if_faith.c revision 1.15 1 /* $NetBSD: if_faith.c,v 1.15 2001/01/17 00:30:51 thorpej 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 /*
36 * derived from
37 * @(#)if_loop.c 8.1 (Berkeley) 6/10/93
38 * Id: if_loop.c,v 1.22 1996/06/19 16:24:10 wollman Exp
39 */
40
41 /*
42 * Loopback interface driver for protocol testing and timing.
43 */
44 #include "opt_inet.h"
45
46 #include "faith.h"
47 #if NFAITH > 0
48
49 #include <sys/param.h>
50 #include <sys/systm.h>
51 #include <sys/kernel.h>
52 #include <sys/mbuf.h>
53 #include <sys/socket.h>
54 #include <sys/errno.h>
55 #include <sys/ioctl.h>
56 #include <sys/time.h>
57 #include <sys/queue.h>
58
59 #include <machine/cpu.h>
60
61 #include <net/if.h>
62 #include <net/if_types.h>
63 #include <net/netisr.h>
64 #include <net/route.h>
65 #include <net/bpf.h>
66
67 #ifdef INET
68 #include <netinet/in.h>
69 #include <netinet/in_systm.h>
70 #include <netinet/in_var.h>
71 #include <netinet/ip.h>
72 #endif
73
74 #ifdef INET6
75 #ifndef INET
76 #include <netinet/in.h>
77 #endif
78 #include <netinet6/in6_var.h>
79 #include <netinet/ip6.h>
80 #endif
81
82 #include "bpfilter.h"
83
84 #include <net/net_osdep.h>
85
86 struct faith_softc {
87 struct ifnet sc_if; /* must be first */
88 LIST_ENTRY(faith_softc) sc_list;
89 };
90
91 static int faithioctl __P((struct ifnet *, u_long, caddr_t));
92 int faithoutput __P((struct ifnet *, struct mbuf *, struct sockaddr *,
93 struct rtentry *));
94 static void faithrtrequest __P((int, struct rtentry *, struct sockaddr *));
95
96 void faithattach __P((int));
97
98 LIST_HEAD(, faith_softc) faith_softc_list;
99
100 int faith_clone_create __P((struct if_clone *, int));
101 void faith_clone_destroy __P((struct ifnet *));
102
103 struct if_clone faith_cloner =
104 IF_CLONE_INITIALIZER("faith", faith_clone_create, faith_clone_destroy);
105
106 #define FAITHMTU 1500
107
108 /* ARGSUSED */
109 void
110 faithattach(count)
111 int count;
112 {
113
114 LIST_INIT(&faith_softc_list);
115 if_clone_attach(&faith_cloner);
116 }
117
118 int
119 faith_clone_create(ifc, unit)
120 struct if_clone *ifc;
121 int unit;
122 {
123 struct faith_softc *sc;
124
125 sc = malloc(sizeof(struct faith_softc), M_DEVBUF, M_WAITOK);
126 bzero(sc, sizeof(struct faith_softc));
127
128 sprintf(sc->sc_if.if_xname, "%s%d", ifc->ifc_name, unit);
129
130 sc->sc_if.if_mtu = FAITHMTU;
131 /* Change to BROADCAST experimentaly to announce its prefix. */
132 sc->sc_if.if_flags = /* IFF_LOOPBACK */ IFF_BROADCAST | IFF_MULTICAST;
133 sc->sc_if.if_ioctl = faithioctl;
134 sc->sc_if.if_output = faithoutput;
135 sc->sc_if.if_type = IFT_FAITH;
136 sc->sc_if.if_hdrlen = 0;
137 sc->sc_if.if_addrlen = 0;
138 sc->sc_if.if_dlt = DLT_NULL;
139 if_attach(&sc->sc_if);
140 if_alloc_sadl(&sc->sc_if);
141 #if NBPFILTER > 0
142 bpfattach(&sc->sc_if, DLT_NULL, sizeof(u_int));
143 #endif
144 LIST_INSERT_HEAD(&faith_softc_list, sc, sc_list);
145 return (0);
146 }
147
148 void
149 faith_clone_destroy(ifp)
150 struct ifnet *ifp;
151 {
152 struct faith_softc *sc = (void *) ifp;
153
154 LIST_REMOVE(sc, sc_list);
155 #if NBPFILTER > 0
156 bpfdetach(ifp);
157 #endif
158 if_detach(ifp);
159 free(sc, M_DEVBUF);
160 }
161
162 int
163 faithoutput(ifp, m, dst, rt)
164 struct ifnet *ifp;
165 struct mbuf *m;
166 struct sockaddr *dst;
167 struct rtentry *rt;
168 {
169 int s, isr;
170 struct ifqueue *ifq = 0;
171
172 if ((m->m_flags & M_PKTHDR) == 0)
173 panic("faithoutput no HDR");
174 #if NBPFILTER > 0
175 /* BPF write needs to be handled specially */
176 if (dst->sa_family == AF_UNSPEC) {
177 dst->sa_family = *(mtod(m, int *));
178 m->m_len -= sizeof(int);
179 m->m_pkthdr.len -= sizeof(int);
180 m->m_data += sizeof(int);
181 }
182
183 if (ifp->if_bpf) {
184 /*
185 * We need to prepend the address family as
186 * a four byte field. Cons up a faith header
187 * to pacify bpf. This is safe because bpf
188 * will only read from the mbuf (i.e., it won't
189 * try to free it or keep a pointer a to it).
190 */
191 struct mbuf m0;
192 u_int af = dst->sa_family;
193
194 m0.m_next = m;
195 m0.m_len = 4;
196 m0.m_data = (char *)⁡
197
198 #ifdef HAVE_OLD_BPF
199 bpf_mtap(ifp, &m0);
200 #else
201 bpf_mtap(ifp->if_bpf, &m0);
202 #endif
203 }
204 #endif
205
206 if (rt && rt->rt_flags & (RTF_REJECT|RTF_BLACKHOLE)) {
207 m_freem(m);
208 return (rt->rt_flags & RTF_BLACKHOLE ? 0 :
209 rt->rt_flags & RTF_HOST ? EHOSTUNREACH : ENETUNREACH);
210 }
211 ifp->if_opackets++;
212 ifp->if_obytes += m->m_pkthdr.len;
213 switch (dst->sa_family) {
214 #ifdef INET
215 case AF_INET:
216 ifq = &ipintrq;
217 isr = NETISR_IP;
218 break;
219 #endif
220 #ifdef INET6
221 case AF_INET6:
222 ifq = &ip6intrq;
223 isr = NETISR_IPV6;
224 break;
225 #endif
226 default:
227 m_freem(m);
228 return EAFNOSUPPORT;
229 }
230
231 /* XXX do we need more sanity checks? */
232
233 m->m_pkthdr.rcvif = ifp;
234 s = splimp();
235 if (IF_QFULL(ifq)) {
236 IF_DROP(ifq);
237 m_freem(m);
238 splx(s);
239 return (ENOBUFS);
240 }
241 IF_ENQUEUE(ifq, m);
242 schednetisr(isr);
243 ifp->if_ipackets++;
244 ifp->if_ibytes += m->m_pkthdr.len;
245 splx(s);
246 return (0);
247 }
248
249 /* ARGSUSED */
250 static void
251 faithrtrequest(cmd, rt, sa)
252 int cmd;
253 struct rtentry *rt;
254 struct sockaddr *sa;
255 {
256 if (rt) {
257 rt->rt_rmx.rmx_mtu = rt->rt_ifp->if_mtu; /* for ISO */
258 /*
259 * For optimal performance, the send and receive buffers
260 * should be at least twice the MTU plus a little more for
261 * overhead.
262 */
263 rt->rt_rmx.rmx_recvpipe =
264 rt->rt_rmx.rmx_sendpipe = 3 * FAITHMTU;
265 }
266 }
267
268 /*
269 * Process an ioctl request.
270 */
271 /* ARGSUSED */
272 static int
273 faithioctl(ifp, cmd, data)
274 struct ifnet *ifp;
275 u_long cmd;
276 caddr_t data;
277 {
278 struct ifaddr *ifa;
279 struct ifreq *ifr = (struct ifreq *)data;
280 int error = 0;
281
282 switch (cmd) {
283
284 case SIOCSIFADDR:
285 ifp->if_flags |= IFF_UP | IFF_RUNNING;
286 ifa = (struct ifaddr *)data;
287 ifa->ifa_rtrequest = faithrtrequest;
288 /*
289 * Everything else is done at a higher level.
290 */
291 break;
292
293 case SIOCADDMULTI:
294 case SIOCDELMULTI:
295 if (ifr == 0) {
296 error = EAFNOSUPPORT; /* XXX */
297 break;
298 }
299 switch (ifr->ifr_addr.sa_family) {
300 #ifdef INET
301 case AF_INET:
302 break;
303 #endif
304 #ifdef INET6
305 case AF_INET6:
306 break;
307 #endif
308
309 default:
310 error = EAFNOSUPPORT;
311 break;
312 }
313 break;
314
315 #ifdef SIOCSIFMTU
316 case SIOCSIFMTU:
317 ifp->if_mtu = ifr->ifr_mtu;
318 break;
319 #endif
320
321 case SIOCSIFFLAGS:
322 break;
323
324 default:
325 error = EINVAL;
326 }
327 return (error);
328 }
329 #endif /* NFAITH > 0 */
330