sys/netproto/ipx/ipx_ip.c

   1 /*
   2  * Copyright (c) 1995, Mike Mitchell
   3  * Copyright (c) 1984, 1985, 1986, 1987, 1993
   4  *      The Regents of the University of California.  All rights reserved.
   5  *
   6  * Redistribution and use in source and binary forms, with or without
   7  * modification, are permitted provided that the following conditions
   8  * are met:
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  * 3. All advertising materials mentioning features or use of this software
  15  *    must display the following acknowledgement:
  16  *      This product includes software developed by the University of
  17  *      California, Berkeley and its contributors.
  18  * 4. Neither the name of the University nor the names of its contributors
  19  *    may be used to endorse or promote products derived from this software
  20  *    without specific prior written permission.
  21  *
  22  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  23  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  24  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  25  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  26  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  27  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  28  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  29  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  30  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  31  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  32  * SUCH DAMAGE.
  33  *
  34  *      @(#)ipx_ip.c
  35  *
  36  * $FreeBSD: src/sys/netipx/ipx_ip.c,v 1.24.2.2 2003/01/23 21:06:48 sam Exp $
  37  * $DragonFly: src/sys/netproto/ipx/ipx_ip.c,v 1.18 2008/06/08 08:38:05 sephe Exp $
  38  */
  39
  40 /*
  41  * Software interface driver for encapsulating IPX in IP.
  42  */
  43
  44 #include "opt_inet.h"
  45 #include "opt_ipx.h"
  46
  47 #ifdef IPXIP
  48 #ifndef INET
  49 #error The option IPXIP requires option INET.
  50 #endif
  51
  52 #include <sys/param.h>
  53 #include <sys/systm.h>
  54 #include <sys/malloc.h>
  55 #include <sys/mbuf.h>
  56 #include <sys/protosw.h>
  57 #include <sys/socket.h>
  58 #include <sys/socketvar.h>
  59 #include <sys/sockio.h>
  60
  61 #include <net/if.h>
  62 #include <net/netisr.h>
  63 #include <net/route.h>
  64
  65 #include <netinet/in.h>
  66 #include <netinet/in_systm.h>
  67 #include <netinet/in_var.h>
  68 #include <netinet/ip.h>
  69 #include <netinet/ip_var.h>
  70
  71 #include "ipx.h"
  72 #include "ipx_if.h"
  73 #include "ipx_ip.h"
  74 #include "ipx_var.h"
  75
  76 static struct   ifnet ipxipif;
  77 static int      ipxipif_units;
  78
  79 /* list of all hosts and gateways or broadcast addrs */
  80 static struct   ifnet_en *ipxip_list;
  81
  82 static  struct ifnet_en *ipxipattach(void);
  83 static  int ipxip_free(struct ifnet *ifp);
  84 static  int ipxipioctl(struct ifnet *ifp, u_long cmd, caddr_t data,
  85                        struct ucred *cr);
  86 static  int ipxipoutput(struct ifnet *ifp, struct mbuf *m,
  87                         struct sockaddr *dst, struct rtentry *rt);
  88 static  void ipxip_rtchange(struct in_addr *dst);
  89 static  void ipxipstart(struct ifnet *ifp);
  90
  91 static struct ifnet_en *
  92 ipxipattach(void)
  93 {
  94         struct ifnet_en *m;
  95         struct ifnet *ifp;
  96
  97         if (ipxipif.if_mtu == 0) {
  98                 ifp = &ipxipif;
  99                 if_initname(ifp, "ipxip", ipxipif_units);
 100                 ifp->if_mtu = LOMTU;
 101                 ifp->if_ioctl = ipxipioctl;
 102                 ifp->if_output = ipxipoutput;
 103                 ifp->if_start = ipxipstart;
 104                 ifp->if_flags = IFF_POINTOPOINT;
 105         }
 106
 107         MALLOC((m), struct ifnet_en *, sizeof(*m), M_PCB, M_WAITOK | M_ZERO);
 108         m->ifen_next = ipxip_list;
 109         ipxip_list = m;
 110         ifp = &m->ifen_ifnet;
 111
 112         if_initname(ifp, "ipxip", ipxipif_units++);
 113         ifp->if_mtu = LOMTU;
 114         ifp->if_ioctl = ipxipioctl;
 115         ifp->if_output = ipxipoutput;
 116         ifp->if_start = ipxipstart;
 117         ifp->if_flags = IFF_POINTOPOINT;
 118         if_attach(ifp, NULL);
 119
 120         return (m);
 121 }
 122
 123
 124 /*
 125  * Process an ioctl request.
 126  */
 127 static int
 128 ipxipioctl(struct ifnet *ifp, u_long cmd, caddr_t data, struct ucred *cr)
 129 {
 130         int error = 0;
 131         struct ifreq *ifr;
 132
 133         switch (cmd) {
 134
 135         case SIOCSIFADDR:
 136                 ifp->if_flags |= IFF_UP;
 137                 /* fall into: */
 138
 139         case SIOCSIFDSTADDR:
 140                 /*
 141                  * Everything else is done at a higher level.
 142                  */
 143                 break;
 144
 145         case SIOCSIFFLAGS:
 146                 ifr = (struct ifreq *)data;
 147                 if ((ifr->ifr_flags & IFF_UP) == 0)
 148                         error = ipxip_free(ifp);
 149
 150
 151         default:
 152                 error = EINVAL;
 153         }
 154         return (error);
 155 }
 156
 157 static struct mbuf *ipxip_badlen;
 158 static struct mbuf *ipxip_lastin;
 159 static int ipxip_hold_input;
 160
 161 int
 162 ipxip_input(struct mbuf **mp, int *offp, int proto)
 163 {
 164         struct mbuf *m = *mp;
 165         struct ip *ip;
 166         struct ipx *ipx;
 167         int len, s;
 168
 169         if (ipxip_hold_input) {
 170                 if (ipxip_lastin != NULL) {
 171                         m_freem(ipxip_lastin);
 172                 }
 173                 ipxip_lastin = m_copym(m, 0, (int)M_COPYALL, MB_DONTWAIT);
 174         }
 175         /*
 176          * Get IP and IPX header together in first mbuf.
 177          */
 178         ipxipif.if_ipackets++;
 179         s = sizeof(struct ip) + sizeof(struct ipx);
 180         if (((m->m_flags & M_EXT) || m->m_len < s) &&
 181             (m = m_pullup(m, s)) == NULL) {
 182                 ipxipif.if_ierrors++;
 183                 return(IPPROTO_DONE);
 184         }
 185         ip = mtod(m, struct ip *);
 186         if (ip->ip_hl > (sizeof(struct ip) >> 2)) {
 187                 ip_stripoptions(m);
 188                 if (m->m_len < s) {
 189                         if ((m = m_pullup(m, s)) == NULL) {
 190                                 ipxipif.if_ierrors++;
 191                                 return(IPPROTO_DONE);
 192                         }
 193                         ip = mtod(m, struct ip *);
 194                 }
 195         }
 196
 197         /*
 198          * Make mbuf data length reflect IPX length.
 199          * If not enough data to reflect IPX length, drop.
 200          */
 201         m->m_data += sizeof(struct ip);
 202         m->m_len -= sizeof(struct ip);
 203         m->m_pkthdr.len -= sizeof(struct ip);
 204         ipx = mtod(m, struct ipx *);
 205         len = ntohs(ipx->ipx_len);
 206         if (len & 1)
 207                 len++;          /* Preserve Garbage Byte */
 208         if (ip->ip_len != len) {
 209                 if (len > ip->ip_len) {
 210                         ipxipif.if_ierrors++;
 211                         if (ipxip_badlen)
 212                                 m_freem(ipxip_badlen);
 213                         ipxip_badlen = m;
 214                         return(IPPROTO_DONE);
 215                 }
 216                 /* Any extra will be trimmed off by the IPX routines */
 217         }
 218
 219         /*
 220          * Deliver to IPX
 221          */
 222         netisr_queue(NETISR_IPX, m);
 223         return(IPPROTO_DONE);
 224 }
 225
 226 static int
 227 ipxipoutput_serialized(struct ifnet *ifp, struct mbuf *m, struct sockaddr *dst,
 228                        struct rtentry *rt)
 229 {
 230         struct ifnet_en *ifn = (struct ifnet_en *)ifp;
 231         struct ip *ip;
 232         struct route *ro = &(ifn->ifen_route);
 233         int len = 0;
 234         struct ipx *ipx = mtod(m, struct ipx *);
 235         int error;
 236
 237         ifn->ifen_ifnet.if_opackets++;
 238         ipxipif.if_opackets++;
 239
 240         /*
 241          * Calculate data length and make space
 242          * for IP header.
 243          */
 244         len =  ntohs(ipx->ipx_len);
 245         if (len & 1)
 246                 len++;          /* Preserve Garbage Byte */
 247         /* following clause not necessary on vax */
 248         if (3 & (int)m->m_data) {
 249                 /* force longword alignment of ip hdr */
 250                 struct mbuf *m0 = m_gethdr(MT_HEADER, MB_DONTWAIT);
 251                 if (m0 == NULL) {
 252                         m_freem(m);
 253                         return (ENOBUFS);
 254                 }
 255                 MH_ALIGN(m0, sizeof(struct ip));
 256                 m0->m_flags = m->m_flags & M_COPYFLAGS;
 257                 m0->m_next = m;
 258                 m0->m_len = sizeof(struct ip);
 259                 m0->m_pkthdr.len = m0->m_len + m->m_len;
 260                 m = m0;
 261         } else {
 262                 M_PREPEND(m, sizeof(struct ip), MB_DONTWAIT);
 263                 if (m == NULL)
 264                         return (ENOBUFS);
 265         }
 266         /*
 267          * Fill in IP header.
 268          */
 269         ip = mtod(m, struct ip *);
 270         *(long *)ip = 0;
 271         ip->ip_p = IPPROTO_IDP;
 272         ip->ip_src = ifn->ifen_src;
 273         ip->ip_dst = ifn->ifen_dst;
 274         ip->ip_len = (u_short)len + sizeof(struct ip);
 275         ip->ip_ttl = MAXTTL;
 276
 277         /*
 278          * Output final datagram.
 279          */
 280         error =  (ip_output(m, NULL, ro, SO_BROADCAST, NULL, NULL));
 281         if (error) {
 282                 ifn->ifen_ifnet.if_oerrors++;
 283                 ifn->ifen_ifnet.if_ierrors = error;
 284         }
 285         return (error);
 286         m_freem(m);
 287         return (ENETUNREACH);
 288 }
 289
 290 static int
 291 ipxipoutput(struct ifnet *ifp, struct mbuf *m, struct sockaddr *dst,
 292             struct rtentry *rt)
 293 {
 294         int error;
 295
 296         ifnet_serialize_tx(ifp);
 297         error = ipxipoutput_serialized(ifp, m, dst, rt);
 298         ifnet_deserialize_tx(ifp);
 299
 300         return error;
 301 }
 302
 303 static void
 304 ipxipstart(struct ifnet *ifp)
 305 {
 306         panic("ipxip_start called\n");
 307 }
 308
 309 static struct ifreq ifr_ipxip = {"ipxip0"};
 310
 311 int
 312 ipxip_route(struct socket *so, struct sockopt *sopt)
 313 {
 314         int error;
 315         struct ifnet_en *ifn;
 316         struct sockaddr_in *src;
 317         struct ipxip_req rq;
 318         struct sockaddr_ipx *ipx_dst;
 319         struct sockaddr_in *ip_dst;
 320         struct route ro;
 321
 322         error = sooptcopyin(sopt, &rq, sizeof rq, sizeof rq);
 323         if (error)
 324                 return (error);
 325         ipx_dst = (struct sockaddr_ipx *)&rq.rq_ipx;
 326         ip_dst = (struct sockaddr_in *)&rq.rq_ip;
 327
 328         /*
 329          * First, make sure we already have an IPX address:
 330          */
 331         if (ipx_ifaddr == NULL)
 332                 return (EADDRNOTAVAIL);
 333         /*
 334          * Now, determine if we can get to the destination
 335          */
 336         bzero((caddr_t)&ro, sizeof(ro));
 337         ro.ro_dst = *(struct sockaddr *)ip_dst;
 338         rtalloc(&ro);
 339         if (ro.ro_rt == NULL || ro.ro_rt->rt_ifp == NULL) {
 340                 return (ENETUNREACH);
 341         }
 342
 343         /*
 344          * And see how he's going to get back to us:
 345          * i.e., what return ip address do we use?
 346          */
 347         {
 348                 struct in_ifaddr *ia;
 349                 struct in_ifaddr_container *iac;
 350                 struct ifnet *ifp = ro.ro_rt->rt_ifp;
 351
 352                 ia = NULL;
 353                 TAILQ_FOREACH(iac, &in_ifaddrheads[mycpuid], ia_link) {
 354                         if (iac->ia->ia_ifp == ifp) {
 355                                 ia = iac->ia;
 356                                 break;
 357                         }
 358                 }
 359                 if (ia == NULL && !TAILQ_EMPTY(&in_ifaddrheads[mycpuid]))
 360                         ia = TAILQ_FIRST(&in_ifaddrheads[mycpuid])->ia;
 361                 if (ia == NULL) {
 362                         RTFREE(ro.ro_rt);
 363                         return (EADDRNOTAVAIL);
 364                 }
 365                 src = (struct sockaddr_in *)&ia->ia_addr;
 366         }
 367
 368         /*
 369          * Is there a free (pseudo-)interface or space?
 370          */
 371         for (ifn = ipxip_list; ifn != NULL; ifn = ifn->ifen_next) {
 372                 if ((ifn->ifen_ifnet.if_flags & IFF_UP) == 0)
 373                         break;
 374         }
 375         if (ifn == NULL)
 376                 ifn = ipxipattach();
 377         if (ifn == NULL) {
 378                 RTFREE(ro.ro_rt);
 379                 return (ENOBUFS);
 380         }
 381         ifn->ifen_route = ro;
 382         ifn->ifen_dst =  ip_dst->sin_addr;
 383         ifn->ifen_src = src->sin_addr;
 384
 385         /*
 386          * now configure this as a point to point link
 387          */
 388         ifr_ipxip.ifr_name[4] = '0' + ipxipif_units - 1;
 389         ifr_ipxip.ifr_dstaddr = *(struct sockaddr *)ipx_dst;
 390         ipx_control(so, (int)SIOCSIFDSTADDR, (caddr_t)&ifr_ipxip,
 391                         (struct ifnet *)ifn, sopt->sopt_td);
 392
 393         /* use any of our addresses */
 394         satoipx_addr(ifr_ipxip.ifr_addr).x_host =
 395                         ipx_ifaddr->ia_addr.sipx_addr.x_host;
 396
 397         return (ipx_control(so, (int)SIOCSIFADDR, (caddr_t)&ifr_ipxip,
 398                         (struct ifnet *)ifn, sopt->sopt_td));
 399 }
 400
 401 static int
 402 ipxip_free(struct ifnet *ifp)
 403 {
 404         struct ifnet_en *ifn = (struct ifnet_en *)ifp;
 405         struct route *ro = & ifn->ifen_route;
 406
 407         if (ro->ro_rt != NULL) {
 408                 RTFREE(ro->ro_rt);
 409                 ro->ro_rt = NULL;
 410         }
 411         ifp->if_flags &= ~IFF_UP;
 412         return (0);
 413 }
 414
 415 void
 416 ipxip_ctlinput(netmsg_t msg)
 417 {
 418         int cmd = msg->ctlinput.nm_cmd;
 419         struct sockaddr *sa = msg->ctlinput.nm_data;
 420         struct sockaddr_in *sin;
 421
 422         if ((unsigned)cmd >= PRC_NCMDS)
 423                 goto out;
 424         if (sa->sa_family != AF_INET && sa->sa_family != AF_IMPLINK)
 425                 goto out;
 426         sin = (struct sockaddr_in *)sa;
 427         if (sin->sin_addr.s_addr == INADDR_ANY)
 428                 goto out;
 429
 430         switch (cmd) {
 431
 432         case PRC_ROUTEDEAD:
 433         case PRC_REDIRECT_NET:
 434         case PRC_REDIRECT_HOST:
 435         case PRC_REDIRECT_TOSNET:
 436         case PRC_REDIRECT_TOSHOST:
 437                 ipxip_rtchange(&sin->sin_addr);
 438                 break;
 439         }
 440 out:
 441         lwkt_replymsg(&msg->lmsg, 0);
 442 }
 443
 444 static void
 445 ipxip_rtchange(struct in_addr *dst)
 446 {
 447         struct ifnet_en *ifn;
 448
 449         for (ifn = ipxip_list; ifn != NULL; ifn = ifn->ifen_next) {
 450                 if (ifn->ifen_dst.s_addr == dst->s_addr &&
 451                         ifn->ifen_route.ro_rt != NULL) {
 452                                 RTFREE(ifn->ifen_route.ro_rt);
 453                                 ifn->ifen_route.ro_rt = NULL;
 454                 }
 455         }
 456 }
 457 #endif /* IPXIP */