Merge branch 'vendor/GDTOA'
[dragonfly.git] / sys / net / faith / if_faith.c
1 /*      $KAME: if_faith.c,v 1.23 2001/12/17 13:55:29 sumikawa Exp $     */
2
3 /*
4  * Copyright (c) 1982, 1986, 1993
5  *      The Regents of the University of California.  All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  * 2. Redistributions in binary form must reproduce the above copyright
13  *    notice, this list of conditions and the following disclaimer in the
14  *    documentation and/or other materials provided with the distribution.
15  * 3. All advertising materials mentioning features or use of this software
16  *    must display the following acknowledgement:
17  *      This product includes software developed by the University of
18  *      California, Berkeley and its contributors.
19  * 4. Neither the name of the University nor the names of its contributors
20  *    may be used to endorse or promote products derived from this software
21  *    without specific prior written permission.
22  *
23  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
24  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
27  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
28  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
29  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33  * SUCH DAMAGE.
34  *
35  * $FreeBSD: src/sys/net/if_faith.c,v 1.3.2.6 2002/04/28 05:40:25 suz Exp $
36  * $DragonFly: src/sys/net/faith/if_faith.c,v 1.18 2008/01/11 11:59:40 sephe Exp $
37  */
38 /*
39  * derived from
40  *      @(#)if_loop.c   8.1 (Berkeley) 6/10/93
41  * Id: if_loop.c,v 1.22 1996/06/19 16:24:10 wollman Exp
42  */
43
44 /*
45  * Loopback interface driver for protocol testing and timing.
46  */
47 #ifndef NFAITH
48 #include "use_faith.h"
49 #endif
50 #include "opt_inet.h"
51 #include "opt_inet6.h"
52
53 #include <sys/param.h>
54 #include <sys/systm.h>
55 #include <sys/kernel.h>
56 #include <sys/mbuf.h>
57 #include <sys/bus.h>
58 #include <sys/socket.h>
59 #include <sys/errno.h>
60 #include <sys/sockio.h>
61 #include <sys/time.h>
62 #include <sys/queue.h>
63 #include <sys/types.h>
64 #include <sys/malloc.h>
65
66 #include <net/if.h>
67 #include <net/if_types.h>
68 #include <net/netisr.h>
69 #include <net/route.h>
70 #include <net/bpf.h>
71 #include <net/if_clone.h>
72
73 #ifdef  INET
74 #include <netinet/in.h>
75 #include <netinet/in_systm.h>
76 #include <netinet/in_var.h>
77 #include <netinet/ip.h>
78 #endif
79
80 #ifdef INET6
81 #ifndef INET
82 #include <netinet/in.h>
83 #endif
84 #include <netinet6/in6_var.h>
85 #include <netinet/ip6.h>
86 #include <netinet6/ip6_var.h>
87 #endif
88
89 #include <net/net_osdep.h>
90
91 #define FAITHNAME       "faith"
92
93 struct faith_softc {
94         struct ifnet sc_if;     /* must be first */
95         LIST_ENTRY(faith_softc) sc_list;
96 };
97
98 static int faithioctl (struct ifnet *, u_long, caddr_t, struct ucred *);
99 int faithoutput (struct ifnet *, struct mbuf *, struct sockaddr *,
100         struct rtentry *);
101 static void faithrtrequest (int, struct rtentry *, struct rt_addrinfo *);
102 #ifdef INET6
103 static int faithprefix (struct in6_addr *);
104 #endif
105
106 static int faithmodevent (module_t, int, void *);
107
108 static MALLOC_DEFINE(M_FAITH, FAITHNAME, "Firewall Assisted Tunnel Interface");
109 LIST_HEAD(, faith_softc) faith_softc_list;
110
111 int     faith_clone_create (struct if_clone *, int, caddr_t);
112 int     faith_clone_destroy (struct ifnet *);
113
114 struct if_clone faith_cloner = IF_CLONE_INITIALIZER(FAITHNAME,
115     faith_clone_create, faith_clone_destroy, NFAITH, IF_MAXUNIT);
116
117 #define FAITHMTU        1500
118
119 static int
120 faithmodevent(module_t mod, int type, void *data)
121 {
122
123         switch (type) {
124         case MOD_LOAD:
125                 LIST_INIT(&faith_softc_list);
126                 if_clone_attach(&faith_cloner);
127
128 #ifdef INET6
129                 faithprefix_p = faithprefix;
130 #endif
131
132                 break;
133         case MOD_UNLOAD:
134 #ifdef INET6
135                 faithprefix_p = NULL;
136 #endif
137
138                 if_clone_detach(&faith_cloner);
139
140                 while (!LIST_EMPTY(&faith_softc_list))
141                         faith_clone_destroy(
142                             &LIST_FIRST(&faith_softc_list)->sc_if);
143
144                 break;
145         }
146         return 0;
147 }
148
149 static moduledata_t faith_mod = {
150         "if_faith",
151         faithmodevent,
152         0
153 };
154
155 DECLARE_MODULE(if_faith, faith_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
156 MODULE_VERSION(if_faith, 1);
157
158 int
159 faith_clone_create(struct if_clone *ifc, int unit, caddr_t param __unused)
160 {
161         struct faith_softc *sc;
162
163         sc = kmalloc(sizeof(struct faith_softc), M_FAITH, M_WAITOK | M_ZERO);
164
165         sc->sc_if.if_softc = sc;
166         if_initname(&(sc->sc_if), FAITHNAME, unit);
167
168         sc->sc_if.if_mtu = FAITHMTU;
169         /* Change to BROADCAST experimentaly to announce its prefix. */
170         sc->sc_if.if_flags = /* IFF_LOOPBACK */ IFF_BROADCAST | IFF_MULTICAST;
171         sc->sc_if.if_ioctl = faithioctl;
172         sc->sc_if.if_output = faithoutput;
173         sc->sc_if.if_type = IFT_FAITH;
174         sc->sc_if.if_hdrlen = 0;
175         sc->sc_if.if_addrlen = 0;
176         sc->sc_if.if_snd.ifq_maxlen = ifqmaxlen;
177         if_attach(&sc->sc_if, NULL);
178         bpfattach(&sc->sc_if, DLT_NULL, sizeof(u_int));
179         LIST_INSERT_HEAD(&faith_softc_list, sc, sc_list);
180         return (0);
181 }
182
183 int
184 faith_clone_destroy(struct ifnet *ifp)
185 {
186         struct faith_softc *sc = (struct faith_softc *) ifp;
187
188         LIST_REMOVE(sc, sc_list);
189         bpfdetach(ifp);
190         if_detach(ifp);
191
192         kfree(sc, M_FAITH);
193
194         return 0;
195 }
196
197 int
198 faithoutput(struct ifnet *ifp, struct mbuf *m, struct sockaddr *dst,
199             struct rtentry *rt)
200 {
201         int isr;
202
203         if ((m->m_flags & M_PKTHDR) == 0)
204                 panic("faithoutput no HDR");
205
206         /* BPF write needs to be handled specially */
207         if (dst->sa_family == AF_UNSPEC) {
208                 dst->sa_family = *(mtod(m, int *));
209                 m->m_len -= sizeof(int);
210                 m->m_pkthdr.len -= sizeof(int);
211                 m->m_data += sizeof(int);
212         }
213
214         if (ifp->if_bpf != NULL) {
215                 /*
216                  * We need to prepend the address family as
217                  * a four byte field.
218                  */
219                 uint32_t af = dst->sa_family;
220
221                 bpf_ptap(ifp->if_bpf, m, &af, sizeof(af));
222         }
223
224         if (rt && rt->rt_flags & (RTF_REJECT|RTF_BLACKHOLE)) {
225                 m_freem(m);
226                 return (rt->rt_flags & RTF_BLACKHOLE ? 0 :
227                         rt->rt_flags & RTF_HOST ? EHOSTUNREACH : ENETUNREACH);
228         }
229         ifp->if_opackets++;
230         ifp->if_obytes += m->m_pkthdr.len;
231         switch (dst->sa_family) {
232 #ifdef INET
233         case AF_INET:
234                 isr = NETISR_IP;
235                 break;
236 #endif
237 #ifdef INET6
238         case AF_INET6:
239                 isr = NETISR_IPV6;
240                 break;
241 #endif
242         default:
243                 m_freem(m);
244                 return EAFNOSUPPORT;
245         }
246
247         /* XXX do we need more sanity checks? */
248
249         m->m_pkthdr.rcvif = ifp;
250         m->m_flags &= ~M_HASH;
251         ifp->if_ipackets++;
252         ifp->if_ibytes += m->m_pkthdr.len;
253         netisr_queue(isr, m);
254         return (0);
255 }
256
257 /* ARGSUSED */
258 static void
259 faithrtrequest(int cmd, struct rtentry *rt, struct rt_addrinfo *info)
260 {
261         if (rt) {
262                 rt->rt_rmx.rmx_mtu = rt->rt_ifp->if_mtu; /* for ISO */
263                 /*
264                  * For optimal performance, the send and receive buffers
265                  * should be at least twice the MTU plus a little more for
266                  * overhead.
267                  */
268                 rt->rt_rmx.rmx_recvpipe =
269                         rt->rt_rmx.rmx_sendpipe = 3 * FAITHMTU;
270         }
271 }
272
273 /*
274  * Process an ioctl request.
275  */
276 /* ARGSUSED */
277 static int
278 faithioctl(struct ifnet *ifp, u_long cmd, caddr_t data, struct ucred *cr)
279 {
280         struct ifaddr *ifa;
281         struct ifreq *ifr = (struct ifreq *)data;
282         int error = 0;
283
284         switch (cmd) {
285
286         case SIOCSIFADDR:
287                 ifp->if_flags |= IFF_UP | IFF_RUNNING;
288                 ifa = (struct ifaddr *)data;
289                 ifa->ifa_rtrequest = faithrtrequest;
290                 /*
291                  * Everything else is done at a higher level.
292                  */
293                 break;
294
295         case SIOCADDMULTI:
296         case SIOCDELMULTI:
297                 if (ifr == 0) {
298                         error = EAFNOSUPPORT;           /* XXX */
299                         break;
300                 }
301                 switch (ifr->ifr_addr.sa_family) {
302 #ifdef INET
303                 case AF_INET:
304                         break;
305 #endif
306 #ifdef INET6
307                 case AF_INET6:
308                         break;
309 #endif
310
311                 default:
312                         error = EAFNOSUPPORT;
313                         break;
314                 }
315                 break;
316
317 #ifdef SIOCSIFMTU
318         case SIOCSIFMTU:
319                 ifp->if_mtu = ifr->ifr_mtu;
320                 break;
321 #endif
322
323         case SIOCSIFFLAGS:
324                 break;
325
326         default:
327                 error = EINVAL;
328         }
329         return (error);
330 }
331
332 #ifdef INET6
333 /*
334  * XXX could be slow
335  * XXX could be layer violation to call sys/net from sys/netinet6
336  */
337 static int
338 faithprefix(struct in6_addr *in6)
339 {
340         struct rtentry *rt;
341         struct sockaddr_in6 sin6;
342         int ret;
343
344         if (ip6_keepfaith == 0)
345                 return 0;
346
347         bzero(&sin6, sizeof sin6);
348         sin6.sin6_family = AF_INET6;
349         sin6.sin6_len = sizeof(struct sockaddr_in6);
350         sin6.sin6_addr = *in6;
351         rt = rtpurelookup((struct sockaddr *)&sin6);
352         if (rt != NULL && rt->rt_ifp && rt->rt_ifp->if_type == IFT_FAITH &&
353             (rt->rt_ifp->if_flags & IFF_UP))
354                 ret = 1;
355         else
356                 ret = 0;
357         if (rt != NULL)
358                 RTFREE(rt);
359         return ret;
360 }
361 #endif