Rick McConney / Mbed 2 deprecated StarterKit

GSMA version

Dependencies:   FXOS8700CQ mbed

Fork of AvnetATT_shape_hackathon by Rick McConney

Wnc.cpp@46:733edf15f9e8, 2017-01-09 (annotated)

Committer:
elmkom
Date:
Mon Jan 09 18:23:37 2017 +0000
Revision:
46:733edf15f9e8
Parent:
45:fe90f1fcb4e0 
tcp test code

Who changed what in which revision?

UserRevisionLine numberNew contents of line
elmkom 42:8500f0cb2ea5 1 #include "Wnc.h"
elmkom 42:8500f0cb2ea5 2 #include "mbed.h"
elmkom 42:8500f0cb2ea5 3 #include <cctype>
elmkom 42:8500f0cb2ea5 4 #include "config_me.h"
elmkom 42:8500f0cb2ea5 5 #include "SerialBuffered.h"
elmkom 42:8500f0cb2ea5 6
elmkom 42:8500f0cb2ea5 7
elmkom 42:8500f0cb2ea5 8 extern Serial pc;
elmkom 42:8500f0cb2ea5 9
elmkom 42:8500f0cb2ea5 10 DigitalOut mdm_uart2_rx_boot_mode_sel(PTC17); // on powerup, 0 = boot mode, 1 = normal boot
elmkom 42:8500f0cb2ea5 11 DigitalOut mdm_power_on(PTB9); // 0 = turn modem on, 1 = turn modem off (should be held high for >5 seconds to cycle modem)
elmkom 42:8500f0cb2ea5 12 DigitalInOut mdm_wakeup_in(PTC2); // 0 = let modem sleep, 1 = keep modem awake -- Note: pulled high on shield
elmkom 42:8500f0cb2ea5 13
elmkom 42:8500f0cb2ea5 14 DigitalOut mdm_reset(PTC12); // active high
elmkom 42:8500f0cb2ea5 15
elmkom 42:8500f0cb2ea5 16 DigitalOut shield_3v3_1v8_sig_trans_ena(PTC4); // 0 = disabled (all signals high impedence, 1 = translation active
elmkom 42:8500f0cb2ea5 17 DigitalOut mdm_uart1_cts(PTD0);
elmkom 42:8500f0cb2ea5 18
elmkom 44:60008ebffdd4 19 DigitalOut uart1Rts(PTD1);
elmkom 44:60008ebffdd4 20
elmkom 42:8500f0cb2ea5 21 SerialBuffered mdm(PTD3, PTD2, 512);
elmkom 42:8500f0cb2ea5 22
elmkom 44:60008ebffdd4 23 int t3412Timer = 4*60*60;
elmkom 44:60008ebffdd4 24 int t3324Timer = 20;
elmkom 42:8500f0cb2ea5 25 bool powerSave = false;
elmkom 45:fe90f1fcb4e0 26
elmkom 42:8500f0cb2ea5 27
elmkom 42:8500f0cb2ea5 28 Wnc::Wnc(void)
elmkom 42:8500f0cb2ea5 29 {
elmkom 42:8500f0cb2ea5 30 }
elmkom 42:8500f0cb2ea5 31
elmkom 42:8500f0cb2ea5 32 void Wnc::checkPassthrough()
elmkom 42:8500f0cb2ea5 33 {
elmkom 42:8500f0cb2ea5 34 if(pc.readable())
elmkom 42:8500f0cb2ea5 35 {
elmkom 42:8500f0cb2ea5 36 if(pc.getc() == '~')
elmkom 42:8500f0cb2ea5 37 passthrough();
elmkom 42:8500f0cb2ea5 38 }
elmkom 42:8500f0cb2ea5 39 }
elmkom 42:8500f0cb2ea5 40
elmkom 42:8500f0cb2ea5 41
elmkom 42:8500f0cb2ea5 42 void Wnc::passthrough()
elmkom 42:8500f0cb2ea5 43 {
elmkom 42:8500f0cb2ea5 44 pc.printf(">>\r\n");
elmkom 42:8500f0cb2ea5 45 while(1)
elmkom 42:8500f0cb2ea5 46 {
elmkom 42:8500f0cb2ea5 47 char c;
elmkom 42:8500f0cb2ea5 48 if(pc.readable())
elmkom 42:8500f0cb2ea5 49 {
elmkom 42:8500f0cb2ea5 50 c = pc.getc();
elmkom 42:8500f0cb2ea5 51 pc.putc(c);
elmkom 42:8500f0cb2ea5 52 if(c == '~')
elmkom 42:8500f0cb2ea5 53 {
elmkom 42:8500f0cb2ea5 54 pc.printf("exit\r\n");
elmkom 42:8500f0cb2ea5 55 break;
elmkom 42:8500f0cb2ea5 56 }
elmkom 42:8500f0cb2ea5 57 else if(c == '<')
elmkom 42:8500f0cb2ea5 58 {
elmkom 42:8500f0cb2ea5 59
elmkom 42:8500f0cb2ea5 60 mdm_wakeup_in = 0;
elmkom 42:8500f0cb2ea5 61 pc.printf("sleep\r\n");
elmkom 42:8500f0cb2ea5 62 }
elmkom 42:8500f0cb2ea5 63 else if(c == '>')
elmkom 42:8500f0cb2ea5 64 {
elmkom 42:8500f0cb2ea5 65 mdm_wakeup_in = 1;
elmkom 42:8500f0cb2ea5 66 pc.printf("wake\r\n");
elmkom 42:8500f0cb2ea5 67 }
elmkom 43:3979ea0a2df3 68 else if(c == '}')
elmkom 43:3979ea0a2df3 69 {
elmkom 43:3979ea0a2df3 70 mdm_uart2_rx_boot_mode_sel = 1;
elmkom 43:3979ea0a2df3 71 pc.printf("rx hi\r\n");
elmkom 43:3979ea0a2df3 72 }
elmkom 43:3979ea0a2df3 73 else if(c == '{')
elmkom 43:3979ea0a2df3 74 {
elmkom 43:3979ea0a2df3 75 mdm_uart2_rx_boot_mode_sel = 0;
elmkom 43:3979ea0a2df3 76 pc.printf("rx low\r\n");
elmkom 43:3979ea0a2df3 77 }
elmkom 43:3979ea0a2df3 78
elmkom 42:8500f0cb2ea5 79 else if(c == '^')
elmkom 42:8500f0cb2ea5 80 {
elmkom 42:8500f0cb2ea5 81 pc.printf("reboot\r\n");
elmkom 42:8500f0cb2ea5 82 NVIC_SystemReset();
elmkom 42:8500f0cb2ea5 83 }
elmkom 42:8500f0cb2ea5 84 else
elmkom 42:8500f0cb2ea5 85 {
elmkom 42:8500f0cb2ea5 86
elmkom 42:8500f0cb2ea5 87 mdm.putc(c);
elmkom 42:8500f0cb2ea5 88 }
elmkom 42:8500f0cb2ea5 89 }
elmkom 42:8500f0cb2ea5 90 if(mdm.readable())
elmkom 42:8500f0cb2ea5 91 pc.putc(mdm.getc());
elmkom 42:8500f0cb2ea5 92 }
elmkom 42:8500f0cb2ea5 93 }
elmkom 42:8500f0cb2ea5 94
elmkom 42:8500f0cb2ea5 95 bool Wnc::isPowerSaveOn()
elmkom 42:8500f0cb2ea5 96 {
elmkom 42:8500f0cb2ea5 97 return powerSave;
elmkom 42:8500f0cb2ea5 98 }
elmkom 42:8500f0cb2ea5 99
elmkom 42:8500f0cb2ea5 100 void Wnc::resumePowerSave()
elmkom 42:8500f0cb2ea5 101 {
elmkom 42:8500f0cb2ea5 102 mdm_wakeup_in = 0;
elmkom 42:8500f0cb2ea5 103 }
elmkom 42:8500f0cb2ea5 104
elmkom 44:60008ebffdd4 105 int Wnc::gett3412Timer()
elmkom 44:60008ebffdd4 106 {
elmkom 44:60008ebffdd4 107 return t3412Timer;
elmkom 44:60008ebffdd4 108 }
elmkom 44:60008ebffdd4 109
elmkom 44:60008ebffdd4 110 int Wnc::gett3324Timer()
elmkom 44:60008ebffdd4 111 {
elmkom 44:60008ebffdd4 112 return t3324Timer;
elmkom 44:60008ebffdd4 113 }
elmkom 44:60008ebffdd4 114
elmkom 42:8500f0cb2ea5 115 char* Wnc::read(int timeout_ms)
elmkom 42:8500f0cb2ea5 116 {
elmkom 42:8500f0cb2ea5 117 static char response[3200];
elmkom 42:8500f0cb2ea5 118 int len = 0;
elmkom 45:fe90f1fcb4e0 119 char c;
elmkom 42:8500f0cb2ea5 120
elmkom 42:8500f0cb2ea5 121 if(timeout_ms > 0) // read until timeout or OK
elmkom 42:8500f0cb2ea5 122 {
elmkom 42:8500f0cb2ea5 123 Timer timer;
elmkom 42:8500f0cb2ea5 124 timer.start();
elmkom 42:8500f0cb2ea5 125 while ((len < (3200-1)) && (timer.read_ms() < timeout_ms)) {
elmkom 42:8500f0cb2ea5 126 if (mdm.readable()) {
elmkom 45:fe90f1fcb4e0 127 c = mdm.getc();
elmkom 45:fe90f1fcb4e0 128 // replace \r\n to make debug messages more compact
elmkom 45:fe90f1fcb4e0 129 if(c == '\r') c = ' ';
elmkom 45:fe90f1fcb4e0 130 if(c == '\n') c = ' ';
elmkom 45:fe90f1fcb4e0 131
elmkom 45:fe90f1fcb4e0 132 response[len++] = c;
elmkom 42:8500f0cb2ea5 133 if(len>1 && response[len-2] == 'O' && response[len-1] == 'K')
elmkom 42:8500f0cb2ea5 134 break;
elmkom 45:fe90f1fcb4e0 135
elmkom 42:8500f0cb2ea5 136 }
elmkom 42:8500f0cb2ea5 137 }
elmkom 42:8500f0cb2ea5 138 }
elmkom 42:8500f0cb2ea5 139
elmkom 42:8500f0cb2ea5 140 response[len] = (char)NULL;
elmkom 45:fe90f1fcb4e0 141 pc.printf("{%d %s}\r\n",len,response);
elmkom 42:8500f0cb2ea5 142 return response;
elmkom 42:8500f0cb2ea5 143 }
elmkom 42:8500f0cb2ea5 144
elmkom 42:8500f0cb2ea5 145 char* Wnc::send(const char *cmd, int timeout_ms)
elmkom 42:8500f0cb2ea5 146 {
elmkom 45:fe90f1fcb4e0 147 char *reply;
elmkom 43:3979ea0a2df3 148
elmkom 43:3979ea0a2df3 149 while (mdm.readable()) {
elmkom 43:3979ea0a2df3 150 mdm.getc();
elmkom 43:3979ea0a2df3 151 }
elmkom 42:8500f0cb2ea5 152
elmkom 42:8500f0cb2ea5 153 int tries = 4;
elmkom 42:8500f0cb2ea5 154 while(tries > 0)
elmkom 42:8500f0cb2ea5 155 {
elmkom 42:8500f0cb2ea5 156 tries--;
elmkom 42:8500f0cb2ea5 157 pc.printf("\r\n<%s>",cmd);
elmkom 42:8500f0cb2ea5 158 const char *pt = cmd;
elmkom 42:8500f0cb2ea5 159 size_t n = strlen(cmd);
elmkom 42:8500f0cb2ea5 160 while (n--) {
elmkom 42:8500f0cb2ea5 161 mdm.putc(*pt++);
elmkom 42:8500f0cb2ea5 162 };
elmkom 42:8500f0cb2ea5 163 mdm.putc('\r');
elmkom 42:8500f0cb2ea5 164 mdm.putc('\n');
elmkom 42:8500f0cb2ea5 165 reply = read(timeout_ms);
elmkom 42:8500f0cb2ea5 166 if(strlen(reply) > 0 && strstr(reply,"OK") !=0)
elmkom 42:8500f0cb2ea5 167 break;
elmkom 42:8500f0cb2ea5 168 checkPassthrough();
elmkom 42:8500f0cb2ea5 169 }
elmkom 42:8500f0cb2ea5 170 return reply;
elmkom 42:8500f0cb2ea5 171 }
elmkom 42:8500f0cb2ea5 172
elmkom 42:8500f0cb2ea5 173 bool Wnc::isModemResponding()
elmkom 42:8500f0cb2ea5 174 {
elmkom 42:8500f0cb2ea5 175 char *reply = send("AT",WNC_WAIT_TIME_MS);
elmkom 42:8500f0cb2ea5 176 if(strlen(reply) > 0 && strstr(reply,"OK") !=0)
elmkom 42:8500f0cb2ea5 177 return true;
elmkom 42:8500f0cb2ea5 178 return false;
elmkom 42:8500f0cb2ea5 179 }
elmkom 42:8500f0cb2ea5 180
elmkom 42:8500f0cb2ea5 181 void Wnc::setIn()
elmkom 42:8500f0cb2ea5 182 {
elmkom 42:8500f0cb2ea5 183 mdm_wakeup_in.input();
elmkom 42:8500f0cb2ea5 184 }
elmkom 42:8500f0cb2ea5 185
elmkom 42:8500f0cb2ea5 186 void Wnc::toggleWake()
elmkom 42:8500f0cb2ea5 187 {
elmkom 42:8500f0cb2ea5 188 mdm_wakeup_in = 0;
elmkom 42:8500f0cb2ea5 189 wait_ms(2000);
elmkom 42:8500f0cb2ea5 190 mdm_wakeup_in = 0;
elmkom 42:8500f0cb2ea5 191 }
elmkom 42:8500f0cb2ea5 192
elmkom 45:fe90f1fcb4e0 193 bool Wnc::init(void) {
elmkom 44:60008ebffdd4 194 uart1Rts = 0;
elmkom 42:8500f0cb2ea5 195 mdm_wakeup_in.output();
elmkom 42:8500f0cb2ea5 196 // disable signal level translator (necessary
elmkom 42:8500f0cb2ea5 197 // for the modem to boot properly)
elmkom 42:8500f0cb2ea5 198 shield_3v3_1v8_sig_trans_ena = 0;
elmkom 42:8500f0cb2ea5 199
elmkom 42:8500f0cb2ea5 200 // Hard reset the modem (doesn't go through
elmkom 42:8500f0cb2ea5 201 // the signal level translator)
elmkom 42:8500f0cb2ea5 202 mdm_reset = 1;
elmkom 42:8500f0cb2ea5 203
elmkom 42:8500f0cb2ea5 204 // wait a moment for the modem to react
elmkom 42:8500f0cb2ea5 205 wait_ms(10);
elmkom 42:8500f0cb2ea5 206
elmkom 42:8500f0cb2ea5 207 // Let modem boot
elmkom 42:8500f0cb2ea5 208 mdm_reset = 0;
elmkom 42:8500f0cb2ea5 209
elmkom 42:8500f0cb2ea5 210 // wait a moment for the modem to react
elmkom 42:8500f0cb2ea5 211 wait(1.0);
elmkom 42:8500f0cb2ea5 212
elmkom 42:8500f0cb2ea5 213 // power modem on //off
elmkom 42:8500f0cb2ea5 214 mdm_power_on = 0; //1;
elmkom 42:8500f0cb2ea5 215
elmkom 42:8500f0cb2ea5 216 // insure modem boots into normal operating mode
elmkom 42:8500f0cb2ea5 217 // and does not go to sleep when powered on
elmkom 42:8500f0cb2ea5 218 mdm_uart2_rx_boot_mode_sel = 1;
elmkom 42:8500f0cb2ea5 219 mdm_wakeup_in = 1;
elmkom 42:8500f0cb2ea5 220
elmkom 42:8500f0cb2ea5 221 // initialze comm with the modem
elmkom 42:8500f0cb2ea5 222 mdm.baud(115200);
elmkom 42:8500f0cb2ea5 223 // clear out potential garbage
elmkom 42:8500f0cb2ea5 224 while (mdm.readable())
elmkom 42:8500f0cb2ea5 225 mdm.getc();
elmkom 42:8500f0cb2ea5 226
elmkom 42:8500f0cb2ea5 227 mdm_uart1_cts = 0;
elmkom 42:8500f0cb2ea5 228
elmkom 42:8500f0cb2ea5 229 // wait a moment for the modem to react to signal
elmkom 42:8500f0cb2ea5 230 // conditions while the level translator is disabled
elmkom 42:8500f0cb2ea5 231 // (sorry, don't have enough information to know
elmkom 42:8500f0cb2ea5 232 // what exactly the modem is doing with the current
elmkom 42:8500f0cb2ea5 233 // pin settings)
elmkom 42:8500f0cb2ea5 234 wait(1.0);
elmkom 42:8500f0cb2ea5 235
elmkom 42:8500f0cb2ea5 236 // enable the signal level translator to start
elmkom 42:8500f0cb2ea5 237 // modem reset process (modem will be powered down)
elmkom 42:8500f0cb2ea5 238 shield_3v3_1v8_sig_trans_ena = 1;
elmkom 42:8500f0cb2ea5 239
elmkom 42:8500f0cb2ea5 240 // Give the modem 60 secons to start responding by
elmkom 42:8500f0cb2ea5 241 // sending simple 'AT' commands to modem once per second.
elmkom 42:8500f0cb2ea5 242 Timer timer;
elmkom 42:8500f0cb2ea5 243 timer.start();
elmkom 42:8500f0cb2ea5 244 while (timer.read() < 60) {
elmkom 42:8500f0cb2ea5 245 SetLedColor(0x1); //red
elmkom 42:8500f0cb2ea5 246 if(isModemResponding())
elmkom 42:8500f0cb2ea5 247 {
elmkom 42:8500f0cb2ea5 248 SetLedColor(0);
elmkom 44:60008ebffdd4 249 //mdm_uart2_rx_boot_mode_sel = 0;
elmkom 42:8500f0cb2ea5 250 return true;
elmkom 42:8500f0cb2ea5 251 }
elmkom 42:8500f0cb2ea5 252 SetLedColor(0); //off
elmkom 42:8500f0cb2ea5 253 wait_ms(1000 - (timer.read_ms() % 1000));
elmkom 42:8500f0cb2ea5 254 pc.printf("\r%d",timer.read_ms()/1000);
elmkom 42:8500f0cb2ea5 255
elmkom 42:8500f0cb2ea5 256 }
elmkom 42:8500f0cb2ea5 257 return false;
elmkom 42:8500f0cb2ea5 258 }
elmkom 42:8500f0cb2ea5 259 int Wnc::secToTau(int time)
elmkom 42:8500f0cb2ea5 260 {
elmkom 42:8500f0cb2ea5 261 /*
elmkom 42:8500f0cb2ea5 262 0 - value is incremented in multiples of 10 minutes
elmkom 42:8500f0cb2ea5 263 1 - value is incremented in multiples of 1 hour
elmkom 42:8500f0cb2ea5 264 2 - value is incremented in multiples of 10 hours
elmkom 42:8500f0cb2ea5 265 3 - value is incremented in multiples of 2 seconds
elmkom 42:8500f0cb2ea5 266 4 - value is incremented in multiples of 30 seconds
elmkom 42:8500f0cb2ea5 267 5 - value is incremented in multiples of 1 minute
elmkom 42:8500f0cb2ea5 268 */
elmkom 42:8500f0cb2ea5 269 if(time/2 < 32)
elmkom 42:8500f0cb2ea5 270 {
elmkom 42:8500f0cb2ea5 271 return (0x3<<5)+time/2;
elmkom 42:8500f0cb2ea5 272 }
elmkom 42:8500f0cb2ea5 273 else if(time/30 < 32)
elmkom 42:8500f0cb2ea5 274 {
elmkom 42:8500f0cb2ea5 275 return (0x4<<5)+time/30;
elmkom 42:8500f0cb2ea5 276 }
elmkom 42:8500f0cb2ea5 277 else if(time/60 < 32)
elmkom 42:8500f0cb2ea5 278 {
elmkom 42:8500f0cb2ea5 279 return (0x5<<5)+time/60;
elmkom 42:8500f0cb2ea5 280 }
elmkom 42:8500f0cb2ea5 281 else if(time/3600 < 32)
elmkom 42:8500f0cb2ea5 282 {
elmkom 42:8500f0cb2ea5 283 return (0x1<<5)+time/3600;
elmkom 42:8500f0cb2ea5 284 }
elmkom 42:8500f0cb2ea5 285 else if(time/36000 < 32)
elmkom 42:8500f0cb2ea5 286 {
elmkom 42:8500f0cb2ea5 287 return (0x2<<5)+time/36000;
elmkom 42:8500f0cb2ea5 288 }
elmkom 42:8500f0cb2ea5 289 else
elmkom 42:8500f0cb2ea5 290 return (0x7<<5);
elmkom 42:8500f0cb2ea5 291
elmkom 42:8500f0cb2ea5 292
elmkom 42:8500f0cb2ea5 293 }
elmkom 42:8500f0cb2ea5 294 int Wnc::secToActivity(int time)
elmkom 42:8500f0cb2ea5 295 {
elmkom 42:8500f0cb2ea5 296 /*
elmkom 42:8500f0cb2ea5 297 0 - value is incremented in multiples of 2 seconds
elmkom 42:8500f0cb2ea5 298 1 - value is incremented in multiples of 1 minute
elmkom 42:8500f0cb2ea5 299 2 - value is incremented in multiples of decihours
elmkom 42:8500f0cb2ea5 300 7 - value indicates that the timer is deactivated.
elmkom 42:8500f0cb2ea5 301 */
elmkom 42:8500f0cb2ea5 302 if(time/2 < 32)
elmkom 42:8500f0cb2ea5 303 {
elmkom 42:8500f0cb2ea5 304 return (0x0<<5)+time/2;
elmkom 42:8500f0cb2ea5 305 }
elmkom 42:8500f0cb2ea5 306 else if(time/60 < 32)
elmkom 42:8500f0cb2ea5 307 {
elmkom 42:8500f0cb2ea5 308 return (0x1<<5)+time/60;
elmkom 42:8500f0cb2ea5 309 }
elmkom 42:8500f0cb2ea5 310 else if(time/36000 < 32)
elmkom 42:8500f0cb2ea5 311 {
elmkom 42:8500f0cb2ea5 312 return (0x2<<5)+time/36000;
elmkom 42:8500f0cb2ea5 313 }
elmkom 42:8500f0cb2ea5 314 else
elmkom 42:8500f0cb2ea5 315 return (0x7<<5);
elmkom 42:8500f0cb2ea5 316
elmkom 42:8500f0cb2ea5 317 }
elmkom 42:8500f0cb2ea5 318 void Wnc::setPowerSave(bool on,int t3412,int t3324)
elmkom 42:8500f0cb2ea5 319 {
elmkom 42:8500f0cb2ea5 320 if(on)
elmkom 42:8500f0cb2ea5 321 {
elmkom 44:60008ebffdd4 322 t3412Timer = t3412;
elmkom 44:60008ebffdd4 323 t3324Timer = t3324;
elmkom 42:8500f0cb2ea5 324 int tau = secToTau(t3412);
elmkom 42:8500f0cb2ea5 325 int activity = secToActivity(t3324);
elmkom 42:8500f0cb2ea5 326 mdm_wakeup_in = 0; //allow power sleep mode
elmkom 42:8500f0cb2ea5 327 powerSave = true;
elmkom 42:8500f0cb2ea5 328 char cmd[32];
elmkom 45:fe90f1fcb4e0 329 snprintf(cmd,sizeof(cmd),"AT+CPSMS=1,,,%d,%d",tau,activity);
elmkom 42:8500f0cb2ea5 330 send(cmd, WNC_WAIT_TIME_MS);
elmkom 42:8500f0cb2ea5 331 }
elmkom 42:8500f0cb2ea5 332 else
elmkom 42:8500f0cb2ea5 333 {
elmkom 42:8500f0cb2ea5 334 mdm_wakeup_in = 1; //disallow power sleep mode
elmkom 42:8500f0cb2ea5 335 powerSave = false;
elmkom 42:8500f0cb2ea5 336 send("AT+CPSMS=0", WNC_WAIT_TIME_MS);
elmkom 42:8500f0cb2ea5 337 }
elmkom 42:8500f0cb2ea5 338 }
elmkom 42:8500f0cb2ea5 339
elmkom 42:8500f0cb2ea5 340 char* Wnc::getIccid()
elmkom 42:8500f0cb2ea5 341 {
elmkom 42:8500f0cb2ea5 342 static char iccidBuf[32];
elmkom 42:8500f0cb2ea5 343 iccidBuf[0] = NULL;
elmkom 42:8500f0cb2ea5 344 char* reply = send("AT%CCID",500);
elmkom 42:8500f0cb2ea5 345 int index = 0;
elmkom 42:8500f0cb2ea5 346 int begin = -1;
elmkom 42:8500f0cb2ea5 347 int i = 0;
elmkom 42:8500f0cb2ea5 348
elmkom 42:8500f0cb2ea5 349 while (reply[index]) { // While there are more characters to process...
elmkom 42:8500f0cb2ea5 350 if (begin == -1 && isdigit(reply[index])) { // Upon finding a digit, ...
elmkom 42:8500f0cb2ea5 351 begin = index;
elmkom 42:8500f0cb2ea5 352 }
elmkom 42:8500f0cb2ea5 353 if(begin != -1)
elmkom 42:8500f0cb2ea5 354 {
elmkom 42:8500f0cb2ea5 355 if(isdigit(reply[index]))
elmkom 42:8500f0cb2ea5 356 {
elmkom 42:8500f0cb2ea5 357 iccidBuf[i++] = reply[index];
elmkom 42:8500f0cb2ea5 358 }
elmkom 42:8500f0cb2ea5 359 else
elmkom 42:8500f0cb2ea5 360 {
elmkom 42:8500f0cb2ea5 361 iccidBuf[i++] = NULL;
elmkom 42:8500f0cb2ea5 362 return iccidBuf;
elmkom 42:8500f0cb2ea5 363 }
elmkom 42:8500f0cb2ea5 364 }
elmkom 42:8500f0cb2ea5 365 index++;
elmkom 42:8500f0cb2ea5 366 }
elmkom 42:8500f0cb2ea5 367 return iccidBuf;
elmkom 42:8500f0cb2ea5 368 }
elmkom 42:8500f0cb2ea5 369
elmkom 42:8500f0cb2ea5 370 void Wnc::wakeFromPowerSave()
elmkom 42:8500f0cb2ea5 371 {
elmkom 42:8500f0cb2ea5 372 mdm_wakeup_in = 1;
elmkom 43:3979ea0a2df3 373 pc.printf("wake from power save\r\n");
elmkom 42:8500f0cb2ea5 374 }
elmkom 42:8500f0cb2ea5 375
elmkom 45:fe90f1fcb4e0 376 bool Wnc::cmdFailed(char* reply,char* msg)
elmkom 45:fe90f1fcb4e0 377 {
elmkom 45:fe90f1fcb4e0 378 if(strstr(reply,"OK") > 0)
elmkom 45:fe90f1fcb4e0 379 return false;
elmkom 45:fe90f1fcb4e0 380 pc.printf("%s\r\n",msg);
elmkom 45:fe90f1fcb4e0 381 return true;
elmkom 45:fe90f1fcb4e0 382 }
elmkom 45:fe90f1fcb4e0 383
elmkom 45:fe90f1fcb4e0 384 bool Wnc::startInternet()
elmkom 42:8500f0cb2ea5 385 {
elmkom 42:8500f0cb2ea5 386 char *reply;
elmkom 42:8500f0cb2ea5 387 reply = send("ATE1",WNC_WAIT_TIME_MS); // Echo ON
elmkom 42:8500f0cb2ea5 388 char apn [32];
elmkom 45:fe90f1fcb4e0 389 snprintf(apn,sizeof(apn),"AT%%PDNSET=1,%s,IP",MY_APN_STR);
elmkom 42:8500f0cb2ea5 390
elmkom 42:8500f0cb2ea5 391 reply = send(apn, 2*WNC_WAIT_TIME_MS); // Set APN, cmd seems to take a little longer sometimes
elmkom 45:fe90f1fcb4e0 392 if(cmdFailed(reply,"Failed to set APN")) return false;
elmkom 45:fe90f1fcb4e0 393
elmkom 45:fe90f1fcb4e0 394 reply = send("AT%PDNSET?", WNC_WAIT_TIME_MS);
elmkom 45:fe90f1fcb4e0 395
elmkom 46:733edf15f9e8 396 //pc.printf("Wiating ...\r\n");
elmkom 46:733edf15f9e8 397 //wait(10);
elmkom 45:fe90f1fcb4e0 398
elmkom 42:8500f0cb2ea5 399 reply = send("AT@INTERNET=1", WNC_WAIT_TIME_MS); // Internet services enabled
elmkom 45:fe90f1fcb4e0 400 if(cmdFailed(reply,"Failed to start INTERNET"))
elmkom 45:fe90f1fcb4e0 401 {
elmkom 45:fe90f1fcb4e0 402 return false;
elmkom 45:fe90f1fcb4e0 403 }
elmkom 46:733edf15f9e8 404 reply = send("AT@SOCKDIAL=1", 4*WNC_WAIT_TIME_MS);
elmkom 45:fe90f1fcb4e0 405 if(cmdFailed(reply,"SOCKDIAL Failed"))
elmkom 45:fe90f1fcb4e0 406 {
elmkom 45:fe90f1fcb4e0 407 // passthrough();
elmkom 45:fe90f1fcb4e0 408 return false;
elmkom 45:fe90f1fcb4e0 409 }
elmkom 45:fe90f1fcb4e0 410 return true;
elmkom 42:8500f0cb2ea5 411 }
elmkom 42:8500f0cb2ea5 412
elmkom 42:8500f0cb2ea5 413 char* Wnc::ping(char* ip)
elmkom 42:8500f0cb2ea5 414 {
elmkom 42:8500f0cb2ea5 415 char cmd[32];
elmkom 45:fe90f1fcb4e0 416 snprintf(cmd,sizeof(cmd),"AT@PINGREQ=\"%s\"",ip);
elmkom 42:8500f0cb2ea5 417 return send(cmd,WNC_WAIT_TIME_MS);
elmkom 42:8500f0cb2ea5 418 }
elmkom 45:fe90f1fcb4e0 419
elmkom 42:8500f0cb2ea5 420 bool Wnc::connect(char* ip, int port)
elmkom 42:8500f0cb2ea5 421 {
elmkom 42:8500f0cb2ea5 422 char *reply;
elmkom 42:8500f0cb2ea5 423
elmkom 45:fe90f1fcb4e0 424 for(int i = 0;i<2;i++)
elmkom 45:fe90f1fcb4e0 425 {
elmkom 45:fe90f1fcb4e0 426 if(isModemResponding())
elmkom 45:fe90f1fcb4e0 427 break;
elmkom 45:fe90f1fcb4e0 428 wait(0.5);
elmkom 45:fe90f1fcb4e0 429 }
elmkom 45:fe90f1fcb4e0 430
elmkom 43:3979ea0a2df3 431 if(isModemResponding())
elmkom 43:3979ea0a2df3 432 {
elmkom 43:3979ea0a2df3 433 reply = send("AT@SOCKCREAT=1", WNC_WAIT_TIME_MS);
elmkom 45:fe90f1fcb4e0 434 if(cmdFailed(reply,"Socket Create Failed")) return false;
elmkom 45:fe90f1fcb4e0 435 }
elmkom 45:fe90f1fcb4e0 436 else
elmkom 45:fe90f1fcb4e0 437 {
elmkom 45:fe90f1fcb4e0 438 pc.printf("Error Modem not responding\r\n");
elmkom 45:fe90f1fcb4e0 439 return false;
elmkom 43:3979ea0a2df3 440 }
elmkom 43:3979ea0a2df3 441
elmkom 43:3979ea0a2df3 442
elmkom 45:fe90f1fcb4e0 443 char cmd[64];
elmkom 45:fe90f1fcb4e0 444
elmkom 45:fe90f1fcb4e0 445 snprintf(cmd,sizeof(cmd),"AT@SOCKCONN=1,\"%s\",%d",ip,port);
elmkom 45:fe90f1fcb4e0 446 reply = send(cmd,12*WNC_WAIT_TIME_MS);
elmkom 45:fe90f1fcb4e0 447 if(cmdFailed(reply,"Socket Connect Failed")) return false;
elmkom 45:fe90f1fcb4e0 448
elmkom 45:fe90f1fcb4e0 449 for(int i = 0;i<10;i++)
elmkom 43:3979ea0a2df3 450 {
elmkom 45:fe90f1fcb4e0 451 reply = send("AT+CREG?",WNC_WAIT_TIME_MS);
elmkom 45:fe90f1fcb4e0 452 if(strlen(reply) > 0 && strstr(reply,"2,1") != 0)
elmkom 43:3979ea0a2df3 453 {
elmkom 45:fe90f1fcb4e0 454 pc.printf("Connected %s\r\n",reply);
elmkom 45:fe90f1fcb4e0 455 return true;
elmkom 43:3979ea0a2df3 456 }
elmkom 45:fe90f1fcb4e0 457 else
elmkom 45:fe90f1fcb4e0 458 {
elmkom 45:fe90f1fcb4e0 459 pc.printf("Unconnected %s\r\n",reply);
elmkom 45:fe90f1fcb4e0 460 }
elmkom 45:fe90f1fcb4e0 461 wait(1);
elmkom 43:3979ea0a2df3 462 }
elmkom 45:fe90f1fcb4e0 463 return false;
elmkom 42:8500f0cb2ea5 464 }
elmkom 42:8500f0cb2ea5 465
elmkom 42:8500f0cb2ea5 466 void Wnc::disconnect()
elmkom 42:8500f0cb2ea5 467 {
elmkom 42:8500f0cb2ea5 468 send("AT@SOCKCLOSE=1", WNC_WAIT_TIME_MS);
elmkom 42:8500f0cb2ea5 469 }
elmkom 42:8500f0cb2ea5 470
elmkom 42:8500f0cb2ea5 471 char* Wnc::encode(int value, char* result, int base)
elmkom 42:8500f0cb2ea5 472 {
elmkom 42:8500f0cb2ea5 473 // check that the base if valid
elmkom 42:8500f0cb2ea5 474 if ( base < 2 || base > 36 ) {
elmkom 42:8500f0cb2ea5 475 *result = '\0';
elmkom 42:8500f0cb2ea5 476 return result;
elmkom 42:8500f0cb2ea5 477 }
elmkom 42:8500f0cb2ea5 478
elmkom 42:8500f0cb2ea5 479 char* ptr = result, *ptr1 = result, tmp_char;
elmkom 42:8500f0cb2ea5 480 int tmp_value;
elmkom 42:8500f0cb2ea5 481
elmkom 42:8500f0cb2ea5 482 do {
elmkom 42:8500f0cb2ea5 483 tmp_value = value;
elmkom 42:8500f0cb2ea5 484 value /= base;
elmkom 42:8500f0cb2ea5 485 *ptr++ = "zyxwvutsrqponmlkjihgfedcba9876543210123456789abcdefghijklmnopqrstuvwxyz"[35 + (tmp_value - value * base)];
elmkom 42:8500f0cb2ea5 486 } while ( value );
elmkom 42:8500f0cb2ea5 487
elmkom 42:8500f0cb2ea5 488 // Apply negative sign
elmkom 42:8500f0cb2ea5 489 if ( tmp_value < 0 )
elmkom 42:8500f0cb2ea5 490 *ptr++ = '-';
elmkom 42:8500f0cb2ea5 491 *ptr-- = '\0';
elmkom 42:8500f0cb2ea5 492
elmkom 42:8500f0cb2ea5 493 while ( ptr1 < ptr ) {
elmkom 42:8500f0cb2ea5 494 tmp_char = *ptr;
elmkom 42:8500f0cb2ea5 495 *ptr-- = *ptr1;
elmkom 42:8500f0cb2ea5 496 *ptr1++ = tmp_char;
elmkom 42:8500f0cb2ea5 497 }
elmkom 42:8500f0cb2ea5 498 return result;
elmkom 42:8500f0cb2ea5 499 }
elmkom 42:8500f0cb2ea5 500
elmkom 45:fe90f1fcb4e0 501 bool Wnc::writeSocket(const char * s)
elmkom 42:8500f0cb2ea5 502 {
elmkom 42:8500f0cb2ea5 503
elmkom 42:8500f0cb2ea5 504 char num2str[6];
elmkom 42:8500f0cb2ea5 505 size_t sLen = strlen(s);
elmkom 42:8500f0cb2ea5 506 if (sLen <= 99999)
elmkom 42:8500f0cb2ea5 507 {
elmkom 45:fe90f1fcb4e0 508 char cmd[sLen*2+32];
elmkom 45:fe90f1fcb4e0 509 int index = snprintf(cmd,sizeof(cmd),"AT@SOCKWRITE=1,%d,\"",sLen);
elmkom 42:8500f0cb2ea5 510
elmkom 42:8500f0cb2ea5 511 while(*s != '\0')
elmkom 42:8500f0cb2ea5 512 {
elmkom 42:8500f0cb2ea5 513 encode((int)*s++, num2str, 16);
elmkom 42:8500f0cb2ea5 514 // Always 2-digit ascii hex:
elmkom 42:8500f0cb2ea5 515 if (strlen(num2str) == 1)
elmkom 42:8500f0cb2ea5 516 {
elmkom 42:8500f0cb2ea5 517 num2str[2] = '\0';
elmkom 42:8500f0cb2ea5 518 num2str[1] = num2str[0];
elmkom 42:8500f0cb2ea5 519 num2str[0] = '0';
elmkom 42:8500f0cb2ea5 520 }
elmkom 45:fe90f1fcb4e0 521 cmd[index++] = num2str[0];
elmkom 45:fe90f1fcb4e0 522 cmd[index++] = num2str[1];
elmkom 42:8500f0cb2ea5 523 }
elmkom 45:fe90f1fcb4e0 524 cmd[index++] = '"';
elmkom 45:fe90f1fcb4e0 525 cmd[index] = '\0';
elmkom 45:fe90f1fcb4e0 526 char* reply = send(cmd, WNC_WAIT_TIME_MS);
elmkom 45:fe90f1fcb4e0 527 if(cmdFailed(reply,"Send Failed")) return false;
elmkom 45:fe90f1fcb4e0 528 return true;
elmkom 42:8500f0cb2ea5 529 }
elmkom 42:8500f0cb2ea5 530 else
elmkom 45:fe90f1fcb4e0 531 {
elmkom 42:8500f0cb2ea5 532 pc.puts("sockwrite Err, string to long\r\n");
elmkom 45:fe90f1fcb4e0 533 return false;
elmkom 45:fe90f1fcb4e0 534 }
elmkom 45:fe90f1fcb4e0 535
elmkom 42:8500f0cb2ea5 536 }
elmkom 42:8500f0cb2ea5 537
elmkom 45:fe90f1fcb4e0 538 int Wnc::hex_to_int(char A)
elmkom 45:fe90f1fcb4e0 539 {
elmkom 45:fe90f1fcb4e0 540 return (A > '9')? (A &~ 0x20) - 'A' + 10: (A - '0');
elmkom 42:8500f0cb2ea5 541 }
elmkom 42:8500f0cb2ea5 542
elmkom 45:fe90f1fcb4e0 543 int Wnc::hex_to_ascii(char h, char l)
elmkom 45:fe90f1fcb4e0 544 {
elmkom 45:fe90f1fcb4e0 545 return hex_to_int(h) * 16 + hex_to_int(l);
elmkom 42:8500f0cb2ea5 546 }
elmkom 42:8500f0cb2ea5 547
elmkom 42:8500f0cb2ea5 548 int Wnc::indexOf(char* str, char c)
elmkom 42:8500f0cb2ea5 549 {
elmkom 42:8500f0cb2ea5 550 int index = 0;
elmkom 42:8500f0cb2ea5 551 while(str[index] != 0)
elmkom 42:8500f0cb2ea5 552 {
elmkom 42:8500f0cb2ea5 553 if(str[index] == c)
elmkom 42:8500f0cb2ea5 554 return index;
elmkom 42:8500f0cb2ea5 555 index++;
elmkom 42:8500f0cb2ea5 556 }
elmkom 42:8500f0cb2ea5 557 return -1;
elmkom 42:8500f0cb2ea5 558 }
elmkom 42:8500f0cb2ea5 559
elmkom 42:8500f0cb2ea5 560 char* Wnc::readSocket()
elmkom 42:8500f0cb2ea5 561 {
elmkom 42:8500f0cb2ea5 562
elmkom 42:8500f0cb2ea5 563 static char data[1000];
elmkom 42:8500f0cb2ea5 564 int i = 0;
elmkom 42:8500f0cb2ea5 565 char *reply;
elmkom 42:8500f0cb2ea5 566 reply = send("AT@SOCKREAD=1,1024",1000);
elmkom 42:8500f0cb2ea5 567 if(strlen(reply) > 0)
elmkom 42:8500f0cb2ea5 568 {
elmkom 42:8500f0cb2ea5 569 int pos_start = indexOf(reply,'"');
elmkom 42:8500f0cb2ea5 570
elmkom 42:8500f0cb2ea5 571 if(pos_start > 0)
elmkom 42:8500f0cb2ea5 572 {
elmkom 42:8500f0cb2ea5 573 pos_start+=1;
elmkom 42:8500f0cb2ea5 574 int length = indexOf(&reply[pos_start],'"');
elmkom 42:8500f0cb2ea5 575
elmkom 42:8500f0cb2ea5 576 if(length > 0)
elmkom 42:8500f0cb2ea5 577 {
elmkom 42:8500f0cb2ea5 578 char hi;
elmkom 42:8500f0cb2ea5 579 char low;
elmkom 42:8500f0cb2ea5 580 for(i = 0; i < length; i++){
elmkom 42:8500f0cb2ea5 581 if(i % 2 != 0){
elmkom 42:8500f0cb2ea5 582 low = reply[pos_start++];
elmkom 42:8500f0cb2ea5 583 data[i/2] = (char) hex_to_ascii(hi,low);
elmkom 42:8500f0cb2ea5 584 }else{
elmkom 42:8500f0cb2ea5 585 hi = reply[pos_start++];
elmkom 42:8500f0cb2ea5 586 }
elmkom 42:8500f0cb2ea5 587 }
elmkom 44:60008ebffdd4 588 data[length/2] = NULL;
elmkom 42:8500f0cb2ea5 589 }
elmkom 42:8500f0cb2ea5 590 }
elmkom 42:8500f0cb2ea5 591 }
elmkom 42:8500f0cb2ea5 592 data[i] = NULL;
elmkom 42:8500f0cb2ea5 593 return data;
elmkom 45:fe90f1fcb4e0 594 }
elmkom 45:fe90f1fcb4e0 595
elmkom 45:fe90f1fcb4e0 596 char* Wnc::resolveDn(const char* name)
elmkom 45:fe90f1fcb4e0 597 {
elmkom 45:fe90f1fcb4e0 598 char cmd[64];
elmkom 45:fe90f1fcb4e0 599
elmkom 45:fe90f1fcb4e0 600 snprintf(cmd,sizeof(cmd),"AT@DNSRESVDON=\"%s\"",name);
elmkom 45:fe90f1fcb4e0 601 char* reply = send(cmd,12*WNC_WAIT_TIME_MS);
elmkom 45:fe90f1fcb4e0 602 static char ipBuf[32];
elmkom 45:fe90f1fcb4e0 603 ipBuf[0] = NULL;
elmkom 45:fe90f1fcb4e0 604 int index = 0;
elmkom 45:fe90f1fcb4e0 605 int begin = -1;
elmkom 45:fe90f1fcb4e0 606 int i = 0;
elmkom 45:fe90f1fcb4e0 607
elmkom 45:fe90f1fcb4e0 608 while (reply[index]) { // While there are more characters to process...
elmkom 45:fe90f1fcb4e0 609 if (begin == -1 && isdigit(reply[index])) { // Upon finding a digit, ...
elmkom 45:fe90f1fcb4e0 610 begin = index;
elmkom 45:fe90f1fcb4e0 611 }
elmkom 45:fe90f1fcb4e0 612 if(begin != -1)
elmkom 45:fe90f1fcb4e0 613 {
elmkom 45:fe90f1fcb4e0 614 if(isdigit(reply[index]) || reply[index] == '.')
elmkom 45:fe90f1fcb4e0 615 {
elmkom 45:fe90f1fcb4e0 616 ipBuf[i++] = reply[index];
elmkom 45:fe90f1fcb4e0 617 }
elmkom 45:fe90f1fcb4e0 618 else
elmkom 45:fe90f1fcb4e0 619 {
elmkom 45:fe90f1fcb4e0 620 ipBuf[i++] = NULL;
elmkom 45:fe90f1fcb4e0 621 return ipBuf;
elmkom 45:fe90f1fcb4e0 622 }
elmkom 45:fe90f1fcb4e0 623 }
elmkom 45:fe90f1fcb4e0 624 index++;
elmkom 45:fe90f1fcb4e0 625 }
elmkom 45:fe90f1fcb4e0 626 return ipBuf;
elmkom 42:8500f0cb2ea5 627 }