Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

source: asp3_tinet_ecnl_arm/trunk/asp3_dcre/tinet/netinet/udpn_usrreq.c@ 352

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

Note: See TracBrowser for help on using the repository browser.

Download in other formats: