source: uKadecot/trunk/uip/apps/webserver/websocket.c@ 108

Last change on this file since 108 was 108, checked in by coas-nagasima, 9 years ago

MIMEプロパティの変更
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-chdr; charset=SHIFT_JIS
File size: 6.9 KB
RevLine 
[101]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
44static ECN_FBS_ID cur_out_msg;
45
46void websocket_init(struct websocket *ws, ID wbsid)
47{
48 memset(ws, 0, sizeof(*ws));
49 ws->wbsid = wbsid;
50}
51
52void 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
68int 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
150bool_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
187int 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}
Note: See TracBrowser for help on using the repository browser.