source: asp3_gr_sakura/trunk/tinet/netinet/udpn_usrreq.c@ 318

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

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