Damien Frost / WiflyInterface

- Added setBaud() function - Added CheckNetworkStatus() function - Improved messaging system

Dependents:   IoT_Ex BatteryModelTester BatteryModelTester

Fork of WiflyInterface by Components

Wifly/Wifly.cpp@31:2846355deb7e, 2016-05-09 (annotated)

Committer:
defrost
Date:
Mon May 09 11:39:08 2016 +0000
Revision:
31:2846355deb7e
Parent:
30:2c704a72d88a
Child:
32:ab206f7f5090
- Fixed checkNetworkStatus() function, works properly

Who changed what in which revision?

UserRevisionLine numberNew contents of line
samux 1:fb4494783863 1 /* Copyright (C) 2012 mbed.org, MIT License
samux 1:fb4494783863 2 *
samux 1:fb4494783863 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
samux 1:fb4494783863 4 * and associated documentation files (the "Software"), to deal in the Software without restriction,
samux 1:fb4494783863 5 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
samux 1:fb4494783863 6 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
samux 1:fb4494783863 7 * furnished to do so, subject to the following conditions:
samux 1:fb4494783863 8 *
samux 1:fb4494783863 9 * The above copyright notice and this permission notice shall be included in all copies or
samux 1:fb4494783863 10 * substantial portions of the Software.
samux 1:fb4494783863 11 *
samux 1:fb4494783863 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
samux 1:fb4494783863 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
samux 1:fb4494783863 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
samux 1:fb4494783863 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
samux 1:fb4494783863 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
samux 1:fb4494783863 17 */
samux 1:fb4494783863 18
samux 1:fb4494783863 19 #include "mbed.h"
samux 1:fb4494783863 20 #include "Wifly.h"
samux 1:fb4494783863 21 #include <string>
samux 1:fb4494783863 22 #include <algorithm>
defrost 22:6c5bcfa33922 23
defrost 29:c991041e766e 24 //#define DEBUG
defrost 26:eaaedb036df1 25 #define INFOMESSAGES
samux 1:fb4494783863 26 //Debug is disabled by default
defrost 23:cb8522185c56 27 #ifdef DEBUG
defrost 26:eaaedb036df1 28 #define DBG(x, ...) pc.printf("[Wifly : DBG] "x"\r\n", ##__VA_ARGS__);
defrost 26:eaaedb036df1 29 #define WARN(x, ...) pc.printf("[Wifly : WARN] "x"\r\n", ##__VA_ARGS__);
defrost 26:eaaedb036df1 30 #define ERR(x, ...) pc.printf("[Wifly : ERR] "x"\r\n", ##__VA_ARGS__);
samux 1:fb4494783863 31 #else
samux 1:fb4494783863 32 #define DBG(x, ...)
samux 1:fb4494783863 33 #define WARN(x, ...)
samux 1:fb4494783863 34 #define ERR(x, ...)
samux 1:fb4494783863 35 #endif
samux 1:fb4494783863 36
defrost 26:eaaedb036df1 37 #ifdef INFOMESSAGES
defrost 26:eaaedb036df1 38 #define INFO(x, ...) pc.printf("[Wifly : INFO] "x"\r\n", ##__VA_ARGS__);
samux 1:fb4494783863 39 #else
samux 1:fb4494783863 40 #define INFO(x, ...)
samux 1:fb4494783863 41 #endif
samux 1:fb4494783863 42
samux 1:fb4494783863 43 #define MAX_TRY_JOIN 3
samux 1:fb4494783863 44
samux 1:fb4494783863 45 Wifly * Wifly::inst;
samux 1:fb4494783863 46
samux 1:fb4494783863 47 Wifly::Wifly( PinName tx, PinName rx, PinName _reset, PinName tcp_status, const char * ssid, const char * phrase, Security sec):
defrost 25:36b2d76ca8d9 48 wifi(tx, rx), reset_pin(_reset), tcp_status(tcp_status), buf_wifly(1024)
samux 1:fb4494783863 49 {
samux 1:fb4494783863 50 memset(&state, 0, sizeof(state));
samux 1:fb4494783863 51 state.sec = sec;
samux 1:fb4494783863 52
samux 1:fb4494783863 53 // change all ' ' in '$' in the ssid and the passphrase
samux 1:fb4494783863 54 strcpy(this->ssid, ssid);
samux 1:fb4494783863 55 for (int i = 0; i < strlen(ssid); i++) {
samux 1:fb4494783863 56 if (this->ssid[i] == ' ')
samux 1:fb4494783863 57 this->ssid[i] = '$';
samux 1:fb4494783863 58 }
samux 1:fb4494783863 59 strcpy(this->phrase, phrase);
samux 1:fb4494783863 60 for (int i = 0; i < strlen(phrase); i++) {
samux 1:fb4494783863 61 if (this->phrase[i] == ' ')
samux 1:fb4494783863 62 this->phrase[i] = '$';
samux 1:fb4494783863 63 }
samux 1:fb4494783863 64
samux 1:fb4494783863 65 inst = this;
samux 1:fb4494783863 66 attach_rx(false);
samux 1:fb4494783863 67 state.cmd_mode = false;
samux 1:fb4494783863 68 }
samux 1:fb4494783863 69
defrost 23:cb8522185c56 70
defrost 15:eaa1ec0e26bf 71 void Wifly::setBaud(int baudrate)
defrost 15:eaa1ec0e26bf 72 {
defrost 18:cf3bd54703a5 73 char cmd[28];
defrost 15:eaa1ec0e26bf 74 // This sets the baud rate 'instantly'
defrost 15:eaa1ec0e26bf 75 sprintf(cmd, "set u i %d\r", baudrate);
defrost 15:eaa1ec0e26bf 76 // This one sets it some other way that does not work
defrost 15:eaa1ec0e26bf 77 //sprintf(cmd, "set u b %d\r", baudrate);
defrost 15:eaa1ec0e26bf 78 // Set baud rate of wifly:
defrost 16:de16e8b077c1 79 sendCommand(cmd, NULL);
defrost 16:de16e8b077c1 80 wait(0.5);
defrost 15:eaa1ec0e26bf 81 // Set baud rate of UART:
defrost 15:eaa1ec0e26bf 82 wifi.baud(baudrate);
defrost 16:de16e8b077c1 83 wait(0.5);
defrost 15:eaa1ec0e26bf 84 exit();
defrost 15:eaa1ec0e26bf 85 }
defrost 15:eaa1ec0e26bf 86
samux 1:fb4494783863 87 bool Wifly::join()
samux 1:fb4494783863 88 {
defrost 18:cf3bd54703a5 89 char cmd[28];
samux 1:fb4494783863 90
samux 1:fb4494783863 91 for (int i= 0; i < MAX_TRY_JOIN; i++) {
samux 2:8e54830d0df7 92
samux 2:8e54830d0df7 93 // no auto join
samux 2:8e54830d0df7 94 if (!sendCommand("set w j 0\r", "AOK"))
samux 2:8e54830d0df7 95 continue;
samux 2:8e54830d0df7 96
samux 2:8e54830d0df7 97 //no echo
samux 2:8e54830d0df7 98 if (!sendCommand("set u m 1\r", "AOK"))
samux 2:8e54830d0df7 99 continue;
samux 2:8e54830d0df7 100
samux 1:fb4494783863 101 // set time
samux 4:0bcec6272784 102 if (!sendCommand("set c t 30\r", "AOK"))
samux 1:fb4494783863 103 continue;
samux 1:fb4494783863 104
samux 1:fb4494783863 105 // set size
samux 4:0bcec6272784 106 if (!sendCommand("set c s 1024\r", "AOK"))
samux 1:fb4494783863 107 continue;
samux 1:fb4494783863 108
samux 1:fb4494783863 109 // red led on when tcp connection active
samux 1:fb4494783863 110 if (!sendCommand("set s i 0x40\r", "AOK"))
samux 1:fb4494783863 111 continue;
samux 1:fb4494783863 112
samux 1:fb4494783863 113 // no string sent to the tcp client
samux 1:fb4494783863 114 if (!sendCommand("set c r 0\r", "AOK"))
samux 1:fb4494783863 115 continue;
samux 1:fb4494783863 116
samux 1:fb4494783863 117 // tcp protocol
samux 1:fb4494783863 118 if (!sendCommand("set i p 2\r", "AOK"))
samux 1:fb4494783863 119 continue;
samux 1:fb4494783863 120
samux 1:fb4494783863 121 // tcp retry
samux 1:fb4494783863 122 if (!sendCommand("set i f 0x7\r", "AOK"))
samux 1:fb4494783863 123 continue;
samux 2:8e54830d0df7 124
samux 2:8e54830d0df7 125 // set dns server
samux 2:8e54830d0df7 126 if (!sendCommand("set d n rn.microchip.com\r", "AOK"))
samux 1:fb4494783863 127 continue;
samux 1:fb4494783863 128
samux 1:fb4494783863 129 //dhcp
samux 1:fb4494783863 130 sprintf(cmd, "set i d %d\r", (state.dhcp) ? 1 : 0);
samux 1:fb4494783863 131 if (!sendCommand(cmd, "AOK"))
samux 1:fb4494783863 132 continue;
samux 1:fb4494783863 133
samux 1:fb4494783863 134 // ssid
samux 1:fb4494783863 135 sprintf(cmd, "set w s %s\r", ssid);
lz307 7:3152fcc74390 136 if (!sendCommand(cmd, "AOK", NULL, 1000))
samux 1:fb4494783863 137 continue;
samux 1:fb4494783863 138
samux 1:fb4494783863 139 //auth
samux 1:fb4494783863 140 sprintf(cmd, "set w a %d\r", state.sec);
samux 1:fb4494783863 141 if (!sendCommand(cmd, "AOK"))
samux 1:fb4494783863 142 continue;
samux 1:fb4494783863 143
samux 1:fb4494783863 144 // if no dhcp, set ip, netmask and gateway
samux 1:fb4494783863 145 if (!state.dhcp) {
samux 1:fb4494783863 146 DBG("not dhcp\r");
samux 1:fb4494783863 147
samux 1:fb4494783863 148 sprintf(cmd, "set i a %s\r\n", ip);
samux 1:fb4494783863 149 if (!sendCommand(cmd, "AOK"))
samux 1:fb4494783863 150 continue;
samux 1:fb4494783863 151
samux 1:fb4494783863 152 sprintf(cmd, "set i n %s\r", netmask);
samux 1:fb4494783863 153 if (!sendCommand(cmd, "AOK"))
samux 1:fb4494783863 154 continue;
samux 1:fb4494783863 155
samux 1:fb4494783863 156 sprintf(cmd, "set i g %s\r", gateway);
samux 1:fb4494783863 157 if (!sendCommand(cmd, "AOK"))
samux 1:fb4494783863 158 continue;
samux 1:fb4494783863 159 }
samux 1:fb4494783863 160
samux 1:fb4494783863 161 //key step
samux 1:fb4494783863 162 if (state.sec != NONE) {
defrost 12:1aaea7f302e6 163 if ((state.sec == WPA)||(state.sec == WPA2))
samux 1:fb4494783863 164 sprintf(cmd, "set w p %s\r", phrase);
samux 1:fb4494783863 165 else if (state.sec == WEP_128)
samux 1:fb4494783863 166 sprintf(cmd, "set w k %s\r", phrase);
samux 1:fb4494783863 167
lz307 7:3152fcc74390 168 if (!sendCommand(cmd, "AOK", NULL, 1000))
samux 1:fb4494783863 169 continue;
samux 1:fb4494783863 170 }
samux 1:fb4494783863 171
samux 1:fb4494783863 172 //join the network
samux 1:fb4494783863 173 sprintf(cmd, "join\r");
samux 1:fb4494783863 174 if (!sendCommand(cmd, "Associated", NULL, 3000))
samux 1:fb4494783863 175 continue;
lz307 7:3152fcc74390 176
lz307 7:3152fcc74390 177 if (!sendCommand("", "IP=", NULL, 10000))
lz307 7:3152fcc74390 178 continue;
samux 1:fb4494783863 179
samux 1:fb4494783863 180 if (state.dhcp) {
lz307 7:3152fcc74390 181 if (!sendCommand("get i\r", "DHCP=ON", NULL, 3000))
samux 1:fb4494783863 182 continue;
samux 1:fb4494783863 183 }
samux 1:fb4494783863 184
samux 2:8e54830d0df7 185 if (!sendCommand("save\r", "Stor"))
samux 2:8e54830d0df7 186 continue;
samux 2:8e54830d0df7 187
samux 1:fb4494783863 188 exit();
samux 1:fb4494783863 189
samux 1:fb4494783863 190 state.associated = true;
samux 1:fb4494783863 191 INFO("\r\nssid: %s\r\nphrase: %s\r\nsecurity: %s\r\n\r\n", this->ssid, this->phrase, getStringSecurity());
defrost 13:8846f12fa277 192
samux 1:fb4494783863 193 return true;
samux 1:fb4494783863 194 }
samux 1:fb4494783863 195 return false;
samux 1:fb4494783863 196 }
samux 1:fb4494783863 197
samux 1:fb4494783863 198
samux 1:fb4494783863 199 bool Wifly::setProtocol(Protocol p)
samux 1:fb4494783863 200 {
samux 1:fb4494783863 201 // use udp auto pairing
samux 1:fb4494783863 202 char cmd[20];
samux 1:fb4494783863 203 sprintf(cmd, "set i p %d\r", p);
samux 1:fb4494783863 204 if (!sendCommand(cmd, "AOK"))
samux 1:fb4494783863 205 return false;
samux 1:fb4494783863 206
samux 1:fb4494783863 207 switch(p) {
samux 1:fb4494783863 208 case TCP:
samux 1:fb4494783863 209 // set ip flags: tcp retry enabled
samux 1:fb4494783863 210 if (!sendCommand("set i f 0x07\r", "AOK"))
samux 1:fb4494783863 211 return false;
samux 1:fb4494783863 212 break;
samux 1:fb4494783863 213 case UDP:
samux 1:fb4494783863 214 // set ip flags: udp auto pairing enabled
samux 1:fb4494783863 215 if (!sendCommand("set i h 0.0.0.0\r", "AOK"))
samux 1:fb4494783863 216 return false;
samux 4:0bcec6272784 217 if (!sendCommand("set i f 0x40\r", "AOK"))
samux 1:fb4494783863 218 return false;
samux 1:fb4494783863 219 break;
samux 1:fb4494783863 220 }
samux 1:fb4494783863 221 state.proto = p;
samux 1:fb4494783863 222 return true;
samux 1:fb4494783863 223 }
samux 1:fb4494783863 224
samux 1:fb4494783863 225 char * Wifly::getStringSecurity()
samux 1:fb4494783863 226 {
samux 1:fb4494783863 227 switch(state.sec) {
samux 1:fb4494783863 228 case NONE:
samux 1:fb4494783863 229 return "NONE";
samux 1:fb4494783863 230 case WEP_128:
samux 1:fb4494783863 231 return "WEP_128";
samux 1:fb4494783863 232 case WPA:
samux 1:fb4494783863 233 return "WPA";
defrost 13:8846f12fa277 234 case WPA2:
defrost 13:8846f12fa277 235 return "WPA2";
samux 1:fb4494783863 236 }
samux 1:fb4494783863 237 return "UNKNOWN";
samux 1:fb4494783863 238 }
samux 1:fb4494783863 239
samux 1:fb4494783863 240 bool Wifly::connect(const char * host, int port)
samux 1:fb4494783863 241 {
defrost 18:cf3bd54703a5 242 char rcv[28];
defrost 18:cf3bd54703a5 243 char cmd[28];
defrost 12:1aaea7f302e6 244
defrost 12:1aaea7f302e6 245
samux 1:fb4494783863 246
samux 2:8e54830d0df7 247 // try to open
samux 2:8e54830d0df7 248 sprintf(cmd, "open %s %d\r", host, port);
defrost 18:cf3bd54703a5 249 DBG("CMD1: %s\n\r",cmd);
defrost 18:cf3bd54703a5 250 if (sendCommand(cmd, "OPEN", rcv, 10000)) {
samux 2:8e54830d0df7 251 state.tcp = true;
samux 2:8e54830d0df7 252 state.cmd_mode = false;
samux 2:8e54830d0df7 253 return true;
samux 1:fb4494783863 254 }
defrost 18:cf3bd54703a5 255 DBG("CMD2: %s\n\r",cmd);
defrost 18:cf3bd54703a5 256 DBG("CMD4: %s\n\r",rcv);
samux 2:8e54830d0df7 257 // if failed, retry and parse the response
samux 2:8e54830d0df7 258 if (sendCommand(cmd, NULL, rcv, 5000)) {
defrost 20:3616a765c1b8 259 DBG("CMD5: %s\n\r",rcv);
samux 1:fb4494783863 260 if (strstr(rcv, "OPEN") == NULL) {
samux 1:fb4494783863 261 if (strstr(rcv, "Connected") != NULL) {
samux 2:8e54830d0df7 262 wait(0.25);
samux 1:fb4494783863 263 if (!sendCommand("close\r", "CLOS"))
samux 1:fb4494783863 264 return false;
samux 2:8e54830d0df7 265 wait(0.25);
samux 2:8e54830d0df7 266 if (!sendCommand(cmd, "OPEN", NULL, 10000))
samux 1:fb4494783863 267 return false;
samux 1:fb4494783863 268 } else {
samux 1:fb4494783863 269 return false;
samux 1:fb4494783863 270 }
samux 1:fb4494783863 271 }
samux 1:fb4494783863 272 } else {
defrost 20:3616a765c1b8 273 DBG("CMD5: %s\n\r",rcv);
samux 1:fb4494783863 274 return false;
samux 1:fb4494783863 275 }
defrost 12:1aaea7f302e6 276
samux 2:8e54830d0df7 277
samux 1:fb4494783863 278 state.tcp = true;
samux 1:fb4494783863 279 state.cmd_mode = false;
samux 1:fb4494783863 280
samux 1:fb4494783863 281 return true;
samux 1:fb4494783863 282 }
samux 1:fb4494783863 283
samux 1:fb4494783863 284
samux 1:fb4494783863 285 bool Wifly::gethostbyname(const char * host, char * ip)
samux 1:fb4494783863 286 {
samux 1:fb4494783863 287 string h = host;
samux 1:fb4494783863 288 char cmd[30], rcv[100];
samux 1:fb4494783863 289 int l = 0;
samux 1:fb4494783863 290 char * point;
samux 1:fb4494783863 291 int nb_digits = 0;
samux 1:fb4494783863 292
samux 1:fb4494783863 293 // no dns needed
samux 1:fb4494783863 294 int pos = h.find(".");
samux 1:fb4494783863 295 if (pos != string::npos) {
samux 1:fb4494783863 296 string sub = h.substr(0, h.find("."));
samux 1:fb4494783863 297 nb_digits = atoi(sub.c_str());
samux 1:fb4494783863 298 }
samux 1:fb4494783863 299 if (count(h.begin(), h.end(), '.') == 3 && nb_digits > 0) {
samux 1:fb4494783863 300 strcpy(ip, host);
samux 1:fb4494783863 301 }
samux 1:fb4494783863 302 // dns needed
samux 1:fb4494783863 303 else {
samux 1:fb4494783863 304 nb_digits = 0;
samux 1:fb4494783863 305 sprintf(cmd, "lookup %s\r", host);
samux 1:fb4494783863 306 if (!sendCommand(cmd, NULL, rcv))
samux 1:fb4494783863 307 return false;
samux 1:fb4494783863 308
samux 1:fb4494783863 309 // look for the ip address
samux 1:fb4494783863 310 char * begin = strstr(rcv, "=") + 1;
samux 1:fb4494783863 311 for (int i = 0; i < 3; i++) {
samux 1:fb4494783863 312 point = strstr(begin + l, ".");
samux 1:fb4494783863 313 DBG("str: %s", begin + l);
samux 1:fb4494783863 314 l += point - (begin + l) + 1;
samux 1:fb4494783863 315 }
samux 1:fb4494783863 316 DBG("str: %s", begin + l);
samux 1:fb4494783863 317 while(*(begin + l + nb_digits) >= '0' && *(begin + l + nb_digits) <= '9') {
samux 1:fb4494783863 318 DBG("digit: %c", *(begin + l + nb_digits));
samux 1:fb4494783863 319 nb_digits++;
samux 1:fb4494783863 320 }
samux 1:fb4494783863 321 memcpy(ip, begin, l + nb_digits);
samux 1:fb4494783863 322 ip[l+nb_digits] = 0;
samux 1:fb4494783863 323 DBG("ip from dns: %s", ip);
samux 1:fb4494783863 324 }
samux 1:fb4494783863 325 return true;
samux 1:fb4494783863 326 }
samux 1:fb4494783863 327
samux 1:fb4494783863 328
samux 1:fb4494783863 329 void Wifly::flush()
samux 1:fb4494783863 330 {
samux 1:fb4494783863 331 buf_wifly.flush();
samux 1:fb4494783863 332 }
samux 1:fb4494783863 333
samux 1:fb4494783863 334 bool Wifly::sendCommand(const char * cmd, const char * ack, char * res, int timeout)
samux 1:fb4494783863 335 {
samux 1:fb4494783863 336 if (!state.cmd_mode) {
samux 1:fb4494783863 337 cmdMode();
samux 1:fb4494783863 338 }
samux 1:fb4494783863 339 if (send(cmd, strlen(cmd), ack, res, timeout) == -1) {
defrost 23:cb8522185c56 340 ERR("sendCommand: cannot (%s)", cmd);
samux 1:fb4494783863 341 exit();
samux 1:fb4494783863 342 return false;
samux 1:fb4494783863 343 }
samux 1:fb4494783863 344 return true;
samux 1:fb4494783863 345 }
samux 1:fb4494783863 346
samux 1:fb4494783863 347 bool Wifly::cmdMode()
samux 1:fb4494783863 348 {
samux 1:fb4494783863 349 // if already in cmd mode, return
samux 1:fb4494783863 350 if (state.cmd_mode)
samux 1:fb4494783863 351 return true;
samux 1:fb4494783863 352
lz307 7:3152fcc74390 353 if (send("$$$", 3, "CMD") == -1 && send("\r",1,">") != true) {
samux 1:fb4494783863 354 ERR("cannot enter in cmd mode\r\n");
samux 2:8e54830d0df7 355 exit();
samux 1:fb4494783863 356 return false;
samux 1:fb4494783863 357 }
samux 1:fb4494783863 358 state.cmd_mode = true;
samux 1:fb4494783863 359 return true;
samux 1:fb4494783863 360 }
samux 1:fb4494783863 361
samux 1:fb4494783863 362 bool Wifly::disconnect()
samux 1:fb4494783863 363 {
samux 1:fb4494783863 364 // if already disconnected, return
samux 1:fb4494783863 365 if (!state.associated)
samux 1:fb4494783863 366 return true;
samux 2:8e54830d0df7 367
samux 1:fb4494783863 368 if (!sendCommand("leave\r", "DeAuth"))
samux 1:fb4494783863 369 return false;
samux 1:fb4494783863 370 exit();
samux 2:8e54830d0df7 371
samux 1:fb4494783863 372 state.associated = false;
samux 1:fb4494783863 373 return true;
samux 1:fb4494783863 374
samux 1:fb4494783863 375 }
samux 1:fb4494783863 376
samux 1:fb4494783863 377 bool Wifly::is_connected()
samux 1:fb4494783863 378 {
samux 1:fb4494783863 379 return (tcp_status.read() == 1) ? true : false;
samux 1:fb4494783863 380 }
samux 1:fb4494783863 381
samux 1:fb4494783863 382
samux 1:fb4494783863 383 void Wifly::reset()
samux 1:fb4494783863 384 {
samux 1:fb4494783863 385 reset_pin = 0;
samux 1:fb4494783863 386 wait(0.2);
samux 1:fb4494783863 387 reset_pin = 1;
samux 1:fb4494783863 388 wait(0.2);
samux 1:fb4494783863 389 }
samux 1:fb4494783863 390
samux 3:9aa05e19c62e 391 bool Wifly::reboot()
samux 3:9aa05e19c62e 392 {
samux 3:9aa05e19c62e 393 // if already in cmd mode, return
samux 3:9aa05e19c62e 394 if (!sendCommand("reboot\r"))
samux 3:9aa05e19c62e 395 return false;
samux 3:9aa05e19c62e 396
samux 3:9aa05e19c62e 397 wait(0.3);
samux 3:9aa05e19c62e 398
samux 3:9aa05e19c62e 399 state.cmd_mode = false;
samux 3:9aa05e19c62e 400 return true;
samux 3:9aa05e19c62e 401 }
samux 3:9aa05e19c62e 402
samux 1:fb4494783863 403 bool Wifly::close()
samux 1:fb4494783863 404 {
samux 1:fb4494783863 405 // if not connected, return
samux 1:fb4494783863 406 if (!state.tcp)
samux 1:fb4494783863 407 return true;
samux 2:8e54830d0df7 408
samux 1:fb4494783863 409 wait(0.25);
samux 1:fb4494783863 410 if (!sendCommand("close\r", "CLOS"))
samux 1:fb4494783863 411 return false;
samux 1:fb4494783863 412 exit();
samux 2:8e54830d0df7 413
samux 1:fb4494783863 414 state.tcp = false;
samux 1:fb4494783863 415 return true;
samux 1:fb4494783863 416 }
samux 1:fb4494783863 417
samux 1:fb4494783863 418
samux 1:fb4494783863 419 int Wifly::putc(char c)
samux 1:fb4494783863 420 {
samux 1:fb4494783863 421 while (!wifi.writeable());
samux 1:fb4494783863 422 return wifi.putc(c);
samux 1:fb4494783863 423 }
samux 1:fb4494783863 424
samux 1:fb4494783863 425
samux 1:fb4494783863 426 bool Wifly::exit()
samux 1:fb4494783863 427 {
samux 1:fb4494783863 428 flush();
samux 1:fb4494783863 429 if (!state.cmd_mode)
samux 1:fb4494783863 430 return true;
samux 1:fb4494783863 431 if (!sendCommand("exit\r", "EXIT"))
samux 1:fb4494783863 432 return false;
samux 1:fb4494783863 433 state.cmd_mode = false;
samux 1:fb4494783863 434 flush();
samux 1:fb4494783863 435 return true;
samux 1:fb4494783863 436 }
samux 1:fb4494783863 437
samux 1:fb4494783863 438
samux 1:fb4494783863 439 int Wifly::readable()
samux 1:fb4494783863 440 {
samux 1:fb4494783863 441 return buf_wifly.available();
samux 1:fb4494783863 442 }
samux 1:fb4494783863 443
samux 1:fb4494783863 444 int Wifly::writeable()
samux 1:fb4494783863 445 {
samux 1:fb4494783863 446 return wifi.writeable();
samux 1:fb4494783863 447 }
samux 1:fb4494783863 448
samux 1:fb4494783863 449 char Wifly::getc()
samux 1:fb4494783863 450 {
samux 1:fb4494783863 451 char c;
defrost 24:705480e2e482 452 //DBG("Waiting for buf_wifly.available() to return true...");
samux 1:fb4494783863 453 while (!buf_wifly.available());
defrost 24:705480e2e482 454 //DBG("Dequeue-ing c...");
samux 1:fb4494783863 455 buf_wifly.dequeue(&c);
defrost 24:705480e2e482 456 //DBG("Return c:(%c)",c);
samux 1:fb4494783863 457 return c;
samux 1:fb4494783863 458 }
samux 1:fb4494783863 459
samux 1:fb4494783863 460 void Wifly::handler_rx(void)
samux 1:fb4494783863 461 {
samux 1:fb4494783863 462 //read characters
samux 1:fb4494783863 463 while (wifi.readable())
samux 1:fb4494783863 464 buf_wifly.queue(wifi.getc());
samux 1:fb4494783863 465 }
samux 1:fb4494783863 466
samux 1:fb4494783863 467 void Wifly::attach_rx(bool callback)
samux 1:fb4494783863 468 {
samux 1:fb4494783863 469 if (!callback)
samux 1:fb4494783863 470 wifi.attach(NULL);
samux 1:fb4494783863 471 else
samux 1:fb4494783863 472 wifi.attach(this, &Wifly::handler_rx);
samux 1:fb4494783863 473 }
samux 1:fb4494783863 474
samux 1:fb4494783863 475
samux 1:fb4494783863 476 int Wifly::send(const char * str, int len, const char * ACK, char * res, int timeout)
samux 1:fb4494783863 477 {
samux 1:fb4494783863 478 char read;
samux 1:fb4494783863 479 size_t found = string::npos;
samux 1:fb4494783863 480 string checking;
samux 1:fb4494783863 481 Timer tmr;
samux 1:fb4494783863 482 int result = 0;
defrost 30:2c704a72d88a 483
defrost 30:2c704a72d88a 484 if(ACK == NULL){
defrost 30:2c704a72d88a 485 DBG("Will send: %s, no ACK requested.",str);
defrost 30:2c704a72d88a 486 }else{
defrost 30:2c704a72d88a 487 DBG("Will send: %s, looking for ACK: %s",str, ACK);
defrost 30:2c704a72d88a 488 }
samux 1:fb4494783863 489
samux 1:fb4494783863 490 attach_rx(false);
samux 1:fb4494783863 491
samux 1:fb4494783863 492 //We flush the buffer
samux 1:fb4494783863 493 while (wifi.readable())
samux 1:fb4494783863 494 wifi.getc();
samux 1:fb4494783863 495
samux 1:fb4494783863 496 if (!ACK || !strcmp(ACK, "NO")) {
samux 1:fb4494783863 497 for (int i = 0; i < len; i++)
samux 1:fb4494783863 498 result = (putc(str[i]) == str[i]) ? result + 1 : result;
samux 1:fb4494783863 499 } else {
samux 1:fb4494783863 500 //We flush the buffer
samux 1:fb4494783863 501 while (wifi.readable())
samux 1:fb4494783863 502 wifi.getc();
samux 1:fb4494783863 503
samux 1:fb4494783863 504 tmr.start();
samux 1:fb4494783863 505 for (int i = 0; i < len; i++)
samux 1:fb4494783863 506 result = (putc(str[i]) == str[i]) ? result + 1 : result;
samux 1:fb4494783863 507
samux 1:fb4494783863 508 while (1) {
samux 1:fb4494783863 509 if (tmr.read_ms() > timeout) {
samux 1:fb4494783863 510 //We flush the buffer
samux 1:fb4494783863 511 while (wifi.readable())
samux 1:fb4494783863 512 wifi.getc();
samux 1:fb4494783863 513
defrost 23:cb8522185c56 514 DBG("check: %s", checking.c_str());
defrost 23:cb8522185c56 515 DBG("result ignored: %d", result)
samux 1:fb4494783863 516 attach_rx(true);
samux 1:fb4494783863 517 return -1;
samux 1:fb4494783863 518 } else if (wifi.readable()) {
samux 1:fb4494783863 519 read = wifi.getc();
samux 1:fb4494783863 520 if ( read != '\r' && read != '\n') {
samux 1:fb4494783863 521 checking += read;
samux 1:fb4494783863 522 found = checking.find(ACK);
samux 1:fb4494783863 523 if (found != string::npos) {
samux 1:fb4494783863 524 wait(0.01);
samux 1:fb4494783863 525
samux 1:fb4494783863 526 //We flush the buffer
samux 1:fb4494783863 527 while (wifi.readable())
samux 1:fb4494783863 528 wifi.getc();
samux 1:fb4494783863 529
samux 1:fb4494783863 530 break;
samux 1:fb4494783863 531 }
defrost 24:705480e2e482 532 }
samux 1:fb4494783863 533 }
samux 1:fb4494783863 534 }
defrost 23:cb8522185c56 535 DBG("check: %s", checking.c_str());
defrost 23:cb8522185c56 536 DBG("result: %d", result)
samux 1:fb4494783863 537 attach_rx(true);
samux 1:fb4494783863 538 return result;
samux 1:fb4494783863 539 }
samux 1:fb4494783863 540
samux 1:fb4494783863 541 //the user wants the result from the command (ACK == NULL, res != NULL)
samux 1:fb4494783863 542 if ( res != NULL) {
samux 1:fb4494783863 543 int i = 0;
samux 1:fb4494783863 544 Timer timeout;
samux 1:fb4494783863 545 timeout.start();
samux 1:fb4494783863 546 tmr.reset();
samux 1:fb4494783863 547 while (1) {
samux 1:fb4494783863 548 if (timeout.read() > 2) {
samux 1:fb4494783863 549 if (i == 0) {
samux 1:fb4494783863 550 res = NULL;
samux 1:fb4494783863 551 break;
samux 1:fb4494783863 552 }
samux 1:fb4494783863 553 res[i] = '\0';
defrost 23:cb8522185c56 554 DBG("user str 1: %s", res);
samux 1:fb4494783863 555
samux 1:fb4494783863 556 break;
samux 1:fb4494783863 557 } else {
samux 1:fb4494783863 558 if (tmr.read_ms() > 300) {
samux 1:fb4494783863 559 res[i] = '\0';
defrost 23:cb8522185c56 560 DBG("user str2: %s", res);
samux 1:fb4494783863 561
samux 1:fb4494783863 562 break;
samux 1:fb4494783863 563 }
samux 1:fb4494783863 564 if (wifi.readable()) {
samux 1:fb4494783863 565 tmr.start();
samux 1:fb4494783863 566 read = wifi.getc();
samux 1:fb4494783863 567
samux 1:fb4494783863 568 // we drop \r and \n
samux 1:fb4494783863 569 if ( read != '\r' && read != '\n') {
samux 1:fb4494783863 570 res[i++] = read;
samux 1:fb4494783863 571 }
samux 1:fb4494783863 572 }
samux 1:fb4494783863 573 }
samux 1:fb4494783863 574 }
defrost 23:cb8522185c56 575 DBG("user str3: %s", res);
samux 1:fb4494783863 576 }
samux 1:fb4494783863 577
samux 1:fb4494783863 578 //We flush the buffer
samux 1:fb4494783863 579 while (wifi.readable())
samux 1:fb4494783863 580 wifi.getc();
samux 1:fb4494783863 581
samux 1:fb4494783863 582 attach_rx(true);
defrost 23:cb8522185c56 583 DBG("result: %d", result)
samux 1:fb4494783863 584 return result;
defrost 30:2c704a72d88a 585 }
defrost 30:2c704a72d88a 586
defrost 30:2c704a72d88a 587 int Wifly::checkNetworkStatus(void){
defrost 30:2c704a72d88a 588 int status = 0;
defrost 30:2c704a72d88a 589 char rcv[128];
defrost 31:2846355deb7e 590 unsigned int ConnectionReg;
defrost 30:2c704a72d88a 591
defrost 31:2846355deb7e 592 if(!sendCommand("show c\r", NULL, rcv, 5000)){
defrost 30:2c704a72d88a 593 status = 0;
defrost 30:2c704a72d88a 594 // the sendCommand function quits command mode if there is an error
defrost 30:2c704a72d88a 595 }else{
defrost 30:2c704a72d88a 596 // check the response:
defrost 31:2846355deb7e 597 sscanf(rcv, "%x%*s", &ConnectionReg);
defrost 31:2846355deb7e 598 if(((ConnectionReg & CC_ASSOCIATION)>0) && ((ConnectionReg & CC_AUTHENTICATION)>0)){
defrost 31:2846355deb7e 599 // Associated and Authenticated:
defrost 31:2846355deb7e 600 status = 3;
defrost 31:2846355deb7e 601 }else if((ConnectionReg & CC_ASSOCIATION)>0){
defrost 31:2846355deb7e 602 // Associated:
defrost 31:2846355deb7e 603 status = 1;
defrost 31:2846355deb7e 604 }else if((ConnectionReg & CC_AUTHENTICATION)>0){
defrost 31:2846355deb7e 605 // Athenticated:
defrost 31:2846355deb7e 606 status = 2;
defrost 31:2846355deb7e 607 }else{
defrost 31:2846355deb7e 608 // Disconnected:
defrost 31:2846355deb7e 609 status = 0;
defrost 31:2846355deb7e 610 }
defrost 31:2846355deb7e 611 INFO("Wifly Check network response: 0x%x, Status: %d", ConnectionReg, status);
defrost 30:2c704a72d88a 612 exit(); // Quit command mode
defrost 30:2c704a72d88a 613 }
defrost 30:2c704a72d88a 614
defrost 30:2c704a72d88a 615 return status;
samux 1:fb4494783863 616 }