if_gif.c revision 1.28 1 1.28 itojun /* $NetBSD: if_gif.c,v 1.28 2001/06/04 23:53:13 itojun Exp $ */
2 1.28 itojun /* $KAME: if_gif.c,v 1.49 2001/06/04 12:03:41 itojun 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.2 itojun
33 1.2 itojun #include "opt_inet.h"
34 1.24 itojun #include "opt_iso.h"
35 1.2 itojun
36 1.2 itojun #include <sys/param.h>
37 1.2 itojun #include <sys/systm.h>
38 1.2 itojun #include <sys/kernel.h>
39 1.2 itojun #include <sys/mbuf.h>
40 1.2 itojun #include <sys/socket.h>
41 1.2 itojun #include <sys/sockio.h>
42 1.2 itojun #include <sys/errno.h>
43 1.2 itojun #include <sys/ioctl.h>
44 1.2 itojun #include <sys/time.h>
45 1.2 itojun #include <sys/syslog.h>
46 1.17 martin #include <sys/proc.h>
47 1.9 itojun #include <sys/protosw.h>
48 1.2 itojun #include <machine/cpu.h>
49 1.2 itojun
50 1.2 itojun #include <net/if.h>
51 1.2 itojun #include <net/if_types.h>
52 1.2 itojun #include <net/netisr.h>
53 1.2 itojun #include <net/route.h>
54 1.2 itojun #include <net/bpf.h>
55 1.2 itojun
56 1.2 itojun #include <netinet/in.h>
57 1.2 itojun #include <netinet/in_systm.h>
58 1.15 itojun #include <netinet/ip.h>
59 1.15 itojun #ifdef INET
60 1.2 itojun #include <netinet/in_var.h>
61 1.2 itojun #include <netinet/in_gif.h>
62 1.2 itojun #endif /* INET */
63 1.2 itojun
64 1.2 itojun #ifdef INET6
65 1.2 itojun #ifndef INET
66 1.2 itojun #include <netinet/in.h>
67 1.2 itojun #endif
68 1.2 itojun #include <netinet6/in6_var.h>
69 1.2 itojun #include <netinet/ip6.h>
70 1.2 itojun #include <netinet6/ip6_var.h>
71 1.2 itojun #include <netinet6/in6_gif.h>
72 1.9 itojun #include <netinet6/ip6protosw.h>
73 1.2 itojun #endif /* INET6 */
74 1.2 itojun
75 1.24 itojun #ifdef ISO
76 1.24 itojun #include <netiso/iso.h>
77 1.24 itojun #include <netiso/iso_var.h>
78 1.24 itojun #endif
79 1.24 itojun
80 1.9 itojun #include <netinet/ip_encap.h>
81 1.2 itojun #include <net/if_gif.h>
82 1.2 itojun
83 1.2 itojun #include "gif.h"
84 1.2 itojun #include "bpfilter.h"
85 1.2 itojun
86 1.4 itojun #include <net/net_osdep.h>
87 1.4 itojun
88 1.2 itojun #if NGIF > 0
89 1.2 itojun
90 1.4 itojun void gifattach __P((int));
91 1.9 itojun static int gif_encapcheck __P((const struct mbuf *, int, int, void *));
92 1.9 itojun #ifdef INET
93 1.9 itojun extern struct protosw in_gif_protosw;
94 1.9 itojun #endif
95 1.9 itojun #ifdef INET6
96 1.9 itojun extern struct ip6protosw in6_gif_protosw;
97 1.9 itojun #endif
98 1.24 itojun #ifdef ISO
99 1.24 itojun static int gif_eon_encap(struct mbuf **);
100 1.24 itojun static int gif_eon_decap(struct ifnet *, struct mbuf **);
101 1.24 itojun #endif
102 1.2 itojun
103 1.2 itojun /*
104 1.2 itojun * gif global variable definitions
105 1.2 itojun */
106 1.12 thorpej LIST_HEAD(, gif_softc) gif_softc_list;
107 1.12 thorpej
108 1.12 thorpej int gif_clone_create __P((struct if_clone *, int));
109 1.12 thorpej void gif_clone_destroy __P((struct ifnet *));
110 1.12 thorpej
111 1.12 thorpej struct if_clone gif_cloner =
112 1.12 thorpej IF_CLONE_INITIALIZER("gif", gif_clone_create, gif_clone_destroy);
113 1.12 thorpej
114 1.12 thorpej void gif_delete_tunnel __P((struct gif_softc *));
115 1.9 itojun
116 1.9 itojun #ifndef MAX_GIF_NEST
117 1.9 itojun /*
118 1.9 itojun * This macro controls the upper limitation on nesting of gif tunnels.
119 1.9 itojun * Since, setting a large value to this macro with a careless configuration
120 1.9 itojun * may introduce system crash, we don't allow any nestings by default.
121 1.9 itojun * If you need to configure nested gif tunnels, you can define this macro
122 1.9 itojun * in your kernel configuration file. However, if you do so, please be
123 1.9 itojun * careful to configure the tunnels so that it won't make a loop.
124 1.9 itojun */
125 1.9 itojun #define MAX_GIF_NEST 1
126 1.9 itojun #endif
127 1.9 itojun static int max_gif_nesting = MAX_GIF_NEST;
128 1.2 itojun
129 1.12 thorpej /* ARGSUSED */
130 1.2 itojun void
131 1.12 thorpej gifattach(count)
132 1.12 thorpej int count;
133 1.12 thorpej {
134 1.12 thorpej
135 1.12 thorpej LIST_INIT(&gif_softc_list);
136 1.12 thorpej if_clone_attach(&gif_cloner);
137 1.12 thorpej }
138 1.12 thorpej
139 1.12 thorpej int
140 1.12 thorpej gif_clone_create(ifc, unit)
141 1.12 thorpej struct if_clone *ifc;
142 1.12 thorpej int unit;
143 1.2 itojun {
144 1.12 thorpej struct gif_softc *sc;
145 1.12 thorpej
146 1.12 thorpej sc = malloc(sizeof(struct gif_softc), M_DEVBUF, M_WAIT);
147 1.12 thorpej bzero(sc, sizeof(struct gif_softc));
148 1.2 itojun
149 1.12 thorpej sprintf(sc->gif_if.if_xname, "%s%d", ifc->ifc_name, unit);
150 1.9 itojun
151 1.12 thorpej sc->encap_cookie4 = sc->encap_cookie6 = NULL;
152 1.9 itojun #ifdef INET
153 1.12 thorpej sc->encap_cookie4 = encap_attach_func(AF_INET, -1,
154 1.12 thorpej gif_encapcheck, &in_gif_protosw, sc);
155 1.12 thorpej if (sc->encap_cookie4 == NULL) {
156 1.12 thorpej printf("%s: unable to attach encap4\n", if_name(&sc->gif_if));
157 1.13 thorpej free(sc, M_DEVBUF);
158 1.12 thorpej return (EIO); /* XXX */
159 1.12 thorpej }
160 1.9 itojun #endif
161 1.9 itojun #ifdef INET6
162 1.12 thorpej sc->encap_cookie6 = encap_attach_func(AF_INET6, -1,
163 1.12 thorpej gif_encapcheck, (struct protosw *)&in6_gif_protosw, sc);
164 1.12 thorpej if (sc->encap_cookie6 == NULL) {
165 1.12 thorpej if (sc->encap_cookie4) {
166 1.12 thorpej encap_detach(sc->encap_cookie4);
167 1.12 thorpej sc->encap_cookie4 = NULL;
168 1.9 itojun }
169 1.12 thorpej printf("%s: unable to attach encap6\n", if_name(&sc->gif_if));
170 1.13 thorpej free(sc, M_DEVBUF);
171 1.12 thorpej return (EIO); /* XXX */
172 1.12 thorpej }
173 1.9 itojun #endif
174 1.9 itojun
175 1.12 thorpej sc->gif_if.if_mtu = GIF_MTU;
176 1.12 thorpej sc->gif_if.if_flags = IFF_POINTOPOINT | IFF_MULTICAST;
177 1.12 thorpej sc->gif_if.if_ioctl = gif_ioctl;
178 1.12 thorpej sc->gif_if.if_output = gif_output;
179 1.12 thorpej sc->gif_if.if_type = IFT_GIF;
180 1.19 thorpej sc->gif_if.if_dlt = DLT_NULL;
181 1.12 thorpej if_attach(&sc->gif_if);
182 1.20 thorpej if_alloc_sadl(&sc->gif_if);
183 1.2 itojun #if NBPFILTER > 0
184 1.12 thorpej bpfattach(&sc->gif_if, DLT_NULL, sizeof(u_int));
185 1.9 itojun #endif
186 1.12 thorpej LIST_INSERT_HEAD(&gif_softc_list, sc, gif_list);
187 1.12 thorpej return (0);
188 1.12 thorpej }
189 1.12 thorpej
190 1.12 thorpej void
191 1.12 thorpej gif_clone_destroy(ifp)
192 1.12 thorpej struct ifnet *ifp;
193 1.12 thorpej {
194 1.12 thorpej struct gif_softc *sc = (void *) ifp;
195 1.12 thorpej
196 1.12 thorpej gif_delete_tunnel(sc);
197 1.12 thorpej LIST_REMOVE(sc, gif_list);
198 1.12 thorpej #ifdef INET6
199 1.12 thorpej encap_detach(sc->encap_cookie6);
200 1.12 thorpej #endif
201 1.12 thorpej #ifdef INET
202 1.12 thorpej encap_detach(sc->encap_cookie4);
203 1.12 thorpej #endif
204 1.12 thorpej
205 1.12 thorpej #if NBPFILTER > 0
206 1.12 thorpej bpfdetach(ifp);
207 1.12 thorpej #endif
208 1.12 thorpej if_detach(ifp);
209 1.12 thorpej
210 1.12 thorpej free(sc, M_DEVBUF);
211 1.9 itojun }
212 1.9 itojun
213 1.9 itojun static int
214 1.9 itojun gif_encapcheck(m, off, proto, arg)
215 1.9 itojun const struct mbuf *m;
216 1.9 itojun int off;
217 1.9 itojun int proto;
218 1.9 itojun void *arg;
219 1.9 itojun {
220 1.9 itojun struct ip ip;
221 1.9 itojun struct gif_softc *sc;
222 1.9 itojun
223 1.9 itojun sc = (struct gif_softc *)arg;
224 1.9 itojun if (sc == NULL)
225 1.9 itojun return 0;
226 1.9 itojun
227 1.9 itojun if ((sc->gif_if.if_flags & IFF_UP) == 0)
228 1.9 itojun return 0;
229 1.9 itojun
230 1.9 itojun /* no physical address */
231 1.9 itojun if (!sc->gif_psrc || !sc->gif_pdst)
232 1.9 itojun return 0;
233 1.9 itojun
234 1.9 itojun switch (proto) {
235 1.9 itojun #ifdef INET
236 1.9 itojun case IPPROTO_IPV4:
237 1.9 itojun break;
238 1.9 itojun #endif
239 1.9 itojun #ifdef INET6
240 1.9 itojun case IPPROTO_IPV6:
241 1.9 itojun break;
242 1.9 itojun #endif
243 1.24 itojun #ifdef ISO
244 1.24 itojun case IPPROTO_EON:
245 1.24 itojun break;
246 1.24 itojun #endif
247 1.9 itojun default:
248 1.9 itojun return 0;
249 1.9 itojun }
250 1.9 itojun
251 1.9 itojun /* LINTED const cast */
252 1.9 itojun m_copydata((struct mbuf *)m, 0, sizeof(ip), (caddr_t)&ip);
253 1.9 itojun
254 1.9 itojun switch (ip.ip_v) {
255 1.9 itojun #ifdef INET
256 1.9 itojun case 4:
257 1.9 itojun if (sc->gif_psrc->sa_family != AF_INET ||
258 1.9 itojun sc->gif_pdst->sa_family != AF_INET)
259 1.9 itojun return 0;
260 1.9 itojun return gif_encapcheck4(m, off, proto, arg);
261 1.9 itojun #endif
262 1.9 itojun #ifdef INET6
263 1.9 itojun case 6:
264 1.9 itojun if (sc->gif_psrc->sa_family != AF_INET6 ||
265 1.9 itojun sc->gif_pdst->sa_family != AF_INET6)
266 1.9 itojun return 0;
267 1.9 itojun return gif_encapcheck6(m, off, proto, arg);
268 1.9 itojun #endif
269 1.9 itojun default:
270 1.9 itojun return 0;
271 1.2 itojun }
272 1.2 itojun }
273 1.2 itojun
274 1.2 itojun int
275 1.2 itojun gif_output(ifp, m, dst, rt)
276 1.2 itojun struct ifnet *ifp;
277 1.2 itojun struct mbuf *m;
278 1.2 itojun struct sockaddr *dst;
279 1.2 itojun struct rtentry *rt; /* added in net2 */
280 1.2 itojun {
281 1.21 itojun struct gif_softc *sc = (struct gif_softc*)ifp;
282 1.2 itojun int error = 0;
283 1.2 itojun static int called = 0; /* XXX: MUTEX */
284 1.2 itojun
285 1.2 itojun /*
286 1.2 itojun * gif may cause infinite recursion calls when misconfigured.
287 1.2 itojun * We'll prevent this by introducing upper limit.
288 1.2 itojun * XXX: this mechanism may introduce another problem about
289 1.2 itojun * mutual exclusion of the variable CALLED, especially if we
290 1.2 itojun * use kernel thread.
291 1.2 itojun */
292 1.9 itojun if (++called > max_gif_nesting) {
293 1.2 itojun log(LOG_NOTICE,
294 1.2 itojun "gif_output: recursively called too many times(%d)\n",
295 1.2 itojun called);
296 1.2 itojun m_freem(m);
297 1.2 itojun error = EIO; /* is there better errno? */
298 1.2 itojun goto end;
299 1.2 itojun }
300 1.2 itojun
301 1.2 itojun ifp->if_lastchange = time;
302 1.2 itojun m->m_flags &= ~(M_BCAST|M_MCAST);
303 1.2 itojun if (!(ifp->if_flags & IFF_UP) ||
304 1.2 itojun sc->gif_psrc == NULL || sc->gif_pdst == NULL) {
305 1.2 itojun m_freem(m);
306 1.2 itojun error = ENETDOWN;
307 1.2 itojun goto end;
308 1.2 itojun }
309 1.2 itojun
310 1.2 itojun #if NBPFILTER > 0
311 1.2 itojun if (ifp->if_bpf) {
312 1.2 itojun /*
313 1.2 itojun * We need to prepend the address family as
314 1.2 itojun * a four byte field. Cons up a dummy header
315 1.2 itojun * to pacify bpf. This is safe because bpf
316 1.2 itojun * will only read from the mbuf (i.e., it won't
317 1.2 itojun * try to free it or keep a pointer a to it).
318 1.2 itojun */
319 1.2 itojun struct mbuf m0;
320 1.23 itojun u_int32_t af = dst->sa_family;
321 1.2 itojun
322 1.2 itojun m0.m_next = m;
323 1.2 itojun m0.m_len = 4;
324 1.2 itojun m0.m_data = (char *)⁡
325 1.2 itojun
326 1.9 itojun #ifdef HAVE_OLD_BPF
327 1.9 itojun bpf_mtap(ifp, &m0);
328 1.9 itojun #else
329 1.2 itojun bpf_mtap(ifp->if_bpf, &m0);
330 1.9 itojun #endif
331 1.2 itojun }
332 1.2 itojun #endif
333 1.2 itojun ifp->if_opackets++;
334 1.2 itojun ifp->if_obytes += m->m_pkthdr.len;
335 1.9 itojun
336 1.24 itojun /* inner AF-specific encapsulation */
337 1.24 itojun switch (dst->sa_family) {
338 1.24 itojun #ifdef ISO
339 1.24 itojun case AF_ISO:
340 1.24 itojun error = gif_eon_encap(&m);
341 1.24 itojun if (error)
342 1.24 itojun goto end;
343 1.24 itojun #endif
344 1.24 itojun default:
345 1.24 itojun break;
346 1.24 itojun }
347 1.24 itojun
348 1.9 itojun /* XXX should we check if our outer source is legal? */
349 1.2 itojun
350 1.24 itojun /* dispatch to output logic based on outer AF */
351 1.2 itojun switch (sc->gif_psrc->sa_family) {
352 1.2 itojun #ifdef INET
353 1.2 itojun case AF_INET:
354 1.2 itojun error = in_gif_output(ifp, dst->sa_family, m, rt);
355 1.2 itojun break;
356 1.2 itojun #endif
357 1.2 itojun #ifdef INET6
358 1.2 itojun case AF_INET6:
359 1.2 itojun error = in6_gif_output(ifp, dst->sa_family, m, rt);
360 1.2 itojun break;
361 1.2 itojun #endif
362 1.2 itojun default:
363 1.2 itojun m_freem(m);
364 1.2 itojun error = ENETDOWN;
365 1.2 itojun }
366 1.2 itojun
367 1.2 itojun end:
368 1.2 itojun called = 0; /* reset recursion counter */
369 1.2 itojun if (error) ifp->if_oerrors++;
370 1.2 itojun return error;
371 1.2 itojun }
372 1.2 itojun
373 1.2 itojun void
374 1.2 itojun gif_input(m, af, gifp)
375 1.2 itojun struct mbuf *m;
376 1.2 itojun int af;
377 1.2 itojun struct ifnet *gifp;
378 1.2 itojun {
379 1.2 itojun int s, isr;
380 1.21 itojun struct ifqueue *ifq = 0;
381 1.2 itojun
382 1.2 itojun if (gifp == NULL) {
383 1.2 itojun /* just in case */
384 1.2 itojun m_freem(m);
385 1.2 itojun return;
386 1.2 itojun }
387 1.2 itojun
388 1.10 itojun m->m_pkthdr.rcvif = gifp;
389 1.2 itojun
390 1.2 itojun #if NBPFILTER > 0
391 1.2 itojun if (gifp->if_bpf) {
392 1.2 itojun /*
393 1.2 itojun * We need to prepend the address family as
394 1.2 itojun * a four byte field. Cons up a dummy header
395 1.2 itojun * to pacify bpf. This is safe because bpf
396 1.2 itojun * will only read from the mbuf (i.e., it won't
397 1.2 itojun * try to free it or keep a pointer a to it).
398 1.2 itojun */
399 1.2 itojun struct mbuf m0;
400 1.22 itojun u_int32_t af1 = af;
401 1.2 itojun
402 1.2 itojun m0.m_next = m;
403 1.2 itojun m0.m_len = 4;
404 1.22 itojun m0.m_data = (char *)&af1;
405 1.2 itojun
406 1.9 itojun #ifdef HAVE_OLD_BPF
407 1.9 itojun bpf_mtap(gifp, &m0);
408 1.9 itojun #else
409 1.2 itojun bpf_mtap(gifp->if_bpf, &m0);
410 1.9 itojun #endif
411 1.2 itojun }
412 1.2 itojun #endif /*NBPFILTER > 0*/
413 1.2 itojun
414 1.2 itojun /*
415 1.2 itojun * Put the packet to the network layer input queue according to the
416 1.2 itojun * specified address family.
417 1.2 itojun * Note: older versions of gif_input directly called network layer
418 1.2 itojun * input functions, e.g. ip6_input, here. We changed the policy to
419 1.2 itojun * prevent too many recursive calls of such input functions, which
420 1.2 itojun * might cause kernel panic. But the change may introduce another
421 1.2 itojun * problem; if the input queue is full, packets are discarded.
422 1.2 itojun * We believed it rarely occurs and changed the policy. If we find
423 1.2 itojun * it occurs more times than we thought, we may change the policy
424 1.2 itojun * again.
425 1.2 itojun */
426 1.2 itojun switch (af) {
427 1.2 itojun #ifdef INET
428 1.2 itojun case AF_INET:
429 1.2 itojun ifq = &ipintrq;
430 1.2 itojun isr = NETISR_IP;
431 1.2 itojun break;
432 1.2 itojun #endif
433 1.2 itojun #ifdef INET6
434 1.2 itojun case AF_INET6:
435 1.2 itojun ifq = &ip6intrq;
436 1.2 itojun isr = NETISR_IPV6;
437 1.2 itojun break;
438 1.2 itojun #endif
439 1.24 itojun #ifdef ISO
440 1.24 itojun case AF_ISO:
441 1.24 itojun if (gif_eon_decap(gifp, &m)) {
442 1.24 itojun if (m)
443 1.24 itojun m_freem(m);
444 1.24 itojun return;
445 1.24 itojun }
446 1.24 itojun ifq = &clnlintrq;
447 1.24 itojun isr = NETISR_ISO;
448 1.24 itojun break;
449 1.24 itojun #endif
450 1.2 itojun default:
451 1.2 itojun m_freem(m);
452 1.2 itojun return;
453 1.2 itojun }
454 1.2 itojun
455 1.27 thorpej s = splnet();
456 1.2 itojun if (IF_QFULL(ifq)) {
457 1.2 itojun IF_DROP(ifq); /* update statistics */
458 1.2 itojun m_freem(m);
459 1.2 itojun splx(s);
460 1.2 itojun return;
461 1.2 itojun }
462 1.2 itojun IF_ENQUEUE(ifq, m);
463 1.2 itojun /* we need schednetisr since the address family may change */
464 1.2 itojun schednetisr(isr);
465 1.2 itojun gifp->if_ipackets++;
466 1.2 itojun gifp->if_ibytes += m->m_pkthdr.len;
467 1.2 itojun splx(s);
468 1.2 itojun
469 1.2 itojun return;
470 1.2 itojun }
471 1.2 itojun
472 1.9 itojun /* XXX how should we handle IPv6 scope on SIOC[GS]IFPHYADDR? */
473 1.2 itojun int
474 1.2 itojun gif_ioctl(ifp, cmd, data)
475 1.2 itojun struct ifnet *ifp;
476 1.2 itojun u_long cmd;
477 1.2 itojun caddr_t data;
478 1.2 itojun {
479 1.17 martin struct proc *p = curproc; /* 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.9 itojun struct sockaddr *sa;
485 1.28 itojun int s;
486 1.9 itojun struct gif_softc *sc2;
487 1.2 itojun
488 1.2 itojun switch (cmd) {
489 1.2 itojun case SIOCSIFADDR:
490 1.2 itojun break;
491 1.2 itojun
492 1.2 itojun case SIOCSIFDSTADDR:
493 1.2 itojun break;
494 1.2 itojun
495 1.2 itojun case SIOCADDMULTI:
496 1.2 itojun case SIOCDELMULTI:
497 1.17 martin if ((error = suser(p->p_ucred, &p->p_acflag)) != 0)
498 1.17 martin break;
499 1.2 itojun switch (ifr->ifr_addr.sa_family) {
500 1.2 itojun #ifdef INET
501 1.2 itojun case AF_INET: /* IP supports Multicast */
502 1.2 itojun break;
503 1.2 itojun #endif /* INET */
504 1.2 itojun #ifdef INET6
505 1.2 itojun case AF_INET6: /* IP6 supports Multicast */
506 1.2 itojun break;
507 1.2 itojun #endif /* INET6 */
508 1.2 itojun default: /* Other protocols doesn't support Multicast */
509 1.2 itojun error = EAFNOSUPPORT;
510 1.2 itojun break;
511 1.2 itojun }
512 1.2 itojun break;
513 1.2 itojun
514 1.2 itojun #ifdef SIOCSIFMTU /* xxx */
515 1.2 itojun case SIOCGIFMTU:
516 1.2 itojun break;
517 1.11 itojun
518 1.2 itojun case SIOCSIFMTU:
519 1.2 itojun {
520 1.2 itojun u_long mtu;
521 1.17 martin if ((error = suser(p->p_ucred, &p->p_acflag)) != 0)
522 1.17 martin break;
523 1.2 itojun mtu = ifr->ifr_mtu;
524 1.2 itojun if (mtu < GIF_MTU_MIN || mtu > GIF_MTU_MAX) {
525 1.2 itojun return (EINVAL);
526 1.2 itojun }
527 1.2 itojun ifp->if_mtu = mtu;
528 1.2 itojun }
529 1.2 itojun break;
530 1.2 itojun #endif /* SIOCSIFMTU */
531 1.2 itojun
532 1.2 itojun case SIOCSIFPHYADDR:
533 1.2 itojun #ifdef INET6
534 1.2 itojun case SIOCSIFPHYADDR_IN6:
535 1.2 itojun #endif /* INET6 */
536 1.25 itojun case SIOCSLIFPHYADDR:
537 1.17 martin if ((error = suser(p->p_ucred, &p->p_acflag)) != 0)
538 1.17 martin break;
539 1.11 itojun switch (cmd) {
540 1.15 itojun #ifdef INET
541 1.11 itojun case SIOCSIFPHYADDR:
542 1.11 itojun src = (struct sockaddr *)
543 1.11 itojun &(((struct in_aliasreq *)data)->ifra_addr);
544 1.11 itojun dst = (struct sockaddr *)
545 1.11 itojun &(((struct in_aliasreq *)data)->ifra_dstaddr);
546 1.11 itojun break;
547 1.15 itojun #endif
548 1.11 itojun #ifdef INET6
549 1.11 itojun case SIOCSIFPHYADDR_IN6:
550 1.11 itojun src = (struct sockaddr *)
551 1.11 itojun &(((struct in6_aliasreq *)data)->ifra_addr);
552 1.11 itojun dst = (struct sockaddr *)
553 1.11 itojun &(((struct in6_aliasreq *)data)->ifra_dstaddr);
554 1.25 itojun break;
555 1.25 itojun #endif
556 1.25 itojun case SIOCSLIFPHYADDR:
557 1.25 itojun src = (struct sockaddr *)
558 1.25 itojun &(((struct if_laddrreq *)data)->addr);
559 1.25 itojun dst = (struct sockaddr *)
560 1.25 itojun &(((struct if_laddrreq *)data)->dstaddr);
561 1.25 itojun }
562 1.25 itojun
563 1.25 itojun /* sa_family must be equal */
564 1.25 itojun if (src->sa_family != dst->sa_family)
565 1.25 itojun return EINVAL;
566 1.25 itojun
567 1.25 itojun /* validate sa_len */
568 1.25 itojun switch (src->sa_family) {
569 1.25 itojun #ifdef INET
570 1.25 itojun case AF_INET:
571 1.25 itojun if (src->sa_len != sizeof(struct sockaddr_in))
572 1.16 itojun return EINVAL;
573 1.11 itojun break;
574 1.11 itojun #endif
575 1.25 itojun #ifdef INET6
576 1.25 itojun case AF_INET6:
577 1.25 itojun if (src->sa_len != sizeof(struct sockaddr_in6))
578 1.25 itojun return EINVAL;
579 1.25 itojun break;
580 1.25 itojun #endif
581 1.25 itojun default:
582 1.25 itojun return EAFNOSUPPORT;
583 1.25 itojun }
584 1.25 itojun switch (dst->sa_family) {
585 1.25 itojun #ifdef INET
586 1.25 itojun case AF_INET:
587 1.25 itojun if (dst->sa_len != sizeof(struct sockaddr_in))
588 1.25 itojun return EINVAL;
589 1.25 itojun break;
590 1.25 itojun #endif
591 1.25 itojun #ifdef INET6
592 1.25 itojun case AF_INET6:
593 1.25 itojun if (dst->sa_len != sizeof(struct sockaddr_in6))
594 1.25 itojun return EINVAL;
595 1.25 itojun break;
596 1.25 itojun #endif
597 1.25 itojun default:
598 1.25 itojun return EAFNOSUPPORT;
599 1.25 itojun }
600 1.25 itojun
601 1.25 itojun /* check sa_family looks sane for the cmd */
602 1.25 itojun switch (cmd) {
603 1.25 itojun case SIOCSIFPHYADDR:
604 1.25 itojun if (src->sa_family == AF_INET)
605 1.25 itojun break;
606 1.25 itojun return EAFNOSUPPORT;
607 1.25 itojun #ifdef INET6
608 1.25 itojun case SIOCSIFPHYADDR_IN6:
609 1.25 itojun if (src->sa_family == AF_INET6)
610 1.25 itojun break;
611 1.25 itojun return EAFNOSUPPORT;
612 1.25 itojun #endif /* INET6 */
613 1.25 itojun case SIOCSLIFPHYADDR:
614 1.25 itojun /* checks done in the above */
615 1.25 itojun break;
616 1.11 itojun }
617 1.11 itojun
618 1.12 thorpej for (sc2 = LIST_FIRST(&gif_softc_list); sc2 != NULL;
619 1.12 thorpej sc2 = LIST_NEXT(sc2, gif_list)) {
620 1.9 itojun if (sc2 == sc)
621 1.9 itojun continue;
622 1.9 itojun if (!sc2->gif_pdst || !sc2->gif_psrc)
623 1.9 itojun continue;
624 1.10 itojun if (sc2->gif_pdst->sa_family != dst->sa_family ||
625 1.10 itojun sc2->gif_pdst->sa_len != dst->sa_len ||
626 1.10 itojun sc2->gif_psrc->sa_family != src->sa_family ||
627 1.10 itojun sc2->gif_psrc->sa_len != src->sa_len)
628 1.10 itojun continue;
629 1.10 itojun
630 1.10 itojun /* can't configure same pair of address onto two gifs */
631 1.10 itojun if (bcmp(sc2->gif_pdst, dst, dst->sa_len) == 0 &&
632 1.9 itojun bcmp(sc2->gif_psrc, src, src->sa_len) == 0) {
633 1.9 itojun error = EADDRNOTAVAIL;
634 1.9 itojun goto bad;
635 1.9 itojun }
636 1.10 itojun
637 1.10 itojun /* can't configure multiple multi-dest interfaces */
638 1.10 itojun #define multidest(x) \
639 1.10 itojun (((struct sockaddr_in *)(x))->sin_addr.s_addr == INADDR_ANY)
640 1.10 itojun #ifdef INET6
641 1.10 itojun #define multidest6(x) \
642 1.10 itojun (IN6_IS_ADDR_UNSPECIFIED(&((struct sockaddr_in6 *)(x))->sin6_addr))
643 1.10 itojun #endif
644 1.10 itojun if (dst->sa_family == AF_INET &&
645 1.10 itojun multidest(dst) && multidest(sc2->gif_pdst)) {
646 1.10 itojun error = EADDRNOTAVAIL;
647 1.10 itojun goto bad;
648 1.10 itojun }
649 1.10 itojun #ifdef INET6
650 1.10 itojun if (dst->sa_family == AF_INET6 &&
651 1.10 itojun multidest6(dst) && multidest6(sc2->gif_pdst)) {
652 1.10 itojun error = EADDRNOTAVAIL;
653 1.10 itojun goto bad;
654 1.10 itojun }
655 1.10 itojun #endif
656 1.9 itojun }
657 1.9 itojun
658 1.9 itojun if (sc->gif_psrc)
659 1.2 itojun free((caddr_t)sc->gif_psrc, M_IFADDR);
660 1.25 itojun sa = (struct sockaddr *)malloc(src->sa_len, M_IFADDR, M_WAITOK);
661 1.25 itojun bcopy((caddr_t)src, (caddr_t)sa, src->sa_len);
662 1.2 itojun sc->gif_psrc = sa;
663 1.9 itojun
664 1.9 itojun if (sc->gif_pdst)
665 1.9 itojun free((caddr_t)sc->gif_pdst, M_IFADDR);
666 1.25 itojun sa = (struct sockaddr *)malloc(dst->sa_len, M_IFADDR, M_WAITOK);
667 1.25 itojun bcopy((caddr_t)dst, (caddr_t)sa, dst->sa_len);
668 1.2 itojun sc->gif_pdst = sa;
669 1.9 itojun
670 1.28 itojun s = splsoftnet();
671 1.28 itojun ifp->if_flags |= IFF_RUNNING;
672 1.2 itojun if_up(ifp); /* send up RTM_IFINFO */
673 1.28 itojun splx(s);
674 1.2 itojun
675 1.9 itojun error = 0;
676 1.9 itojun break;
677 1.9 itojun
678 1.9 itojun #ifdef SIOCDIFPHYADDR
679 1.9 itojun case SIOCDIFPHYADDR:
680 1.17 martin if ((error = suser(p->p_ucred, &p->p_acflag)) != 0)
681 1.17 martin break;
682 1.12 thorpej gif_delete_tunnel(sc);
683 1.2 itojun break;
684 1.9 itojun #endif
685 1.2 itojun
686 1.2 itojun case SIOCGIFPSRCADDR:
687 1.2 itojun #ifdef INET6
688 1.2 itojun case SIOCGIFPSRCADDR_IN6:
689 1.2 itojun #endif /* INET6 */
690 1.2 itojun if (sc->gif_psrc == NULL) {
691 1.2 itojun error = EADDRNOTAVAIL;
692 1.2 itojun goto bad;
693 1.2 itojun }
694 1.2 itojun src = sc->gif_psrc;
695 1.16 itojun switch (cmd) {
696 1.2 itojun #ifdef INET
697 1.16 itojun case SIOCGIFPSRCADDR:
698 1.2 itojun dst = &ifr->ifr_addr;
699 1.16 itojun size = sizeof(ifr->ifr_addr);
700 1.2 itojun break;
701 1.2 itojun #endif /* INET */
702 1.2 itojun #ifdef INET6
703 1.16 itojun case SIOCGIFPSRCADDR_IN6:
704 1.2 itojun dst = (struct sockaddr *)
705 1.2 itojun &(((struct in6_ifreq *)data)->ifr_addr);
706 1.16 itojun size = sizeof(((struct in6_ifreq *)data)->ifr_addr);
707 1.2 itojun break;
708 1.2 itojun #endif /* INET6 */
709 1.2 itojun default:
710 1.2 itojun error = EADDRNOTAVAIL;
711 1.2 itojun goto bad;
712 1.2 itojun }
713 1.16 itojun if (src->sa_len > size)
714 1.16 itojun return EINVAL;
715 1.16 itojun bcopy((caddr_t)src, (caddr_t)dst, src->sa_len);
716 1.2 itojun break;
717 1.2 itojun
718 1.2 itojun case SIOCGIFPDSTADDR:
719 1.2 itojun #ifdef INET6
720 1.2 itojun case SIOCGIFPDSTADDR_IN6:
721 1.2 itojun #endif /* INET6 */
722 1.2 itojun if (sc->gif_pdst == NULL) {
723 1.2 itojun error = EADDRNOTAVAIL;
724 1.2 itojun goto bad;
725 1.2 itojun }
726 1.2 itojun src = sc->gif_pdst;
727 1.16 itojun switch (cmd) {
728 1.2 itojun #ifdef INET
729 1.16 itojun case SIOCGIFPDSTADDR:
730 1.2 itojun dst = &ifr->ifr_addr;
731 1.16 itojun size = sizeof(ifr->ifr_addr);
732 1.2 itojun break;
733 1.2 itojun #endif /* INET */
734 1.2 itojun #ifdef INET6
735 1.16 itojun case SIOCGIFPDSTADDR_IN6:
736 1.2 itojun dst = (struct sockaddr *)
737 1.2 itojun &(((struct in6_ifreq *)data)->ifr_addr);
738 1.16 itojun size = sizeof(((struct in6_ifreq *)data)->ifr_addr);
739 1.2 itojun break;
740 1.2 itojun #endif /* INET6 */
741 1.2 itojun default:
742 1.2 itojun error = EADDRNOTAVAIL;
743 1.2 itojun goto bad;
744 1.2 itojun }
745 1.25 itojun if (src->sa_len > size)
746 1.25 itojun return EINVAL;
747 1.25 itojun bcopy((caddr_t)src, (caddr_t)dst, src->sa_len);
748 1.25 itojun break;
749 1.25 itojun
750 1.25 itojun case SIOCGLIFPHYADDR:
751 1.25 itojun if (sc->gif_psrc == NULL || sc->gif_pdst == NULL) {
752 1.25 itojun error = EADDRNOTAVAIL;
753 1.25 itojun goto bad;
754 1.25 itojun }
755 1.25 itojun
756 1.25 itojun /* copy src */
757 1.25 itojun src = sc->gif_psrc;
758 1.25 itojun dst = (struct sockaddr *)
759 1.25 itojun &(((struct if_laddrreq *)data)->addr);
760 1.25 itojun size = sizeof(((struct if_laddrreq *)data)->addr);
761 1.25 itojun if (src->sa_len > size)
762 1.25 itojun return EINVAL;
763 1.25 itojun bcopy((caddr_t)src, (caddr_t)dst, src->sa_len);
764 1.25 itojun
765 1.25 itojun /* copy dst */
766 1.25 itojun src = sc->gif_pdst;
767 1.25 itojun dst = (struct sockaddr *)
768 1.25 itojun &(((struct if_laddrreq *)data)->dstaddr);
769 1.25 itojun size = sizeof(((struct if_laddrreq *)data)->dstaddr);
770 1.16 itojun if (src->sa_len > size)
771 1.16 itojun return EINVAL;
772 1.16 itojun bcopy((caddr_t)src, (caddr_t)dst, src->sa_len);
773 1.2 itojun break;
774 1.2 itojun
775 1.2 itojun case SIOCSIFFLAGS:
776 1.9 itojun /* if_ioctl() takes care of it */
777 1.2 itojun break;
778 1.2 itojun
779 1.2 itojun default:
780 1.2 itojun error = EINVAL;
781 1.2 itojun break;
782 1.2 itojun }
783 1.2 itojun bad:
784 1.2 itojun return error;
785 1.12 thorpej }
786 1.12 thorpej
787 1.12 thorpej void
788 1.12 thorpej gif_delete_tunnel(sc)
789 1.12 thorpej struct gif_softc *sc;
790 1.12 thorpej {
791 1.12 thorpej int s;
792 1.12 thorpej
793 1.12 thorpej s = splsoftnet();
794 1.12 thorpej
795 1.12 thorpej if (sc->gif_psrc) {
796 1.12 thorpej free((caddr_t)sc->gif_psrc, M_IFADDR);
797 1.12 thorpej sc->gif_psrc = NULL;
798 1.12 thorpej }
799 1.12 thorpej if (sc->gif_pdst) {
800 1.12 thorpej free((caddr_t)sc->gif_pdst, M_IFADDR);
801 1.12 thorpej sc->gif_pdst = NULL;
802 1.12 thorpej }
803 1.12 thorpej /* change the IFF_UP flag as well? */
804 1.12 thorpej
805 1.12 thorpej splx(s);
806 1.2 itojun }
807 1.24 itojun
808 1.24 itojun #ifdef ISO
809 1.24 itojun struct eonhdr {
810 1.24 itojun u_int8_t version;
811 1.24 itojun u_int8_t class;
812 1.24 itojun u_int16_t cksum;
813 1.26 itojun };
814 1.24 itojun
815 1.24 itojun /*
816 1.24 itojun * prepend EON header to ISO PDU
817 1.24 itojun */
818 1.24 itojun static int
819 1.24 itojun gif_eon_encap(struct mbuf **m)
820 1.24 itojun {
821 1.24 itojun struct eonhdr *ehdr;
822 1.24 itojun
823 1.24 itojun M_PREPEND(*m, sizeof(*ehdr), M_DONTWAIT);
824 1.24 itojun if (*m && (*m)->m_len < sizeof(*ehdr))
825 1.24 itojun *m = m_pullup(*m, sizeof(*ehdr));
826 1.24 itojun if (*m == NULL) {
827 1.24 itojun printf("ENOBUFS in gif_eon_encap %d\n", __LINE__);
828 1.24 itojun return ENOBUFS;
829 1.24 itojun }
830 1.24 itojun ehdr = mtod(*m, struct eonhdr *);
831 1.24 itojun ehdr->version = 1;
832 1.24 itojun ehdr->class = 0; /* always unicast */
833 1.24 itojun #if 0
834 1.24 itojun /* calculate the checksum of the eonhdr */
835 1.24 itojun {
836 1.24 itojun struct mbuf mhead;
837 1.24 itojun memset(&mhead, 0, sizeof(mhead));
838 1.24 itojun ehdr->cksum = 0;
839 1.24 itojun mhead.m_data = (caddr_t)ehdr;
840 1.24 itojun mhead.m_len = sizeof(*ehdr);
841 1.24 itojun mhead.m_next = 0;
842 1.24 itojun iso_gen_csum(&mhead, offsetof(struct eonhdr, cksum),
843 1.24 itojun mhead.m_len);
844 1.24 itojun }
845 1.24 itojun #else
846 1.24 itojun /* since the data is always constant we'll just plug the value in */
847 1.24 itojun ehdr->cksum = htons(0xfc02);
848 1.24 itojun #endif
849 1.24 itojun return (0);
850 1.24 itojun }
851 1.24 itojun
852 1.24 itojun /*
853 1.24 itojun * remove EON header and check checksum
854 1.24 itojun */
855 1.24 itojun static int
856 1.24 itojun gif_eon_decap(struct ifnet *gifp, struct mbuf **m)
857 1.24 itojun {
858 1.24 itojun struct eonhdr *ehdr;
859 1.24 itojun
860 1.24 itojun if ((*m)->m_len < sizeof(*ehdr) &&
861 1.24 itojun (*m = m_pullup(*m, sizeof(*ehdr))) == 0) {
862 1.24 itojun gifp->if_ierrors++;
863 1.24 itojun return (EINVAL);
864 1.24 itojun }
865 1.24 itojun if (iso_check_csum(*m, sizeof(struct eonhdr)))
866 1.24 itojun return (EINVAL);
867 1.24 itojun m_adj(*m, sizeof(*ehdr));
868 1.24 itojun return (0);
869 1.24 itojun }
870 1.24 itojun #endif /*ISO*/
871 1.2 itojun #endif /*NGIF > 0*/
872