source: azure_iot_hub/trunk/asp3_dcre/tinet/netapp/udp6_echo_srv.c@ 388

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

Azure IoT Hub Device C SDK を使ったサンプルの追加
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc
File size: 8.3 KB
Line 
1/*
2 * TINET (TCP/IP Protocol Stack)
3 *
4 * Copyright (C) 2001-2017 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: udp6_echo_srv.c 388 2019-05-22 11:25:18Z coas-nagasima $
44 */
45
46/*
47 * UDP ECHO サーバ
48 *
49 * IPv6
50 */
51
52#include <string.h>
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
61#endif /* of #ifdef TARGET_KERNEL_ASP */
62
63#ifdef TARGET_KERNEL_JSP
64
65#include <t_services.h>
66#include "kernel_id.h"
67#include "tinet_id.h"
68
69#endif /* of #ifdef TARGET_KERNEL_JSP */
70
71#include <netinet/in.h>
72#include <netinet/in_itron.h>
73
74#include <netapp/netapp.h>
75#include <netapp/netapp_var.h>
76#include <netapp/udp6_echo_srv.h>
77
78#ifdef USE_UDP6_ECHO_SRV_TSK
79
80/*
81 * 受信タイムアウト
82 */
83
84#define RCV_TMOUT TMO_FEVR
85//#define RCV_TMOUT (30*ULONG_C(1000))
86
87#define BUF_SIZE 2048
88
89static char echo_rcv_buf[BUF_SIZE];
90static T_IPV6EP dst;
91
92#ifdef USE_UDP_CALL_BACK
93
94/*
95 * コールバック関数
96 */
97
98ER
99callback_udp6_echo_srv (ID cepid, FN fncd, void *p_parblk)
100{
101 ER_UINT len;
102 SYSTIM now;
103
104 if ((len = udp6_rcv_dat(cepid, &dst, echo_rcv_buf, sizeof(echo_rcv_buf), TMO_FEVR)) >= 0) {
105 echo_rcv_buf[len] = '\0';
106 get_tim(&now);
107 syslog(LOG_NOTICE, "[UES6:%02u UCB] recv: %7lu,from: %s.%d\n"
108 " msg: %s",
109 cepid, now / SYSTIM_HZ, ipv62str(NULL, &dst.ipaddr), dst.portno, echo_rcv_buf);
110 if (len > 0) {
111 len = udp6_snd_dat(cepid, &dst, echo_rcv_buf, len, TMO_FEVR);
112 get_tim(&now);
113 if (len >= 0)
114 syslog(LOG_NOTICE, "[UES6:%02u UCB] send: %7lu, len: %d",
115 cepid, now / SYSTIM_HZ, len);
116 else
117 syslog(LOG_NOTICE, "[UES6:%02u UCB] error: %7lu,%s",
118 cepid, now / SYSTIM_HZ, itron_strerror(len));
119 }
120 len = E_OK;
121 }
122 else {
123 get_tim(&now);
124 syslog(LOG_NOTICE, "[UES6:%02u UCB] recv: %7lu,%s",
125 cepid, now / SYSTIM_HZ, itron_strerror(len));
126 }
127
128 return len;
129 }
130
131#else /* of #ifdef USE_UDP_CALL_BACK */
132
133#ifdef USE_UDP_NON_BLOCKING
134
135/*
136 * 変数
137 */
138
139static ER_UINT nblk_len;
140
141/*
142 * ノンブロッキングコールのコールバック関数
143 */
144
145ER
146callback_nblk_udp6_echo_srv (ID cepid, FN fncd, void *p_parblk)
147{
148 SYSTIM now;
149
150 get_tim(&now);
151 nblk_len = *(ER_UINT*)p_parblk;
152 if (nblk_len < 0) { /* 0 以下の場合は、エラーコード */
153 syslog(LOG_NOTICE, "[UES6:%02u CBR] error: %7lu,%s, fncd: %s",
154 cepid, now / SYSTIM_HZ, itron_strerror(nblk_len), in_strtfn(fncd));
155 }
156 else if (fncd == TFN_UDP_RCV_DAT) {
157 echo_rcv_buf[nblk_len] = '\0';
158 syslog(LOG_NOTICE, "[UES6:%02u CBR] recv: %7lu,from: %s.%d\n"
159 " msg: %s",
160 cepid, now / SYSTIM_HZ, ipv62str(NULL, &dst.ipaddr), dst.portno, echo_rcv_buf);
161 }
162 syscall(wup_tsk(UDP6_ECHO_SRV_TASK));
163 return E_OK;
164 }
165
166/*
167 * UDP ECHO サーバ
168 */
169
170ER
171udp6_echo_srv (ID cepid)
172{
173 ER error;
174 SYSTIM now;
175
176 if ((error = udp6_rcv_dat(cepid, &dst, echo_rcv_buf, sizeof(echo_rcv_buf), TMO_NBLK)) != E_WBLK) {
177 get_tim(&now);
178 syslog(LOG_NOTICE, "[UES6:%02u RCV] error: %7lu,%s", cepid, now / SYSTIM_HZ, itron_strerror(error));
179 return error;
180 }
181
182 syscall(slp_tsk());
183 if (nblk_len < 0)
184 error = nblk_len;
185 else {
186 if ((error = udp6_snd_dat(cepid, &dst, echo_rcv_buf, nblk_len, TMO_NBLK)) != E_WBLK) {
187 get_tim(&now);
188 syslog(LOG_NOTICE, "[UES6:%02u SND] error %7lu,%s",
189 cepid, now / SYSTIM_HZ, itron_strerror(error));
190 return error;
191 }
192
193 syscall(slp_tsk());
194 if (nblk_len < 0)
195 error = nblk_len;
196 else {
197 get_tim(&now);
198 syslog(LOG_NOTICE, "[UES6:%02u SND] send: %7lu, len: %d",
199 cepid, now / SYSTIM_HZ, nblk_len);
200 error = E_OK;
201 }
202 }
203
204 return error;
205 }
206
207#else /* of #ifdef USE_UDP_NON_BLOCKING */
208
209/*
210 * UDP ECHO サーバ
211 */
212
213ER
214udp6_echo_srv (ID cepid)
215{
216 ER_UINT len;
217 SYSTIM now;
218
219 if ((len = udp6_rcv_dat(cepid, &dst, echo_rcv_buf, sizeof(echo_rcv_buf), RCV_TMOUT)) >= 0) {
220 get_tim(&now);
221 echo_rcv_buf[len] = '\0';
222 syslog(LOG_NOTICE, "[UES6:%02u RCV] recv: %7lu,from: %s.%d\n"
223 " msg: %s",
224 cepid, now / SYSTIM_HZ, ipv62str(NULL, &dst.ipaddr), dst.portno, echo_rcv_buf);
225 if (len > 0) {
226 len = udp6_snd_dat(cepid, &dst, echo_rcv_buf, len, TMO_FEVR);
227 get_tim(&now);
228 if (len >= 0)
229 syslog(LOG_NOTICE, "[UES6:%02u SND] send: %7lu, len: %d",
230 cepid, now / SYSTIM_HZ, (uint16_t)len);
231 else
232 syslog(LOG_NOTICE, "[UES6:%02u SND] error: %7lu,%s",
233 cepid, now / SYSTIM_HZ, itron_strerror(len));
234 }
235 }
236 else {
237 get_tim(&now);
238 syslog(LOG_NOTICE, "[UES6:%02u RCV] error: %7lu,%s",
239 cepid, now / SYSTIM_HZ, itron_strerror(len));
240 }
241
242 return len >= 0 || len == E_TMOUT ? E_OK : len;
243 }
244
245#endif /* of #ifdef USE_UDP_NON_BLOCKING */
246
247/*
248 * UDP ECHO サーバタスク
249 */
250
251#ifdef USE_UDP_EXTENTIONS
252
253void
254udp6_echo_srv_task (intptr_t exinf)
255{
256 ID tskid, cepid;
257 ER error;
258 T_UDP6_CCEP ccep;
259
260 get_tid(&tskid);
261 syslog(LOG_NOTICE, "[UDP6 ECHO SRV(EXT):%d] started.", tskid);
262 while (true) {
263
264 syscall(slp_tsk());
265 syslog(LOG_NOTICE, "[UDP6 ECHO SRV(EXT):%d] wake up.", tskid);
266
267 ccep.cepatr = UINT_C(0);
268 ccep.myaddr.portno = UINT_C(7);
269 memcpy(&ccep.myaddr.ipaddr, &ipv6_addrany, sizeof(T_IN6_ADDR));
270
271#ifdef USE_UDP_NON_BLOCKING
272 ccep.callback = (FP)callback_nblk_udp6_echo_srv;
273#else
274 ccep.callback = NULL;
275#endif
276
277 if ((error = alloc_udp6_cep(&cepid, tskid, &ccep)) != E_OK) {
278 syslog(LOG_NOTICE, "[UES6:%02u TSK] CEP create error:%s", cepid, itron_strerror(error));
279 continue;
280 }
281
282 while (error == E_OK) {
283 if ((error = udp6_echo_srv(cepid)) != E_OK) {
284 if ((error = free_udp6_cep(cepid, !(error == E_NOEXS || error == E_DLT))) != E_OK)
285 syslog(LOG_NOTICE, "[UES6:%02u TSK] CEP delete error:%s", cepid, itron_strerror(error));
286 break;
287 }
288 }
289
290 }
291 slp_tsk();
292 }
293
294#else /* of #ifdef USE_UDP_EXTENTIONS */
295
296void
297udp6_echo_srv_task (intptr_t exinf)
298{
299 ID tskid;
300 ER error = E_OK;
301
302 get_tid(&tskid);
303 syslog(LOG_NOTICE, "[UDP6 ECHO SRV:%d,%d] started.", tskid, (ID)exinf);
304 while (error == E_OK) {
305 error = udp6_echo_srv((ID)exinf);
306 }
307 slp_tsk();
308 }
309
310#endif /* of #ifdef USE_UDP_EXTENTIONS */
311
312#endif /* of #ifdef USE_UDP_CALL_BACK */
313
314#endif /* of #ifdef USE_UDP6_ECHO_SRV_TSK */
Note: See TracBrowser for help on using the repository browser.