source: EcnlProtoTool/trunk/asp3_dcre/tinet/netinet/udp_output.c@ 321

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

文字コードを設定
  • Property svn:eol-style set to native
  • Property svn:mime-type set to text/x-csrc;charset=UTF-8
File size: 8.6 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 * 上記著作権者は，以下の (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 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
67#include <string.h>
68
69#ifdef TARGET_KERNEL_ASP
70
71#include <kernel.h>
72#include <sil.h>
73#include <t_syslog.h>
74#include "kernel_cfg.h"
75
76#endif /* of #ifdef TARGET_KERNEL_ASP */
77
78#ifdef TARGET_KERNEL_JSP
79
80#include <s_services.h>
81#include <t_services.h>
82#include "kernel_id.h"
83
84#endif /* of #ifdef TARGET_KERNEL_JSP */
85
86#include <tinet_defs.h>
87#include <tinet_config.h>
88
89#include <net/if.h>
90#include <net/if_ppp.h>
91#include <net/if_loop.h>
92#include <net/ethernet.h>
93#include <net/net.h>
94#include <net/net_buf.h>
95#include <net/net_count.h>
96
97#include <netinet/in.h>
98#include <netinet6/in6.h>
99#include <netinet/in_var.h>
100#include <netinet/in_itron.h>
101#include <netinet/ip.h>
102#include <netinet/ip_var.h>
103#include <netinet/ip_icmp.h>
104#include <netinet6/in6_var.h>
105#include <netinet/ip6.h>
106#include <netinet6/ip6_var.h>
107#include <netinet6/nd6.h>
108#include <netinet/icmp6.h>
109#include <netinet/udp.h>
110#include <netinet/udp_var.h>
111
112#ifdef SUPPORT_UDP
113
114#ifdef UDP_CFG_NON_BLOCKING
115
116/*
117 * 関数
118 */
119
120static void udp_output (T_UDP_CEP *cep);
121
122/*
123 * UDP 出力タスク
124 * ノンブロッキングコールを組み込んだとき使用する。
125 */
126
127static void
128udp_output (T_UDP_CEP *cep)
129{
130 T_NET_BUF *output;
131 T_UDP_HDR *udph;
132 ER_UINT error;
133
134#ifdef UDP_CFG_OUT_CHECKSUM
135 uint16_t sum;
136#endif /* of #ifdef UDP_CFG_OUT_CHECKSUM */
137
138 /* IP データグラムを割り当てる。*/
139 if ((error = IN_GET_DATAGRAM(&output, (uint_t)(UDP_HDR_SIZE + cep->snd_len), 0,
140 &cep->snd_p_dstaddr->ipaddr,
141 &cep->myaddr.ipaddr,
142 IPPROTO_UDP, IP_DEFTTL,
143 NBA_SEARCH_ASCENT, TMO_UDP_OUTPUT)) != E_OK) {
144 goto err_ret;
145 }
146
147 /* UDP ヘッダに情報を設定する。*/
148 udph = GET_UDP_HDR(output, IF_IP_UDP_HDR_OFFSET);
149 udph->sport = htons(cep->myaddr.portno);
150 udph->dport = htons(cep->snd_p_dstaddr->portno);
151 udph->ulen = htons(UDP_HDR_SIZE + cep->snd_len);
152 udph->sum = 0;
153
154 /* データをコピーする。*/
155 memcpy((void*)GET_UDP_SDU(output, IF_IP_UDP_HDR_OFFSET),
156 cep->snd_data, (size_t)cep->snd_len);
157
158#ifdef UDP_CFG_OUT_CHECKSUM
159
160 sum = IN_CKSUM(output, IPPROTO_UDP, IF_IP_UDP_HDR_OFFSET,
161 (uint_t)(UDP_HDR_SIZE + cep->snd_len));
162
163 /* 計算したチェックサムの値が 0 なら 0xffff を入れる。*/
164 if (sum == 0)
165 sum = UINT_C(0xffff);
166 udph->sum = sum;
167
168#endif/* of #ifdef UDP_CFG_OUT_CHECKSUM */
169
170 /* ネットワークバッファ長を調整する。*/
171 output->len = (uint16_t)(IF_IP_UDP_HDR_SIZE + cep->snd_len);
172
173 /* ネットワーク層 (IP) の出力関数を呼び出す。*/
174 if ((error = IP_OUTPUT(output, TMO_UDP_OUTPUT)) != E_OK)
175 goto err_ret;
176
177
178 NET_COUNT_MIB(udp_stats.udpOutDatagrams, 1);
179
180 if (IS_PTR_DEFINED(cep->callback)) {
181
182 if (error == E_OK)
183 error = cep->snd_len;
184
185#ifdef TCP_CFG_NON_BLOCKING_COMPAT14
186
187 (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_SND_DAT, (void*)error);
188
189#else /* of #ifdef TCP_CFG_NON_BLOCKING_COMPAT14 */
190
191 (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_SND_DAT, (void*)&error);
192
193#endif /* of #ifdef TCP_CFG_NON_BLOCKING_COMPAT14 */
194
195 }
196 else
197 syslog(LOG_WARNING, "[UDP] no call back, CEP: %d.", GET_UDP_CEPID(cep));
198 cep->snd_p_dstaddr = NULL;
199 return;
200
201err_ret:
202 NET_COUNT_UDP(net_count_udp.out_err_packets, 1);
203 if (IS_PTR_DEFINED(cep->callback)) {
204
205#ifdef TCP_CFG_NON_BLOCKING_COMPAT14
206
207 (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_SND_DAT, (void*)E_NOMEM);
208
209#else /* of #ifdef TCP_CFG_NON_BLOCKING_COMPAT14 */
210
211 error = E_NOMEM;
212 (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_SND_DAT, (void*)&error);
213
214#endif /* of #ifdef TCP_CFG_NON_BLOCKING_COMPAT14 */
215
216 }
217 else
218 syslog(LOG_WARNING, "[UDP] no call back, CEP: %d.", GET_UDP_CEPID(cep));
219 cep->snd_p_dstaddr = NULL;
220 return;
221 }
222
223/*
224 * UDP 出力タスク
225 * ノンブロッキングコールを組み込んだとき使用する。
226 */
227
228void
229udp_output_task (intptr_t exinf)
230{
231 ID tskid;
232 int_t ix;
233
234 get_tid(&tskid);
235 syslog(LOG_NOTICE, "[UDP OUTPUT:%d] started.", tskid);
236
237
238#if defined(SUPPORT_INET6) && !defined(SUPPORT_TCP)
239
240 /* IPv6 のステートレス・アドレス自動設定を実行する。*/
241 in6_if_up(IF_GET_IFNET());
242
243#endif /* of #if defined(SUPPORT_INET6) && !defined(SUPPORT_TCP) */
244
245 while (true) {
246
247 /* 出力がポストされるまで待つ。*/
248 syscall(wai_sem(SEM_UDP_POST_OUTPUT));
249
250 for (ix = tmax_udp_ccepid; ix -- > 0; ) {
251
252 if (udp_cep[ix].flags & UDP_CEP_FLG_POST_OUTPUT) {
253 udp_cep[ix].flags &= ~UDP_CEP_FLG_POST_OUTPUT;
254 udp_output(&udp_cep[ix]);
255 }
256 }
257 }
258 }
259
260#endif /* of #ifdef UDP_CFG_NON_BLOCKING */
261
262#endif /* of #ifdef SUPPORT_UDP */
Note: See TracBrowser for help on using the repository browser.