if_faith.c revision 1.14 1 /* $NetBSD: if_faith.c,v 1.14 2000/12/18 19:50:44 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 NBPFILTER > 0
141 bpfattach(&sc->sc_if, DLT_NULL, sizeof(u_int));
142 #endif
143 LIST_INSERT_HEAD(&faith_softc_list, sc, sc_list);
144 return (0);
145 }
146
147 void
148 faith_clone_destroy(ifp)
149 struct ifnet *ifp;
150 {
151 struct faith_softc *sc = (void *) ifp;
152
153 LIST_REMOVE(sc, sc_list);
154 #if NBPFILTER > 0
155 bpfdetach(ifp);
156 #endif
157 if_detach(ifp);
158 free(sc, M_DEVBUF);
159 }
160
161 int
162 faithoutput(ifp, m, dst, rt)
163 struct ifnet *ifp;
164 struct mbuf *m;
165 struct sockaddr *dst;
166 struct rtentry *rt;
167 {
168 int s, isr;
169 struct ifqueue *ifq = 0;
170
171 if ((m->m_flags & M_PKTHDR) == 0)
172 panic("faithoutput no HDR");
173 #if NBPFILTER > 0
174 /* BPF write needs to be handled specially */
175 if (dst->sa_family == AF_UNSPEC) {
176 dst->sa_family = *(mtod(m, int *));
177 m->m_len -= sizeof(int);
178 m->m_pkthdr.len -= sizeof(int);
179 m->m_data += sizeof(int);
180 }
181
182 if (ifp->if_bpf) {
183 /*
184 * We need to prepend the address family as
185 * a four byte field. Cons up a faith header
186 * to pacify bpf. This is safe because bpf
187 * will only read from the mbuf (i.e., it won't
188 * try to free it or keep a pointer a to it).
189 */
190 struct mbuf m0;
191 u_int af = dst->sa_family;
192
193 m0.m_next = m;
194 m0.m_len = 4;
195 m0.m_data = (char *)⁡
196
197 #ifdef HAVE_OLD_BPF
198 bpf_mtap(ifp, &m0);
199 #else
200 bpf_mtap(ifp->if_bpf, &m0);
201 #endif
202 }
203 #endif
204
205 if (rt && rt->rt_flags & (RTF_REJECT|RTF_BLACKHOLE)) {
206 m_freem(m);
207 return (rt->rt_flags & RTF_BLACKHOLE ? 0 :
208 rt->rt_flags & RTF_HOST ? EHOSTUNREACH : ENETUNREACH);
209 }
210 ifp->if_opackets++;
211 ifp->if_obytes += m->m_pkthdr.len;
212 switch (dst->sa_family) {
213 #ifdef INET
214 case AF_INET:
215 ifq = &ipintrq;
216 isr = NETISR_IP;
217 break;
218 #endif
219 #ifdef INET6
220 case AF_INET6:
221 ifq = &ip6intrq;
222 isr = NETISR_IPV6;
223 break;
224 #endif
225 default:
226 m_freem(m);
227 return EAFNOSUPPORT;
228 }
229
230 /* XXX do we need more sanity checks? */
231
232 m->m_pkthdr.rcvif = ifp;
233 s = splimp();
234 if (IF_QFULL(ifq)) {
235 IF_DROP(ifq);
236 m_freem(m);
237 splx(s);
238 return (ENOBUFS);
239 }
240 IF_ENQUEUE(ifq, m);
241 schednetisr(isr);
242 ifp->if_ipackets++;
243 ifp->if_ibytes += m->m_pkthdr.len;
244 splx(s);
245 return (0);
246 }
247
248 /* ARGSUSED */
249 static void
250 faithrtrequest(cmd, rt, sa)
251 int cmd;
252 struct rtentry *rt;
253 struct sockaddr *sa;
254 {
255 if (rt) {
256 rt->rt_rmx.rmx_mtu = rt->rt_ifp->if_mtu; /* for ISO */
257 /*
258 * For optimal performance, the send and receive buffers
259 * should be at least twice the MTU plus a little more for
260 * overhead.
261 */
262 rt->rt_rmx.rmx_recvpipe =
263 rt->rt_rmx.rmx_sendpipe = 3 * FAITHMTU;
264 }
265 }
266
267 /*
268 * Process an ioctl request.
269 */
270 /* ARGSUSED */
271 static int
272 faithioctl(ifp, cmd, data)
273 struct ifnet *ifp;
274 u_long cmd;
275 caddr_t data;
276 {
277 struct ifaddr *ifa;
278 struct ifreq *ifr = (struct ifreq *)data;
279 int error = 0;
280
281 switch (cmd) {
282
283 case SIOCSIFADDR:
284 ifp->if_flags |= IFF_UP | IFF_RUNNING;
285 ifa = (struct ifaddr *)data;
286 ifa->ifa_rtrequest = faithrtrequest;
287 /*
288 * Everything else is done at a higher level.
289 */
290 break;
291
292 case SIOCADDMULTI:
293 case SIOCDELMULTI:
294 if (ifr == 0) {
295 error = EAFNOSUPPORT; /* XXX */
296 break;
297 }
298 switch (ifr->ifr_addr.sa_family) {
299 #ifdef INET
300 case AF_INET:
301 break;
302 #endif
303 #ifdef INET6
304 case AF_INET6:
305 break;
306 #endif
307
308 default:
309 error = EAFNOSUPPORT;
310 break;
311 }
312 break;
313
314 #ifdef SIOCSIFMTU
315 case SIOCSIFMTU:
316 ifp->if_mtu = ifr->ifr_mtu;
317 break;
318 #endif
319
320 case SIOCSIFFLAGS:
321 break;
322
323 default:
324 error = EINVAL;
325 }
326 return (error);
327 }
328 #endif /* NFAITH > 0 */
329