6/sys/net/if_faith.c

   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
  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
  85 struct faith_softc {
  86         struct ifnet *sc_ifp;
  87         LIST_ENTRY(faith_softc) sc_list;
  88 };
  89
  90 static int faithioctl(struct ifnet *, u_long, caddr_t);
  91 int faithoutput(struct ifnet *, struct mbuf *, struct sockaddr *,
  92         struct rtentry *);
  93 static void faithrtrequest(int, struct rtentry *, struct rt_addrinfo *);
  94 #ifdef INET6
  95 static int faithprefix(struct in6_addr *);
  96 #endif
  97
  98 static int faithmodevent(module_t, int, void *);
  99
 100 static struct mtx faith_mtx;
 101 static MALLOC_DEFINE(M_FAITH, FAITHNAME, "Firewall Assisted Tunnel Interface");
 102 static LIST_HEAD(, faith_softc) faith_softc_list;
 103
 104 static int      faith_clone_create(struct if_clone *, int);
 105 static void     faith_clone_destroy(struct ifnet *);
 106 static void     faith_destroy(struct faith_softc *);
 107
 108 IFC_SIMPLE_DECLARE(faith, 0);
 109
 110 #define FAITHMTU        1500
 111
 112 static int
 113 faithmodevent(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
 154 static moduledata_t faith_mod = {
 155         "if_faith",
 156         faithmodevent,
 157         0
 158 };
 159
 160 DECLARE_MODULE(if_faith, faith_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
 161 MODULE_VERSION(if_faith, 1);
 162
 163 static int
 164 faith_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
 197 static void
 198 faith_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
 207 static void
 208 faith_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
 220 int
 221 faithoutput(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 (bpf_peers_present(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 */
 276 static void
 277 faithrtrequest(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 */
 290 static int
 291 faithioctl(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  */
 354 static int
 355 faithprefix(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