source: azure_iot_hub/trunk/asp3_dcre/tinet/netinet/in_subr.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: 13.9 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: in_subr.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
79#include <string.h>
80
81#ifdef TARGET_KERNEL_ASP
82
83#include <kernel.h>
84#include <sil.h>
85#include "kernel_cfg.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/net.h>
105#include <net/net_endian.h>
106#include <net/net_var.h>
107#include <net/net_buf.h>
108#include <net/net_timer.h>
109
110#include <netinet/in.h>
111#include <netinet/in_var.h>
112#include <netinet/ip.h>
113#include <netinet/ip_var.h>
114#include <netinet/in_itron.h>
115
116#include <net/if_var.h>
117
118/*
119 * in_cksum_sum -- チェックサムの合計計算関数
120 *
121 * 注意: data は 4 オクテット単位でパディングすること。
122 * data が 2 オクテット単位にアラインされていないと
123 * 例外が発生する可能性がある。
124 * len は 4 オクテット単位にアラインされていること。
125 *
126 * 戻り値はホストバイトオーダ
127 */
128
129uint32_t
130in_cksum_sum (void *data, uint_t len /*オクテット単位*/)
131{
132 uint32_t sum = 0;
133
134 for ( ; len > 0; len -= 2) {
135 sum += *((uint16_t*)data);
136 data = (uint8_t*)data + 2;
137 }
138
139#if _NET_CFG_BYTE_ORDER == _NET_CFG_BIG_ENDIAN
140 return sum;
141#elif _NET_CFG_BYTE_ORDER == _NET_CFG_LITTLE_ENDIAN
142 return ((sum >> 8) & 0xffff) + ((sum & 0xff) << 8) + ((sum >> 24) & 0xff);
143#endif /* #if _NET_CFG_BYTE_ORDER == _NET_CFG_BIG_ENDIAN */
144
145 }
146
147/*
148 * in_cksum_carry -- チェックサムの桁上げ計算関数
149 *
150 * 注意: data は 4 オクテット単位でパディングすること。
151 * data が 2 オクテット単位にアラインされていないと
152 * 例外が発生する可能性がある。
153 * len は 4 オクテット単位にアラインされていること。
154 */
155
156uint32_t
157in_cksum_carry (uint32_t sum)
158{
159 uint32_t carry;
160
161 while (sum >= 0x00010000) {
162 carry = sum >> 16;
163 sum = (sum & 0xffff) + carry;
164 }
165
166 return sum;
167 }
168
169/*
170 * in_strtfn -- API 機能コードの文字表現を返す。
171 */
172
173typedef struct t_strtfn {
174 FN fncd; /* API 機能コード */
175 const char *str; /* 文字表現 */
176 } T_STRTFN;
177
178const T_STRTFN strtfn[] = {
179 { TEV_TCP_RCV_OOB, "TEV_TCP_RCV_OOB" },
180 { TFN_TCP_DEL_REP, "TFN_TCP_DEL_REP" },
181 { TFN_TCP_CRE_CEP, "TFN_TCP_CRE_CEP" },
182 { TFN_TCP_DEL_CEP, "TFN_TCP_DEL_CEP" },
183 { TFN_TCP_ACP_CEP, "TFN_TCP_ACP_CEP" },
184 { TFN_TCP_CON_CEP, "TFN_TCP_CON_CEP" },
185 { TFN_TCP_SHT_CEP, "TFN_TCP_SHT_CEP" },
186 { TFN_TCP_CLS_CEP, "TFN_TCP_CLS_CEP" },
187 { TFN_TCP_SND_DAT, "TFN_TCP_SND_DAT" },
188 { TFN_TCP_RCV_DAT, "TFN_TCP_RCV_DAT" },
189 { TFN_TCP_GET_BUF, "TFN_TCP_GET_BUF" },
190 { TFN_TCP_SND_BUF, "TFN_TCP_SND_BUF" },
191 { TFN_TCP_RCV_BUF, "TFN_TCP_RCV_BUF" },
192 { TFN_TCP_REL_BUF, "TFN_TCP_REL_BUF" },
193 { TFN_TCP_SND_OOB, "TFN_TCP_SND_OOB" },
194 { TFN_TCP_RCV_OOB, "TFN_TCP_RCV_OOB" },
195 { TFN_TCP_CAN_CEP, "TFN_TCP_CAN_CEP" },
196 { TFN_TCP_SET_OPT, "TFN_TCP_SET_OPT" },
197 { TFN_TCP_GET_OPT, "TFN_TCP_GET_OPT" },
198 { TFN_TCP_ALL, "TFN_TCP_ALL" },
199
200 { TEV_UDP_RCV_DAT, "TEV_UDP_RCV_DAT" },
201 { TFN_UDP_DEL_CEP, "TFN_UDP_DEL_CEP" },
202 { TFN_UDP_SND_DAT, "TFN_UDP_SND_DAT" },
203 { TFN_UDP_RCV_DAT, "TFN_UDP_RCV_DAT" },
204 { TFN_UDP_CAN_CEP, "TFN_UDP_CAN_CEP" },
205 { TFN_UDP_SET_OPT, "TFN_UDP_SET_OPT" },
206 { TFN_UDP_GET_OPT, "TFN_UDP_GET_OPT" },
207 };
208
209const char *
210in_strtfn (FN fncd)
211{
212 int_t ix;
213
214 for (ix = sizeof(strtfn) / sizeof(T_STRTFN); ix -- > 0; )
215 if (strtfn[ix].fncd == fncd)
216 return strtfn[ix].str;
217
218 return "unknown TFN";
219 }
220
221#if defined(_IP4_CFG)
222
223/*
224 * ipv42str -- IPv4 アドレスを文字列に変換する。
225 */
226
227char *
228ipv42str (char *buf, const T_IN4_ADDR *ipaddr)
229{
230 static char addr_sbuf[NUM_IPV4ADDR_STR_BUFF][sizeof("123.123.123.123")];
231 static int_t bix = NUM_IPV4ADDR_STR_BUFF;
232
233 char *start;
234
235 if (buf == NULL) {
236 syscall(wai_sem(SEM_IP2STR_BUFF_LOCK));
237 buf = addr_sbuf[-- bix];
238 if (bix <= 0)
239 bix = NUM_IPV4ADDR_STR_BUFF;
240 syscall(sig_sem(SEM_IP2STR_BUFF_LOCK));
241 }
242
243 start = buf;
244 buf += convert_hexdigit(buf, (uint_t)((*ipaddr >> 24) & 0xff), 10, 0, ' ');
245 *(buf ++) = '.';
246 buf += convert_hexdigit(buf, (uint_t)((*ipaddr >> 16) & 0xff), 10, 0, ' ');
247 *(buf ++) = '.';
248 buf += convert_hexdigit(buf, (uint_t)((*ipaddr >> 8) & 0xff), 10, 0, ' ');
249 *(buf ++) = '.';
250 buf += convert_hexdigit(buf, (uint_t)((*ipaddr ) & 0xff), 10, 0, ' ');
251 *buf = '\0';
252 return start;
253 }
254
255#endif /* of #if defined(_IP4_CFG) */
256
257/*
258 * in6_is_addr_ipv4mapped -- IPv4 射影アドレスである事を検査する。
259 */
260
261bool_t
262in6_is_addr_ipv4mapped (const T_IN6_ADDR *addr)
263{
264 return IN6_IS_ADDR_V4MAPPED(addr);
265 }
266
267#if defined(_IP6_CFG) && defined(_IP4_CFG)
268
269/*
270 * ip_exchg_addr -- IP アドレスを交換する。
271 */
272
273static void
274ip6_exchg_addr (T_NET_BUF *nbuf)
275{
276 T_IP6_HDR *iph;
277 T_IN6_ADDR ipaddr;
278
279 iph = GET_IP6_HDR(nbuf);
280
281 /* IPv6 アドレスを交換する。*/
282 ipaddr = iph->src;
283 iph->src = iph->dst;
284 iph->dst = ipaddr;
285 }
286
287static void
288ip4_exchg_addr (T_NET_BUF *nbuf)
289{
290 T_IP4_HDR *iph;
291 T_IN4_ADDR ipaddr;
292
293 iph = GET_IP4_HDR(nbuf);
294
295 /* IPv4 アドレスを交換する。*/
296 ipaddr = iph->src;
297 iph->src = iph->dst;
298 iph->dst = ipaddr;
299 }
300
301void
302ip_exchg_addr (T_NET_BUF *nbuf)
303{
304 if (GET_IP_VER(nbuf) == 6)
305 ip6_exchg_addr(nbuf);
306 else
307 ip4_exchg_addr(nbuf);
308 }
309
310#else /* of #if defined(_IP6_CFG) && defined(_IP4_CFG) */
311
312/*
313 * ip_exchg_addr -- IP アドレスを交換する。
314 */
315
316void
317ip_exchg_addr (T_NET_BUF *nbuf)
318{
319 T_IP_HDR *iph;
320 T_IN_ADDR ipaddr;
321
322 iph = GET_IP_HDR(nbuf);
323
324 /* IP アドレスを交換する。*/
325 ipaddr = iph->src;
326 iph->src = iph->dst;
327 iph->dst = ipaddr;
328 }
329
330#endif /* of #if defined(_IP6_CFG) && defined(_IP4_CFG) */
331
332#if defined(_IP6_CFG) && defined(_IP4_CFG)
333
334/*
335 * inn_is_dstaddr_accept -- 宛å…
336ˆã‚¢ãƒ‰ãƒ¬ã‚¹ã¨ã—て正しいかチェックする。
337 */
338
339bool_t
340inn_is_dstaddr_accept (T_IN6_ADDR *myaddr, T_NET_BUF *nbuf)
341{
342 if (GET_IP_VER(nbuf)==IPV6_VERSION)
343 return INN6_IS_DSTADDR_ACCEPT(myaddr, nbuf);
344 else /*if (GET_IP_VER(nbuf)==IPV4_VERSION)*/ {
345 T_IP4_HDR *ip4h;
346
347 ip4h = GET_IP4_HDR(nbuf);
348 if (IN6_IS_ADDR_UNSPECIFIED(myaddr))
349 return ntohl(ip4h->dst) == IF_GET_IFNET()->in4_ifaddr.addr;
350 else {
351 T_IN6_ADDR dstaddr;
352
353 return IN6_ARE_ADDR_EQUAL(myaddr, in6_make_ipv4mapped(&dstaddr, ntohl(ip4h->dst)));
354 }
355 }
356 }
357
358/*
359 * inn_are_net_srcaddr_equal -- アドレスが同一かチェックする。
360 */
361
362bool_t
363inn_are_net_srcaddr_equal (T_IN6_ADDR *ipaddr, T_NET_BUF *nbuf)
364{
365 if (GET_IP_VER(nbuf)==IPV6_VERSION)
366 return IN6_ARE_ADDR_EQUAL(ipaddr, &GET_IP6_HDR(nbuf)->src);
367 else /*if (GET_IP_VER(nbuf)==IPV4_VERSION)*/ {
368
369
370 T_IN6_ADDR srcaddr;
371
372 return IN6_ARE_ADDR_EQUAL(ipaddr, in6_make_ipv4mapped(&srcaddr, ntohl(GET_IP4_HDR(nbuf)->src)));
373 }
374 }
375
376/*
377 * inn_copy_to_host -- IP ヘッダからホスト表現変換して、IP アドレスをコピーする。
378 */
379
380void
381inn_copy_to_host (T_IN6_ADDR *dst, T_NET_BUF *nbuf)
382{
383 if (GET_IP_VER(nbuf)==IPV6_VERSION)
384 memcpy(dst, &GET_IP6_HDR(nbuf)->src, sizeof(T_IN6_ADDR));
385 else /*if (GET_IP_VER(nbuf)==IPV4_VERSION)*/
386 in6_make_ipv4mapped(dst, ntohl(GET_IP4_HDR(nbuf)->src));
387
388 }
389
390/*
391 * inn_get_datagram -- IPv6/IPv4 データグラムを獲得し、ヘッダを設定する。
392 */
393
394ER
395inn_get_datagram (T_NET_BUF **nbuf, uint_t len, uint_t maxlen,
396 T_IN6_ADDR *dstaddr, T_IN6_ADDR *srcaddr,
397 uint8_t next, uint8_t hlim, ATR nbatr, TMO tmout)
398{
399 if (IN6_IS_ADDR_V4MAPPED(dstaddr)) {
400 T_IN4_ADDR ip4dstaddr, ip4srcaddr;
401
402 ip4dstaddr = ntohl(dstaddr->s6_addr32[3]);
403 if (IN6_IS_ADDR_UNSPECIFIED(srcaddr))
404 ip4srcaddr = IF_GET_IFNET()->in4_ifaddr.addr;
405 else
406 ip4srcaddr = ntohl(srcaddr->s6_addr32[3]);
407
408 return in4_get_datagram(nbuf, len, maxlen, &ip4dstaddr, &ip4srcaddr, next, hlim, nbatr, tmout);
409 }
410 else
411 return in6_get_datagram(nbuf, len, maxlen, dstaddr, srcaddr, next, hlim, nbatr, tmout);
412 }
413
414/*
415 * inn_addrwithifp -- 宛å…
416ˆã‚¢ãƒ‰ãƒ¬ã‚¹ã«ãµã•ã‚ã—い送信å…
417ƒã‚¢ãƒ‰ãƒ¬ã‚¹ã‚’、
418 * ネットワークインタフェースから探索する。
419 */
420
421T_IN6_ADDR *
422inn_addrwithifp (T_IFNET *ifp, T_IN6_ADDR *src, T_IN6_ADDR *dst)
423{
424 T_IN6_IFADDR *ifaddr;
425
426 if (IN6_IS_ADDR_V4MAPPED(dst))
427 return in6_make_ipv4mapped (src, ifp->in4_ifaddr.addr);
428 else if ((ifaddr = in6_ifawithifp(ifp, dst)) == NULL)
429 return NULL;
430 else {
431 *src = ifaddr->addr;
432 return src;
433 }
434 }
435
436/*
437 * inn_is_addr_multicast -- アドレスがマルチキャストアドレスかチェックする。
438 */
439
440bool_t
441inn_is_addr_multicast (T_IN6_ADDR *addr)
442{
443
444 if (IN6_IS_ADDR_V4MAPPED(addr))
445 return IN4_IS_ADDR_MULTICAST(ntohl(addr->s6_addr32[3]));
446 else
447 return IN6_IS_ADDR_MULTICAST(addr);
448 }
449
450#endif /* of #if defined(_IP6_CFG) && defined(_IP4_CFG) */
451
452/*
453 * バイトオーダ関数の定義
454 *
455 * tinet/net/net.h でもバイトオーダの定義を行っているが、
456 * tinet/net/net.h をインクルードしない
457 * アプリケーションプログラム用に
458 * ターゲット依存しないバイトオーダ関数を定義する。
459 */
460
461#if defined(_NET_CFG_BYTE_ORDER)
462
463#undef ntohs
464#undef htons
465#undef ntohl
466#undef htonl
467
468#if _NET_CFG_BYTE_ORDER == _NET_CFG_BIG_ENDIAN
469
470uint16_t
471ntohs (uint16_t net)
472{
473 return net;
474 }
475
476uint16_t
477htons (uint16_t host)
478{
479 return host;
480 }
481
482uint32_t
483ntohl (uint32_t net)
484{
485 return net;
486 }
487
488uint32_t
489htonl (uint32_t host)
490{
491 return host;
492 }
493
494#elif _NET_CFG_BYTE_ORDER == _NET_CFG_LITTLE_ENDIAN /* of #if _NET_CFG_BYTE_ORDER == _NET_CFG_BIG_ENDIAN */
495
496uint16_t
497ntohs (uint16_t net)
498{
499 return NET_REV_ENDIAN_HWORD(net);
500 }
501
502uint16_t
503htons (uint16_t host)
504{
505 return NET_REV_ENDIAN_HWORD(host);
506 }
507
508uint32_t
509ntohl (uint32_t net)
510{
511 return NET_REV_ENDIAN_WORD(net);
512 }
513
514uint32_t
515htonl (uint32_t host)
516{
517 return NET_REV_ENDIAN_WORD(host);
518 }
519
520#else /* #if _NET_CFG_BYTE_ORDER == _NET_CFG_BIG_ENDIAN */
521
522#error "_NET_CFG_BYTE_ORDER expected."
523
524#endif /* #if _NET_CFG_BYTE_ORDER == _NET_CFG_BIG_ENDIAN */
525
526#endif /* of #if defined(_NET_CFG_BYTE_ORDER) */
Note: See TracBrowser for help on using the repository browser.