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