udp6_usrreq.c revision 1.13 1 1.13 itojun /* $NetBSD: udp6_usrreq.c,v 1.13 1999/09/13 12:15:56 itojun Exp $ */
2 1.3 thorpej
3 1.2 itojun /*
4 1.2 itojun * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
5 1.2 itojun * All rights reserved.
6 1.2 itojun *
7 1.2 itojun * Redistribution and use in source and binary forms, with or without
8 1.2 itojun * modification, are permitted provided that the following conditions
9 1.2 itojun * are met:
10 1.2 itojun * 1. Redistributions of source code must retain the above copyright
11 1.2 itojun * notice, this list of conditions and the following disclaimer.
12 1.2 itojun * 2. Redistributions in binary form must reproduce the above copyright
13 1.2 itojun * notice, this list of conditions and the following disclaimer in the
14 1.2 itojun * documentation and/or other materials provided with the distribution.
15 1.2 itojun * 3. Neither the name of the project nor the names of its contributors
16 1.2 itojun * may be used to endorse or promote products derived from this software
17 1.2 itojun * without specific prior written permission.
18 1.2 itojun *
19 1.2 itojun * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
20 1.2 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 1.2 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 1.2 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
23 1.2 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 1.2 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 1.2 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 1.2 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 1.2 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 1.2 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 1.2 itojun * SUCH DAMAGE.
30 1.2 itojun */
31 1.2 itojun
32 1.2 itojun /*
33 1.2 itojun * Copyright (c) 1982, 1986, 1989, 1993
34 1.2 itojun * The Regents of the University of California. All rights reserved.
35 1.2 itojun *
36 1.2 itojun * Redistribution and use in source and binary forms, with or without
37 1.2 itojun * modification, are permitted provided that the following conditions
38 1.2 itojun * are met:
39 1.2 itojun * 1. Redistributions of source code must retain the above copyright
40 1.2 itojun * notice, this list of conditions and the following disclaimer.
41 1.2 itojun * 2. Redistributions in binary form must reproduce the above copyright
42 1.2 itojun * notice, this list of conditions and the following disclaimer in the
43 1.2 itojun * documentation and/or other materials provided with the distribution.
44 1.2 itojun * 3. All advertising materials mentioning features or use of this software
45 1.2 itojun * must display the following acknowledgement:
46 1.2 itojun * This product includes software developed by the University of
47 1.2 itojun * California, Berkeley and its contributors.
48 1.2 itojun * 4. Neither the name of the University nor the names of its contributors
49 1.2 itojun * may be used to endorse or promote products derived from this software
50 1.2 itojun * without specific prior written permission.
51 1.2 itojun *
52 1.2 itojun * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
53 1.2 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
54 1.2 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
55 1.2 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
56 1.2 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
57 1.2 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
58 1.2 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
59 1.2 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
60 1.2 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
61 1.2 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
62 1.2 itojun * SUCH DAMAGE.
63 1.2 itojun *
64 1.2 itojun * @(#)udp_var.h 8.1 (Berkeley) 6/10/93
65 1.2 itojun */
66 1.5 thorpej
67 1.7 itojun #ifdef __NetBSD__ /*XXX*/
68 1.5 thorpej #include "opt_ipsec.h"
69 1.7 itojun #endif
70 1.2 itojun
71 1.2 itojun #include <sys/param.h>
72 1.2 itojun #include <sys/malloc.h>
73 1.2 itojun #include <sys/mbuf.h>
74 1.2 itojun #include <sys/protosw.h>
75 1.2 itojun #include <sys/socket.h>
76 1.2 itojun #include <sys/socketvar.h>
77 1.2 itojun #include <sys/errno.h>
78 1.2 itojun #include <sys/stat.h>
79 1.2 itojun #include <sys/systm.h>
80 1.2 itojun #ifdef __NetBSD__
81 1.2 itojun #include <sys/proc.h>
82 1.2 itojun #endif
83 1.8 itojun #include <sys/syslog.h>
84 1.2 itojun
85 1.2 itojun #include <net/if.h>
86 1.2 itojun #include <net/route.h>
87 1.2 itojun #include <net/if_types.h>
88 1.2 itojun
89 1.2 itojun #include <netinet/in.h>
90 1.2 itojun #include <netinet/in_var.h>
91 1.2 itojun #include <netinet6/ip6.h>
92 1.2 itojun #include <netinet6/in6_pcb.h>
93 1.2 itojun #include <netinet6/ip6_var.h>
94 1.2 itojun #include <netinet6/icmp6.h>
95 1.2 itojun #include <netinet6/udp6.h>
96 1.2 itojun #include <netinet6/udp6_var.h>
97 1.2 itojun
98 1.2 itojun #ifdef IPSEC
99 1.2 itojun #include <netinet6/ipsec.h>
100 1.2 itojun #endif /*IPSEC*/
101 1.2 itojun
102 1.2 itojun #include "faith.h"
103 1.2 itojun
104 1.2 itojun /*
105 1.2 itojun * UDP protocol inplementation.
106 1.2 itojun * Per RFC 768, August, 1980.
107 1.2 itojun */
108 1.2 itojun
109 1.2 itojun struct in6pcb *udp6_last_in6pcb = &udb6;
110 1.2 itojun
111 1.2 itojun static int in6_mcmatch __P((struct in6pcb *, struct in6_addr *, struct ifnet *));
112 1.2 itojun static void udp6_detach __P((struct in6pcb *));
113 1.2 itojun static void udp6_notify __P((struct in6pcb *, int));
114 1.2 itojun
115 1.2 itojun void
116 1.2 itojun udp6_init()
117 1.2 itojun {
118 1.2 itojun udb6.in6p_next = udb6.in6p_prev = &udb6;
119 1.2 itojun }
120 1.2 itojun
121 1.2 itojun static int
122 1.2 itojun in6_mcmatch(in6p, ia6, ifp)
123 1.2 itojun struct in6pcb *in6p;
124 1.2 itojun register struct in6_addr *ia6;
125 1.2 itojun struct ifnet *ifp;
126 1.2 itojun {
127 1.2 itojun struct ip6_moptions *im6o = in6p->in6p_moptions;
128 1.2 itojun struct in6_multi_mship *imm;
129 1.2 itojun
130 1.2 itojun if (im6o == NULL)
131 1.2 itojun return 0;
132 1.2 itojun
133 1.2 itojun for (imm = im6o->im6o_memberships.lh_first; imm != NULL;
134 1.2 itojun imm = imm->i6mm_chain.le_next) {
135 1.2 itojun if ((ifp == NULL ||
136 1.2 itojun imm->i6mm_maddr->in6m_ifp == ifp) &&
137 1.2 itojun IN6_ARE_ADDR_EQUAL(&imm->i6mm_maddr->in6m_addr,
138 1.2 itojun ia6))
139 1.2 itojun return 1;
140 1.2 itojun }
141 1.2 itojun return 0;
142 1.2 itojun }
143 1.2 itojun
144 1.2 itojun int
145 1.2 itojun udp6_input(mp, offp, proto)
146 1.2 itojun struct mbuf **mp;
147 1.2 itojun int *offp, proto;
148 1.2 itojun {
149 1.2 itojun struct mbuf *m = *mp;
150 1.2 itojun register struct ip6_hdr *ip6;
151 1.2 itojun register struct udphdr *uh;
152 1.2 itojun register struct in6pcb *in6p;
153 1.2 itojun struct mbuf *opts = 0;
154 1.2 itojun int off = *offp;
155 1.2 itojun int plen, ulen;
156 1.2 itojun struct sockaddr_in6 udp_in6;
157 1.2 itojun
158 1.2 itojun #if defined(NFAITH) && 0 < NFAITH
159 1.2 itojun if (m->m_pkthdr.rcvif) {
160 1.2 itojun if (m->m_pkthdr.rcvif->if_type == IFT_FAITH) {
161 1.2 itojun /* send icmp6 host unreach? */
162 1.2 itojun m_freem(m);
163 1.2 itojun return IPPROTO_DONE;
164 1.2 itojun }
165 1.2 itojun }
166 1.2 itojun #endif
167 1.2 itojun udp6stat.udp6s_ipackets++;
168 1.2 itojun
169 1.2 itojun IP6_EXTHDR_CHECK(m, off, sizeof(struct udphdr), IPPROTO_DONE);
170 1.2 itojun
171 1.2 itojun ip6 = mtod(m, struct ip6_hdr *);
172 1.2 itojun plen = ntohs(ip6->ip6_plen) - off + sizeof(*ip6);
173 1.2 itojun uh = (struct udphdr *)((caddr_t)ip6 + off);
174 1.2 itojun ulen = ntohs((u_short)uh->uh_ulen);
175 1.2 itojun
176 1.2 itojun if (plen != ulen) {
177 1.2 itojun udp6stat.udp6s_badlen++;
178 1.2 itojun goto bad;
179 1.2 itojun }
180 1.2 itojun
181 1.2 itojun /*
182 1.2 itojun * Checksum extended UDP header and data.
183 1.2 itojun */
184 1.2 itojun if (uh->uh_sum == 0)
185 1.2 itojun udp6stat.udp6s_nosum++;
186 1.2 itojun else if (in6_cksum(m, IPPROTO_UDP, off, ulen) != 0) {
187 1.2 itojun udp6stat.udp6s_badsum++;
188 1.2 itojun goto bad;
189 1.2 itojun }
190 1.2 itojun
191 1.2 itojun if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) {
192 1.2 itojun struct in6pcb *last;
193 1.2 itojun
194 1.2 itojun /*
195 1.2 itojun * Deliver a multicast datagram to all sockets
196 1.2 itojun * for which the local and remote addresses and ports match
197 1.2 itojun * those of the incoming datagram. This allows more than
198 1.2 itojun * one process to receive multicasts on the same port.
199 1.2 itojun * (This really ought to be done for unicast datagrams as
200 1.2 itojun * well, but that would cause problems with existing
201 1.2 itojun * applications that open both address-specific sockets and
202 1.2 itojun * a wildcard socket listening to the same port -- they would
203 1.2 itojun * end up receiving duplicates of every unicast datagram.
204 1.2 itojun * Those applications open the multiple sockets to overcome an
205 1.2 itojun * inadequacy of the UDP socket interface, but for backwards
206 1.2 itojun * compatibility we avoid the problem here rather than
207 1.2 itojun * fixing the interface. Maybe 4.5BSD will remedy this?)
208 1.2 itojun */
209 1.2 itojun
210 1.2 itojun /*
211 1.2 itojun * In a case that laddr should be set to the link-local
212 1.2 itojun * address (this happens in RIPng), the multicast address
213 1.2 itojun * specified in the received packet does not match with
214 1.2 itojun * laddr. To cure this situation, the matching is relaxed
215 1.2 itojun * if the receiving interface is the same as one specified
216 1.2 itojun * in the socket and if the destination multicast address
217 1.2 itojun * matches one of the multicast groups specified in the socket.
218 1.2 itojun */
219 1.2 itojun
220 1.2 itojun /*
221 1.2 itojun * Construct sockaddr format source address.
222 1.2 itojun */
223 1.2 itojun bzero(&udp_in6, sizeof(udp_in6));
224 1.2 itojun udp_in6.sin6_len = sizeof(struct sockaddr_in6);
225 1.2 itojun udp_in6.sin6_family = AF_INET6;
226 1.2 itojun udp_in6.sin6_port = uh->uh_sport;
227 1.2 itojun udp_in6.sin6_addr = ip6->ip6_src;
228 1.2 itojun if (IN6_IS_SCOPE_LINKLOCAL(&udp_in6.sin6_addr))
229 1.2 itojun udp_in6.sin6_addr.s6_addr16[1] = 0;
230 1.2 itojun if (m->m_pkthdr.rcvif) {
231 1.2 itojun if (IN6_IS_SCOPE_LINKLOCAL(&udp_in6.sin6_addr)) {
232 1.2 itojun udp_in6.sin6_scope_id =
233 1.2 itojun m->m_pkthdr.rcvif->if_index;
234 1.2 itojun } else
235 1.2 itojun udp_in6.sin6_scope_id = 0;
236 1.2 itojun } else
237 1.2 itojun udp_in6.sin6_scope_id = 0;
238 1.2 itojun /*
239 1.2 itojun * KAME note: usually we drop udphdr from mbuf here.
240 1.2 itojun * We need udphdr for IPsec processing so we do that later.
241 1.2 itojun */
242 1.2 itojun
243 1.2 itojun /*
244 1.2 itojun * Locate pcb(s) for datagram.
245 1.2 itojun * (Algorithm copied from raw_intr().)
246 1.2 itojun */
247 1.2 itojun last = NULL;
248 1.2 itojun for (in6p = udb6.in6p_next;
249 1.2 itojun in6p != &udb6;
250 1.2 itojun in6p = in6p->in6p_next) {
251 1.2 itojun if (in6p->in6p_lport != uh->uh_dport)
252 1.2 itojun continue;
253 1.2 itojun if (!IN6_IS_ADDR_ANY(&in6p->in6p_laddr)) {
254 1.2 itojun if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr,
255 1.2 itojun &ip6->ip6_dst) &&
256 1.2 itojun !in6_mcmatch(in6p, &ip6->ip6_dst,
257 1.2 itojun m->m_pkthdr.rcvif))
258 1.2 itojun continue;
259 1.2 itojun }
260 1.2 itojun if (!IN6_IS_ADDR_ANY(&in6p->in6p_faddr)) {
261 1.2 itojun if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr,
262 1.2 itojun &ip6->ip6_src) ||
263 1.2 itojun in6p->in6p_fport != uh->uh_sport)
264 1.2 itojun continue;
265 1.2 itojun }
266 1.2 itojun
267 1.2 itojun if (last != NULL) {
268 1.2 itojun struct mbuf *n;
269 1.2 itojun
270 1.2 itojun #ifdef IPSEC
271 1.2 itojun /*
272 1.2 itojun * Check AH/ESP integrity.
273 1.2 itojun */
274 1.2 itojun if (last != NULL && ipsec6_in_reject(m, last)) {
275 1.2 itojun ipsec6stat.in_polvio++;
276 1.2 itojun /* do not inject data into pcb */
277 1.2 itojun } else
278 1.2 itojun #endif /*IPSEC*/
279 1.2 itojun if ((n = m_copy(m, 0, M_COPYALL)) != NULL) {
280 1.2 itojun /*
281 1.2 itojun * KAME NOTE: do not
282 1.2 itojun * m_copy(m, offset, ...) above.
283 1.2 itojun * sbappendaddr() expects M_PKTHDR,
284 1.2 itojun * and m_copy() will copy M_PKTHDR
285 1.2 itojun * only if offset is 0.
286 1.2 itojun */
287 1.8 itojun if (last->in6p_flags & IN6P_CONTROLOPTS
288 1.8 itojun || last->in6p_socket->so_options & SO_TIMESTAMP) {
289 1.2 itojun ip6_savecontrol(last, &opts,
290 1.2 itojun ip6, n);
291 1.2 itojun }
292 1.2 itojun
293 1.11 itojun m_adj(n, off + sizeof(struct udphdr));
294 1.2 itojun if (sbappendaddr(&last->in6p_socket->so_rcv,
295 1.2 itojun (struct sockaddr *)&udp_in6,
296 1.2 itojun n, opts) == 0) {
297 1.2 itojun m_freem(n);
298 1.2 itojun if (opts)
299 1.2 itojun m_freem(opts);
300 1.2 itojun udp6stat.udp6s_fullsock++;
301 1.2 itojun } else
302 1.2 itojun sorwakeup(last->in6p_socket);
303 1.2 itojun opts = 0;
304 1.2 itojun }
305 1.2 itojun }
306 1.2 itojun last = in6p;
307 1.2 itojun /*
308 1.2 itojun * Don't look for additional matches if this one does
309 1.2 itojun * not have either the SO_REUSEPORT or SO_REUSEADDR
310 1.2 itojun * socket options set. This heuristic avoids searching
311 1.2 itojun * through all pcbs in the common case of a non-shared
312 1.2 itojun * port. It assumes that an application will never
313 1.2 itojun * clear these options after setting them.
314 1.2 itojun */
315 1.2 itojun if ((last->in6p_socket->so_options &
316 1.2 itojun (SO_REUSEPORT|SO_REUSEADDR)) == 0)
317 1.2 itojun break;
318 1.2 itojun }
319 1.2 itojun
320 1.2 itojun if (last == NULL) {
321 1.2 itojun /*
322 1.2 itojun * No matching pcb found; discard datagram.
323 1.2 itojun * (No need to send an ICMP Port Unreachable
324 1.2 itojun * for a broadcast or multicast datgram.)
325 1.2 itojun */
326 1.2 itojun udp6stat.udp6s_noport++;
327 1.2 itojun udp6stat.udp6s_noportmcast++;
328 1.2 itojun goto bad;
329 1.2 itojun }
330 1.2 itojun #ifdef IPSEC
331 1.2 itojun /*
332 1.2 itojun * Check AH/ESP integrity.
333 1.2 itojun */
334 1.2 itojun if (last != NULL && ipsec6_in_reject(m, last)) {
335 1.2 itojun ipsec6stat.in_polvio++;
336 1.2 itojun goto bad;
337 1.2 itojun }
338 1.2 itojun #endif /*IPSEC*/
339 1.8 itojun if (last->in6p_flags & IN6P_CONTROLOPTS
340 1.8 itojun || last->in6p_socket->so_options & SO_TIMESTAMP) {
341 1.2 itojun ip6_savecontrol(last, &opts, ip6, m);
342 1.8 itojun }
343 1.2 itojun
344 1.2 itojun m_adj(m, off + sizeof(struct udphdr));
345 1.2 itojun if (sbappendaddr(&last->in6p_socket->so_rcv,
346 1.2 itojun (struct sockaddr *)&udp_in6,
347 1.2 itojun m, opts) == 0) {
348 1.2 itojun udp6stat.udp6s_fullsock++;
349 1.2 itojun goto bad;
350 1.2 itojun }
351 1.2 itojun sorwakeup(last->in6p_socket);
352 1.2 itojun return IPPROTO_DONE;
353 1.2 itojun }
354 1.2 itojun /*
355 1.2 itojun * Locate pcb for datagram.
356 1.2 itojun */
357 1.2 itojun in6p = udp6_last_in6pcb;
358 1.2 itojun if (in6p->in6p_lport != uh->uh_dport ||
359 1.2 itojun in6p->in6p_fport != uh->uh_sport ||
360 1.2 itojun !IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, &ip6->ip6_src) ||
361 1.2 itojun !IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, &ip6->ip6_dst)) {
362 1.2 itojun in6p = in6_pcblookup(&udb6,
363 1.2 itojun &ip6->ip6_src, uh->uh_sport,
364 1.2 itojun &ip6->ip6_dst, uh->uh_dport,
365 1.2 itojun IN6PLOOKUP_WILDCARD);
366 1.2 itojun if (in6p)
367 1.2 itojun udp6_last_in6pcb = in6p;
368 1.2 itojun udp6stat.udp6ps_pcbcachemiss++;
369 1.2 itojun }
370 1.2 itojun if (in6p == 0) {
371 1.2 itojun udp6stat.udp6s_noport++;
372 1.2 itojun if (m->m_flags & M_MCAST) {
373 1.2 itojun printf("UDP6: M_MCAST is set in a unicast packet.\n");
374 1.2 itojun udp6stat.udp6s_noportmcast++;
375 1.2 itojun goto bad;
376 1.2 itojun }
377 1.2 itojun icmp6_error(m, ICMP6_DST_UNREACH, ICMP6_DST_UNREACH_NOPORT, 0);
378 1.2 itojun return IPPROTO_DONE;
379 1.2 itojun }
380 1.2 itojun #ifdef IPSEC
381 1.2 itojun /*
382 1.2 itojun * Check AH/ESP integrity.
383 1.2 itojun */
384 1.2 itojun if (in6p != NULL && ipsec6_in_reject(m, in6p)) {
385 1.2 itojun ipsec6stat.in_polvio++;
386 1.2 itojun goto bad;
387 1.2 itojun }
388 1.2 itojun #endif /*IPSEC*/
389 1.2 itojun
390 1.2 itojun /*
391 1.2 itojun * Construct sockaddr format source address.
392 1.2 itojun * Stuff source address and datagram in user buffer.
393 1.2 itojun */
394 1.2 itojun bzero(&udp_in6, sizeof(udp_in6));
395 1.2 itojun udp_in6.sin6_len = sizeof(struct sockaddr_in6);
396 1.2 itojun udp_in6.sin6_family = AF_INET6;
397 1.2 itojun udp_in6.sin6_port = uh->uh_sport;
398 1.2 itojun udp_in6.sin6_addr = ip6->ip6_src;
399 1.2 itojun if (IN6_IS_SCOPE_LINKLOCAL(&udp_in6.sin6_addr))
400 1.2 itojun udp_in6.sin6_addr.s6_addr16[1] = 0;
401 1.2 itojun if (m->m_pkthdr.rcvif) {
402 1.2 itojun if (IN6_IS_SCOPE_LINKLOCAL(&udp_in6.sin6_addr))
403 1.2 itojun udp_in6.sin6_scope_id = m->m_pkthdr.rcvif->if_index;
404 1.2 itojun else
405 1.2 itojun udp_in6.sin6_scope_id = 0;
406 1.2 itojun } else
407 1.2 itojun udp_in6.sin6_scope_id = 0;
408 1.8 itojun if (in6p->in6p_flags & IN6P_CONTROLOPTS
409 1.8 itojun || in6p->in6p_socket->so_options & SO_TIMESTAMP) {
410 1.2 itojun ip6_savecontrol(in6p, &opts, ip6, m);
411 1.8 itojun }
412 1.2 itojun
413 1.2 itojun m_adj(m, off + sizeof(struct udphdr));
414 1.2 itojun if (sbappendaddr(&in6p->in6p_socket->so_rcv,
415 1.2 itojun (struct sockaddr *)&udp_in6,
416 1.2 itojun m, opts) == 0) {
417 1.2 itojun udp6stat.udp6s_fullsock++;
418 1.2 itojun goto bad;
419 1.2 itojun }
420 1.2 itojun sorwakeup(in6p->in6p_socket);
421 1.2 itojun return IPPROTO_DONE;
422 1.2 itojun bad:
423 1.2 itojun if (m)
424 1.2 itojun m_freem(m);
425 1.2 itojun if (opts)
426 1.2 itojun m_freem(opts);
427 1.2 itojun return IPPROTO_DONE;
428 1.2 itojun }
429 1.2 itojun
430 1.2 itojun /*
431 1.2 itojun * Notify a udp user of an asynchronous error;
432 1.2 itojun * just wake up so tat he can collect error status.
433 1.2 itojun */
434 1.2 itojun static void
435 1.2 itojun udp6_notify(in6p, errno)
436 1.2 itojun register struct in6pcb *in6p;
437 1.2 itojun int errno;
438 1.2 itojun {
439 1.2 itojun in6p->in6p_socket->so_error = errno;
440 1.2 itojun sorwakeup(in6p->in6p_socket);
441 1.2 itojun sowwakeup(in6p->in6p_socket);
442 1.2 itojun }
443 1.2 itojun
444 1.2 itojun void
445 1.2 itojun udp6_ctlinput(cmd, sa, ip6, m, off)
446 1.2 itojun int cmd;
447 1.2 itojun struct sockaddr *sa;
448 1.2 itojun register struct ip6_hdr *ip6;
449 1.2 itojun struct mbuf *m;
450 1.2 itojun int off;
451 1.2 itojun {
452 1.2 itojun register struct udphdr *uhp;
453 1.2 itojun struct udphdr uh;
454 1.7 itojun struct sockaddr_in6 sa6;
455 1.2 itojun
456 1.10 itojun if (sa->sa_family != AF_INET6 ||
457 1.10 itojun sa->sa_len != sizeof(struct sockaddr_in6))
458 1.10 itojun return;
459 1.2 itojun #if 0
460 1.2 itojun if (cmd == PRC_IFNEWADDR)
461 1.2 itojun in6_mrejoin(&udb6);
462 1.2 itojun else
463 1.2 itojun #endif
464 1.2 itojun if (!PRC_IS_REDIRECT(cmd) &&
465 1.2 itojun ((unsigned)cmd >= PRC_NCMDS || inet6ctlerrmap[cmd] == 0))
466 1.2 itojun return;
467 1.7 itojun
468 1.7 itojun /* translate addresses into internal form */
469 1.7 itojun sa6 = *(struct sockaddr_in6 *)sa;
470 1.7 itojun if (IN6_IS_ADDR_LINKLOCAL(&sa6.sin6_addr))
471 1.7 itojun sa6.sin6_addr.s6_addr16[1] = htons(m->m_pkthdr.rcvif->if_index);
472 1.7 itojun
473 1.2 itojun if (ip6) {
474 1.2 itojun /*
475 1.2 itojun * XXX: We assume that when IPV6 is non NULL,
476 1.2 itojun * M and OFF are valid.
477 1.2 itojun */
478 1.7 itojun struct in6_addr s;
479 1.7 itojun
480 1.7 itojun /* translate addresses into internal form */
481 1.12 itojun memcpy(&s, &ip6->ip6_src, sizeof(s));
482 1.7 itojun if (IN6_IS_ADDR_LINKLOCAL(&s))
483 1.7 itojun s.s6_addr16[1] = htons(m->m_pkthdr.rcvif->if_index);
484 1.7 itojun
485 1.2 itojun if (m->m_len < off + sizeof(uh)) {
486 1.2 itojun /*
487 1.2 itojun * this should be rare case,
488 1.2 itojun * so we compromise on this copy...
489 1.2 itojun */
490 1.2 itojun m_copydata(m, off, sizeof(uh), (caddr_t)&uh);
491 1.2 itojun uhp = &uh;
492 1.2 itojun } else
493 1.2 itojun uhp = (struct udphdr *)(mtod(m, caddr_t) + off);
494 1.7 itojun (void) in6_pcbnotify(&udb6, (struct sockaddr *)&sa6,
495 1.7 itojun uhp->uh_dport, &s,
496 1.2 itojun uhp->uh_sport, cmd, udp6_notify);
497 1.2 itojun } else {
498 1.7 itojun (void) in6_pcbnotify(&udb6, (struct sockaddr *)&sa6, 0,
499 1.7 itojun &zeroin6_addr, 0, cmd, udp6_notify);
500 1.2 itojun }
501 1.2 itojun }
502 1.2 itojun
503 1.2 itojun int
504 1.2 itojun udp6_output(in6p, m, addr6, control)
505 1.2 itojun register struct in6pcb *in6p;
506 1.2 itojun register struct mbuf *m;
507 1.2 itojun struct mbuf *addr6, *control;
508 1.2 itojun {
509 1.2 itojun register int ulen = m->m_pkthdr.len;
510 1.2 itojun int plen = sizeof(struct udphdr) + ulen;
511 1.2 itojun struct ip6_hdr *ip6;
512 1.2 itojun struct udphdr *udp6;
513 1.2 itojun struct in6_addr laddr6;
514 1.2 itojun int s = 0, error = 0;
515 1.2 itojun struct ip6_pktopts opt, *stickyopt = in6p->in6p_outputopts;
516 1.2 itojun int priv = 0;
517 1.2 itojun struct proc *p = curproc; /* XXX */
518 1.2 itojun
519 1.2 itojun if (p && !suser(p->p_ucred, &p->p_acflag))
520 1.2 itojun priv = 1;
521 1.2 itojun if (control) {
522 1.2 itojun if ((error = ip6_setpktoptions(control, &opt, priv)) != 0)
523 1.2 itojun goto release;
524 1.2 itojun in6p->in6p_outputopts = &opt;
525 1.2 itojun }
526 1.2 itojun
527 1.2 itojun if (addr6) {
528 1.2 itojun laddr6 = in6p->in6p_laddr;
529 1.2 itojun if (!IN6_IS_ADDR_ANY(&in6p->in6p_faddr)) {
530 1.2 itojun error = EISCONN;
531 1.2 itojun goto release;
532 1.2 itojun }
533 1.2 itojun /*
534 1.2 itojun * Must block input while temporarily connected.
535 1.2 itojun */
536 1.4 itojun s = splsoftnet();
537 1.2 itojun error = in6_pcbconnect(in6p, addr6);
538 1.2 itojun if (error) {
539 1.2 itojun splx(s);
540 1.2 itojun goto release;
541 1.2 itojun }
542 1.2 itojun } else {
543 1.2 itojun if (IN6_IS_ADDR_ANY(&in6p->in6p_faddr)) {
544 1.2 itojun error = ENOTCONN;
545 1.2 itojun goto release;
546 1.2 itojun }
547 1.2 itojun }
548 1.2 itojun /*
549 1.2 itojun * Calculate data length and get a mbuf
550 1.2 itojun * for UDP and IP6 headers.
551 1.2 itojun */
552 1.2 itojun M_PREPEND(m, sizeof(struct ip6_hdr) + sizeof(struct udphdr), M_DONTWAIT);
553 1.2 itojun if (m == 0) {
554 1.2 itojun error = ENOBUFS;
555 1.8 itojun if (addr6)
556 1.8 itojun splx(s);
557 1.2 itojun goto release;
558 1.2 itojun }
559 1.2 itojun
560 1.2 itojun /*
561 1.2 itojun * Stuff checksum and output datagram.
562 1.2 itojun */
563 1.2 itojun ip6 = mtod(m, struct ip6_hdr *);
564 1.2 itojun ip6->ip6_flow = in6p->in6p_flowinfo & IPV6_FLOWINFO_MASK;
565 1.2 itojun ip6->ip6_vfc = IPV6_VERSION;
566 1.2 itojun #if 0 /* ip6_plen will be filled in ip6_output. */
567 1.2 itojun ip6->ip6_plen = htons((u_short)plen);
568 1.2 itojun #endif
569 1.2 itojun ip6->ip6_nxt = IPPROTO_UDP;
570 1.2 itojun ip6->ip6_hlim = in6p->in6p_ip6.ip6_hlim; /* XXX */
571 1.2 itojun ip6->ip6_src = in6p->in6p_laddr;
572 1.2 itojun ip6->ip6_dst = in6p->in6p_faddr;
573 1.2 itojun
574 1.2 itojun udp6 = (struct udphdr *)(ip6 + 1);
575 1.2 itojun udp6->uh_sport = in6p->in6p_lport;
576 1.2 itojun udp6->uh_dport = in6p->in6p_fport;
577 1.2 itojun udp6->uh_ulen = htons((u_short)plen);
578 1.2 itojun udp6->uh_sum = 0;
579 1.2 itojun
580 1.2 itojun if ((udp6->uh_sum = in6_cksum(m, IPPROTO_UDP,
581 1.2 itojun sizeof(struct ip6_hdr), plen)) == 0) {
582 1.2 itojun udp6->uh_sum = 0xffff;
583 1.2 itojun }
584 1.2 itojun
585 1.2 itojun udp6stat.udp6s_opackets++;
586 1.2 itojun
587 1.2 itojun #ifdef IPSEC
588 1.2 itojun m->m_pkthdr.rcvif = (struct ifnet *)in6p->in6p_socket;
589 1.2 itojun #endif /*IPSEC*/
590 1.2 itojun error = ip6_output(m, in6p->in6p_outputopts, &in6p->in6p_route,
591 1.2 itojun 0, in6p->in6p_moptions);
592 1.2 itojun
593 1.2 itojun if (addr6) {
594 1.2 itojun in6_pcbdisconnect(in6p);
595 1.2 itojun in6p->in6p_laddr = laddr6;
596 1.2 itojun splx(s);
597 1.2 itojun }
598 1.2 itojun goto releaseopt;
599 1.2 itojun
600 1.2 itojun release:
601 1.2 itojun m_freem(m);
602 1.2 itojun
603 1.2 itojun releaseopt:
604 1.2 itojun if (control) {
605 1.2 itojun in6p->in6p_outputopts = stickyopt;
606 1.2 itojun m_freem(control);
607 1.2 itojun }
608 1.2 itojun return(error);
609 1.2 itojun }
610 1.2 itojun
611 1.2 itojun extern int udp6_sendspace;
612 1.2 itojun extern int udp6_recvspace;
613 1.2 itojun
614 1.2 itojun int
615 1.2 itojun udp6_usrreq(so, req, m, addr6, control, p)
616 1.2 itojun struct socket *so;
617 1.2 itojun int req;
618 1.2 itojun struct mbuf *m, *addr6, *control;
619 1.2 itojun struct proc *p;
620 1.2 itojun {
621 1.2 itojun struct in6pcb *in6p = sotoin6pcb(so);
622 1.2 itojun int error = 0;
623 1.2 itojun int s;
624 1.2 itojun
625 1.2 itojun /*
626 1.2 itojun * MAPPED_ADDR implementation info:
627 1.2 itojun * Mapped addr support for PRU_CONTROL is not necessary.
628 1.2 itojun * Because typical user of PRU_CONTROL is such as ifconfig,
629 1.2 itojun * and they don't associate any addr to their socket. Then
630 1.2 itojun * socket family is only hint about the PRU_CONTROL'ed address
631 1.2 itojun * family, especially when getting addrs from kernel.
632 1.2 itojun * So AF_INET socket need to be used to control AF_INET addrs,
633 1.2 itojun * and AF_INET6 socket for AF_INET6 addrs.
634 1.2 itojun */
635 1.2 itojun if (req == PRU_CONTROL)
636 1.2 itojun return(in6_control(so, (u_long)m, (caddr_t)addr6,
637 1.2 itojun (struct ifnet *)control, p));
638 1.2 itojun
639 1.2 itojun if (in6p == NULL && req != PRU_ATTACH) {
640 1.2 itojun error = EINVAL;
641 1.2 itojun goto release;
642 1.2 itojun }
643 1.2 itojun
644 1.2 itojun switch (req) {
645 1.2 itojun case PRU_ATTACH:
646 1.2 itojun /*
647 1.2 itojun * MAPPED_ADDR implementation spec:
648 1.2 itojun * Always attach for IPv6,
649 1.2 itojun * and only when necessary for IPv4.
650 1.2 itojun */
651 1.2 itojun if (in6p != NULL) {
652 1.2 itojun error = EINVAL;
653 1.2 itojun break;
654 1.2 itojun }
655 1.4 itojun s = splsoftnet();
656 1.2 itojun error = in6_pcballoc(so, &udb6);
657 1.2 itojun splx(s);
658 1.2 itojun if (error)
659 1.2 itojun break;
660 1.2 itojun error = soreserve(so, udp6_sendspace, udp6_recvspace);
661 1.2 itojun if (error)
662 1.2 itojun break;
663 1.2 itojun in6p = sotoin6pcb(so);
664 1.2 itojun in6p->in6p_ip6.ip6_hlim = ip6_defhlim;
665 1.2 itojun in6p->in6p_cksum = -1; /* just to be sure */
666 1.2 itojun #ifdef IPSEC
667 1.13 itojun if ((error = ipsec_init_policy(&in6p->in6p_sp)) != 0)
668 1.13 itojun in6_pcbdetach(in6p);
669 1.2 itojun #endif /*IPSEC*/
670 1.2 itojun break;
671 1.2 itojun
672 1.2 itojun case PRU_DETACH:
673 1.2 itojun udp6_detach(in6p);
674 1.2 itojun break;
675 1.2 itojun
676 1.2 itojun case PRU_BIND:
677 1.4 itojun s = splsoftnet();
678 1.2 itojun error = in6_pcbbind(in6p, addr6);
679 1.2 itojun splx(s);
680 1.2 itojun break;
681 1.2 itojun
682 1.2 itojun case PRU_LISTEN:
683 1.2 itojun error = EOPNOTSUPP;
684 1.2 itojun break;
685 1.2 itojun
686 1.2 itojun case PRU_CONNECT:
687 1.2 itojun if (!IN6_IS_ADDR_ANY(&in6p->in6p_faddr)) {
688 1.2 itojun error = EISCONN;
689 1.2 itojun break;
690 1.2 itojun }
691 1.4 itojun s = splsoftnet();
692 1.2 itojun error = in6_pcbconnect(in6p, addr6);
693 1.2 itojun if (ip6_auto_flowlabel) {
694 1.2 itojun in6p->in6p_flowinfo &= ~IPV6_FLOWLABEL_MASK;
695 1.2 itojun in6p->in6p_flowinfo |=
696 1.2 itojun (htonl(ip6_flow_seq++) & IPV6_FLOWLABEL_MASK);
697 1.2 itojun }
698 1.2 itojun splx(s);
699 1.2 itojun if (error == 0)
700 1.2 itojun soisconnected(so);
701 1.2 itojun break;
702 1.2 itojun
703 1.2 itojun case PRU_CONNECT2:
704 1.2 itojun error = EOPNOTSUPP;
705 1.2 itojun break;
706 1.2 itojun
707 1.2 itojun case PRU_ACCEPT:
708 1.2 itojun error = EOPNOTSUPP;
709 1.2 itojun break;
710 1.2 itojun
711 1.2 itojun case PRU_DISCONNECT:
712 1.2 itojun if (IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr)) {
713 1.2 itojun error = ENOTCONN;
714 1.2 itojun break;
715 1.2 itojun }
716 1.4 itojun s = splsoftnet();
717 1.2 itojun in6_pcbdisconnect(in6p);
718 1.2 itojun bzero((caddr_t)&in6p->in6p_laddr, sizeof(in6p->in6p_laddr));
719 1.2 itojun splx(s);
720 1.2 itojun so->so_state &= ~SS_ISCONNECTED; /* XXX */
721 1.2 itojun break;
722 1.2 itojun
723 1.2 itojun case PRU_SHUTDOWN:
724 1.2 itojun socantsendmore(so);
725 1.2 itojun break;
726 1.2 itojun
727 1.2 itojun case PRU_SEND:
728 1.2 itojun return(udp6_output(in6p, m, addr6, control));
729 1.2 itojun
730 1.2 itojun case PRU_ABORT:
731 1.2 itojun soisdisconnected(so);
732 1.2 itojun udp6_detach(in6p);
733 1.2 itojun break;
734 1.2 itojun
735 1.2 itojun case PRU_SOCKADDR:
736 1.2 itojun in6_setsockaddr(in6p, addr6);
737 1.2 itojun break;
738 1.2 itojun
739 1.2 itojun case PRU_PEERADDR:
740 1.2 itojun in6_setpeeraddr(in6p, addr6);
741 1.2 itojun break;
742 1.2 itojun
743 1.2 itojun case PRU_SENSE:
744 1.2 itojun /*
745 1.2 itojun * stat: don't bother with a blocksize
746 1.2 itojun */
747 1.2 itojun return(0);
748 1.2 itojun
749 1.2 itojun case PRU_SENDOOB:
750 1.2 itojun case PRU_FASTTIMO:
751 1.2 itojun case PRU_SLOWTIMO:
752 1.2 itojun case PRU_PROTORCV:
753 1.2 itojun case PRU_PROTOSEND:
754 1.2 itojun error = EOPNOTSUPP;
755 1.2 itojun break;
756 1.2 itojun
757 1.2 itojun case PRU_RCVD:
758 1.2 itojun case PRU_RCVOOB:
759 1.2 itojun return(EOPNOTSUPP); /* do not free mbuf's */
760 1.2 itojun
761 1.2 itojun default:
762 1.2 itojun panic("udp6_usrreq");
763 1.2 itojun }
764 1.2 itojun
765 1.2 itojun release:
766 1.2 itojun if (control) {
767 1.2 itojun printf("udp control data unexpectedly retained\n");
768 1.2 itojun m_freem(control);
769 1.2 itojun }
770 1.2 itojun if (m)
771 1.2 itojun m_freem(m);
772 1.2 itojun return(error);
773 1.2 itojun }
774 1.2 itojun
775 1.2 itojun static void
776 1.2 itojun udp6_detach(in6p)
777 1.2 itojun struct in6pcb *in6p;
778 1.2 itojun {
779 1.4 itojun int s = splsoftnet();
780 1.2 itojun
781 1.2 itojun if (in6p == udp6_last_in6pcb)
782 1.2 itojun udp6_last_in6pcb = &udb6;
783 1.2 itojun in6_pcbdetach(in6p);
784 1.2 itojun splx(s);
785 1.2 itojun }
786 1.2 itojun
787 1.2 itojun #ifdef __bsdi__
788 1.2 itojun int *udp6_sysvars[] = UDP6CTL_VARS;
789 1.2 itojun
790 1.2 itojun int
791 1.2 itojun udp6_sysctl(name, namelen, oldp, oldlenp, newp, newlen)
792 1.2 itojun int *name;
793 1.2 itojun u_int namelen;
794 1.2 itojun void *oldp;
795 1.2 itojun size_t *oldlenp;
796 1.2 itojun void *newp;
797 1.2 itojun size_t newlen;
798 1.2 itojun {
799 1.2 itojun if (name[0] >= UDP6CTL_MAXID)
800 1.2 itojun return (EOPNOTSUPP);
801 1.2 itojun switch (name[0]) {
802 1.2 itojun case UDP6CTL_STATS:
803 1.2 itojun return sysctl_rdtrunc(oldp, oldlenp, newp, &udp6stat,
804 1.2 itojun sizeof(udp6stat));
805 1.2 itojun
806 1.2 itojun default:
807 1.2 itojun return (sysctl_int_arr(udp6_sysvars, name, namelen,
808 1.2 itojun oldp, oldlenp, newp, newlen));
809 1.2 itojun }
810 1.2 itojun }
811 1.2 itojun #endif /*__bsdi__*/
812 1.2 itojun
813 1.2 itojun #ifdef __NetBSD__
814 1.2 itojun #include <vm/vm.h>
815 1.2 itojun #include <sys/sysctl.h>
816 1.2 itojun
817 1.2 itojun int
818 1.2 itojun udp6_sysctl(name, namelen, oldp, oldlenp, newp, newlen)
819 1.2 itojun int *name;
820 1.2 itojun u_int namelen;
821 1.2 itojun void *oldp;
822 1.2 itojun size_t *oldlenp;
823 1.2 itojun void *newp;
824 1.2 itojun size_t newlen;
825 1.2 itojun {
826 1.2 itojun /* All sysctl names at this level are terminal. */
827 1.2 itojun if (namelen != 1)
828 1.2 itojun return ENOTDIR;
829 1.2 itojun
830 1.2 itojun switch (name[0]) {
831 1.2 itojun
832 1.2 itojun case UDP6CTL_SENDMAX:
833 1.2 itojun return sysctl_int(oldp, oldlenp, newp, newlen,
834 1.2 itojun &udp6_sendspace);
835 1.2 itojun case UDP6CTL_RECVSPACE:
836 1.2 itojun return sysctl_int(oldp, oldlenp, newp, newlen,
837 1.2 itojun &udp6_recvspace);
838 1.2 itojun default:
839 1.2 itojun return ENOPROTOOPT;
840 1.2 itojun }
841 1.2 itojun /* NOTREACHED */
842 1.2 itojun }
843 1.2 itojun #endif
844