source: asp3_tinet_ecnl_rx/trunk/asp3_dcre/tinet/netinet/udpn_usrreq.c@ 387

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

ファイルディスクリプタ処理を更新
  • Property svn:eol-style set to native
  • Property svn:mime-type set to text/x-csrc;charset=UTF-8
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 * 上記著作権者は，以下の (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 /* UDP 通信端点生成情報をコピーする。*/
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_cre_cep */
329
330#ifdef __udp_del_cep
331
332/*
333 * udp_delete_cep -- UDP 通信端点を削除する。
334 *
335 * udp_del_cep から呼出されるメイン関数
336 */
337
338static ER
339UDP_DELETE_CEP (T_UDP_CEP *cep)
340{
341 ER error;
342
343 /* UDP 通信端点をチェックする。*/
344 if (!VALID_UDP_CEP(cep))
345 return E_NOEXS;
346
347 /* UDP 通信端点が、動的生成用でなければエラー */
348 if (!DYNAMIC_UDP_CEP(cep))
349 return E_ID;
350
351 /* 通信端点をロックする。*/
352 syscall(wai_sem(cep->semid_lock));
353
354 /*
355 * UDP 通信端点をチェックする。未生成の場合はエラー
356 * ・未生成。
357 */
358 if (!VALID_UDP_CEP(cep))
359 error = E_NOEXS;
360 else {
361 UDP_CAN_SND(cep, E_DLT);
362 UDP_CAN_RCV(cep, E_DLT);
363
364 /* UDP 通信端点を未生成にする。*/
365 cep->flags &= ~UDP_CEP_FLG_VALID;
366 error = E_OK;
367 }
368
369 /* 通信端点のロックを解除する。*/
370 syscall(sig_sem(cep->semid_lock));
371
372 return error;
373 }
374
375/*
376 * udp_del_cep -- UDP 通信端点の削除【拡張機能】
377 */
378
379ER
380UDP_DEL_CEP (ID cepid)
381{
382 T_UDP_CEP *cep;
383
384 /* UDP 通信端点 ID をチェックする。*/
385 if (!VALID_UDP_CEPID(cepid))
386 return E_ID;
387
388 /* UDP 通信端点を得る。*/
389 cep = GET_UDP_CEP(cepid);
390
391 /* メイン関数を呼び出す。*/
392 return UDP_DELETE_CEP(cep);
393 }
394
395#endif /* of #ifdef __udp_del_cep */
396
397#ifdef __udp_set_opt
398
399/*
400 * udp_set_option -- UDP 通信端点オプションを設定する。
401 *
402 * udp_set_opt から呼出されるメイン関数
403 */
404
405static ER
406UDP_SET_OPTION (T_UDP_CEP *cep, int_t optname, void *optval, int_t optlen)
407{
408 /* UDP 通信端点をチェックする。*/
409 if (!VALID_UDP_CEP(cep))
410 return E_NOEXS;
411#if defined(SUPPORT_INET6)
412#elif defined(SUPPORT_INET4) && defined(SUPPORT_IGMP) && TNUM_UDP4_CEPID > 0
413 switch (optname) {
414 case IP_MULTICAST_LOOP:
415 if (optlen >= sizeof(uint8_t)) {
416 return igmp_set_loop(cep, *(uint8_t *)optval);
417 }
418 break;
419 case IP_MULTICAST_TTL:
420 if (optlen >= sizeof(uint8_t)) {
421 return igmp_set_ttl(cep, *(uint8_t *)optval);
422 }
423 break;
424 case IP_MULTICAST_IF:
425 if (optlen >= sizeof(T_IN4_ADDR)) {
426 return igmp_set_if(cep, (T_IN4_ADDR *)optval);
427 }
428 break;
429 case IP_ADD_MEMBERSHIP:
430 if (optlen >= sizeof(T_IP_MREQ)) {
431 return igmp_add_membership(cep, (T_IP_MREQ *)optval);
432 }
433 break;
434 case IP_DROP_MEMBERSHIP:
435 if (optlen >= sizeof(T_IP_MREQ)) {
436 return igmp_drop_membership(cep, (T_IP_MREQ *)optval);
437 }
438 break;
439 case IP_MSFILTER:
440 if (optlen >= sizeof(T_IP_MSFILTER)) {
441 return igmp_set_ip_msfilter(cep, (T_IP_MSFILTER *)optval);
442 }
443 break;
444 }
445#endif
446 return E_PAR;
447 }
448
449/*
450 * udp_set_opt -- UDP 通信端点オプションの設定【拡張機能】
451 *
452 * 注意: 設定可能な UDP 通信端点オプションは無いため、E_PAR が返される。
453 */
454
455ER
456UDP_SET_OPT (ID cepid, int_t optname, void *optval, int_t optlen)
457{
458 T_UDP_CEP *cep;
459
460 /* UDP 通信端点 ID をチェックする。*/
461 if (!VALID_UDP_CEPID(cepid))
462 return E_ID;
463
464 /* UDP 通信端点を得る。*/
465 cep = GET_UDP_CEP(cepid);
466
467 /* メイン関数を呼び出す。*/
468 return UDP_SET_OPTION(cep, optname, optval, optlen);
469 }
470
471#endif /* of #ifdef __udp_set_opt */
472
473#ifdef __udp_get_opt
474
475/*
476 * udp_get_option -- UDP 通信端点オプションを獲得する。
477 *
478 * udp_get_opt から呼出されるメイン関数
479 */
480
481static ER
482UDP_GET_OPTION (T_UDP_CEP *cep, int_t optname, void *optval, int_t optlen)
483{
484 /* UDP 通信端点をチェックする。*/
485 if (!VALID_UDP_CEP(cep))
486 return E_NOEXS;
487#if defined(SUPPORT_INET6)
488#elif defined(SUPPORT_INET4) && defined(SUPPORT_IGMP) && TNUM_UDP4_CEPID > 0
489 switch (optname) {
490 case IP_MULTICAST_LOOP:
491 if (optlen >= sizeof(uint8_t)) {
492 return igmp_get_loop(cep, (uint8_t *)optval);
493 }
494 break;
495 case IP_MULTICAST_TTL:
496 if (optlen >= sizeof(uint8_t)) {
497 return igmp_get_ttl(cep, (uint8_t *)optval);
498 }
499 break;
500 case IP_MULTICAST_IF:
501 if (optlen >= sizeof(uint32_t)) {
502 return igmp_get_if(cep, (uint32_t *)optval);
503 }
504 break;
505 case IP_MSFILTER:
506 if (optlen >= sizeof(T_IP_MSFILTER)) {
507 return igmp_get_ip_msfilter(cep, (T_IP_MSFILTER *)optval);
508 }
509 break;
510 }
511#endif
512 return E_PAR;
513 }
514
515/*
516 * udp_get_opt -- UDP 通信端点オプションの獲得【拡張機能】
517 *
518 * 注意: 設定可能な UDP 通信端点オプションは無いため、E_PAR が返される。
519 */
520
521ER
522UDP_GET_OPT (ID cepid, int_t optname, void *optval, int_t optlen)
523{
524 T_UDP_CEP *cep;
525
526 /* UDP 通信端点 ID をチェックする。*/
527 if (!VALID_UDP_CEPID(cepid))
528 return E_ID;
529
530 /* UDP 通信端点を得る。*/
531 cep = GET_UDP_CEP(cepid);
532
533 /* メイン関数を呼び出す。*/
534 return UDP_GET_OPTION(cep, optname, optval, optlen);
535 }
536
537#endif /* of #ifdef __udp_get_opt */
538
539#endif /* of #ifdef UDP_CFG_EXTENTIONS */
540
541#ifdef UDP_CFG_NON_BLOCKING
542
543#else /* of #ifdef UDP_CFG_NON_BLOCKING */
544
545#ifdef __udp_can_snd
546
547/*
548 * udp_can_snd -- ペンディングしている送信のキャンセル
549 */
550
551ER
552UDP_CAN_SND (T_UDP_CEP *cep, ER error)
553{
554 if (cep->snd_tskid != TA_NULL) { /* 非ノンブロッキングコールでペンディング中 */
555
556#ifdef UDP_CFG_EXTENTIONS
557
558 /* 待ち中に発生したエラー情報を設定する。*/
559 cep->error = error;
560
561#endif /* of #ifdef UDP_CFG_EXTENTIONS */
562
563 error = rel_wai(cep->snd_tskid);
564 cep->snd_tskid = TA_NULL;
565 }
566 else /* どちらでもないならペンディングしていない */
567 error = EV_NOPND;
568
569 return error;
570 }
571
572#endif /* of #ifdef __udp_can_snd */
573
574#ifdef __udp_can_rcv
575
576/*
577 * udp_can_rcv -- ペンディングしている受信のキャンセル
578 */
579
580ER
581UDP_CAN_RCV (T_UDP_CEP *cep, ER error)
582{
583 if (cep->rcv_tskid != TA_NULL) { /* 非ノンブロッキングコールでペンディング中 */
584
585#ifdef UDP_CFG_EXTENTIONS
586
587 /* 待ち中に発生したエラー情報を設定する。*/
588 cep->error = error;
589
590#endif /* of #ifdef UDP_CFG_EXTENTIONS */
591
592 error = rel_wai(cep->rcv_tskid);
593 cep->rcv_tskid = TA_NULL;
594 }
595 else /* どちらでもないならペンディングしていない */
596 error = EV_NOPND;
597
598 return error;
599 }
600
601#endif /* of #ifdef __udp_can_rcv */
602
603#ifdef __udp_snd_dat
604
605/*
606 * udp_snd_dat -- パケットの送信【標準機能】
607 */
608
609ER_UINT
610UDP_SND_DAT (ID cepid, T_IPEP *p_dstaddr, void *data, int_t len, TMO tmout)
611{
612 T_UDP_CEP *cep;
613 ER error;
614
615 /* p_dstaddr または data が NULL か、tmout が TMO_NBLK ならエラー */
616 if (p_dstaddr == NULL || data == NULL || tmout == TMO_NBLK)
617 return E_PAR;
618
619 /* データ長をチェックする。*/
620 if (len < 0 || len + IP_HDR_SIZE + UDP_HDR_SIZE > IF_MTU)
621 return E_PAR;
622
623#if (API_PROTO == API_PROTO_IPV6) && !defined(API_CFG_IP4MAPPED_ADDR)
624
625 /*
626 * API が IPv6 で IPv4 射影アドレスが認められていないのにもかかわらず、
627 * IPv4 射影アドレスが指定されたらエラー
628 */
629 if (in6_is_addr_ipv4mapped(&p_dstaddr->ipaddr))
630 return E_PAR;
631
632#endif /* of #if (API_PROTO == API_PROTO_IPV6) && !defined(DAPI_CFG_IP4MAPPED_ADDR) */
633
634 /* UDP 通信端点 ID をチェックする。*/
635 if (!VALID_UDP_CEPID(cepid))
636 return E_ID;
637
638 /* UDP 通信端点を得る。*/
639 cep = GET_UDP_CEP(cepid);
640
641 /* UDP 通信端点をチェックする。*/
642 if (!VALID_UDP_CEP(cep))
643 return E_NOEXS;
644
645 /*
646 * 自ポート番号が UDP_PORTANY なら、自動で割り当てる。
647 */
648 if (cep->myaddr.portno == UDP_PORTANY) {
649 if ((error = UDP_ALLOC_AUTO_PORT(cep)) != E_OK)
650 return error;
651 }
652
653 /* 通信端点をロックする。*/
654 syscall(wai_sem(cep->semid_lock));
655
656 if (cep->snd_tskid != TA_NULL) {
657
658 /* 非ノンブロッキングコールでペンディング中 */
659 error = E_QOVR;
660
661 /* 通信端点をロックを解除する。*/
662 syscall(sig_sem(cep->semid_lock));
663 }
664 else {
665 /* 現在のタスク識別子を記録する。*/
666 get_tid(&(cep->snd_tskid));
667
668#ifdef UDP_CFG_EXTENTIONS
669
670 /* 待ち中に発生したエラー情報をリセットする。*/
671 cep->error = E_OK;
672
673#endif /* of #ifdef UDP_CFG_EXTENTIONS */
674
675 /* 通信端点をロックを解除する。*/
676 syscall(sig_sem(cep->semid_lock));
677
678 /* パケットを送信する。*/
679 error = UDP_SEND_DATA(cep, p_dstaddr, data, len, tmout);
680
681#ifdef UDP_CFG_EXTENTIONS
682
683 /* 待ち中に発生したエラー情報を返す。*/
684 if (error == E_RLWAI)
685 error = cep->error;
686
687#endif /* of #ifdef UDP_CFG_EXTENTIONS */
688 }
689
690 return error;
691 }
692
693#endif /* of #ifdef __udp_snd_dat */
694
695#ifdef __udp_rcv_dat
696
697/*
698 * udp_rcv_dat -- パケットの受信【標準機能】
699 */
700
701ER_UINT
702UDP_RCV_DAT (ID cepid, T_IPEP *p_dstaddr, void *data, int_t len, TMO tmout)
703{
704 T_NET_BUF *input;
705 T_UDP_CEP *cep;
706 T_UDP_HDR *udph;
707 ER_UINT error;
708 uint_t ulen, uhoff;
709
710 /* p_dstaddr または data が NULL 、len < 0 か、tmout が TMO_NBLK ならエラー */
711 if (p_dstaddr == NULL || data == NULL || len < 0 || tmout == TMO_NBLK)
712 return E_PAR;
713
714 /* UDP 通信端点 ID をチェックする。*/
715 if (!VALID_UDP_CEPID(cepid))
716 return E_ID;
717
718 /* UDP 通信端点を得る。*/
719 cep = GET_UDP_CEP(cepid);
720
721 /* UDP 通信端点をチェックする。*/
722 if (!VALID_UDP_CEP(cep))
723 return E_NOEXS;
724
725 /* 通信端点をロックする。*/
726 syscall(wai_sem(cep->semid_lock));
727
728 if (cep->rcv_tskid != TA_NULL) {
729
730 /* 非ノンブロッキングコールでペンディング中 */
731 error = E_QOVR;
732
733 /* 通信端点をロックを解除する。*/
734 syscall(sig_sem(cep->semid_lock));
735 }
736 else {
737
738 /* 現在のタスク識別子を記録する。*/
739 get_tid(&(cep->rcv_tskid));
740
741#ifdef UDP_CFG_EXTENTIONS
742
743 /* 待ち中に発生したエラー情報をリセットする。*/
744 cep->error = E_OK;
745
746#endif /* of #ifdef UDP_CFG_EXTENTIONS */
747
748 /* 通信端点をロックを解除する。*/
749 syscall(sig_sem(cep->semid_lock));
750
751 /* 入力があるまで待つ。*/
752 if (cep->cb_netbuf != NULL) {
753
754 /*
755 * ここにくる場合は、コールバック関数の中から
756 * udp_rcv_dat を呼び出していることになり、
757 * すでに入力済みである。
758 */
759 input = cep->cb_netbuf;
760 cep->cb_netbuf = NULL;
761 }
762 else if ((error = trcv_dtq(cep->rcvqid, (intptr_t*)&input, tmout)) != E_OK) {
763
764#ifdef UDP_CFG_EXTENTIONS
765
766 /* 待ち中に発生したエラー情報を返す。*/
767 if (error == E_RLWAI)
768 error = cep->error;
769
770#endif /* of #ifdef UDP_CFG_EXTENTIONS */
771
772 cep->rcv_tskid = TA_NULL;
773 return error;
774 }
775
776 /* p_dstaddr を設定する。*/
777 uhoff = (uint_t)GET_UDP_HDR_OFFSET(input);
778 udph = GET_UDP_HDR(input, uhoff);
779 p_dstaddr->portno = ntohs(udph->sport);
780 IN_COPY_TO_HOST(&p_dstaddr->ipaddr, input);
781
782 /* データをバッファに移す。*/
783 ulen = ntohs(udph->ulen);
784 if (ulen - UDP_HDR_SIZE > len)
785 error = E_BOVR;
786 else {
787 len = (uint_t)(ulen - UDP_HDR_SIZE);
788 error = (ER_UINT)(ulen - UDP_HDR_SIZE);
789 }
790
791 memcpy(data, GET_UDP_SDU(input, uhoff), (size_t)len);
792
793 syscall(rel_net_buf(input));
794
795 cep->rcv_tskid = TA_NULL;
796 }
797
798 return error;
799 }
800
801#endif /* of #ifdef __udp_rcv_dat */
802
803#endif /* of #ifdef UDP_CFG_NON_BLOCKING */
Note: See TracBrowser for help on using the repository browser.