source: azure_iot_hub/trunk/asp3_dcre/tinet/netinet/udpn_usrreq.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: 21.5 KB
Line 
1/*
2 * TINET (UDP/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: udpn_usrreq.c 388 2019-05-22 11:25:18Z coas-nagasima $
44 */
45
46/*
47 * Copyright (c) 1982, 1986, 1988, 1990, 1993, 1995
48 * The Regents of the University of California. All rights reserved.
49 *
50 * Redistribution and use in source and binary forms, with or without
51 * modification, are permitted provided that the following conditions
52 * are met:
53 * 1. Redistributions of source code must retain the above copyright
54 * notice, this list of conditions and the following disclaimer.
55 * 2. Redistributions in binary form must ceproduce the above copyright
56 * notice, this list of conditions and the following disclaimer in the
57 * documentation and/or other materials provided with the distribution.
58 * 3. All advertising materials mentioning features or use of this software
59 * must display the following acknowledgement:
60 * This product includes software developed by the University of
61 * California, Berkeley and its contributors.
62 * 4. Neither the name of the University nor the names of its contributors
63 * may be used to endorse or promote products derived from this software
64 * without specific prior written permission.
65 *
66 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
67 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
68 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
69 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
70 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
71 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
72 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
73 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
74 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
75 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
76 * SUCH DAMAGE.
77 *
78 * @(#)udp_usrreq.c 8.6 (Berkeley) 5/23/95
79 * $FreeBSD: src/sys/netinet/udp_usrreq.c,v 1.49.2.2 1999/08/29 16:29:58 peter Exp $
80 */
81
82#ifdef __udp_send_data
83
84/*
85 * udp_send_data -- パケット送信の主要部
86 */
87
88ER_UINT
89UDP_SEND_DATA (T_UDP_CEP *cep, T_IPEP *p_dstaddr, void *data, int_t len, TMO tmout)
90{
91 T_NET_BUF *output;
92 T_UDP_HDR *udph;
93 SYSTIM before, after;
94 ER error = E_OK;
95
96#ifdef UDP_CFG_OUT_CHECKSUM
97 uint16_t sum;
98#endif /* of #ifdef UDP_CFG_OUT_CHECKSUM */
99
100 NET_COUNT_UDP(net_count_udp.out_octets, len);
101 NET_COUNT_UDP(net_count_udp.out_packets, 1);
102
103 /* IP データグラム割り当ての時間を tmout から減ずる。*/
104 if (!(tmout == TMO_POL || tmout == TMO_FEVR))
105 syscall(get_tim(&before));
106
107 /* IP データグラムを割り当てる。*/
108 if ((error = IN_GET_DATAGRAM(&output, (uint_t)(UDP_HDR_SIZE + len), 0,
109 &p_dstaddr->ipaddr,
110 &cep->myaddr.ipaddr,
111 IPPROTO_UDP, IP_DEFTTL,
112 NBA_SEARCH_ASCENT, tmout)) != E_OK)
113 goto err_ret;
114
115 /* IP データグラム割り当ての時間を tmout から減ずる。*/
116 if (!(tmout == TMO_POL || tmout == TMO_FEVR)) {
117 syscall(get_tim(&after));
118 if (after - before > tmout) {
119 syscall(rel_net_buf(output));
120 error = E_TMOUT;
121 goto err_ret;
122 }
123 tmout -= (TMO)(after - before);
124 }
125
126 /* UDP ヘッダに情
127報を設定する。*/
128 udph = GET_UDP_HDR(output, IF_IP_UDP_HDR_OFFSET(output));
129 udph->sport = htons(cep->myaddr.portno);
130 udph->dport = htons(p_dstaddr->portno);
131 udph->ulen = htons(UDP_HDR_SIZE + len);
132 udph->sum = 0;
133
134 /* データをコピーする。*/
135 memcpy((void*)GET_UDP_SDU(output, IF_IP_UDP_HDR_OFFSET(output)), data, (size_t)len);
136
137#ifdef UDP_CFG_OUT_CHECKSUM
138
139 sum = IN_CKSUM(output, IPPROTO_UDP, IF_IP_UDP_HDR_OFFSET(output), (uint_t)(UDP_HDR_SIZE + len));
140
141 /* 計算したチェックサムの値が 0 なら 0xffff をå…
142¥ã‚Œã‚‹ã€‚*/
143 if (sum == 0)
144 sum = 0xffff;
145 udph->sum = sum;
146
147#endif /* of #ifdef UDP_CFG_OUT_CHECKSUM */
148
149 /* ネットワークバッファ長を調整する。*/
150 output->len = (uint16_t)(IF_IP_UDP_HDR_SIZE(output) + len);
151
152 /* ネットワーク層 (IP) の出力関数を呼び出す。*/
153 if ((error = IP_OUTPUT(output, tmout)) == E_OK) {
154 NET_COUNT_MIB(udp_stats.udpOutDatagrams, 1);
155 cep->snd_tskid = TA_NULL;
156 return len;
157 }
158
159err_ret:
160 NET_COUNT_UDP(net_count_udp.out_err_packets, 1);
161 cep->snd_tskid = TA_NULL;
162 return error;
163 }
164
165#endif /* of #ifdef __udp_send_data */
166
167/*
168 * udp_cancel_cep -- ペンディングしている処理をキャンセルする。
169 *
170 * udp_can_cep から呼出されるメイン関数
171 */
172
173#ifdef __udp_can_cep
174
175static ER
176UDP_CANCEL_CEP (T_UDP_CEP *cep, FN fncd)
177{
178 ER error = E_OK, snd_err, rcv_err;
179
180 /* UDP 通信端点をチェックする。*/
181 if (!VALID_UDP_CEP(cep))
182 return E_NOEXS;
183
184 /* API 機能コードをチェックする。*/
185 if (!VALID_TFN_UDP_CAN(fncd))
186 return E_PAR;
187
188 /* 通信端点をロックする。*/
189 syscall(wai_sem(cep->semid_lock));
190
191 if (fncd == TFN_UDP_ALL) { /* TFN_UDP_ALL の処理 */
192
193 snd_err = UDP_CAN_SND(cep, E_RLWAI);
194 rcv_err = UDP_CAN_RCV(cep, E_RLWAI);
195
196 /*
197 * snd_err と rcv_err のどちらも EV_NOPND
198 * なら、ペンディングしていないのでエラー
199 */
200 if (snd_err == EV_NOPND && rcv_err == EV_NOPND)
201 error = E_OBJ;
202 else {
203 if (snd_err == EV_NOPND)
204 snd_err = E_OK;
205 if (rcv_err == EV_NOPND)
206 rcv_err = E_OK;
207
208 if (snd_err != E_OK)
209 error = snd_err;
210 else if (rcv_err != E_OK)
211 error = rcv_err;
212 }
213 }
214 else if (fncd == TFN_UDP_SND_DAT) { /* 送信処理のキャンセル */
215 if ((error = UDP_CAN_SND(cep, E_RLWAI)) == EV_NOPND)
216 error = E_OBJ;
217 }
218 else if (fncd == TFN_UDP_RCV_DAT) { /* 受信処理のキャンセル */
219 if ((error = UDP_CAN_RCV(cep, E_RLWAI)) == EV_NOPND)
220 error = E_OBJ;
221 }
222 else
223 error = E_PAR;
224
225 /* 通信端点をロックを解除する。*/
226 syscall(sig_sem(cep->semid_lock));
227
228 return error;
229 }
230
231#endif /* of #ifdef __udp_can_cep */
232
233#if defined(SUPPORT_INET6) && (defined(SUPPORT_INET4) && TNUM_UDP4_CEPID > 0)
234
235#else /* of #if defined(SUPPORT_INET6) && (defined(SUPPORT_INET4) && TNUM_UDP4_CEPID > 0) */
236
237/*
238 * udp_can_cep -- ペンディングしている処理のキャンセル【標準機能】
239 */
240
241#ifdef __udp_can_cep
242
243ER
244udp_can_cep (ID cepid, FN fncd)
245{
246 T_UDP_CEP *cep;
247
248 /* UDP 通信端点 ID をチェックする。*/
249 if (!VALID_UDP_CEPID(cepid))
250 return E_ID;
251
252 /* UDP 通信端点を得る。*/
253 cep = GET_UDP_CEP(cepid);
254
255 /* メイン関数を呼び出す。*/
256 return UDP_CANCEL_CEP(cep, fncd);
257 }
258
259#endif /* of #ifdef __udp_can_cep */
260
261#endif /* of #if defined(SUPPORT_INET6) && (defined(SUPPORT_INET4) && TNUM_UDP4_CEPID > 0) */
262
263#ifdef UDP_CFG_EXTENTIONS
264
265/*
266 * udp_cre_cep -- UDP 通信端点の生成【拡張機能】
267 */
268
269#ifdef __udp_cre_cep
270
271ER
272UDP_CRE_CEP (ID cepid, T_UDPN_CCEP *pk_ccep)
273{
274 T_UDP_CEP *cep;
275 ER error;
276
277 /* UDP 通信端点 ID をチェックする。*/
278 if (!VALID_UDP_CEPID(cepid))
279 return E_ID;
280
281 /* pk_ccep が NULL ならエラー */
282 if (pk_ccep == NULL)
283 return E_PAR;
284
285#if (API_PROTO == API_PROTO_IPV6) && !defined(API_CFG_IP4MAPPED_ADDR)
286
287 /*
288 * API が IPv6 で IPv4 射影アドレスが認められていないのにもかかわらず、
289 * IPv4 射影アドレスが指定されたらエラー
290 */
291 if (in6_is_addr_ipv4mapped(&pk_ccep->myaddr.ipaddr))
292 return E_PAR;
293
294#endif /* of #if (API_PROTO == API_PROTO_IPV6) && !defined(DAPI_CFG_IP4MAPPED_ADDR) */
295
296 /* UDP 通信端点を得る。*/
297 cep = GET_UDP_CEP(cepid);
298
299 /* UDP 通信端点をチェックする。*/
300 if (VALID_UDP_CEP(cep))
301 return E_OBJ;
302
303 /* UDP 通信端点が、動的生成用でなければエラー */
304 if (!DYNAMIC_UDP_CEP(cep))
305 return E_ID;
306
307 /* 通信端点をロックする。*/
308 syscall(wai_sem(cep->semid_lock));
309
310 /*
311 * UDP 通信端点をチェックする。生成済みであればエラー
312 */
313 if (VALID_UDP_CEP(cep))
314 error = E_OBJ;
315 else {
316
317 /*
318 * 自ポート番号が UDP_PORTANY なら、自動で割り当てる。
319 */
320 if (pk_ccep->myaddr.portno == UDP_PORTANY)
321 error = UDP_ALLOC_AUTO_PORT(cep);
322 else
323 error = UDP_ALLOC_PORT(cep, pk_ccep->myaddr.portno);
324
325 if (error == E_OK) {
326 /* UDP 通信端点生成情
327報をコピーする。*/
328 cep->cepatr = pk_ccep->cepatr; /* 通信端点属性 */
329 cep->myaddr.ipaddr = pk_ccep->myaddr.ipaddr; /* 自分のアドレス */
330 cep->callback = (void*)pk_ccep->callback; /* コールバック */
331
332 /* UDP 通信端点を生成済みにする。*/
333 cep->flags |= UDP_CEP_FLG_VALID;
334 }
335 }
336
337 /* 通信端点のロックを解除する。*/
338 syscall(sig_sem(cep->semid_lock));
339
340 return error;
341 }
342
343#endif /* of #ifdef __udp_cre_cep */
344
345#ifdef __udp_del_cep
346
347/*
348 * udp_delete_cep -- UDP 通信端点を削除する。
349 *
350 * udp_del_cep から呼出されるメイン関数
351 */
352
353static ER
354UDP_DELETE_CEP (T_UDP_CEP *cep)
355{
356 ER error;
357
358 /* UDP 通信端点をチェックする。*/
359 if (!VALID_UDP_CEP(cep))
360 return E_NOEXS;
361
362 /* UDP 通信端点が、動的生成用でなければエラー */
363 if (!DYNAMIC_UDP_CEP(cep))
364 return E_ID;
365
366 /* 通信端点をロックする。*/
367 syscall(wai_sem(cep->semid_lock));
368
369 /*
370 * UDP 通信端点をチェックする。未生成の場合はエラー
371 * ・未生成。
372 */
373 if (!VALID_UDP_CEP(cep))
374 error = E_NOEXS;
375 else {
376 UDP_CAN_SND(cep, E_DLT);
377 UDP_CAN_RCV(cep, E_DLT);
378
379 /* UDP 通信端点を未生成にする。*/
380 cep->flags &= ~UDP_CEP_FLG_VALID;
381 error = E_OK;
382 }
383
384 /* 通信端点のロックを解除する。*/
385 syscall(sig_sem(cep->semid_lock));
386
387 return error;
388 }
389
390/*
391 * udp_del_cep -- UDP 通信端点の削除【拡張機能】
392 */
393
394ER
395UDP_DEL_CEP (ID cepid)
396{
397 T_UDP_CEP *cep;
398
399 /* UDP 通信端点 ID をチェックする。*/
400 if (!VALID_UDP_CEPID(cepid))
401 return E_ID;
402
403 /* UDP 通信端点を得る。*/
404 cep = GET_UDP_CEP(cepid);
405
406 /* メイン関数を呼び出す。*/
407 return UDP_DELETE_CEP(cep);
408 }
409
410#endif /* of #ifdef __udp_del_cep */
411
412#ifdef __udp_set_opt
413
414/*
415 * udp_set_option -- UDP 通信端点オプションを設定する。
416 *
417 * udp_set_opt から呼出されるメイン関数
418 */
419
420static ER
421UDP_SET_OPTION (T_UDP_CEP *cep, int_t optname, void *optval, int_t optlen)
422{
423 /* UDP 通信端点をチェックする。*/
424 if (!VALID_UDP_CEP(cep))
425 return E_NOEXS;
426#if defined(SUPPORT_INET6)
427#elif defined(SUPPORT_INET4) && defined(SUPPORT_IGMP) && TNUM_UDP4_CEPID > 0
428 switch (optname) {
429 case IP_MULTICAST_LOOP:
430 if (optlen >= sizeof(uint8_t)) {
431 return igmp_set_loop(cep, *(uint8_t *)optval);
432 }
433 break;
434 case IP_MULTICAST_TTL:
435 if (optlen >= sizeof(uint8_t)) {
436 return igmp_set_ttl(cep, *(uint8_t *)optval);
437 }
438 break;
439 case IP_MULTICAST_IF:
440 if (optlen >= sizeof(T_IN4_ADDR)) {
441 return igmp_set_if(cep, (T_IN4_ADDR *)optval);
442 }
443 break;
444 case IP_ADD_MEMBERSHIP:
445 if (optlen >= sizeof(T_IP_MREQ)) {
446 return igmp_add_membership(cep, (T_IP_MREQ *)optval);
447 }
448 break;
449 case IP_DROP_MEMBERSHIP:
450 if (optlen >= sizeof(T_IP_MREQ)) {
451 return igmp_drop_membership(cep, (T_IP_MREQ *)optval);
452 }
453 break;
454 case IP_MSFILTER:
455 if (optlen >= sizeof(T_IP_MSFILTER)) {
456 return igmp_set_ip_msfilter(cep, (T_IP_MSFILTER *)optval);
457 }
458 break;
459 }
460#endif
461 return E_PAR;
462 }
463
464/*
465 * udp_set_opt -- UDP 通信端点オプションの設定【拡張機能】
466 *
467 * 注意: 設定可能な UDP 通信端点オプションは無いため、E_PAR が返される。
468 */
469
470ER
471UDP_SET_OPT (ID cepid, int_t optname, void *optval, int_t optlen)
472{
473 T_UDP_CEP *cep;
474
475 /* UDP 通信端点 ID をチェックする。*/
476 if (!VALID_UDP_CEPID(cepid))
477 return E_ID;
478
479 /* UDP 通信端点を得る。*/
480 cep = GET_UDP_CEP(cepid);
481
482 /* メイン関数を呼び出す。*/
483 return UDP_SET_OPTION(cep, optname, optval, optlen);
484 }
485
486#endif /* of #ifdef __udp_set_opt */
487
488#ifdef __udp_get_opt
489
490/*
491 * udp_get_option -- UDP 通信端点オプションを獲得する。
492 *
493 * udp_get_opt から呼出されるメイン関数
494 */
495
496static ER
497UDP_GET_OPTION (T_UDP_CEP *cep, int_t optname, void *optval, int_t optlen)
498{
499 /* UDP 通信端点をチェックする。*/
500 if (!VALID_UDP_CEP(cep))
501 return E_NOEXS;
502#if defined(SUPPORT_INET6)
503#elif defined(SUPPORT_INET4) && defined(SUPPORT_IGMP) && TNUM_UDP4_CEPID > 0
504 switch (optname) {
505 case IP_MULTICAST_LOOP:
506 if (optlen >= sizeof(uint8_t)) {
507 return igmp_get_loop(cep, (uint8_t *)optval);
508 }
509 break;
510 case IP_MULTICAST_TTL:
511 if (optlen >= sizeof(uint8_t)) {
512 return igmp_get_ttl(cep, (uint8_t *)optval);
513 }
514 break;
515 case IP_MULTICAST_IF:
516 if (optlen >= sizeof(uint32_t)) {
517 return igmp_get_if(cep, (uint32_t *)optval);
518 }
519 break;
520 case IP_MSFILTER:
521 if (optlen >= sizeof(T_IP_MSFILTER)) {
522 return igmp_get_ip_msfilter(cep, (T_IP_MSFILTER *)optval);
523 }
524 break;
525 }
526#endif
527 return E_PAR;
528 }
529
530/*
531 * udp_get_opt -- UDP 通信端点オプションの獲得【拡張機能】
532 *
533 * 注意: 設定可能な UDP 通信端点オプションは無いため、E_PAR が返される。
534 */
535
536ER
537UDP_GET_OPT (ID cepid, int_t optname, void *optval, int_t optlen)
538{
539 T_UDP_CEP *cep;
540
541 /* UDP 通信端点 ID をチェックする。*/
542 if (!VALID_UDP_CEPID(cepid))
543 return E_ID;
544
545 /* UDP 通信端点を得る。*/
546 cep = GET_UDP_CEP(cepid);
547
548 /* メイン関数を呼び出す。*/
549 return UDP_GET_OPTION(cep, optname, optval, optlen);
550 }
551
552#endif /* of #ifdef __udp_get_opt */
553
554#endif /* of #ifdef UDP_CFG_EXTENTIONS */
555
556#ifdef UDP_CFG_NON_BLOCKING
557
558#else /* of #ifdef UDP_CFG_NON_BLOCKING */
559
560#ifdef __udp_can_snd
561
562/*
563 * udp_can_snd -- ペンディングしている送信のキャンセル
564 */
565
566ER
567UDP_CAN_SND (T_UDP_CEP *cep, ER error)
568{
569 if (cep->snd_tskid != TA_NULL) { /* 非ノンブロッキングコールでペンディング中 */
570
571#ifdef UDP_CFG_EXTENTIONS
572
573 /* 待
574ち中に発生したエラー情
575報を設定する。*/
576 cep->error = error;
577
578#endif /* of #ifdef UDP_CFG_EXTENTIONS */
579
580 error = rel_wai(cep->snd_tskid);
581 cep->snd_tskid = TA_NULL;
582 }
583 else /* どちらでもないならペンディングしていない */
584 error = EV_NOPND;
585
586 return error;
587 }
588
589#endif /* of #ifdef __udp_can_snd */
590
591#ifdef __udp_can_rcv
592
593/*
594 * udp_can_rcv -- ペンディングしている受信のキャンセル
595 */
596
597ER
598UDP_CAN_RCV (T_UDP_CEP *cep, ER error)
599{
600 if (cep->rcv_tskid != TA_NULL) { /* 非ノンブロッキングコールでペンディング中 */
601
602#ifdef UDP_CFG_EXTENTIONS
603
604 /* 待
605ち中に発生したエラー情
606報を設定する。*/
607 cep->error = error;
608
609#endif /* of #ifdef UDP_CFG_EXTENTIONS */
610
611 error = rel_wai(cep->rcv_tskid);
612 cep->rcv_tskid = TA_NULL;
613 }
614 else /* どちらでもないならペンディングしていない */
615 error = EV_NOPND;
616
617 return error;
618 }
619
620#endif /* of #ifdef __udp_can_rcv */
621
622#ifdef __udp_snd_dat
623
624/*
625 * udp_snd_dat -- パケットの送信【標準機能】
626 */
627
628ER_UINT
629UDP_SND_DAT (ID cepid, T_IPEP *p_dstaddr, void *data, int_t len, TMO tmout)
630{
631 T_UDP_CEP *cep;
632 ER error;
633
634 /* p_dstaddr または data が NULL か、tmout が TMO_NBLK ならエラー */
635 if (p_dstaddr == NULL || data == NULL || tmout == TMO_NBLK)
636 return E_PAR;
637
638 /* データ長をチェックする。*/
639 if (len < 0 || len + IP_HDR_SIZE + UDP_HDR_SIZE > IF_MTU)
640 return E_PAR;
641
642#if (API_PROTO == API_PROTO_IPV6) && !defined(API_CFG_IP4MAPPED_ADDR)
643
644 /*
645 * API が IPv6 で IPv4 射影アドレスが認められていないのにもかかわらず、
646 * IPv4 射影アドレスが指定されたらエラー
647 */
648 if (in6_is_addr_ipv4mapped(&p_dstaddr->ipaddr))
649 return E_PAR;
650
651#endif /* of #if (API_PROTO == API_PROTO_IPV6) && !defined(DAPI_CFG_IP4MAPPED_ADDR) */
652
653 /* UDP 通信端点 ID をチェックする。*/
654 if (!VALID_UDP_CEPID(cepid))
655 return E_ID;
656
657 /* UDP 通信端点を得る。*/
658 cep = GET_UDP_CEP(cepid);
659
660 /* UDP 通信端点をチェックする。*/
661 if (!VALID_UDP_CEP(cep))
662 return E_NOEXS;
663
664 /*
665 * 自ポート番号が UDP_PORTANY なら、自動で割り当てる。
666 */
667 if (cep->myaddr.portno == UDP_PORTANY) {
668 if ((error = UDP_ALLOC_AUTO_PORT(cep)) != E_OK)
669 return error;
670 }
671
672 /* 通信端点をロックする。*/
673 syscall(wai_sem(cep->semid_lock));
674
675 if (cep->snd_tskid != TA_NULL) {
676
677 /* 非ノンブロッキングコールでペンディング中 */
678 error = E_QOVR;
679
680 /* 通信端点をロックを解除する。*/
681 syscall(sig_sem(cep->semid_lock));
682 }
683 else {
684 /* 現在のタスク識別子を記録する。*/
685 get_tid(&(cep->snd_tskid));
686
687#ifdef UDP_CFG_EXTENTIONS
688
689 /* 待
690ち中に発生したエラー情
691報をリセットする。*/
692 cep->error = E_OK;
693
694#endif /* of #ifdef UDP_CFG_EXTENTIONS */
695
696 /* 通信端点をロックを解除する。*/
697 syscall(sig_sem(cep->semid_lock));
698
699 /* パケットを送信する。*/
700 error = UDP_SEND_DATA(cep, p_dstaddr, data, len, tmout);
701
702#ifdef UDP_CFG_EXTENTIONS
703
704 /* 待
705ち中に発生したエラー情
706報を返す。*/
707 if (error == E_RLWAI)
708 error = cep->error;
709
710#endif /* of #ifdef UDP_CFG_EXTENTIONS */
711 }
712
713 return error;
714 }
715
716#endif /* of #ifdef __udp_snd_dat */
717
718#ifdef __udp_rcv_dat
719
720/*
721 * udp_rcv_dat -- パケットの受信【標準機能】
722 */
723
724ER_UINT
725UDP_RCV_DAT (ID cepid, T_IPEP *p_dstaddr, void *data, int_t len, TMO tmout)
726{
727 T_NET_BUF *input;
728 T_UDP_CEP *cep;
729 T_UDP_HDR *udph;
730 ER_UINT error;
731 uint_t ulen, uhoff;
732
733 /* p_dstaddr または data が NULL 、len < 0 か、tmout が TMO_NBLK ならエラー */
734 if (p_dstaddr == NULL || data == NULL || len < 0 || tmout == TMO_NBLK)
735 return E_PAR;
736
737 /* UDP 通信端点 ID をチェックする。*/
738 if (!VALID_UDP_CEPID(cepid))
739 return E_ID;
740
741 /* UDP 通信端点を得る。*/
742 cep = GET_UDP_CEP(cepid);
743
744 /* UDP 通信端点をチェックする。*/
745 if (!VALID_UDP_CEP(cep))
746 return E_NOEXS;
747
748 /* 通信端点をロックする。*/
749 syscall(wai_sem(cep->semid_lock));
750
751 if (cep->rcv_tskid != TA_NULL) {
752
753 /* 非ノンブロッキングコールでペンディング中 */
754 error = E_QOVR;
755
756 /* 通信端点をロックを解除する。*/
757 syscall(sig_sem(cep->semid_lock));
758 }
759 else {
760
761 /* 現在のタスク識別子を記録する。*/
762 get_tid(&(cep->rcv_tskid));
763
764#ifdef UDP_CFG_EXTENTIONS
765
766 /* 待
767ち中に発生したエラー情
768報をリセットする。*/
769 cep->error = E_OK;
770
771#endif /* of #ifdef UDP_CFG_EXTENTIONS */
772
773 /* 通信端点をロックを解除する。*/
774 syscall(sig_sem(cep->semid_lock));
775
776 /* å…
777¥åŠ›ãŒã‚るまで待
778つ。*/
779 if (cep->cb_netbuf != NULL) {
780
781 /*
782 * ここにくる場合は、コールバック関数の中から
783 * udp_rcv_dat を呼び出していることになり、
784 * すでにå…
785¥åŠ›æ¸ˆã¿ã§ã‚る。
786 */
787 input = cep->cb_netbuf;
788 cep->cb_netbuf = NULL;
789 }
790 else if ((error = trcv_dtq(cep->rcvqid, (intptr_t*)&input, tmout)) != E_OK) {
791
792#ifdef UDP_CFG_EXTENTIONS
793
794 /* 待
795ち中に発生したエラー情
796報を返す。*/
797 if (error == E_RLWAI)
798 error = cep->error;
799
800#endif /* of #ifdef UDP_CFG_EXTENTIONS */
801
802 cep->rcv_tskid = TA_NULL;
803 return error;
804 }
805
806 /* p_dstaddr を設定する。*/
807 uhoff = (uint_t)GET_UDP_HDR_OFFSET(input);
808 udph = GET_UDP_HDR(input, uhoff);
809 p_dstaddr->portno = ntohs(udph->sport);
810 IN_COPY_TO_HOST(&p_dstaddr->ipaddr, input);
811
812 /* データをバッファに移す。*/
813 ulen = ntohs(udph->ulen);
814 if (ulen - UDP_HDR_SIZE > len)
815 error = E_BOVR;
816 else {
817 len = (uint_t)(ulen - UDP_HDR_SIZE);
818 error = (ER_UINT)(ulen - UDP_HDR_SIZE);
819 }
820
821 memcpy(data, GET_UDP_SDU(input, uhoff), (size_t)len);
822
823 syscall(rel_net_buf(input));
824
825 cep->rcv_tskid = TA_NULL;
826 }
827
828 return error;
829 }
830
831#endif /* of #ifdef __udp_rcv_dat */
832
833#endif /* of #ifdef UDP_CFG_NON_BLOCKING */
Note: See TracBrowser for help on using the repository browser.