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$ 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#include <net/vnet.h> 65 66#ifdef INET 67#include <netinet/in.h> 68#include <netinet/in_systm.h> 69#include <netinet/in_var.h> 70#include <netinet/ip.h> 71#endif 72 73#ifdef INET6 74#ifndef INET 75#include <netinet/in.h> 76#endif 77#include <netinet6/in6_var.h> 78#include <netinet/ip6.h> 79#include <netinet6/ip6_var.h> 80#endif 81 82#define FAITHNAME "faith" 83 84struct faith_softc { 85 struct ifnet *sc_ifp; 86}; 87 88static int faithioctl(struct ifnet *, u_long, caddr_t); 89int faithoutput(struct ifnet *, struct mbuf *, struct sockaddr *, 90 struct route *); 91static void faithrtrequest(int, struct rtentry *, struct rt_addrinfo *); 92#ifdef INET6 93static int faithprefix(struct in6_addr *); 94#endif 95 96static int faithmodevent(module_t, int, void *); 97 98static MALLOC_DEFINE(M_FAITH, FAITHNAME, "Firewall Assisted Tunnel Interface"); 99 100static int faith_clone_create(struct if_clone *, int, caddr_t); 101static void faith_clone_destroy(struct ifnet *); 102 103IFC_SIMPLE_DECLARE(faith, 0); 104 105#define FAITHMTU 1500 106 107static int 108faithmodevent(mod, type, data) 109 module_t mod; 110 int type; 111 void *data; 112{ 113 114 switch (type) { 115 case MOD_LOAD: 116 if_clone_attach(&faith_cloner); 117 118#ifdef INET6 119 faithprefix_p = faithprefix; 120#endif 121 122 break; 123 case MOD_UNLOAD: 124#ifdef INET6 125 faithprefix_p = NULL; 126#endif 127 128 if_clone_detach(&faith_cloner); 129 break; 130 default: 131 return EOPNOTSUPP; 132 } 133 return 0; 134} 135 136static moduledata_t faith_mod = { 137 "if_faith", 138 faithmodevent, 139 0 140}; 141 142DECLARE_MODULE(if_faith, faith_mod, SI_SUB_PSEUDO, SI_ORDER_ANY); 143MODULE_VERSION(if_faith, 1); 144 145static int 146faith_clone_create(ifc, unit, params) 147 struct if_clone *ifc; 148 int unit; 149 caddr_t params; 150{ 151 struct ifnet *ifp; 152 struct faith_softc *sc; 153 154 sc = malloc(sizeof(struct faith_softc), M_FAITH, M_WAITOK | M_ZERO); 155 ifp = sc->sc_ifp = if_alloc(IFT_FAITH); 156 if (ifp == NULL) { 157 free(sc, M_FAITH); 158 return (ENOSPC); 159 } 160 161 ifp->if_softc = sc; 162 if_initname(sc->sc_ifp, ifc->ifc_name, unit); 163 164 ifp->if_mtu = FAITHMTU; 165 /* Change to BROADCAST experimentaly to announce its prefix. */ 166 ifp->if_flags = /* IFF_LOOPBACK */ IFF_BROADCAST | IFF_MULTICAST; 167 ifp->if_ioctl = faithioctl; 168 ifp->if_output = faithoutput; 169 ifp->if_hdrlen = 0; 170 ifp->if_addrlen = 0; 171 ifp->if_snd.ifq_maxlen = ifqmaxlen; 172 if_attach(ifp); 173 bpfattach(ifp, DLT_NULL, sizeof(u_int32_t)); 174 return (0); 175} 176 177static void 178faith_clone_destroy(ifp) 179 struct ifnet *ifp; 180{ 181 struct faith_softc *sc = ifp->if_softc; 182 183 bpfdetach(ifp); 184 if_detach(ifp); 185 if_free(ifp); 186 free(sc, M_FAITH); 187} 188 189int 190faithoutput(ifp, m, dst, ro) 191 struct ifnet *ifp; 192 struct mbuf *m; 193 struct sockaddr *dst; 194 struct route *ro; 195{ 196 int isr; 197 u_int32_t af; 198 struct rtentry *rt = NULL; 199 200 M_ASSERTPKTHDR(m); 201 202 if (ro != NULL) 203 rt = ro->ro_rt; 204 /* BPF writes need to be handled specially. */ 205 if (dst->sa_family == AF_UNSPEC) { 206 bcopy(dst->sa_data, &af, sizeof(af)); 207 dst->sa_family = af; 208 } 209 210 if (bpf_peers_present(ifp->if_bpf)) { 211 af = dst->sa_family; 212 bpf_mtap2(ifp->if_bpf, &af, sizeof(af), m); 213 } 214 215 if (rt && rt->rt_flags & (RTF_REJECT|RTF_BLACKHOLE)) { 216 m_freem(m); 217 return (rt->rt_flags & RTF_BLACKHOLE ? 0 : 218 rt->rt_flags & RTF_HOST ? EHOSTUNREACH : ENETUNREACH); 219 } 220 ifp->if_opackets++; 221 ifp->if_obytes += m->m_pkthdr.len; 222 switch (dst->sa_family) { 223#ifdef INET 224 case AF_INET: 225 isr = NETISR_IP; 226 break; 227#endif 228#ifdef INET6 229 case AF_INET6: 230 isr = NETISR_IPV6; 231 break; 232#endif 233 default: 234 m_freem(m); 235 return EAFNOSUPPORT; 236 } 237 238 /* XXX do we need more sanity checks? */ 239 240 m->m_pkthdr.rcvif = ifp; 241 ifp->if_ipackets++; 242 ifp->if_ibytes += m->m_pkthdr.len; 243 netisr_dispatch(isr, m); 244 return (0); 245} 246 247/* ARGSUSED */ 248static void 249faithrtrequest(cmd, rt, info) 250 int cmd; 251 struct rtentry *rt; 252 struct rt_addrinfo *info; 253{ 254 RT_LOCK_ASSERT(rt); 255 rt->rt_rmx.rmx_mtu = rt->rt_ifp->if_mtu; 256} 257 258/* 259 * Process an ioctl request. 260 */ 261/* ARGSUSED */ 262static int 263faithioctl(ifp, cmd, data) 264 struct ifnet *ifp; 265 u_long cmd; 266 caddr_t data; 267{ 268 struct ifaddr *ifa; 269 struct ifreq *ifr = (struct ifreq *)data; 270 int error = 0; 271 272 switch (cmd) { 273 274 case SIOCSIFADDR: 275 ifp->if_flags |= IFF_UP; 276 ifp->if_drv_flags |= IFF_DRV_RUNNING; 277 ifa = (struct ifaddr *)data; 278 ifa->ifa_rtrequest = faithrtrequest; 279 /* 280 * Everything else is done at a higher level. 281 */ 282 break; 283 284 case SIOCADDMULTI: 285 case SIOCDELMULTI: 286 if (ifr == 0) { 287 error = EAFNOSUPPORT; /* XXX */ 288 break; 289 } 290 switch (ifr->ifr_addr.sa_family) { 291#ifdef INET 292 case AF_INET: 293 break; 294#endif 295#ifdef INET6 296 case AF_INET6: 297 break; 298#endif 299 300 default: 301 error = EAFNOSUPPORT; 302 break; 303 } 304 break; 305 306#ifdef SIOCSIFMTU 307 case SIOCSIFMTU: 308 ifp->if_mtu = ifr->ifr_mtu; 309 break; 310#endif 311 312 case SIOCSIFFLAGS: 313 break; 314 315 default: 316 error = EINVAL; 317 } 318 return (error); 319} 320 321#ifdef INET6 322/* 323 * XXX could be slow 324 * XXX could be layer violation to call sys/net from sys/netinet6 325 */ 326static int 327faithprefix(in6) 328 struct in6_addr *in6; 329{ 330 struct rtentry *rt; 331 struct sockaddr_in6 sin6; 332 int ret; 333 334 if (V_ip6_keepfaith == 0) 335 return 0; 336 337 bzero(&sin6, sizeof(sin6)); 338 sin6.sin6_family = AF_INET6; 339 sin6.sin6_len = sizeof(struct sockaddr_in6); 340 sin6.sin6_addr = *in6; 341 rt = in6_rtalloc1((struct sockaddr *)&sin6, 0, 0UL, RT_DEFAULT_FIB); 342 if (rt && rt->rt_ifp && rt->rt_ifp->if_type == IFT_FAITH && 343 (rt->rt_ifp->if_flags & IFF_UP) != 0) 344 ret = 1; 345 else 346 ret = 0; 347 if (rt) 348 RTFREE_LOCKED(rt); 349 return ret; 350} 351#endif 352