if_faith.c revision 148887
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 * 4. Neither the name of the University nor the names of its contributors 16 * may be used to endorse or promote products derived from this software 17 * without specific prior written permission. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 22 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 25 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 29 * SUCH DAMAGE. 30 * 31 * $FreeBSD: head/sys/net/if_faith.c 148887 2005-08-09 10:20:02Z rwatson $ 32 */ 33/* 34 * derived from 35 * @(#)if_loop.c 8.1 (Berkeley) 6/10/93 36 * Id: if_loop.c,v 1.22 1996/06/19 16:24:10 wollman Exp 37 */ 38 39/* 40 * Loopback interface driver for protocol testing and timing. 41 */ 42#include "opt_inet.h" 43#include "opt_inet6.h" 44 45#include <sys/param.h> 46#include <sys/systm.h> 47#include <sys/kernel.h> 48#include <sys/mbuf.h> 49#include <sys/module.h> 50#include <sys/socket.h> 51#include <sys/errno.h> 52#include <sys/sockio.h> 53#include <sys/time.h> 54#include <sys/queue.h> 55#include <sys/types.h> 56#include <sys/malloc.h> 57 58#include <net/if.h> 59#include <net/if_clone.h> 60#include <net/if_types.h> 61#include <net/netisr.h> 62#include <net/route.h> 63#include <net/bpf.h> 64 65#ifdef INET 66#include <netinet/in.h> 67#include <netinet/in_systm.h> 68#include <netinet/in_var.h> 69#include <netinet/ip.h> 70#endif 71 72#ifdef INET6 73#ifndef INET 74#include <netinet/in.h> 75#endif 76#include <netinet6/in6_var.h> 77#include <netinet/ip6.h> 78#include <netinet6/ip6_var.h> 79#endif 80 81#include <net/net_osdep.h> 82 83#define FAITHNAME "faith" 84 85struct faith_softc { 86 struct ifnet *sc_ifp; 87 LIST_ENTRY(faith_softc) sc_list; 88}; 89 90static int faithioctl(struct ifnet *, u_long, caddr_t); 91int faithoutput(struct ifnet *, struct mbuf *, struct sockaddr *, 92 struct rtentry *); 93static void faithrtrequest(int, struct rtentry *, struct rt_addrinfo *); 94#ifdef INET6 95static int faithprefix(struct in6_addr *); 96#endif 97 98static int faithmodevent(module_t, int, void *); 99 100static struct mtx faith_mtx; 101static MALLOC_DEFINE(M_FAITH, FAITHNAME, "Firewall Assisted Tunnel Interface"); 102static LIST_HEAD(, faith_softc) faith_softc_list; 103 104static int faith_clone_create(struct if_clone *, int); 105static void faith_clone_destroy(struct ifnet *); 106static void faith_destroy(struct faith_softc *); 107 108IFC_SIMPLE_DECLARE(faith, 0); 109 110#define FAITHMTU 1500 111 112static int 113faithmodevent(mod, type, data) 114 module_t mod; 115 int type; 116 void *data; 117{ 118 struct faith_softc *sc; 119 120 switch (type) { 121 case MOD_LOAD: 122 mtx_init(&faith_mtx, "faith_mtx", NULL, MTX_DEF); 123 LIST_INIT(&faith_softc_list); 124 if_clone_attach(&faith_cloner); 125 126#ifdef INET6 127 faithprefix_p = faithprefix; 128#endif 129 130 break; 131 case MOD_UNLOAD: 132#ifdef INET6 133 faithprefix_p = NULL; 134#endif 135 136 if_clone_detach(&faith_cloner); 137 138 mtx_lock(&faith_mtx); 139 while ((sc = LIST_FIRST(&faith_softc_list)) != NULL) { 140 LIST_REMOVE(sc, sc_list); 141 mtx_unlock(&faith_mtx); 142 faith_destroy(sc); 143 mtx_lock(&faith_mtx); 144 } 145 mtx_unlock(&faith_mtx); 146 mtx_destroy(&faith_mtx); 147 break; 148 default: 149 return EOPNOTSUPP; 150 } 151 return 0; 152} 153 154static moduledata_t faith_mod = { 155 "if_faith", 156 faithmodevent, 157 0 158}; 159 160DECLARE_MODULE(if_faith, faith_mod, SI_SUB_PSEUDO, SI_ORDER_ANY); 161MODULE_VERSION(if_faith, 1); 162 163static int 164faith_clone_create(ifc, unit) 165 struct if_clone *ifc; 166 int unit; 167{ 168 struct ifnet *ifp; 169 struct faith_softc *sc; 170 171 sc = malloc(sizeof(struct faith_softc), M_FAITH, M_WAITOK | M_ZERO); 172 ifp = sc->sc_ifp = if_alloc(IFT_FAITH); 173 if (ifp == NULL) { 174 free(sc, M_FAITH); 175 return (ENOSPC); 176 } 177 178 ifp->if_softc = sc; 179 if_initname(sc->sc_ifp, ifc->ifc_name, unit); 180 181 ifp->if_mtu = FAITHMTU; 182 /* Change to BROADCAST experimentaly to announce its prefix. */ 183 ifp->if_flags = /* IFF_LOOPBACK */ IFF_BROADCAST | IFF_MULTICAST; 184 ifp->if_ioctl = faithioctl; 185 ifp->if_output = faithoutput; 186 ifp->if_hdrlen = 0; 187 ifp->if_addrlen = 0; 188 ifp->if_snd.ifq_maxlen = ifqmaxlen; 189 if_attach(ifp); 190 bpfattach(ifp, DLT_NULL, sizeof(u_int32_t)); 191 mtx_lock(&faith_mtx); 192 LIST_INSERT_HEAD(&faith_softc_list, sc, sc_list); 193 mtx_unlock(&faith_mtx); 194 return (0); 195} 196 197static void 198faith_destroy(struct faith_softc *sc) 199{ 200 201 bpfdetach(sc->sc_ifp); 202 if_detach(sc->sc_ifp); 203 if_free(sc->sc_ifp); 204 free(sc, M_FAITH); 205} 206 207static void 208faith_clone_destroy(ifp) 209 struct ifnet *ifp; 210{ 211 struct faith_softc *sc = ifp->if_softc; 212 213 mtx_lock(&faith_mtx); 214 LIST_REMOVE(sc, sc_list); 215 mtx_unlock(&faith_mtx); 216 217 faith_destroy(sc); 218} 219 220int 221faithoutput(ifp, m, dst, rt) 222 struct ifnet *ifp; 223 struct mbuf *m; 224 struct sockaddr *dst; 225 struct rtentry *rt; 226{ 227 int isr; 228 u_int32_t af; 229 230 M_ASSERTPKTHDR(m); 231 232 /* BPF writes need to be handled specially. */ 233 if (dst->sa_family == AF_UNSPEC) { 234 bcopy(dst->sa_data, &af, sizeof(af)); 235 dst->sa_family = af; 236 } 237 238 if (ifp->if_bpf) { 239 af = dst->sa_family; 240 bpf_mtap2(ifp->if_bpf, &af, sizeof(af), m); 241 } 242 243 if (rt && rt->rt_flags & (RTF_REJECT|RTF_BLACKHOLE)) { 244 m_freem(m); 245 return (rt->rt_flags & RTF_BLACKHOLE ? 0 : 246 rt->rt_flags & RTF_HOST ? EHOSTUNREACH : ENETUNREACH); 247 } 248 ifp->if_opackets++; 249 ifp->if_obytes += m->m_pkthdr.len; 250 switch (dst->sa_family) { 251#ifdef INET 252 case AF_INET: 253 isr = NETISR_IP; 254 break; 255#endif 256#ifdef INET6 257 case AF_INET6: 258 isr = NETISR_IPV6; 259 break; 260#endif 261 default: 262 m_freem(m); 263 return EAFNOSUPPORT; 264 } 265 266 /* XXX do we need more sanity checks? */ 267 268 m->m_pkthdr.rcvif = ifp; 269 ifp->if_ipackets++; 270 ifp->if_ibytes += m->m_pkthdr.len; 271 netisr_dispatch(isr, m); 272 return (0); 273} 274 275/* ARGSUSED */ 276static void 277faithrtrequest(cmd, rt, info) 278 int cmd; 279 struct rtentry *rt; 280 struct rt_addrinfo *info; 281{ 282 RT_LOCK_ASSERT(rt); 283 rt->rt_rmx.rmx_mtu = rt->rt_ifp->if_mtu; 284} 285 286/* 287 * Process an ioctl request. 288 */ 289/* ARGSUSED */ 290static int 291faithioctl(ifp, cmd, data) 292 struct ifnet *ifp; 293 u_long cmd; 294 caddr_t data; 295{ 296 struct ifaddr *ifa; 297 struct ifreq *ifr = (struct ifreq *)data; 298 int error = 0; 299 300 switch (cmd) { 301 302 case SIOCSIFADDR: 303 ifp->if_flags |= IFF_UP; 304 ifp->if_drv_flags |= IFF_DRV_RUNNING; 305 ifa = (struct ifaddr *)data; 306 ifa->ifa_rtrequest = faithrtrequest; 307 /* 308 * Everything else is done at a higher level. 309 */ 310 break; 311 312 case SIOCADDMULTI: 313 case SIOCDELMULTI: 314 if (ifr == 0) { 315 error = EAFNOSUPPORT; /* XXX */ 316 break; 317 } 318 switch (ifr->ifr_addr.sa_family) { 319#ifdef INET 320 case AF_INET: 321 break; 322#endif 323#ifdef INET6 324 case AF_INET6: 325 break; 326#endif 327 328 default: 329 error = EAFNOSUPPORT; 330 break; 331 } 332 break; 333 334#ifdef SIOCSIFMTU 335 case SIOCSIFMTU: 336 ifp->if_mtu = ifr->ifr_mtu; 337 break; 338#endif 339 340 case SIOCSIFFLAGS: 341 break; 342 343 default: 344 error = EINVAL; 345 } 346 return (error); 347} 348 349#ifdef INET6 350/* 351 * XXX could be slow 352 * XXX could be layer violation to call sys/net from sys/netinet6 353 */ 354static int 355faithprefix(in6) 356 struct in6_addr *in6; 357{ 358 struct rtentry *rt; 359 struct sockaddr_in6 sin6; 360 int ret; 361 362 if (ip6_keepfaith == 0) 363 return 0; 364 365 bzero(&sin6, sizeof(sin6)); 366 sin6.sin6_family = AF_INET6; 367 sin6.sin6_len = sizeof(struct sockaddr_in6); 368 sin6.sin6_addr = *in6; 369 rt = rtalloc1((struct sockaddr *)&sin6, 0, 0UL); 370 if (rt && rt->rt_ifp && rt->rt_ifp->if_type == IFT_FAITH && 371 (rt->rt_ifp->if_flags & IFF_UP) != 0) 372 ret = 1; 373 else 374 ret = 0; 375 if (rt) 376 RTFREE_LOCKED(rt); 377 return ret; 378} 379#endif 380