gs fan / GSwifiInterface

GSwifiInterface library (interface for GainSpan Wi-Fi GS1011 modules) Please see https://mbed.org/users/gsfan/notebook/GSwifiInterface/

Dependents:   GSwifiInterface_HelloWorld GSwifiInterface_HelloServo GSwifiInterface_UDPEchoServer GSwifiInterface_UDPEchoClient ... more

Fork of WiflyInterface by mbed official

GainSpan Wi-Fi library

The GS1011/GS2100 is an ultra low power 802.11b wireless module from GainSpan.

mbed RTOS supported.

/media/uploads/gsfan/gs_im_002.jpg /media/uploads/gsfan/gs1011m_2.jpg

ゲインスパン Wi-Fi モジュール ライブラリ

ゲインスパン社の低電力 Wi-Fiモジュール（無線LAN） GS1011/GS2100 シリーズ用のライブラリです。

mbed RTOS に対応しています。(mbed2.0)

GSwifi/GSwifi_httpd_ws.cpp@22:d25a5a0d2497, 2019-09-24 (annotated)

Committer:
gsfan
Date:
Tue Sep 24 06:24:37 2019 +0000
Revision:
22:d25a5a0d2497
Parent:
17:c30ed7b1536d 
UART Command and SPI Data supported.; bug fix.;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gsfan 12:057089026a20 1 /* Copyright (C) 2013 gsfan, MIT License
gsfan 12:057089026a20 2 *
gsfan 12:057089026a20 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
gsfan 12:057089026a20 4 * and associated documentation files (the "Software"), to deal in the Software without restriction,
gsfan 12:057089026a20 5 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
gsfan 12:057089026a20 6 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
gsfan 12:057089026a20 7 * furnished to do so, subject to the following conditions:
gsfan 12:057089026a20 8 *
gsfan 12:057089026a20 9 * The above copyright notice and this permission notice shall be included in all copies or
gsfan 12:057089026a20 10 * substantial portions of the Software.
gsfan 12:057089026a20 11 *
gsfan 12:057089026a20 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
gsfan 12:057089026a20 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
gsfan 12:057089026a20 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
gsfan 12:057089026a20 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
gsfan 12:057089026a20 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
gsfan 12:057089026a20 17 */
gsfan 12:057089026a20 18
gsfan 12:057089026a20 19 #include "GSwifi.h"
gsfan 12:057089026a20 20
gsfan 12:057089026a20 21 #ifdef CFG_ENABLE_WEBSOCKET
gsfan 12:057089026a20 22
gsfan 12:057089026a20 23 #include "sha1.h"
gsfan 12:057089026a20 24
gsfan 12:057089026a20 25 int GSwifi::wsOpen (const char *host, int port, const char *uri, const char *user, const char *pwd) {
gsfan 12:057089026a20 26 int cid;
gsfan 12:057089026a20 27 char cmd[CFG_CMD_SIZE], tmp[CFG_CMD_SIZE];
gsfan 12:057089026a20 28 char ip[17];
gsfan 12:057089026a20 29
gsfan 12:057089026a20 30 if (!isAssociated() || _state.status != STAT_READY) return -1;
gsfan 12:057089026a20 31
gsfan 12:057089026a20 32 if (getHostByName(host, ip)) return -1;
gsfan 12:057089026a20 33 if (! port) {
gsfan 12:057089026a20 34 port = 80;
gsfan 12:057089026a20 35 }
gsfan 12:057089026a20 36
gsfan 12:057089026a20 37 cid = open(PROTO_TCP, ip, port);
gsfan 12:057089026a20 38 if (cid < 0) return -1;
gsfan 12:057089026a20 39 DBG("ws cid %d\r\n", cid);
gsfan 12:057089026a20 40
gsfan 12:057089026a20 41 // request
gsfan 17:c30ed7b1536d 42 snprintf(cmd, sizeof(cmd), "GET %s HTTP/1.1\r\n", uri);
gsfan 12:057089026a20 43 send(cid, cmd, strlen(cmd));
gsfan 12:057089026a20 44 if (host) {
gsfan 12:057089026a20 45 snprintf(cmd, sizeof(cmd), "Host: %s\r\n", host);
gsfan 12:057089026a20 46 send(cid, cmd, strlen(cmd));
gsfan 12:057089026a20 47 }
gsfan 12:057089026a20 48 if (user && pwd) {
gsfan 12:057089026a20 49 snprintf(cmd, sizeof(cmd), "%s:%s", user, pwd);
gsfan 12:057089026a20 50 base64encode(cmd, strlen(cmd), tmp, sizeof(tmp));
gsfan 12:057089026a20 51 snprintf(cmd, sizeof(cmd), "Authorization: Basic %s\r\n", tmp);
gsfan 12:057089026a20 52 send(cid, cmd, strlen(cmd));
gsfan 12:057089026a20 53 }
gsfan 12:057089026a20 54 strcpy(cmd, "Upgrade: websocket\r\n");
gsfan 12:057089026a20 55 send(cid, cmd, strlen(cmd));
gsfan 12:057089026a20 56 strcpy(cmd, "Connection: Upgrade\r\n");
gsfan 12:057089026a20 57 send(cid, cmd, strlen(cmd));
gsfan 17:c30ed7b1536d 58 getMacAddress(cmd);
gsfan 17:c30ed7b1536d 59 memcpy(&cmd[6], host, 10);
gsfan 17:c30ed7b1536d 60 base64encode(cmd, 16, tmp, sizeof(tmp));
gsfan 12:057089026a20 61 snprintf(cmd, sizeof(cmd), "Sec-WebSocket-Key: %s\r\n", tmp);
gsfan 12:057089026a20 62 send(cid, cmd, strlen(cmd));
gsfan 17:c30ed7b1536d 63 // strcpy(cmd, "Sec-WebSocket-Protocol: chat\r\n");
gsfan 17:c30ed7b1536d 64 // send(cid, cmd, strlen(cmd));
gsfan 12:057089026a20 65 strcpy(cmd, "Sec-WebSocket-Version: 13\r\n\r\n");
gsfan 12:057089026a20 66 send(cid, cmd, strlen(cmd));
gsfan 12:057089026a20 67
gsfan 12:057089026a20 68 if (wsWait(cid, 101)) {
gsfan 12:057089026a20 69 close(cid);
gsfan 12:057089026a20 70 return -1;
gsfan 12:057089026a20 71 }
gsfan 12:057089026a20 72 wsWait(cid, 0);
gsfan 12:057089026a20 73 return cid;
gsfan 12:057089026a20 74 }
gsfan 12:057089026a20 75
gsfan 12:057089026a20 76 int GSwifi::wsWait (int cid, int code) {
gsfan 12:057089026a20 77 Timer timeout;
gsfan 12:057089026a20 78 int i, n, len;
gsfan 12:057089026a20 79 char buf[CFG_DATA_SIZE], data[CFG_CMD_SIZE];
gsfan 12:057089026a20 80
gsfan 12:057089026a20 81 if (code == 0) {
gsfan 12:057089026a20 82 // dummy read
gsfan 12:057089026a20 83 timeout.start();
gsfan 12:057089026a20 84 while (timeout.read_ms() < CFG_TIMEOUT) {
gsfan 12:057089026a20 85 wait_ms(10);
gsfan 12:057089026a20 86 if (!readable(cid)) break;
gsfan 12:057089026a20 87 n = recv(cid, buf, sizeof(buf));
gsfan 12:057089026a20 88 if (n <= 0) break;
gsfan 12:057089026a20 89 }
gsfan 12:057089026a20 90 timeout.stop();
gsfan 12:057089026a20 91 return 0;
gsfan 12:057089026a20 92 }
gsfan 12:057089026a20 93
gsfan 12:057089026a20 94 // wait responce
gsfan 12:057089026a20 95 len = 0;
gsfan 12:057089026a20 96 timeout.start();
gsfan 12:057089026a20 97 while (timeout.read_ms() < CFG_TIMEOUT) {
gsfan 12:057089026a20 98 wait_ms(10);
gsfan 12:057089026a20 99 n = recv(cid, buf, sizeof(buf));
gsfan 12:057089026a20 100 for (i = 0; i < n; i ++) {
gsfan 12:057089026a20 101 if (buf[i] == '\r') continue;
gsfan 12:057089026a20 102 if (buf[i] == '\n') {
gsfan 12:057089026a20 103 if (len == 0) continue;
gsfan 12:057089026a20 104 goto next;
gsfan 12:057089026a20 105 } else
gsfan 12:057089026a20 106 if (len < sizeof(data) - 1) {
gsfan 12:057089026a20 107 data[len] = buf[i];
gsfan 12:057089026a20 108 len ++;
gsfan 12:057089026a20 109 }
gsfan 12:057089026a20 110 }
gsfan 12:057089026a20 111 }
gsfan 12:057089026a20 112 next:
gsfan 12:057089026a20 113 data[len] = 0;
gsfan 12:057089026a20 114 timeout.stop();
gsfan 12:057089026a20 115 DBG("ws: %s\r\n", data);
gsfan 12:057089026a20 116
gsfan 12:057089026a20 117 // check return code
gsfan 12:057089026a20 118 if (strncmp(data, "HTTP/1.1 ", 9) != 0) return -1;
gsfan 12:057089026a20 119 i = atoi(&data[9]);
gsfan 12:057089026a20 120 DBG("ws status %d\r\n", i);
gsfan 12:057089026a20 121 return i == code ? 0 : -1;
gsfan 12:057089026a20 122 }
gsfan 12:057089026a20 123
gsfan 12:057089026a20 124 int GSwifi::wsSend (int cid, const char *buf, int len, const char *mask) {
gsfan 12:057089026a20 125 int i = 0, r;
gsfan 12:057089026a20 126 char tmp[10];
gsfan 12:057089026a20 127
gsfan 12:057089026a20 128 tmp[i++] = 0x81; // single, text frame
gsfan 12:057089026a20 129 if (len < 126) {
gsfan 12:057089026a20 130 tmp[i++] = (mask == NULL ? 0 : 0x80) | len;
gsfan 12:057089026a20 131 } else {
gsfan 12:057089026a20 132 tmp[i++] = (mask == NULL ? 0 : 0x80) | 126;
gsfan 12:057089026a20 133 tmp[i++] = (len >> 8) & 0xff;
gsfan 12:057089026a20 134 tmp[i++] = len & 0xff;
gsfan 12:057089026a20 135 }
gsfan 12:057089026a20 136 if (mask) {
gsfan 12:057089026a20 137 memcpy(&tmp[i], mask, 4);
gsfan 12:057089026a20 138 i += 4;
gsfan 12:057089026a20 139 }
gsfan 15:086d1a33a197 140 r = send(cid, tmp, i);
gsfan 12:057089026a20 141
gsfan 15:086d1a33a197 142 if (r > 0) {
gsfan 12:057089026a20 143 if (mask) {
gsfan 12:057089026a20 144 char tmp2[len];
gsfan 12:057089026a20 145 for (i = 0; i < len; i ++) {
gsfan 12:057089026a20 146 tmp2[i] = buf[i] ^ mask[i & 0x03];
gsfan 12:057089026a20 147 }
gsfan 12:057089026a20 148 r = send(cid, tmp2, len);
gsfan 12:057089026a20 149 } else {
gsfan 12:057089026a20 150 r = send(cid, buf, len);
gsfan 12:057089026a20 151 }
gsfan 12:057089026a20 152 }
gsfan 12:057089026a20 153 return r;
gsfan 12:057089026a20 154 }
gsfan 12:057089026a20 155
gsfan 12:057089026a20 156 #ifdef CFG_ENABLE_HTTPD
gsfan 12:057089026a20 157
gsfan 12:057089026a20 158 void GSwifi::wsRecvData (int cid, char c) {
gsfan 12:057089026a20 159
gsfan 12:057089026a20 160 switch (_httpd[cid].mode) {
gsfan 12:057089026a20 161 case HTTPDMODE_WEBSOCKET:
gsfan 12:057089026a20 162 if (_httpd[cid].n == 0) {
gsfan 12:057089026a20 163 // flag
gsfan 12:057089026a20 164 _httpd[cid].websocket_opcode = c & 0x0f;
gsfan 12:057089026a20 165 _httpd[cid].websocket_flg = c << 8;
gsfan 12:057089026a20 166 _httpd[cid].n ++;
gsfan 12:057089026a20 167 } else
gsfan 12:057089026a20 168 if (_httpd[cid].n == 1) {
gsfan 12:057089026a20 169 // length 7bit
gsfan 12:057089026a20 170 _httpd[cid].websocket_flg |= c;
gsfan 12:057089026a20 171 _httpd[cid].length = c & 0x7f;
gsfan 12:057089026a20 172 _httpd[cid].n ++;
gsfan 12:057089026a20 173 if (_httpd[cid].length < 126) {
gsfan 12:057089026a20 174 _httpd[cid].n = 0;
gsfan 12:057089026a20 175 if (_httpd[cid].length) {
gsfan 12:057089026a20 176 if (_httpd[cid].websocket_flg & 0x0080) {
gsfan 12:057089026a20 177 _httpd[cid].mode = HTTPDMODE_WEBSOCKET_MASK;
gsfan 12:057089026a20 178 } else {
gsfan 12:057089026a20 179 _httpd[cid].mode = HTTPDMODE_WEBSOCKET_BODY;
gsfan 12:057089026a20 180 }
gsfan 12:057089026a20 181 } else {
gsfan 12:057089026a20 182 _httpd[cid].mode = HTTPDMODE_WEBSOCKET_ENTER;
gsfan 12:057089026a20 183 }
gsfan 12:057089026a20 184 DBG("ws length %d\r\n", _httpd[cid].length);
gsfan 12:057089026a20 185 }
gsfan 12:057089026a20 186 } else {
gsfan 12:057089026a20 187 // length 16bit,64bit
gsfan 12:057089026a20 188 if (_httpd[cid].n == 2) {
gsfan 12:057089026a20 189 _httpd[cid].length = c;
gsfan 12:057089026a20 190 _httpd[cid].n ++;
gsfan 12:057089026a20 191 } else
gsfan 12:057089026a20 192 if (_httpd[cid].n < 9 && (_httpd[cid].websocket_flg & 0x7f) == 127) {
gsfan 12:057089026a20 193 // 64bit
gsfan 12:057089026a20 194 _httpd[cid].length = (_httpd[cid].length << 8) | c;
gsfan 12:057089026a20 195 _httpd[cid].n ++;
gsfan 12:057089026a20 196 } else {
gsfan 12:057089026a20 197 // end
gsfan 12:057089026a20 198 _httpd[cid].length = (_httpd[cid].length << 8) | c;
gsfan 12:057089026a20 199 _httpd[cid].n = 0;
gsfan 12:057089026a20 200 if (_httpd[cid].websocket_flg & 0x0080) {
gsfan 12:057089026a20 201 _httpd[cid].mode = HTTPDMODE_WEBSOCKET_MASK;
gsfan 12:057089026a20 202 } else {
gsfan 12:057089026a20 203 _httpd[cid].mode = HTTPDMODE_WEBSOCKET_BODY;
gsfan 12:057089026a20 204 }
gsfan 12:057089026a20 205 DBG("ws length2 %d\r\n", _httpd[cid].length);
gsfan 12:057089026a20 206 }
gsfan 12:057089026a20 207 }
gsfan 12:057089026a20 208 break;
gsfan 12:057089026a20 209 case HTTPDMODE_WEBSOCKET_MASK:
gsfan 12:057089026a20 210 // masking key
gsfan 12:057089026a20 211 _httpd[cid].websocket_mask[_httpd[cid].n] = c;
gsfan 12:057089026a20 212 _httpd[cid].n ++;
gsfan 12:057089026a20 213 if (_httpd[cid].n >= 4) {
gsfan 12:057089026a20 214 _httpd[cid].n = 0;
gsfan 12:057089026a20 215 _httpd[cid].mode = HTTPDMODE_WEBSOCKET_BODY;
gsfan 12:057089026a20 216 DBG("ws mask\r\n");
gsfan 12:057089026a20 217 }
gsfan 12:057089026a20 218 break;
gsfan 12:057089026a20 219 case HTTPDMODE_WEBSOCKET_BODY:
gsfan 12:057089026a20 220 // payload
gsfan 12:057089026a20 221 if (_httpd[cid].websocket_flg & 0x0080) {
gsfan 12:057089026a20 222 // un-mask
gsfan 12:057089026a20 223 _httpd[cid].buf->queue(c ^ _httpd[cid].websocket_mask[_httpd[cid].n & 0x03]);
gsfan 12:057089026a20 224 } else {
gsfan 12:057089026a20 225 _httpd[cid].buf->queue(c);
gsfan 12:057089026a20 226 }
gsfan 12:057089026a20 227 _httpd[cid].n ++;
gsfan 12:057089026a20 228 if (_httpd[cid].n >= _httpd[cid].length) {
gsfan 12:057089026a20 229 _httpd[cid].mode = HTTPDMODE_WEBSOCKET_ENTER;
gsfan 12:057089026a20 230 _con[cid].received = true;
gsfan 12:057089026a20 231 }
gsfan 12:057089026a20 232 break;
gsfan 12:057089026a20 233 }
gsfan 12:057089026a20 234 }
gsfan 12:057089026a20 235
gsfan 12:057089026a20 236 int GSwifi::wsParseRequest (int cid) {
gsfan 12:057089026a20 237 int i;
gsfan 12:057089026a20 238
gsfan 12:057089026a20 239 DBG("ws opcode %d\r\n", _httpd[cid].websocket_opcode);
gsfan 12:057089026a20 240 switch (_httpd[cid].websocket_opcode) {
gsfan 12:057089026a20 241 case 0x00: // continuation
gsfan 12:057089026a20 242 break;
gsfan 12:057089026a20 243 case 0x01: // text
gsfan 12:057089026a20 244 case 0x02: // binary
gsfan 12:057089026a20 245 i = httpdGetHandler(_httpd[cid].uri);
gsfan 12:057089026a20 246 if (i >= 0) {
gsfan 15:086d1a33a197 247 if (_httpd_handler[i].func && _httpd_handler[i].ws) {
gsfan 12:057089026a20 248 // cgi
gsfan 12:057089026a20 249 _httpd_handler[i].func(cid);
gsfan 12:057089026a20 250 }
gsfan 12:057089026a20 251 }
gsfan 12:057089026a20 252 break;
gsfan 12:057089026a20 253 case 0x08: // close
gsfan 12:057089026a20 254 close(cid);
gsfan 12:057089026a20 255 break;
gsfan 12:057089026a20 256 case 0x09: // ping
gsfan 12:057089026a20 257 {
gsfan 12:057089026a20 258 char pong[_httpd[cid].n + 2];
gsfan 12:057089026a20 259 pong[0] = 0x8a;
gsfan 12:057089026a20 260 pong[1] = 0x04;
gsfan 12:057089026a20 261 for (i = 0; i < _httpd[cid].length; i ++) {
gsfan 12:057089026a20 262 if (_httpd[cid].buf->dequeue(&pong[i + 2]) == false) break;
gsfan 12:057089026a20 263 }
gsfan 12:057089026a20 264 send(cid, pong, _httpd[cid].length + 2);
gsfan 12:057089026a20 265 }
gsfan 12:057089026a20 266 break;
gsfan 12:057089026a20 267 case 0x0a: // pong
gsfan 12:057089026a20 268 break;
gsfan 12:057089026a20 269 default:
gsfan 12:057089026a20 270 break;
gsfan 12:057089026a20 271 }
gsfan 12:057089026a20 272 _httpd[cid].n = 0;
gsfan 12:057089026a20 273 _httpd[cid].length = 0;
gsfan 12:057089026a20 274 return 0;
gsfan 12:057089026a20 275 }
gsfan 12:057089026a20 276
gsfan 12:057089026a20 277 int GSwifi::wsAccept (int cid) {
gsfan 12:057089026a20 278 char buf[CFG_CMD_SIZE], buf2[CFG_CMD_SIZE];
gsfan 12:057089026a20 279
gsfan 12:057089026a20 280 DBG("websocket accept: %d\r\n", cid);
gsfan 12:057089026a20 281
gsfan 12:057089026a20 282 strcpy(buf, "HTTP/1.1 101 Switching Protocols\r\n");
gsfan 12:057089026a20 283 send(cid, buf, strlen(buf));
gsfan 12:057089026a20 284 strcpy(buf, "Upgrade: websocket\r\n");
gsfan 12:057089026a20 285 send(cid, buf, strlen(buf));
gsfan 12:057089026a20 286 strcpy(buf, "Connection: Upgrade\r\n");
gsfan 12:057089026a20 287 send(cid, buf, strlen(buf));
gsfan 12:057089026a20 288
gsfan 12:057089026a20 289 strcpy(buf, "Sec-WebSocket-Accept: ");
gsfan 12:057089026a20 290 send(cid, buf, strlen(buf));
gsfan 12:057089026a20 291 strcpy(buf, _httpd[cid].websocket_key);
gsfan 12:057089026a20 292 strcat(buf, "258EAFA5-E914-47DA-95CA-C5AB0DC85B11");
gsfan 12:057089026a20 293 sha1(buf, strlen(buf), buf2);
gsfan 12:057089026a20 294 base64encode(buf2, 20, buf, sizeof(buf));
gsfan 12:057089026a20 295 send(cid, buf, strlen(buf));
gsfan 12:057089026a20 296 strcpy(buf, "\r\n\r\n");
gsfan 12:057089026a20 297 send(cid, buf, strlen(buf));
gsfan 12:057089026a20 298 return 0;
gsfan 12:057089026a20 299 }
gsfan 12:057089026a20 300
gsfan 12:057089026a20 301 #endif
gsfan 12:057089026a20 302 #endif