1 | /*
|
---|
2 | * TOPPERS ECHONET Lite Communication Middleware
|
---|
3 | *
|
---|
4 | * Copyright (C) 2015 Cores Co., Ltd. Japan
|
---|
5 | *
|
---|
6 | * 上記著作権者は,以下の(1)〜(4)の条件を満たす場合に限り,本ソフトウェ
|
---|
7 | * ア(本ソフトウェアを改変したものを含む.以下同じ)を使用・複製・改
|
---|
8 | * 変・再配布(以下,利用と呼ぶ)することを無償で許諾する.
|
---|
9 | * (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作
|
---|
10 | * 権表示,この利用条件および下記の無保証規定が,そのままの形でソー
|
---|
11 | * スコード中に含まれていること.
|
---|
12 | * (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使
|
---|
13 | * 用できる形で再配布する場合には,再配布に伴うドキュメント(利用
|
---|
14 | * 者マニュアルなど)に,上記の著作権表示,この利用条件および下記
|
---|
15 | * の無保証規定を掲載すること.
|
---|
16 | * (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使
|
---|
17 | * 用できない形で再配布する場合には,次のいずれかの条件を満たすこ
|
---|
18 | * と.
|
---|
19 | * (a) 再配布に伴うドキュメント(利用者マニュアルなど)に,上記の著
|
---|
20 | * 作権表示,この利用条件および下記の無保証規定を掲載すること.
|
---|
21 | * (b) 再配布の形態を,別に定める方法によって,TOPPERSプロジェクトに
|
---|
22 | * 報告すること.
|
---|
23 | * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
|
---|
24 | * 害からも,上記著作権者およびTOPPERSプロジェクトを免責すること.
|
---|
25 | * また,本ソフトウェアのユーザまたはエンドユーザからのいかなる理
|
---|
26 | * 由に基づく請求からも,上記著作権者およびTOPPERSプロジェクトを
|
---|
27 | * 免責すること.
|
---|
28 | *
|
---|
29 | * 本ソフトウェアは,無保証で提供されているものである.上記著作権者お
|
---|
30 | * よびTOPPERSプロジェクトは,本ソフトウェアに関して,特定の使用目的
|
---|
31 | * に対する適合性も含めて,いかなる保証も行わない.また,本ソフトウェ
|
---|
32 | * アの利用により直接的または間接的に生じたいかなる損害に関しても,そ
|
---|
33 | * の責任を負わない.
|
---|
34 | *
|
---|
35 | * @(#) $Id: websocket.c 108 2015-06-11 09:15:46Z coas-nagasima $
|
---|
36 | */
|
---|
37 |
|
---|
38 | #include <string.h>
|
---|
39 | #include "websocket.h"
|
---|
40 | #include "uip.h"
|
---|
41 | #include "kernel.h"
|
---|
42 | #include "kernel_cfg.h"
|
---|
43 |
|
---|
44 | static ECN_FBS_ID cur_out_msg;
|
---|
45 |
|
---|
46 | void websocket_init(struct websocket *ws, ID wbsid)
|
---|
47 | {
|
---|
48 | memset(ws, 0, sizeof(*ws));
|
---|
49 | ws->wbsid = wbsid;
|
---|
50 | }
|
---|
51 |
|
---|
52 | void websocket_destroy(struct websocket *ws)
|
---|
53 | {
|
---|
54 | if ((cur_out_msg.ptr != NULL) && (((ID *)cur_out_msg.ptr->_gap)[0] == ws->wbsid))
|
---|
55 | {
|
---|
56 | _ecn_fbs_del(cur_out_msg);
|
---|
57 | memset(&cur_out_msg, 0, sizeof(cur_out_msg));
|
---|
58 | }
|
---|
59 |
|
---|
60 | if (ws->cur_in_msg.ptr != NULL) {
|
---|
61 | _ecn_fbs_del(ws->cur_in_msg);
|
---|
62 | memset(&ws->cur_in_msg, 0, sizeof(ws->cur_in_msg));
|
---|
63 | }
|
---|
64 |
|
---|
65 | ws->wbsid = 0;
|
---|
66 | }
|
---|
67 |
|
---|
68 | int websocket_input(struct websocket *ws, const void *data, int len)
|
---|
69 | {
|
---|
70 | ws_state_t *s = &ws->rstate;
|
---|
71 | const u8_t *pos = (const u8_t *)data, *end = &((const u8_t *)data)[len];
|
---|
72 |
|
---|
73 | for(; pos < end; pos++){
|
---|
74 | switch (s->state)
|
---|
75 | {
|
---|
76 | // FIN RSV1-3 OPECODE
|
---|
77 | case 0:
|
---|
78 | s->fin = (*pos & 0x80) != 0;
|
---|
79 | s->opecode = (enum opecode_t)(*pos & 0x0F);
|
---|
80 | s->state = 1;
|
---|
81 | break;
|
---|
82 | // MASK Payload len
|
---|
83 | case 1:
|
---|
84 | // MASK=0はNG
|
---|
85 | if((*pos & 0x80) == 0)
|
---|
86 | return -1/*MASK_ERROR*/;
|
---|
87 |
|
---|
88 | switch(*pos & 0x7F){
|
---|
89 | case 127:
|
---|
90 | s->payload_len = 0;
|
---|
91 | s->state = 2/*7+64bit*/;
|
---|
92 | break;
|
---|
93 | case 126:
|
---|
94 | s->payload_len = 0;
|
---|
95 | s->state = 8/*7+16bit*/;
|
---|
96 | break;
|
---|
97 | default:
|
---|
98 | s->payload_len = *pos & 0x7F;
|
---|
99 | s->state = 10/*7bit*/;
|
---|
100 | break;
|
---|
101 | }
|
---|
102 | break;
|
---|
103 | // 64bit Extended payload length
|
---|
104 | case 2: case 3: case 4: case 5: case 6: case 7:
|
---|
105 | // 16bit Extended payload length
|
---|
106 | case 8: case 9:
|
---|
107 | s->payload_len = (s->payload_len << 8) + *pos;
|
---|
108 | s->state++;
|
---|
109 | break;
|
---|
110 | // Masking-key
|
---|
111 | case 10: case 11: case 12:
|
---|
112 | s->masking_key[s->state - 10] = *pos;
|
---|
113 | s->state++;
|
---|
114 | break;
|
---|
115 | case 13:
|
---|
116 | s->masking_key[3] = *pos;
|
---|
117 |
|
---|
118 | s->data_pos = 0;
|
---|
119 | if (s->payload_len <= 0) {
|
---|
120 | s->state = 0;
|
---|
121 | }
|
---|
122 | else {
|
---|
123 | _ecn_fbs_cre(1, &ws->cur_in_msg);
|
---|
124 | s->state++;
|
---|
125 | }
|
---|
126 | break;
|
---|
127 | // Payload buffer
|
---|
128 | default:
|
---|
129 | _ecn_fbs_poke(ws->cur_in_msg, s->data_pos, *pos ^ s->masking_key[s->data_pos % 4]);
|
---|
130 |
|
---|
131 | s->data_pos++;
|
---|
132 | if (s->data_pos >= s->payload_len) {
|
---|
133 | ER ret;
|
---|
134 | s->state = 0;
|
---|
135 | ((ID *)ws->cur_in_msg.ptr->_gap)[0] = ws->wbsid;
|
---|
136 | ret = psnd_dtq(ecn_api_mailboxid, (intptr_t)ws->cur_in_msg.ptr);
|
---|
137 | if (ret != E_OK) {
|
---|
138 | syslog(LOG_WARNING, "websocket_input() : psnd_dtq(%d) result = %d", ecn_api_mailboxid, ret);
|
---|
139 | _ecn_fbs_del(ws->cur_in_msg);
|
---|
140 | }
|
---|
141 | memset(&ws->cur_in_msg, 0, sizeof(ws->cur_in_msg));
|
---|
142 | }
|
---|
143 | break;
|
---|
144 | }
|
---|
145 | }
|
---|
146 |
|
---|
147 | return 0;
|
---|
148 | }
|
---|
149 |
|
---|
150 | bool_t websocket_newdata(struct websocket *ws)
|
---|
151 | {
|
---|
152 | ws_state_t *s = &ws->wstate;
|
---|
153 | struct websocket *mws;
|
---|
154 | ER ret;
|
---|
155 | ECN_FBS_ID data;
|
---|
156 | ID wbsid;
|
---|
157 |
|
---|
158 | if(s->state != 0)
|
---|
159 | return true;
|
---|
160 |
|
---|
161 | if (cur_out_msg.ptr != NULL)
|
---|
162 | return (((ID *)cur_out_msg.ptr->_gap)[0] == ws->wbsid);
|
---|
163 |
|
---|
164 | for (;;) {
|
---|
165 | ret = prcv_dtq(WEBSOCKET_MBXID, (intptr_t *)&data.ptr);
|
---|
166 | if (ret == E_TMOUT)
|
---|
167 | return false;
|
---|
168 |
|
---|
169 | if (ret != E_OK) {
|
---|
170 | TOPPERS_assert_abort();
|
---|
171 | return false;
|
---|
172 | }
|
---|
173 |
|
---|
174 | wbsid = ((ID *)data.ptr->_gap)[0];
|
---|
175 | mws = websocket_getws(wbsid);
|
---|
176 | if ((mws != NULL) && (mws->wbsid != 0))
|
---|
177 | break;
|
---|
178 |
|
---|
179 | _ecn_fbs_del(cur_out_msg);
|
---|
180 | }
|
---|
181 |
|
---|
182 | cur_out_msg.ptr = data.ptr;
|
---|
183 |
|
---|
184 | return (wbsid == ws->wbsid);
|
---|
185 | }
|
---|
186 |
|
---|
187 | int websocket_output(struct websocket *ws, void *data, int len)
|
---|
188 | {
|
---|
189 | ws_state_t *s = &ws->wstate;
|
---|
190 | u8_t *pos = (u8_t *)data, *end = &((u8_t *)data)[len];
|
---|
191 |
|
---|
192 | for(; pos < end; pos++){
|
---|
193 | switch (s->state)
|
---|
194 | {
|
---|
195 | // FIN RSV1-3 OPECODE
|
---|
196 | case 0:
|
---|
197 | if ((cur_out_msg.ptr == NULL) || (((ID *)cur_out_msg.ptr->_gap)[0] != ws->wbsid))
|
---|
198 | return (intptr_t)pos - (intptr_t)data;
|
---|
199 |
|
---|
200 | s->payload_len = _ecn_fbs_get_datalen(cur_out_msg);
|
---|
201 | if(s->payload_len == 0){
|
---|
202 | goto next;
|
---|
203 | }
|
---|
204 |
|
---|
205 | s->fin = 1;
|
---|
206 | s->opecode = text_frame;
|
---|
207 | s->masked = 0;//
|
---|
208 | s->masking_key[0] = 0;//0x01;
|
---|
209 | s->masking_key[1] = 0;//0x23;
|
---|
210 | s->masking_key[2] = 0;//0x45;
|
---|
211 | s->masking_key[3] = 0;//0x67;
|
---|
212 |
|
---|
213 | *pos = ((s->fin != 0) ? 0x80 : 0)
|
---|
214 | | ((char)s->opecode & 0x0F);
|
---|
215 | s->state = 1;
|
---|
216 | break;
|
---|
217 | // MASK Payload len
|
---|
218 | case 1:
|
---|
219 | if(s->payload_len < 126){
|
---|
220 | *pos = ((s->masked != 0) ? 0x80 : 0) | s->payload_len;
|
---|
221 | if (s->masked != 0) {
|
---|
222 | s->state = 10/*7bit*/;
|
---|
223 | }
|
---|
224 | else{
|
---|
225 | goto payload_check;
|
---|
226 | }
|
---|
227 | }
|
---|
228 | else if(s->payload_len < 0x10000){
|
---|
229 | *pos = ((s->masked != 0) ? 0x80 : 0) | 126;
|
---|
230 | s->state = 8/*7+16bit*/;
|
---|
231 | }
|
---|
232 | else{
|
---|
233 | *pos = ((s->masked != 0) ? 0x80 : 0) | 127;
|
---|
234 | s->state = 2/*7+64bit*/;
|
---|
235 | }
|
---|
236 | break;
|
---|
237 | // 64bit Extended payload length
|
---|
238 | case 2: case 3: case 4: case 5: case 6: case 7:
|
---|
239 | // 16bit Extended payload length
|
---|
240 | case 8: case 9:
|
---|
241 | *pos = (s->payload_len >> (8 * (9 - s->state)));
|
---|
242 | s->state++;
|
---|
243 | if((s->state == 10) && (s->masked == 0)){
|
---|
244 | goto payload_check;
|
---|
245 | }
|
---|
246 | break;
|
---|
247 | // Masking-key
|
---|
248 | case 10: case 11: case 12:
|
---|
249 | *pos = s->masking_key[s->state - 10];
|
---|
250 | s->state++;
|
---|
251 | break;
|
---|
252 | case 13:
|
---|
253 | *pos = s->masking_key[3];
|
---|
254 | s->state++;
|
---|
255 | payload_check:
|
---|
256 | s->data_pos = 0;
|
---|
257 | if (s->data_pos < s->payload_len)
|
---|
258 | s->state = 14;
|
---|
259 | else
|
---|
260 | goto next;
|
---|
261 | break;
|
---|
262 | // Payload buffer
|
---|
263 | default:
|
---|
264 | *pos = _ecn_fbs_peek(cur_out_msg, s->data_pos) ^ s->masking_key[s->data_pos % 4];
|
---|
265 |
|
---|
266 | s->data_pos++;
|
---|
267 | if(s->data_pos >= s->payload_len){
|
---|
268 | goto next;
|
---|
269 | }
|
---|
270 | break;
|
---|
271 | next:
|
---|
272 | _ecn_fbs_del(cur_out_msg);
|
---|
273 | memset(&cur_out_msg, 0, sizeof(cur_out_msg));
|
---|
274 | s->state = 0;
|
---|
275 | websocket_newdata(ws);
|
---|
276 | break;
|
---|
277 | }
|
---|
278 | }
|
---|
279 |
|
---|
280 | return (intptr_t)pos - (intptr_t)data;
|
---|
281 | }
|
---|