source: azure_iot_hub/trunk/asp3_dcre/tinet/netinet/if_ether.c@ 389

Last change on this file since 389 was 389, 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: 15.5 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 * 上記著作権者は，以下の (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, 1993
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 reproduce 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 * @(#)if_ether.c 8.1 (Berkeley) 6/10/93
67 * $FreeBSD: src/sys/netinet/if_ether.c,v 1.52.2.6 1999/10/18 11:59:31 sheldonh Exp $
68 */
69
70#include <string.h>
71
72#ifdef TARGET_KERNEL_ASP
73
74#include <kernel.h>
75#include <sil.h>
76#include <t_syslog.h>
77#include "kernel_cfg.h"
78
79#endif /* of #ifdef TARGET_KERNEL_ASP */
80
81#ifdef TARGET_KERNEL_JSP
82
83#include <s_services.h>
84#include <t_services.h>
85#include "kernel_id.h"
86
87#endif /* of #ifdef TARGET_KERNEL_JSP */
88
89#include <tinet_defs.h>
90#include <tinet_config.h>
91
92#include <net/if.h>
93#include <net/ethernet.h>
94#include <net/if_arp.h>
95#include <net/net.h>
96#include <net/net_endian.h>
97#include <net/net_buf.h>
98#include <net/net_var.h>
99#include <net/net_timer.h>
100#include <net/net_count.h>
101
102#include <netinet/in.h>
103#include <netinet/in_var.h>
104#include <netinet/ip.h>
105#include <netinet/if_ether.h>
106
107#include <net/if_var.h>
108
109#if defined(_IP4_CFG) && defined(SUPPORT_ETHER)
110
111/*
112 * ARP キャッシュエントリ
113 */
114
115static T_ARP_ENTRY arp_cache[NUM_ARP_ENTRY];
116
117/*
118 * 関数
119 */
120
121static void in_arpinput (T_IF_ADDR *ifaddr, T_NET_BUF *input);
122static void arp_timer (void *ignore);
123
124/*
125 * in_arpinput -- TCP/IP 用 ARP の入力関数
126 */
127
128static void
129in_arpinput (T_IF_ADDR *ifaddr, T_NET_BUF *input)
130{
131 T_NET_BUF *pending;
132 T_ETHER_HDR *eth;
133 T_ARP_HDR *arph;
134 T_ETHER_ARP_HDR *et_arph;
135 T_ARP_ENTRY *ent;
136 T_IFNET *ifp = IF_GET_IFNET();
137 T_IN4_ADDR saddr, taddr;
138
139 et_arph = GET_ETHER_ARP_HDR(input);
140
141 ntoahl(saddr, et_arph->sproto); /* 送信元 IP アドレス */
142 ntoahl(taddr, et_arph->tproto); /* 解決対象 IP アドレス */
143
144 /*
145 * 以下の場合はエラー
146 * ・送信ホストの物理アドレスが自分
147 * ・送信ホストの物理アドレスがブロードキャスト
148 */
149 if (memcmp(et_arph->shost, ifaddr->lladdr, ETHER_ADDR_LEN) == 0 ||
150 memcmp(et_arph->shost, ether_broad_cast_addr, ETHER_ADDR_LEN) == 0)
151 goto err_ret;
152
153 /*
154 * 送信ホストの IP アドレスが自分の場合は、重複しているので
155 * 相手にも知らせる。
156 * ただし、自分と相手のアドレスが未定義（IPV4_ADDRANY）の時は何もしない。
157 */
158 if ((saddr == ifp->in4_ifaddr.addr) && (saddr != IPV4_ADDRANY)) {
159
160#ifdef ARP_CFG_CALLBACK_DUPLICATED
161
162 if (arp_callback_duplicated(et_arph->shost)) {
163 syslog(LOG_ERROR, "[ARP] IP address duplicated: %s",
164 ip2str(NULL, &ifp->in4_ifaddr.addr),
165 mac2str(NULL, et_arph->shost));
166 taddr = saddr;
167 goto reply;
168 }
169 else
170 goto buf_rel;
171
172#else /* of #ifdef ARP_CFG_CALLBACK_DUPLICATED */
173
174 syslog(LOG_ERROR, "[ARP] IP address duplicated: %s",
175 ip2str(NULL, &ifp->in4_ifaddr.addr),
176 mac2str(NULL, et_arph->shost));
177 taddr = saddr;
178 goto reply;
179
180#endif /* of #ifdef ARP_CFG_CALLBACK_DUPLICATED */
181
182 }
183
184 /*
185 * 以下の場合は何もしない。
186 * ・解決対象 IP アドレスが自分ではない、注: 元の FreeBSD の
187 * 実装では、ARP PROXY 等のため、自分以外の IP アドレスの
188 * 解決も行っているが、本実装では、自分以外の IP
189 * アドレスの解決は行わない。
190 */
191 if (taddr != ifp->in4_ifaddr.addr)
192 goto buf_rel;
193
194 /*
195 * 送信元 IP アドレスが ARP キャッシュにあるか調べる。
196 * キャッシュになければ、新たにエントリを登録する。
197 */
198 syscall(wai_sem(SEM_ARP_CACHE_LOCK));
199 ent = arp_lookup(saddr, true);
200
201 memcpy(ent->mac_addr, et_arph->shost, ETHER_ADDR_LEN);
202 ent->expire = ARP_CACHE_KEEP;
203
204 /*
205 * 送信がペンデングされているフレームがあれば送信する。
206 */
207 if (ent->hold) {
208
209 /* フレームの Ethernet ヘッダを設定する。*/
210 memcpy(GET_ETHER_HDR(ent->hold)->dhost, ent->mac_addr, ETHER_ADDR_LEN);
211
212 pending = ent->hold;
213 ent->hold = NULL;
214 syscall(sig_sem(SEM_ARP_CACHE_LOCK));
215
216 /* ペンディングされているフレームを送信する。*/
217 IF_RAW_OUTPUT(pending, TMO_FEVR);
218
219 }
220 else
221 syscall(sig_sem(SEM_ARP_CACHE_LOCK));
222
223reply:
224
225 arph = GET_ARP_HDR(input);
226
227 /* アドレス解決要求でなければ終了 */
228 if (ntohs(arph->opcode) != ARPOP_REQUEST)
229 goto buf_rel;
230
231 /* Ethernet ARP ヘッダを設定する。*/
232 memcpy(et_arph->thost, et_arph->shost, ETHER_ADDR_LEN);
233 memcpy(et_arph->shost, ifaddr->lladdr, ETHER_ADDR_LEN);
234 memcpy(et_arph->tproto, (uint8_t*)&et_arph->sproto, sizeof(T_IN_ADDR));
235 ahtonl(et_arph->sproto, taddr);
236
237 /* Ethernet ARP ヘッダを設定する。*/
238 arph->opcode = htons(ARPOP_REPLY);
239
240 /* Ethernet ヘッダを設定する。*/
241 eth = GET_ETHER_HDR(input);
242 memcpy(eth->dhost, eth->shost, ETHER_ADDR_LEN);
243 memcpy(eth->shost, ifaddr->lladdr, ETHER_ADDR_LEN);
244
245 /* ARP 応答を送信する。*/
246 IF_RAW_OUTPUT(input, TMO_FEVR);
247 return;
248
249err_ret:
250 NET_COUNT_ARP(net_count_arp.in_err_packets, 1);
251buf_rel:
252 syscall(rel_net_buf(input));
253 }
254
255/*
256 * arp_timer -- ARP キャッシュの更新
257 */
258
259static void
260arp_timer (void *ignore)
261{
262 int_t ix;
263
264 syscall(wai_sem(SEM_ARP_CACHE_LOCK));
265
266 for (ix = NUM_ARP_ENTRY; ix -- > 0; ) {
267 if (arp_cache[ix].expire) {
268 arp_cache[ix].expire -= ARP_TIMER_TMO;
269 if (arp_cache[ix].expire == 0) {
270 /* 送信がペンデングされているフレームがあれば捨てる。*/
271 if (arp_cache[ix].hold) {
272 NET_COUNT_IP4(net_count_ip4[NC_IP4_OUT_ERR_PACKETS], 1);
273 syscall(rel_net_buf(arp_cache[ix].hold));
274 }
275 memset(&arp_cache[ix], 0, sizeof(T_ARP_ENTRY));
276 }
277 }
278 }
279
280 syscall(sig_sem(SEM_ARP_CACHE_LOCK));
281 timeout(arp_timer, NULL, ARP_TIMER_TMO);
282 }
283
284/*
285 * arp_lookup -- ARP キャッシュの探索と登録
286 *
287 * 注意: SEM_ARP_CACHE_LOCK を獲得した状態で呼出すこと
288 */
289
290T_ARP_ENTRY *
291arp_lookup (T_IN4_ADDR addr, bool_t create)
292{
293 int_t ix, six;
294 uint16_t min;
295
296 for (ix = NUM_ARP_ENTRY; ix -- > 0; ) {
297 if (arp_cache[ix].expire && arp_cache[ix].ip_addr == addr)
298 return &arp_cache[ix];
299 }
300
301 /* create が真なら、新たなエントリを登録する。*/
302 if (create) {
303
304 /* まず、空きがあれば、その空きを利用する。*/
305 for (ix = NUM_ARP_ENTRY; ix -- > 0; ) {
306 if (arp_cache[ix].expire == 0) {
307 arp_cache[ix].ip_addr = addr;
308 return &arp_cache[ix];
309 }
310 }
311
312 /*
313 * 空きがなければ、タイムアウトまで時間が最短の
314 * エントリーを破棄して利用する。
315 */
316 syslog(LOG_NOTICE, "[ARP] cache busy, size=%d", NUM_ARP_ENTRY);
317 min = 0xffff;
318 for (six = ix = NUM_ARP_ENTRY; ix -- > 0; )
319 if (arp_cache[ix].expire < min) {
320 six = ix;
321 min = arp_cache[ix].expire;
322 }
323 arp_cache[six].expire = 0;
324 arp_cache[six].ip_addr = addr;
325 return &arp_cache[six];
326 }
327 else
328 return NULL;
329 }
330
331/*
332 * arp_request -- MAC アドレス解決要求
333 */
334
335ER
336arp_request (T_IF_ADDR *ifaddr, T_IN4_ADDR dst)
337{
338 ER error;
339 T_IN4_ADDR src;
340 T_ETHER_HDR *eth;
341 T_ARP_HDR *arph;
342 T_ETHER_ARP_HDR *et_arph;
343 T_NET_BUF *arp_req;
344
345 NET_COUNT_ARP(net_count_arp.out_octets , IF_ARP_ETHER_HDR_SIZE - IF_HDR_SIZE);
346 NET_COUNT_ARP(net_count_arp.out_packets, 1);
347
348 if ((error = tget_net_buf(&arp_req, IF_ARP_ETHER_HDR_SIZE, TMO_ARP_GET_NET_BUF)) == E_OK) {
349
350 /* イーサネットヘッダを設定する。*/
351 eth = GET_ETHER_HDR(arp_req);
352 memcpy(eth->dhost, ether_broad_cast_addr, ETHER_ADDR_LEN);
353 memcpy(eth->shost, ifaddr->lladdr, ETHER_ADDR_LEN);
354 eth->type = htons(ETHER_TYPE_ARP);
355
356 /* ARP ヘッダを設定する。*/
357 arph = GET_ARP_HDR(arp_req);
358 arph->hrd_addr = htons(ARPHRD_ETHER);
359 arph->proto = htons(ETHER_TYPE_IP);
360 arph->hdr_len = sizeof(et_arph->shost);
361 arph->proto_len = sizeof(et_arph->sproto);
362 arph->opcode = htons(ARPOP_REQUEST);
363
364 /* イーサネット ARP ヘッダを設定する。*/
365 et_arph = GET_ETHER_ARP_HDR(arp_req);
366 src = IF_GET_IFNET()->in4_ifaddr.addr;
367 memcpy(et_arph->shost, ifaddr->lladdr, ETHER_ADDR_LEN);
368 memset(et_arph->thost, 0, ETHER_ADDR_LEN);
369 ahtonl(et_arph->sproto, src);
370 ahtonl(et_arph->tproto, dst);
371
372 /* 送信する。*/
373 error = IF_RAW_OUTPUT(arp_req, TMO_ARP_OUTPUT);
374 }
375 if (error != E_OK)
376 NET_COUNT_ARP(net_count_arp.out_err_packets, 1);
377 return error;
378 }
379
380/*
381 * arp_get_cache -- ARP キャッシュを獲得する。
382 */
383
384const T_ARP_ENTRY *
385arp_get_cache (void)
386{
387 return arp_cache;
388 }
389
390/*
391 * arp_input -- ARP の入力関数
392 */
393
394void
395arp_input (T_IF_ADDR *ifaddr, T_NET_BUF *input)
396{
397 T_ARP_HDR *arph;
398
399 NET_COUNT_ARP(net_count_arp.in_octets , input->len - IF_HDR_SIZE);
400 NET_COUNT_ARP(net_count_arp.in_packets, 1);
401
402 /* ARP ヘッダの長さをチェックする。*/
403 if (input->len < IF_ARP_HDR_SIZE)
404 goto buf_rel;
405
406 arph = GET_ARP_HDR(input);
407
408 /*
409 * 物理アドレスフォーマットが Ehternet 以外
410 * または、プロトコルが IP 以外はエラー。
411 */
412 if (ntohs(arph->hrd_addr) != ARPHRD_ETHER ||
413 ntohs(arph->proto) != ETHER_TYPE_IP)
414 goto buf_rel;
415
416 /* ARP ヘッダ + Ether ARP ヘッダの長さをチェックする。*/
417 if (input->len < IF_ARP_ETHER_HDR_SIZE)
418 goto buf_rel;
419
420 in_arpinput(ifaddr, input);
421 return;
422
423buf_rel:
424 NET_COUNT_ARP(net_count_arp.in_err_packets, 1);
425 syscall(rel_net_buf(input));
426 }
427
428/*
429 * arp_resolve -- MAC アドレス解決
430 *
431 * アドレス解決ができれば、戻り値は true を返し、できなければ
432 * 送信をペンディングして、戻り値は false を返す。
433 */
434
435bool_t
436arp_resolve (T_IF_ADDR *ifaddr, T_NET_BUF *output, T_IN4_ADDR gw)
437{
438 T_ARP_ENTRY *ent;
439 T_ETHER_HDR *eth;
440 T_IFNET *ifp = IF_GET_IFNET();
441
442 eth = GET_ETHER_HDR(output);
443
444 /*
445 * 次の場合は、イーサネットのブロードキャストアドレスを返す。
446 *
447 * ・全ビットが 1
448 * ・ホスト部の全ビットが 1 で、ネットワーク部がローカルアドレス
449 */
450 if (gw == IPV4_ADDR_BROADCAST ||
451 gw == ((ifp->in4_ifaddr.addr & ifp->in4_ifaddr.mask) | ~ifp->in4_ifaddr.mask)) {
452 memcpy(eth->dhost, ether_broad_cast_addr, ETHER_ADDR_LEN);
453 return true;
454 }
455
456 /* 送信先 GW の IP アドレスが ARP キャッシュにあるか調べる。*/
457 syscall(wai_sem(SEM_ARP_CACHE_LOCK));
458 ent = arp_lookup(gw, true);
459 if (ent->expire) {
460 memcpy(eth->dhost, ent->mac_addr, ETHER_ADDR_LEN);
461 syscall(sig_sem(SEM_ARP_CACHE_LOCK));
462 return true;
463 }
464 else {
465 /* 送信がペンデングされているフレームがあれば捨てる。*/
466 if (ent->hold) {
467 NET_COUNT_IP4(net_count_ip4[NC_IP4_OUT_ERR_PACKETS], 1);
468 syscall(rel_net_buf(ent->hold));
469 }
470
471 /*
472 * 送信をペンディングする。
473 * IF でネットワークバッファを開放しないフラグが設定されているときは、
474 * 送信をペンディングしない。
475 */
476 if ((output->flags & NB_FLG_NOREL_IFOUT) == 0)
477 ent->hold = output;
478 else {
479 output->flags &= (uint8_t)~NB_FLG_NOREL_IFOUT;
480 ent->hold = NULL;
481 }
482 syscall(sig_sem(SEM_ARP_CACHE_LOCK));
483
484 /* アドレス解決要求を送信する。*/
485 arp_request(ifaddr, gw);
486 return false;
487 }
488 }
489
490/*
491 * arp_init -- ARP 初期化
492 */
493
494void
495arp_init (void)
496{
497 timeout(arp_timer, NULL, ARP_TIMER_TMO);
498 }
499
500#ifdef ETHER_CFG_MULTICAST
501/*
502 * ether_map_ipv4_multicast -- IPv4 マルチキャストアドレスからイーサネット・マルチキャストアドレスへの変換
503 */
504
505void
506ether_map_ipv4_multicast (T_ETHER_ADDR *eaddr, T_IN4_ADDR maddr)
507{
508 eaddr->lladdr[0] = UINT_C(0x01);
509 eaddr->lladdr[1] = UINT_C(0x00);
510 eaddr->lladdr[2] = UINT_C(0x5E);
511 eaddr->lladdr[3] = (uint8_t)((maddr & 0x7F0000) >> 16);
512 eaddr->lladdr[4] = (uint8_t)((maddr & 0xFF00) >> 8);
513 eaddr->lladdr[5] = (uint8_t)(maddr & 0xFF);
514 }
515#endif /* ETHER_CFG_MULTICAST */
516
517#endif /* of #if defined(_IP4_CFG) && defined(SUPPORT_ETHER) */
Note: See TracBrowser for help on using the repository browser.