sys/netinet/in_gif.c

   1 /*-
   2  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  * 3. Neither the name of the project nor the names of its contributors
  14  *    may be used to endorse or promote products derived from this software
  15  *    without specific prior written permission.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
  18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
  21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27  * SUCH DAMAGE.
  28  *
  29  *      $KAME: in_gif.c,v 1.54 2001/05/14 14:02:16 itojun Exp $
  30  */
  31
  32 #include <sys/cdefs.h>
  33 __FBSDID("$FreeBSD$");
  34
  35 #include "opt_inet.h"
  36 #include "opt_inet6.h"
  37
  38 #include <sys/param.h>
  39 #include <sys/lock.h>
  40 #include <sys/rmlock.h>
  41 #include <sys/systm.h>
  42 #include <sys/socket.h>
  43 #include <sys/sockio.h>
  44 #include <sys/mbuf.h>
  45 #include <sys/errno.h>
  46 #include <sys/kernel.h>
  47 #include <sys/sysctl.h>
  48 #include <sys/protosw.h>
  49 #include <sys/malloc.h>
  50
  51 #include <net/if.h>
  52 #include <net/if_var.h>
  53 #include <net/route.h>
  54 #include <net/vnet.h>
  55
  56 #include <netinet/in.h>
  57 #include <netinet/in_systm.h>
  58 #include <netinet/ip.h>
  59 #include <netinet/ip_var.h>
  60 #include <netinet/in_gif.h>
  61 #include <netinet/in_var.h>
  62 #include <netinet/ip_encap.h>
  63 #include <netinet/ip_ecn.h>
  64
  65 #ifdef INET6
  66 #include <netinet/ip6.h>
  67 #endif
  68
  69 #include <net/if_gif.h>
  70
  71 static int gif_validate4(const struct ip *, struct gif_softc *,
  72         struct ifnet *);
  73
  74 static void in_gif_input10(struct mbuf *, int);
  75 extern  struct domain inetdomain;
  76 struct protosw in_gif_protosw = {
  77         .pr_type =              SOCK_RAW,
  78         .pr_domain =            &inetdomain,
  79         .pr_protocol =          0/* IPPROTO_IPV[46] */,
  80         .pr_flags =             PR_ATOMIC|PR_ADDR,
  81         .pr_input =             in_gif_input10,
  82         .pr_output =            (pr_output_t*)rip_output,
  83         .pr_ctloutput =         rip_ctloutput,
  84         .pr_usrreqs =           &rip_usrreqs
  85 };
  86
  87 VNET_DEFINE(int, ip_gif_ttl) = GIF_TTL;
  88 #define V_ip_gif_ttl            VNET(ip_gif_ttl)
  89 SYSCTL_VNET_INT(_net_inet_ip, IPCTL_GIF_TTL, gifttl, CTLFLAG_RW,
  90         &VNET_NAME(ip_gif_ttl), 0, "");
  91
  92 int
  93 in_gif_output(struct ifnet *ifp, struct mbuf *m, int proto, uint8_t ecn)
  94 {
  95         GIF_RLOCK_TRACKER;
  96         struct gif_softc *sc = ifp->if_softc;
  97         struct ip *ip;
  98         int len;
  99
 100         /* prepend new IP header */
 101         len = sizeof(struct ip);
 102 #ifndef __NO_STRICT_ALIGNMENT
 103         if (proto == IPPROTO_ETHERIP)
 104                 len += ETHERIP_ALIGN;
 105 #endif
 106         M_PREPEND(m, len, M_NOWAIT);
 107         if (m == NULL)
 108                 return (ENOBUFS);
 109 #ifndef __NO_STRICT_ALIGNMENT
 110         if (proto == IPPROTO_ETHERIP) {
 111                 len = mtod(m, vm_offset_t) & 3;
 112                 KASSERT(len == 0 || len == ETHERIP_ALIGN,
 113                     ("in_gif_output: unexpected misalignment"));
 114                 m->m_data += len;
 115                 m->m_len -= ETHERIP_ALIGN;
 116         }
 117 #endif
 118         ip = mtod(m, struct ip *);
 119         GIF_RLOCK(sc);
 120         if (sc->gif_family != AF_INET) {
 121                 m_freem(m);
 122                 GIF_RUNLOCK(sc);
 123                 return (ENETDOWN);
 124         }
 125         bcopy(sc->gif_iphdr, ip, sizeof(struct ip));
 126         GIF_RUNLOCK(sc);
 127
 128         ip->ip_p = proto;
 129         /* version will be set in ip_output() */
 130         ip->ip_ttl = V_ip_gif_ttl;
 131         ip->ip_len = htons(m->m_pkthdr.len);
 132         ip->ip_tos = ecn;
 133
 134         return (ip_output(m, NULL, NULL, 0, NULL, NULL));
 135 }
 136
 137 static void
 138 in_gif_input10(struct mbuf *m, int off)
 139 {
 140         int proto;
 141
 142         proto = (mtod(m, struct ip *))->ip_p;
 143         in_gif_input(&m, &off, proto);
 144 }
 145
 146 int
 147 in_gif_input(struct mbuf **mp, int *offp, int proto)
 148 {
 149         struct mbuf *m = *mp;
 150         struct gif_softc *sc;
 151         struct ifnet *gifp;
 152         struct ip *ip;
 153         uint8_t ecn;
 154
 155         sc = encap_getarg(m);
 156         if (sc == NULL) {
 157                 m_freem(m);
 158                 KMOD_IPSTAT_INC(ips_nogif);
 159                 return (IPPROTO_DONE);
 160         }
 161         gifp = GIF2IFP(sc);
 162         if ((gifp->if_flags & IFF_UP) != 0) {
 163                 ip = mtod(m, struct ip *);
 164                 ecn = ip->ip_tos;
 165                 m_adj(m, *offp);
 166                 gif_input(m, gifp, proto, ecn);
 167         } else {
 168                 m_freem(m);
 169                 KMOD_IPSTAT_INC(ips_nogif);
 170         }
 171         return (IPPROTO_DONE);
 172 }
 173
 174 /*
 175  * validate outer address.
 176  */
 177 static int
 178 gif_validate4(const struct ip *ip, struct gif_softc *sc, struct ifnet *ifp)
 179 {
 180         int ret;
 181
 182         GIF_RLOCK_ASSERT(sc);
 183
 184         /* check for address match */
 185         if (sc->gif_iphdr->ip_src.s_addr != ip->ip_dst.s_addr)
 186                 return (0);
 187         ret = 32;
 188         if (sc->gif_iphdr->ip_dst.s_addr != ip->ip_src.s_addr) {
 189                 if ((sc->gif_options & GIF_IGNORE_SOURCE) == 0)
 190                         return (0);
 191         } else
 192                 ret += 32;
 193
 194         /* martian filters on outer source - NOT done in ip_input! */
 195         if (IN_MULTICAST(ntohl(ip->ip_src.s_addr)))
 196                 return (0);
 197         switch ((ntohl(ip->ip_src.s_addr) & 0xff000000) >> 24) {
 198         case 0:
 199         case 127:
 200         case 255:
 201                 return (0);
 202         }
 203
 204         /* ingress filters on outer source */
 205         if ((GIF2IFP(sc)->if_flags & IFF_LINK2) == 0 && ifp) {
 206                 struct sockaddr_in sin;
 207                 struct rtentry *rt;
 208
 209                 bzero(&sin, sizeof(sin));
 210                 sin.sin_family = AF_INET;
 211                 sin.sin_len = sizeof(struct sockaddr_in);
 212                 sin.sin_addr = ip->ip_src;
 213                 /* XXX MRT  check for the interface we would use on output */
 214                 rt = in_rtalloc1((struct sockaddr *)&sin, 0,
 215                     0UL, sc->gif_fibnum);
 216                 if (!rt || rt->rt_ifp != ifp) {
 217                         if (rt)
 218                                 RTFREE_LOCKED(rt);
 219                         return (0);
 220                 }
 221                 RTFREE_LOCKED(rt);
 222         }
 223         return (ret);
 224 }
 225
 226 /*
 227  * we know that we are in IFF_UP, outer address available, and outer family
 228  * matched the physical addr family.  see gif_encapcheck().
 229  */
 230 int
 231 in_gif_encapcheck(const struct mbuf *m, int off, int proto, void *arg)
 232 {
 233         struct ip ip;
 234         struct gif_softc *sc;
 235         struct ifnet *ifp;
 236
 237         /* sanity check done in caller */
 238         sc = (struct gif_softc *)arg;
 239         GIF_RLOCK_ASSERT(sc);
 240
 241         m_copydata(m, 0, sizeof(ip), (caddr_t)&ip);
 242         ifp = ((m->m_flags & M_PKTHDR) != 0) ? m->m_pkthdr.rcvif : NULL;
 243         return (gif_validate4(&ip, sc, ifp));
 244 }
 245
 246 int
 247 in_gif_attach(struct gif_softc *sc)
 248 {
 249
 250         KASSERT(sc->gif_ecookie == NULL, ("gif_ecookie isn't NULL"));
 251         sc->gif_ecookie = encap_attach_func(AF_INET, -1, gif_encapcheck,
 252             &in_gif_protosw, sc);
 253         if (sc->gif_ecookie == NULL)
 254                 return (EEXIST);
 255         return (0);
 256 }