source: EcnlProtoTool/trunk/asp3_dcre/tinet/netinet/udp_input.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: 12.0 KB
Line 
1/*
2 * TINET (TCP/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_input.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 reproduce 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
79#include <string.h>
80
81#ifdef TARGET_KERNEL_ASP
82
83#include <kernel.h>
84#include <sil.h>
85#include <t_syslog.h>
86
87#endif /* of #ifdef TARGET_KERNEL_ASP */
88
89#ifdef TARGET_KERNEL_JSP
90
91#include <s_services.h>
92#include <t_services.h>
93#include "kernel_id.h"
94
95#endif /* of #ifdef TARGET_KERNEL_JSP */
96
97#include <tinet_defs.h>
98#include <tinet_config.h>
99
100#include <net/if.h>
101#include <net/if_loop.h>
102#include <net/if_ppp.h>
103#include <net/ethernet.h>
104#include <net/ppp_ipcp.h>
105#include <net/net.h>
106#include <net/net_buf.h>
107#include <net/net_count.h>
108
109#include <netinet/in.h>
110#include <netinet/in_var.h>
111#include <netinet6/in6.h>
112#include <netinet6/in6_var.h>
113#include <netinet/in_itron.h>
114#include <netinet/ip.h>
115#include <netinet/ip_var.h>
116#include <netinet/ip6.h>
117#include <netinet6/ip6_var.h>
118#include <netinet/ip_icmp.h>
119#include <netinet/icmp6.h>
120
121#include <netinet/udp.h>
122#include <netinet/udp_var.h>
123
124#include <net/if_var.h>
125
126#ifdef SUPPORT_UDP
127
128#ifdef SUPPORT_MIB
129
130/*
131 * SNMP の 管理情
132報ベース (MIB)
133 */
134
135T_UDP_STATS udp_stats;
136
137#endif /* of #ifdef SUPPORT_MIB */
138
139#if defined(SUPPORT_INET4)
140
141#ifdef DHCP_CFG
142
143/*
144 * udp_dstaddr_accept -- UDP のあてå…
145ˆã‚¢ãƒ‰ãƒ¬ã‚¹ãŒæ­£ã—いかチェックする。
146 *
147 * DHCP_CFG が定義されているときは、以下のデータグラムを受信する。
148 *
149 * ・あてå…
150ˆã‚¢ãƒ‰ãƒ¬ã‚¹ãŒãƒ–ロードキャスト
151 * ・ローカルアドレスが未定義
152 */
153
154static bool_t
155udp_is_dstaddr_accept (T_IN4_ADDR *myaddr, T_IN4_ADDR *dstaddr)
156{
157 T_IFNET *ifp = IF_GET_IFNET();
158
159 if (ifp->in_ifaddr.addr == IPV4_ADDRANY ||
160 ntohl(*dstaddr) == IPV4_ADDR_BROADCAST ||
161 ntohl(*dstaddr) == ((ifp->in_ifaddr.addr & ifp->in_ifaddr.mask) | ~ifp->in_ifaddr.mask))
162 return true;
163 else
164 return IN_IS_DSTADDR_ACCEPT(myaddr, dstaddr);
165 }
166
167#elif defined(ETHER_CFG_MULTICAST)
168
169/*
170 * udp_dstaddr_accept -- UDP のあてå…
171ˆã‚¢ãƒ‰ãƒ¬ã‚¹ãŒæ­£ã—いかチェックする。
172 *
173 * 以下の場合もデータグラムを受信する。
174 *
175 * ・あてå…
176ˆã‚¢ãƒ‰ãƒ¬ã‚¹ãŒãƒ–ロードキャスト
177 */
178
179static bool_t
180udp_is_dstaddr_accept (T_IN4_ADDR *myaddr, T_IN4_ADDR *dstaddr)
181{
182 T_IFNET *ifp = IF_GET_IFNET();
183 T_IN4_ADDR dst = ntohl(*dstaddr);
184
185 if (dst == IPV4_ADDR_BROADCAST ||
186 dst == ((ifp->in_ifaddr.addr & ifp->in_ifaddr.mask) | ~ifp->in_ifaddr.mask) ||
187 IN4_IS_ADDR_MULTICAST(dst))
188 return true;
189 else
190 return IN_IS_DSTADDR_ACCEPT(myaddr, dstaddr);
191 }
192
193#else /* of #ifdef DHCP_CFG */
194
195/*
196 * udp_dstaddr_accept -- UDP のあてå…
197ˆã‚¢ãƒ‰ãƒ¬ã‚¹ãŒæ­£ã—いかチェックする。
198 *
199 * 以下の場合もデータグラムを受信する。
200 *
201 * ・あてå…
202ˆã‚¢ãƒ‰ãƒ¬ã‚¹ãŒãƒ–ロードキャスト
203 */
204
205static bool_t
206udp_is_dstaddr_accept (T_IN4_ADDR *myaddr, T_IN4_ADDR *dstaddr)
207{
208 T_IFNET *ifp = IF_GET_IFNET();
209
210 if (ntohl(*dstaddr) == IPV4_ADDR_BROADCAST ||
211 ntohl(*dstaddr) == ((ifp->in_ifaddr.addr & ifp->in_ifaddr.mask) | ~ifp->in_ifaddr.mask))
212 return true;
213 else
214 return IN_IS_DSTADDR_ACCEPT(myaddr, dstaddr);
215 }
216
217#endif /* of #ifdef DHCP_CFG */
218
219#endif /* of #if defined(SUPPORT_INET4) */
220
221#if defined(SUPPORT_INET6)
222
223/*
224 * udp_dstaddr_accept -- UDP のあてå…
225ˆã‚¢ãƒ‰ãƒ¬ã‚¹ãŒæ­£ã—いかチェックする。
226 *
227 * 以下の場合もデータグラムを受信する。
228 *
229 * ・あてå…
230ˆã‚¢ãƒ‰ãƒ¬ã‚¹ãŒãƒžãƒ«ãƒã‚­ãƒ£ã‚¹ãƒˆ
231 */
232
233static bool_t
234udp_is_dstaddr_accept (T_IN6_ADDR *myaddr, T_IN6_ADDR *dstaddr)
235{
236 if (IN6_IS_ADDR_MULTICAST(dstaddr))
237 return true;
238 else
239 return IN_IS_DSTADDR_ACCEPT(myaddr, dstaddr);
240 }
241
242#endif /* of #if defined(SUPPORT_INET6) */
243
244/*
245 * udp_input -- UDP のå…
246¥åŠ›é–¢æ•°
247 */
248
249uint_t
250udp_input (T_NET_BUF **inputp, uint_t *offp, uint_t *nextp)
251{
252 T_NET_BUF *input = *inputp;
253 T_UDP_CEP *cep;
254 T_UDP_HDR *udph;
255 T_IP_HDR *iph;
256 int_t ix;
257 uint_t len, hlen, ulen;
258
259 hlen = (uint_t)GET_IF_IP_HDR_SIZE(input);
260
261 NET_COUNT_UDP(net_count_udp.in_octets, input->len - hlen);
262 NET_COUNT_UDP(net_count_udp.in_packets, 1);
263 NET_COUNT_MIB(udp_stats.udpInDatagrams, 1);
264
265 /* ヘッダ長をチェックする。*/
266 if (input->len < hlen + UDP_HDR_SIZE)
267 goto buf_rel;
268
269 udph = (T_UDP_HDR *)(input->buf + *offp);
270
271 /* データグラム長をチェックする */
272 ulen = ntohs(udph->ulen);
273 if (ulen != input->len - hlen)
274 goto buf_rel;
275
276 /* 宛å…
277ˆãƒãƒ¼ãƒˆãŒ 0 のデータグラムは破棄する。RFC768 */
278 if (udph->dport == 0)
279 goto buf_rel;
280
281#ifdef UDP_CFG_IN_CHECKSUM
282
283 /* チェックサムをチェックする */
284 if (udph->sum && IN_CKSUM(input, IPPROTO_UDP, *offp, ulen) != 0)
285 goto buf_rel;
286
287#endif /* of #ifdef UDP_CFG_IN_CHECKSUM */
288
289 iph = GET_IP_HDR(input);
290
291 /* 宛å…
292ˆã‚¢ãƒ‰ãƒ¬ã‚¹ã¨ãƒãƒ¼ãƒˆã‚’チェックする */
293 for (ix = tmax_udp_ccepid; ix -- > 0; ) {
294 cep = &udp_cep[ix];
295 if (VALID_UDP_CEP(cep) &&
296 udp_is_dstaddr_accept(&cep->myaddr.ipaddr, &iph->dst) &&
297 ntohs(udph->dport) == cep->myaddr.portno) {
298 len = (uint_t)(ntohs(udph->ulen) - UDP_HDR_SIZE);
299
300 if (cep->rcv_tskid != TA_NULL) { /* 非ノンブロッキングコールでペンディング中 */
301 if (psnd_dtq(cep->rcvqid, (intptr_t)input) != E_OK)
302 goto buf_rel;
303 }
304
305#ifdef UDP_CFG_NON_BLOCKING
306
307 else if (cep->rcv_p_dstaddr != NULL) { /* ノンブロッキングコールでペンディング中 */
308
309 /* p_dstaddr を設定する。*/
310 cep->rcv_p_dstaddr->portno = ntohs(udph->sport);
311 IN_COPY_TO_HOST(&cep->rcv_p_dstaddr->ipaddr, &GET_IP_HDR(input)->src);
312
313 /* データをバッファに移す。*/
314 memcpy(cep->rcv_data, GET_UDP_SDU(input, *offp),
315 (size_t)(len < cep->rcv_len ? len : cep->rcv_len));
316 syscall(rel_net_buf(input));
317
318 if (IS_PTR_DEFINED(cep->callback))
319
320#ifdef TCP_CFG_NON_BLOCKING_COMPAT14
321
322 (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_RCV_DAT, (void*)(uint32_t)len);
323
324#else /* of #ifdef TCP_CFG_NON_BLOCKING_COMPAT14 */
325
326 (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_RCV_DAT, (void*)&len);
327
328#endif /* of #ifdef TCP_CFG_NON_BLOCKING_COMPAT14 */
329
330 else
331 syslog(LOG_WARNING, "[UDP] no call back, CEP: %d.", GET_UDP_CEPID(cep));
332 cep->rcv_p_dstaddr = NULL;
333 }
334
335#endif /* of #ifdef UDP_CFG_NON_BLOCKING */
336
337 else if (IS_PTR_DEFINED(cep->callback)) {
338
339 /* コールバック関数を呼び出す。*/
340 cep->cb_netbuf = input;
341
342#ifdef TCP_CFG_NON_BLOCKING_COMPAT14
343
344 (*cep->callback)(GET_UDP_CEPID(cep), TEV_UDP_RCV_DAT, (void*)(uint32_t)len);
345
346#else /* of #ifdef TCP_CFG_NON_BLOCKING_COMPAT14 */
347
348 (*cep->callback)(GET_UDP_CEPID(cep), TEV_UDP_RCV_DAT, (void*)&len);
349
350#endif /* of #ifdef TCP_CFG_NON_BLOCKING_COMPAT14 */
351
352 /*
353 * ネットワークバッファがそのままであれば、コールバック関数内
354で
355 * データを読み出さなかったことになるので、捨てる。
356 */
357 if (cep->cb_netbuf != NULL)
358 syscall(rel_net_buf(cep->cb_netbuf));
359 }
360 else
361 goto buf_rel;
362
363 return IPPROTO_DONE;
364 }
365 }
366
367 NET_COUNT_MIB(udp_stats.udpNoPorts, 1);
368
369#if defined(SUPPORT_INET4)
370
371 /* ローカル IP アドレスに届いたデータグラムのみ ICMP エラーを通知する。*/
372 if (ntohl(iph->dst) == IF_GET_IFNET()->in_ifaddr.addr) {
373 syslog(LOG_INFO, "[UDP] unexp port: %d.", ntohs(udph->dport));
374
375 icmp_error(ICMP4_UNREACH_PORT, input);
376 /* icmp_error では、ネットワークバッファ input を返却しないので下へ抜ける。*/
377 }
378
379#endif /* of #if defined(SUPPORT_INET4) */
380
381#if defined(SUPPORT_INET6)
382
383 /* マルチキャストアドレスに届いたデータグラムは ICMP エラーを通知しない。*/
384 if (!IN6_IS_ADDR_MULTICAST(&iph->dst)) {
385 syslog(LOG_INFO, "[UDP] unexp port: %d.", ntohs(udph->dport));
386
387 /* icmp6_error で、ネットワークバッファ input を返却する。*/
388 icmp6_error(input, ICMP6_DST_UNREACH, ICMP6_DST_UNREACH_NOPORT, 0);
389
390 NET_COUNT_UDP(net_count_udp.in_err_packets, 1);
391 NET_COUNT_MIB(udp_stats.udpInErrors, 1);
392 return IPPROTO_DONE;
393 }
394
395#endif /* of #if defined(SUPPORT_INET6) */
396
397buf_rel:
398 NET_COUNT_UDP(net_count_udp.in_err_packets, 1);
399 NET_COUNT_MIB(udp_stats.udpInErrors, 1);
400 syscall(rel_net_buf(input));
401 return IPPROTO_DONE;
402 }
403
404#endif /* of #ifdef SUPPORT_UDP */
Note: See TracBrowser for help on using the repository browser.