![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Tarea 6 Gps
Fork of Tarea6_Gsm_gps by
main.cpp@1:e72724565122, 2018-06-05 (annotated)
- Committer:
- jclondonol
- Date:
- Tue Jun 05 03:22:27 2018 +0000
- Revision:
- 1:e72724565122
- Parent:
- 0:e48cba9116f6
- Child:
- 2:20facdf67dcf
tarea6 gsm gps
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
satelite | 0:e48cba9116f6 | 1 | |
satelite | 0:e48cba9116f6 | 2 | #include "mbed.h" |
satelite | 0:e48cba9116f6 | 3 | #include "iostream" |
satelite | 0:e48cba9116f6 | 4 | #include "GPS.h" |
satelite | 0:e48cba9116f6 | 5 | |
satelite | 0:e48cba9116f6 | 6 | // Configuracion de los puertos del microcontrolador |
jclondonol | 1:e72724565122 | 7 | Serial gsm(PTE22, PTE23); // puerto serie para la comunicacíón GSM |
satelite | 0:e48cba9116f6 | 8 | Serial pc(USBTX, USBRX); // puerto serie para debug |
jclondonol | 1:e72724565122 | 9 | GPS gps(PTE0, PTE1); // puerto para comunicacion GPS |
satelite | 0:e48cba9116f6 | 10 | |
satelite | 0:e48cba9116f6 | 11 | // Declaracion de variables globales |
jclondonol | 1:e72724565122 | 12 | char buffer[200], pdu[] = "", vector1[] = "", vector2[] = "", dE[255], dS[255], dEs[255], dSs[255]; |
jclondonol | 1:e72724565122 | 13 | char Ctamanosms[1], Ctiposmsc[1], Csmscnumber[12], Cdeliver[1]; |
jclondonol | 1:e72724565122 | 14 | char Ctamanoaddress[1], Ctipoaddress[1], Cnumero[12], Cprotocolo[1], Cencoding[1]; |
jclondonol | 1:e72724565122 | 15 | char Ctime[14], Ctamano[1], Cdato[30], Xnumero[10]; |
satelite | 0:e48cba9116f6 | 16 | int i, k, c, w, r, ta, tam, lenOUT, lenIN; // variables auxiliares |
satelite | 0:e48cba9116f6 | 17 | float lon, lat; // variables para almacenar coordenadas |
satelite | 0:e48cba9116f6 | 18 | char link[]= {"http://maps.google.com/?q="}; // inicio trama mensaje |
satelite | 0:e48cba9116f6 | 19 | |
satelite | 0:e48cba9116f6 | 20 | // Rutina principal |
satelite | 0:e48cba9116f6 | 21 | int main() |
satelite | 0:e48cba9116f6 | 22 | { |
jclondonol | 1:e72724565122 | 23 | pc.printf("###ss###################### INICIO DEL PROGRAMA #########################"); // mensaje de bienvenida debug |
satelite | 0:e48cba9116f6 | 24 | // Establecimiento de la comunicacion con el modem del telefono movil |
satelite | 0:e48cba9116f6 | 25 | pc.printf("\r\n>>>>>>>>>>>>>>>>>>>>>> Configurando SIEMENS A56i <<<<<<<<<<<<<<<<<<<<<<\r\n"); // mensaje debug |
satelite | 0:e48cba9116f6 | 26 | gsm.baud(9600); |
satelite | 0:e48cba9116f6 | 27 | gsm.format(8,Serial::None,1); |
satelite | 0:e48cba9116f6 | 28 | std::string strOK ("OK"); |
satelite | 0:e48cba9116f6 | 29 | pc.printf("\r\n Enviamos AT \r\n"); // prueba comunicacion con el movil |
satelite | 0:e48cba9116f6 | 30 | gsm.printf("AT\r\n"); |
satelite | 0:e48cba9116f6 | 31 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 32 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 33 | pc.printf("%s\n",buffer); |
satelite | 0:e48cba9116f6 | 34 | |
satelite | 0:e48cba9116f6 | 35 | if(strOK.compare(buffer) != 0) { |
satelite | 0:e48cba9116f6 | 36 | pc.printf("\r\nModem GSM no responde\r\n"); |
satelite | 0:e48cba9116f6 | 37 | } |
satelite | 0:e48cba9116f6 | 38 | |
satelite | 0:e48cba9116f6 | 39 | gsm.printf("\n AT+CNMI=1,1\r\n"); // Selecciona la memoria de la simcard |
satelite | 0:e48cba9116f6 | 40 | pc.printf("AT+CNMI=1,1\r\n"); |
satelite | 0:e48cba9116f6 | 41 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 42 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 43 | pc.printf(">%s\n",buffer); |
satelite | 0:e48cba9116f6 | 44 | if(strOK.compare(buffer) != 0) { |
satelite | 0:e48cba9116f6 | 45 | pc.printf("\r\nModem GSM no responde\r\n"); |
satelite | 0:e48cba9116f6 | 46 | } |
satelite | 0:e48cba9116f6 | 47 | |
satelite | 0:e48cba9116f6 | 48 | gsm.printf("\n AT+CPMS= \"SM\",\"SM\",\"SM\"\r\n"); // |
satelite | 0:e48cba9116f6 | 49 | pc.printf("AT+CPMS= \"SM\",\"SM\",\"SM\"\n"); |
satelite | 0:e48cba9116f6 | 50 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 51 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 52 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 53 | pc.printf(">%s\n",buffer); |
satelite | 0:e48cba9116f6 | 54 | wait(1); |
satelite | 0:e48cba9116f6 | 55 | |
satelite | 0:e48cba9116f6 | 56 | gsm.printf("\n AT+CMGF=0\r\n"); // Configura modo PDU |
satelite | 0:e48cba9116f6 | 57 | pc.printf("AT+CMGF=0\r\n"); |
satelite | 0:e48cba9116f6 | 58 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 59 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 60 | pc.printf(">%s\n",buffer); |
satelite | 0:e48cba9116f6 | 61 | |
satelite | 0:e48cba9116f6 | 62 | if(strOK.compare(buffer) != 0) { |
satelite | 0:e48cba9116f6 | 63 | pc.printf("\r\nModem GSM no responde\r\n"); |
satelite | 0:e48cba9116f6 | 64 | } |
satelite | 0:e48cba9116f6 | 65 | |
satelite | 0:e48cba9116f6 | 66 | pc.printf("\n CBST=0,0,1\r\n"); |
satelite | 0:e48cba9116f6 | 67 | gsm.printf("CBST=0,0,1\r\n"); // en espera de mensajes entrantes |
satelite | 0:e48cba9116f6 | 68 | |
satelite | 0:e48cba9116f6 | 69 | if(gps.sample()) { |
jclondonol | 1:e72724565122 | 70 | pc.printf("Estamos en %f, %f\r\n", gps.latitude, gps.longitude); // muestro la ubicacion actual, para saber si el GPS esta recibiendo |
satelite | 0:e48cba9116f6 | 71 | } else { |
satelite | 0:e48cba9116f6 | 72 | pc.printf("no se donde!:(\r\n"); |
satelite | 0:e48cba9116f6 | 73 | } |
satelite | 0:e48cba9116f6 | 74 | |
satelite | 0:e48cba9116f6 | 75 | // Ciclo infinito |
satelite | 0:e48cba9116f6 | 76 | while(1) { |
satelite | 0:e48cba9116f6 | 77 | |
satelite | 0:e48cba9116f6 | 78 | pc.printf("\r\n>>>>>>>>>>>>>>>>>> Esperando nuevo mensaje de texto <<<<<<<<<<<<<<<<<<<\r\n"); |
satelite | 0:e48cba9116f6 | 79 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 80 | pc.printf("%s",buffer); |
satelite | 0:e48cba9116f6 | 81 | i = strlen(buffer); |
satelite | 0:e48cba9116f6 | 82 | |
satelite | 0:e48cba9116f6 | 83 | if(i>3) { // si reciba un mensaje |
satelite | 0:e48cba9116f6 | 84 | pc.printf("\r\n>>>>>>>>>>>>>>>>>>>>>>>>>>>> Nuevo mensaje <<<<<<<<<<<<<<<<<<<<<<<<<<<<\r\n"); |
satelite | 0:e48cba9116f6 | 85 | gsm.printf("AT+CMGR=1\r\n"); // lee menjsae en la primera posicion de memoria |
satelite | 0:e48cba9116f6 | 86 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 87 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 88 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 89 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 90 | pc.printf(">%s \r\n",buffer); // imprime la cadena PDU del mensaje |
satelite | 0:e48cba9116f6 | 91 | tam = strlen(buffer); // longitud del mensaje leido |
satelite | 0:e48cba9116f6 | 92 | pc.printf("\r\nLectura de la trama PDU: %d\r\n", tam); // separa la trama pdu para extraer informacion necesaria |
satelite | 0:e48cba9116f6 | 93 | Ctamanosms[0] = buffer[0]; // tamaño en septetos de toda la trama pdu |
satelite | 0:e48cba9116f6 | 94 | Ctamanosms[1] = buffer[1]; |
satelite | 0:e48cba9116f6 | 95 | pc.printf("\r\nLongitud del mensaje en septetos %c%c en septetos \n", Ctamanosms[0], Ctamanosms[1]); |
satelite | 0:e48cba9116f6 | 96 | Ctiposmsc[0] = buffer[2]; |
satelite | 0:e48cba9116f6 | 97 | Ctiposmsc[1] = buffer[3]; |
satelite | 0:e48cba9116f6 | 98 | pc.printf("\r\nTipo de direccion SMSC %c%c \r\n", Ctiposmsc[0], Ctiposmsc[1]); |
satelite | 0:e48cba9116f6 | 99 | Csmscnumber[0] = buffer[4]; |
satelite | 0:e48cba9116f6 | 100 | Csmscnumber[1] = buffer[5]; |
satelite | 0:e48cba9116f6 | 101 | Csmscnumber[2] = buffer[6]; |
satelite | 0:e48cba9116f6 | 102 | Csmscnumber[3] = buffer[7]; |
satelite | 0:e48cba9116f6 | 103 | Csmscnumber[4] = buffer[8]; |
satelite | 0:e48cba9116f6 | 104 | Csmscnumber[5] = buffer[9]; |
satelite | 0:e48cba9116f6 | 105 | Csmscnumber[6] = buffer[10]; |
satelite | 0:e48cba9116f6 | 106 | Csmscnumber[7] = buffer[11]; |
satelite | 0:e48cba9116f6 | 107 | Csmscnumber[8] = buffer[12]; |
satelite | 0:e48cba9116f6 | 108 | Csmscnumber[9] = buffer[13]; |
satelite | 0:e48cba9116f6 | 109 | Csmscnumber[10] = buffer[14]; |
satelite | 0:e48cba9116f6 | 110 | Csmscnumber[11] = buffer[15]; |
satelite | 0:e48cba9116f6 | 111 | pc.printf("\r\nNumero del SMSC %s \r\n", Csmscnumber); |
satelite | 0:e48cba9116f6 | 112 | Cdeliver[0] = buffer[16]; |
satelite | 0:e48cba9116f6 | 113 | Cdeliver[1] = buffer[17]; |
satelite | 0:e48cba9116f6 | 114 | Ctamanoaddress[0] = buffer[18]; |
satelite | 0:e48cba9116f6 | 115 | Ctamanoaddress[1] = buffer[19]; |
satelite | 0:e48cba9116f6 | 116 | Ctipoaddress[0] = buffer[20]; |
satelite | 0:e48cba9116f6 | 117 | Ctipoaddress[1] = buffer[21]; |
satelite | 0:e48cba9116f6 | 118 | Cnumero[0] = buffer[22]; // Numero del usuario |
satelite | 0:e48cba9116f6 | 119 | Cnumero[1] = buffer[23]; |
satelite | 0:e48cba9116f6 | 120 | Cnumero[2] = buffer[24]; |
satelite | 0:e48cba9116f6 | 121 | Cnumero[3] = buffer[25]; |
satelite | 0:e48cba9116f6 | 122 | Cnumero[4] = buffer[26]; |
satelite | 0:e48cba9116f6 | 123 | Cnumero[5] = buffer[27]; |
satelite | 0:e48cba9116f6 | 124 | Cnumero[6] = buffer[28]; |
satelite | 0:e48cba9116f6 | 125 | Cnumero[7] = buffer[29]; |
satelite | 0:e48cba9116f6 | 126 | Cnumero[8] = buffer[30]; |
satelite | 0:e48cba9116f6 | 127 | Cnumero[9] = buffer[31]; |
satelite | 0:e48cba9116f6 | 128 | Cnumero[10] = buffer[32]; |
satelite | 0:e48cba9116f6 | 129 | Cnumero[11] = buffer[33]; |
satelite | 0:e48cba9116f6 | 130 | Xnumero[0] = buffer[23]; |
satelite | 0:e48cba9116f6 | 131 | Xnumero[1] = buffer[22]; |
satelite | 0:e48cba9116f6 | 132 | Xnumero[2] = buffer[25]; |
satelite | 0:e48cba9116f6 | 133 | Xnumero[3] = buffer[24]; |
satelite | 0:e48cba9116f6 | 134 | Xnumero[4] = buffer[27]; |
satelite | 0:e48cba9116f6 | 135 | Xnumero[5] = buffer[26]; |
satelite | 0:e48cba9116f6 | 136 | Xnumero[6] = buffer[29]; |
satelite | 0:e48cba9116f6 | 137 | Xnumero[7] = buffer[28]; |
satelite | 0:e48cba9116f6 | 138 | Xnumero[8] = buffer[31]; |
satelite | 0:e48cba9116f6 | 139 | Xnumero[9] = buffer[30]; |
satelite | 0:e48cba9116f6 | 140 | pc.printf("\r\nNumero del usuario %s \r\n", Xnumero); |
satelite | 0:e48cba9116f6 | 141 | Cprotocolo[0] = buffer[34]; // protocolo |
satelite | 0:e48cba9116f6 | 142 | Cprotocolo[1] = buffer[35]; |
satelite | 0:e48cba9116f6 | 143 | Cencoding[0] = buffer[36]; // cifrado |
satelite | 0:e48cba9116f6 | 144 | Cencoding[1] = buffer[37]; |
satelite | 0:e48cba9116f6 | 145 | Ctime[0] = buffer[38]; // Tiempo envio mensaje |
satelite | 0:e48cba9116f6 | 146 | Ctime[1] = buffer[39]; |
satelite | 0:e48cba9116f6 | 147 | Ctime[2] = buffer[40]; |
satelite | 0:e48cba9116f6 | 148 | Ctime[3] = buffer[41]; |
satelite | 0:e48cba9116f6 | 149 | Ctime[4] = buffer[42]; |
satelite | 0:e48cba9116f6 | 150 | Ctime[5] = buffer[43]; |
satelite | 0:e48cba9116f6 | 151 | Ctime[6] = buffer[44]; |
satelite | 0:e48cba9116f6 | 152 | Ctime[7] = buffer[45]; |
satelite | 0:e48cba9116f6 | 153 | Ctime[8] = buffer[46]; |
satelite | 0:e48cba9116f6 | 154 | Ctime[9] = buffer[47]; |
satelite | 0:e48cba9116f6 | 155 | Ctime[10] = buffer[48]; |
satelite | 0:e48cba9116f6 | 156 | Ctime[11] = buffer[49]; |
satelite | 0:e48cba9116f6 | 157 | Ctime[12] = buffer[50]; |
satelite | 0:e48cba9116f6 | 158 | Ctime[13] = buffer[51]; |
satelite | 0:e48cba9116f6 | 159 | Ctamano[0]= buffer[50]; // longitud de la parte legible |
satelite | 0:e48cba9116f6 | 160 | Ctamano[1]= buffer[51]; |
satelite | 0:e48cba9116f6 | 161 | ta = (Ctamano[0]-48)*16+(Ctamano[1]-48); |
satelite | 0:e48cba9116f6 | 162 | pc.printf("\r\nNumero de caracteres del mensaje entrante %d \r\n", ta); |
satelite | 0:e48cba9116f6 | 163 | pc.printf("\r\nPosicion de los datos en el mensaje PDU %d \r\n", tam-2*ta); // posicion de los datos en la trama pdu |
satelite | 0:e48cba9116f6 | 164 | for(i = 0; i < 2*ta; i++) { //Toma de los datos o mensaje |
satelite | 0:e48cba9116f6 | 165 | Cdato[i] = buffer[52+i]; |
satelite | 0:e48cba9116f6 | 166 | } |
satelite | 0:e48cba9116f6 | 167 | // Inicia la convercion de PDU a Texto |
satelite | 0:e48cba9116f6 | 168 | pc.printf("\r\n>>>>>>>>>>>>>>>>>>>>> Convirtiendo de PDU a texto <<<<<<<<<<<<<<<<<<<<<\r\n"); |
satelite | 0:e48cba9116f6 | 169 | lenIN = strlen(Cdato)/2; |
satelite | 0:e48cba9116f6 | 170 | w = 0; |
satelite | 0:e48cba9116f6 | 171 | pc.printf("\r\nTamano de los datos %d \r\n", strlen(Cdato)); |
satelite | 0:e48cba9116f6 | 172 | for(i = 0; i <= strlen(Cdato); i++) { |
satelite | 0:e48cba9116f6 | 173 | if(i%2==0) { |
satelite | 0:e48cba9116f6 | 174 | if(Cdato[i]>47 & Cdato[i]<58) { // primero se asigna el valor numerico de cada caracter en caso de ser 0-9 se le resta 48 en caso de ser letra se le resta 55 |
satelite | 0:e48cba9116f6 | 175 | Cdato[i] = Cdato[i]-48; |
satelite | 0:e48cba9116f6 | 176 | } |
satelite | 0:e48cba9116f6 | 177 | |
satelite | 0:e48cba9116f6 | 178 | if(Cdato[i]>65 & Cdato[i]<71) { |
satelite | 0:e48cba9116f6 | 179 | Cdato[i] = Cdato[i]-55; |
satelite | 0:e48cba9116f6 | 180 | |
satelite | 0:e48cba9116f6 | 181 | } |
satelite | 0:e48cba9116f6 | 182 | |
satelite | 0:e48cba9116f6 | 183 | } else { |
satelite | 0:e48cba9116f6 | 184 | if(Cdato[i]>47 & Cdato[i]<58) { |
satelite | 0:e48cba9116f6 | 185 | Cdato[i] = Cdato[i]-48; |
satelite | 0:e48cba9116f6 | 186 | } |
satelite | 0:e48cba9116f6 | 187 | |
satelite | 0:e48cba9116f6 | 188 | if(Cdato[i]>65 & Cdato[i]<71) { |
satelite | 0:e48cba9116f6 | 189 | Cdato[i] = Cdato[i]-55; |
satelite | 0:e48cba9116f6 | 190 | |
satelite | 0:e48cba9116f6 | 191 | } |
satelite | 0:e48cba9116f6 | 192 | |
satelite | 0:e48cba9116f6 | 193 | dE[w] = Cdato[i-1]*16+Cdato[i]; |
satelite | 0:e48cba9116f6 | 194 | pc.printf("\r\nDatos en hexagesimal DE[%d] %2X \r\n", w, dE[w]); // Se guarda la dupla en el vector dE |
satelite | 0:e48cba9116f6 | 195 | w++; |
satelite | 0:e48cba9116f6 | 196 | } |
satelite | 0:e48cba9116f6 | 197 | } |
satelite | 0:e48cba9116f6 | 198 | lenOUT = lenIN*8/7; |
satelite | 0:e48cba9116f6 | 199 | k = 7; |
satelite | 0:e48cba9116f6 | 200 | c = 0; |
satelite | 0:e48cba9116f6 | 201 | dS[0] = dE[0] & 0x7F; |
satelite | 0:e48cba9116f6 | 202 | pc.printf("%2X,%d,%d\r\n",dS[0],i,k); |
satelite | 0:e48cba9116f6 | 203 | for (i = 1; i < lenOUT; i++) { // inicia el algoritmo |
satelite | 0:e48cba9116f6 | 204 | dS[i] = (dE[i-1-c]>>k | dE[i-c]<<(8-k))& 0x7F; |
satelite | 0:e48cba9116f6 | 205 | pc.printf("%2X,%d,%d\r\n",dS[i],i,k); |
satelite | 0:e48cba9116f6 | 206 | if (k==0) { |
satelite | 0:e48cba9116f6 | 207 | k = 8; |
satelite | 0:e48cba9116f6 | 208 | c++; |
satelite | 0:e48cba9116f6 | 209 | } |
satelite | 0:e48cba9116f6 | 210 | k--; |
satelite | 0:e48cba9116f6 | 211 | } |
jclondonol | 1:e72724565122 | 212 | dS[10] = dS[10] + 112; |
jclondonol | 1:e72724565122 | 213 | |
satelite | 0:e48cba9116f6 | 214 | pc.printf("\r\nMensaje entrante: "); |
satelite | 0:e48cba9116f6 | 215 | for (i = 0; i < lenOUT; i++) { |
satelite | 0:e48cba9116f6 | 216 | pc.printf("%c",dS[i]); |
satelite | 0:e48cba9116f6 | 217 | } |
satelite | 0:e48cba9116f6 | 218 | pc.printf("\r\n>>>>>>>>>>> Termina convercion de los datos de PDU a texto <<<<<<<<<<<<\r\n"); |
satelite | 0:e48cba9116f6 | 219 | } |
jclondonol | 1:e72724565122 | 220 | |
jclondonol | 1:e72724565122 | 221 | |
jclondonol | 1:e72724565122 | 222 | std::string strC ("Coordenadas"); // cadenas para comparar el mensaje recibido |
satelite | 0:e48cba9116f6 | 223 | |
satelite | 0:e48cba9116f6 | 224 | if(strC.compare(dS) == 0) { // En caso de que se pidan las coordenadas |
satelite | 0:e48cba9116f6 | 225 | pc.printf("\r\n>>>>>>>>>>>>>>>>>>>>>>>> Recibido: Coordenada <<<<<<<<<<<<<<<<<<<<<<<<<\n"); |
satelite | 0:e48cba9116f6 | 226 | pc.printf("\r\nEsperando GPS \r\n"); |
satelite | 0:e48cba9116f6 | 227 | |
jclondonol | 1:e72724565122 | 228 | |
satelite | 0:e48cba9116f6 | 229 | while(1) { |
satelite | 0:e48cba9116f6 | 230 | i = 0; |
satelite | 0:e48cba9116f6 | 231 | if(gps.sample() && i == 0) { |
satelite | 0:e48cba9116f6 | 232 | pc.printf("\r\n>>>>>>>>>>>>>>>>>>>>>>>>>>>>> Leyendo GPS <<<<<<<<<<<<<<<<<<<<<<<<<<<<<\r\n"); |
satelite | 0:e48cba9116f6 | 233 | //Toma de datos del gps y concatenacion para armar los datos. |
jclondonol | 1:e72724565122 | 234 | lon = gps.longitude; |
satelite | 0:e48cba9116f6 | 235 | lat = gps.latitude; |
satelite | 0:e48cba9116f6 | 236 | sprintf(vector1, "%f", lat); |
satelite | 0:e48cba9116f6 | 237 | strcat(link,vector1); |
satelite | 0:e48cba9116f6 | 238 | strcat(link,","); |
satelite | 0:e48cba9116f6 | 239 | sprintf(vector2, "%f", lon); |
satelite | 0:e48cba9116f6 | 240 | strcat(link,vector2); |
satelite | 0:e48cba9116f6 | 241 | strcat(dEs,link); |
satelite | 0:e48cba9116f6 | 242 | pc.printf("%s\n",link); |
satelite | 0:e48cba9116f6 | 243 | // Conversion de los datos "link" a formato PDU |
satelite | 0:e48cba9116f6 | 244 | lenIN = strlen(dEs); |
satelite | 0:e48cba9116f6 | 245 | k = 0; |
satelite | 0:e48cba9116f6 | 246 | c = 0; |
satelite | 0:e48cba9116f6 | 247 | for (i = 0; i < lenIN; i++) { |
satelite | 0:e48cba9116f6 | 248 | dSs[i] = dEs[i+c]>>k | dEs[i+c+1]<<(7-k); |
satelite | 0:e48cba9116f6 | 249 | if (dSs[i]==0x00) { |
satelite | 0:e48cba9116f6 | 250 | lenOUT = i; |
satelite | 0:e48cba9116f6 | 251 | goto salir; |
satelite | 0:e48cba9116f6 | 252 | } |
satelite | 0:e48cba9116f6 | 253 | k++; |
satelite | 0:e48cba9116f6 | 254 | if (k==7) { |
satelite | 0:e48cba9116f6 | 255 | k = 0; |
satelite | 0:e48cba9116f6 | 256 | c++; |
satelite | 0:e48cba9116f6 | 257 | } |
satelite | 0:e48cba9116f6 | 258 | } |
satelite | 0:e48cba9116f6 | 259 | |
satelite | 0:e48cba9116f6 | 260 | salir: |
satelite | 0:e48cba9116f6 | 261 | pc.printf("DEs\n"); |
satelite | 0:e48cba9116f6 | 262 | for (i = 0; i < lenIN; i++) { |
satelite | 0:e48cba9116f6 | 263 | pc.printf("%X",dEs[i]); |
satelite | 0:e48cba9116f6 | 264 | } |
satelite | 0:e48cba9116f6 | 265 | pc.printf("\n DSs \n"); |
satelite | 0:e48cba9116f6 | 266 | for (i = 0; i<lenOUT; i++) { |
satelite | 0:e48cba9116f6 | 267 | pc.printf("%02X",dSs[i]&0x000000FF); |
satelite | 0:e48cba9116f6 | 268 | } |
satelite | 0:e48cba9116f6 | 269 | |
satelite | 0:e48cba9116f6 | 270 | pc.printf("\n lenOUT:%d,lenIN:%d\r\n",lenOUT,strlen(dEs)); |
satelite | 0:e48cba9116f6 | 271 | pc.printf("\r\n>>>>>>>>>>>>>>>>> Comienza el envio del mensaje SMS <<<<<<<<<<<<<<<<<<\r\n"); |
satelite | 0:e48cba9116f6 | 272 | |
satelite | 0:e48cba9116f6 | 273 | if(lenOUT%2==0) { |
satelite | 0:e48cba9116f6 | 274 | w = 27; |
satelite | 0:e48cba9116f6 | 275 | } else { |
satelite | 0:e48cba9116f6 | 276 | w = 26; |
satelite | 0:e48cba9116f6 | 277 | } |
satelite | 0:e48cba9116f6 | 278 | gsm.printf("AT+CMGS=%d\r\n", ((2*lenOUT)+w)/2); // Inicia envio del mensaje |
jclondonol | 1:e72724565122 | 279 | //pc.printf("\n AT+CMGS=%d\r\n", ((2*lenOUT)+w)/2); |
satelite | 0:e48cba9116f6 | 280 | wait(0.5); |
satelite | 0:e48cba9116f6 | 281 | |
satelite | 0:e48cba9116f6 | 282 | gsm.printf("0011000A91"); // relleno inicial |
jclondonol | 1:e72724565122 | 283 | //pc.printf("0011000A91"); |
satelite | 0:e48cba9116f6 | 284 | |
satelite | 0:e48cba9116f6 | 285 | |
satelite | 0:e48cba9116f6 | 286 | for(i = 0; i < 11; i++) { // numero de destino |
satelite | 0:e48cba9116f6 | 287 | gsm.printf("%c", Cnumero[i]); |
jclondonol | 1:e72724565122 | 288 | // pc.printf("%c", Cnumero[i]); |
satelite | 0:e48cba9116f6 | 289 | |
satelite | 0:e48cba9116f6 | 290 | } |
satelite | 0:e48cba9116f6 | 291 | |
satelite | 0:e48cba9116f6 | 292 | gsm.printf("000AA"); // segundo relleno |
jclondonol | 1:e72724565122 | 293 | //pc.printf("000AA"); |
satelite | 0:e48cba9116f6 | 294 | |
satelite | 0:e48cba9116f6 | 295 | gsm.printf("%2X",lenIN); // longitud de los datos |
jclondonol | 1:e72724565122 | 296 | //pc.printf("%2X",lenIN); |
satelite | 0:e48cba9116f6 | 297 | |
satelite | 0:e48cba9116f6 | 298 | |
satelite | 0:e48cba9116f6 | 299 | for (i = 0; i < lenOUT; i++) { |
satelite | 0:e48cba9116f6 | 300 | gsm.printf("%02X",dSs[i]&0x000000FF); |
jclondonol | 1:e72724565122 | 301 | // pc.printf("%02X",dSs[i]&0x000000FF); |
jclondonol | 1:e72724565122 | 302 | //wait(0.1); |
satelite | 0:e48cba9116f6 | 303 | } |
satelite | 0:e48cba9116f6 | 304 | gsm.putc((char)0x1A); |
satelite | 0:e48cba9116f6 | 305 | gsm.scanf("%s",buffer); // lectura respuesta del modem |
satelite | 0:e48cba9116f6 | 306 | gsm.scanf("%s",buffer); |
jclondonol | 1:e72724565122 | 307 | //pc.printf("\r\nRespuesta movil: %s \r\n",buffer); |
satelite | 0:e48cba9116f6 | 308 | i = 1; |
satelite | 0:e48cba9116f6 | 309 | gsm.printf("AT+CMGD=1\r\n"); |
satelite | 0:e48cba9116f6 | 310 | |
satelite | 0:e48cba9116f6 | 311 | for(i = 26; i <= strlen(link); i++) { |
satelite | 0:e48cba9116f6 | 312 | link[i] = NULL; |
satelite | 0:e48cba9116f6 | 313 | |
satelite | 0:e48cba9116f6 | 314 | } |
satelite | 0:e48cba9116f6 | 315 | |
satelite | 0:e48cba9116f6 | 316 | for(i = 0; i <= 255; i++) { |
satelite | 0:e48cba9116f6 | 317 | dSs[i] = NULL; |
satelite | 0:e48cba9116f6 | 318 | dEs[i] = NULL; |
satelite | 0:e48cba9116f6 | 319 | } |
satelite | 0:e48cba9116f6 | 320 | |
satelite | 0:e48cba9116f6 | 321 | pc.printf("\r\n Se sale de while para la lectura de gps \r\n "); |
satelite | 0:e48cba9116f6 | 322 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 323 | pc.printf(">%s",buffer); |
satelite | 0:e48cba9116f6 | 324 | goto xt; |
satelite | 0:e48cba9116f6 | 325 | } |
satelite | 0:e48cba9116f6 | 326 | } |
satelite | 0:e48cba9116f6 | 327 | } |
satelite | 0:e48cba9116f6 | 328 | |
satelite | 0:e48cba9116f6 | 329 | if(strC.compare(dS) != 0) { |
satelite | 0:e48cba9116f6 | 330 | pc.printf("\r\nMensaje no valido\r\n"); |
satelite | 0:e48cba9116f6 | 331 | gsm.printf("AT+CMGD=1\r\n"); // Borrar el mensaje |
satelite | 0:e48cba9116f6 | 332 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 333 | pc.printf("\n%s\n",buffer); |
satelite | 0:e48cba9116f6 | 334 | } |
satelite | 0:e48cba9116f6 | 335 | |
satelite | 0:e48cba9116f6 | 336 | xt: |
satelite | 0:e48cba9116f6 | 337 | gsm.scanf("%s",buffer); |
satelite | 0:e48cba9116f6 | 338 | pc.printf("%s",buffer); |
satelite | 0:e48cba9116f6 | 339 | } |
satelite | 0:e48cba9116f6 | 340 | } |