if_gif.c revision 1.75 1 1.75 christos /* $NetBSD: if_gif.c,v 1.75 2008/06/15 16:37:21 christos 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.75 christos __KERNEL_RCSID(0, "$NetBSD: if_gif.c,v 1.75 2008/06/15 16:37:21 christos 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.75 christos sc = malloc(sizeof(struct gif_softc), M_DEVBUF, M_WAITOK|M_ZERO);
138 1.2 itojun
139 1.75 christos if_initname(&sc->gif_if, ifc->ifc_name, unit);
140 1.9 itojun
141 1.31 itojun gifattach0(sc);
142 1.31 itojun
143 1.31 itojun LIST_INSERT_HEAD(&gif_softc_list, sc, gif_list);
144 1.31 itojun return (0);
145 1.31 itojun }
146 1.31 itojun
147 1.31 itojun void
148 1.56 thorpej gifattach0(struct gif_softc *sc)
149 1.31 itojun {
150 1.31 itojun
151 1.12 thorpej sc->encap_cookie4 = sc->encap_cookie6 = NULL;
152 1.9 itojun
153 1.31 itojun sc->gif_if.if_addrlen = 0;
154 1.12 thorpej sc->gif_if.if_mtu = GIF_MTU;
155 1.12 thorpej sc->gif_if.if_flags = IFF_POINTOPOINT | IFF_MULTICAST;
156 1.12 thorpej sc->gif_if.if_ioctl = gif_ioctl;
157 1.12 thorpej sc->gif_if.if_output = gif_output;
158 1.12 thorpej sc->gif_if.if_type = IFT_GIF;
159 1.19 thorpej sc->gif_if.if_dlt = DLT_NULL;
160 1.34 itojun IFQ_SET_READY(&sc->gif_if.if_snd);
161 1.12 thorpej if_attach(&sc->gif_if);
162 1.20 thorpej if_alloc_sadl(&sc->gif_if);
163 1.2 itojun #if NBPFILTER > 0
164 1.12 thorpej bpfattach(&sc->gif_if, DLT_NULL, sizeof(u_int));
165 1.9 itojun #endif
166 1.12 thorpej }
167 1.12 thorpej
168 1.56 thorpej static int
169 1.56 thorpej gif_clone_destroy(struct ifnet *ifp)
170 1.12 thorpej {
171 1.12 thorpej struct gif_softc *sc = (void *) ifp;
172 1.12 thorpej
173 1.31 itojun gif_delete_tunnel(&sc->gif_if);
174 1.12 thorpej LIST_REMOVE(sc, gif_list);
175 1.12 thorpej #ifdef INET6
176 1.12 thorpej encap_detach(sc->encap_cookie6);
177 1.12 thorpej #endif
178 1.12 thorpej #ifdef INET
179 1.12 thorpej encap_detach(sc->encap_cookie4);
180 1.12 thorpej #endif
181 1.12 thorpej
182 1.12 thorpej #if NBPFILTER > 0
183 1.12 thorpej bpfdetach(ifp);
184 1.12 thorpej #endif
185 1.69 dyoung if_detach(ifp);
186 1.66 dyoung rtcache_free(&sc->gif_ro);
187 1.12 thorpej
188 1.12 thorpej free(sc, M_DEVBUF);
189 1.47 peter
190 1.47 peter return (0);
191 1.9 itojun }
192 1.9 itojun
193 1.42 itojun #ifdef GIF_ENCAPCHECK
194 1.31 itojun int
195 1.56 thorpej gif_encapcheck(struct mbuf *m, int off, int proto, void *arg)
196 1.9 itojun {
197 1.9 itojun struct ip ip;
198 1.9 itojun struct gif_softc *sc;
199 1.9 itojun
200 1.9 itojun sc = (struct gif_softc *)arg;
201 1.9 itojun if (sc == NULL)
202 1.9 itojun return 0;
203 1.9 itojun
204 1.9 itojun if ((sc->gif_if.if_flags & IFF_UP) == 0)
205 1.9 itojun return 0;
206 1.9 itojun
207 1.9 itojun /* no physical address */
208 1.9 itojun if (!sc->gif_psrc || !sc->gif_pdst)
209 1.9 itojun return 0;
210 1.9 itojun
211 1.9 itojun switch (proto) {
212 1.9 itojun #ifdef INET
213 1.9 itojun case IPPROTO_IPV4:
214 1.9 itojun break;
215 1.9 itojun #endif
216 1.9 itojun #ifdef INET6
217 1.9 itojun case IPPROTO_IPV6:
218 1.9 itojun break;
219 1.9 itojun #endif
220 1.24 itojun #ifdef ISO
221 1.24 itojun case IPPROTO_EON:
222 1.24 itojun break;
223 1.24 itojun #endif
224 1.9 itojun default:
225 1.9 itojun return 0;
226 1.9 itojun }
227 1.40 christos
228 1.40 christos /* Bail on short packets */
229 1.40 christos KASSERT(m->m_flags & M_PKTHDR);
230 1.40 christos if (m->m_pkthdr.len < sizeof(ip))
231 1.40 christos return 0;
232 1.9 itojun
233 1.67 christos m_copydata(m, 0, sizeof(ip), (void *)&ip);
234 1.9 itojun
235 1.9 itojun switch (ip.ip_v) {
236 1.9 itojun #ifdef INET
237 1.9 itojun case 4:
238 1.9 itojun if (sc->gif_psrc->sa_family != AF_INET ||
239 1.9 itojun sc->gif_pdst->sa_family != AF_INET)
240 1.9 itojun return 0;
241 1.9 itojun return gif_encapcheck4(m, off, proto, arg);
242 1.9 itojun #endif
243 1.9 itojun #ifdef INET6
244 1.9 itojun case 6:
245 1.41 itojun if (m->m_pkthdr.len < sizeof(struct ip6_hdr))
246 1.41 itojun return 0;
247 1.9 itojun if (sc->gif_psrc->sa_family != AF_INET6 ||
248 1.9 itojun sc->gif_pdst->sa_family != AF_INET6)
249 1.9 itojun return 0;
250 1.9 itojun return gif_encapcheck6(m, off, proto, arg);
251 1.9 itojun #endif
252 1.9 itojun default:
253 1.9 itojun return 0;
254 1.2 itojun }
255 1.2 itojun }
256 1.42 itojun #endif
257 1.2 itojun
258 1.2 itojun int
259 1.65 dyoung gif_output(struct ifnet *ifp, struct mbuf *m, const struct sockaddr *dst,
260 1.63 christos struct rtentry *rt)
261 1.2 itojun {
262 1.21 itojun struct gif_softc *sc = (struct gif_softc*)ifp;
263 1.2 itojun int error = 0;
264 1.2 itojun static int called = 0; /* XXX: MUTEX */
265 1.39 itojun ALTQ_DECL(struct altq_pktattr pktattr;)
266 1.33 itojun int s;
267 1.33 itojun
268 1.33 itojun IFQ_CLASSIFY(&ifp->if_snd, m, dst->sa_family, &pktattr);
269 1.2 itojun
270 1.2 itojun /*
271 1.2 itojun * gif may cause infinite recursion calls when misconfigured.
272 1.2 itojun * We'll prevent this by introducing upper limit.
273 1.2 itojun * XXX: this mechanism may introduce another problem about
274 1.2 itojun * mutual exclusion of the variable CALLED, especially if we
275 1.2 itojun * use kernel thread.
276 1.2 itojun */
277 1.9 itojun if (++called > max_gif_nesting) {
278 1.2 itojun log(LOG_NOTICE,
279 1.2 itojun "gif_output: recursively called too many times(%d)\n",
280 1.2 itojun called);
281 1.2 itojun m_freem(m);
282 1.2 itojun error = EIO; /* is there better errno? */
283 1.2 itojun goto end;
284 1.2 itojun }
285 1.2 itojun
286 1.2 itojun m->m_flags &= ~(M_BCAST|M_MCAST);
287 1.2 itojun if (!(ifp->if_flags & IFF_UP) ||
288 1.2 itojun sc->gif_psrc == NULL || sc->gif_pdst == NULL) {
289 1.2 itojun m_freem(m);
290 1.2 itojun error = ENETDOWN;
291 1.2 itojun goto end;
292 1.2 itojun }
293 1.2 itojun
294 1.24 itojun /* inner AF-specific encapsulation */
295 1.24 itojun switch (dst->sa_family) {
296 1.24 itojun #ifdef ISO
297 1.24 itojun case AF_ISO:
298 1.31 itojun m = gif_eon_encap(m);
299 1.31 itojun if (!m) {
300 1.31 itojun error = ENOBUFS;
301 1.24 itojun goto end;
302 1.31 itojun }
303 1.31 itojun break;
304 1.24 itojun #endif
305 1.24 itojun default:
306 1.24 itojun break;
307 1.24 itojun }
308 1.24 itojun
309 1.9 itojun /* XXX should we check if our outer source is legal? */
310 1.2 itojun
311 1.33 itojun /* use DLT_NULL encapsulation here to pass inner af type */
312 1.33 itojun M_PREPEND(m, sizeof(int), M_DONTWAIT);
313 1.33 itojun if (!m) {
314 1.33 itojun error = ENOBUFS;
315 1.33 itojun goto end;
316 1.33 itojun }
317 1.33 itojun *mtod(m, int *) = dst->sa_family;
318 1.33 itojun
319 1.33 itojun s = splnet();
320 1.33 itojun IFQ_ENQUEUE(&ifp->if_snd, m, &pktattr, error);
321 1.33 itojun if (error) {
322 1.33 itojun splx(s);
323 1.31 itojun goto end;
324 1.2 itojun }
325 1.33 itojun splx(s);
326 1.33 itojun
327 1.72 ad softint_schedule(sc->gif_si);
328 1.33 itojun error = 0;
329 1.2 itojun
330 1.2 itojun end:
331 1.2 itojun called = 0; /* reset recursion counter */
332 1.31 itojun if (error)
333 1.31 itojun ifp->if_oerrors++;
334 1.2 itojun return error;
335 1.2 itojun }
336 1.2 itojun
337 1.56 thorpej static void
338 1.56 thorpej gifintr(void *arg)
339 1.33 itojun {
340 1.33 itojun struct gif_softc *sc;
341 1.33 itojun struct ifnet *ifp;
342 1.33 itojun struct mbuf *m;
343 1.33 itojun int family;
344 1.33 itojun int len;
345 1.33 itojun int s;
346 1.33 itojun int error;
347 1.33 itojun
348 1.33 itojun sc = (struct gif_softc *)arg;
349 1.33 itojun ifp = &sc->gif_if;
350 1.33 itojun
351 1.33 itojun /* output processing */
352 1.33 itojun while (1) {
353 1.33 itojun s = splnet();
354 1.34 itojun IFQ_DEQUEUE(&sc->gif_if.if_snd, m);
355 1.33 itojun splx(s);
356 1.33 itojun if (m == NULL)
357 1.33 itojun break;
358 1.33 itojun
359 1.33 itojun /* grab and chop off inner af type */
360 1.33 itojun if (sizeof(int) > m->m_len) {
361 1.33 itojun m = m_pullup(m, sizeof(int));
362 1.33 itojun if (!m) {
363 1.33 itojun ifp->if_oerrors++;
364 1.33 itojun continue;
365 1.33 itojun }
366 1.33 itojun }
367 1.33 itojun family = *mtod(m, int *);
368 1.33 itojun #if NBPFILTER > 0
369 1.46 christos if (ifp->if_bpf)
370 1.33 itojun bpf_mtap(ifp->if_bpf, m);
371 1.33 itojun #endif
372 1.33 itojun m_adj(m, sizeof(int));
373 1.33 itojun
374 1.33 itojun len = m->m_pkthdr.len;
375 1.33 itojun
376 1.33 itojun /* dispatch to output logic based on outer AF */
377 1.33 itojun switch (sc->gif_psrc->sa_family) {
378 1.33 itojun #ifdef INET
379 1.33 itojun case AF_INET:
380 1.33 itojun error = in_gif_output(ifp, family, m);
381 1.33 itojun break;
382 1.33 itojun #endif
383 1.33 itojun #ifdef INET6
384 1.33 itojun case AF_INET6:
385 1.33 itojun error = in6_gif_output(ifp, family, m);
386 1.33 itojun break;
387 1.33 itojun #endif
388 1.33 itojun default:
389 1.50 perry m_freem(m);
390 1.33 itojun error = ENETDOWN;
391 1.33 itojun break;
392 1.33 itojun }
393 1.33 itojun
394 1.33 itojun if (error)
395 1.33 itojun ifp->if_oerrors++;
396 1.33 itojun else {
397 1.50 perry ifp->if_opackets++;
398 1.33 itojun ifp->if_obytes += len;
399 1.33 itojun }
400 1.33 itojun }
401 1.33 itojun }
402 1.33 itojun
403 1.33 itojun void
404 1.56 thorpej gif_input(struct mbuf *m, int af, struct ifnet *ifp)
405 1.2 itojun {
406 1.2 itojun int s, isr;
407 1.33 itojun struct ifqueue *ifq = NULL;
408 1.2 itojun
409 1.33 itojun if (ifp == NULL) {
410 1.2 itojun /* just in case */
411 1.2 itojun m_freem(m);
412 1.2 itojun return;
413 1.2 itojun }
414 1.2 itojun
415 1.33 itojun m->m_pkthdr.rcvif = ifp;
416 1.50 perry
417 1.2 itojun #if NBPFILTER > 0
418 1.46 christos if (ifp->if_bpf)
419 1.46 christos bpf_mtap_af(ifp->if_bpf, af, m);
420 1.2 itojun #endif /*NBPFILTER > 0*/
421 1.2 itojun
422 1.2 itojun /*
423 1.2 itojun * Put the packet to the network layer input queue according to the
424 1.2 itojun * specified address family.
425 1.2 itojun * Note: older versions of gif_input directly called network layer
426 1.31 itojun * input functions, e.g. ip6_input, here. We changed the policy to
427 1.2 itojun * prevent too many recursive calls of such input functions, which
428 1.31 itojun * might cause kernel panic. But the change may introduce another
429 1.2 itojun * problem; if the input queue is full, packets are discarded.
430 1.31 itojun * The kernel stack overflow really happened, and we believed
431 1.31 itojun * queue-full rarely occurs, so we changed the policy.
432 1.2 itojun */
433 1.2 itojun switch (af) {
434 1.2 itojun #ifdef INET
435 1.2 itojun case AF_INET:
436 1.2 itojun ifq = &ipintrq;
437 1.2 itojun isr = NETISR_IP;
438 1.2 itojun break;
439 1.2 itojun #endif
440 1.2 itojun #ifdef INET6
441 1.2 itojun case AF_INET6:
442 1.2 itojun ifq = &ip6intrq;
443 1.2 itojun isr = NETISR_IPV6;
444 1.2 itojun break;
445 1.2 itojun #endif
446 1.24 itojun #ifdef ISO
447 1.24 itojun case AF_ISO:
448 1.33 itojun m = gif_eon_decap(ifp, m);
449 1.31 itojun if (!m)
450 1.24 itojun return;
451 1.24 itojun ifq = &clnlintrq;
452 1.24 itojun isr = NETISR_ISO;
453 1.24 itojun break;
454 1.24 itojun #endif
455 1.2 itojun default:
456 1.2 itojun m_freem(m);
457 1.2 itojun return;
458 1.2 itojun }
459 1.2 itojun
460 1.27 thorpej s = splnet();
461 1.2 itojun if (IF_QFULL(ifq)) {
462 1.2 itojun IF_DROP(ifq); /* update statistics */
463 1.2 itojun m_freem(m);
464 1.2 itojun splx(s);
465 1.2 itojun return;
466 1.2 itojun }
467 1.33 itojun ifp->if_ipackets++;
468 1.33 itojun ifp->if_ibytes += m->m_pkthdr.len;
469 1.2 itojun IF_ENQUEUE(ifq, m);
470 1.2 itojun /* we need schednetisr since the address family may change */
471 1.2 itojun schednetisr(isr);
472 1.2 itojun splx(s);
473 1.2 itojun }
474 1.2 itojun
475 1.9 itojun /* XXX how should we handle IPv6 scope on SIOC[GS]IFPHYADDR? */
476 1.2 itojun int
477 1.67 christos gif_ioctl(struct ifnet *ifp, u_long cmd, void *data)
478 1.2 itojun {
479 1.60 ad struct lwp *l = curlwp; /* XXX */
480 1.2 itojun struct gif_softc *sc = (struct gif_softc*)ifp;
481 1.2 itojun struct ifreq *ifr = (struct ifreq*)data;
482 1.2 itojun int error = 0, size;
483 1.9 itojun struct sockaddr *dst, *src;
484 1.31 itojun
485 1.2 itojun switch (cmd) {
486 1.60 ad case SIOCSIFMTU:
487 1.60 ad case SIOCSLIFPHYADDR:
488 1.60 ad #ifdef SIOCDIFPHYADDR
489 1.60 ad case SIOCDIFPHYADDR:
490 1.60 ad #endif
491 1.62 elad if ((error = kauth_authorize_network(l->l_cred,
492 1.62 elad KAUTH_NETWORK_INTERFACE,
493 1.62 elad KAUTH_REQ_NETWORK_INTERFACE_SETPRIV, ifp, (void *)cmd,
494 1.62 elad NULL)) != 0)
495 1.60 ad return (error);
496 1.60 ad /* FALLTHROUGH */
497 1.60 ad default:
498 1.60 ad break;
499 1.60 ad }
500 1.60 ad
501 1.60 ad switch (cmd) {
502 1.2 itojun case SIOCSIFADDR:
503 1.32 itojun ifp->if_flags |= IFF_UP;
504 1.2 itojun break;
505 1.50 perry
506 1.2 itojun case SIOCSIFDSTADDR:
507 1.2 itojun break;
508 1.2 itojun
509 1.2 itojun case SIOCADDMULTI:
510 1.2 itojun case SIOCDELMULTI:
511 1.2 itojun switch (ifr->ifr_addr.sa_family) {
512 1.2 itojun #ifdef INET
513 1.2 itojun case AF_INET: /* IP supports Multicast */
514 1.2 itojun break;
515 1.2 itojun #endif /* INET */
516 1.2 itojun #ifdef INET6
517 1.2 itojun case AF_INET6: /* IP6 supports Multicast */
518 1.2 itojun break;
519 1.2 itojun #endif /* INET6 */
520 1.2 itojun default: /* Other protocols doesn't support Multicast */
521 1.2 itojun error = EAFNOSUPPORT;
522 1.2 itojun break;
523 1.2 itojun }
524 1.2 itojun break;
525 1.2 itojun
526 1.2 itojun case SIOCGIFMTU:
527 1.2 itojun break;
528 1.11 itojun
529 1.2 itojun case SIOCSIFMTU:
530 1.73 dyoung if (ifr->ifr_mtu < GIF_MTU_MIN || ifr->ifr_mtu > GIF_MTU_MAX)
531 1.73 dyoung return EINVAL;
532 1.73 dyoung else if ((error = ifioctl_common(ifp, cmd, data)) == ENETRESET)
533 1.73 dyoung error = 0;
534 1.2 itojun break;
535 1.2 itojun
536 1.31 itojun #ifdef INET
537 1.2 itojun case SIOCSIFPHYADDR:
538 1.31 itojun #endif
539 1.2 itojun #ifdef INET6
540 1.2 itojun case SIOCSIFPHYADDR_IN6:
541 1.2 itojun #endif /* INET6 */
542 1.25 itojun case SIOCSLIFPHYADDR:
543 1.11 itojun switch (cmd) {
544 1.15 itojun #ifdef INET
545 1.11 itojun case SIOCSIFPHYADDR:
546 1.11 itojun src = (struct sockaddr *)
547 1.11 itojun &(((struct in_aliasreq *)data)->ifra_addr);
548 1.11 itojun dst = (struct sockaddr *)
549 1.11 itojun &(((struct in_aliasreq *)data)->ifra_dstaddr);
550 1.11 itojun break;
551 1.15 itojun #endif
552 1.11 itojun #ifdef INET6
553 1.11 itojun case SIOCSIFPHYADDR_IN6:
554 1.11 itojun src = (struct sockaddr *)
555 1.11 itojun &(((struct in6_aliasreq *)data)->ifra_addr);
556 1.11 itojun dst = (struct sockaddr *)
557 1.11 itojun &(((struct in6_aliasreq *)data)->ifra_dstaddr);
558 1.25 itojun break;
559 1.25 itojun #endif
560 1.25 itojun case SIOCSLIFPHYADDR:
561 1.25 itojun src = (struct sockaddr *)
562 1.25 itojun &(((struct if_laddrreq *)data)->addr);
563 1.25 itojun dst = (struct sockaddr *)
564 1.25 itojun &(((struct if_laddrreq *)data)->dstaddr);
565 1.31 itojun break;
566 1.31 itojun default:
567 1.31 itojun return EINVAL;
568 1.25 itojun }
569 1.25 itojun
570 1.25 itojun /* sa_family must be equal */
571 1.25 itojun if (src->sa_family != dst->sa_family)
572 1.25 itojun return EINVAL;
573 1.25 itojun
574 1.25 itojun /* validate sa_len */
575 1.25 itojun switch (src->sa_family) {
576 1.25 itojun #ifdef INET
577 1.25 itojun case AF_INET:
578 1.25 itojun if (src->sa_len != sizeof(struct sockaddr_in))
579 1.16 itojun return EINVAL;
580 1.11 itojun break;
581 1.11 itojun #endif
582 1.25 itojun #ifdef INET6
583 1.25 itojun case AF_INET6:
584 1.25 itojun if (src->sa_len != sizeof(struct sockaddr_in6))
585 1.25 itojun return EINVAL;
586 1.25 itojun break;
587 1.25 itojun #endif
588 1.25 itojun default:
589 1.25 itojun return EAFNOSUPPORT;
590 1.25 itojun }
591 1.25 itojun switch (dst->sa_family) {
592 1.25 itojun #ifdef INET
593 1.25 itojun case AF_INET:
594 1.25 itojun if (dst->sa_len != sizeof(struct sockaddr_in))
595 1.25 itojun return EINVAL;
596 1.25 itojun break;
597 1.25 itojun #endif
598 1.25 itojun #ifdef INET6
599 1.25 itojun case AF_INET6:
600 1.25 itojun if (dst->sa_len != sizeof(struct sockaddr_in6))
601 1.25 itojun return EINVAL;
602 1.25 itojun break;
603 1.25 itojun #endif
604 1.25 itojun default:
605 1.25 itojun return EAFNOSUPPORT;
606 1.25 itojun }
607 1.25 itojun
608 1.25 itojun /* check sa_family looks sane for the cmd */
609 1.25 itojun switch (cmd) {
610 1.25 itojun case SIOCSIFPHYADDR:
611 1.25 itojun if (src->sa_family == AF_INET)
612 1.25 itojun break;
613 1.25 itojun return EAFNOSUPPORT;
614 1.25 itojun #ifdef INET6
615 1.25 itojun case SIOCSIFPHYADDR_IN6:
616 1.25 itojun if (src->sa_family == AF_INET6)
617 1.25 itojun break;
618 1.25 itojun return EAFNOSUPPORT;
619 1.25 itojun #endif /* INET6 */
620 1.25 itojun case SIOCSLIFPHYADDR:
621 1.25 itojun /* checks done in the above */
622 1.25 itojun break;
623 1.11 itojun }
624 1.11 itojun
625 1.31 itojun error = gif_set_tunnel(&sc->gif_if, src, dst);
626 1.9 itojun break;
627 1.9 itojun
628 1.9 itojun #ifdef SIOCDIFPHYADDR
629 1.9 itojun case SIOCDIFPHYADDR:
630 1.31 itojun gif_delete_tunnel(&sc->gif_if);
631 1.2 itojun break;
632 1.9 itojun #endif
633 1.50 perry
634 1.2 itojun case SIOCGIFPSRCADDR:
635 1.2 itojun #ifdef INET6
636 1.2 itojun case SIOCGIFPSRCADDR_IN6:
637 1.2 itojun #endif /* INET6 */
638 1.2 itojun if (sc->gif_psrc == NULL) {
639 1.2 itojun error = EADDRNOTAVAIL;
640 1.2 itojun goto bad;
641 1.2 itojun }
642 1.2 itojun src = sc->gif_psrc;
643 1.16 itojun switch (cmd) {
644 1.2 itojun #ifdef INET
645 1.16 itojun case SIOCGIFPSRCADDR:
646 1.2 itojun dst = &ifr->ifr_addr;
647 1.16 itojun size = sizeof(ifr->ifr_addr);
648 1.2 itojun break;
649 1.2 itojun #endif /* INET */
650 1.2 itojun #ifdef INET6
651 1.16 itojun case SIOCGIFPSRCADDR_IN6:
652 1.2 itojun dst = (struct sockaddr *)
653 1.2 itojun &(((struct in6_ifreq *)data)->ifr_addr);
654 1.16 itojun size = sizeof(((struct in6_ifreq *)data)->ifr_addr);
655 1.2 itojun break;
656 1.2 itojun #endif /* INET6 */
657 1.2 itojun default:
658 1.2 itojun error = EADDRNOTAVAIL;
659 1.2 itojun goto bad;
660 1.2 itojun }
661 1.16 itojun if (src->sa_len > size)
662 1.16 itojun return EINVAL;
663 1.68 dyoung memcpy(dst, src, src->sa_len);
664 1.2 itojun break;
665 1.50 perry
666 1.2 itojun case SIOCGIFPDSTADDR:
667 1.2 itojun #ifdef INET6
668 1.2 itojun case SIOCGIFPDSTADDR_IN6:
669 1.2 itojun #endif /* INET6 */
670 1.2 itojun if (sc->gif_pdst == NULL) {
671 1.2 itojun error = EADDRNOTAVAIL;
672 1.2 itojun goto bad;
673 1.2 itojun }
674 1.2 itojun src = sc->gif_pdst;
675 1.16 itojun switch (cmd) {
676 1.2 itojun #ifdef INET
677 1.16 itojun case SIOCGIFPDSTADDR:
678 1.2 itojun dst = &ifr->ifr_addr;
679 1.16 itojun size = sizeof(ifr->ifr_addr);
680 1.2 itojun break;
681 1.2 itojun #endif /* INET */
682 1.2 itojun #ifdef INET6
683 1.16 itojun case SIOCGIFPDSTADDR_IN6:
684 1.2 itojun dst = (struct sockaddr *)
685 1.2 itojun &(((struct in6_ifreq *)data)->ifr_addr);
686 1.16 itojun size = sizeof(((struct in6_ifreq *)data)->ifr_addr);
687 1.2 itojun break;
688 1.2 itojun #endif /* INET6 */
689 1.2 itojun default:
690 1.2 itojun error = EADDRNOTAVAIL;
691 1.2 itojun goto bad;
692 1.2 itojun }
693 1.25 itojun if (src->sa_len > size)
694 1.25 itojun return EINVAL;
695 1.68 dyoung memcpy(dst, src, src->sa_len);
696 1.25 itojun break;
697 1.25 itojun
698 1.25 itojun case SIOCGLIFPHYADDR:
699 1.25 itojun if (sc->gif_psrc == NULL || sc->gif_pdst == NULL) {
700 1.25 itojun error = EADDRNOTAVAIL;
701 1.25 itojun goto bad;
702 1.25 itojun }
703 1.25 itojun
704 1.25 itojun /* copy src */
705 1.25 itojun src = sc->gif_psrc;
706 1.25 itojun dst = (struct sockaddr *)
707 1.25 itojun &(((struct if_laddrreq *)data)->addr);
708 1.25 itojun size = sizeof(((struct if_laddrreq *)data)->addr);
709 1.25 itojun if (src->sa_len > size)
710 1.25 itojun return EINVAL;
711 1.68 dyoung memcpy(dst, src, src->sa_len);
712 1.25 itojun
713 1.25 itojun /* copy dst */
714 1.25 itojun src = sc->gif_pdst;
715 1.25 itojun dst = (struct sockaddr *)
716 1.25 itojun &(((struct if_laddrreq *)data)->dstaddr);
717 1.25 itojun size = sizeof(((struct if_laddrreq *)data)->dstaddr);
718 1.16 itojun if (src->sa_len > size)
719 1.16 itojun return EINVAL;
720 1.68 dyoung memcpy(dst, src, src->sa_len);
721 1.2 itojun break;
722 1.2 itojun
723 1.2 itojun case SIOCSIFFLAGS:
724 1.9 itojun /* if_ioctl() takes care of it */
725 1.2 itojun break;
726 1.2 itojun
727 1.2 itojun default:
728 1.2 itojun error = EINVAL;
729 1.2 itojun break;
730 1.2 itojun }
731 1.2 itojun bad:
732 1.2 itojun return error;
733 1.12 thorpej }
734 1.12 thorpej
735 1.31 itojun int
736 1.56 thorpej gif_set_tunnel(struct ifnet *ifp, struct sockaddr *src, struct sockaddr *dst)
737 1.31 itojun {
738 1.31 itojun struct gif_softc *sc = (struct gif_softc *)ifp;
739 1.31 itojun struct gif_softc *sc2;
740 1.71 dyoung struct sockaddr *osrc, *odst;
741 1.31 itojun int s;
742 1.31 itojun int error;
743 1.31 itojun
744 1.31 itojun s = splsoftnet();
745 1.31 itojun
746 1.68 dyoung LIST_FOREACH(sc2, &gif_softc_list, gif_list) {
747 1.31 itojun if (sc2 == sc)
748 1.31 itojun continue;
749 1.31 itojun if (!sc2->gif_pdst || !sc2->gif_psrc)
750 1.31 itojun continue;
751 1.31 itojun /* can't configure same pair of address onto two gifs */
752 1.71 dyoung if (sockaddr_cmp(sc2->gif_pdst, dst) == 0 &&
753 1.71 dyoung sockaddr_cmp(sc2->gif_psrc, src) == 0) {
754 1.31 itojun error = EADDRNOTAVAIL;
755 1.31 itojun goto bad;
756 1.31 itojun }
757 1.31 itojun
758 1.31 itojun /* XXX both end must be valid? (I mean, not 0.0.0.0) */
759 1.31 itojun }
760 1.31 itojun
761 1.58 msaitoh if (sc->gif_si) {
762 1.72 ad softint_disestablish(sc->gif_si);
763 1.58 msaitoh sc->gif_si = NULL;
764 1.58 msaitoh }
765 1.58 msaitoh
766 1.31 itojun /* XXX we can detach from both, but be polite just in case */
767 1.31 itojun if (sc->gif_psrc)
768 1.31 itojun switch (sc->gif_psrc->sa_family) {
769 1.31 itojun #ifdef INET
770 1.31 itojun case AF_INET:
771 1.31 itojun (void)in_gif_detach(sc);
772 1.31 itojun break;
773 1.31 itojun #endif
774 1.31 itojun #ifdef INET6
775 1.31 itojun case AF_INET6:
776 1.31 itojun (void)in6_gif_detach(sc);
777 1.31 itojun break;
778 1.31 itojun #endif
779 1.31 itojun }
780 1.31 itojun
781 1.72 ad sc->gif_si = softint_establish(SOFTINT_NET, gifintr, sc);
782 1.33 itojun if (sc->gif_si == NULL) {
783 1.33 itojun error = ENOMEM;
784 1.33 itojun goto bad;
785 1.33 itojun }
786 1.33 itojun
787 1.31 itojun osrc = sc->gif_psrc;
788 1.71 dyoung sc->gif_psrc = sockaddr_dup(src, M_WAITOK);
789 1.31 itojun
790 1.31 itojun odst = sc->gif_pdst;
791 1.71 dyoung sc->gif_pdst = sockaddr_dup(dst, M_WAITOK);
792 1.31 itojun
793 1.31 itojun switch (sc->gif_psrc->sa_family) {
794 1.31 itojun #ifdef INET
795 1.31 itojun case AF_INET:
796 1.31 itojun error = in_gif_attach(sc);
797 1.31 itojun break;
798 1.31 itojun #endif
799 1.31 itojun #ifdef INET6
800 1.31 itojun case AF_INET6:
801 1.31 itojun error = in6_gif_attach(sc);
802 1.31 itojun break;
803 1.31 itojun #endif
804 1.43 christos default:
805 1.44 mycroft error = EINVAL;
806 1.43 christos break;
807 1.31 itojun }
808 1.31 itojun if (error) {
809 1.31 itojun /* rollback */
810 1.71 dyoung sockaddr_free(sc->gif_psrc);
811 1.71 dyoung sockaddr_free(sc->gif_pdst);
812 1.31 itojun sc->gif_psrc = osrc;
813 1.31 itojun sc->gif_pdst = odst;
814 1.31 itojun goto bad;
815 1.31 itojun }
816 1.31 itojun
817 1.31 itojun if (osrc)
818 1.71 dyoung sockaddr_free(osrc);
819 1.31 itojun if (odst)
820 1.71 dyoung sockaddr_free(odst);
821 1.31 itojun
822 1.33 itojun if (sc->gif_psrc && sc->gif_pdst)
823 1.33 itojun ifp->if_flags |= IFF_RUNNING;
824 1.33 itojun else
825 1.33 itojun ifp->if_flags &= ~IFF_RUNNING;
826 1.33 itojun splx(s);
827 1.33 itojun
828 1.33 itojun return 0;
829 1.31 itojun
830 1.31 itojun bad:
831 1.35 itojun if (sc->gif_si) {
832 1.72 ad softint_disestablish(sc->gif_si);
833 1.35 itojun sc->gif_si = NULL;
834 1.35 itojun }
835 1.31 itojun if (sc->gif_psrc && sc->gif_pdst)
836 1.31 itojun ifp->if_flags |= IFF_RUNNING;
837 1.31 itojun else
838 1.31 itojun ifp->if_flags &= ~IFF_RUNNING;
839 1.31 itojun splx(s);
840 1.31 itojun
841 1.31 itojun return error;
842 1.31 itojun }
843 1.31 itojun
844 1.12 thorpej void
845 1.56 thorpej gif_delete_tunnel(struct ifnet *ifp)
846 1.12 thorpej {
847 1.31 itojun struct gif_softc *sc = (struct gif_softc *)ifp;
848 1.12 thorpej int s;
849 1.12 thorpej
850 1.12 thorpej s = splsoftnet();
851 1.12 thorpej
852 1.35 itojun if (sc->gif_si) {
853 1.72 ad softint_disestablish(sc->gif_si);
854 1.35 itojun sc->gif_si = NULL;
855 1.35 itojun }
856 1.12 thorpej if (sc->gif_psrc) {
857 1.71 dyoung sockaddr_free(sc->gif_psrc);
858 1.12 thorpej sc->gif_psrc = NULL;
859 1.12 thorpej }
860 1.12 thorpej if (sc->gif_pdst) {
861 1.71 dyoung sockaddr_free(sc->gif_pdst);
862 1.12 thorpej sc->gif_pdst = NULL;
863 1.12 thorpej }
864 1.31 itojun /* it is safe to detach from both */
865 1.31 itojun #ifdef INET
866 1.31 itojun (void)in_gif_detach(sc);
867 1.31 itojun #endif
868 1.31 itojun #ifdef INET6
869 1.31 itojun (void)in6_gif_detach(sc);
870 1.31 itojun #endif
871 1.12 thorpej
872 1.31 itojun if (sc->gif_psrc && sc->gif_pdst)
873 1.31 itojun ifp->if_flags |= IFF_RUNNING;
874 1.31 itojun else
875 1.31 itojun ifp->if_flags &= ~IFF_RUNNING;
876 1.12 thorpej splx(s);
877 1.2 itojun }
878 1.24 itojun
879 1.24 itojun #ifdef ISO
880 1.24 itojun struct eonhdr {
881 1.74 matt uint8_t version;
882 1.74 matt uint8_t class;
883 1.74 matt uint16_t cksum;
884 1.26 itojun };
885 1.24 itojun
886 1.24 itojun /*
887 1.24 itojun * prepend EON header to ISO PDU
888 1.24 itojun */
889 1.31 itojun static struct mbuf *
890 1.31 itojun gif_eon_encap(struct mbuf *m)
891 1.24 itojun {
892 1.24 itojun struct eonhdr *ehdr;
893 1.24 itojun
894 1.31 itojun M_PREPEND(m, sizeof(*ehdr), M_DONTWAIT);
895 1.31 itojun if (m && m->m_len < sizeof(*ehdr))
896 1.31 itojun m = m_pullup(m, sizeof(*ehdr));
897 1.31 itojun if (m == NULL)
898 1.31 itojun return NULL;
899 1.31 itojun ehdr = mtod(m, struct eonhdr *);
900 1.24 itojun ehdr->version = 1;
901 1.24 itojun ehdr->class = 0; /* always unicast */
902 1.24 itojun #if 0
903 1.24 itojun /* calculate the checksum of the eonhdr */
904 1.24 itojun {
905 1.24 itojun struct mbuf mhead;
906 1.24 itojun memset(&mhead, 0, sizeof(mhead));
907 1.24 itojun ehdr->cksum = 0;
908 1.67 christos mhead.m_data = (void *)ehdr;
909 1.24 itojun mhead.m_len = sizeof(*ehdr);
910 1.24 itojun mhead.m_next = 0;
911 1.24 itojun iso_gen_csum(&mhead, offsetof(struct eonhdr, cksum),
912 1.24 itojun mhead.m_len);
913 1.24 itojun }
914 1.24 itojun #else
915 1.24 itojun /* since the data is always constant we'll just plug the value in */
916 1.24 itojun ehdr->cksum = htons(0xfc02);
917 1.24 itojun #endif
918 1.31 itojun return m;
919 1.24 itojun }
920 1.24 itojun
921 1.24 itojun /*
922 1.24 itojun * remove EON header and check checksum
923 1.24 itojun */
924 1.31 itojun static struct mbuf *
925 1.33 itojun gif_eon_decap(struct ifnet *ifp, struct mbuf *m)
926 1.24 itojun {
927 1.24 itojun struct eonhdr *ehdr;
928 1.24 itojun
929 1.31 itojun if (m->m_len < sizeof(*ehdr) &&
930 1.31 itojun (m = m_pullup(m, sizeof(*ehdr))) == NULL) {
931 1.33 itojun ifp->if_ierrors++;
932 1.31 itojun return NULL;
933 1.24 itojun }
934 1.31 itojun if (iso_check_csum(m, sizeof(struct eonhdr))) {
935 1.31 itojun m_freem(m);
936 1.31 itojun return NULL;
937 1.31 itojun }
938 1.31 itojun m_adj(m, sizeof(*ehdr));
939 1.31 itojun return m;
940 1.24 itojun }
941 1.24 itojun #endif /*ISO*/
942