source: azure_iot_hub/trunk/asp3_dcre/tinet/netinet/ip_icmp.c@ 388

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

Azure IoT Hub Device C SDK を使ったサンプルの追加
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc
File size: 14.3 KB
Line 
1/*
2 * TINET (TCP/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 * 上記著作権者
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: ip_icmp.c 388 2019-05-22 11:25:18Z coas-nagasima $
44 */
45
46/*
47 * Copyright (c) 1982, 1986, 1988, 1993
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 * @(#)ip_icmp.c 8.2 (Berkeley) 1/4/94
79 * $FreeBSD: src/sys/netinet/ip_icmp.c,v 1.33.2.3 1999/10/14 11:49:38 des Exp $
80 */
81
82#include <string.h>
83
84#ifdef TARGET_KERNEL_ASP
85
86#include <kernel.h>
87#include <sil.h>
88#include <t_syslog.h>
89#include "kernel_cfg.h"
90#include "tinet_cfg.h"
91
92#endif /* of #ifdef TARGET_KERNEL_ASP */
93
94#ifdef TARGET_KERNEL_JSP
95
96#include <s_services.h>
97#include <t_services.h>
98#include "tinet_id.h"
99
100#endif /* of #ifdef TARGET_KERNEL_JSP */
101
102#include <tinet_defs.h>
103#include <tinet_config.h>
104
105#include <net/if.h>
106#include <net/if_loop.h>
107#include <net/if_ppp.h>
108#include <net/ethernet.h>
109#include <net/ppp_ipcp.h>
110#include <net/net.h>
111#include <net/net_endian.h>
112#include <net/net_buf.h>
113#include <net/net_timer.h>
114#include <net/net_count.h>
115
116#include <netinet/in.h>
117#include <netinet/in_var.h>
118#include <netinet/ip.h>
119#include <netinet/ip_var.h>
120#include <netinet/ip_icmp.h>
121#include <netinet/icmp_var.h>
122#include <netinet/tcp.h>
123#include <netinet/tcp_var.h>
124#include <netinet/udp_var.h>
125
126#include <net/if_var.h>
127
128#if defined(_IP4_CFG)
129
130/*
131 * 変数
132 */
133
134#ifdef SUPPORT_MIB
135
136/*
137 * SNMP の 管理情
138報ベース (MIB)
139 */
140
141T_ICMP_STATS icmp_stats;
142
143#endif /* of #ifdef SUPPORT_MIB */
144
145/*
146 * 関数
147 */
148
149static void icmp_echo (T_NET_BUF *input, uint_t ihoff);
150static void icmp_unreach (T_NET_BUF *input, uint_t ihoff);
151
152#if defined(NUM_REDIRECT_ROUTE_ENTRY)
153#if NUM_REDIRECT_ROUTE_ENTRY > 0
154
155static void icmp_redirect (T_NET_BUF *input, uint_t ihoff);
156
157#endif /* of #if NUM_REDIRECT_ROUTE_ENTRY > 0 */
158#endif /* of #if defined(NUM_REDIRECT_ROUTE_ENTRY) */
159
160/*
161 * icmp_echo -- エコー要求を受信したときの処理
162 *
163 * input には IF ヘッダと IP ヘッダも含まれている。
164 */
165
166static void
167icmp_echo (T_NET_BUF *input, uint_t ihoff)
168{
169 T_IP4_HDR *ip4h;
170 T_ICMP4_HDR *icmp4h;
171 T_IFNET *ifp = IF_GET_IFNET();
172
173 NET_COUNT_MIB(icmp_stats.icmpInEchos, 1);
174
175 /* IPv4 アドレスが未定義の時は応答しない。*/
176 if (!IN4_IS_ADDR_ANY(&ifp->in4_ifaddr.addr)) {
177
178 /*
179 * メッセージの型をエコー要求 (8) から
180 * エコー応答 (0) に変更して送り返す。
181 */
182
183 icmp4h = GET_ICMP4_HDR(input, ihoff);
184 icmp4h->type = ICMP4_ECHO_REPLY;
185
186 /*
187 * 宛å…
188ˆã‚¢ãƒ‰ãƒ¬ã‚¹ã¯å—信したメッセージの送信å…
189ƒã‚¢ãƒ‰ãƒ¬ã‚¹ã€‚
190 * 送信å…
191ƒã‚¢ãƒ‰ãƒ¬ã‚¹ã¯è‡ª IPv4 アドレス。
192 */
193 ip4h = GET_IP4_HDR(input);
194 ip4h->dst = ip4h->src;
195 ip4h->src = htonl(ifp->in4_ifaddr.addr);
196
197 /* チェックサムを計算する。*/
198 icmp4h->sum = 0;
199 icmp4h->sum = in_cksum(icmp4h,
200 (uint_t)(((input->len - GET_IF_IP4_HDR_SIZE(input)) + 3) >> 2 << 2));
201
202 /* 送信する。*/
203 NET_COUNT_ICMP4(net_count_icmp4.out_octets,
204 input->len - GET_IF_IP4_HDR_SIZE(input));
205 NET_COUNT_ICMP4(net_count_icmp4.out_packets, 1);
206 NET_COUNT_MIB(icmp_stats.icmpOutMsgs, 1);
207 NET_COUNT_MIB(icmp_stats.icmpOutEchoReps, 1);
208 ip_output(input, TMO_ICMP_OUTPUT);
209 }
210 }
211
212/*
213 * icmp_unreach -- ICMP4_UNREACH を受信したときの処理
214 */
215
216static const int8_t code2error[] = {
217 EV_HURCH, /* ICMP4_UNREACH_NET 0 */
218 EV_HURCH, /* ICMP4_UNREACH_HOST 1 */
219 EV_CNNRF, /* ICMP4_UNREACH_PROTOCOL 2 */
220 EV_CNNRF, /* ICMP4_UNREACH_PORT 3 */
221 EV_MSIZE, /* ICMP4_UNREACH_FLAG 4 */
222 EV_HURCH, /* ICMP4_UNREACH_SRC_FAIL 5 */
223 EV_HURCH, /* ICMP4_UNREACH_NET_UNKNOWN 6 */
224 EV_HURCH, /* ICMP4_UNREACH_HOST_UNKNOWN 7 */
225 EV_HURCH, /* ICMP4_UNREACH_ISOLATED 8 */
226 EV_HURCH, /* ICMP4_UNREACH_NET_PROHIB 9 */
227 EV_HURCH, /* ICMP4_UNREACH_HOST_PROHIB 10 */
228 EV_HURCH, /* ICMP4_UNREACH_TOS_NET 11 */
229 EV_HURCH, /* ICMP4_UNREACH_TOS_HOST 12 */
230 EV_HURCH, /* ICMP4_UNREACH_FILTER_PROHIB 13 */
231 EV_HURCH, /* ICMP4_UNREACH_HOST_PRECEDENCE 14 */
232 EV_HURCH, /* ICMP4_UNREACH_PRECEDENCE_CUTOFF 15 */
233 };
234
235static void
236icmp_unreach (T_NET_BUF *input, uint_t ihoff)
237{
238 T_IP4_HDR *ip4h;
239 uint8_t code;
240 ER error;
241
242 NET_COUNT_MIB(icmp_stats.icmpInDestUnreachs, 1);
243
244 ip4h = (T_IP4_HDR*)GET_ICMP4_SDU(input, ihoff);
245 code = GET_ICMP4_HDR(input, ihoff)->code;
246 error = code2error[code];
247
248 /* 最終ヘッダが TCP/UDP のみ対応する。*/
249 if (ip4h->proto == IPPROTO_TCP || ip4h->proto == IPPROTO_UDP) {
250
251 memcpy(GET_IP4_HDR(input), ip4h, input->len - (IP4_HDR_SIZE + ICMP4_HDR_SIZE));
252 input->len -= IP4_HDR_SIZE + ICMP4_HDR_SIZE;
253
254#if defined(SUPPORT_TCP)
255
256 if (ip4h->proto == IPPROTO_TCP)
257 tcp_notify(input, error);
258
259#endif /* of #if defined(SUPPORT_TCP) */
260
261#if defined(SUPPORT_UDP) && TNUM_UDP4_CEPID > 0
262
263 if (ip4h->proto == IPPROTO_UDP)
264 udp4_notify(input, error);
265
266#endif /* of #if defined(SUPPORT_UDP) && TNUM_UDP4_CEPID > 0 */
267
268 }
269 else
270 syslog(LOG_NOTICE, "[ICMP] error, code: %d.", code);
271 }
272
273#if defined(NUM_REDIRECT_ROUTE_ENTRY)
274#if NUM_REDIRECT_ROUTE_ENTRY > 0
275
276/*
277 * icmp_redirect -- 向け直しメッセージを受信したときの処理
278 *
279 * input には IF ヘッダと IP ヘッダも含まれている。
280 */
281
282static void
283icmp_redirect (T_NET_BUF *input, uint_t ihoff)
284{
285 T_IP4_HDR *ip4h, *sip4h;
286 T_ICMP4_HDR *icmp4h;
287
288 ip4h = GET_IP4_HDR(input);
289 icmp4h = GET_ICMP4_HDR(input, ihoff);
290 sip4h = (T_IP4_HDR *)GET_ICMP4_SDU(input, ihoff);
291
292 /*
293 * 内
294容チェック、以下の場合はエラー
295 *
296 * ・ICMP コードが、ICMP4_REDIRECT_PORT_AND_HOST (3) 以上
297 * ・データグラム長が、ICMP の最小長より短い (IP ヘッダ + ICMP ヘッダ + IP ヘッダ + 8)
298 * ・データグラム長が、ICMP の最大長より短い
299 * ・
300 */
301 if (icmp4h->code > ICMP4_REDIRECT_PORT_AND_HOST ||
302 ip4h->len < GET_IP4_ICMP4_HDR_SIZE(input) + 8 + IP4_HDR_SIZE ||
303 ip4h->len < GET_IP4_ICMP4_HDR_SIZE(input) + 8 + (IP4_VHL_HL(sip4h->vhl) << 2)) {
304 NET_COUNT_ICMP4(net_count_icmp4.in_err_packets, 1);
305 return;
306 }
307
308 in4_rtredirect(icmp4h->data.addr, sip4h->dst, IN_RTF_REDIRECT, TMO_IN_REDIRECT);
309 }
310
311#endif /* of #if NUM_REDIRECT_ROUTE_ENTRY > 0 */
312#endif /* of #if defined(NUM_REDIRECT_ROUTE_ENTRY) */
313
314/*
315 * icmp_input -- ICMP のå…
316¥åŠ›é–¢æ•°
317 *
318 * input には IF ヘッダと IP ヘッダも含まれている。
319 */
320
321uint_t
322icmp_input (T_NET_BUF **inputp, uint_t *offp, uint_t *nextp)
323{
324 T_NET_BUF *input = *inputp;
325 T_ICMP4_HDR *icmp4h;
326 T_IN4_ADDR addr;
327 uint_t len, align;
328
329 NET_COUNT_ICMP4(net_count_icmp4.in_octets,
330 input->len - GET_IF_IP4_HDR_SIZE(input));
331 NET_COUNT_ICMP4(net_count_icmp4.in_packets, 1);
332
333 /* ICMP ヘッダの長さをチェックする。*/
334 if (input->len < IF_IP4_ICMP4_HDR_SIZE) {
335 NET_COUNT_ICMP4(net_count_icmp4.in_err_packets, 1);
336 NET_COUNT_MIB(icmp_stats.icmpInErrors, 1);
337 goto buf_rel;
338 }
339
340 icmp4h = (T_ICMP4_HDR *)(input->buf + *offp);
341
342 /* 4 オクテット境界のデータ長 */
343 len = input->len - *offp;
344 align = (len + 3) >> 2 << 2;
345
346 /* 4 オクテット境界までパディングで埋める。*/
347 if (align > len)
348 memset((uint8_t*)input->buf + input->len, 0, (size_t)(align - len));
349
350 /* チェックサムを計算する。*/
351 if (in_cksum(icmp4h, align) != 0) {
352 NET_COUNT_ICMP4(net_count_icmp4.in_err_packets, 1);
353 goto buf_rel;
354 }
355
356 /* メッセージの型により分岐する。*/
357 switch (icmp4h->type) {
358 case ICMP4_ECHO_REQUEST:
359 icmp_echo(input, *offp);
360 return IPPROTO_DONE;
361 break;
362 case ICMP4_ECHO_REPLY:
363
364#if defined(SUPPORT_INET4) && defined(ICMP_CFG_CALLBACK_ECHO_REPLY)
365
366 icmp_echo_reply(input, *offp);
367
368#endif /* of #if defined(SUPPORT_INET4) && defined(ICMP_CFG_CALLBACK_ECHO_REPLY) */
369
370 break;
371 case ICMP4_UNREACH:
372 icmp_unreach(input, *offp);
373 break;
374 case ICMP4_REDIRECT:
375
376#if defined(NUM_REDIRECT_ROUTE_ENTRY)
377#if NUM_REDIRECT_ROUTE_ENTRY > 0
378
379 addr = ntohl(icmp4h->data.addr);
380 syslog(LOG_INFO, "[ICMP] redirect, addr: %s.", ip2str(NULL, &addr));
381 icmp_redirect(input, *offp);
382
383#else /* of #if NUM_REDIRECT_ROUTE_ENTRY > 0 */
384
385 addr = ntohl(icmp4h->data.addr);
386 syslog(LOG_INFO, "[ICMP] redirect ignored, addr: %s.", ip2str(NULL, &addr));
387
388#endif /* of #if NUM_REDIRECT_ROUTE_ENTRY > 0 */
389#else /* of #if defined(NUM_REDIRECT_ROUTE_ENTRY) */
390
391 addr = ntohl(icmp4h->data.addr);
392 syslog(LOG_INFO, "[ICMP] redirect ignored, addr: %s.", ip2str(NULL, &addr));
393
394#endif /* of #if defined(NUM_REDIRECT_ROUTE_ENTRY) */
395
396 break;
397 default:
398 syslog(LOG_INFO, "[ICMP] unknown type: %d.", icmp4h->type);
399 NET_COUNT_ICMP4(net_count_icmp4.in_err_packets, 1);
400 break;
401 }
402
403buf_rel:
404 syscall(rel_net_buf(input));
405 return IPPROTO_DONE;
406 }
407
408#ifdef ICMP_REPLY_ERROR
409
410/*
411 * icmp_error -- ICMP エラー送信関数。
412 *
413 * input には IF ヘッダと IP ヘッダも含まれている。
414 * icmp_error では、ネットワークバッファ input を返却しないので、
415 * 呼出し側で、開放してから終了する。
416 */
417
418void
419icmp_error (uint8_t code, T_NET_BUF *input)
420{
421 T_IP4_HDR *ip4h;
422 T_ICMP4_HDR *icmp4h;
423 T_NET_BUF *output;
424 T_IN4_ADDR saddr;
425 uint_t len, ip4hl, align;
426
427 ip4h = GET_IP4_HDR(input);
428 ip4hl = GET_IP4_HDR_SIZE(input);
429
430 /* 送信用の IP データグラムを獲得する。*/
431 if (input->len - ip4hl < 8)
432 len = input->len - ip4hl;
433 else
434 len = 8;
435
436 saddr = ntohl(ip4h->src);
437 if (in4_get_datagram(&output, (uint_t)(ICMP4_HDR_SIZE + ip4hl + len), 0,
438 &saddr, NULL, IPPROTO_ICMP, IP4_DEFTTL,
439 NBA_SEARCH_ASCENT, TMO_ICMP_OUTPUT) != E_OK)
440 return;
441
442 /* ICMP ヘッダを設定する。*/
443 icmp4h = GET_ICMP4_HDR(output, IF_IP4_ICMP4_HDR_OFFSET);
444 icmp4h->type = ICMP4_UNREACH;
445 icmp4h->code = code;
446 icmp4h->data.addr= 0;
447
448 /* エラーが発生した IP ヘッダと データ 8 オクテットをコピーする。*/
449 memcpy(GET_ICMP4_SDU(output, IF_IP4_ICMP4_HDR_OFFSET),
450 GET_IP4_HDR(input), (size_t)(ip4hl + len));
451
452 /* 4 オクテット境界のデータ長 */
453 align = (len + 3) >> 2 << 2;
454
455 /* 4 オクテット境界までパディングで埋める。*/
456 if (align > len)
457 memset((uint8_t*)GET_ICMP4_SDU(output, IF_IP4_ICMP4_HDR_OFFSET) + ip4hl + len,
458 0, (size_t)(align - len));
459
460 /* チェックサムを計算する。*/
461 icmp4h->sum = 0;
462 icmp4h->sum = in_cksum(icmp4h, (uint_t)(ICMP4_HDR_SIZE + ip4hl + align));
463
464 /* 送信する。*/
465 NET_COUNT_ICMP4(net_count_icmp4.out_octets,
466 output->len - GET_IF_IP4_HDR_SIZE(output));
467 NET_COUNT_ICMP4(net_count_icmp4.out_packets, 1);
468 NET_COUNT_MIB(icmp_stats.icmpOutMsgs, 1);
469 NET_COUNT_MIB(icmp_stats.icmpOutDestUnreachs, 1);
470 ip_output(output, TMO_ICMP_OUTPUT);
471 }
472
473#endif /* of #ifdef ICMP_REPLY_ERROR */
474
475#endif /* of #if defined(_IP4_CFG) */
Note: See TracBrowser for help on using the repository browser.