source: EcnlProtoTool/trunk/asp3_dcre/tinet/netinet/udp_usrreq.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: 19.8 KB
Line 
1/*
2 * TINET (UDP/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: udp_usrreq.c 270 2017-02-09 04:03:47Z 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/*
83 * ノンブロッキングコールを組込まない場合にリンクされる関数の定義
84 */
85
86#include <string.h>
87
88#ifdef TARGET_KERNEL_ASP
89
90#include <kernel.h>
91#include <sil.h>
92
93#endif /* of #ifdef TARGET_KERNEL_ASP */
94
95#ifdef TARGET_KERNEL_JSP
96
97#include <s_services.h>
98#include <t_services.h>
99#include "kernel_id.h"
100
101#endif /* of #ifdef TARGET_KERNEL_JSP */
102
103#include <tinet_defs.h>
104#include <tinet_config.h>
105
106#include <net/if.h>
107#include <net/if_ppp.h>
108#include <net/if_loop.h>
109#include <net/ethernet.h>
110#include <net/net.h>
111#include <net/net_buf.h>
112#include <net/net_count.h>
113#include <net/ppp_ipcp.h>
114
115#include <netinet/in.h>
116#include <netinet6/in6.h>
117#include <netinet/in_var.h>
118#include <netinet/in_itron.h>
119#include <netinet/ip.h>
120#include <netinet/ip_var.h>
121#include <netinet/ip_icmp.h>
122#include <netinet6/in6_var.h>
123#include <netinet/ip6.h>
124#include <netinet6/ip6_var.h>
125#include <netinet6/nd6.h>
126#include <netinet/icmp6.h>
127#include <netinet/udp.h>
128#include <netinet/udp_var.h>
129
130#ifdef SUPPORT_UDP
131
132/*
133 * IPv4 と IPv6 の切り替えマクロ
134 */
135
136#if defined(SUPPORT_INET4)
137
138#define UDP_CRE_CEP udp_cre_cep
139#define UDP_SND_DAT udp_snd_dat
140#define UDP_RCV_DAT udp_rcv_dat
141
142#endif /* of #if defined(SUPPORT_INET4) */
143
144#if defined(SUPPORT_INET6)
145
146#define UDP_CRE_CEP udp6_cre_cep
147#define UDP_SND_DAT udp6_snd_dat
148#define UDP_RCV_DAT udp6_rcv_dat
149
150#endif /* of #if defined(SUPPORT_INET6) */
151
152/*
153 * TINET をライブラリ化しない場合は、å…
154¨ã¦ã®æ©Ÿèƒ½ã‚’
155 * オブジェクトファイルに出力するため、マクロを有効にする。
156 */
157
158#ifndef UDP_CFG_LIBRARY
159
160#define __udp_send_data
161#define __udp_cre_cep
162#define __udp_del_cep
163#define __udp_can_cep
164#define __udp_set_opt
165#define __udp_get_opt
166#define __udp_can_snd
167#define __udp_can_rcv
168#define __udp_snd_dat
169#define __udp_rcv_dat
170
171#endif /* of #ifndef UDP_CFG_LIBRARY */
172
173#ifdef __udp_send_data
174
175/*
176 * udp_send_data -- パケット送信の主要部
177 */
178
179ER_UINT
180udp_send_data (T_UDP_CEP *cep, T_IPEP *p_dstaddr, void *data, int_t len, TMO tmout)
181{
182 T_NET_BUF *output;
183 T_UDP_HDR *udph;
184 SYSTIM before, after;
185 ER error = E_OK;
186
187#ifdef UDP_CFG_OUT_CHECKSUM
188 uint16_t sum;
189#endif /* of #ifdef UDP_CFG_OUT_CHECKSUM */
190
191 NET_COUNT_UDP(net_count_udp.out_octets, len);
192 NET_COUNT_UDP(net_count_udp.out_packets, 1);
193
194 /* IP データグラム割り当ての時間を tmout から減ずる。*/
195 if (!(tmout == TMO_POL || tmout == TMO_FEVR))
196 syscall(get_tim(&before));
197
198 /* IP データグラムを割り当てる。*/
199 if ((error = IN_GET_DATAGRAM(&output, (uint_t)(UDP_HDR_SIZE + len), 0,
200 &p_dstaddr->ipaddr,
201 &cep->myaddr.ipaddr,
202 IPPROTO_UDP, IP_DEFTTL,
203 NBA_SEARCH_ASCENT, tmout)) != E_OK)
204 goto err_ret;
205
206 /* IP データグラム割り当ての時間を tmout から減ずる。*/
207 if (!(tmout == TMO_POL || tmout == TMO_FEVR)) {
208 syscall(get_tim(&after));
209 if (after - before > tmout) {
210 syscall(rel_net_buf(output));
211 error = E_TMOUT;
212 goto err_ret;
213 }
214 tmout -= (TMO)(after - before);
215 }
216
217 /* UDP ヘッダに情
218報を設定する。*/
219 udph = GET_UDP_HDR(output, IF_IP_UDP_HDR_OFFSET);
220 udph->sport = htons(cep->myaddr.portno);
221 udph->dport = htons(p_dstaddr->portno);
222 udph->ulen = htons(UDP_HDR_SIZE + len);
223 udph->sum = 0;
224
225 /* データをコピーする。*/
226 memcpy((void*)GET_UDP_SDU(output, IF_IP_UDP_HDR_OFFSET), data, (size_t)len);
227
228#ifdef UDP_CFG_OUT_CHECKSUM
229
230 sum = IN_CKSUM(output, IPPROTO_UDP, IF_IP_UDP_HDR_OFFSET, (uint_t)(UDP_HDR_SIZE + len));
231
232 /* 計算したチェックサムの値が 0 なら 0xffff をå…
233¥ã‚Œã‚‹ã€‚*/
234 if (sum == 0)
235 sum = 0xffff;
236 udph->sum = sum;
237
238#endif /* of #ifdef UDP_CFG_OUT_CHECKSUM */
239
240 /* ネットワークバッファ長を調整する。*/
241 output->len = (uint16_t)(IF_IP_UDP_HDR_SIZE + len);
242
243 /* ネットワーク層 (IP) の出力関数を呼び出す。*/
244 if ((error = IP_OUTPUT(output, tmout)) == E_OK) {
245 NET_COUNT_MIB(udp_stats.udpOutDatagrams, 1);
246 cep->snd_tskid = TA_NULL;
247 return len;
248 }
249
250err_ret:
251 NET_COUNT_UDP(net_count_udp.out_err_packets, 1);
252 cep->snd_tskid = TA_NULL;
253 return error;
254 }
255
256#endif /* of #ifdef __udp_send_data */
257
258/*
259 * udp_cre_cep -- UDP 通信端点の生成【拡張機能】
260 */
261
262#ifdef __udp_cre_cep
263
264#ifdef UDP_CFG_EXTENTIONS
265
266ER
267UDP_CRE_CEP (ID cepid, T_UDP_CCEP *pk_ccep)
268{
269 T_UDP_CEP *cep;
270 ER error;
271
272 /* UDP 通信端点 ID をチェックする。*/
273 if (!VALID_UDP_CEPID(cepid))
274 return E_ID;
275
276 /* pk_ccep が NULL ならエラー */
277 if (pk_ccep == NULL)
278 return E_PAR;
279
280 /* UDP 通信端点を得る。*/
281 cep = GET_UDP_CEP(cepid);
282
283 /* UDP 通信端点をチェックする。*/
284 if (VALID_UDP_CEP(cep))
285 return E_OBJ;
286
287 /* UDP 通信端点が、動的生成用でなければエラー */
288 if (!DYNAMIC_UDP_CEP(cep))
289 return E_ID;
290
291 /* 通信端点をロックする。*/
292 syscall(wai_sem(cep->semid_lock));
293
294 /*
295 * UDP 通信端点をチェックする。生成済みであればエラー
296 */
297 if (VALID_UDP_CEP(cep))
298 error = E_OBJ;
299 else {
300
301 /*
302 * 自ポート番号が UDP_PORTANY なら、自動で割り当てる。
303 */
304 if (pk_ccep->myaddr.portno == UDP_PORTANY)
305 error = udp_alloc_auto_port(cep);
306 else
307 error = udp_alloc_port(cep, pk_ccep->myaddr.portno);
308
309 if (error == E_OK) {
310
311 /* UDP 通信端点生成情
312報をコピーする。*/
313 cep->cepatr = pk_ccep->cepatr; /* 通信端点属性 */
314 cep->myaddr.ipaddr = pk_ccep->myaddr.ipaddr; /* 自分のアドレス */
315 cep->callback = (void*)pk_ccep->callback; /* コールバック */
316
317 /* UDP 通信端点を生成済みにする。*/
318 cep->flags |= UDP_CEP_FLG_VALID;
319 }
320 }
321
322 /* 通信端点のロックを解除する。*/
323 syscall(sig_sem(cep->semid_lock));
324
325 return error;
326 }
327
328#endif /* of #ifdef UDP_CFG_EXTENTIONS */
329
330#endif /* of #ifdef __udp_cre_cep */
331
332/*
333 * udp_del_cep -- UDP 通信端点の削除【拡張機能】
334 */
335
336#ifdef __udp_del_cep
337
338#ifdef UDP_CFG_EXTENTIONS
339
340ER
341udp_del_cep (ID cepid)
342{
343 T_UDP_CEP *cep;
344 ER error;
345
346 /* UDP 通信端点 ID をチェックする。*/
347 if (!VALID_UDP_CEPID(cepid))
348 return E_ID;
349
350 /* UDP 通信端点を得る。*/
351 cep = GET_UDP_CEP(cepid);
352
353 /* UDP 通信端点をチェックする。*/
354 if (!VALID_UDP_CEP(cep))
355 return E_NOEXS;
356
357 /* UDP 通信端点が、動的生成用でなければエラー */
358 if (!DYNAMIC_UDP_CEP(cep))
359 return E_ID;
360
361 /* 通信端点をロックする。*/
362 syscall(wai_sem(cep->semid_lock));
363
364 /*
365 * UDP 通信端点をチェックする。未生成の場合はエラー
366 * ・未生成。
367 */
368 if (!VALID_UDP_CEP(cep))
369 error = E_NOEXS;
370 else {
371 udp_can_snd(cep, E_DLT);
372 udp_can_rcv(cep, E_DLT);
373
374 /* UDP 通信端点を未生成にする。*/
375 cep->flags &= ~UDP_CEP_FLG_VALID;
376 error = E_OK;
377 }
378
379 /* 通信端点のロックを解除する。*/
380 syscall(sig_sem(cep->semid_lock));
381
382 return error;
383 }
384
385#endif /* of #ifdef UDP_CFG_EXTENTIONS */
386
387#endif /* of #ifdef __udp_del_cep */
388
389#ifdef __udp_can_cep
390
391/*
392 * udp_can_cep -- ペンディングしている処理のキャンセル【標準機能】
393 */
394
395ER
396udp_can_cep (ID cepid, FN fncd)
397{
398 T_UDP_CEP *cep;
399 ER error = E_OK, snd_err, rcv_err;
400
401 /* API 機能コードをチェックする。*/
402 if (!VALID_TFN_UDP_CAN(fncd))
403 return E_PAR;
404
405 /* UDP 通信端点 ID をチェックする。*/
406 if (!VALID_UDP_CEPID(cepid))
407 return E_ID;
408
409 /* UDP 通信端点を得る。*/
410 cep = GET_UDP_CEP(cepid);
411
412 /* UDP 通信端点をチェックする。*/
413 if (!VALID_UDP_CEP(cep))
414 return E_NOEXS;
415
416 /* 通信端点をロックする。*/
417 syscall(wai_sem(cep->semid_lock));
418
419 if (fncd == TFN_UDP_ALL) { /* TFN_UDP_ALL の処理 */
420
421 snd_err = udp_can_snd(cep, E_RLWAI);
422 rcv_err = udp_can_rcv(cep, E_RLWAI);
423
424 /*
425 * snd_err と rcv_err のどちらも EV_NOPND
426 * なら、ペンディングしていないのでエラー
427 */
428 if (snd_err == EV_NOPND && rcv_err == EV_NOPND)
429 error = E_OBJ;
430 else {
431 if (snd_err == EV_NOPND)
432 snd_err = E_OK;
433 if (rcv_err == EV_NOPND)
434 rcv_err = E_OK;
435
436 if (snd_err != E_OK)
437 error = snd_err;
438 else if (rcv_err != E_OK)
439 error = rcv_err;
440 }
441 }
442 else if (fncd == TFN_UDP_SND_DAT) { /* 送信処理のキャンセル */
443 if ((error = udp_can_snd(cep, E_RLWAI)) == EV_NOPND)
444 error = E_OBJ;
445 }
446 else if (fncd == TFN_UDP_RCV_DAT) { /* 受信処理のキャンセル */
447 if ((error = udp_can_rcv(cep, E_RLWAI)) == EV_NOPND)
448 error = E_OBJ;
449 }
450 else
451 error = E_PAR;
452
453 /* 通信端点をロックを解除する。*/
454 syscall(sig_sem(cep->semid_lock));
455
456 return error;
457 }
458
459#endif /* of #ifdef __udp_can_cep */
460
461/*
462 * udp_set_opt -- UDP 通信端点オプションの設定【拡張機能】
463 *
464 * 注意: 設定可能な UDP 通信端点オプションは無いため、E_PAR が返される。
465 */
466
467#ifdef __udp_set_opt
468
469#ifdef UDP_CFG_EXTENTIONS
470
471ER
472udp_set_opt (ID cepid, int_t optname, void *optval, int_t optlen)
473{
474 T_UDP_CEP *cep;
475
476 /* UDP 通信端点 ID をチェックする。*/
477 if (!VALID_UDP_CEPID(cepid))
478 return E_ID;
479
480 /* UDP 通信端点を得る。*/
481 cep = GET_UDP_CEP(cepid);
482
483 /* UDP 通信端点をチェックする。*/
484 if (!VALID_UDP_CEP(cep))
485 return E_NOEXS;
486
487 return E_PAR;
488 }
489
490#endif /* of #ifdef UDP_CFG_EXTENTIONS */
491
492#endif /* of #ifdef __udp_set_opt */
493
494/*
495 * udp_get_opt -- UDP 通信端点オプションの設定【拡張機能】
496 *
497 * 注意: 設定可能な UDP 通信端点オプションは無いため、E_PAR が返される。
498 */
499
500#ifdef __udp_get_opt
501
502#ifdef UDP_CFG_EXTENTIONS
503
504ER
505udp_get_opt (ID cepid, int_t optname, void *optval, int_t optlen)
506{
507 T_UDP_CEP *cep;
508
509 /* UDP 通信端点 ID をチェックする。*/
510 if (!VALID_UDP_CEPID(cepid))
511 return E_ID;
512
513 /* UDP 通信端点を得る。*/
514 cep = GET_UDP_CEP(cepid);
515
516 /* UDP 通信端点をチェックする。*/
517 if (!VALID_UDP_CEP(cep))
518 return E_NOEXS;
519
520 return E_PAR;
521 }
522
523#endif /* of #ifdef UDP_CFG_EXTENTIONS */
524
525#endif /* of #ifdef __udp_get_opt */
526
527#ifdef UDP_CFG_NON_BLOCKING
528
529#include "udp_usrreq_nblk.c"
530
531#else /* of #ifdef UDP_CFG_NON_BLOCKING */
532
533#ifdef __udp_can_snd
534
535/*
536 * udp_can_snd -- ペンディングしている送信のキャンセル
537 */
538
539ER
540udp_can_snd (T_UDP_CEP *cep, ER error)
541{
542 if (cep->snd_tskid != TA_NULL) { /* 非ノンブロッキングコールでペンディング中 */
543
544#ifdef UDP_CFG_EXTENTIONS
545
546 /* 待
547ち中に発生したエラー情
548報を設定する。*/
549 cep->error = error;
550
551#endif /* of #ifdef UDP_CFG_EXTENTIONS */
552
553 error = rel_wai(cep->snd_tskid);
554 cep->snd_tskid = TA_NULL;
555 }
556 else /* どちらでもないならペンディングしていない */
557 error = EV_NOPND;
558
559 return error;
560 }
561
562#endif /* of #ifdef __udp_can_snd */
563
564#ifdef __udp_can_rcv
565
566/*
567 * udp_can_rcv -- ペンディングしている受信のキャンセル
568 */
569
570ER
571udp_can_rcv (T_UDP_CEP *cep, ER error)
572{
573 if (cep->rcv_tskid != TA_NULL) { /* 非ノンブロッキングコールでペンディング中 */
574
575#ifdef UDP_CFG_EXTENTIONS
576
577 /* 待
578ち中に発生したエラー情
579報を設定する。*/
580 cep->error = error;
581
582#endif /* of #ifdef UDP_CFG_EXTENTIONS */
583
584 error = rel_wai(cep->rcv_tskid);
585 cep->rcv_tskid = TA_NULL;
586 }
587 else /* どちらでもないならペンディングしていない */
588 error = EV_NOPND;
589
590 return error;
591 }
592
593#endif /* of #ifdef __udp_can_rcv */
594
595#ifdef __udp_snd_dat
596
597/*
598 * udp_snd_dat -- パケットの送信【標準機能】
599 */
600
601ER_UINT
602UDP_SND_DAT (ID cepid, T_IPEP *p_dstaddr, void *data, int_t len, TMO tmout)
603{
604 T_UDP_CEP *cep;
605 ER error;
606
607 /* p_dstaddr または data が NULL か、tmout が TMO_NBLK ならエラー */
608 if (p_dstaddr == NULL || data == NULL || tmout == TMO_NBLK)
609 return E_PAR;
610
611 /* データ長をチェックする。*/
612 if (len < 0 || len + IP_HDR_SIZE + UDP_HDR_SIZE > IF_MTU)
613 return E_PAR;
614
615 /* UDP 通信端点 ID をチェックする。*/
616 if (!VALID_UDP_CEPID(cepid))
617 return E_ID;
618
619 /* UDP 通信端点を得る。*/
620 cep = GET_UDP_CEP(cepid);
621
622 /* UDP 通信端点をチェックする。*/
623 if (!VALID_UDP_CEP(cep))
624 return E_NOEXS;
625
626 /*
627 * 自ポート番号が UDP_PORTANY なら、自動で割り当てる。
628 */
629 if (cep->myaddr.portno == UDP_PORTANY) {
630 if ((error = udp_alloc_auto_port(cep)) != E_OK)
631 return error;
632 }
633
634 /* 通信端点をロックする。*/
635 syscall(wai_sem(cep->semid_lock));
636
637 if (cep->snd_tskid != TA_NULL) {
638
639 /* 非ノンブロッキングコールでペンディング中 */
640 error = E_QOVR;
641
642 /* 通信端点をロックを解除する。*/
643 syscall(sig_sem(cep->semid_lock));
644 }
645 else {
646 /* 現在のタスク識別子を記録する。*/
647 get_tid(&(cep->snd_tskid));
648
649#ifdef UDP_CFG_EXTENTIONS
650
651 /* 待
652ち中に発生したエラー情
653報をリセットする。*/
654 cep->error = E_OK;
655
656#endif /* of #ifdef UDP_CFG_EXTENTIONS */
657
658 /* 通信端点をロックを解除する。*/
659 syscall(sig_sem(cep->semid_lock));
660
661 /* パケットを送信する。*/
662 error = udp_send_data(cep, p_dstaddr, data, len, tmout);
663
664#ifdef UDP_CFG_EXTENTIONS
665
666 /* 待
667ち中に発生したエラー情
668報を返す。*/
669 if (error == E_RLWAI)
670 error = cep->error;
671
672#endif /* of #ifdef UDP_CFG_EXTENTIONS */
673 }
674
675 return error;
676 }
677
678#endif /* of #ifdef __udp_snd_dat */
679
680#ifdef __udp_rcv_dat
681
682/*
683 * udp_rcv_dat -- パケットの受信【標準機能】
684 */
685
686ER_UINT
687UDP_RCV_DAT (ID cepid, T_IPEP *p_dstaddr, void *data, int_t len, TMO tmout)
688{
689 T_NET_BUF *input;
690 T_UDP_CEP *cep;
691 T_UDP_HDR *udph;
692 ER_UINT error;
693 uint_t ulen, uhoff;
694
695 /* p_dstaddr または data が NULL 、len < 0 か、tmout が TMO_NBLK ならエラー */
696 if (p_dstaddr == NULL || data == NULL || len < 0 || tmout == TMO_NBLK)
697 return E_PAR;
698
699 /* UDP 通信端点 ID をチェックする。*/
700 if (!VALID_UDP_CEPID(cepid))
701 return E_ID;
702
703 /* UDP 通信端点を得る。*/
704 cep = GET_UDP_CEP(cepid);
705
706 /* UDP 通信端点をチェックする。*/
707 if (!VALID_UDP_CEP(cep))
708 return E_NOEXS;
709
710 /* 通信端点をロックする。*/
711 syscall(wai_sem(cep->semid_lock));
712
713 if (cep->rcv_tskid != TA_NULL) {
714
715 /* 非ノンブロッキングコールでペンディング中 */
716 error = E_QOVR;
717
718 /* 通信端点をロックを解除する。*/
719 syscall(sig_sem(cep->semid_lock));
720 }
721 else {
722
723 /* 現在のタスク識別子を記録する。*/
724 get_tid(&(cep->rcv_tskid));
725
726#ifdef UDP_CFG_EXTENTIONS
727
728 /* 待
729ち中に発生したエラー情
730報をリセットする。*/
731 cep->error = E_OK;
732
733#endif /* of #ifdef UDP_CFG_EXTENTIONS */
734
735 /* 通信端点をロックを解除する。*/
736 syscall(sig_sem(cep->semid_lock));
737
738 /* å…
739¥åŠ›ãŒã‚るまで待
740つ。*/
741 if (cep->cb_netbuf != NULL) {
742
743 /*
744 * ここにくる場合は、コールバック関数の中から
745 * udp_rcv_dat を呼び出していることになり、
746 * すでにå…
747¥åŠ›æ¸ˆã¿ã§ã‚る。
748 */
749 input = cep->cb_netbuf;
750 cep->cb_netbuf = NULL;
751 }
752 else if ((error = trcv_dtq(cep->rcvqid, (intptr_t*)&input, tmout)) != E_OK) {
753
754#ifdef UDP_CFG_EXTENTIONS
755
756 /* 待
757ち中に発生したエラー情
758報を返す。*/
759 if (error == E_RLWAI)
760 error = cep->error;
761
762#endif /* of #ifdef UDP_CFG_EXTENTIONS */
763
764 cep->rcv_tskid = TA_NULL;
765 return error;
766 }
767
768 /* p_dstaddr を設定する。*/
769 uhoff = (uint_t)GET_UDP_HDR_OFFSET(input);
770 udph = GET_UDP_HDR(input, uhoff);
771 p_dstaddr->portno = ntohs(udph->sport);
772 IN_COPY_TO_HOST(&p_dstaddr->ipaddr, &GET_IP_HDR(input)->src);
773
774 /* データをバッファに移す。*/
775 ulen = ntohs(udph->ulen);
776 if (ulen - UDP_HDR_SIZE > len)
777 error = E_BOVR;
778 else {
779 len = (uint_t)(ulen - UDP_HDR_SIZE);
780 error = (ER_UINT)(ulen - UDP_HDR_SIZE);
781 }
782
783 memcpy(data, GET_UDP_SDU(input, uhoff), (size_t)len);
784
785 syscall(rel_net_buf(input));
786
787 cep->rcv_tskid = TA_NULL;
788 }
789
790 return error;
791 }
792
793#endif /* of #ifdef __udp_rcv_dat */
794
795#endif /* of #ifdef UDP_CFG_NON_BLOCKING */
796
797#endif /* of #ifdef SUPPORT_UDP */
Note: See TracBrowser for help on using the repository browser.