if_gif.c revision 1.73 1 1.73 dyoung /* $NetBSD: if_gif.c,v 1.73 2008/02/07 01:22:00 dyoung Exp $ */
2 1.34 itojun /* $KAME: if_gif.c,v 1.76 2001/08/20 02:01:02 kjc Exp $ */
3 1.3 itojun
4 1.2 itojun /*
5 1.2 itojun * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
6 1.2 itojun * All rights reserved.
7 1.9 itojun *
8 1.2 itojun * Redistribution and use in source and binary forms, with or without
9 1.2 itojun * modification, are permitted provided that the following conditions
10 1.2 itojun * are met:
11 1.2 itojun * 1. Redistributions of source code must retain the above copyright
12 1.2 itojun * notice, this list of conditions and the following disclaimer.
13 1.2 itojun * 2. Redistributions in binary form must reproduce the above copyright
14 1.2 itojun * notice, this list of conditions and the following disclaimer in the
15 1.2 itojun * documentation and/or other materials provided with the distribution.
16 1.2 itojun * 3. Neither the name of the project nor the names of its contributors
17 1.2 itojun * may be used to endorse or promote products derived from this software
18 1.2 itojun * without specific prior written permission.
19 1.9 itojun *
20 1.2 itojun * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
21 1.2 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 1.2 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 1.2 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
24 1.2 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25 1.2 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26 1.2 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 1.2 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 1.2 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 1.2 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30 1.2 itojun * SUCH DAMAGE.
31 1.2 itojun */
32 1.36 lukem
33 1.36 lukem #include <sys/cdefs.h>
34 1.73 dyoung __KERNEL_RCSID(0, "$NetBSD: if_gif.c,v 1.73 2008/02/07 01:22:00 dyoung Exp $");
35 1.2 itojun
36 1.2 itojun #include "opt_inet.h"
37 1.24 itojun #include "opt_iso.h"
38 1.2 itojun
39 1.2 itojun #include <sys/param.h>
40 1.2 itojun #include <sys/systm.h>
41 1.2 itojun #include <sys/kernel.h>
42 1.2 itojun #include <sys/mbuf.h>
43 1.2 itojun #include <sys/socket.h>
44 1.2 itojun #include <sys/sockio.h>
45 1.2 itojun #include <sys/errno.h>
46 1.2 itojun #include <sys/ioctl.h>
47 1.2 itojun #include <sys/time.h>
48 1.2 itojun #include <sys/syslog.h>
49 1.17 martin #include <sys/proc.h>
50 1.9 itojun #include <sys/protosw.h>
51 1.59 elad #include <sys/kauth.h>
52 1.72 ad #include <sys/cpu.h>
53 1.72 ad #include <sys/intr.h>
54 1.2 itojun
55 1.2 itojun #include <net/if.h>
56 1.2 itojun #include <net/if_types.h>
57 1.2 itojun #include <net/netisr.h>
58 1.2 itojun #include <net/route.h>
59 1.2 itojun #include <net/bpf.h>
60 1.2 itojun
61 1.2 itojun #include <netinet/in.h>
62 1.2 itojun #include <netinet/in_systm.h>
63 1.15 itojun #include <netinet/ip.h>
64 1.15 itojun #ifdef INET
65 1.2 itojun #include <netinet/in_var.h>
66 1.57 christos #endif /* INET */
67 1.2 itojun #include <netinet/in_gif.h>
68 1.2 itojun
69 1.2 itojun #ifdef INET6
70 1.2 itojun #ifndef INET
71 1.2 itojun #include <netinet/in.h>
72 1.2 itojun #endif
73 1.2 itojun #include <netinet6/in6_var.h>
74 1.2 itojun #include <netinet/ip6.h>
75 1.2 itojun #include <netinet6/ip6_var.h>
76 1.2 itojun #include <netinet6/in6_gif.h>
77 1.9 itojun #include <netinet6/ip6protosw.h>
78 1.2 itojun #endif /* INET6 */
79 1.2 itojun
80 1.24 itojun #ifdef ISO
81 1.24 itojun #include <netiso/iso.h>
82 1.24 itojun #include <netiso/iso_var.h>
83 1.24 itojun #endif
84 1.24 itojun
85 1.9 itojun #include <netinet/ip_encap.h>
86 1.2 itojun #include <net/if_gif.h>
87 1.2 itojun
88 1.2 itojun #include "bpfilter.h"
89 1.2 itojun
90 1.4 itojun #include <net/net_osdep.h>
91 1.4 itojun
92 1.56 thorpej void gifattach(int);
93 1.56 thorpej static void gifintr(void *);
94 1.24 itojun #ifdef ISO
95 1.56 thorpej static struct mbuf *gif_eon_encap(struct mbuf *);
96 1.56 thorpej static struct mbuf *gif_eon_decap(struct ifnet *, struct mbuf *);
97 1.24 itojun #endif
98 1.2 itojun
99 1.2 itojun /*
100 1.2 itojun * gif global variable definitions
101 1.2 itojun */
102 1.56 thorpej LIST_HEAD(, gif_softc) gif_softc_list; /* XXX should be static */
103 1.12 thorpej
104 1.56 thorpej static int gif_clone_create(struct if_clone *, int);
105 1.56 thorpej static int gif_clone_destroy(struct ifnet *);
106 1.12 thorpej
107 1.56 thorpej static struct if_clone gif_cloner =
108 1.12 thorpej IF_CLONE_INITIALIZER("gif", gif_clone_create, gif_clone_destroy);
109 1.12 thorpej
110 1.9 itojun #ifndef MAX_GIF_NEST
111 1.9 itojun /*
112 1.9 itojun * This macro controls the upper limitation on nesting of gif tunnels.
113 1.9 itojun * Since, setting a large value to this macro with a careless configuration
114 1.9 itojun * may introduce system crash, we don't allow any nestings by default.
115 1.9 itojun * If you need to configure nested gif tunnels, you can define this macro
116 1.31 itojun * in your kernel configuration file. However, if you do so, please be
117 1.9 itojun * careful to configure the tunnels so that it won't make a loop.
118 1.9 itojun */
119 1.9 itojun #define MAX_GIF_NEST 1
120 1.9 itojun #endif
121 1.9 itojun static int max_gif_nesting = MAX_GIF_NEST;
122 1.2 itojun
123 1.12 thorpej /* ARGSUSED */
124 1.2 itojun void
125 1.63 christos gifattach(int count)
126 1.12 thorpej {
127 1.12 thorpej
128 1.12 thorpej LIST_INIT(&gif_softc_list);
129 1.12 thorpej if_clone_attach(&gif_cloner);
130 1.12 thorpej }
131 1.12 thorpej
132 1.56 thorpej static int
133 1.56 thorpej gif_clone_create(struct if_clone *ifc, int unit)
134 1.2 itojun {
135 1.12 thorpej struct gif_softc *sc;
136 1.12 thorpej
137 1.71 dyoung sc = malloc(sizeof(struct gif_softc), M_DEVBUF, M_WAITOK);
138 1.30 thorpej memset(sc, 0, sizeof(struct gif_softc));
139 1.2 itojun
140 1.45 itojun snprintf(sc->gif_if.if_xname, sizeof(sc->gif_if.if_xname), "%s%d",
141 1.45 itojun ifc->ifc_name, unit);
142 1.9 itojun
143 1.31 itojun gifattach0(sc);
144 1.31 itojun
145 1.31 itojun LIST_INSERT_HEAD(&gif_softc_list, sc, gif_list);
146 1.31 itojun return (0);
147 1.31 itojun }
148 1.31 itojun
149 1.31 itojun void
150 1.56 thorpej gifattach0(struct gif_softc *sc)
151 1.31 itojun {
152 1.31 itojun
153 1.12 thorpej sc->encap_cookie4 = sc->encap_cookie6 = NULL;
154 1.9 itojun
155 1.31 itojun sc->gif_if.if_addrlen = 0;
156 1.12 thorpej sc->gif_if.if_mtu = GIF_MTU;
157 1.12 thorpej sc->gif_if.if_flags = IFF_POINTOPOINT | IFF_MULTICAST;
158 1.12 thorpej sc->gif_if.if_ioctl = gif_ioctl;
159 1.12 thorpej sc->gif_if.if_output = gif_output;
160 1.12 thorpej sc->gif_if.if_type = IFT_GIF;
161 1.19 thorpej sc->gif_if.if_dlt = DLT_NULL;
162 1.34 itojun IFQ_SET_READY(&sc->gif_if.if_snd);
163 1.12 thorpej if_attach(&sc->gif_if);
164 1.20 thorpej if_alloc_sadl(&sc->gif_if);
165 1.2 itojun #if NBPFILTER > 0
166 1.12 thorpej bpfattach(&sc->gif_if, DLT_NULL, sizeof(u_int));
167 1.9 itojun #endif
168 1.12 thorpej }
169 1.12 thorpej
170 1.56 thorpej static int
171 1.56 thorpej gif_clone_destroy(struct ifnet *ifp)
172 1.12 thorpej {
173 1.12 thorpej struct gif_softc *sc = (void *) ifp;
174 1.12 thorpej
175 1.31 itojun gif_delete_tunnel(&sc->gif_if);
176 1.12 thorpej LIST_REMOVE(sc, gif_list);
177 1.12 thorpej #ifdef INET6
178 1.12 thorpej encap_detach(sc->encap_cookie6);
179 1.12 thorpej #endif
180 1.12 thorpej #ifdef INET
181 1.12 thorpej encap_detach(sc->encap_cookie4);
182 1.12 thorpej #endif
183 1.12 thorpej
184 1.12 thorpej #if NBPFILTER > 0
185 1.12 thorpej bpfdetach(ifp);
186 1.12 thorpej #endif
187 1.69 dyoung if_detach(ifp);
188 1.66 dyoung rtcache_free(&sc->gif_ro);
189 1.12 thorpej
190 1.12 thorpej free(sc, M_DEVBUF);
191 1.47 peter
192 1.47 peter return (0);
193 1.9 itojun }
194 1.9 itojun
195 1.42 itojun #ifdef GIF_ENCAPCHECK
196 1.31 itojun int
197 1.56 thorpej gif_encapcheck(struct mbuf *m, int off, int proto, void *arg)
198 1.9 itojun {
199 1.9 itojun struct ip ip;
200 1.9 itojun struct gif_softc *sc;
201 1.9 itojun
202 1.9 itojun sc = (struct gif_softc *)arg;
203 1.9 itojun if (sc == NULL)
204 1.9 itojun return 0;
205 1.9 itojun
206 1.9 itojun if ((sc->gif_if.if_flags & IFF_UP) == 0)
207 1.9 itojun return 0;
208 1.9 itojun
209 1.9 itojun /* no physical address */
210 1.9 itojun if (!sc->gif_psrc || !sc->gif_pdst)
211 1.9 itojun return 0;
212 1.9 itojun
213 1.9 itojun switch (proto) {
214 1.9 itojun #ifdef INET
215 1.9 itojun case IPPROTO_IPV4:
216 1.9 itojun break;
217 1.9 itojun #endif
218 1.9 itojun #ifdef INET6
219 1.9 itojun case IPPROTO_IPV6:
220 1.9 itojun break;
221 1.9 itojun #endif
222 1.24 itojun #ifdef ISO
223 1.24 itojun case IPPROTO_EON:
224 1.24 itojun break;
225 1.24 itojun #endif
226 1.9 itojun default:
227 1.9 itojun return 0;
228 1.9 itojun }
229 1.40 christos
230 1.40 christos /* Bail on short packets */
231 1.40 christos KASSERT(m->m_flags & M_PKTHDR);
232 1.40 christos if (m->m_pkthdr.len < sizeof(ip))
233 1.40 christos return 0;
234 1.9 itojun
235 1.67 christos m_copydata(m, 0, sizeof(ip), (void *)&ip);
236 1.9 itojun
237 1.9 itojun switch (ip.ip_v) {
238 1.9 itojun #ifdef INET
239 1.9 itojun case 4:
240 1.9 itojun if (sc->gif_psrc->sa_family != AF_INET ||
241 1.9 itojun sc->gif_pdst->sa_family != AF_INET)
242 1.9 itojun return 0;
243 1.9 itojun return gif_encapcheck4(m, off, proto, arg);
244 1.9 itojun #endif
245 1.9 itojun #ifdef INET6
246 1.9 itojun case 6:
247 1.41 itojun if (m->m_pkthdr.len < sizeof(struct ip6_hdr))
248 1.41 itojun return 0;
249 1.9 itojun if (sc->gif_psrc->sa_family != AF_INET6 ||
250 1.9 itojun sc->gif_pdst->sa_family != AF_INET6)
251 1.9 itojun return 0;
252 1.9 itojun return gif_encapcheck6(m, off, proto, arg);
253 1.9 itojun #endif
254 1.9 itojun default:
255 1.9 itojun return 0;
256 1.2 itojun }
257 1.2 itojun }
258 1.42 itojun #endif
259 1.2 itojun
260 1.2 itojun int
261 1.65 dyoung gif_output(struct ifnet *ifp, struct mbuf *m, const struct sockaddr *dst,
262 1.63 christos struct rtentry *rt)
263 1.2 itojun {
264 1.21 itojun struct gif_softc *sc = (struct gif_softc*)ifp;
265 1.2 itojun int error = 0;
266 1.2 itojun static int called = 0; /* XXX: MUTEX */
267 1.39 itojun ALTQ_DECL(struct altq_pktattr pktattr;)
268 1.33 itojun int s;
269 1.33 itojun
270 1.33 itojun IFQ_CLASSIFY(&ifp->if_snd, m, dst->sa_family, &pktattr);
271 1.2 itojun
272 1.2 itojun /*
273 1.2 itojun * gif may cause infinite recursion calls when misconfigured.
274 1.2 itojun * We'll prevent this by introducing upper limit.
275 1.2 itojun * XXX: this mechanism may introduce another problem about
276 1.2 itojun * mutual exclusion of the variable CALLED, especially if we
277 1.2 itojun * use kernel thread.
278 1.2 itojun */
279 1.9 itojun if (++called > max_gif_nesting) {
280 1.2 itojun log(LOG_NOTICE,
281 1.2 itojun "gif_output: recursively called too many times(%d)\n",
282 1.2 itojun called);
283 1.2 itojun m_freem(m);
284 1.2 itojun error = EIO; /* is there better errno? */
285 1.2 itojun goto end;
286 1.2 itojun }
287 1.2 itojun
288 1.2 itojun m->m_flags &= ~(M_BCAST|M_MCAST);
289 1.2 itojun if (!(ifp->if_flags & IFF_UP) ||
290 1.2 itojun sc->gif_psrc == NULL || sc->gif_pdst == NULL) {
291 1.2 itojun m_freem(m);
292 1.2 itojun error = ENETDOWN;
293 1.2 itojun goto end;
294 1.2 itojun }
295 1.2 itojun
296 1.24 itojun /* inner AF-specific encapsulation */
297 1.24 itojun switch (dst->sa_family) {
298 1.24 itojun #ifdef ISO
299 1.24 itojun case AF_ISO:
300 1.31 itojun m = gif_eon_encap(m);
301 1.31 itojun if (!m) {
302 1.31 itojun error = ENOBUFS;
303 1.24 itojun goto end;
304 1.31 itojun }
305 1.31 itojun break;
306 1.24 itojun #endif
307 1.24 itojun default:
308 1.24 itojun break;
309 1.24 itojun }
310 1.24 itojun
311 1.9 itojun /* XXX should we check if our outer source is legal? */
312 1.2 itojun
313 1.33 itojun /* use DLT_NULL encapsulation here to pass inner af type */
314 1.33 itojun M_PREPEND(m, sizeof(int), M_DONTWAIT);
315 1.33 itojun if (!m) {
316 1.33 itojun error = ENOBUFS;
317 1.33 itojun goto end;
318 1.33 itojun }
319 1.33 itojun *mtod(m, int *) = dst->sa_family;
320 1.33 itojun
321 1.33 itojun s = splnet();
322 1.33 itojun IFQ_ENQUEUE(&ifp->if_snd, m, &pktattr, error);
323 1.33 itojun if (error) {
324 1.33 itojun splx(s);
325 1.31 itojun goto end;
326 1.2 itojun }
327 1.33 itojun splx(s);
328 1.33 itojun
329 1.72 ad softint_schedule(sc->gif_si);
330 1.33 itojun error = 0;
331 1.2 itojun
332 1.2 itojun end:
333 1.2 itojun called = 0; /* reset recursion counter */
334 1.31 itojun if (error)
335 1.31 itojun ifp->if_oerrors++;
336 1.2 itojun return error;
337 1.2 itojun }
338 1.2 itojun
339 1.56 thorpej static void
340 1.56 thorpej gifintr(void *arg)
341 1.33 itojun {
342 1.33 itojun struct gif_softc *sc;
343 1.33 itojun struct ifnet *ifp;
344 1.33 itojun struct mbuf *m;
345 1.33 itojun int family;
346 1.33 itojun int len;
347 1.33 itojun int s;
348 1.33 itojun int error;
349 1.33 itojun
350 1.33 itojun sc = (struct gif_softc *)arg;
351 1.33 itojun ifp = &sc->gif_if;
352 1.33 itojun
353 1.33 itojun /* output processing */
354 1.33 itojun while (1) {
355 1.33 itojun s = splnet();
356 1.34 itojun IFQ_DEQUEUE(&sc->gif_if.if_snd, m);
357 1.33 itojun splx(s);
358 1.33 itojun if (m == NULL)
359 1.33 itojun break;
360 1.33 itojun
361 1.33 itojun /* grab and chop off inner af type */
362 1.33 itojun if (sizeof(int) > m->m_len) {
363 1.33 itojun m = m_pullup(m, sizeof(int));
364 1.33 itojun if (!m) {
365 1.33 itojun ifp->if_oerrors++;
366 1.33 itojun continue;
367 1.33 itojun }
368 1.33 itojun }
369 1.33 itojun family = *mtod(m, int *);
370 1.33 itojun #if NBPFILTER > 0
371 1.46 christos if (ifp->if_bpf)
372 1.33 itojun bpf_mtap(ifp->if_bpf, m);
373 1.33 itojun #endif
374 1.33 itojun m_adj(m, sizeof(int));
375 1.33 itojun
376 1.33 itojun len = m->m_pkthdr.len;
377 1.33 itojun
378 1.33 itojun /* dispatch to output logic based on outer AF */
379 1.33 itojun switch (sc->gif_psrc->sa_family) {
380 1.33 itojun #ifdef INET
381 1.33 itojun case AF_INET:
382 1.33 itojun error = in_gif_output(ifp, family, m);
383 1.33 itojun break;
384 1.33 itojun #endif
385 1.33 itojun #ifdef INET6
386 1.33 itojun case AF_INET6:
387 1.33 itojun error = in6_gif_output(ifp, family, m);
388 1.33 itojun break;
389 1.33 itojun #endif
390 1.33 itojun default:
391 1.50 perry m_freem(m);
392 1.33 itojun error = ENETDOWN;
393 1.33 itojun break;
394 1.33 itojun }
395 1.33 itojun
396 1.33 itojun if (error)
397 1.33 itojun ifp->if_oerrors++;
398 1.33 itojun else {
399 1.50 perry ifp->if_opackets++;
400 1.33 itojun ifp->if_obytes += len;
401 1.33 itojun }
402 1.33 itojun }
403 1.33 itojun }
404 1.33 itojun
405 1.33 itojun void
406 1.56 thorpej gif_input(struct mbuf *m, int af, struct ifnet *ifp)
407 1.2 itojun {
408 1.2 itojun int s, isr;
409 1.33 itojun struct ifqueue *ifq = NULL;
410 1.2 itojun
411 1.33 itojun if (ifp == NULL) {
412 1.2 itojun /* just in case */
413 1.2 itojun m_freem(m);
414 1.2 itojun return;
415 1.2 itojun }
416 1.2 itojun
417 1.33 itojun m->m_pkthdr.rcvif = ifp;
418 1.50 perry
419 1.2 itojun #if NBPFILTER > 0
420 1.46 christos if (ifp->if_bpf)
421 1.46 christos bpf_mtap_af(ifp->if_bpf, af, m);
422 1.2 itojun #endif /*NBPFILTER > 0*/
423 1.2 itojun
424 1.2 itojun /*
425 1.2 itojun * Put the packet to the network layer input queue according to the
426 1.2 itojun * specified address family.
427 1.2 itojun * Note: older versions of gif_input directly called network layer
428 1.31 itojun * input functions, e.g. ip6_input, here. We changed the policy to
429 1.2 itojun * prevent too many recursive calls of such input functions, which
430 1.31 itojun * might cause kernel panic. But the change may introduce another
431 1.2 itojun * problem; if the input queue is full, packets are discarded.
432 1.31 itojun * The kernel stack overflow really happened, and we believed
433 1.31 itojun * queue-full rarely occurs, so we changed the policy.
434 1.2 itojun */
435 1.2 itojun switch (af) {
436 1.2 itojun #ifdef INET
437 1.2 itojun case AF_INET:
438 1.2 itojun ifq = &ipintrq;
439 1.2 itojun isr = NETISR_IP;
440 1.2 itojun break;
441 1.2 itojun #endif
442 1.2 itojun #ifdef INET6
443 1.2 itojun case AF_INET6:
444 1.2 itojun ifq = &ip6intrq;
445 1.2 itojun isr = NETISR_IPV6;
446 1.2 itojun break;
447 1.2 itojun #endif
448 1.24 itojun #ifdef ISO
449 1.24 itojun case AF_ISO:
450 1.33 itojun m = gif_eon_decap(ifp, m);
451 1.31 itojun if (!m)
452 1.24 itojun return;
453 1.24 itojun ifq = &clnlintrq;
454 1.24 itojun isr = NETISR_ISO;
455 1.24 itojun break;
456 1.24 itojun #endif
457 1.2 itojun default:
458 1.2 itojun m_freem(m);
459 1.2 itojun return;
460 1.2 itojun }
461 1.2 itojun
462 1.27 thorpej s = splnet();
463 1.2 itojun if (IF_QFULL(ifq)) {
464 1.2 itojun IF_DROP(ifq); /* update statistics */
465 1.2 itojun m_freem(m);
466 1.2 itojun splx(s);
467 1.2 itojun return;
468 1.2 itojun }
469 1.33 itojun ifp->if_ipackets++;
470 1.33 itojun ifp->if_ibytes += m->m_pkthdr.len;
471 1.2 itojun IF_ENQUEUE(ifq, m);
472 1.2 itojun /* we need schednetisr since the address family may change */
473 1.2 itojun schednetisr(isr);
474 1.2 itojun splx(s);
475 1.2 itojun }
476 1.2 itojun
477 1.9 itojun /* XXX how should we handle IPv6 scope on SIOC[GS]IFPHYADDR? */
478 1.2 itojun int
479 1.67 christos gif_ioctl(struct ifnet *ifp, u_long cmd, void *data)
480 1.2 itojun {
481 1.60 ad struct lwp *l = curlwp; /* XXX */
482 1.2 itojun struct gif_softc *sc = (struct gif_softc*)ifp;
483 1.2 itojun struct ifreq *ifr = (struct ifreq*)data;
484 1.2 itojun int error = 0, size;
485 1.9 itojun struct sockaddr *dst, *src;
486 1.31 itojun
487 1.2 itojun switch (cmd) {
488 1.60 ad case SIOCSIFMTU:
489 1.60 ad case SIOCSLIFPHYADDR:
490 1.60 ad #ifdef SIOCDIFPHYADDR
491 1.60 ad case SIOCDIFPHYADDR:
492 1.60 ad #endif
493 1.62 elad if ((error = kauth_authorize_network(l->l_cred,
494 1.62 elad KAUTH_NETWORK_INTERFACE,
495 1.62 elad KAUTH_REQ_NETWORK_INTERFACE_SETPRIV, ifp, (void *)cmd,
496 1.62 elad NULL)) != 0)
497 1.60 ad return (error);
498 1.60 ad /* FALLTHROUGH */
499 1.60 ad default:
500 1.60 ad break;
501 1.60 ad }
502 1.60 ad
503 1.60 ad switch (cmd) {
504 1.2 itojun case SIOCSIFADDR:
505 1.32 itojun ifp->if_flags |= IFF_UP;
506 1.2 itojun break;
507 1.50 perry
508 1.2 itojun case SIOCSIFDSTADDR:
509 1.2 itojun break;
510 1.2 itojun
511 1.2 itojun case SIOCADDMULTI:
512 1.2 itojun case SIOCDELMULTI:
513 1.2 itojun switch (ifr->ifr_addr.sa_family) {
514 1.2 itojun #ifdef INET
515 1.2 itojun case AF_INET: /* IP supports Multicast */
516 1.2 itojun break;
517 1.2 itojun #endif /* INET */
518 1.2 itojun #ifdef INET6
519 1.2 itojun case AF_INET6: /* IP6 supports Multicast */
520 1.2 itojun break;
521 1.2 itojun #endif /* INET6 */
522 1.2 itojun default: /* Other protocols doesn't support Multicast */
523 1.2 itojun error = EAFNOSUPPORT;
524 1.2 itojun break;
525 1.2 itojun }
526 1.2 itojun break;
527 1.2 itojun
528 1.2 itojun case SIOCGIFMTU:
529 1.2 itojun break;
530 1.11 itojun
531 1.2 itojun case SIOCSIFMTU:
532 1.73 dyoung if (ifr->ifr_mtu < GIF_MTU_MIN || ifr->ifr_mtu > GIF_MTU_MAX)
533 1.73 dyoung return EINVAL;
534 1.73 dyoung else if ((error = ifioctl_common(ifp, cmd, data)) == ENETRESET)
535 1.73 dyoung error = 0;
536 1.2 itojun break;
537 1.2 itojun
538 1.31 itojun #ifdef INET
539 1.2 itojun case SIOCSIFPHYADDR:
540 1.31 itojun #endif
541 1.2 itojun #ifdef INET6
542 1.2 itojun case SIOCSIFPHYADDR_IN6:
543 1.2 itojun #endif /* INET6 */
544 1.25 itojun case SIOCSLIFPHYADDR:
545 1.11 itojun switch (cmd) {
546 1.15 itojun #ifdef INET
547 1.11 itojun case SIOCSIFPHYADDR:
548 1.11 itojun src = (struct sockaddr *)
549 1.11 itojun &(((struct in_aliasreq *)data)->ifra_addr);
550 1.11 itojun dst = (struct sockaddr *)
551 1.11 itojun &(((struct in_aliasreq *)data)->ifra_dstaddr);
552 1.11 itojun break;
553 1.15 itojun #endif
554 1.11 itojun #ifdef INET6
555 1.11 itojun case SIOCSIFPHYADDR_IN6:
556 1.11 itojun src = (struct sockaddr *)
557 1.11 itojun &(((struct in6_aliasreq *)data)->ifra_addr);
558 1.11 itojun dst = (struct sockaddr *)
559 1.11 itojun &(((struct in6_aliasreq *)data)->ifra_dstaddr);
560 1.25 itojun break;
561 1.25 itojun #endif
562 1.25 itojun case SIOCSLIFPHYADDR:
563 1.25 itojun src = (struct sockaddr *)
564 1.25 itojun &(((struct if_laddrreq *)data)->addr);
565 1.25 itojun dst = (struct sockaddr *)
566 1.25 itojun &(((struct if_laddrreq *)data)->dstaddr);
567 1.31 itojun break;
568 1.31 itojun default:
569 1.31 itojun return EINVAL;
570 1.25 itojun }
571 1.25 itojun
572 1.25 itojun /* sa_family must be equal */
573 1.25 itojun if (src->sa_family != dst->sa_family)
574 1.25 itojun return EINVAL;
575 1.25 itojun
576 1.25 itojun /* validate sa_len */
577 1.25 itojun switch (src->sa_family) {
578 1.25 itojun #ifdef INET
579 1.25 itojun case AF_INET:
580 1.25 itojun if (src->sa_len != sizeof(struct sockaddr_in))
581 1.16 itojun return EINVAL;
582 1.11 itojun break;
583 1.11 itojun #endif
584 1.25 itojun #ifdef INET6
585 1.25 itojun case AF_INET6:
586 1.25 itojun if (src->sa_len != sizeof(struct sockaddr_in6))
587 1.25 itojun return EINVAL;
588 1.25 itojun break;
589 1.25 itojun #endif
590 1.25 itojun default:
591 1.25 itojun return EAFNOSUPPORT;
592 1.25 itojun }
593 1.25 itojun switch (dst->sa_family) {
594 1.25 itojun #ifdef INET
595 1.25 itojun case AF_INET:
596 1.25 itojun if (dst->sa_len != sizeof(struct sockaddr_in))
597 1.25 itojun return EINVAL;
598 1.25 itojun break;
599 1.25 itojun #endif
600 1.25 itojun #ifdef INET6
601 1.25 itojun case AF_INET6:
602 1.25 itojun if (dst->sa_len != sizeof(struct sockaddr_in6))
603 1.25 itojun return EINVAL;
604 1.25 itojun break;
605 1.25 itojun #endif
606 1.25 itojun default:
607 1.25 itojun return EAFNOSUPPORT;
608 1.25 itojun }
609 1.25 itojun
610 1.25 itojun /* check sa_family looks sane for the cmd */
611 1.25 itojun switch (cmd) {
612 1.25 itojun case SIOCSIFPHYADDR:
613 1.25 itojun if (src->sa_family == AF_INET)
614 1.25 itojun break;
615 1.25 itojun return EAFNOSUPPORT;
616 1.25 itojun #ifdef INET6
617 1.25 itojun case SIOCSIFPHYADDR_IN6:
618 1.25 itojun if (src->sa_family == AF_INET6)
619 1.25 itojun break;
620 1.25 itojun return EAFNOSUPPORT;
621 1.25 itojun #endif /* INET6 */
622 1.25 itojun case SIOCSLIFPHYADDR:
623 1.25 itojun /* checks done in the above */
624 1.25 itojun break;
625 1.11 itojun }
626 1.11 itojun
627 1.31 itojun error = gif_set_tunnel(&sc->gif_if, src, dst);
628 1.9 itojun break;
629 1.9 itojun
630 1.9 itojun #ifdef SIOCDIFPHYADDR
631 1.9 itojun case SIOCDIFPHYADDR:
632 1.31 itojun gif_delete_tunnel(&sc->gif_if);
633 1.2 itojun break;
634 1.9 itojun #endif
635 1.50 perry
636 1.2 itojun case SIOCGIFPSRCADDR:
637 1.2 itojun #ifdef INET6
638 1.2 itojun case SIOCGIFPSRCADDR_IN6:
639 1.2 itojun #endif /* INET6 */
640 1.2 itojun if (sc->gif_psrc == NULL) {
641 1.2 itojun error = EADDRNOTAVAIL;
642 1.2 itojun goto bad;
643 1.2 itojun }
644 1.2 itojun src = sc->gif_psrc;
645 1.16 itojun switch (cmd) {
646 1.2 itojun #ifdef INET
647 1.16 itojun case SIOCGIFPSRCADDR:
648 1.2 itojun dst = &ifr->ifr_addr;
649 1.16 itojun size = sizeof(ifr->ifr_addr);
650 1.2 itojun break;
651 1.2 itojun #endif /* INET */
652 1.2 itojun #ifdef INET6
653 1.16 itojun case SIOCGIFPSRCADDR_IN6:
654 1.2 itojun dst = (struct sockaddr *)
655 1.2 itojun &(((struct in6_ifreq *)data)->ifr_addr);
656 1.16 itojun size = sizeof(((struct in6_ifreq *)data)->ifr_addr);
657 1.2 itojun break;
658 1.2 itojun #endif /* INET6 */
659 1.2 itojun default:
660 1.2 itojun error = EADDRNOTAVAIL;
661 1.2 itojun goto bad;
662 1.2 itojun }
663 1.16 itojun if (src->sa_len > size)
664 1.16 itojun return EINVAL;
665 1.68 dyoung memcpy(dst, src, src->sa_len);
666 1.2 itojun break;
667 1.50 perry
668 1.2 itojun case SIOCGIFPDSTADDR:
669 1.2 itojun #ifdef INET6
670 1.2 itojun case SIOCGIFPDSTADDR_IN6:
671 1.2 itojun #endif /* INET6 */
672 1.2 itojun if (sc->gif_pdst == NULL) {
673 1.2 itojun error = EADDRNOTAVAIL;
674 1.2 itojun goto bad;
675 1.2 itojun }
676 1.2 itojun src = sc->gif_pdst;
677 1.16 itojun switch (cmd) {
678 1.2 itojun #ifdef INET
679 1.16 itojun case SIOCGIFPDSTADDR:
680 1.2 itojun dst = &ifr->ifr_addr;
681 1.16 itojun size = sizeof(ifr->ifr_addr);
682 1.2 itojun break;
683 1.2 itojun #endif /* INET */
684 1.2 itojun #ifdef INET6
685 1.16 itojun case SIOCGIFPDSTADDR_IN6:
686 1.2 itojun dst = (struct sockaddr *)
687 1.2 itojun &(((struct in6_ifreq *)data)->ifr_addr);
688 1.16 itojun size = sizeof(((struct in6_ifreq *)data)->ifr_addr);
689 1.2 itojun break;
690 1.2 itojun #endif /* INET6 */
691 1.2 itojun default:
692 1.2 itojun error = EADDRNOTAVAIL;
693 1.2 itojun goto bad;
694 1.2 itojun }
695 1.25 itojun if (src->sa_len > size)
696 1.25 itojun return EINVAL;
697 1.68 dyoung memcpy(dst, src, src->sa_len);
698 1.25 itojun break;
699 1.25 itojun
700 1.25 itojun case SIOCGLIFPHYADDR:
701 1.25 itojun if (sc->gif_psrc == NULL || sc->gif_pdst == NULL) {
702 1.25 itojun error = EADDRNOTAVAIL;
703 1.25 itojun goto bad;
704 1.25 itojun }
705 1.25 itojun
706 1.25 itojun /* copy src */
707 1.25 itojun src = sc->gif_psrc;
708 1.25 itojun dst = (struct sockaddr *)
709 1.25 itojun &(((struct if_laddrreq *)data)->addr);
710 1.25 itojun size = sizeof(((struct if_laddrreq *)data)->addr);
711 1.25 itojun if (src->sa_len > size)
712 1.25 itojun return EINVAL;
713 1.68 dyoung memcpy(dst, src, src->sa_len);
714 1.25 itojun
715 1.25 itojun /* copy dst */
716 1.25 itojun src = sc->gif_pdst;
717 1.25 itojun dst = (struct sockaddr *)
718 1.25 itojun &(((struct if_laddrreq *)data)->dstaddr);
719 1.25 itojun size = sizeof(((struct if_laddrreq *)data)->dstaddr);
720 1.16 itojun if (src->sa_len > size)
721 1.16 itojun return EINVAL;
722 1.68 dyoung memcpy(dst, src, src->sa_len);
723 1.2 itojun break;
724 1.2 itojun
725 1.2 itojun case SIOCSIFFLAGS:
726 1.9 itojun /* if_ioctl() takes care of it */
727 1.2 itojun break;
728 1.2 itojun
729 1.2 itojun default:
730 1.2 itojun error = EINVAL;
731 1.2 itojun break;
732 1.2 itojun }
733 1.2 itojun bad:
734 1.2 itojun return error;
735 1.12 thorpej }
736 1.12 thorpej
737 1.31 itojun int
738 1.56 thorpej gif_set_tunnel(struct ifnet *ifp, struct sockaddr *src, struct sockaddr *dst)
739 1.31 itojun {
740 1.31 itojun struct gif_softc *sc = (struct gif_softc *)ifp;
741 1.31 itojun struct gif_softc *sc2;
742 1.71 dyoung struct sockaddr *osrc, *odst;
743 1.31 itojun int s;
744 1.31 itojun int error;
745 1.31 itojun
746 1.31 itojun s = splsoftnet();
747 1.31 itojun
748 1.68 dyoung LIST_FOREACH(sc2, &gif_softc_list, gif_list) {
749 1.31 itojun if (sc2 == sc)
750 1.31 itojun continue;
751 1.31 itojun if (!sc2->gif_pdst || !sc2->gif_psrc)
752 1.31 itojun continue;
753 1.31 itojun /* can't configure same pair of address onto two gifs */
754 1.71 dyoung if (sockaddr_cmp(sc2->gif_pdst, dst) == 0 &&
755 1.71 dyoung sockaddr_cmp(sc2->gif_psrc, src) == 0) {
756 1.31 itojun error = EADDRNOTAVAIL;
757 1.31 itojun goto bad;
758 1.31 itojun }
759 1.31 itojun
760 1.31 itojun /* XXX both end must be valid? (I mean, not 0.0.0.0) */
761 1.31 itojun }
762 1.31 itojun
763 1.58 msaitoh if (sc->gif_si) {
764 1.72 ad softint_disestablish(sc->gif_si);
765 1.58 msaitoh sc->gif_si = NULL;
766 1.58 msaitoh }
767 1.58 msaitoh
768 1.31 itojun /* XXX we can detach from both, but be polite just in case */
769 1.31 itojun if (sc->gif_psrc)
770 1.31 itojun switch (sc->gif_psrc->sa_family) {
771 1.31 itojun #ifdef INET
772 1.31 itojun case AF_INET:
773 1.31 itojun (void)in_gif_detach(sc);
774 1.31 itojun break;
775 1.31 itojun #endif
776 1.31 itojun #ifdef INET6
777 1.31 itojun case AF_INET6:
778 1.31 itojun (void)in6_gif_detach(sc);
779 1.31 itojun break;
780 1.31 itojun #endif
781 1.31 itojun }
782 1.31 itojun
783 1.72 ad sc->gif_si = softint_establish(SOFTINT_NET, gifintr, sc);
784 1.33 itojun if (sc->gif_si == NULL) {
785 1.33 itojun error = ENOMEM;
786 1.33 itojun goto bad;
787 1.33 itojun }
788 1.33 itojun
789 1.31 itojun osrc = sc->gif_psrc;
790 1.71 dyoung sc->gif_psrc = sockaddr_dup(src, M_WAITOK);
791 1.31 itojun
792 1.31 itojun odst = sc->gif_pdst;
793 1.71 dyoung sc->gif_pdst = sockaddr_dup(dst, M_WAITOK);
794 1.31 itojun
795 1.31 itojun switch (sc->gif_psrc->sa_family) {
796 1.31 itojun #ifdef INET
797 1.31 itojun case AF_INET:
798 1.31 itojun error = in_gif_attach(sc);
799 1.31 itojun break;
800 1.31 itojun #endif
801 1.31 itojun #ifdef INET6
802 1.31 itojun case AF_INET6:
803 1.31 itojun error = in6_gif_attach(sc);
804 1.31 itojun break;
805 1.31 itojun #endif
806 1.43 christos default:
807 1.44 mycroft error = EINVAL;
808 1.43 christos break;
809 1.31 itojun }
810 1.31 itojun if (error) {
811 1.31 itojun /* rollback */
812 1.71 dyoung sockaddr_free(sc->gif_psrc);
813 1.71 dyoung sockaddr_free(sc->gif_pdst);
814 1.31 itojun sc->gif_psrc = osrc;
815 1.31 itojun sc->gif_pdst = odst;
816 1.31 itojun goto bad;
817 1.31 itojun }
818 1.31 itojun
819 1.31 itojun if (osrc)
820 1.71 dyoung sockaddr_free(osrc);
821 1.31 itojun if (odst)
822 1.71 dyoung sockaddr_free(odst);
823 1.31 itojun
824 1.33 itojun if (sc->gif_psrc && sc->gif_pdst)
825 1.33 itojun ifp->if_flags |= IFF_RUNNING;
826 1.33 itojun else
827 1.33 itojun ifp->if_flags &= ~IFF_RUNNING;
828 1.33 itojun splx(s);
829 1.33 itojun
830 1.33 itojun return 0;
831 1.31 itojun
832 1.31 itojun bad:
833 1.35 itojun if (sc->gif_si) {
834 1.72 ad softint_disestablish(sc->gif_si);
835 1.35 itojun sc->gif_si = NULL;
836 1.35 itojun }
837 1.31 itojun if (sc->gif_psrc && sc->gif_pdst)
838 1.31 itojun ifp->if_flags |= IFF_RUNNING;
839 1.31 itojun else
840 1.31 itojun ifp->if_flags &= ~IFF_RUNNING;
841 1.31 itojun splx(s);
842 1.31 itojun
843 1.31 itojun return error;
844 1.31 itojun }
845 1.31 itojun
846 1.12 thorpej void
847 1.56 thorpej gif_delete_tunnel(struct ifnet *ifp)
848 1.12 thorpej {
849 1.31 itojun struct gif_softc *sc = (struct gif_softc *)ifp;
850 1.12 thorpej int s;
851 1.12 thorpej
852 1.12 thorpej s = splsoftnet();
853 1.12 thorpej
854 1.35 itojun if (sc->gif_si) {
855 1.72 ad softint_disestablish(sc->gif_si);
856 1.35 itojun sc->gif_si = NULL;
857 1.35 itojun }
858 1.12 thorpej if (sc->gif_psrc) {
859 1.71 dyoung sockaddr_free(sc->gif_psrc);
860 1.12 thorpej sc->gif_psrc = NULL;
861 1.12 thorpej }
862 1.12 thorpej if (sc->gif_pdst) {
863 1.71 dyoung sockaddr_free(sc->gif_pdst);
864 1.12 thorpej sc->gif_pdst = NULL;
865 1.12 thorpej }
866 1.31 itojun /* it is safe to detach from both */
867 1.31 itojun #ifdef INET
868 1.31 itojun (void)in_gif_detach(sc);
869 1.31 itojun #endif
870 1.31 itojun #ifdef INET6
871 1.31 itojun (void)in6_gif_detach(sc);
872 1.31 itojun #endif
873 1.12 thorpej
874 1.31 itojun if (sc->gif_psrc && sc->gif_pdst)
875 1.31 itojun ifp->if_flags |= IFF_RUNNING;
876 1.31 itojun else
877 1.31 itojun ifp->if_flags &= ~IFF_RUNNING;
878 1.12 thorpej splx(s);
879 1.2 itojun }
880 1.24 itojun
881 1.24 itojun #ifdef ISO
882 1.24 itojun struct eonhdr {
883 1.24 itojun u_int8_t version;
884 1.24 itojun u_int8_t class;
885 1.24 itojun u_int16_t cksum;
886 1.26 itojun };
887 1.24 itojun
888 1.24 itojun /*
889 1.24 itojun * prepend EON header to ISO PDU
890 1.24 itojun */
891 1.31 itojun static struct mbuf *
892 1.31 itojun gif_eon_encap(struct mbuf *m)
893 1.24 itojun {
894 1.24 itojun struct eonhdr *ehdr;
895 1.24 itojun
896 1.31 itojun M_PREPEND(m, sizeof(*ehdr), M_DONTWAIT);
897 1.31 itojun if (m && m->m_len < sizeof(*ehdr))
898 1.31 itojun m = m_pullup(m, sizeof(*ehdr));
899 1.31 itojun if (m == NULL)
900 1.31 itojun return NULL;
901 1.31 itojun ehdr = mtod(m, struct eonhdr *);
902 1.24 itojun ehdr->version = 1;
903 1.24 itojun ehdr->class = 0; /* always unicast */
904 1.24 itojun #if 0
905 1.24 itojun /* calculate the checksum of the eonhdr */
906 1.24 itojun {
907 1.24 itojun struct mbuf mhead;
908 1.24 itojun memset(&mhead, 0, sizeof(mhead));
909 1.24 itojun ehdr->cksum = 0;
910 1.67 christos mhead.m_data = (void *)ehdr;
911 1.24 itojun mhead.m_len = sizeof(*ehdr);
912 1.24 itojun mhead.m_next = 0;
913 1.24 itojun iso_gen_csum(&mhead, offsetof(struct eonhdr, cksum),
914 1.24 itojun mhead.m_len);
915 1.24 itojun }
916 1.24 itojun #else
917 1.24 itojun /* since the data is always constant we'll just plug the value in */
918 1.24 itojun ehdr->cksum = htons(0xfc02);
919 1.24 itojun #endif
920 1.31 itojun return m;
921 1.24 itojun }
922 1.24 itojun
923 1.24 itojun /*
924 1.24 itojun * remove EON header and check checksum
925 1.24 itojun */
926 1.31 itojun static struct mbuf *
927 1.33 itojun gif_eon_decap(struct ifnet *ifp, struct mbuf *m)
928 1.24 itojun {
929 1.24 itojun struct eonhdr *ehdr;
930 1.24 itojun
931 1.31 itojun if (m->m_len < sizeof(*ehdr) &&
932 1.31 itojun (m = m_pullup(m, sizeof(*ehdr))) == NULL) {
933 1.33 itojun ifp->if_ierrors++;
934 1.31 itojun return NULL;
935 1.24 itojun }
936 1.31 itojun if (iso_check_csum(m, sizeof(struct eonhdr))) {
937 1.31 itojun m_freem(m);
938 1.31 itojun return NULL;
939 1.31 itojun }
940 1.31 itojun m_adj(m, sizeof(*ehdr));
941 1.31 itojun return m;
942 1.24 itojun }
943 1.24 itojun #endif /*ISO*/
944