FRDM-K64F, Avnet M14A2A, Grove Shield, to create smart home system. In use with AT&Ts M2x & Flow.
Dependencies: mbed FXOS8700CQ MODSERIAL
wnc_control.cpp@32:1e052a3e73fe, 2016-07-22 (annotated)
- Committer:
- fkellermavnet
- Date:
- Fri Jul 22 16:22:17 2016 +0000
- Revision:
- 32:1e052a3e73fe
- Parent:
- 30:33be8e2992f3
- Child:
- 34:1a4498e3580e
Removed in between character delays when talking to the WNC.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
JMF | 2:0e2ef866af95 | 1 | #include "mbed.h" |
JMF | 2:0e2ef866af95 | 2 | #include <cctype> |
JMF | 2:0e2ef866af95 | 3 | #include <string> |
JMF | 2:0e2ef866af95 | 4 | #include "config_me.h" |
JMF | 2:0e2ef866af95 | 5 | #include "SerialBuffered.h" |
JMF | 2:0e2ef866af95 | 6 | #include "wnc_control.h" |
JMF | 2:0e2ef866af95 | 7 | |
JMF | 2:0e2ef866af95 | 8 | extern Serial pc; |
JMF | 2:0e2ef866af95 | 9 | extern Serial mdm; |
JMF | 2:0e2ef866af95 | 10 | extern string MyServerIpAddress; |
JMF | 2:0e2ef866af95 | 11 | extern string MySocketData; |
JMF | 2:0e2ef866af95 | 12 | |
JMF | 2:0e2ef866af95 | 13 | int reinitialize_mdm(void); |
JMF | 2:0e2ef866af95 | 14 | |
JMF | 2:0e2ef866af95 | 15 | enum WNC_ERR_e { |
JMF | 2:0e2ef866af95 | 16 | WNC_OK =0, |
JMF | 2:0e2ef866af95 | 17 | WNC_CMD_ERR = -1, |
JMF | 2:0e2ef866af95 | 18 | WNC_NO_RESPONSE = -2 |
JMF | 2:0e2ef866af95 | 19 | }; |
JMF | 2:0e2ef866af95 | 20 | |
JMF | 2:0e2ef866af95 | 21 | // Contains result of last call to send_wnc_cmd(..) |
JMF | 2:0e2ef866af95 | 22 | WNC_ERR_e WNC_MDM_ERR = WNC_OK; |
JMF | 2:0e2ef866af95 | 23 | |
JMF | 2:0e2ef866af95 | 24 | // Contains the RAW WNC UART responses |
JMF | 2:0e2ef866af95 | 25 | static string wncStr; |
fkellermavnet | 10:df54436ecd38 | 26 | static int socketOpen = 0; |
JMF | 2:0e2ef866af95 | 27 | |
JMF | 2:0e2ef866af95 | 28 | void software_init_mdm(void) |
JMF | 2:0e2ef866af95 | 29 | { |
JMF | 2:0e2ef866af95 | 30 | do |
JMF | 2:0e2ef866af95 | 31 | { |
JMF | 2:0e2ef866af95 | 32 | WNC_MDM_ERR = WNC_OK; |
JMF | 2:0e2ef866af95 | 33 | at_init_wnc(); |
fkellermavnet | 30:33be8e2992f3 | 34 | if (WNC_MDM_ERR == WNC_NO_RESPONSE) |
JMF | 2:0e2ef866af95 | 35 | reinitialize_mdm(); |
JMF | 2:0e2ef866af95 | 36 | } while (WNC_MDM_ERR != WNC_OK); |
JMF | 2:0e2ef866af95 | 37 | } |
JMF | 2:0e2ef866af95 | 38 | |
JMF | 2:0e2ef866af95 | 39 | void resolve_mdm(void) |
JMF | 2:0e2ef866af95 | 40 | { |
JMF | 2:0e2ef866af95 | 41 | do |
JMF | 2:0e2ef866af95 | 42 | { |
JMF | 2:0e2ef866af95 | 43 | WNC_MDM_ERR = WNC_OK; |
JMF | 2:0e2ef866af95 | 44 | at_dnsresolve_wnc(MY_SERVER_URL, &MyServerIpAddress); |
JMF | 2:0e2ef866af95 | 45 | if (WNC_MDM_ERR == WNC_NO_RESPONSE) |
JMF | 2:0e2ef866af95 | 46 | { |
JMF | 2:0e2ef866af95 | 47 | reinitialize_mdm(); |
JMF | 2:0e2ef866af95 | 48 | software_init_mdm(); |
JMF | 2:0e2ef866af95 | 49 | } |
JMF | 2:0e2ef866af95 | 50 | else if (WNC_MDM_ERR == WNC_CMD_ERR) |
JMF | 2:0e2ef866af95 | 51 | { |
JMF | 2:0e2ef866af95 | 52 | pc.puts("Bad URL!!!!!!\r\n"); |
JMF | 2:0e2ef866af95 | 53 | MyServerIpAddress = "192.168.0.1"; |
JMF | 2:0e2ef866af95 | 54 | WNC_MDM_ERR = WNC_OK; |
JMF | 2:0e2ef866af95 | 55 | } |
JMF | 2:0e2ef866af95 | 56 | } while (WNC_MDM_ERR != WNC_OK); |
JMF | 2:0e2ef866af95 | 57 | |
fkellermavnet | 30:33be8e2992f3 | 58 | pc.printf("My Server IP: %s\r\n", MyServerIpAddress.c_str()); |
JMF | 2:0e2ef866af95 | 59 | } |
JMF | 2:0e2ef866af95 | 60 | |
JMF | 2:0e2ef866af95 | 61 | void sockopen_mdm(void) |
JMF | 2:0e2ef866af95 | 62 | { |
JMF | 2:0e2ef866af95 | 63 | do |
JMF | 2:0e2ef866af95 | 64 | { |
fkellermavnet | 19:f89baed3bd6f | 65 | at_at_wnc(); |
fkellermavnet | 19:f89baed3bd6f | 66 | at_at_wnc(); |
JMF | 2:0e2ef866af95 | 67 | WNC_MDM_ERR = WNC_OK; |
JMF | 2:0e2ef866af95 | 68 | at_sockopen_wnc(MyServerIpAddress, MY_PORT_STR); |
JMF | 2:0e2ef866af95 | 69 | if (WNC_MDM_ERR == WNC_NO_RESPONSE) |
JMF | 2:0e2ef866af95 | 70 | { |
JMF | 2:0e2ef866af95 | 71 | reinitialize_mdm(); |
JMF | 2:0e2ef866af95 | 72 | software_init_mdm(); |
JMF | 2:0e2ef866af95 | 73 | } |
JMF | 2:0e2ef866af95 | 74 | else if (WNC_MDM_ERR == WNC_CMD_ERR) |
JMF | 2:0e2ef866af95 | 75 | pc.puts("Socket open fail!!!!\r\n"); |
fkellermavnet | 10:df54436ecd38 | 76 | else |
fkellermavnet | 10:df54436ecd38 | 77 | socketOpen = 1; |
JMF | 2:0e2ef866af95 | 78 | } while (WNC_MDM_ERR != WNC_OK); |
JMF | 2:0e2ef866af95 | 79 | } |
JMF | 2:0e2ef866af95 | 80 | |
JMF | 2:0e2ef866af95 | 81 | void sockwrite_mdm(const char * s) |
JMF | 2:0e2ef866af95 | 82 | { |
fkellermavnet | 10:df54436ecd38 | 83 | if (socketOpen == 1) |
fkellermavnet | 10:df54436ecd38 | 84 | { |
JMF | 2:0e2ef866af95 | 85 | do |
JMF | 2:0e2ef866af95 | 86 | { |
JMF | 2:0e2ef866af95 | 87 | WNC_MDM_ERR = WNC_OK; |
JMF | 2:0e2ef866af95 | 88 | at_sockwrite_wnc(s); |
JMF | 2:0e2ef866af95 | 89 | if (WNC_MDM_ERR == WNC_NO_RESPONSE) |
JMF | 2:0e2ef866af95 | 90 | { |
JMF | 2:0e2ef866af95 | 91 | reinitialize_mdm(); |
JMF | 2:0e2ef866af95 | 92 | software_init_mdm(); |
JMF | 2:0e2ef866af95 | 93 | } |
JMF | 2:0e2ef866af95 | 94 | else if (WNC_MDM_ERR == WNC_CMD_ERR) |
JMF | 2:0e2ef866af95 | 95 | { |
JMF | 2:0e2ef866af95 | 96 | pc.puts("Socket Write fail!!!\r\n"); |
JMF | 2:0e2ef866af95 | 97 | // Have seen when write fails modem gets stuck in bad state, try to recover |
JMF | 2:0e2ef866af95 | 98 | reinitialize_mdm(); |
JMF | 2:0e2ef866af95 | 99 | software_init_mdm(); |
JMF | 2:0e2ef866af95 | 100 | } |
JMF | 2:0e2ef866af95 | 101 | } while (WNC_MDM_ERR != WNC_OK); |
fkellermavnet | 10:df54436ecd38 | 102 | } |
fkellermavnet | 10:df54436ecd38 | 103 | else |
fkellermavnet | 10:df54436ecd38 | 104 | puts("Socket is closed for write!\r\n"); |
JMF | 2:0e2ef866af95 | 105 | } |
JMF | 2:0e2ef866af95 | 106 | |
fkellermavnet | 30:33be8e2992f3 | 107 | unsigned sockread_mdm(string * sockData, int len, int retries) |
JMF | 2:0e2ef866af95 | 108 | { |
fkellermavnet | 30:33be8e2992f3 | 109 | unsigned n = 0; |
fkellermavnet | 30:33be8e2992f3 | 110 | |
fkellermavnet | 30:33be8e2992f3 | 111 | // Clean slate: |
fkellermavnet | 30:33be8e2992f3 | 112 | sockData->erase(); |
fkellermavnet | 30:33be8e2992f3 | 113 | |
fkellermavnet | 10:df54436ecd38 | 114 | if (socketOpen == 1) |
fkellermavnet | 10:df54436ecd38 | 115 | { |
JMF | 2:0e2ef866af95 | 116 | do |
JMF | 2:0e2ef866af95 | 117 | { |
JMF | 2:0e2ef866af95 | 118 | WNC_MDM_ERR = WNC_OK; |
fkellermavnet | 30:33be8e2992f3 | 119 | n = at_sockread_wnc(sockData, len, retries); |
JMF | 2:0e2ef866af95 | 120 | if (WNC_MDM_ERR == WNC_NO_RESPONSE) |
JMF | 2:0e2ef866af95 | 121 | { |
fkellermavnet | 30:33be8e2992f3 | 122 | if (n == 0) |
fkellermavnet | 30:33be8e2992f3 | 123 | { |
fkellermavnet | 30:33be8e2992f3 | 124 | reinitialize_mdm(); |
fkellermavnet | 30:33be8e2992f3 | 125 | software_init_mdm(); |
fkellermavnet | 30:33be8e2992f3 | 126 | } |
fkellermavnet | 30:33be8e2992f3 | 127 | else |
fkellermavnet | 30:33be8e2992f3 | 128 | puts("Sock read partial data!!!\r\n"); |
JMF | 2:0e2ef866af95 | 129 | } |
JMF | 2:0e2ef866af95 | 130 | else if (WNC_MDM_ERR == WNC_CMD_ERR) |
JMF | 2:0e2ef866af95 | 131 | puts("Sock read fail!!!!\r\n"); |
fkellermavnet | 30:33be8e2992f3 | 132 | } while (WNC_MDM_ERR == WNC_NO_RESPONSE); |
fkellermavnet | 10:df54436ecd38 | 133 | } |
fkellermavnet | 10:df54436ecd38 | 134 | else |
fkellermavnet | 10:df54436ecd38 | 135 | puts("Socket is closed for read\r\n"); |
fkellermavnet | 30:33be8e2992f3 | 136 | |
fkellermavnet | 30:33be8e2992f3 | 137 | return (n); |
JMF | 2:0e2ef866af95 | 138 | } |
JMF | 2:0e2ef866af95 | 139 | |
JMF | 2:0e2ef866af95 | 140 | void sockclose_mdm(void) |
JMF | 2:0e2ef866af95 | 141 | { |
JMF | 2:0e2ef866af95 | 142 | do |
JMF | 2:0e2ef866af95 | 143 | { |
JMF | 2:0e2ef866af95 | 144 | WNC_MDM_ERR = WNC_OK; |
JMF | 2:0e2ef866af95 | 145 | at_sockclose_wnc(); |
fkellermavnet | 10:df54436ecd38 | 146 | // Assume close happened even if it went bad |
fkellermavnet | 10:df54436ecd38 | 147 | // going bad will result in a re-init anyways and if close |
fkellermavnet | 10:df54436ecd38 | 148 | // fails we're pretty much in bad state and not much can do |
fkellermavnet | 10:df54436ecd38 | 149 | socketOpen = 0; |
JMF | 2:0e2ef866af95 | 150 | if (WNC_MDM_ERR == WNC_NO_RESPONSE) |
JMF | 2:0e2ef866af95 | 151 | { |
JMF | 2:0e2ef866af95 | 152 | reinitialize_mdm(); |
JMF | 2:0e2ef866af95 | 153 | software_init_mdm(); |
JMF | 2:0e2ef866af95 | 154 | } |
JMF | 2:0e2ef866af95 | 155 | else if (WNC_MDM_ERR == WNC_CMD_ERR) |
JMF | 2:0e2ef866af95 | 156 | puts("Sock close fail!!!\r\n"); |
JMF | 2:0e2ef866af95 | 157 | } while (WNC_MDM_ERR != WNC_OK); |
JMF | 2:0e2ef866af95 | 158 | } |
JMF | 2:0e2ef866af95 | 159 | |
JMF | 2:0e2ef866af95 | 160 | /** |
JMF | 2:0e2ef866af95 | 161 | * C++ version 0.4 char* style "itoa": |
JMF | 2:0e2ef866af95 | 162 | * Written by Lukás Chmela |
JMF | 2:0e2ef866af95 | 163 | * Released under GPLv3. |
JMF | 2:0e2ef866af95 | 164 | */ |
JMF | 2:0e2ef866af95 | 165 | |
JMF | 2:0e2ef866af95 | 166 | char* itoa(int value, char* result, int base) |
JMF | 2:0e2ef866af95 | 167 | { |
JMF | 2:0e2ef866af95 | 168 | // check that the base if valid |
JMF | 2:0e2ef866af95 | 169 | if ( base < 2 || base > 36 ) { |
JMF | 2:0e2ef866af95 | 170 | *result = '\0'; |
JMF | 2:0e2ef866af95 | 171 | return result; |
JMF | 2:0e2ef866af95 | 172 | } |
JMF | 2:0e2ef866af95 | 173 | |
JMF | 2:0e2ef866af95 | 174 | char* ptr = result, *ptr1 = result, tmp_char; |
JMF | 2:0e2ef866af95 | 175 | int tmp_value; |
JMF | 2:0e2ef866af95 | 176 | |
JMF | 2:0e2ef866af95 | 177 | do { |
JMF | 2:0e2ef866af95 | 178 | tmp_value = value; |
JMF | 2:0e2ef866af95 | 179 | value /= base; |
JMF | 2:0e2ef866af95 | 180 | *ptr++ = "zyxwvutsrqponmlkjihgfedcba9876543210123456789abcdefghijklmnopqrstuvwxyz"[35 + (tmp_value - value * base)]; |
JMF | 2:0e2ef866af95 | 181 | } while ( value ); |
JMF | 2:0e2ef866af95 | 182 | |
JMF | 2:0e2ef866af95 | 183 | // Apply negative sign |
JMF | 2:0e2ef866af95 | 184 | if ( tmp_value < 0 ) |
JMF | 2:0e2ef866af95 | 185 | *ptr++ = '-'; |
JMF | 2:0e2ef866af95 | 186 | *ptr-- = '\0'; |
JMF | 2:0e2ef866af95 | 187 | |
JMF | 2:0e2ef866af95 | 188 | while ( ptr1 < ptr ) { |
JMF | 2:0e2ef866af95 | 189 | tmp_char = *ptr; |
JMF | 2:0e2ef866af95 | 190 | *ptr-- = *ptr1; |
JMF | 2:0e2ef866af95 | 191 | *ptr1++ = tmp_char; |
JMF | 2:0e2ef866af95 | 192 | } |
JMF | 2:0e2ef866af95 | 193 | |
JMF | 2:0e2ef866af95 | 194 | return result; |
JMF | 2:0e2ef866af95 | 195 | } |
JMF | 2:0e2ef866af95 | 196 | |
JMF | 2:0e2ef866af95 | 197 | extern int mdm_sendAtCmdRsp(const char *cmd, const char **rsp_list, int timeout_ms, string * rsp, int * len); |
JMF | 2:0e2ef866af95 | 198 | |
JMF | 2:0e2ef866af95 | 199 | // Sets a global with failure or success, assumes 1 thread all the time |
JMF | 2:0e2ef866af95 | 200 | int send_wnc_cmd(const char * s, string ** r, int ms_timeout) |
JMF | 2:0e2ef866af95 | 201 | { |
JMF | 2:0e2ef866af95 | 202 | static const char * rsp_lst[] = { "OK", "ERROR", NULL }; |
JMF | 2:0e2ef866af95 | 203 | int len; |
JMF | 2:0e2ef866af95 | 204 | |
JMF | 2:0e2ef866af95 | 205 | pc.printf("Send: %s\r\n",s); |
JMF | 2:0e2ef866af95 | 206 | int res = mdm_sendAtCmdRsp(s, rsp_lst, ms_timeout, &wncStr, &len); |
JMF | 2:0e2ef866af95 | 207 | *r = &wncStr; // Return a pointer to the static string |
JMF | 2:0e2ef866af95 | 208 | |
JMF | 2:0e2ef866af95 | 209 | if (res >= 0) |
JMF | 2:0e2ef866af95 | 210 | { |
JMF | 2:0e2ef866af95 | 211 | pc.puts("["); |
fkellermavnet | 30:33be8e2992f3 | 212 | pc.puts(wncStr.c_str()); |
JMF | 2:0e2ef866af95 | 213 | pc.puts("]\n\r"); |
JMF | 2:0e2ef866af95 | 214 | if (res > 0) |
JMF | 2:0e2ef866af95 | 215 | { |
JMF | 2:0e2ef866af95 | 216 | if (WNC_MDM_ERR != WNC_NO_RESPONSE) |
JMF | 2:0e2ef866af95 | 217 | WNC_MDM_ERR = WNC_CMD_ERR; |
JMF | 2:0e2ef866af95 | 218 | return -1; |
JMF | 2:0e2ef866af95 | 219 | } |
JMF | 2:0e2ef866af95 | 220 | else |
JMF | 2:0e2ef866af95 | 221 | return 0; |
JMF | 2:0e2ef866af95 | 222 | } |
JMF | 2:0e2ef866af95 | 223 | else |
JMF | 2:0e2ef866af95 | 224 | { |
JMF | 2:0e2ef866af95 | 225 | WNC_MDM_ERR = WNC_NO_RESPONSE; |
JMF | 2:0e2ef866af95 | 226 | pc.puts("No response from WNC!\n\r"); |
JMF | 2:0e2ef866af95 | 227 | return -2; |
JMF | 2:0e2ef866af95 | 228 | } |
JMF | 2:0e2ef866af95 | 229 | } |
JMF | 2:0e2ef866af95 | 230 | |
fkellermavnet | 19:f89baed3bd6f | 231 | void at_at_wnc(void) |
fkellermavnet | 19:f89baed3bd6f | 232 | { |
fkellermavnet | 19:f89baed3bd6f | 233 | string * pRespStr; |
fkellermavnet | 19:f89baed3bd6f | 234 | send_wnc_cmd("AT", &pRespStr, WNC_TIMEOUT_MS); // Heartbeat? |
fkellermavnet | 19:f89baed3bd6f | 235 | } |
fkellermavnet | 19:f89baed3bd6f | 236 | |
JMF | 2:0e2ef866af95 | 237 | void at_init_wnc(void) |
JMF | 2:0e2ef866af95 | 238 | { |
JMF | 2:0e2ef866af95 | 239 | string * pRespStr; |
JMF | 2:0e2ef866af95 | 240 | send_wnc_cmd("AT", &pRespStr, WNC_TIMEOUT_MS); // Heartbeat? |
JMF | 2:0e2ef866af95 | 241 | send_wnc_cmd("ATE1", &pRespStr, WNC_TIMEOUT_MS); // Echo ON |
JMF | 2:0e2ef866af95 | 242 | string cmd_str("AT%PDNSET=1,"); |
JMF | 2:0e2ef866af95 | 243 | cmd_str += MY_APN_STR; |
JMF | 2:0e2ef866af95 | 244 | cmd_str += ",IP"; |
fkellermavnet | 30:33be8e2992f3 | 245 | send_wnc_cmd(cmd_str.c_str(), &pRespStr, 2*WNC_TIMEOUT_MS); // Set APN, cmd seems to take a little longer sometimes |
JMF | 2:0e2ef866af95 | 246 | send_wnc_cmd("AT@INTERNET=1", &pRespStr, WNC_TIMEOUT_MS); // Internet services enabled |
JMF | 2:0e2ef866af95 | 247 | send_wnc_cmd("AT@SOCKDIAL=1", &pRespStr, WNC_TIMEOUT_MS); |
JMF | 2:0e2ef866af95 | 248 | } |
JMF | 2:0e2ef866af95 | 249 | |
JMF | 2:0e2ef866af95 | 250 | void at_sockopen_wnc(const string & ipStr, const char * port ) |
JMF | 2:0e2ef866af95 | 251 | { |
JMF | 2:0e2ef866af95 | 252 | string * pRespStr; |
JMF | 2:0e2ef866af95 | 253 | send_wnc_cmd("AT@SOCKCREAT=1", &pRespStr, WNC_TIMEOUT_MS); |
JMF | 2:0e2ef866af95 | 254 | string cmd_str("AT@SOCKCONN=1,\""); |
JMF | 2:0e2ef866af95 | 255 | cmd_str += ipStr; |
JMF | 2:0e2ef866af95 | 256 | cmd_str += "\","; |
JMF | 2:0e2ef866af95 | 257 | cmd_str += port; |
fkellermavnet | 30:33be8e2992f3 | 258 | send_wnc_cmd(cmd_str.c_str(), &pRespStr, WNC_TIMEOUT_MS); |
JMF | 2:0e2ef866af95 | 259 | } |
JMF | 2:0e2ef866af95 | 260 | |
JMF | 2:0e2ef866af95 | 261 | void at_sockclose_wnc(void) |
JMF | 2:0e2ef866af95 | 262 | { |
JMF | 2:0e2ef866af95 | 263 | string * pRespStr; |
JMF | 2:0e2ef866af95 | 264 | send_wnc_cmd("AT@SOCKCLOSE=1", &pRespStr, WNC_TIMEOUT_MS); |
JMF | 2:0e2ef866af95 | 265 | } |
JMF | 2:0e2ef866af95 | 266 | |
JMF | 2:0e2ef866af95 | 267 | int at_dnsresolve_wnc(const char * s, string * ipStr) |
JMF | 2:0e2ef866af95 | 268 | { |
JMF | 2:0e2ef866af95 | 269 | string * pRespStr; |
JMF | 2:0e2ef866af95 | 270 | string str(s); |
JMF | 2:0e2ef866af95 | 271 | str = "AT@DNSRESVDON=\"" + str; |
JMF | 2:0e2ef866af95 | 272 | str += "\"\r\n"; |
fkellermavnet | 30:33be8e2992f3 | 273 | if (send_wnc_cmd(str.c_str(), &pRespStr, WNC_TIMEOUT_MS) == 0) |
JMF | 2:0e2ef866af95 | 274 | { |
JMF | 2:0e2ef866af95 | 275 | size_t pos_start = pRespStr->find(":\"") + 2; |
JMF | 2:0e2ef866af95 | 276 | if (pos_start != string::npos) |
JMF | 2:0e2ef866af95 | 277 | { |
JMF | 2:0e2ef866af95 | 278 | size_t pos_end = pRespStr->rfind("\"") - 1; |
JMF | 2:0e2ef866af95 | 279 | if (pos_end != string::npos) |
JMF | 2:0e2ef866af95 | 280 | { |
JMF | 2:0e2ef866af95 | 281 | if (pos_end > pos_start) |
JMF | 2:0e2ef866af95 | 282 | { |
JMF | 2:0e2ef866af95 | 283 | // Make a copy for use later (the source string is re-used) |
JMF | 2:0e2ef866af95 | 284 | *ipStr = pRespStr->substr(pos_start, pos_end - pos_start + 1); |
JMF | 2:0e2ef866af95 | 285 | return 1; |
JMF | 2:0e2ef866af95 | 286 | } |
JMF | 2:0e2ef866af95 | 287 | else |
JMF | 2:0e2ef866af95 | 288 | pc.puts("URL Resolve fail, substr Err\r\n"); |
JMF | 2:0e2ef866af95 | 289 | } |
JMF | 2:0e2ef866af95 | 290 | else |
JMF | 2:0e2ef866af95 | 291 | pc.puts("URL Resolve fail, no 2nd quote\r\n"); |
JMF | 2:0e2ef866af95 | 292 | } |
JMF | 2:0e2ef866af95 | 293 | else |
JMF | 2:0e2ef866af95 | 294 | pc.puts("URL Resolve fail, no quotes\r\n"); |
JMF | 2:0e2ef866af95 | 295 | } |
JMF | 2:0e2ef866af95 | 296 | else |
JMF | 2:0e2ef866af95 | 297 | pc.puts("URL Resolve fail, WNC cmd fail\r\n"); |
JMF | 2:0e2ef866af95 | 298 | |
JMF | 2:0e2ef866af95 | 299 | return -1; |
JMF | 2:0e2ef866af95 | 300 | } |
JMF | 2:0e2ef866af95 | 301 | |
JMF | 2:0e2ef866af95 | 302 | void at_sockwrite_wnc(const char * s) |
JMF | 2:0e2ef866af95 | 303 | { |
JMF | 2:0e2ef866af95 | 304 | string * pRespStr; |
JMF | 2:0e2ef866af95 | 305 | char num2str[6]; |
JMF | 2:0e2ef866af95 | 306 | size_t sLen = strlen(s); |
JMF | 2:0e2ef866af95 | 307 | if (sLen <= 99999) |
JMF | 2:0e2ef866af95 | 308 | { |
JMF | 2:0e2ef866af95 | 309 | string cmd_str("AT@SOCKWRITE=1,"); |
JMF | 2:0e2ef866af95 | 310 | itoa(sLen, num2str, 10); |
JMF | 2:0e2ef866af95 | 311 | cmd_str += num2str; |
JMF | 2:0e2ef866af95 | 312 | cmd_str += ",\""; |
JMF | 2:0e2ef866af95 | 313 | while(*s != '\0') |
JMF | 2:0e2ef866af95 | 314 | { |
JMF | 2:0e2ef866af95 | 315 | itoa((int)*s++, num2str, 16); |
JMF | 2:0e2ef866af95 | 316 | // Always 2-digit ascii hex: |
JMF | 2:0e2ef866af95 | 317 | if (strlen(num2str) == 1) |
JMF | 2:0e2ef866af95 | 318 | { |
JMF | 2:0e2ef866af95 | 319 | num2str[2] = '\0'; |
JMF | 2:0e2ef866af95 | 320 | num2str[1] = num2str[0]; |
JMF | 2:0e2ef866af95 | 321 | num2str[0] = '0'; |
JMF | 2:0e2ef866af95 | 322 | } |
JMF | 2:0e2ef866af95 | 323 | cmd_str += num2str; |
JMF | 2:0e2ef866af95 | 324 | } |
JMF | 2:0e2ef866af95 | 325 | cmd_str += "\""; |
fkellermavnet | 30:33be8e2992f3 | 326 | send_wnc_cmd(cmd_str.c_str(), &pRespStr, WNC_TIMEOUT_MS); |
JMF | 2:0e2ef866af95 | 327 | } |
JMF | 2:0e2ef866af95 | 328 | else |
JMF | 2:0e2ef866af95 | 329 | pc.puts("sockwrite Err, string to long\r\n"); |
JMF | 2:0e2ef866af95 | 330 | } |
JMF | 2:0e2ef866af95 | 331 | |
JMF | 2:0e2ef866af95 | 332 | unsigned at_sockread_wnc(string * pS, unsigned n, unsigned retries = 0) |
JMF | 2:0e2ef866af95 | 333 | { |
JMF | 2:0e2ef866af95 | 334 | unsigned i; |
JMF | 2:0e2ef866af95 | 335 | string * pRespStr; |
JMF | 2:0e2ef866af95 | 336 | string cmd_str("AT@SOCKREAD=1,"); |
fkellermavnet | 30:33be8e2992f3 | 337 | |
fkellermavnet | 30:33be8e2992f3 | 338 | // Clean slate |
fkellermavnet | 30:33be8e2992f3 | 339 | pS->erase(); |
fkellermavnet | 30:33be8e2992f3 | 340 | |
JMF | 2:0e2ef866af95 | 341 | if (n <= 1500) |
JMF | 2:0e2ef866af95 | 342 | { |
JMF | 2:0e2ef866af95 | 343 | char num2str[6]; |
fkellermavnet | 22:41e6c417ace1 | 344 | |
JMF | 2:0e2ef866af95 | 345 | itoa(n, num2str, 10); |
JMF | 2:0e2ef866af95 | 346 | cmd_str += num2str; |
JMF | 2:0e2ef866af95 | 347 | retries += 1; |
JMF | 2:0e2ef866af95 | 348 | while (retries--) |
JMF | 2:0e2ef866af95 | 349 | { |
fkellermavnet | 22:41e6c417ace1 | 350 | // Assuming someone is sending then calling this to receive response, invoke |
fkellermavnet | 22:41e6c417ace1 | 351 | // a pause to give the response some time to come back and then also |
fkellermavnet | 22:41e6c417ace1 | 352 | // between each retry. |
fkellermavnet | 22:41e6c417ace1 | 353 | wait_ms(10); |
fkellermavnet | 22:41e6c417ace1 | 354 | |
fkellermavnet | 30:33be8e2992f3 | 355 | send_wnc_cmd(cmd_str.c_str(), &pRespStr, WNC_TIMEOUT_MS); |
JMF | 2:0e2ef866af95 | 356 | size_t pos_start = pRespStr->find("\"") + 1; |
JMF | 2:0e2ef866af95 | 357 | size_t pos_end = pRespStr->rfind("\"") - 1; |
JMF | 2:0e2ef866af95 | 358 | i = pos_end - pos_start + 1; |
JMF | 2:0e2ef866af95 | 359 | if (i > 0) |
JMF | 2:0e2ef866af95 | 360 | { |
JMF | 2:0e2ef866af95 | 361 | retries = 0; // If any data found stop retrying |
JMF | 2:0e2ef866af95 | 362 | string byte; |
JMF | 2:0e2ef866af95 | 363 | while (pos_start < pos_end) |
JMF | 2:0e2ef866af95 | 364 | { |
JMF | 2:0e2ef866af95 | 365 | byte = pRespStr->substr(pos_start, 2); |
fkellermavnet | 30:33be8e2992f3 | 366 | *pS += (char)strtol(byte.c_str(), NULL, 16); |
JMF | 2:0e2ef866af95 | 367 | pos_start += 2; |
JMF | 2:0e2ef866af95 | 368 | } |
JMF | 2:0e2ef866af95 | 369 | return i; |
JMF | 2:0e2ef866af95 | 370 | } |
JMF | 2:0e2ef866af95 | 371 | } |
JMF | 2:0e2ef866af95 | 372 | } |
JMF | 2:0e2ef866af95 | 373 | else |
JMF | 2:0e2ef866af95 | 374 | pc.puts("sockread Err, to many to read\r\n"); |
JMF | 2:0e2ef866af95 | 375 | |
JMF | 2:0e2ef866af95 | 376 | return 0; |
JMF | 2:0e2ef866af95 | 377 | } |