GPS y GSM con envío de cadena de google maps.
Dependencies: GPSGSM TextLCD mbed
Fork of TAREA_4_GPS_GSM by
main.cpp@2:ea6275d1222f, 2016-11-18 (annotated)
- Committer:
- joshema216
- Date:
- Fri Nov 18 21:27:40 2016 +0000
- Revision:
- 2:ea6275d1222f
- Parent:
- 1:e2bd083802c0
- Child:
- 3:238bcdf52c8f
Version 1.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
joshema216 | 2:ea6275d1222f | 1 | // Programa para establecer la comunicación con un módem Siemens A56 por una de las UART. |
joshema216 | 2:ea6275d1222f | 2 | // Por otra UART se envían datos de GPS de una región seleccionada de la aplicación de |
joshema216 | 2:ea6275d1222f | 3 | // Google Earth en formato .kml leídos por el programa SatGen de NMEA por un puerto COM |
joshema216 | 2:ea6275d1222f | 4 | // del Micro hacia un Dongle USB. Se deberá enviar un mensaje de texto al módem el cual |
joshema216 | 2:ea6275d1222f | 5 | // podrá ser la palabra "coordenadas" o "voltaje". Si se envía "coordenadas" el programa |
joshema216 | 2:ea6275d1222f | 6 | // calcula la latitud y la longitud de la coordenada actual de GPS y envía un mensaje de |
joshema216 | 2:ea6275d1222f | 7 | // texto al mismo número con las coordenadas en formato de Google Maps. Si se envía |
joshema216 | 2:ea6275d1222f | 8 | // "voltaje" se lee el voltaje de un puerto que se puede variar con un potenciómetro y |
joshema216 | 2:ea6275d1222f | 9 | // envía un mensaje de texto con la medida. Los mensajes de texto recibidos se interpretan |
joshema216 | 2:ea6275d1222f | 10 | // y decodifican de formato PDU a caracteres y los mensajes enviados se codifican de |
joshema216 | 2:ea6275d1222f | 11 | // caracteres a formato PDU para ser enviados. |
joshema216 | 2:ea6275d1222f | 12 | |
joshema216 | 2:ea6275d1222f | 13 | // Oswaldo Andrés Giraldo Giraldo - C.C.: 1152458465 |
joshema216 | 2:ea6275d1222f | 14 | // Héctor Andrés Hoyos Ceballos - C.C.: 1039466317 |
joshema216 | 2:ea6275d1222f | 15 | // Jose Fernando Montoya Vargas - C.C.: 1039468676 |
joshema216 | 2:ea6275d1222f | 16 | // María Fernanda Villa Tamayo - C.C.: 1152457490 |
joshema216 | 2:ea6275d1222f | 17 | |
procesadores_FAC | 0:b2a6aa7c0c8c | 18 | #include "mbed.h" |
procesadores_FAC | 0:b2a6aa7c0c8c | 19 | #include "DebouncedIn.h" |
procesadores_FAC | 0:b2a6aa7c0c8c | 20 | #include "stdio.h" |
procesadores_FAC | 0:b2a6aa7c0c8c | 21 | #include "string.h" |
procesadores_FAC | 0:b2a6aa7c0c8c | 22 | #include "GPS.h" |
joshema216 | 2:ea6275d1222f | 23 | |
AaronGonzalez | 1:e2bd083802c0 | 24 | //Salidas digitales |
procesadores_FAC | 0:b2a6aa7c0c8c | 25 | Timer t; |
procesadores_FAC | 0:b2a6aa7c0c8c | 26 | DigitalOut LedVerde(LED2); |
procesadores_FAC | 0:b2a6aa7c0c8c | 27 | DigitalOut LedRojo(LED1); |
procesadores_FAC | 0:b2a6aa7c0c8c | 28 | DigitalOut LedAzul(LED3); |
procesadores_FAC | 0:b2a6aa7c0c8c | 29 | |
joshema216 | 2:ea6275d1222f | 30 | // Entrada análoga |
joshema216 | 2:ea6275d1222f | 31 | AnalogIn v(PTB0); |
joshema216 | 2:ea6275d1222f | 32 | float medi; |
joshema216 | 2:ea6275d1222f | 33 | |
joshema216 | 2:ea6275d1222f | 34 | // Declaración de los puertos de la FRDM, Módem y GPS. |
joshema216 | 2:ea6275d1222f | 35 | Serial GSM(PTE0,PTE1); // Puertos del FRDM para el Módem. |
procesadores_FAC | 0:b2a6aa7c0c8c | 36 | Serial pc(USBTX,USBRX); |
joshema216 | 2:ea6275d1222f | 37 | GPS gps(PTE22, PTE23); // Puerto del FDRM para el GPS. |
procesadores_FAC | 0:b2a6aa7c0c8c | 38 | |
joshema216 | 2:ea6275d1222f | 39 | // Declaración de variables |
joshema216 | 2:ea6275d1222f | 40 | // Cadenas de caracteres con las que se va a trabajar. |
joshema216 | 2:ea6275d1222f | 41 | char DE1[255]; |
joshema216 | 2:ea6275d1222f | 42 | char DS1[255]; |
joshema216 | 2:ea6275d1222f | 43 | char DE2[255]; |
joshema216 | 2:ea6275d1222f | 44 | char DS2[255]; |
procesadores_FAC | 0:b2a6aa7c0c8c | 45 | char buffer[512]; |
joshema216 | 2:ea6275d1222f | 46 | char resp[6]; |
joshema216 | 2:ea6275d1222f | 47 | char tam[2]; |
procesadores_FAC | 0:b2a6aa7c0c8c | 48 | char mensaje[100]; |
joshema216 | 2:ea6275d1222f | 49 | |
AaronGonzalez | 1:e2bd083802c0 | 50 | //Variables enteras y caracteres |
procesadores_FAC | 0:b2a6aa7c0c8c | 51 | int count; |
joshema216 | 2:ea6275d1222f | 52 | int i, K, LENOUT1, LENIN1, LENOUT2, LENIN2, C; |
procesadores_FAC | 0:b2a6aa7c0c8c | 53 | int c=0; |
procesadores_FAC | 0:b2a6aa7c0c8c | 54 | char r[]=""; |
procesadores_FAC | 0:b2a6aa7c0c8c | 55 | char msg[256]; |
procesadores_FAC | 0:b2a6aa7c0c8c | 56 | char char1; |
joshema216 | 2:ea6275d1222f | 57 | int ind; |
joshema216 | 2:ea6275d1222f | 58 | float med; |
joshema216 | 2:ea6275d1222f | 59 | char outmed[16], outmedn[16]; |
joshema216 | 2:ea6275d1222f | 60 | int ret = 1; |
joshema216 | 2:ea6275d1222f | 61 | |
joshema216 | 2:ea6275d1222f | 62 | // Adquisición de números de teléfono, emisor - receptor |
joshema216 | 2:ea6275d1222f | 63 | char tel[15]; |
procesadores_FAC | 0:b2a6aa7c0c8c | 64 | |
joshema216 | 2:ea6275d1222f | 65 | // El GPS entregará al celular coordenadas expresadas en latitud y longitud |
joshema216 | 2:ea6275d1222f | 66 | // según la ubicación que encuentre, por lo tanto se declaran estas variables. |
procesadores_FAC | 0:b2a6aa7c0c8c | 67 | float lo,la; |
joshema216 | 2:ea6275d1222f | 68 | char clo[255], cla[255]; // Cadenas a capturar para latitud y longitud. |
joshema216 | 2:ea6275d1222f | 69 | char la_lo[255], volt[255]; |
joshema216 | 2:ea6275d1222f | 70 | |
joshema216 | 2:ea6275d1222f | 71 | // Cadena de google maps |
procesadores_FAC | 0:b2a6aa7c0c8c | 72 | char http2[255]; |
procesadores_FAC | 0:b2a6aa7c0c8c | 73 | char http[] = "http://maps.google.com/maps?q="; |
procesadores_FAC | 0:b2a6aa7c0c8c | 74 | char buf[100]; |
procesadores_FAC | 0:b2a6aa7c0c8c | 75 | |
joshema216 | 2:ea6275d1222f | 76 | // Relleno de datos propio del protocolo de SMS. |
joshema216 | 2:ea6275d1222f | 77 | char relle1[] = "0011000A91"; |
joshema216 | 2:ea6275d1222f | 78 | char relle2[] = "0000AA"; |
procesadores_FAC | 0:b2a6aa7c0c8c | 79 | |
joshema216 | 2:ea6275d1222f | 80 | // Reverses a string 'str' of length 'len' |
joshema216 | 2:ea6275d1222f | 81 | // driver program to test above funtion. |
joshema216 | 2:ea6275d1222f | 82 | void reverse(char *str, int len) |
joshema216 | 2:ea6275d1222f | 83 | { |
joshema216 | 2:ea6275d1222f | 84 | int i=0, j=len-1, temp; |
joshema216 | 2:ea6275d1222f | 85 | while (i<j) |
joshema216 | 2:ea6275d1222f | 86 | { |
joshema216 | 2:ea6275d1222f | 87 | temp = str[i]; |
joshema216 | 2:ea6275d1222f | 88 | str[i] = str[j]; |
joshema216 | 2:ea6275d1222f | 89 | str[j] = temp; |
joshema216 | 2:ea6275d1222f | 90 | i++; j--; |
joshema216 | 2:ea6275d1222f | 91 | } |
joshema216 | 2:ea6275d1222f | 92 | } |
joshema216 | 2:ea6275d1222f | 93 | |
joshema216 | 2:ea6275d1222f | 94 | // Converts a given integer x to string str[]. d is the number |
joshema216 | 2:ea6275d1222f | 95 | // of digits required in output. If d is more than the number |
joshema216 | 2:ea6275d1222f | 96 | // of digits in x, then 0s are added at the beginning. |
joshema216 | 2:ea6275d1222f | 97 | int intToStr(int x, char str[], int d) |
joshema216 | 2:ea6275d1222f | 98 | { |
joshema216 | 2:ea6275d1222f | 99 | int i = 0; |
joshema216 | 2:ea6275d1222f | 100 | while (x) |
joshema216 | 2:ea6275d1222f | 101 | { |
joshema216 | 2:ea6275d1222f | 102 | str[i++] = (x%10) + '0'; |
joshema216 | 2:ea6275d1222f | 103 | x = x/10; |
joshema216 | 2:ea6275d1222f | 104 | } |
joshema216 | 2:ea6275d1222f | 105 | |
joshema216 | 2:ea6275d1222f | 106 | // If number of digits required is more, then |
joshema216 | 2:ea6275d1222f | 107 | // add 0s at the beginning |
joshema216 | 2:ea6275d1222f | 108 | while (i < d) |
joshema216 | 2:ea6275d1222f | 109 | str[i++] = '0'; |
joshema216 | 2:ea6275d1222f | 110 | |
joshema216 | 2:ea6275d1222f | 111 | reverse(str, i); |
joshema216 | 2:ea6275d1222f | 112 | str[i] = '\0'; |
joshema216 | 2:ea6275d1222f | 113 | return i; |
joshema216 | 2:ea6275d1222f | 114 | } |
procesadores_FAC | 0:b2a6aa7c0c8c | 115 | |
joshema216 | 2:ea6275d1222f | 116 | // Converts a floating point number to string. |
joshema216 | 2:ea6275d1222f | 117 | void ftoa(float n, char *res, int afterpoint) |
joshema216 | 2:ea6275d1222f | 118 | { |
joshema216 | 2:ea6275d1222f | 119 | // Extract integer part |
joshema216 | 2:ea6275d1222f | 120 | int ipart = (int)n; |
joshema216 | 2:ea6275d1222f | 121 | |
joshema216 | 2:ea6275d1222f | 122 | // Extract floating part |
joshema216 | 2:ea6275d1222f | 123 | float fpart = n - (float)ipart; |
joshema216 | 2:ea6275d1222f | 124 | |
joshema216 | 2:ea6275d1222f | 125 | // convert integer part to string |
joshema216 | 2:ea6275d1222f | 126 | int i = intToStr(ipart, res, 0); |
joshema216 | 2:ea6275d1222f | 127 | |
joshema216 | 2:ea6275d1222f | 128 | // check for display option after point |
joshema216 | 2:ea6275d1222f | 129 | if (afterpoint != 0) |
joshema216 | 2:ea6275d1222f | 130 | { |
joshema216 | 2:ea6275d1222f | 131 | res[i] = '.'; // add dot |
procesadores_FAC | 0:b2a6aa7c0c8c | 132 | |
joshema216 | 2:ea6275d1222f | 133 | // Get the value of fraction part upto given no. |
joshema216 | 2:ea6275d1222f | 134 | // of points after dot. The third parameter is needed |
joshema216 | 2:ea6275d1222f | 135 | // to handle cases like 233.007 |
joshema216 | 2:ea6275d1222f | 136 | float fp=10; |
joshema216 | 2:ea6275d1222f | 137 | fpart =fpart * pow(fp,afterpoint); |
joshema216 | 2:ea6275d1222f | 138 | |
joshema216 | 2:ea6275d1222f | 139 | intToStr((int)fpart, res + i + 1, afterpoint); |
joshema216 | 2:ea6275d1222f | 140 | } |
joshema216 | 2:ea6275d1222f | 141 | } |
joshema216 | 2:ea6275d1222f | 142 | |
joshema216 | 2:ea6275d1222f | 143 | void FlushGSM(void) { |
joshema216 | 2:ea6275d1222f | 144 | char1 = 0; |
joshema216 | 2:ea6275d1222f | 145 | while (GSM.readable()){ |
joshema216 | 2:ea6275d1222f | 146 | char1 = GSM.getc(); |
joshema216 | 2:ea6275d1222f | 147 | } |
joshema216 | 2:ea6275d1222f | 148 | return; |
joshema216 | 2:ea6275d1222f | 149 | } |
joshema216 | 2:ea6275d1222f | 150 | |
joshema216 | 2:ea6275d1222f | 151 | void callback(){ |
joshema216 | 2:ea6275d1222f | 152 | // Note: you need to actually read from the serial to clear the RX interrupt |
joshema216 | 2:ea6275d1222f | 153 | pc.printf("%c\n", GSM.getc()); |
joshema216 | 2:ea6275d1222f | 154 | } |
joshema216 | 2:ea6275d1222f | 155 | |
joshema216 | 2:ea6275d1222f | 156 | // Esta funcion de abajo lee todo un bufer hasta encontrar CR o LF y el resto lo rellena de |
joshema216 | 2:ea6275d1222f | 157 | // $, count es lo que va a leer. Lo leido lo mete en buffer que es una cadena previamente definida |
joshema216 | 2:ea6275d1222f | 158 | // incorpora medida de tiempo si se demora mas de tres segundos retorna fracaso con -1 |
joshema216 | 2:ea6275d1222f | 159 | int readBuffer(char *buffer,int count){ |
procesadores_FAC | 0:b2a6aa7c0c8c | 160 | int i=0; |
joshema216 | 2:ea6275d1222f | 161 | t.start(); // start timer |
procesadores_FAC | 0:b2a6aa7c0c8c | 162 | while(1) { |
procesadores_FAC | 0:b2a6aa7c0c8c | 163 | while (GSM.readable()) { |
procesadores_FAC | 0:b2a6aa7c0c8c | 164 | char c = GSM.getc(); |
procesadores_FAC | 0:b2a6aa7c0c8c | 165 | if (c == '\r' || c == '\n') c = '$'; |
procesadores_FAC | 0:b2a6aa7c0c8c | 166 | buffer[i++] = c; |
procesadores_FAC | 0:b2a6aa7c0c8c | 167 | if(i > count)break; |
procesadores_FAC | 0:b2a6aa7c0c8c | 168 | } |
joshema216 | 2:ea6275d1222f | 169 | if(i > count)break; |
procesadores_FAC | 0:b2a6aa7c0c8c | 170 | if(t.read() > 3) { |
procesadores_FAC | 0:b2a6aa7c0c8c | 171 | t.stop(); |
procesadores_FAC | 0:b2a6aa7c0c8c | 172 | t.reset(); |
procesadores_FAC | 0:b2a6aa7c0c8c | 173 | break; |
procesadores_FAC | 0:b2a6aa7c0c8c | 174 | } |
procesadores_FAC | 0:b2a6aa7c0c8c | 175 | } |
procesadores_FAC | 0:b2a6aa7c0c8c | 176 | wait(0.5); |
joshema216 | 2:ea6275d1222f | 177 | while(GSM.readable()){ // display the other thing.. |
joshema216 | 2:ea6275d1222f | 178 | char c = GSM.getc(); |
joshema216 | 2:ea6275d1222f | 179 | } |
joshema216 | 2:ea6275d1222f | 180 | return 0; |
joshema216 | 2:ea6275d1222f | 181 | } |
joshema216 | 2:ea6275d1222f | 182 | |
joshema216 | 2:ea6275d1222f | 183 | // Esta función de abajo limpia o borra todo un "buffer" de tamaño "count", |
joshema216 | 2:ea6275d1222f | 184 | // lo revisa elemento por elemento y le mete el caracter null que indica fin de cadena. |
joshema216 | 2:ea6275d1222f | 185 | // No retorna nada. |
joshema216 | 2:ea6275d1222f | 186 | void cleanBuffer(char *buffer, int count){ |
joshema216 | 2:ea6275d1222f | 187 | for(int i=0; i < count; i++) { |
joshema216 | 2:ea6275d1222f | 188 | buffer[i] = '\0'; |
joshema216 | 2:ea6275d1222f | 189 | } |
joshema216 | 2:ea6275d1222f | 190 | } |
joshema216 | 2:ea6275d1222f | 191 | |
joshema216 | 2:ea6275d1222f | 192 | // Esta función de abajo envia un comando parametrizado como cadena |
joshema216 | 2:ea6275d1222f | 193 | // puede ser un comando tipo AT. |
joshema216 | 2:ea6275d1222f | 194 | void sendCmd(char *cmd){ |
joshema216 | 2:ea6275d1222f | 195 | GSM.puts(cmd); |
joshema216 | 2:ea6275d1222f | 196 | } |
joshema216 | 2:ea6275d1222f | 197 | |
joshema216 | 2:ea6275d1222f | 198 | // Esta función de abajo espera la respuesta de un comando que debe ser idéntica a la cadena "resp" y un tiempo "timeout", |
joshema216 | 2:ea6275d1222f | 199 | // si todo sale bien retorna un cero que en la programacion hay que validar, |
joshema216 | 2:ea6275d1222f | 200 | // si algo sale mal (no se parece o se demora mucho) retorna -1 que debera validarse con alguna expresion logica. |
joshema216 | 2:ea6275d1222f | 201 | int waitForResp(char *resp, int timeout){ |
joshema216 | 2:ea6275d1222f | 202 | int len = strlen(resp); |
joshema216 | 2:ea6275d1222f | 203 | int sum=0; |
joshema216 | 2:ea6275d1222f | 204 | t.start(); |
joshema216 | 2:ea6275d1222f | 205 | |
joshema216 | 2:ea6275d1222f | 206 | while(1) { |
joshema216 | 2:ea6275d1222f | 207 | if(GSM.readable()) { |
joshema216 | 2:ea6275d1222f | 208 | char c = GSM.getc(); |
joshema216 | 2:ea6275d1222f | 209 | sum = (c==resp[sum]) ? sum+1 : 0;// esta linea de C# sum se incrementa o se hace cero segun c |
joshema216 | 2:ea6275d1222f | 210 | if(sum == len)break; //ya acabo se sale |
joshema216 | 2:ea6275d1222f | 211 | } |
joshema216 | 2:ea6275d1222f | 212 | if(t.read() > timeout) { // time out chequea el tiempo minimo antes de salir perdiendo |
joshema216 | 2:ea6275d1222f | 213 | t.stop(); |
joshema216 | 2:ea6275d1222f | 214 | t.reset(); |
joshema216 | 2:ea6275d1222f | 215 | return -1; |
joshema216 | 2:ea6275d1222f | 216 | } |
joshema216 | 2:ea6275d1222f | 217 | } |
joshema216 | 2:ea6275d1222f | 218 | t.stop(); // stop timer antes de retornar |
joshema216 | 2:ea6275d1222f | 219 | t.reset(); // clear timer |
joshema216 | 2:ea6275d1222f | 220 | while(GSM.readable()) { // display the other thing.. |
procesadores_FAC | 0:b2a6aa7c0c8c | 221 | char c = GSM.getc(); |
procesadores_FAC | 0:b2a6aa7c0c8c | 222 | } |
procesadores_FAC | 0:b2a6aa7c0c8c | 223 | return 0; |
procesadores_FAC | 0:b2a6aa7c0c8c | 224 | } |
procesadores_FAC | 0:b2a6aa7c0c8c | 225 | |
joshema216 | 2:ea6275d1222f | 226 | // Esta función de abajo es muy completa y útil, se encarga de enviar el comando y esperar la respuesta. |
joshema216 | 2:ea6275d1222f | 227 | // Si todo sale bien retorna un cero (herencia de las funciones contenedoras) que en la programacion hay que validar |
joshema216 | 2:ea6275d1222f | 228 | // con alguna expresion lógica. |
joshema216 | 2:ea6275d1222f | 229 | int sendCmdAndWaitForResp(char *cmd, char *resp, int timeout){ |
joshema216 | 2:ea6275d1222f | 230 | sendCmd(cmd); |
joshema216 | 2:ea6275d1222f | 231 | return waitForResp(resp,timeout); |
joshema216 | 2:ea6275d1222f | 232 | } |
joshema216 | 2:ea6275d1222f | 233 | |
joshema216 | 2:ea6275d1222f | 234 | // Esta función de abajo chequea que el módem este vivo, envia AT, le contesta con OK y espera 2 segundos. |
joshema216 | 2:ea6275d1222f | 235 | int powerCheck(void){ // Este comando se manda para verificar si el módem esta vivo o conectado. |
joshema216 | 2:ea6275d1222f | 236 | return sendCmdAndWaitForResp("AT\r\n", "OK", 2); |
joshema216 | 2:ea6275d1222f | 237 | } |
joshema216 | 2:ea6275d1222f | 238 | |
joshema216 | 2:ea6275d1222f | 239 | // Esta función de abajo chequea el estado de la sim card |
joshema216 | 2:ea6275d1222f | 240 | // y si todo sale bien retorna un cero que en la programacion hay que validar |
joshema216 | 2:ea6275d1222f | 241 | // con alguna expresión lógica. |
joshema216 | 2:ea6275d1222f | 242 | int checkSIMStatus(void){ |
joshema216 | 2:ea6275d1222f | 243 | char gprsBuffer[30]; |
joshema216 | 2:ea6275d1222f | 244 | int count = 0; |
joshema216 | 2:ea6275d1222f | 245 | cleanBuffer(gprsBuffer, 30); |
joshema216 | 2:ea6275d1222f | 246 | while(count < 3){ |
joshema216 | 2:ea6275d1222f | 247 | sendCmd("AT+CPIN?\r\n"); |
joshema216 | 2:ea6275d1222f | 248 | readBuffer(gprsBuffer,30); |
joshema216 | 2:ea6275d1222f | 249 | if((NULL != strstr(gprsBuffer,"+CPIN: READY"))){ |
joshema216 | 2:ea6275d1222f | 250 | break; |
joshema216 | 2:ea6275d1222f | 251 | } |
joshema216 | 2:ea6275d1222f | 252 | count++; |
joshema216 | 2:ea6275d1222f | 253 | wait(1); |
joshema216 | 2:ea6275d1222f | 254 | } |
joshema216 | 2:ea6275d1222f | 255 | |
joshema216 | 2:ea6275d1222f | 256 | if(count == 3){ |
joshema216 | 2:ea6275d1222f | 257 | return -1; |
joshema216 | 2:ea6275d1222f | 258 | } |
joshema216 | 2:ea6275d1222f | 259 | return 0; |
joshema216 | 2:ea6275d1222f | 260 | } |
joshema216 | 2:ea6275d1222f | 261 | |
joshema216 | 2:ea6275d1222f | 262 | // Esta función de abajo chequea la calidad de la señal |
joshema216 | 2:ea6275d1222f | 263 | // y si todo sale bien retorna con el valor de señal útil o un -1 si no es aceptable, en la programacion hay que validar |
joshema216 | 2:ea6275d1222f | 264 | // con alguna expresión lógica. |
joshema216 | 2:ea6275d1222f | 265 | int checkSignalStrength(void){ |
joshema216 | 2:ea6275d1222f | 266 | char gprsBuffer[100]; |
joshema216 | 2:ea6275d1222f | 267 | int index, count = 0; |
joshema216 | 2:ea6275d1222f | 268 | cleanBuffer(gprsBuffer,100); |
joshema216 | 2:ea6275d1222f | 269 | while(count < 3){ |
joshema216 | 2:ea6275d1222f | 270 | sendCmd("AT+CSQ\r\n"); |
joshema216 | 2:ea6275d1222f | 271 | readBuffer(gprsBuffer,25); |
joshema216 | 2:ea6275d1222f | 272 | if(sscanf(gprsBuffer, "AT+CSQ$$$$+CSQ: %d", &index)>0) { |
joshema216 | 2:ea6275d1222f | 273 | break; |
joshema216 | 2:ea6275d1222f | 274 | } |
joshema216 | 2:ea6275d1222f | 275 | count++; |
joshema216 | 2:ea6275d1222f | 276 | wait(1); |
joshema216 | 2:ea6275d1222f | 277 | } |
joshema216 | 2:ea6275d1222f | 278 | if(count == 3){ |
joshema216 | 2:ea6275d1222f | 279 | return -1; |
joshema216 | 2:ea6275d1222f | 280 | } |
joshema216 | 2:ea6275d1222f | 281 | return index; |
joshema216 | 2:ea6275d1222f | 282 | } |
joshema216 | 2:ea6275d1222f | 283 | |
joshema216 | 2:ea6275d1222f | 284 | // Esta funcion de abajo inicaliza el módem. Se compone de un grupo de subfunciones ya definidas previamente |
joshema216 | 2:ea6275d1222f | 285 | // primero chequea que este vivo, |
joshema216 | 2:ea6275d1222f | 286 | // segundo chequea el estado de la simcard, |
joshema216 | 2:ea6275d1222f | 287 | // tercero chequea la intencidad de señal celular, |
joshema216 | 2:ea6275d1222f | 288 | // cuarto aplica la configuracion |
joshema216 | 2:ea6275d1222f | 289 | // y si todo sale bien retorna un cero que en la programacion hay que validar |
joshema216 | 2:ea6275d1222f | 290 | // con alguna expresión lógica. |
joshema216 | 2:ea6275d1222f | 291 | int init(){ |
joshema216 | 2:ea6275d1222f | 292 | if (0 != sendCmdAndWaitForResp("AT\r\n", "OK", 3)){ |
joshema216 | 2:ea6275d1222f | 293 | return -1; |
joshema216 | 2:ea6275d1222f | 294 | } |
joshema216 | 2:ea6275d1222f | 295 | if (0 != sendCmdAndWaitForResp("AT+CNMI=1,1\r\n", "OK", 3)){ |
joshema216 | 2:ea6275d1222f | 296 | return -1; |
joshema216 | 2:ea6275d1222f | 297 | } |
joshema216 | 2:ea6275d1222f | 298 | if (0 != sendCmdAndWaitForResp("AT+CMGF=0\r\n", "OK", 3)){ |
joshema216 | 2:ea6275d1222f | 299 | return -1; |
joshema216 | 2:ea6275d1222f | 300 | } |
joshema216 | 2:ea6275d1222f | 301 | if (0 != sendCmdAndWaitForResp("AT+CBST=7,0,1\r\n", "OK", 3)){ //velocidad fija a 9600, modem asincronico no transparente |
joshema216 | 2:ea6275d1222f | 302 | return -1; |
joshema216 | 2:ea6275d1222f | 303 | } |
joshema216 | 2:ea6275d1222f | 304 | if (0 != sendCmdAndWaitForResp("ATE\r\n", "OK", 3)){ //se le quita el eco al modem GSM |
joshema216 | 2:ea6275d1222f | 305 | return -1; |
joshema216 | 2:ea6275d1222f | 306 | } |
joshema216 | 2:ea6275d1222f | 307 | LedVerde=0; |
joshema216 | 2:ea6275d1222f | 308 | return 0; |
joshema216 | 2:ea6275d1222f | 309 | } |
joshema216 | 2:ea6275d1222f | 310 | |
joshema216 | 2:ea6275d1222f | 311 | // Esta funcion de abajo intenta leer un mensaje de texto en formato PDU o HEX |
joshema216 | 2:ea6275d1222f | 312 | // y si todo sale bien retorna un cero que en la programacion hay que validar |
joshema216 | 2:ea6275d1222f | 313 | // con alguna expresión lógica. |
joshema216 | 2:ea6275d1222f | 314 | int readSMSpdu(char *message, int index){ |
joshema216 | 2:ea6275d1222f | 315 | int i = 0; |
joshema216 | 2:ea6275d1222f | 316 | char gprsBuffer[100]; |
joshema216 | 2:ea6275d1222f | 317 | char *p,*s; |
joshema216 | 2:ea6275d1222f | 318 | GSM.printf("AT+CMGR=%d\r\n",index); |
joshema216 | 2:ea6275d1222f | 319 | cleanBuffer(gprsBuffer,100); |
joshema216 | 2:ea6275d1222f | 320 | readBuffer(gprsBuffer,100); |
joshema216 | 2:ea6275d1222f | 321 | if(NULL == ( s = strstr(gprsBuffer,"+CMGR"))) { |
joshema216 | 2:ea6275d1222f | 322 | return -1; |
joshema216 | 2:ea6275d1222f | 323 | } |
joshema216 | 2:ea6275d1222f | 324 | if(NULL != ( s = strstr(gprsBuffer,"+32"))) { |
joshema216 | 2:ea6275d1222f | 325 | p = s + 6; |
joshema216 | 2:ea6275d1222f | 326 | while((*p != '$')&&(i < 5)) { |
joshema216 | 2:ea6275d1222f | 327 | message[i++] = *(p++); |
joshema216 | 2:ea6275d1222f | 328 | } |
joshema216 | 2:ea6275d1222f | 329 | message[i] = '\0'; |
joshema216 | 2:ea6275d1222f | 330 | } |
joshema216 | 2:ea6275d1222f | 331 | return 0; |
joshema216 | 2:ea6275d1222f | 332 | } |
joshema216 | 2:ea6275d1222f | 333 | |
joshema216 | 2:ea6275d1222f | 334 | // Esta función de abajo borra mensajes SMS del modem |
joshema216 | 2:ea6275d1222f | 335 | // y si todo sale bien retorna un cero que en la programacion hay que validar |
joshema216 | 2:ea6275d1222f | 336 | // con alguna expresion logica. |
joshema216 | 2:ea6275d1222f | 337 | int deleteSMS(int index){ |
joshema216 | 2:ea6275d1222f | 338 | char cmd[32]; |
joshema216 | 2:ea6275d1222f | 339 | snprintf(cmd,sizeof(cmd),"AT+CMGD=%d\r\n",index); |
joshema216 | 2:ea6275d1222f | 340 | sendCmd(cmd); |
joshema216 | 2:ea6275d1222f | 341 | return 0; |
joshema216 | 2:ea6275d1222f | 342 | } |
joshema216 | 2:ea6275d1222f | 343 | |
joshema216 | 2:ea6275d1222f | 344 | // Esta función devuelve la confirmacion del mensaje a quien lo envio. |
joshema216 | 2:ea6275d1222f | 345 | int recibe_ok(){ |
joshema216 | 2:ea6275d1222f | 346 | GSM.printf("AT+CMGS=27\n\r"); |
joshema216 | 2:ea6275d1222f | 347 | pc.printf("AT+CMGS=27\n\r"); |
joshema216 | 2:ea6275d1222f | 348 | wait_ms(100); |
joshema216 | 2:ea6275d1222f | 349 | GSM.printf("0011000A91%s0000AA10CDB27B1E569741F2F2382D4E93DF",tel); |
joshema216 | 2:ea6275d1222f | 350 | pc.printf("0011000A91%s0000AA10CDB27B1E569741F2F2382D4E93DF",tel); |
joshema216 | 2:ea6275d1222f | 351 | wait_ms(100); |
joshema216 | 2:ea6275d1222f | 352 | GSM.putc((char)0x1A); |
joshema216 | 2:ea6275d1222f | 353 | return 0; |
joshema216 | 2:ea6275d1222f | 354 | } |
joshema216 | 2:ea6275d1222f | 355 | |
joshema216 | 2:ea6275d1222f | 356 | // Programas a ejecutar. |
joshema216 | 2:ea6275d1222f | 357 | int main(){ |
joshema216 | 2:ea6275d1222f | 358 | //configuramos los puertos seriales |
joshema216 | 2:ea6275d1222f | 359 | GSM.baud(9600);//configura los baudios de la FRDMKL25Z en 9600 |
joshema216 | 2:ea6275d1222f | 360 | GSM.format(8,Serial::None,1); //configura el formato de los datos de la UART |
joshema216 | 2:ea6275d1222f | 361 | LedVerde = 1; // APAGO LOS LEDS |
joshema216 | 2:ea6275d1222f | 362 | LedRojo = 1; |
joshema216 | 2:ea6275d1222f | 363 | LedAzul = 1; |
joshema216 | 2:ea6275d1222f | 364 | LedRojo = 0; // PRENDO EL LED ROJO |
joshema216 | 2:ea6275d1222f | 365 | // Quito el eco del modem |
procesadores_FAC | 0:b2a6aa7c0c8c | 366 | |
joshema216 | 2:ea6275d1222f | 367 | // CONFIGURACIÓN DEL MODEM GSM (TELEFONO CELULAR SIEMENS A56i). |
joshema216 | 2:ea6275d1222f | 368 | inicio1: |
joshema216 | 2:ea6275d1222f | 369 | ret = init(); |
joshema216 | 2:ea6275d1222f | 370 | if(ret==0){ |
joshema216 | 2:ea6275d1222f | 371 | LedRojo = 1; |
joshema216 | 2:ea6275d1222f | 372 | LedVerde = 0; // Apagar LED Verde para confirmar la comunicación con el módem. |
joshema216 | 2:ea6275d1222f | 373 | pc.printf("Modem configurado\n"); |
joshema216 | 2:ea6275d1222f | 374 | } |
joshema216 | 2:ea6275d1222f | 375 | else{ |
joshema216 | 2:ea6275d1222f | 376 | wait(1); |
joshema216 | 2:ea6275d1222f | 377 | goto inicio1; |
joshema216 | 2:ea6275d1222f | 378 | } |
joshema216 | 2:ea6275d1222f | 379 | |
joshema216 | 2:ea6275d1222f | 380 | while(1){ |
joshema216 | 2:ea6275d1222f | 381 | if (GSM.readable()){ |
joshema216 | 2:ea6275d1222f | 382 | readBuffer(buffer,110); |
joshema216 | 2:ea6275d1222f | 383 | pc.printf("%s\r\n",buffer); |
joshema216 | 2:ea6275d1222f | 384 | for(i=0; i<5; i++){ |
joshema216 | 2:ea6275d1222f | 385 | resp[i] = buffer[i]; |
joshema216 | 2:ea6275d1222f | 386 | } |
joshema216 | 2:ea6275d1222f | 387 | |
joshema216 | 2:ea6275d1222f | 388 | pc.printf("%s\r\n", resp); |
joshema216 | 2:ea6275d1222f | 389 | if(strcmp("$$+CM", resp) == 0){ //COMPARA resp con "+CMTI" |
joshema216 | 2:ea6275d1222f | 390 | pc.printf("Llego MSG\r\n"); |
joshema216 | 2:ea6275d1222f | 391 | cleanBuffer(buffer,10); |
joshema216 | 2:ea6275d1222f | 392 | GSM.printf("AT+CMGL=0\r\n"); // Envío comando para leer mensaje |
joshema216 | 2:ea6275d1222f | 393 | pc.printf("AT+CMGL=0\r\n"); |
joshema216 | 2:ea6275d1222f | 394 | //GSM.printf("AT+CMGD=0\r\n"); // Envío comando para borrar el mensaje. |
joshema216 | 2:ea6275d1222f | 395 | readBuffer(buffer,110); |
joshema216 | 2:ea6275d1222f | 396 | pc.printf("%s\r\n",buffer); |
AaronGonzalez | 1:e2bd083802c0 | 397 | |
joshema216 | 2:ea6275d1222f | 398 | // Lectura el teléfono emisor |
joshema216 | 2:ea6275d1222f | 399 | for(i=0; i<10; i++){ |
joshema216 | 2:ea6275d1222f | 400 | tel[i] = buffer[i+40]; |
joshema216 | 2:ea6275d1222f | 401 | } |
joshema216 | 2:ea6275d1222f | 402 | pc.printf("Telefono: %c%c%c%c%c%c%c%c%c%c\r\n", tel[1], tel[0], tel[3], tel[2], tel[5], tel[4], tel[7], tel[6], tel[9], tel[8]); |
joshema216 | 2:ea6275d1222f | 403 | |
joshema216 | 2:ea6275d1222f | 404 | // Lectura del tamaño |
joshema216 | 2:ea6275d1222f | 405 | for(i=0;i<2;i++){ |
joshema216 | 2:ea6275d1222f | 406 | tam[i] = buffer[i + 68]; |
joshema216 | 2:ea6275d1222f | 407 | } |
joshema216 | 2:ea6275d1222f | 408 | pc.printf("%s-\r\n", tam); |
joshema216 | 2:ea6275d1222f | 409 | |
joshema216 | 2:ea6275d1222f | 410 | // Lectura del mensaje |
joshema216 | 2:ea6275d1222f | 411 | for(i=0;i<26;i++){ |
joshema216 | 2:ea6275d1222f | 412 | msg[i] = buffer[i+70]; // Lee un mensaje de 26 caracteres máximo desde la posición 70 del buffer. |
joshema216 | 2:ea6275d1222f | 413 | } |
joshema216 | 2:ea6275d1222f | 414 | pc.printf("%s-\r\n", msg); |
joshema216 | 2:ea6275d1222f | 415 | |
joshema216 | 2:ea6275d1222f | 416 | // Decodificación del mensaje |
joshema216 | 2:ea6275d1222f | 417 | |
joshema216 | 2:ea6275d1222f | 418 | // Comparar el mensaje |
joshema216 | 2:ea6275d1222f | 419 | deleteSMS(1); // Se borran los mensajes por medio de una función |
joshema216 | 2:ea6275d1222f | 420 | readBuffer(buffer, 200); |
joshema216 | 2:ea6275d1222f | 421 | // COMPARA resp con "E3F75B4E2EBBC3E4F01C" que es "coordenadas", o "C3F75B4E2EBBC3E4F01C" que es "Coordenadas". |
joshema216 | 2:ea6275d1222f | 422 | if((strncmp("E3F75B4E2EBBC3E4F01C", msg, 20) == 0) || (strncmp("C3F75B4E2EBBC3E4F01C", msg, 20) == 0)){ |
joshema216 | 2:ea6275d1222f | 423 | //recibe_ok(); |
joshema216 | 2:ea6275d1222f | 424 | LedVerde = 1; // Encender LED azul. |
joshema216 | 2:ea6275d1222f | 425 | LedAzul = 0; |
joshema216 | 2:ea6275d1222f | 426 | wait(2); |
joshema216 | 2:ea6275d1222f | 427 | |
joshema216 | 2:ea6275d1222f | 428 | if(gps.sample()){ |
joshema216 | 2:ea6275d1222f | 429 | lo = gps.longitude; |
joshema216 | 2:ea6275d1222f | 430 | la = gps.latitude; |
joshema216 | 2:ea6275d1222f | 431 | pc.printf("\nLongitud entera = %f, Latitud entera = %f\n", lo, la); |
joshema216 | 2:ea6275d1222f | 432 | //wait(0.5); |
joshema216 | 2:ea6275d1222f | 433 | |
joshema216 | 2:ea6275d1222f | 434 | //LONGITUD |
joshema216 | 2:ea6275d1222f | 435 | sprintf (clo, "%f", lo); |
joshema216 | 2:ea6275d1222f | 436 | pc.printf ("\nLongitud = %s\n",clo); |
joshema216 | 2:ea6275d1222f | 437 | //wait(0.5); |
joshema216 | 2:ea6275d1222f | 438 | |
joshema216 | 2:ea6275d1222f | 439 | // LATITUD |
joshema216 | 2:ea6275d1222f | 440 | sprintf (cla, "%f", la); |
joshema216 | 2:ea6275d1222f | 441 | pc.printf ( "\nLatitud = %s\n",cla); |
joshema216 | 2:ea6275d1222f | 442 | //wait(0.5); |
joshema216 | 2:ea6275d1222f | 443 | |
joshema216 | 2:ea6275d1222f | 444 | // Concatenando las cadenas de Latitud y Longitud |
joshema216 | 2:ea6275d1222f | 445 | strcpy(la_lo,cla); |
joshema216 | 2:ea6275d1222f | 446 | strcat(la_lo,","); |
joshema216 | 2:ea6275d1222f | 447 | strcat(la_lo,clo); |
joshema216 | 2:ea6275d1222f | 448 | pc.printf("\nLatitud, Longitud: %s\n",la_lo); |
procesadores_FAC | 0:b2a6aa7c0c8c | 449 | |
joshema216 | 2:ea6275d1222f | 450 | //Ahora se juntan las cadenas obtenidas y se agrega el protocolo de transferencia de hipertextos http |
joshema216 | 2:ea6275d1222f | 451 | strcpy(DE1,http); |
joshema216 | 2:ea6275d1222f | 452 | strcat(DE1,la_lo); |
joshema216 | 2:ea6275d1222f | 453 | pc.printf("\nDireccion: %s\n",DE1); |
joshema216 | 2:ea6275d1222f | 454 | pc.printf("\n"); |
joshema216 | 2:ea6275d1222f | 455 | LENIN1 = strlen(DE1); |
joshema216 | 2:ea6275d1222f | 456 | |
joshema216 | 2:ea6275d1222f | 457 | //Conversión a octetos. |
joshema216 | 2:ea6275d1222f | 458 | K = 0; |
joshema216 | 2:ea6275d1222f | 459 | C = 0; |
joshema216 | 2:ea6275d1222f | 460 | for (i = 0; i < LENIN1; i++){ |
joshema216 | 2:ea6275d1222f | 461 | DS1[i] = DE1[i + C] >> K | DE1[i + C + 1] << (7 - K); |
joshema216 | 2:ea6275d1222f | 462 | if(DS1[i] == 0x00) {LENOUT1 = i; goto salir1;} |
joshema216 | 2:ea6275d1222f | 463 | K++; |
joshema216 | 2:ea6275d1222f | 464 | if (K == 7) {K = 0; C++;} // se chequea que ya se acabaron los bits en un ciclo de conversion. |
joshema216 | 2:ea6275d1222f | 465 | } |
joshema216 | 2:ea6275d1222f | 466 | |
joshema216 | 2:ea6275d1222f | 467 | salir1: |
joshema216 | 2:ea6275d1222f | 468 | for (i = 0; i < LENIN1; i++){ |
joshema216 | 2:ea6275d1222f | 469 | pc.printf("%X", DE1[i]); |
joshema216 | 2:ea6275d1222f | 470 | } |
joshema216 | 2:ea6275d1222f | 471 | |
joshema216 | 2:ea6275d1222f | 472 | pc.printf(":\r\n"); |
joshema216 | 2:ea6275d1222f | 473 | for (i = 0; i < LENOUT1; i++){ |
joshema216 | 2:ea6275d1222f | 474 | pc.printf("%2X", DS1[i]&0x000000FF); |
joshema216 | 2:ea6275d1222f | 475 | } |
joshema216 | 2:ea6275d1222f | 476 | pc.printf("\r\nLENOUT GPS: %d, LENIN GPS: %2X\r\n", LENOUT1, LENIN1); |
joshema216 | 2:ea6275d1222f | 477 | |
joshema216 | 2:ea6275d1222f | 478 | // Concatenación del mensaje en formato PDU y envío del mismo. |
joshema216 | 2:ea6275d1222f | 479 | ind = 14 + LENOUT1 - 1; |
joshema216 | 2:ea6275d1222f | 480 | |
joshema216 | 2:ea6275d1222f | 481 | GSM.printf("AT+CMGS=%d\r\n",ind); |
joshema216 | 2:ea6275d1222f | 482 | pc.printf("AT+CMGS=%d\r\n",ind); |
joshema216 | 2:ea6275d1222f | 483 | pc.printf(relle1); |
joshema216 | 2:ea6275d1222f | 484 | GSM.printf(relle1); |
joshema216 | 2:ea6275d1222f | 485 | |
joshema216 | 2:ea6275d1222f | 486 | for (i=0 ;i<=9; i++) { |
joshema216 | 2:ea6275d1222f | 487 | pc.printf("%c",tel[i]); |
joshema216 | 2:ea6275d1222f | 488 | GSM.printf("%c",tel[i]); |
joshema216 | 2:ea6275d1222f | 489 | } |
joshema216 | 2:ea6275d1222f | 490 | |
joshema216 | 2:ea6275d1222f | 491 | pc.printf(relle2); |
joshema216 | 2:ea6275d1222f | 492 | GSM.printf(relle2); |
joshema216 | 2:ea6275d1222f | 493 | pc.printf("%2X", LENIN1); |
joshema216 | 2:ea6275d1222f | 494 | GSM.printf("%2X", LENIN1); |
joshema216 | 2:ea6275d1222f | 495 | |
joshema216 | 2:ea6275d1222f | 496 | for (i = 0; i < LENOUT1; i++){ |
joshema216 | 2:ea6275d1222f | 497 | pc.printf("%02X", DS1[i]&0x000000FF); |
joshema216 | 2:ea6275d1222f | 498 | GSM.printf("%02X", DS1[i]&0x000000FF); |
joshema216 | 2:ea6275d1222f | 499 | } |
joshema216 | 2:ea6275d1222f | 500 | wait(1); |
joshema216 | 2:ea6275d1222f | 501 | GSM.putc((char)0x1A); // Ctrl - Z. |
joshema216 | 2:ea6275d1222f | 502 | GSM.scanf("%s",buf); // Estado del mensaje (Envió o Error). |
joshema216 | 2:ea6275d1222f | 503 | pc.printf(">%s\n",buf); |
joshema216 | 2:ea6275d1222f | 504 | pc.printf("\n"); |
procesadores_FAC | 0:b2a6aa7c0c8c | 505 | } |
procesadores_FAC | 0:b2a6aa7c0c8c | 506 | |
joshema216 | 2:ea6275d1222f | 507 | wait(2); |
joshema216 | 2:ea6275d1222f | 508 | LedAzul = 1; |
joshema216 | 2:ea6275d1222f | 509 | LedVerde = 0; |
joshema216 | 2:ea6275d1222f | 510 | GSM.printf("AT+CMGD=0\r\n"); // Borra el mensaje actual (Posición "0"). |
joshema216 | 2:ea6275d1222f | 511 | //pc.printf("\n%s\n\n", "Borro mensaje"); |
joshema216 | 2:ea6275d1222f | 512 | } |
joshema216 | 2:ea6275d1222f | 513 | |
joshema216 | 2:ea6275d1222f | 514 | // COMPARA resp con "F6379B1E569701" que es "voltaje", o "F6379B1E569701" que es "Voltaje". |
joshema216 | 2:ea6275d1222f | 515 | if((strncmp("F6379B1E569701", msg, 14) == 0) || (strncmp("D6379B1E569701", msg, 14) == 0)){ |
joshema216 | 2:ea6275d1222f | 516 | //recibe_ok(); |
joshema216 | 2:ea6275d1222f | 517 | LedRojo = 0; // Encender LED amarillo. |
joshema216 | 2:ea6275d1222f | 518 | LedVerde = 0; |
joshema216 | 2:ea6275d1222f | 519 | LedAzul = 1; |
joshema216 | 2:ea6275d1222f | 520 | wait(2); |
joshema216 | 2:ea6275d1222f | 521 | |
joshema216 | 2:ea6275d1222f | 522 | med = v.read()*3.3; |
joshema216 | 2:ea6275d1222f | 523 | medi = v.read(); |
joshema216 | 2:ea6275d1222f | 524 | pc.printf("\n%f\n", medi); |
joshema216 | 2:ea6275d1222f | 525 | |
joshema216 | 2:ea6275d1222f | 526 | cleanBuffer(outmed, 16); |
joshema216 | 2:ea6275d1222f | 527 | if (med < 1){ // Se convierte la Medida a caracter. |
joshema216 | 2:ea6275d1222f | 528 | strcat(outmed, "0"); |
joshema216 | 2:ea6275d1222f | 529 | ftoa(med, outmedn, 5); |
joshema216 | 2:ea6275d1222f | 530 | strcat(outmed, outmedn); |
joshema216 | 2:ea6275d1222f | 531 | } |
joshema216 | 2:ea6275d1222f | 532 | else{ |
joshema216 | 2:ea6275d1222f | 533 | ftoa(med, outmed, 5); |
joshema216 | 2:ea6275d1222f | 534 | } |
joshema216 | 2:ea6275d1222f | 535 | strcpy(DE2,"Voltaje: "); |
joshema216 | 2:ea6275d1222f | 536 | strcat(DE2,outmed); |
joshema216 | 2:ea6275d1222f | 537 | pc.printf("\n%s\n\n", DE2); |
joshema216 | 2:ea6275d1222f | 538 | LENIN2 = strlen(DE2); |
joshema216 | 2:ea6275d1222f | 539 | |
joshema216 | 2:ea6275d1222f | 540 | //Conversión a octetos. |
joshema216 | 2:ea6275d1222f | 541 | K = 0; |
joshema216 | 2:ea6275d1222f | 542 | C = 0; |
joshema216 | 2:ea6275d1222f | 543 | for (i = 0; i < LENIN2; i++){ |
joshema216 | 2:ea6275d1222f | 544 | DS2[i] = DE2[i + C] >> K | DE2[i + C + 1] << (7 - K); |
joshema216 | 2:ea6275d1222f | 545 | if(DS2[i] == 0x00) {LENOUT2 = i; goto salir2;} |
joshema216 | 2:ea6275d1222f | 546 | K++; |
joshema216 | 2:ea6275d1222f | 547 | if (K == 7) {K = 0; C++;} // se chequea que ya se acabaron los bits en un ciclo de conversion. |
joshema216 | 2:ea6275d1222f | 548 | } |
joshema216 | 2:ea6275d1222f | 549 | |
joshema216 | 2:ea6275d1222f | 550 | salir2: |
joshema216 | 2:ea6275d1222f | 551 | for (i = 0; i < LENIN2; i++){ |
joshema216 | 2:ea6275d1222f | 552 | pc.printf("%X", DE2[i]); |
joshema216 | 2:ea6275d1222f | 553 | } |
joshema216 | 2:ea6275d1222f | 554 | |
joshema216 | 2:ea6275d1222f | 555 | pc.printf(":\r\n"); |
joshema216 | 2:ea6275d1222f | 556 | for (i = 0; i < LENOUT2; i++){ |
joshema216 | 2:ea6275d1222f | 557 | pc.printf("%2X", DS2[i]&0x000000FF); |
joshema216 | 2:ea6275d1222f | 558 | } |
joshema216 | 2:ea6275d1222f | 559 | pc.printf("\r\nLENOUT VOLTAJE: %d, LENIN VOLTAJE: %2X\r\n", LENOUT2, LENIN2); |
joshema216 | 2:ea6275d1222f | 560 | |
joshema216 | 2:ea6275d1222f | 561 | // Concatenación del mensaje en formato PDU y envío del mismo. |
joshema216 | 2:ea6275d1222f | 562 | ind = 14 + LENOUT2 - 1; |
joshema216 | 2:ea6275d1222f | 563 | |
joshema216 | 2:ea6275d1222f | 564 | GSM.printf("AT+CMGS=%d\r\n",ind); |
joshema216 | 2:ea6275d1222f | 565 | pc.printf("AT+CMGS=%d\r\n",ind); |
joshema216 | 2:ea6275d1222f | 566 | pc.printf(relle1); |
joshema216 | 2:ea6275d1222f | 567 | GSM.printf(relle1); |
joshema216 | 2:ea6275d1222f | 568 | |
joshema216 | 2:ea6275d1222f | 569 | for (i=0; i <= 9; i++) { |
joshema216 | 2:ea6275d1222f | 570 | pc.printf("%c",tel[i]); |
joshema216 | 2:ea6275d1222f | 571 | GSM.printf("%c",tel[i]); |
joshema216 | 2:ea6275d1222f | 572 | } |
joshema216 | 2:ea6275d1222f | 573 | |
joshema216 | 2:ea6275d1222f | 574 | pc.printf(relle2); |
joshema216 | 2:ea6275d1222f | 575 | GSM.printf(relle2); |
joshema216 | 2:ea6275d1222f | 576 | pc.printf("%2X", LENIN2); |
joshema216 | 2:ea6275d1222f | 577 | GSM.printf("%2X", LENIN2); |
joshema216 | 2:ea6275d1222f | 578 | /*pc.printf("0F"); |
joshema216 | 2:ea6275d1222f | 579 | GSM.printf("0F");*/ |
joshema216 | 2:ea6275d1222f | 580 | |
joshema216 | 2:ea6275d1222f | 581 | for (i = 0; i < LENOUT2; i++){ |
joshema216 | 2:ea6275d1222f | 582 | pc.printf("%02X", DS2[i]&0x000000FF); |
joshema216 | 2:ea6275d1222f | 583 | GSM.printf("%02X", DS2[i]&0x000000FF); |
joshema216 | 2:ea6275d1222f | 584 | } |
joshema216 | 2:ea6275d1222f | 585 | |
joshema216 | 2:ea6275d1222f | 586 | wait(1); |
joshema216 | 2:ea6275d1222f | 587 | GSM.putc((char)0x1A); // Ctrl - Z |
joshema216 | 2:ea6275d1222f | 588 | GSM.scanf("%s",buf); // Estado del mensaje (Envió o Error). |
joshema216 | 2:ea6275d1222f | 589 | pc.printf(">%s\n\n",buf); |
procesadores_FAC | 0:b2a6aa7c0c8c | 590 | pc.printf("\n"); |
procesadores_FAC | 0:b2a6aa7c0c8c | 591 | |
joshema216 | 2:ea6275d1222f | 592 | wait(2); |
joshema216 | 2:ea6275d1222f | 593 | LedRojo=1; |
joshema216 | 2:ea6275d1222f | 594 | LedVerde=0; |
joshema216 | 2:ea6275d1222f | 595 | GSM.printf("AT+CMGD=0\r\n"); // Borra el mensaje actual (Posición "0"). |
joshema216 | 2:ea6275d1222f | 596 | //pc.printf("\n%s\n\n", "Borro mensaje"); |
joshema216 | 2:ea6275d1222f | 597 | } |
joshema216 | 2:ea6275d1222f | 598 | } |
joshema216 | 2:ea6275d1222f | 599 | } |
joshema216 | 2:ea6275d1222f | 600 | } |
AaronGonzalez | 1:e2bd083802c0 | 601 | } |