Context Navigation

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

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

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

Download in other formats: