sys/net/if_loop.c

   1 /*
   2  * Copyright (c) 1982, 1986, 1993
   3  *      The Regents of the University of California.  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. All advertising materials mentioning features or use of this software
  14  *    must display the following acknowledgement:
  15  *      This product includes software developed by the University of
  16  *      California, Berkeley and its contributors.
  17  * 4. Neither the name of the University nor the names of its contributors
  18  *    may be used to endorse or promote products derived from this software
  19  *    without specific prior written permission.
  20  *
  21  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  31  * SUCH DAMAGE.
  32  *
  33  *      @(#)if_loop.c   8.1 (Berkeley) 6/10/93
  34  * $FreeBSD: src/sys/net/if_loop.c,v 1.47.2.8 2003/06/01 01:46:11 silby Exp $
  35  * $DragonFly: src/sys/net/if_loop.c,v 1.16 2005/05/05 22:57:45 swildner Exp $
  36  */
  37
  38 /*
  39  * Loopback interface driver for protocol testing and timing.
  40  */
  41 #include "use_loop.h"
  42
  43 #include "opt_atalk.h"
  44 #include "opt_inet.h"
  45 #include "opt_inet6.h"
  46 #include "opt_ipx.h"
  47
  48 #include <sys/param.h>
  49 #include <sys/systm.h>
  50 #include <sys/kernel.h>
  51 #include <sys/mbuf.h>
  52 #include <sys/socket.h>
  53 #include <sys/sockio.h>
  54
  55 #include <net/if.h>
  56 #include <net/if_types.h>
  57 #include <net/ifq_var.h>
  58 #include <net/netisr.h>
  59 #include <net/route.h>
  60 #include <net/bpf.h>
  61 #include <net/bpfdesc.h>
  62
  63 #ifdef  INET
  64 #include <netinet/in.h>
  65 #include <netinet/in_var.h>
  66 #endif
  67
  68 #ifdef IPX
  69 #include <netproto/ipx/ipx.h>
  70 #include <netproto/ipx/ipx_if.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 #endif
  80
  81 #ifdef NS
  82 #include <netns/ns.h>
  83 #include <netns/ns_if.h>
  84 #endif
  85
  86 #ifdef NETATALK
  87 #include <netproto/atalk/at.h>
  88 #include <netproto/atalk/at_var.h>
  89 #endif
  90
  91 int loioctl (struct ifnet *, u_long, caddr_t, struct ucred *);
  92 static void lortrequest (int, struct rtentry *, struct rt_addrinfo *);
  93
  94 static void loopattach (void *);
  95 #ifdef ALTQ
  96 static void lo_altqstart(struct ifnet *);
  97 #endif
  98 PSEUDO_SET(loopattach, if_loop);
  99
 100 int looutput (struct ifnet *ifp,
 101                 struct mbuf *m, struct sockaddr *dst, struct rtentry *rt);
 102
 103 #ifdef TINY_LOMTU
 104 #define LOMTU   (1024+512)
 105 #elif defined(LARGE_LOMTU)
 106 #define LOMTU   131072
 107 #else
 108 #define LOMTU   16384
 109 #endif
 110
 111 struct  ifnet loif[NLOOP];
 112
 113 /* ARGSUSED */
 114 static void
 115 loopattach(void *dummy)
 116 {
 117         struct ifnet *ifp;
 118         int i;
 119
 120         for (i = 0, ifp = loif; i < NLOOP; i++, ifp++) {
 121                 if_initname(ifp, "lo", i);
 122                 ifp->if_mtu = LOMTU;
 123                 ifp->if_flags = IFF_LOOPBACK | IFF_MULTICAST;
 124                 ifp->if_ioctl = loioctl;
 125                 ifp->if_output = looutput;
 126                 ifp->if_type = IFT_LOOP;
 127                 ifq_set_maxlen(&ifp->if_snd, ifqmaxlen);
 128                 ifq_set_ready(&ifp->if_snd);
 129 #ifdef ALTQ
 130                 ifp->if_start = lo_altqstart;
 131 #endif
 132                 if_attach(ifp);
 133                 bpfattach(ifp, DLT_NULL, sizeof(u_int));
 134         }
 135 }
 136
 137 int
 138 looutput(
 139         struct ifnet *ifp,
 140         struct mbuf *m,
 141         struct sockaddr *dst,
 142         struct rtentry *rt)
 143 {
 144         struct mbuf *n;
 145
 146         if ((m->m_flags & M_PKTHDR) == 0)
 147                 panic("looutput no HDR");
 148
 149         if (rt && rt->rt_flags & (RTF_REJECT|RTF_BLACKHOLE)) {
 150                 m_freem(m);
 151                 return (rt->rt_flags & RTF_BLACKHOLE ? 0 :
 152                         rt->rt_flags & RTF_HOST ? EHOSTUNREACH : ENETUNREACH);
 153         }
 154         /*
 155          * KAME requires that the packet to be contiguous on the
 156          * mbuf.  We need to make that sure.
 157          * this kind of code should be avoided.
 158          *
 159          * XXX: KAME may no longer need contiguous packets.  Once
 160          * that has been verified, the following code _should_ be
 161          * removed.
 162          */
 163         if (m && m->m_next != NULL) {
 164
 165                 n = m_defrag(m, MB_DONTWAIT);
 166
 167                 if (n == NULL) {
 168                         m_freem(m);
 169                         return (ENOBUFS);
 170                 } else {
 171                         m = n;
 172                 }
 173         }
 174
 175         ifp->if_opackets++;
 176         ifp->if_obytes += m->m_pkthdr.len;
 177 #if 1   /* XXX */
 178         switch (dst->sa_family) {
 179         case AF_INET:
 180         case AF_INET6:
 181         case AF_IPX:
 182         case AF_NS:
 183         case AF_APPLETALK:
 184                 break;
 185         default:
 186                 printf("looutput: af=%d unexpected\n", dst->sa_family);
 187                 m_freem(m);
 188                 return (EAFNOSUPPORT);
 189         }
 190 #endif
 191         return (if_simloop(ifp, m, dst->sa_family, 0));
 192 }
 193
 194 /*
 195  * if_simloop()
 196  *
 197  * This function is to support software emulation of hardware loopback,
 198  * i.e., for interfaces with the IFF_SIMPLEX attribute. Since they can't
 199  * hear their own broadcasts, we create a copy of the packet that we
 200  * would normally receive via a hardware loopback.
 201  *
 202  * This function expects the packet to include the media header of length hlen.
 203  */
 204 int
 205 if_simloop(struct ifnet *ifp, struct mbuf *m, int af, int hlen)
 206 {
 207         int isr;
 208
 209         KASSERT((m->m_flags & M_PKTHDR) != 0, ("if_simloop: no HDR"));
 210         m->m_pkthdr.rcvif = ifp;
 211
 212         /* BPF write needs to be handled specially */
 213         if (af == AF_UNSPEC) {
 214                 KASSERT(m->m_len >= sizeof(int), ("if_simloop: m_len"));
 215                 af = *(mtod(m, int *));
 216                 m->m_len -= sizeof(int);
 217                 m->m_pkthdr.len -= sizeof(int);
 218                 m->m_data += sizeof(int);
 219         }
 220
 221         if (ifp->if_bpf) {
 222                 if (ifp->if_bpf->bif_dlt == DLT_NULL) {
 223                         uint32_t bpf_af = (uint32_t)af;
 224                         bpf_ptap(ifp->if_bpf, m, &bpf_af, 4);
 225                 }
 226                 else {
 227                         bpf_mtap(ifp->if_bpf, m);
 228                 }
 229         }
 230
 231         /* Strip away media header */
 232         if (hlen > 0)
 233                 m_adj(m, hlen);
 234
 235 #ifdef ALTQ
 236         /*
 237          * altq for loop is just for debugging.
 238          * only used when called for loop interface (not for
 239          * a simplex interface).
 240          */
 241         if (ifq_is_enabled(&ifp->if_snd) && ifp->if_start == lo_altqstart) {
 242                 struct altq_pktattr pktattr;
 243                 int32_t *afp;
 244                 int error, s;
 245
 246                 /*
 247                  * if the queueing discipline needs packet classification,
 248                  * do it before prepending link headers.
 249                  */
 250                 ifq_classify(&ifp->if_snd, m, af, &pktattr);
 251
 252                 M_PREPEND(m, sizeof(int32_t), MB_DONTWAIT);
 253                 if (m == 0)
 254                         return(ENOBUFS);
 255                 afp = mtod(m, int32_t *);
 256                 *afp = (int32_t)af;
 257
 258                 s = splimp();
 259                 error = ifq_enqueue(&ifp->if_snd, m, &pktattr);
 260                 (*ifp->if_start)(ifp);
 261                 splx(s);
 262                 return (error);
 263         }
 264 #endif /* ALTQ */
 265
 266         /* Deliver to upper layer protocol */
 267         switch (af) {
 268 #ifdef INET
 269         case AF_INET:
 270                 isr = NETISR_IP;
 271                 break;
 272 #endif
 273 #ifdef INET6
 274         case AF_INET6:
 275                 m->m_flags |= M_LOOP;
 276                 isr = NETISR_IPV6;
 277                 break;
 278 #endif
 279 #ifdef IPX
 280         case AF_IPX:
 281                 isr = NETISR_IPX;
 282                 break;
 283 #endif
 284 #ifdef NS
 285         case AF_NS:
 286                 isr = NETISR_NS;
 287                 break;
 288 #endif
 289 #ifdef NETATALK
 290         case AF_APPLETALK:
 291                 isr = NETISR_ATALK2;
 292                 break;
 293 #endif
 294         default:
 295                 printf("if_simloop: can't handle af=%d\n", af);
 296                 m_freem(m);
 297                 return (EAFNOSUPPORT);
 298         }
 299
 300         ifp->if_ipackets++;
 301         ifp->if_ibytes += m->m_pkthdr.len;
 302         netisr_queue(isr, m);
 303         return (0);
 304 }
 305
 306 #ifdef ALTQ
 307 static void
 308 lo_altqstart(struct ifnet *ifp)
 309 {
 310         struct mbuf *m;
 311         int32_t af, *afp;
 312         int s, isr;
 313
 314         while (1) {
 315                 s = splimp();
 316                 m = ifq_dequeue(&ifp->if_snd);
 317                 splx(s);
 318                 if (m == NULL)
 319                         return;
 320
 321                 afp = mtod(m, int32_t *);
 322                 af = *afp;
 323                 m_adj(m, sizeof(int32_t));
 324
 325                 switch (af) {
 326 #ifdef INET
 327                 case AF_INET:
 328                         isr = NETISR_IP;
 329                         break;
 330 #endif
 331 #ifdef INET6
 332                 case AF_INET6:
 333                         m->m_flags |= M_LOOP;
 334                         isr = NETISR_IPV6;
 335                         break;
 336 #endif
 337 #ifdef IPX
 338                 case AF_IPX:
 339                         isr = NETISR_IPX;
 340                         break;
 341 #endif
 342 #ifdef NS
 343                 case AF_NS:
 344                         isr = NETISR_NS;
 345                         break;
 346 #endif
 347 #ifdef ISO
 348                 case AF_ISO:
 349                         isr = NETISR_ISO;
 350                         break;
 351 #endif
 352 #ifdef NETATALK
 353                 case AF_APPLETALK:
 354                         isr = NETISR_ATALK2;
 355                         break;
 356 #endif
 357                 default:
 358                         printf("lo_altqstart: can't handle af%d\n", af);
 359                         m_freem(m);
 360                         return;
 361                 }
 362
 363                 ifp->if_ipackets++;
 364                 ifp->if_ibytes += m->m_pkthdr.len;
 365                 netisr_queue(isr, m);
 366         }
 367 }
 368 #endif /* ALTQ */
 369
 370 /* ARGSUSED */
 371 static void
 372 lortrequest(int cmd, struct rtentry *rt, struct rt_addrinfo *info)
 373 {
 374         if (rt) {
 375                 rt->rt_rmx.rmx_mtu = rt->rt_ifp->if_mtu; /* for ISO */
 376                 /*
 377                  * For optimal performance, the send and receive buffers
 378                  * should be at least twice the MTU plus a little more for
 379                  * overhead.
 380                  */
 381                 rt->rt_rmx.rmx_recvpipe = rt->rt_rmx.rmx_sendpipe = 3 * LOMTU;
 382         }
 383 }
 384
 385 /*
 386  * Process an ioctl request.
 387  */
 388 /* ARGSUSED */
 389 int
 390 loioctl(struct ifnet *ifp, u_long cmd, caddr_t data, struct ucred *cr)
 391 {
 392         struct ifaddr *ifa;
 393         struct ifreq *ifr = (struct ifreq *)data;
 394         int error = 0;
 395
 396         switch (cmd) {
 397
 398         case SIOCSIFADDR:
 399                 ifp->if_flags |= IFF_UP | IFF_RUNNING;
 400                 ifa = (struct ifaddr *)data;
 401                 ifa->ifa_rtrequest = lortrequest;
 402                 /*
 403                  * Everything else is done at a higher level.
 404                  */
 405                 break;
 406
 407         case SIOCADDMULTI:
 408         case SIOCDELMULTI:
 409                 if (ifr == 0) {
 410                         error = EAFNOSUPPORT;           /* XXX */
 411                         break;
 412                 }
 413                 switch (ifr->ifr_addr.sa_family) {
 414
 415 #ifdef INET
 416                 case AF_INET:
 417                         break;
 418 #endif
 419 #ifdef INET6
 420                 case AF_INET6:
 421                         break;
 422 #endif
 423
 424                 default:
 425                         error = EAFNOSUPPORT;
 426                         break;
 427                 }
 428                 break;
 429
 430         case SIOCSIFMTU:
 431                 ifp->if_mtu = ifr->ifr_mtu;
 432                 break;
 433
 434         case SIOCSIFFLAGS:
 435                 break;
 436
 437         default:
 438                 error = EINVAL;
 439         }
 440         return (error);
 441 }