if_faith.c revision 148887
195023Ssuz/* $KAME: if_faith.c,v 1.23 2001/12/17 13:55:29 sumikawa Exp $ */ 278064Sume 3139823Simp/*- 454263Sshin * Copyright (c) 1982, 1986, 1993 554263Sshin * The Regents of the University of California. All rights reserved. 654263Sshin * 754263Sshin * Redistribution and use in source and binary forms, with or without 854263Sshin * modification, are permitted provided that the following conditions 954263Sshin * are met: 1054263Sshin * 1. Redistributions of source code must retain the above copyright 1154263Sshin * notice, this list of conditions and the following disclaimer. 1254263Sshin * 2. Redistributions in binary form must reproduce the above copyright 1354263Sshin * notice, this list of conditions and the following disclaimer in the 1454263Sshin * documentation and/or other materials provided with the distribution. 1554263Sshin * 4. Neither the name of the University nor the names of its contributors 1654263Sshin * may be used to endorse or promote products derived from this software 1754263Sshin * without specific prior written permission. 1854263Sshin * 1954263Sshin * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 2054263Sshin * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 2154263Sshin * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 2254263Sshin * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 2354263Sshin * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2454263Sshin * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2554263Sshin * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2654263Sshin * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2754263Sshin * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2854263Sshin * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2954263Sshin * SUCH DAMAGE. 3054263Sshin * 3154263Sshin * $FreeBSD: head/sys/net/if_faith.c 148887 2005-08-09 10:20:02Z rwatson $ 3254263Sshin */ 3354263Sshin/* 3454263Sshin * derived from 3554263Sshin * @(#)if_loop.c 8.1 (Berkeley) 6/10/93 3654263Sshin * Id: if_loop.c,v 1.22 1996/06/19 16:24:10 wollman Exp 3754263Sshin */ 3854263Sshin 3954263Sshin/* 4054263Sshin * Loopback interface driver for protocol testing and timing. 4154263Sshin */ 4278064Sume#include "opt_inet.h" 4378064Sume#include "opt_inet6.h" 4454263Sshin 4554263Sshin#include <sys/param.h> 4654263Sshin#include <sys/systm.h> 4754263Sshin#include <sys/kernel.h> 4854263Sshin#include <sys/mbuf.h> 49129880Sphk#include <sys/module.h> 5054263Sshin#include <sys/socket.h> 5178064Sume#include <sys/errno.h> 5254263Sshin#include <sys/sockio.h> 5378064Sume#include <sys/time.h> 5478064Sume#include <sys/queue.h> 5583934Sbrooks#include <sys/types.h> 5683934Sbrooks#include <sys/malloc.h> 5754263Sshin 5854263Sshin#include <net/if.h> 59130933Sbrooks#include <net/if_clone.h> 6054263Sshin#include <net/if_types.h> 6154263Sshin#include <net/netisr.h> 6254263Sshin#include <net/route.h> 6354263Sshin#include <net/bpf.h> 6454263Sshin 6578064Sume#ifdef INET 6678064Sume#include <netinet/in.h> 6778064Sume#include <netinet/in_systm.h> 6878064Sume#include <netinet/in_var.h> 6978064Sume#include <netinet/ip.h> 7078064Sume#endif 7178064Sume 7278064Sume#ifdef INET6 7378064Sume#ifndef INET 7478064Sume#include <netinet/in.h> 7578064Sume#endif 7678064Sume#include <netinet6/in6_var.h> 7778064Sume#include <netinet/ip6.h> 7878064Sume#include <netinet6/ip6_var.h> 7978064Sume#endif 8078064Sume 8171991Speter#include <net/net_osdep.h> 8271991Speter 8383934Sbrooks#define FAITHNAME "faith" 8483934Sbrooks 8583934Sbrooksstruct faith_softc { 86147256Sbrooks struct ifnet *sc_ifp; 8783934Sbrooks LIST_ENTRY(faith_softc) sc_list; 8883934Sbrooks}; 8983934Sbrooks 9092725Salfredstatic int faithioctl(struct ifnet *, u_long, caddr_t); 9192725Salfredint faithoutput(struct ifnet *, struct mbuf *, struct sockaddr *, 9292725Salfred struct rtentry *); 9392725Salfredstatic void faithrtrequest(int, struct rtentry *, struct rt_addrinfo *); 9491317Sdillon#ifdef INET6 9592725Salfredstatic int faithprefix(struct in6_addr *); 9691317Sdillon#endif 9754263Sshin 9892725Salfredstatic int faithmodevent(module_t, int, void *); 9978064Sume 100126781Srwatsonstatic struct mtx faith_mtx; 10183934Sbrooksstatic MALLOC_DEFINE(M_FAITH, FAITHNAME, "Firewall Assisted Tunnel Interface"); 10289065Smsmithstatic LIST_HEAD(, faith_softc) faith_softc_list; 10354263Sshin 104128209Sbrooksstatic int faith_clone_create(struct if_clone *, int); 105128209Sbrooksstatic void faith_clone_destroy(struct ifnet *); 106126781Srwatsonstatic void faith_destroy(struct faith_softc *); 10783934Sbrooks 108130933SbrooksIFC_SIMPLE_DECLARE(faith, 0); 10983934Sbrooks 11054263Sshin#define FAITHMTU 1500 11154263Sshin 11283934Sbrooksstatic int 11383934Sbrooksfaithmodevent(mod, type, data) 11483934Sbrooks module_t mod; 11583934Sbrooks int type; 11683934Sbrooks void *data; 11754263Sshin{ 118126781Srwatson struct faith_softc *sc; 11954263Sshin 12083934Sbrooks switch (type) { 12183934Sbrooks case MOD_LOAD: 122126781Srwatson mtx_init(&faith_mtx, "faith_mtx", NULL, MTX_DEF); 12383934Sbrooks LIST_INIT(&faith_softc_list); 12483934Sbrooks if_clone_attach(&faith_cloner); 12583934Sbrooks 12683934Sbrooks#ifdef INET6 12783934Sbrooks faithprefix_p = faithprefix; 12878064Sume#endif 12983934Sbrooks 13083934Sbrooks break; 13183934Sbrooks case MOD_UNLOAD: 13283934Sbrooks#ifdef INET6 13383934Sbrooks faithprefix_p = NULL; 13478064Sume#endif 13583934Sbrooks 13683934Sbrooks if_clone_detach(&faith_cloner); 13783934Sbrooks 138126781Srwatson mtx_lock(&faith_mtx); 139126781Srwatson while ((sc = LIST_FIRST(&faith_softc_list)) != NULL) { 140126781Srwatson LIST_REMOVE(sc, sc_list); 141126781Srwatson mtx_unlock(&faith_mtx); 142126781Srwatson faith_destroy(sc); 143126781Srwatson mtx_lock(&faith_mtx); 144126781Srwatson } 145126781Srwatson mtx_unlock(&faith_mtx); 146126781Srwatson mtx_destroy(&faith_mtx); 14783934Sbrooks break; 148132199Sphk default: 149132199Sphk return EOPNOTSUPP; 15054263Sshin } 15183934Sbrooks return 0; 15254263Sshin} 15378064Sume 15483934Sbrooksstatic moduledata_t faith_mod = { 15583934Sbrooks "if_faith", 15683934Sbrooks faithmodevent, 15783934Sbrooks 0 15883934Sbrooks}; 15983934Sbrooks 16083934SbrooksDECLARE_MODULE(if_faith, faith_mod, SI_SUB_PSEUDO, SI_ORDER_ANY); 16183934SbrooksMODULE_VERSION(if_faith, 1); 16283934Sbrooks 163128209Sbrooksstatic int 16483934Sbrooksfaith_clone_create(ifc, unit) 16583934Sbrooks struct if_clone *ifc; 16692081Smux int unit; 16783934Sbrooks{ 168147256Sbrooks struct ifnet *ifp; 16983934Sbrooks struct faith_softc *sc; 17083934Sbrooks 171131675Sbms sc = malloc(sizeof(struct faith_softc), M_FAITH, M_WAITOK | M_ZERO); 172147256Sbrooks ifp = sc->sc_ifp = if_alloc(IFT_FAITH); 173147256Sbrooks if (ifp == NULL) { 174147256Sbrooks free(sc, M_FAITH); 175147256Sbrooks return (ENOSPC); 176147256Sbrooks } 17783934Sbrooks 178147256Sbrooks ifp->if_softc = sc; 179147256Sbrooks if_initname(sc->sc_ifp, ifc->ifc_name, unit); 18083934Sbrooks 181147256Sbrooks ifp->if_mtu = FAITHMTU; 18283934Sbrooks /* Change to BROADCAST experimentaly to announce its prefix. */ 183147256Sbrooks ifp->if_flags = /* IFF_LOOPBACK */ IFF_BROADCAST | IFF_MULTICAST; 184147256Sbrooks ifp->if_ioctl = faithioctl; 185147256Sbrooks ifp->if_output = faithoutput; 186147256Sbrooks ifp->if_hdrlen = 0; 187147256Sbrooks ifp->if_addrlen = 0; 188147256Sbrooks ifp->if_snd.ifq_maxlen = ifqmaxlen; 189147256Sbrooks if_attach(ifp); 190147611Sdwmalone bpfattach(ifp, DLT_NULL, sizeof(u_int32_t)); 191126781Srwatson mtx_lock(&faith_mtx); 19283934Sbrooks LIST_INSERT_HEAD(&faith_softc_list, sc, sc_list); 193126781Srwatson mtx_unlock(&faith_mtx); 19483934Sbrooks return (0); 19583934Sbrooks} 19683934Sbrooks 197126781Srwatsonstatic void 198126781Srwatsonfaith_destroy(struct faith_softc *sc) 199126781Srwatson{ 200126781Srwatson 201147256Sbrooks bpfdetach(sc->sc_ifp); 202147256Sbrooks if_detach(sc->sc_ifp); 203147256Sbrooks if_free(sc->sc_ifp); 204126781Srwatson free(sc, M_FAITH); 205126781Srwatson} 206126781Srwatson 207128209Sbrooksstatic void 20883934Sbrooksfaith_clone_destroy(ifp) 20983934Sbrooks struct ifnet *ifp; 21083934Sbrooks{ 211147256Sbrooks struct faith_softc *sc = ifp->if_softc; 21283934Sbrooks 213126781Srwatson mtx_lock(&faith_mtx); 21483934Sbrooks LIST_REMOVE(sc, sc_list); 215126781Srwatson mtx_unlock(&faith_mtx); 21683934Sbrooks 217126781Srwatson faith_destroy(sc); 21883934Sbrooks} 21983934Sbrooks 22083934Sbrooksint 22178064Sumefaithoutput(ifp, m, dst, rt) 22278064Sume struct ifnet *ifp; 22378064Sume struct mbuf *m; 22478064Sume struct sockaddr *dst; 22578064Sume struct rtentry *rt; 22678064Sume{ 22778064Sume int isr; 228147611Sdwmalone u_int32_t af; 22978064Sume 230113255Sdes M_ASSERTPKTHDR(m); 23183934Sbrooks 232147611Sdwmalone /* BPF writes need to be handled specially. */ 23378064Sume if (dst->sa_family == AF_UNSPEC) { 234147611Sdwmalone bcopy(dst->sa_data, &af, sizeof(af)); 235147611Sdwmalone dst->sa_family = af; 23678064Sume } 23778064Sume 23878064Sume if (ifp->if_bpf) { 239147611Sdwmalone af = dst->sa_family; 240123922Ssam bpf_mtap2(ifp->if_bpf, &af, sizeof(af), m); 24178064Sume } 24278064Sume 24378064Sume if (rt && rt->rt_flags & (RTF_REJECT|RTF_BLACKHOLE)) { 24478064Sume m_freem(m); 24578064Sume return (rt->rt_flags & RTF_BLACKHOLE ? 0 : 24678064Sume rt->rt_flags & RTF_HOST ? EHOSTUNREACH : ENETUNREACH); 24778064Sume } 24878064Sume ifp->if_opackets++; 24978064Sume ifp->if_obytes += m->m_pkthdr.len; 25078064Sume switch (dst->sa_family) { 25178064Sume#ifdef INET 25278064Sume case AF_INET: 25378064Sume isr = NETISR_IP; 25478064Sume break; 25578064Sume#endif 25678064Sume#ifdef INET6 25778064Sume case AF_INET6: 25878064Sume isr = NETISR_IPV6; 25978064Sume break; 26078064Sume#endif 26178064Sume default: 26278064Sume m_freem(m); 26378064Sume return EAFNOSUPPORT; 26478064Sume } 26578064Sume 26678064Sume /* XXX do we need more sanity checks? */ 26778064Sume 26878064Sume m->m_pkthdr.rcvif = ifp; 26978064Sume ifp->if_ipackets++; 27078064Sume ifp->if_ibytes += m->m_pkthdr.len; 271111888Sjlemon netisr_dispatch(isr, m); 27278064Sume return (0); 27378064Sume} 27478064Sume 27578064Sume/* ARGSUSED */ 27678064Sumestatic void 27785074Srufaithrtrequest(cmd, rt, info) 27878064Sume int cmd; 27978064Sume struct rtentry *rt; 28085074Sru struct rt_addrinfo *info; 28178064Sume{ 282120727Ssam RT_LOCK_ASSERT(rt); 283142352Ssam rt->rt_rmx.rmx_mtu = rt->rt_ifp->if_mtu; 28478064Sume} 28578064Sume 28678064Sume/* 28778064Sume * Process an ioctl request. 28878064Sume */ 28978064Sume/* ARGSUSED */ 29078064Sumestatic int 29178064Sumefaithioctl(ifp, cmd, data) 29278064Sume struct ifnet *ifp; 29378064Sume u_long cmd; 29478064Sume caddr_t data; 29578064Sume{ 29678064Sume struct ifaddr *ifa; 29778064Sume struct ifreq *ifr = (struct ifreq *)data; 29878064Sume int error = 0; 29978064Sume 30078064Sume switch (cmd) { 30178064Sume 30278064Sume case SIOCSIFADDR: 303148887Srwatson ifp->if_flags |= IFF_UP; 304148887Srwatson ifp->if_drv_flags |= IFF_DRV_RUNNING; 30578064Sume ifa = (struct ifaddr *)data; 30678064Sume ifa->ifa_rtrequest = faithrtrequest; 30778064Sume /* 30878064Sume * Everything else is done at a higher level. 30978064Sume */ 31078064Sume break; 31178064Sume 31278064Sume case SIOCADDMULTI: 31378064Sume case SIOCDELMULTI: 31478064Sume if (ifr == 0) { 31578064Sume error = EAFNOSUPPORT; /* XXX */ 31678064Sume break; 31778064Sume } 31878064Sume switch (ifr->ifr_addr.sa_family) { 31978064Sume#ifdef INET 32078064Sume case AF_INET: 32178064Sume break; 32278064Sume#endif 32378064Sume#ifdef INET6 32478064Sume case AF_INET6: 32578064Sume break; 32678064Sume#endif 32778064Sume 32878064Sume default: 32978064Sume error = EAFNOSUPPORT; 33078064Sume break; 33178064Sume } 33278064Sume break; 33378064Sume 33478064Sume#ifdef SIOCSIFMTU 33578064Sume case SIOCSIFMTU: 33678064Sume ifp->if_mtu = ifr->ifr_mtu; 33778064Sume break; 33878064Sume#endif 33978064Sume 34078064Sume case SIOCSIFFLAGS: 34178064Sume break; 34278064Sume 34378064Sume default: 34478064Sume error = EINVAL; 34578064Sume } 34678064Sume return (error); 34778064Sume} 34878064Sume 34979326Sume#ifdef INET6 35078064Sume/* 35178064Sume * XXX could be slow 35278064Sume * XXX could be layer violation to call sys/net from sys/netinet6 35378064Sume */ 35483934Sbrooksstatic int 35578064Sumefaithprefix(in6) 35678064Sume struct in6_addr *in6; 35778064Sume{ 35878064Sume struct rtentry *rt; 35978064Sume struct sockaddr_in6 sin6; 36078064Sume int ret; 36178064Sume 36278064Sume if (ip6_keepfaith == 0) 36378064Sume return 0; 36478064Sume 36578064Sume bzero(&sin6, sizeof(sin6)); 36678064Sume sin6.sin6_family = AF_INET6; 36778064Sume sin6.sin6_len = sizeof(struct sockaddr_in6); 36878064Sume sin6.sin6_addr = *in6; 36978064Sume rt = rtalloc1((struct sockaddr *)&sin6, 0, 0UL); 37078064Sume if (rt && rt->rt_ifp && rt->rt_ifp->if_type == IFT_FAITH && 37178064Sume (rt->rt_ifp->if_flags & IFF_UP) != 0) 37278064Sume ret = 1; 37378064Sume else 37478064Sume ret = 0; 37578064Sume if (rt) 376120727Ssam RTFREE_LOCKED(rt); 37778064Sume return ret; 37878064Sume} 37979326Sume#endif 380