source: EcnlProtoTool/trunk/asp3_dcre/tinet/netapp/tcp_echo_srv2.c@ 270

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

mruby版ECNLプロトタイピング・ツールを追加
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc
File size: 20.1 KB
Line 
1/*
2 * TINET (TCP/IP Protocol Stack)
3 *
4 * Copyright (C) 2001-2009 by Dep. of Computer Science and Engineering
5 * Tomakomai National College of Technology, JAPAN
6 *
7 * 上記著作権者
8は，以下の (1)～(4) の条件か，Free Software Foundation
9 * によってå…
10¬è¡¨ã•ã‚Œã¦ã„ã‚‹ GNU General Public License の Version 2 に記
11 * 述されている条件を満たす場合に限り，本ソフトウェア（本ソフトウェア
12 * を改変したものを含む．以下同じ）を使用・複製・改変・再é…
13å¸ƒï¼ˆä»¥ä¸‹ï¼Œ
14 * 利用と呼ぶ）することを無償で許諾する．
15 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
16 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
17 * スコード中に含まれていること．
18 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
19 * 用できる形で再é…
20å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
21å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
22 * 者
23マニュアルなど）に，上記の著作権表示，この利用条件および下記
24 * の無保証規定を掲載すること．
25 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
26 * 用できない形で再é…
27å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®æ¡ä»¶ã‚’満たすこと．
28 * (a) 再é…
29å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
30マニュアルなど）に，上記の著
31 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
32 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
33 * 害からも，上記著作権者
34およびTOPPERSプロジェクトをå…
35è²¬ã™ã‚‹ã“と．
36 *
37 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者
38お
39 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，その適用可能性も
40 * 含めて，いかなる保証も行わない．また，本ソフトウェアの利用により直
41 * 接的または間接的に生じたいかなる損害に関しても，その責任を負わない．
42 *
43 * @(#) $Id: tcp_echo_srv2.c 270 2017-02-09 04:03:47Z coas-nagasima $
44 */
45
46/*
47 * TCP ECHO サーバ #2
48 *
49 * ・送受信タスク分離型
50 * ・ノンブロッキングコール
51 * ・IPv4/IPv6
52 */
53
54#ifdef TARGET_KERNEL_ASP
55
56#include <kernel.h>
57#include <sil.h>
58#include <t_syslog.h>
59#include "kernel_cfg.h"
60#include "tinet_cfg.h"
61
62#endif /* of #ifdef TARGET_KERNEL_ASP */
63
64#ifdef TARGET_KERNEL_JSP
65
66#include <t_services.h>
67#include "kernel_id.h"
68#include "tinet_id.h"
69
70#endif /* of #ifdef TARGET_KERNEL_JSP */
71
72#include <tinet_defs.h>
73#include <tinet_config.h>
74
75#include <net/if.h>
76#include <net/if_ppp.h>
77#include <net/if_loop.h>
78#include <net/ethernet.h>
79#include <net/net_timer.h>
80
81#include <netinet/in.h>
82#include <netinet/in_itron.h>
83#include <netinet/ip.h>
84#include <netinet/ip6.h>
85#include <netinet/tcp.h>
86
87#include <netapp/netapp.h>
88#include <netapp/netapp_var.h>
89#include <netapp/echo.h>
90
91#ifdef USE_TCP_ECHO_SRV2
92
93/*
94 * 表示
95 */
96
97/*#define SHOW_RCV_RANGE*/
98
99/*
100 * コネクション切断方法の指定
101 */
102
103/*#define USE_TCP_SHT_CEP*/
104
105/*
106 * å…
107¨åŸŸå¤‰æ•°
108 */
109
110/* TCP 送受信ウィンドバッファ */
111
112#ifndef TCP_CFG_SWBUF_CSAVE
113uint8_t tcp_echo_srv_swbuf[NUM_TCP_ECHO_SRV_TASKS][TCP_ECHO_SRV_SWBUF_SIZE];
114#endif
115
116#ifndef TCP_CFG_RWBUF_CSAVE
117uint8_t tcp_echo_srv_rwbuf[NUM_TCP_ECHO_SRV_TASKS][TCP_ECHO_SRV_RWBUF_SIZE];
118#endif
119
120/*
121 * 変数
122 */
123
124/*
125 * 注意:
126 *
127 * BUF_SIZE は TCP の
128 * 送信ウインドウバッファサイズ + 受信ウインドウバッファサイズの
129 * 3/2 倍以上の大きさがなければ、デッドロックする可能性がある。
130 */
131
132#define BUF_SIZE ((TCP_ECHO_SRV_SWBUF_SIZE + \
133 TCP_ECHO_SRV_RWBUF_SIZE) * 3 / 2)
134
135static char buffer[BUF_SIZE]; /* バッファ */
136
137static T_IPEP dst; /* 接続相手 */
138static bool_t ena_rcv; /* 受信可能フラグ */
139static char *rptr = buffer; /* 受信ポインタ */
140static char *sptr = buffer; /* 送信ポインタ */
141static uint32_t rcv_total; /* 受信文字数 */
142static uint32_t snd_total; /* 送信文字数 */
143static uint16_t chars; /* バッファ内
144の文字数 */
145static uint16_t rcv_count; /* 受信回数 */
146static uint16_t snd_count; /* 送信回数 */
147
148#ifdef USE_TCP_NON_BLOCKING
149
150static ER rcv_error = E_OK; /* 受信、ノンブロッキングコールエラー */
151static ER snd_error = 1; /* 送信、ノンブロッキングコールエラー */
152
153/*
154 * ノンブロッキングコールのコールバック関数
155 */
156
157ER
158callback_nblk_tcp_echo_srv (ID cepid, FN fncd, void *p_parblk)
159{
160 ER error = E_OK;
161 ER_UINT slen, rlen;
162 SYSTIM now;
163 uint16_t last;
164 char head, tail;
165
166 get_tim(&now);
167
168 switch (fncd) {
169
170 case TFN_TCP_ACP_CEP:
171 rcv_error = *(ER*)p_parblk;
172 if (rcv_error == E_OK) {
173 sptr = rptr = buffer;
174 snd_count = snd_total = rcv_count = rcv_total = chars = 0;
175 snd_error = 1;
176 ena_rcv = true;
177 syslog(LOG_NOTICE, "[TES:%02d CBN] connected: %6ld, from: %s.%d",
178 cepid, now / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
179 }
180 else
181 syslog(LOG_NOTICE, "[TES:%02d CBN] accept error: %s\n", cepid, itron_strerror(rcv_error));
182
183 syscall(sig_sem(SEM_TCP_ECHO_SRV_RCV_READY));
184 break;
185
186 case TFN_TCP_SND_DAT:
187 slen = snd_error = *(ER*)p_parblk;
188 if (slen > 0) {
189 head = *sptr;
190 tail = *(sptr + slen - 1);
191#ifdef SHOW_RCV_RANGE
192 syslog(LOG_NOTICE, "[TES:%02d CBN] send len: %4d, data %02x -> %02x",
193 cepid, (uint16_t)slen, head, tail);
194#endif /* of #ifdef SHOW_RCV_RANGE */
195 snd_count ++;
196 snd_total += slen;
197
198 syscall(wai_sem(SEM_TCP_ECHO_SRV_LOCK));
199
200 /* 送信ポインタを進める。*/
201 if (sptr - buffer + slen >= sizeof(buffer))
202 sptr -= sizeof(buffer) - slen;
203 else
204 sptr += slen;
205
206 /* バッファ内
207の文字数を減らす。*/
208 last = chars;
209 chars -= slen;
210
211 /* バッファ内
212に文字があれば、送信タスクを起床する。*/
213 if (chars > 0 || (!ena_rcv && chars == 0))
214 sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
215
216 /* 受信可能で、バッファ内
217に空きができれば、受信タスクを起床する。*/
218 if (ena_rcv && last == sizeof(buffer) && sizeof(buffer) - chars > 0)
219 syscall(sig_sem(SEM_TCP_ECHO_SRV_RCV_READY));
220
221 syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
222 }
223 else {
224 syslog(LOG_NOTICE, "[TES:%02d CBN] send error = %s", cepid, itron_strerror(snd_error));
225 sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
226 }
227 break;
228
229 case TFN_TCP_RCV_DAT:
230 rlen = rcv_error = *(ER*)p_parblk;
231 if (rlen > 0) {
232 head = *rptr;
233 tail = *(rptr + rlen - 1);
234#ifdef SHOW_RCV_RANGE
235 syslog(LOG_NOTICE, "[TES:%02d CBN] recv len: %4d, data %02x -> %02x",
236 cepid, (uint16_t)rlen, head, tail);
237#endif /* of #ifdef SHOW_RCV_RANGE */
238 rcv_count ++;
239 rcv_total += rlen;
240
241 syscall(wai_sem(SEM_TCP_ECHO_SRV_LOCK));
242
243 /* 受信ポインタを進める。*/
244 if (rptr - buffer + rlen >= sizeof(buffer))
245 rptr -= sizeof(buffer) - rlen;
246 else
247 rptr += rlen;
248
249 /* バッファ内
250の文字数を増やす。*/
251 last = chars;
252 chars += rlen;
253
254 /* バッファ内
255に文字がå…
256¥ã‚Œã°ã€é€ä¿¡ã‚¿ã‚¹ã‚¯ã‚’起床する。*/
257 if (last == 0 && chars > 0)
258 sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
259
260 /* バッファ内
261に空きがあれば、受信タスクを起床する。*/
262 if (sizeof(buffer) - chars > 0)
263 sig_sem(SEM_TCP_ECHO_SRV_RCV_READY);
264
265 syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
266 }
267 else {
268 if (rlen < 0)
269 syslog(LOG_NOTICE, "[TES:%02d CBN] recv error = %s", cepid, itron_strerror(rcv_error));
270 sig_sem(SEM_TCP_ECHO_SRV_RCV_READY);
271 }
272 break;
273
274 case TFN_TCP_CLS_CEP:
275 snd_error = *(ER*)p_parblk;
276 if (snd_error != E_OK)
277 syslog(LOG_NOTICE, "[TES:%02d CBN] close error = %s", cepid, itron_strerror(snd_error));
278
279 syslog(LOG_NOTICE, "[TES:%02d CBN] finished: %6ld, snd: %4d, rcv: %4d, len: %ld",
280 cepid, now / SYSTIM_HZ, snd_count, rcv_count, snd_total);
281
282 sig_sem(SEM_TCP_ECHO_SRV_CLS_READY);
283 break;
284
285 case TFN_TCP_CON_CEP:
286 case TFN_TCP_GET_BUF:
287 case TFN_TCP_RCV_BUF:
288 case TFN_TCP_SND_OOB:
289 default:
290 error = E_PAR;
291 }
292 return error;
293 }
294
295/*
296 * TCP ECHO サーバ受信ルーチン (ノンブロッキングコール使用)
297 */
298
299ER
300tcp_echo_srv_rcv (ID cepid, ID repid)
301{
302 ER error;
303 uint16_t blen;
304
305 if ((error = psnd_dtq(DTQ_TCP_ECHO_SRV_SND, (intptr_t)cepid)) != E_OK) {
306 syslog(LOG_NOTICE, "[TES:%02d RCV] sync error: %s", cepid, itron_strerror(error));
307 return error;
308 }
309
310 if ((error = TCP_ACP_CEP(cepid, repid, &dst, TMO_NBLK)) != E_WBLK) {
311 syslog(LOG_NOTICE, "[TES:%02d ACP] accept error = %s", cepid, itron_strerror(error));
312 return error;
313 }
314
315 /* コネクション開設完了まで待
316つ。*/
317 syscall(wai_sem(SEM_TCP_ECHO_SRV_RCV_READY));
318
319 /* 待
320っている間にエラーになったら、コネクションの開設待
321ちに戻る。*/
322 if (rcv_error != E_OK)
323 return rcv_error;
324
325#ifdef USE_TCP_EXTENTIONS
326 if ((error = free_tcp_rep(repid, true)) != E_OK) {
327 syslog(LOG_NOTICE, "[TES:%02d DEL] REP delete error: %s", cepid, itron_strerror(error));
328 return error;
329 }
330#endif /* of #ifdef USE_TCP_EXTENTIONS */
331
332 while (true) {
333
334 /* 受信サイズを計算する。*/
335 syscall(wai_sem(SEM_TCP_ECHO_SRV_LOCK));
336 if (sptr > rptr)
337 blen = sptr - rptr;
338 else
339 blen = sizeof(buffer) - (rptr - buffer);
340 syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
341
342 /* 受信する。*/
343 if ((error = tcp_rcv_dat(cepid, rptr, blen, TMO_NBLK)) != E_WBLK) {
344 syslog(LOG_NOTICE, "[TES:%02d RCV] recv error = %s", cepid, itron_strerror(error));
345 break;
346 }
347
348 /* 受信バッファに空ができるまで待
349つ。*/
350 syscall(wai_sem(SEM_TCP_ECHO_SRV_RCV_READY));
351
352 /* 待
353っている間に、受信文字数が 0 になるか、エラーになったら終了する。*/
354 if (rcv_error <= 0)
355 break;
356
357 }
358
359 /* 受信完了 */
360 ena_rcv = false;
361
362 /* 受信バッファに文字がå…
363¥ã‚‹ã®ã‚’å¾…
364っている送信タスクを起床する。*/
365 if (chars == 0)
366 sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
367
368 /* コネクション切断完了まで待
369つ。*/
370 syscall(wai_sem(SEM_TCP_ECHO_SRV_CLS_READY));
371
372 return error == E_WBLK ? E_OK : error;
373 }
374
375/*
376 * TCP ECHO サーバ送信タスク (ノンブロッキングコール使用)
377 */
378
379void
380tcp_echo_srv_snd_task(intptr_t exinf)
381{
382 ER error;
383 ID tskid, cepid;
384 uint16_t blen;
385
386 get_tid(&tskid);
387 syslog(LOG_NOTICE, "[TCP ECHO SRV (NBLK) SND:%d] started.", tskid);
388 while (true) {
389 if ((error = rcv_dtq(DTQ_TCP_ECHO_SRV_SND, (intptr_t*)&cepid)) != E_OK) {
390 syslog(LOG_NOTICE, "[TES:%02d SND] sync error: %s",
391 cepid, itron_strerror(error));
392 continue;
393 }
394
395 while (true) {
396
397 /* バッファに文字がå…
398¥ã‚‹ã¾ã§å¾…
399つ。*/
400 syscall(wai_sem(SEM_TCP_ECHO_SRV_SND_READY));
401
402 /* 待
403っている間にエラーになったら終了する。*/
404 if (snd_error <= 0)
405 break;
406
407 /* 受信完了で、バッファに文字がなければ終了する。*/
408 if (!ena_rcv && chars == 0)
409 break;
410
411 /* 送信サイズを計算する。*/
412 syscall(wai_sem(SEM_TCP_ECHO_SRV_LOCK));
413 if (rptr > sptr)
414 blen = rptr - sptr;
415 else
416 blen = sizeof(buffer) - (sptr - buffer);
417 syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
418
419 /* 送信する。*/
420 if ((error = tcp_snd_dat(cepid, sptr, blen, TMO_NBLK)) != E_WBLK) {
421 syslog(LOG_NOTICE, "[TES:%02d SND] send error = %s", cepid, itron_strerror(error));
422 break;
423 }
424 }
425
426 /* 受信バッファに空ができるを待
427っている受信タスクを起床する。*/
428 if (chars == sizeof(buffer))
429 sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
430
431#ifdef USE_TCP_SHT_CEP
432 if ((error = tcp_sht_cep(cepid)) != E_OK)
433 syslog(LOG_NOTICE, "[TES:%02d SND] shutdown error = %s", cepid, itron_strerror(error));
434#endif /* of #ifdef USE_TCP_SHT_CEP */
435
436 if ((error = tcp_cls_cep(cepid, TMO_NBLK)) != E_WBLK) {
437 syslog(LOG_NOTICE, "[TES:%02d SND] close error = %s", cepid, itron_strerror(error));
438 }
439
440 pol_sem(SEM_TCP_ECHO_SRV_SND_READY);
441 pol_sem(SEM_TCP_ECHO_SRV_RCV_READY);
442 }
443 }
444
445#else /* of #ifdef USE_TCP_NON_BLOCKING */
446
447/*
448 * TCP ECHO サーバ受信ルーチン
449 */
450
451ER
452tcp_echo_srv_rcv (ID cepid, ID repid)
453{
454 ER_UINT rlen;
455 ER error;
456 SYSTIM now;
457 uint16_t blen, last;
458 char head, tail;
459
460 if ((error = psnd_dtq(DTQ_TCP_ECHO_SRV_SND, (intptr_t)cepid)) != E_OK) {
461 syslog(LOG_NOTICE, "[TES:%02d RCV] sync error: %s", cepid, itron_strerror(error));
462 return error;
463 }
464
465 if ((error = TCP_ACP_CEP(cepid, repid, &dst, TMO_FEVR)) != E_OK) {
466 syslog(LOG_NOTICE, "[TES:%02d ACP] accept error = %s", cepid, itron_strerror(error));
467 return error;
468 }
469
470#ifdef USE_TCP_EXTENTIONS
471 if ((error = free_tcp_rep(repid, true)) != E_OK) {
472 syslog(LOG_NOTICE, "[TES:%02d DEL] REP delete error: %s", cepid, itron_strerror(error));
473 return error;
474 }
475#endif /* of #ifdef USE_TCP_EXTENTIONS */
476
477 syscall(get_tim(&now));
478 syslog(LOG_NOTICE, "[TES:%02d ACP] connected: %6ld, from: %s.%d",
479 cepid, now / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
480 sptr = rptr = buffer;
481 snd_count = snd_total = rcv_count = rcv_total = chars = 0;
482 ena_rcv = true;
483 while (true) {
484
485 /* 受信サイズを計算する。*/
486 syscall(wai_sem(SEM_TCP_ECHO_SRV_LOCK));
487 if (sptr > rptr)
488 blen = sptr - rptr;
489 else
490 blen = sizeof(buffer) - (rptr - buffer);
491 syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
492
493 /* 受信する。*/
494 if ((rlen = tcp_rcv_dat(cepid, rptr, blen, TMO_FEVR)) <= 0) {
495 if (rlen < 0)
496 syslog(LOG_NOTICE, "[TES:%02d RCV] recv error = %s",
497 cepid, itron_strerror(rlen));
498 break;
499 }
500 head = *rptr;
501 tail = *(rptr + rlen - 1);
502#ifdef SHOW_RCV_RANGE
503 syslog(LOG_NOTICE, "[TES:%02d RCV] len: %4d, data %02x -> %02x",
504 cepid, (uint16_t)rlen, head, tail);
505#endif /* of #ifdef SHOW_RCV_RANGE */
506 rcv_count ++;
507 rcv_total += rlen;
508
509 syscall(wai_sem(SEM_TCP_ECHO_SRV_LOCK));
510
511 /* 受信ポインタを進める。*/
512 if (rptr - buffer + rlen >= sizeof(buffer))
513 rptr -= sizeof(buffer) - rlen;
514 else
515 rptr += rlen;
516
517 /* バッファ内
518の文字数を増やす。*/
519 last = chars;
520 chars += (uint16_t)rlen;
521
522 /* バッファ内
523に文字がå…
524¥ã‚Œã°ã€é€ä¿¡ã‚¿ã‚¹ã‚¯ã‚’起床する。*/
525 if (last == 0 && chars > 0)
526 sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
527
528 /* バッファ内
529に空きがあれば、受信タスクを起床する。*/
530 if (sizeof(buffer) - chars > 0)
531 sig_sem(SEM_TCP_ECHO_SRV_RCV_READY);
532
533 syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
534
535 /* バッファに空きができるまで待
536つ。*/
537 syscall(wai_sem(SEM_TCP_ECHO_SRV_RCV_READY));
538 }
539
540 /* 受信完了 */
541 ena_rcv = false;
542
543 /* 受信バッファに文字がå…
544¥ã‚‹ã®ã‚’å¾…
545っている送信タスクを起床する。*/
546 if (chars == 0)
547 sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
548
549 /* コネクションの切断が完了するまで待
550つ。*/
551 syscall(wai_sem(SEM_TCP_ECHO_SRV_CLS_READY));
552
553 return error;
554 }
555
556/*
557 * TCP ECHO サーバ送信タスク
558 */
559
560void
561tcp_echo_srv_snd_task(intptr_t exinf)
562{
563 ID tskid, cepid;
564 ER error;
565 ER_UINT slen;
566 SYSTIM now;
567 uint16_t blen, last;
568 char head, tail;
569
570 get_tid(&tskid);
571 syslog(LOG_NOTICE, "[TCP ECHO SRV SND:%d] started.", tskid);
572 while (true) {
573 if ((error = rcv_dtq(DTQ_TCP_ECHO_SRV_SND, (intptr_t*)&cepid)) != E_OK) {
574 syslog(LOG_NOTICE, "[TES:%02d SND] sync error: %s",
575 cepid, itron_strerror(error));
576 continue;
577 }
578
579 while (true) {
580
581 /* バッファに文字がå…
582¥ã‚‹ã¾ã§å¾…
583つ。*/
584 syscall(wai_sem(SEM_TCP_ECHO_SRV_SND_READY));
585
586 /* 受信完了で、バッファに文字がなければ終了する。*/
587 if (!ena_rcv && chars == 0)
588 break;
589
590 /* 送信サイズを計算する。*/
591 syscall(wai_sem(SEM_TCP_ECHO_SRV_LOCK));
592 if (rptr > sptr)
593 blen = rptr - sptr;
594 else
595 blen = sizeof(buffer) - (sptr - buffer);
596 syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
597
598 if ((slen = tcp_snd_dat(cepid, sptr, blen, TMO_FEVR)) <= 0) {
599 syslog(LOG_NOTICE, "[TES:%02d SND] send error = %s", cepid, itron_strerror(slen));
600 break;
601 }
602
603 head = *sptr;
604 tail = *(sptr + slen - 1);
605#ifdef SHOW_RCV_RANGE
606 syslog(LOG_NOTICE, "[TES:%02d SND] len: %4d, data %02x -> %02x",
607 cepid, (uint16_t)slen, head, tail);
608#endif /* of #ifdef SHOW_RCV_RANGE */
609 snd_count ++;
610 snd_total += slen;
611
612 syscall(wai_sem(SEM_TCP_ECHO_SRV_LOCK));
613
614 /* 送信ポインタを進める。*/
615 if (sptr - buffer + slen >= sizeof(buffer))
616 sptr -= sizeof(buffer) - slen;
617 else
618 sptr += slen;
619
620 /* バッファ内
621の文字数を減らす。*/
622 last = chars;
623 chars -= (uint16_t)slen;
624
625 /* 受信完了で、バッファに文字がなければ終了する。*/
626 if (!ena_rcv && chars == 0) {
627 syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
628 break;
629 }
630
631 /* バッファ内
632に文字があれば、送信タスクを起床する。*/
633 if (chars > 0)
634 sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
635
636 /* 受信可能で、バッファ内
637に空きができれば、受信タスクを起床する。*/
638 if (ena_rcv && last == sizeof(buffer) && sizeof(buffer) - chars > 0)
639 sig_sem(SEM_TCP_ECHO_SRV_RCV_READY);
640
641 syscall(sig_sem(SEM_TCP_ECHO_SRV_LOCK));
642 }
643
644 /* 受信バッファに空ができるを待
645っている受信タスクを起床する。*/
646 if (chars == sizeof(buffer))
647 sig_sem(SEM_TCP_ECHO_SRV_SND_READY);
648
649#ifdef USE_TCP_SHT_CEP
650 if ((error = tcp_sht_cep(cepid)) != E_OK)
651 syslog(LOG_NOTICE, "[TES:%02d SND] shtudown error = %s", cepid, itron_strerror(error));
652#endif /* of #ifdef USE_TCP_SHT_CEP */
653
654 if ((error = tcp_cls_cep(cepid, TMO_FEVR)) != E_OK)
655 syslog(LOG_NOTICE, "[TES:%02d SND] close error = %s", cepid, itron_strerror(error));
656
657 get_tim(&now);
658 syslog(LOG_NOTICE, "[TES:%02d SND] finished: %6ld, snd: %4d, rcv: %4d, len: %ld",
659 cepid, now / SYSTIM_HZ, snd_count, rcv_count, snd_total);
660
661 sig_sem(SEM_TCP_ECHO_SRV_CLS_READY);
662
663 pol_sem(SEM_TCP_ECHO_SRV_SND_READY);
664 pol_sem(SEM_TCP_ECHO_SRV_RCV_READY);
665 }
666 }
667
668#endif /* of #ifdef USE_TCP_NON_BLOCKING */
669
670#ifdef USE_TCP_EXTENTIONS
671
672/*
673 * get_tcp_rep -- TCP 受付口を獲得する。
674 */
675
676static ER
677get_tcp_rep (ID *repid)
678{
679 ID tskid;
680 T_TCP_CREP crep;
681
682 get_tid(&tskid);
683
684 crep.repatr = UINT_C(0);
685 crep.myaddr.portno = UINT_C(7);
686
687#if defined(SUPPORT_INET4)
688 crep.myaddr.ipaddr = IPV4_ADDRANY;
689#endif
690
691#if defined(SUPPORT_INET6)
692 memcpy(&crep.myaddr.ipaddr, &ipv6_addrany, sizeof(T_IN6_ADDR));
693#endif
694
695 return alloc_tcp_rep(repid, tskid, &crep);
696 }
697
698/*
699 * get_tcp_cep -- TCP 通信端点を獲得する。
700 */
701
702static ER
703get_tcp_cep (ID *cepid)
704{
705 ID tskid;
706 T_TCP_CCEP ccep;
707
708 get_tid(&tskid);
709
710 ccep.cepatr = UINT_C(0);
711 ccep.sbufsz = TCP_ECHO_SRV_SWBUF_SIZE;
712 ccep.rbufsz = TCP_ECHO_SRV_RWBUF_SIZE;
713
714#ifdef TCP_CFG_SWBUF_CSAVE
715 ccep.sbuf = NADR;
716#else
717 ccep.sbuf = tcp_echo_srv_swbuf;
718#endif
719#ifdef TCP_CFG_RWBUF_CSAVE
720 ccep.rbuf = NADR;
721#else
722 ccep.rbuf = tcp_echo_srv_rwbuf;
723#endif
724#ifdef USE_TCP_NON_BLOCKING
725 ccep.callback = (FP)callback_nblk_tcp_echo_srv;
726#else
727 ccep.callback = NULL;
728#endif
729
730 return alloc_tcp_cep(cepid, tskid, &ccep);
731 }
732
733/*
734 * TCP ECHO サーバ受信タスク
735 */
736
737void
738tcp_echo_srv_rcv_task (intptr_t exinf)
739{
740 ID tskid, cepid, repid;
741 ER error = E_OK;
742
743 syscall(get_tid(&tskid));
744 syslog(LOG_NOTICE, "[TCP ECHO SRV:%d] started.", tskid);
745 while (true) {
746
747 syscall(slp_tsk());
748 if ((error = get_tcp_cep (&cepid)) != E_OK) {
749 syslog(LOG_NOTICE, "[TES:00 EXT] CEP create error: %s", itron_strerror(error));
750 continue;
751 }
752
753 while (true) {
754
755 if ((error = get_tcp_rep (&repid)) != E_OK) {
756 syslog(LOG_NOTICE, "[TES:00 EXT] REP create error: %s", itron_strerror(error));
757 break;
758 }
759 else if ((error = tcp_echo_srv_rcv(cepid, repid)) != E_OK) {
760 error = free_tcp_rep(repid, error != E_DLT);
761 break;
762 }
763 }
764
765 if ((error = free_tcp_cep(cepid)) != E_OK)
766 syslog(LOG_NOTICE, "[TES:%02d EXT] CEP delete error: %s", cepid, itron_strerror(error));
767
768 }
769 }
770
771#else /* of #ifdef USE_TCP_EXTENTIONS */
772
773void
774tcp_echo_srv_rcv_task(intptr_t exinf)
775{
776 ID tskid;
777
778 get_tid(&tskid);
779 syslog(LOG_NOTICE, "[TCP ECHO SRV RCV:%d,%d] started.", tskid, (ID)exinf);
780 while (true) {
781 while (tcp_echo_srv_rcv((ID)exinf, TCP_ECHO_SRV_REPID) == E_OK)
782 ;
783 }
784 }
785
786#endif /* of #ifdef USE_TCP_EXTENTIONS */
787
788#endif /* of #ifdef USE_TCP_ECHO_SRV2 */
Note: See TracBrowser for help on using the repository browser.