Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependents: M2X_dev axeda_wrapper_dev MTS_M2x_Example1 MTS_Cellular_Connect_Example ... more
wifi/Wifi.cpp@69:f3e696bbb0d5, 2013-12-26 (annotated)
- Committer:
- jengbrecht
- Date:
- Thu Dec 26 14:46:40 2013 +0000
- Revision:
- 69:f3e696bbb0d5
- Child:
- 73:bb5bbca971ae
- Child:
- 74:9f87bd22c222
Added some Wifi support, including getting the connect method to work.
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| jengbrecht | 69:f3e696bbb0d5 | 1 | #include "Wifi.h" |
| jengbrecht | 69:f3e696bbb0d5 | 2 | |
| jengbrecht | 69:f3e696bbb0d5 | 3 | Wifi* Wifi::instance = NULL; |
| jengbrecht | 69:f3e696bbb0d5 | 4 | |
| jengbrecht | 69:f3e696bbb0d5 | 5 | Wifi* Wifi::getInstance() |
| jengbrecht | 69:f3e696bbb0d5 | 6 | { |
| jengbrecht | 69:f3e696bbb0d5 | 7 | if(instance == NULL) { |
| jengbrecht | 69:f3e696bbb0d5 | 8 | instance = new Wifi(NULL); |
| jengbrecht | 69:f3e696bbb0d5 | 9 | } |
| jengbrecht | 69:f3e696bbb0d5 | 10 | return instance; |
| jengbrecht | 69:f3e696bbb0d5 | 11 | } |
| jengbrecht | 69:f3e696bbb0d5 | 12 | |
| jengbrecht | 69:f3e696bbb0d5 | 13 | bool Wifi::init(MTSBufferedIO* io) |
| jengbrecht | 69:f3e696bbb0d5 | 14 | { |
| jengbrecht | 69:f3e696bbb0d5 | 15 | if (io == NULL) { |
| jengbrecht | 69:f3e696bbb0d5 | 16 | return false; |
| jengbrecht | 69:f3e696bbb0d5 | 17 | } |
| jengbrecht | 69:f3e696bbb0d5 | 18 | instance->io = io; |
| jengbrecht | 69:f3e696bbb0d5 | 19 | //sendCommand("$$$", 1000, Cellular::NONE); |
| jengbrecht | 69:f3e696bbb0d5 | 20 | return true; |
| jengbrecht | 69:f3e696bbb0d5 | 21 | } |
| jengbrecht | 69:f3e696bbb0d5 | 22 | |
| jengbrecht | 69:f3e696bbb0d5 | 23 | Wifi::Wifi(MTSBufferedIO* io) |
| jengbrecht | 69:f3e696bbb0d5 | 24 | : io(io) |
| jengbrecht | 69:f3e696bbb0d5 | 25 | , echoMode(true) |
| jengbrecht | 69:f3e696bbb0d5 | 26 | , wifiConnected(false) |
| jengbrecht | 69:f3e696bbb0d5 | 27 | , mode(TCP) |
| jengbrecht | 69:f3e696bbb0d5 | 28 | , socketOpened(false) |
| jengbrecht | 69:f3e696bbb0d5 | 29 | , socketCloseable(true) |
| jengbrecht | 69:f3e696bbb0d5 | 30 | , local_port(0) |
| jengbrecht | 69:f3e696bbb0d5 | 31 | , host_port(0) |
| jengbrecht | 69:f3e696bbb0d5 | 32 | , _ssid("") |
| jengbrecht | 69:f3e696bbb0d5 | 33 | { |
| jengbrecht | 69:f3e696bbb0d5 | 34 | |
| jengbrecht | 69:f3e696bbb0d5 | 35 | } |
| jengbrecht | 69:f3e696bbb0d5 | 36 | |
| jengbrecht | 69:f3e696bbb0d5 | 37 | Wifi::~Wifi() |
| jengbrecht | 69:f3e696bbb0d5 | 38 | { |
| jengbrecht | 69:f3e696bbb0d5 | 39 | } |
| jengbrecht | 69:f3e696bbb0d5 | 40 | |
| jengbrecht | 69:f3e696bbb0d5 | 41 | bool Wifi::connect() |
| jengbrecht | 69:f3e696bbb0d5 | 42 | { |
| jengbrecht | 69:f3e696bbb0d5 | 43 | //Check if socket is open |
| jengbrecht | 69:f3e696bbb0d5 | 44 | if(socketOpened) { |
| jengbrecht | 69:f3e696bbb0d5 | 45 | return true; |
| jengbrecht | 69:f3e696bbb0d5 | 46 | } |
| jengbrecht | 69:f3e696bbb0d5 | 47 | |
| jengbrecht | 69:f3e696bbb0d5 | 48 | //Run Test first to validate a good state |
| jengbrecht | 69:f3e696bbb0d5 | 49 | if(isConnected()) { |
| jengbrecht | 69:f3e696bbb0d5 | 50 | return true; |
| jengbrecht | 69:f3e696bbb0d5 | 51 | } |
| jengbrecht | 69:f3e696bbb0d5 | 52 | |
| jengbrecht | 69:f3e696bbb0d5 | 53 | //Check RSSI: AT+CSQ |
| jengbrecht | 69:f3e696bbb0d5 | 54 | //int rssi = getSignalStrength(); |
| jengbrecht | 69:f3e696bbb0d5 | 55 | //printf("[DEBUG] Signal strength: %d\r\n", rssi); |
| jengbrecht | 69:f3e696bbb0d5 | 56 | |
| jengbrecht | 69:f3e696bbb0d5 | 57 | //Possibly add a scan command here and look for the network.... |
| jengbrecht | 69:f3e696bbb0d5 | 58 | |
| jengbrecht | 69:f3e696bbb0d5 | 59 | printf("Starting Setup\n\r"); |
| jengbrecht | 69:f3e696bbb0d5 | 60 | //Set device to manual infrastructure mode |
| jengbrecht | 69:f3e696bbb0d5 | 61 | if (sendBasicCommand("set wlan join 0", 1000) != Cellular::CELL_OK) { |
| jengbrecht | 69:f3e696bbb0d5 | 62 | return false; |
| jengbrecht | 69:f3e696bbb0d5 | 63 | } |
| jengbrecht | 69:f3e696bbb0d5 | 64 | |
| jengbrecht | 69:f3e696bbb0d5 | 65 | printf("Set Manual Mode\n\r"); |
| jengbrecht | 69:f3e696bbb0d5 | 66 | //Set device to channel auto-scanning mode |
| jengbrecht | 69:f3e696bbb0d5 | 67 | if (sendBasicCommand("set wlan channel 0", 1000) != Cellular::CELL_OK) { |
| jengbrecht | 69:f3e696bbb0d5 | 68 | return false; |
| jengbrecht | 69:f3e696bbb0d5 | 69 | } |
| jengbrecht | 69:f3e696bbb0d5 | 70 | |
| jengbrecht | 69:f3e696bbb0d5 | 71 | //Set device so no data is transmitted immediately following a socket connection |
| jengbrecht | 69:f3e696bbb0d5 | 72 | if (sendBasicCommand("set comm remote 0", 1000) != Cellular::CELL_OK) { |
| jengbrecht | 69:f3e696bbb0d5 | 73 | return false; |
| jengbrecht | 69:f3e696bbb0d5 | 74 | } |
| jengbrecht | 69:f3e696bbb0d5 | 75 | |
| jengbrecht | 69:f3e696bbb0d5 | 76 | //Set device into DHCP mode |
| jengbrecht | 69:f3e696bbb0d5 | 77 | if (sendBasicCommand("set ip dhcp 1", 1000) != Cellular::CELL_OK) { |
| jengbrecht | 69:f3e696bbb0d5 | 78 | return false; |
| jengbrecht | 69:f3e696bbb0d5 | 79 | } |
| jengbrecht | 69:f3e696bbb0d5 | 80 | |
| jengbrecht | 69:f3e696bbb0d5 | 81 | //join my_network |
| jengbrecht | 69:f3e696bbb0d5 | 82 | |
| jengbrecht | 69:f3e696bbb0d5 | 83 | //AT#CONNECTIONSTART: Make a PPP connection |
| jengbrecht | 69:f3e696bbb0d5 | 84 | printf("[DEBUG] Making SSID Connection Attempt. SSID[%s]\r\n", _ssid.c_str()); |
| jengbrecht | 69:f3e696bbb0d5 | 85 | std::string result = sendCommand("join " + _ssid, 10000); |
| jengbrecht | 69:f3e696bbb0d5 | 86 | printf("Connect Status: %s\n\r", result.c_str()); |
| jengbrecht | 69:f3e696bbb0d5 | 87 | //std::string pppResult = sendCommand("AT#CONNECTIONSTART", 120000); |
| jengbrecht | 69:f3e696bbb0d5 | 88 | // std::vector<std::string> parts = Text::split(pppResult, "\r\n"); |
| jengbrecht | 69:f3e696bbb0d5 | 89 | |
| jengbrecht | 69:f3e696bbb0d5 | 90 | /* |
| jengbrecht | 69:f3e696bbb0d5 | 91 | if(pppResult.find("Ok_Info_GprsActivation") != std::string::npos) { |
| jengbrecht | 69:f3e696bbb0d5 | 92 | if(parts.size() >= 2) { |
| jengbrecht | 69:f3e696bbb0d5 | 93 | local_address = parts[1]; |
| jengbrecht | 69:f3e696bbb0d5 | 94 | } |
| jengbrecht | 69:f3e696bbb0d5 | 95 | printf("[INFO] PPP Connection Established: IP[%s]\r\n", local_address.c_str()); |
| jengbrecht | 69:f3e696bbb0d5 | 96 | pppConnected = true; |
| jengbrecht | 69:f3e696bbb0d5 | 97 | |
| jengbrecht | 69:f3e696bbb0d5 | 98 | } else { |
| jengbrecht | 69:f3e696bbb0d5 | 99 | pppConnected = false; |
| jengbrecht | 69:f3e696bbb0d5 | 100 | } |
| jengbrecht | 69:f3e696bbb0d5 | 101 | */ |
| jengbrecht | 69:f3e696bbb0d5 | 102 | |
| jengbrecht | 69:f3e696bbb0d5 | 103 | wifiConnected = true; |
| jengbrecht | 69:f3e696bbb0d5 | 104 | return wifiConnected; |
| jengbrecht | 69:f3e696bbb0d5 | 105 | } |
| jengbrecht | 69:f3e696bbb0d5 | 106 | |
| jengbrecht | 69:f3e696bbb0d5 | 107 | void Wifi::disconnect() |
| jengbrecht | 69:f3e696bbb0d5 | 108 | { |
| jengbrecht | 69:f3e696bbb0d5 | 109 | } |
| jengbrecht | 69:f3e696bbb0d5 | 110 | |
| jengbrecht | 69:f3e696bbb0d5 | 111 | bool Wifi::isConnected() |
| jengbrecht | 69:f3e696bbb0d5 | 112 | { |
| jengbrecht | 69:f3e696bbb0d5 | 113 | return false; |
| jengbrecht | 69:f3e696bbb0d5 | 114 | } |
| jengbrecht | 69:f3e696bbb0d5 | 115 | |
| jengbrecht | 69:f3e696bbb0d5 | 116 | bool Wifi::bind(unsigned int port) |
| jengbrecht | 69:f3e696bbb0d5 | 117 | { |
| jengbrecht | 69:f3e696bbb0d5 | 118 | return true; |
| jengbrecht | 69:f3e696bbb0d5 | 119 | } |
| jengbrecht | 69:f3e696bbb0d5 | 120 | |
| jengbrecht | 69:f3e696bbb0d5 | 121 | bool Wifi::open(const std::string& address, unsigned int port, Mode mode) |
| jengbrecht | 69:f3e696bbb0d5 | 122 | { |
| jengbrecht | 69:f3e696bbb0d5 | 123 | //set comm size??? are advanced Socket settings |
| jengbrecht | 69:f3e696bbb0d5 | 124 | //set comm time??? are advanced Socket settings |
| jengbrecht | 69:f3e696bbb0d5 | 125 | return true; |
| jengbrecht | 69:f3e696bbb0d5 | 126 | } |
| jengbrecht | 69:f3e696bbb0d5 | 127 | |
| jengbrecht | 69:f3e696bbb0d5 | 128 | bool Wifi::isOpen() |
| jengbrecht | 69:f3e696bbb0d5 | 129 | { |
| jengbrecht | 69:f3e696bbb0d5 | 130 | return true; |
| jengbrecht | 69:f3e696bbb0d5 | 131 | } |
| jengbrecht | 69:f3e696bbb0d5 | 132 | |
| jengbrecht | 69:f3e696bbb0d5 | 133 | bool Wifi::close() |
| jengbrecht | 69:f3e696bbb0d5 | 134 | { |
| jengbrecht | 69:f3e696bbb0d5 | 135 | return true; |
| jengbrecht | 69:f3e696bbb0d5 | 136 | } |
| jengbrecht | 69:f3e696bbb0d5 | 137 | |
| jengbrecht | 69:f3e696bbb0d5 | 138 | int Wifi::read(char* data, int max, int timeout) |
| jengbrecht | 69:f3e696bbb0d5 | 139 | { |
| jengbrecht | 69:f3e696bbb0d5 | 140 | return 0; |
| jengbrecht | 69:f3e696bbb0d5 | 141 | } |
| jengbrecht | 69:f3e696bbb0d5 | 142 | |
| jengbrecht | 69:f3e696bbb0d5 | 143 | int Wifi::write(const char* data, int length, int timeout) |
| jengbrecht | 69:f3e696bbb0d5 | 144 | { |
| jengbrecht | 69:f3e696bbb0d5 | 145 | return 0; |
| jengbrecht | 69:f3e696bbb0d5 | 146 | } |
| jengbrecht | 69:f3e696bbb0d5 | 147 | |
| jengbrecht | 69:f3e696bbb0d5 | 148 | unsigned int Wifi::readable() |
| jengbrecht | 69:f3e696bbb0d5 | 149 | { |
| jengbrecht | 69:f3e696bbb0d5 | 150 | if(io == NULL) { |
| jengbrecht | 69:f3e696bbb0d5 | 151 | printf("[ERROR] MTSBufferedIO not set\r\n"); |
| jengbrecht | 69:f3e696bbb0d5 | 152 | return 0; |
| jengbrecht | 69:f3e696bbb0d5 | 153 | } |
| jengbrecht | 69:f3e696bbb0d5 | 154 | if(!socketOpened) { |
| jengbrecht | 69:f3e696bbb0d5 | 155 | printf("[ERROR] Socket is not open\r\n"); |
| jengbrecht | 69:f3e696bbb0d5 | 156 | return 0; |
| jengbrecht | 69:f3e696bbb0d5 | 157 | } |
| jengbrecht | 69:f3e696bbb0d5 | 158 | return io->readable(); |
| jengbrecht | 69:f3e696bbb0d5 | 159 | } |
| jengbrecht | 69:f3e696bbb0d5 | 160 | |
| jengbrecht | 69:f3e696bbb0d5 | 161 | unsigned int Wifi::writeable() |
| jengbrecht | 69:f3e696bbb0d5 | 162 | { |
| jengbrecht | 69:f3e696bbb0d5 | 163 | if(io == NULL) { |
| jengbrecht | 69:f3e696bbb0d5 | 164 | printf("[ERROR] MTSBufferedIO not set\r\n"); |
| jengbrecht | 69:f3e696bbb0d5 | 165 | return 0; |
| jengbrecht | 69:f3e696bbb0d5 | 166 | } |
| jengbrecht | 69:f3e696bbb0d5 | 167 | if(!socketOpened) { |
| jengbrecht | 69:f3e696bbb0d5 | 168 | printf("[ERROR] Socket is not open\r\n"); |
| jengbrecht | 69:f3e696bbb0d5 | 169 | return 0; |
| jengbrecht | 69:f3e696bbb0d5 | 170 | } |
| jengbrecht | 69:f3e696bbb0d5 | 171 | |
| jengbrecht | 69:f3e696bbb0d5 | 172 | return io->writeable(); |
| jengbrecht | 69:f3e696bbb0d5 | 173 | } |
| jengbrecht | 69:f3e696bbb0d5 | 174 | |
| jengbrecht | 69:f3e696bbb0d5 | 175 | void Wifi::reset() |
| jengbrecht | 69:f3e696bbb0d5 | 176 | { |
| jengbrecht | 69:f3e696bbb0d5 | 177 | } |
| jengbrecht | 69:f3e696bbb0d5 | 178 | |
| jengbrecht | 69:f3e696bbb0d5 | 179 | Cellular::Code Wifi::echo(bool state) |
| jengbrecht | 69:f3e696bbb0d5 | 180 | { |
| jengbrecht | 69:f3e696bbb0d5 | 181 | //Code code; |
| jengbrecht | 69:f3e696bbb0d5 | 182 | if (state) { |
| jengbrecht | 69:f3e696bbb0d5 | 183 | //code = sendBasicCommand("ATE0", 1000); |
| jengbrecht | 69:f3e696bbb0d5 | 184 | //set uart mode 1 - Disabled |
| jengbrecht | 69:f3e696bbb0d5 | 185 | //echoMode = (code == CELL_OK) ? false : echoMode; |
| jengbrecht | 69:f3e696bbb0d5 | 186 | } else { |
| jengbrecht | 69:f3e696bbb0d5 | 187 | //code = sendBasicCommand("ATE1", 1000); |
| jengbrecht | 69:f3e696bbb0d5 | 188 | //set uart mode 0 - Enabled |
| jengbrecht | 69:f3e696bbb0d5 | 189 | //echoMode = (code == CELL_OK) ? true : echoMode; |
| jengbrecht | 69:f3e696bbb0d5 | 190 | } |
| jengbrecht | 69:f3e696bbb0d5 | 191 | return Cellular::CELL_OK; |
| jengbrecht | 69:f3e696bbb0d5 | 192 | } |
| jengbrecht | 69:f3e696bbb0d5 | 193 | |
| jengbrecht | 69:f3e696bbb0d5 | 194 | Cellular::Code Wifi::setNetwork(const std::string& ssid, const std::string& key, SecurityType type) |
| jengbrecht | 69:f3e696bbb0d5 | 195 | { |
| jengbrecht | 69:f3e696bbb0d5 | 196 | Cellular::Code code; |
| jengbrecht | 69:f3e696bbb0d5 | 197 | |
| jengbrecht | 69:f3e696bbb0d5 | 198 | //Set the appropraite SSID |
| jengbrecht | 69:f3e696bbb0d5 | 199 | code = sendBasicCommand("set wlan ssid " + ssid, 1000); |
| jengbrecht | 69:f3e696bbb0d5 | 200 | if (code != Cellular::CELL_OK) { |
| jengbrecht | 69:f3e696bbb0d5 | 201 | return code; |
| jengbrecht | 69:f3e696bbb0d5 | 202 | } |
| jengbrecht | 69:f3e696bbb0d5 | 203 | |
| jengbrecht | 69:f3e696bbb0d5 | 204 | //Set the security key |
| jengbrecht | 69:f3e696bbb0d5 | 205 | if (type == WEP64 || type == WEP128) { |
| jengbrecht | 69:f3e696bbb0d5 | 206 | //Set the WEP key if using WEP encryption |
| jengbrecht | 69:f3e696bbb0d5 | 207 | code = sendBasicCommand("set wlan key " + key, 1000); |
| jengbrecht | 69:f3e696bbb0d5 | 208 | if (code != Cellular::CELL_OK) { |
| jengbrecht | 69:f3e696bbb0d5 | 209 | return code; |
| jengbrecht | 69:f3e696bbb0d5 | 210 | } |
| jengbrecht | 69:f3e696bbb0d5 | 211 | } else if (type == WPA || type == WPA2) { |
| jengbrecht | 69:f3e696bbb0d5 | 212 | //Set the WPA key if using WPA encryption |
| jengbrecht | 69:f3e696bbb0d5 | 213 | code = sendBasicCommand("set wlan phrase " + key, 1000); |
| jengbrecht | 69:f3e696bbb0d5 | 214 | if (code != Cellular::CELL_OK) { |
| jengbrecht | 69:f3e696bbb0d5 | 215 | return code; |
| jengbrecht | 69:f3e696bbb0d5 | 216 | } |
| jengbrecht | 69:f3e696bbb0d5 | 217 | } |
| jengbrecht | 69:f3e696bbb0d5 | 218 | |
| jengbrecht | 69:f3e696bbb0d5 | 219 | _ssid = ssid; |
| jengbrecht | 69:f3e696bbb0d5 | 220 | return Cellular::CELL_OK; |
| jengbrecht | 69:f3e696bbb0d5 | 221 | } |
| jengbrecht | 69:f3e696bbb0d5 | 222 | |
| jengbrecht | 69:f3e696bbb0d5 | 223 | int Wifi::getSignalStrength() |
| jengbrecht | 69:f3e696bbb0d5 | 224 | { |
| jengbrecht | 69:f3e696bbb0d5 | 225 | //show rssi |
| jengbrecht | 69:f3e696bbb0d5 | 226 | return 0; |
| jengbrecht | 69:f3e696bbb0d5 | 227 | } |
| jengbrecht | 69:f3e696bbb0d5 | 228 | |
| jengbrecht | 69:f3e696bbb0d5 | 229 | |
| jengbrecht | 69:f3e696bbb0d5 | 230 | |
| jengbrecht | 69:f3e696bbb0d5 | 231 | Cellular::Code Wifi::sendBasicCommand(string command, int timeoutMillis, Cellular::ESC_CHAR esc) |
| jengbrecht | 69:f3e696bbb0d5 | 232 | { |
| jengbrecht | 69:f3e696bbb0d5 | 233 | if(socketOpened) { |
| jengbrecht | 69:f3e696bbb0d5 | 234 | printf("[ERROR] socket is open. Can not send AT commands\r\n"); |
| jengbrecht | 69:f3e696bbb0d5 | 235 | return Cellular::CELL_ERROR; |
| jengbrecht | 69:f3e696bbb0d5 | 236 | } |
| jengbrecht | 69:f3e696bbb0d5 | 237 | |
| jengbrecht | 69:f3e696bbb0d5 | 238 | string response = sendCommand(command, timeoutMillis, esc); |
| jengbrecht | 69:f3e696bbb0d5 | 239 | //printf("Response: %s\n\r", response.c_str()); |
| jengbrecht | 69:f3e696bbb0d5 | 240 | if (response.size() == 0) { |
| jengbrecht | 69:f3e696bbb0d5 | 241 | return Cellular::CELL_NO_RESPONSE; |
| jengbrecht | 69:f3e696bbb0d5 | 242 | } else if (response.find("AOK") != string::npos) { |
| jengbrecht | 69:f3e696bbb0d5 | 243 | return Cellular::CELL_OK; |
| jengbrecht | 69:f3e696bbb0d5 | 244 | } else if (response.find("ERR") != string::npos) { |
| jengbrecht | 69:f3e696bbb0d5 | 245 | return Cellular::CELL_ERROR; |
| jengbrecht | 69:f3e696bbb0d5 | 246 | } else { |
| jengbrecht | 69:f3e696bbb0d5 | 247 | return Cellular::CELL_FAILURE; |
| jengbrecht | 69:f3e696bbb0d5 | 248 | } |
| jengbrecht | 69:f3e696bbb0d5 | 249 | } |
| jengbrecht | 69:f3e696bbb0d5 | 250 | |
| jengbrecht | 69:f3e696bbb0d5 | 251 | string Wifi::sendCommand(string command, int timeoutMillis, Cellular::ESC_CHAR esc) |
| jengbrecht | 69:f3e696bbb0d5 | 252 | { |
| jengbrecht | 69:f3e696bbb0d5 | 253 | if(io == NULL) { |
| jengbrecht | 69:f3e696bbb0d5 | 254 | printf("[ERROR] MTSBufferedIO not set\r\n"); |
| jengbrecht | 69:f3e696bbb0d5 | 255 | return ""; |
| jengbrecht | 69:f3e696bbb0d5 | 256 | } |
| jengbrecht | 69:f3e696bbb0d5 | 257 | if(socketOpened) { |
| jengbrecht | 69:f3e696bbb0d5 | 258 | printf("[ERROR] socket is open. Can not send AT commands\r\n"); |
| jengbrecht | 69:f3e696bbb0d5 | 259 | return ""; |
| jengbrecht | 69:f3e696bbb0d5 | 260 | } |
| jengbrecht | 69:f3e696bbb0d5 | 261 | |
| jengbrecht | 69:f3e696bbb0d5 | 262 | int size = command.size() + 1; |
| jengbrecht | 69:f3e696bbb0d5 | 263 | char cmd[size]; |
| jengbrecht | 69:f3e696bbb0d5 | 264 | strcpy(cmd, command.c_str()); |
| jengbrecht | 69:f3e696bbb0d5 | 265 | if (esc == Cellular::CR) { |
| jengbrecht | 69:f3e696bbb0d5 | 266 | cmd[size -1] = '\r'; |
| jengbrecht | 69:f3e696bbb0d5 | 267 | } else if (esc == Cellular::CTRL_Z) { |
| jengbrecht | 69:f3e696bbb0d5 | 268 | cmd[size -1] = 0x1A; |
| jengbrecht | 69:f3e696bbb0d5 | 269 | } else if(esc == NONE) { |
| jengbrecht | 69:f3e696bbb0d5 | 270 | cmd[size -1] = '\0'; |
| jengbrecht | 69:f3e696bbb0d5 | 271 | } |
| jengbrecht | 69:f3e696bbb0d5 | 272 | |
| jengbrecht | 69:f3e696bbb0d5 | 273 | io->rxClear(); |
| jengbrecht | 69:f3e696bbb0d5 | 274 | io->txClear(); |
| jengbrecht | 69:f3e696bbb0d5 | 275 | std::string result; |
| jengbrecht | 69:f3e696bbb0d5 | 276 | int status = io->write(cmd, size); |
| jengbrecht | 69:f3e696bbb0d5 | 277 | int available = io->readable(); |
| jengbrecht | 69:f3e696bbb0d5 | 278 | int previous = -1; |
| jengbrecht | 69:f3e696bbb0d5 | 279 | int timer = 0; |
| jengbrecht | 69:f3e696bbb0d5 | 280 | char tmp[256]; |
| jengbrecht | 69:f3e696bbb0d5 | 281 | tmp[255] = 0; |
| jengbrecht | 69:f3e696bbb0d5 | 282 | bool started = !echoMode; |
| jengbrecht | 69:f3e696bbb0d5 | 283 | bool done = false; |
| jengbrecht | 69:f3e696bbb0d5 | 284 | do { |
| jengbrecht | 69:f3e696bbb0d5 | 285 | wait(.1); |
| jengbrecht | 69:f3e696bbb0d5 | 286 | timer = timer + 100; |
| jengbrecht | 69:f3e696bbb0d5 | 287 | previous = available; |
| jengbrecht | 69:f3e696bbb0d5 | 288 | available = io->readable(); |
| jengbrecht | 69:f3e696bbb0d5 | 289 | |
| jengbrecht | 69:f3e696bbb0d5 | 290 | int size = io->read(tmp,255); //1 less than allocated |
| jengbrecht | 69:f3e696bbb0d5 | 291 | if(size > 0) { |
| jengbrecht | 69:f3e696bbb0d5 | 292 | result.append(tmp, size); |
| jengbrecht | 69:f3e696bbb0d5 | 293 | } |
| jengbrecht | 69:f3e696bbb0d5 | 294 | |
| jengbrecht | 69:f3e696bbb0d5 | 295 | if(!started) { |
| jengbrecht | 69:f3e696bbb0d5 | 296 | //In Echo Mode (Command will have echo'd + 2 characters for \r\n) |
| jengbrecht | 69:f3e696bbb0d5 | 297 | if(result.size() > command.size() + 2) { |
| jengbrecht | 69:f3e696bbb0d5 | 298 | started = true; |
| jengbrecht | 69:f3e696bbb0d5 | 299 | } |
| jengbrecht | 69:f3e696bbb0d5 | 300 | } else { |
| jengbrecht | 69:f3e696bbb0d5 | 301 | done = (available == previous); |
| jengbrecht | 69:f3e696bbb0d5 | 302 | } |
| jengbrecht | 69:f3e696bbb0d5 | 303 | if(timer >= timeoutMillis) { |
| jengbrecht | 69:f3e696bbb0d5 | 304 | printf("[WARNING] sendCommand timed out after %d milliseconds\r\n", timeoutMillis); |
| jengbrecht | 69:f3e696bbb0d5 | 305 | done = true; |
| jengbrecht | 69:f3e696bbb0d5 | 306 | } |
| jengbrecht | 69:f3e696bbb0d5 | 307 | } while (!done); |
| jengbrecht | 69:f3e696bbb0d5 | 308 | |
| jengbrecht | 69:f3e696bbb0d5 | 309 | return result; |
| jengbrecht | 69:f3e696bbb0d5 | 310 | } |
uIP Socket Modem Shield (Outdated - see below)