Home | History | Annotate | Line # | Download | only in net
if_tun.c revision 1.2
      1  1.1  cgd /* UNFINISHED CONVERSION TO 386BSD -wfj */
      2  1.1  cgd 
      3  1.1  cgd /* if_tun.c - tunnel interface module & driver */
      4  1.1  cgd 
      5  1.1  cgd /*
      6  1.1  cgd  * Copyright (c) 1988, Julian Onions.
      7  1.1  cgd  *
      8  1.1  cgd  * This source may be freely distributed, however I would be interested
      9  1.1  cgd  * in any changes that are made.
     10  1.1  cgd  */
     11  1.1  cgd 
     12  1.1  cgd /*
     13  1.1  cgd  * 90/02/06 15:03 - Fixed a bug in where TIOCGPGRP and TIOCSPGRP were
     14  1.1  cgd  * mixed up. Anders Klemets - klemets (at) sics.se
     15  1.1  cgd  *
     16  1.2  cgd  * $Id: if_tun.c,v 1.2 1993/05/18 18:19:58 cgd Exp $
     17  1.1  cgd  *
     18  1.2  cgd  * $Log: if_tun.c,v $
     19  1.2  cgd  * Revision 1.2  1993/05/18 18:19:58  cgd
     20  1.2  cgd  * make kernel select interface be one-stop shopping & clean it all up.
     21  1.2  cgd  *
     22  1.1  cgd  * Revision 1.1.1.1  1993/03/21  09:46:06  cgd
     23  1.1  cgd  * initial import of 386bsd-0.1 sources
     24  1.1  cgd  *
     25  1.1  cgd  * Revision 1.13  88/07/11  08:28:51  jpo
     26  1.1  cgd  * Some tidying up
     27  1.1  cgd  *
     28  1.1  cgd  * Revision 1.12  87/12/10  09:16:29  jpo
     29  1.1  cgd  * Decided the vax/mtpr was unnecessay.
     30  1.1  cgd  *
     31  1.1  cgd  * Revision 1.11  87/12/10  09:10:36  jpo
     32  1.1  cgd  * Fixed some minor things & 1 major bug.
     33  1.1  cgd  *
     34  1.1  cgd  * Revision 1.10  87/11/04  14:27:41  jpo
     35  1.1  cgd  * A few sanity checks added.
     36  1.1  cgd  *
     37  1.1  cgd  * Revision 1.9  87/11/04  14:13:45  jpo
     38  1.1  cgd  * Added some ioctls for non-blocking & async I/O
     39  1.1  cgd  *
     40  1.1  cgd  * Revision 1.8  87/10/19  10:28:14  jpo
     41  1.1  cgd  * Another touch up (sigh)
     42  1.1  cgd  *
     43  1.1  cgd  * Revision 1.7  87/10/19  10:25:48  jpo
     44  1.1  cgd  * Touch up.
     45  1.1  cgd  *
     46  1.1  cgd  * Revision 1.6  87/10/19  09:15:14  jpo
     47  1.1  cgd  * Touch up.
     48  1.1  cgd  *
     49  1.1  cgd  * Revision 1.5  87/10/19  08:34:51  jpo
     50  1.1  cgd  * General clean up - plus sun specific fixes
     51  1.1  cgd  *
     52  1.1  cgd  * Revision 1.4  87/10/16  17:10:12  jpo
     53  1.1  cgd  * Purged all ioctl read/writes and non-standard routing stuff.
     54  1.1  cgd  *
     55  1.1  cgd  * Revision 1.3  87/10/05  11:57:09  jpo
     56  1.1  cgd  * More debugging - in error mainly.
     57  1.1  cgd  *
     58  1.1  cgd  * Revision 1.2  87/10/04  18:29:45  jpo
     59  1.1  cgd  * Select & read/write working.
     60  1.1  cgd  */
     61  1.1  cgd 
     62  1.1  cgd #include "tun.h"
     63  1.1  cgd #if NTUN > 0
     64  1.1  cgd 
     65  1.1  cgd /*
     66  1.1  cgd  * Tunnel driver.
     67  1.1  cgd  *
     68  1.1  cgd  * This driver takes packets off the IP i/f and hands them up to a
     69  1.1  cgd  * user process to have it's wicked way with. This driver has it's
     70  1.1  cgd  * roots in a similar driver written by Phil Cockcroft (formerly) at
     71  1.1  cgd  * UCL. This driver is based much more on read/write/select mode of
     72  1.1  cgd  * operation though.
     73  1.1  cgd  *
     74  1.1  cgd  * Julian Onions <jpo (at) cs.nott.ac.uk>
     75  1.1  cgd  * Nottingham University 1987.
     76  1.1  cgd  */
     77  1.1  cgd 
     78  1.1  cgd #include "param.h"
     79  1.1  cgd #include "systm.h"
     80  1.1  cgd #include "mbuf.h"
     81  1.1  cgd #include "buf.h"
     82  1.1  cgd #include "protosw.h"
     83  1.1  cgd #include "socket.h"
     84  1.1  cgd #include "ioctl.h"
     85  1.1  cgd #include "errno.h"
     86  1.1  cgd #include "syslog.h"
     87  1.1  cgd 
     88  1.1  cgd #include "net/if.h"
     89  1.1  cgd #include "net/netisr.h"
     90  1.1  cgd #include "net/route.h"
     91  1.1  cgd 
     92  1.1  cgd #ifdef INET
     93  1.1  cgd #include "netinet/in.h"
     94  1.1  cgd #include "netinet/in_systm.h"
     95  1.1  cgd #include "netinet/in_var.h"
     96  1.1  cgd #include "netinet/ip.h"
     97  1.1  cgd #include "netinet/if_ether.h"
     98  1.1  cgd #endif
     99  1.1  cgd 
    100  1.1  cgd #ifdef NS
    101  1.1  cgd #include "netns/ns.h"
    102  1.1  cgd #include "netns/ns_if.h"
    103  1.1  cgd #endif
    104  1.1  cgd 
    105  1.1  cgd #define TUNDEBUG        if (tundebug) printf
    106  1.1  cgd 
    107  1.1  cgd int             tundebug = 0;
    108  1.1  cgd struct tunctl
    109  1.1  cgd {
    110  1.2  cgd         u_short         tun_flags;      /* misc flags */
    111  1.2  cgd         struct ifnet    tun_if;         /* the interface */
    112  1.1  cgd         int             tun_pgrp;       /* the process group - if any */
    113  1.1  cgd         struct selinfo	tun_rsel;       /* read select */
    114  1.1  cgd         struct selinfo	tun_wsel;       /* write select (not used) */
    115  1.1  cgd }       tunctl[NTUN];
    116  1.1  cgd 
    117  1.1  cgd extern int      ifqmaxlen;
    118  1.1  cgd 
    119  1.1  cgd int             tunoutput (), tunioctl (), tuninit ();
    120  1.1  cgd 
    121  1.1  cgd /* tunnel open - must be superuser & the device must be configured in */
    122  1.1  cgd tunopen (dev, flag)
    123  1.1  cgd dev_t           dev;
    124  1.1  cgd {
    125  1.1  cgd         register int    unit;
    126  1.1  cgd         struct tunctl  *tp;
    127  1.1  cgd         register struct ifnet *ifp;
    128  1.1  cgd 
    129  1.1  cgd         if (!suser ())
    130  1.1  cgd                 return EACCES;
    131  1.1  cgd         if ((unit = minor (dev)) >= NTUN)
    132  1.1  cgd                 return (ENXIO);
    133  1.1  cgd         tp = &tunctl[unit];
    134  1.1  cgd         if (tp->tun_flags & TUN_OPEN)
    135  1.1  cgd                 return ENXIO;
    136  1.1  cgd         if ((tp->tun_flags & TUN_INITED) == 0) {
    137  1.1  cgd                 tp->tun_flags = TUN_INITED;
    138  1.1  cgd                 tunattach (unit);
    139  1.1  cgd         }
    140  1.1  cgd         ifp = &tp->tun_if;
    141  1.1  cgd         tp->tun_flags |= TUN_OPEN;
    142  1.1  cgd         TUNDEBUG ("%s%d: open\n", ifp->if_name, ifp->if_unit);
    143  1.1  cgd         return (0);
    144  1.1  cgd }
    145  1.1  cgd 
    146  1.1  cgd /* tunclose - close the device - mark i/f down & delete routing info */
    147  1.1  cgd tunclose (dev, flag)
    148  1.1  cgd dev_t           dev;
    149  1.1  cgd {
    150  1.1  cgd         int             s;
    151  1.1  cgd         register int    unit = minor (dev);
    152  1.1  cgd         register struct tunctl *tp = &tunctl[unit];
    153  1.1  cgd         register struct ifnet *ifp = &tp->tun_if;
    154  1.1  cgd         register struct mbuf *m;
    155  1.1  cgd 
    156  1.1  cgd         tp->tun_flags &= TUN_INITED;
    157  1.1  cgd 
    158  1.1  cgd         /*
    159  1.1  cgd          * junk all pending output
    160  1.1  cgd          */
    161  1.1  cgd         do {
    162  1.1  cgd                 s = splimp ();
    163  1.1  cgd                 IF_DEQUEUE (&ifp->if_snd, m);
    164  1.1  cgd                 splx (s);
    165  1.1  cgd                 if (m) /* actually - m_freem checks this - but what the hell */
    166  1.1  cgd                         m_freem (m);
    167  1.1  cgd         } while (m != 0);
    168  1.1  cgd         if (ifp->if_flags & IFF_UP) {
    169  1.1  cgd                 s = splimp ();
    170  1.1  cgd                 if_down (ifp);
    171  1.1  cgd                 if (ifp->if_flags & IFF_RUNNING)
    172  1.1  cgd                         rtinit (ifp->if_addrlist, (int)SIOCDELRT, RTF_HOST);
    173  1.1  cgd                 splx (s);
    174  1.2  cgd         }
    175  1.1  cgd         tp -> tun_pgrp = 0;
    176  1.1  cgd         if (tp -> tun_rsel)
    177  1.1  cgd                 selwakeup (&tp->tun_rsel);
    178  1.1  cgd 
    179  1.1  cgd         tp -> tun_rsel = tp -> tun_wsel = (struct proc *)0;
    180  1.1  cgd 
    181  1.1  cgd         TUNDEBUG ("%s%d: closed\n", ifp->if_name, ifp->if_unit);
    182  1.1  cgd         return (0);
    183  1.1  cgd }
    184  1.1  cgd 
    185  1.1  cgd /*
    186  1.1  cgd  * attach an interface N.B. argument is not same as other drivers
    187  1.1  cgd  */
    188  1.1  cgd int
    189  1.1  cgd tunattach (unit)
    190  1.1  cgd int             unit;
    191  1.1  cgd {
    192  1.1  cgd         register struct ifnet *ifp = &tunctl[unit].tun_if;
    193  1.1  cgd         register struct sockaddr_in *sin;
    194  1.1  cgd 
    195  1.1  cgd         ifp->if_unit = unit;
    196  1.1  cgd         ifp->if_name = "tun";
    197  1.1  cgd         ifp->if_mtu = TUNMTU;
    198  1.1  cgd         ifp->if_ioctl = tunioctl;
    199  1.1  cgd         ifp->if_output = tunoutput;
    200  1.1  cgd         ifp->if_init = tuninit;
    201  1.1  cgd #ifndef BSD4_3
    202  1.1  cgd         sin = (struct sockaddr_in *) & ifp->if_addr;
    203  1.1  cgd         sin->sin_family = AF_INET;
    204  1.1  cgd #endif
    205  1.1  cgd         ifp->if_flags = IFF_POINTOPOINT;
    206  1.1  cgd         ifp->if_snd.ifq_maxlen = ifqmaxlen;
    207  1.1  cgd         ifp->if_collisions = ifp->if_ierrors = ifp->if_oerrors = 0;
    208  1.1  cgd         ifp->if_ipackets = ifp->if_opackets = 0;
    209  1.1  cgd         if_attach (ifp);
    210  1.1  cgd         TUNDEBUG ("%s%d: tunattach\n", ifp->if_name, ifp->if_unit);
    211  1.1  cgd         return 0;
    212  1.1  cgd }
    213  1.1  cgd 
    214  1.1  cgd int
    215  1.1  cgd tuninit (unit)
    216  1.1  cgd int             unit;
    217  1.1  cgd {
    218  1.1  cgd         register struct tunctl *tp = &tunctl[unit];
    219  1.1  cgd         register struct ifnet *ifp = &tp->tun_if;
    220  1.1  cgd #ifndef BSD4_3
    221  1.1  cgd         register struct sockaddr_in *sin;
    222  1.1  cgd 
    223  1.1  cgd         sin = (struct sockaddr_in *) & ifp->if_addr;
    224  1.1  cgd         if (sin->sin_addr.s_addr == 0)  /* if address still unknown */
    225  1.1  cgd                 return;
    226  1.1  cgd         if_rtinit (ifp, RTF_UP);
    227  1.1  cgd #endif
    228  1.1  cgd         ifp->if_flags |= IFF_UP | IFF_RUNNING;
    229  1.1  cgd         tp->tun_flags |= TUN_IASET;
    230  1.1  cgd         TUNDEBUG ("%s%d: tuninit\n", ifp->if_name, ifp->if_unit);
    231  1.1  cgd         return 0;
    232  1.1  cgd }
    233  1.1  cgd 
    234  1.1  cgd /*
    235  1.1  cgd  * Process an ioctl request.
    236  1.1  cgd  * The problem here is 4.2 pass a struct ifreq * to this routine,
    237  1.1  cgd  * sun only passes a struct sockaddr * since 3.2 at least. This is
    238  1.1  cgd  * rather upsetting! Also, sun doesn't pass the SIOCDSTADDR ioctl through
    239  1.1  cgd  * so we can't detect this being set directly. This is the reason for
    240  1.1  cgd  * tuncheckready.
    241  1.1  cgd  * Under 4.3 and SunOs 4.0 we now get the SIOCSIFDSTADDR ioctl, and we get a
    242  1.1  cgd  * struct in_ifaddr * for data. (tte)
    243  1.1  cgd  */
    244  1.1  cgd 
    245  1.1  cgd #if !defined(BSD4_3) && defined(sun)
    246  1.1  cgd 
    247  1.1  cgd /*
    248  1.1  cgd  * workaround for not being able to detect DSTADDR being set.
    249  1.1  cgd  */
    250  1.1  cgd 
    251  1.1  cgd tuncheckready (ifp)
    252  1.1  cgd struct ifnet *ifp;
    253  1.1  cgd {
    254  1.1  cgd         struct tunctl *tp = &tunctl[ifp->if_unit];
    255  1.1  cgd         struct sockaddr_in *sin;
    256  1.1  cgd 
    257  1.1  cgd         sin = (struct sockaddr_in *) &ifp->if_dstaddr;
    258  1.1  cgd         if (sin->sin_addr.s_addr == 0)
    259  1.1  cgd                 return 0;
    260  1.1  cgd         tp -> tun_flags |= TUN_DSTADDR;
    261  1.1  cgd         return 1;
    262  1.1  cgd }
    263  1.1  cgd #else
    264  1.1  cgd #define tuncheckready(dummy) 1
    265  1.1  cgd #endif /* !defined(BSD4_3) && defined(sun) */
    266  1.1  cgd 
    267  1.1  cgd int
    268  1.1  cgd tunioctl (ifp, cmd, data)
    269  1.1  cgd register struct ifnet *ifp;
    270  1.1  cgd int             cmd;
    271  1.1  cgd caddr_t         data;
    272  1.1  cgd {
    273  1.1  cgd #ifndef BSD4_3
    274  1.1  cgd #ifdef sun
    275  1.1  cgd         struct sockaddr_in *sin = (struct sockaddr_in *) data;
    276  1.1  cgd #else
    277  1.1  cgd         struct sockaddr_in *sin;
    278  1.1  cgd         struct ifreq    *ifr = (struct ifreq *) data;
    279  1.1  cgd #endif
    280  1.1  cgd #endif /* BSD4_3 */
    281  1.1  cgd 
    282  1.1  cgd         int             s = splimp (), error = 0;
    283  1.1  cgd         struct tunctl  *tp = &tunctl[ifp->if_unit];
    284  1.1  cgd 
    285  1.1  cgd         switch (cmd)
    286  1.1  cgd         {
    287  1.1  cgd             case SIOCSIFADDR:
    288  1.1  cgd #ifndef BSD4_3
    289  1.1  cgd                 if (ifp->if_flags & IFF_RUNNING)
    290  1.1  cgd                         if_rtinit (ifp, -1);    /* delete previous route */
    291  1.1  cgd #ifndef sun
    292  1.1  cgd                 sin = (struct sockaddr_in *)&ifr -> ifr_addr;
    293  1.1  cgd #endif
    294  1.1  cgd                 ifp->if_addr = *((struct sockaddr *) sin);
    295  1.1  cgd                 ifp->if_net = in_netof (sin->sin_addr);
    296  1.1  cgd                 ifp->if_host[0] = in_lnaof (sin->sin_addr);
    297  1.1  cgd #endif
    298  1.1  cgd                 tuninit (ifp->if_unit);
    299  1.1  cgd                 break;
    300  1.1  cgd             case SIOCSIFDSTADDR:
    301  1.1  cgd                 tp->tun_flags |= TUN_DSTADDR;
    302  1.1  cgd #ifndef BSD4_3
    303  1.1  cgd #ifndef sun
    304  1.1  cgd                 sin = (struct sockaddr_in *)&ifr -> ifr_addr;
    305  1.1  cgd #endif
    306  1.1  cgd                 ifp->if_dstaddr = *((struct sockaddr *)sin);
    307  1.1  cgd #endif BSD4_3
    308  1.1  cgd                 TUNDEBUG ("%s%d: destination addres set\n", ifp->if_name,
    309  1.1  cgd                         ifp -> if_unit);
    310  1.1  cgd                 break;
    311  1.1  cgd             default:
    312  1.1  cgd                 error = EINVAL;
    313  1.1  cgd         }
    314  1.1  cgd         splx (s);
    315  1.1  cgd         return (error);
    316  1.1  cgd }
    317  1.1  cgd 
    318  1.1  cgd /*
    319  1.1  cgd  * tunoutput - queue packets from higher level ready to put out.
    320  1.1  cgd  */
    321  1.1  cgd tunoutput (ifp, m0, dst)
    322  1.1  cgd struct ifnet   *ifp;
    323  1.1  cgd struct mbuf    *m0;
    324  1.1  cgd struct sockaddr *dst;
    325  1.1  cgd {
    326  1.1  cgd         struct tunctl  *tp;
    327  1.1  cgd         struct proc     *p;
    328  1.1  cgd         int             s;
    329  1.1  cgd 
    330  1.1  cgd         TUNDEBUG ("%s%d: tunoutput\n", ifp->if_name, ifp->if_unit);
    331  1.1  cgd         tp = &tunctl[ifp->if_unit];
    332  1.1  cgd         if ((tp->tun_flags & TUN_READY) != TUN_READY) {
    333  1.1  cgd                 if(tuncheckready(ifp) == 0) {
    334  1.1  cgd                         TUNDEBUG ("%s%d: not ready 0%o\n", ifp->if_name,
    335  1.1  cgd                                 ifp->if_unit, tp->tun_flags);
    336  1.1  cgd                         m_freem (m0);
    337  1.1  cgd                         return EHOSTDOWN;
    338  1.1  cgd                 }
    339  1.1  cgd         }
    340  1.1  cgd 
    341  1.1  cgd         switch (dst->sa_family) {
    342  1.1  cgd #ifdef INET
    343  1.1  cgd             case AF_INET:
    344  1.1  cgd                 s = splimp ();
    345  1.1  cgd                 if (IF_QFULL (&ifp->if_snd))
    346  1.1  cgd                 {
    347  1.1  cgd                         IF_DROP (&ifp->if_snd);
    348  1.1  cgd                         m_freem (m0);
    349  1.1  cgd                         splx (s);
    350  1.1  cgd                         ifp->if_collisions++;
    351  1.1  cgd                         return (ENOBUFS);
    352  1.1  cgd                 }
    353  1.1  cgd                 IF_ENQUEUE (&ifp->if_snd, m0);
    354  1.1  cgd                 splx (s);
    355  1.1  cgd                 ifp->if_opackets++;
    356  1.1  cgd                 break;
    357  1.1  cgd #endif
    358  1.1  cgd             default:
    359  1.1  cgd                 m_freem (m0);
    360  1.1  cgd                 return EAFNOSUPPORT;
    361  1.1  cgd         }
    362  1.1  cgd 
    363  1.1  cgd         if (tp->tun_flags & TUN_RWAIT) {
    364  1.1  cgd                 tp->tun_flags &= ~TUN_RWAIT;
    365  1.1  cgd                 wakeup ((caddr_t) tp);
    366  1.1  cgd         }
    367  1.1  cgd         if (tp->tun_flags & TUN_ASYNC && tp -> tun_pgrp != 0) {
    368  1.1  cgd                 if (tp->tun_pgrp > 0)
    369  1.1  cgd                         gsignal (tp->tun_pgrp, SIGIO);
    370  1.2  cgd                 else if ((p = pfind (-tp->tun_pgrp)) != 0)
    371  1.1  cgd                         psignal (p, SIGIO);
    372  1.1  cgd         }
    373  1.1  cgd 	selwakeup (&tp->tun_rsel);
    374  1.1  cgd         return 0;
    375  1.1  cgd }
    376  1.1  cgd 
    377  1.1  cgd /*
    378  1.1  cgd  * the cdevsw interface is now pretty minimal.
    379  1.1  cgd  */
    380  1.1  cgd 
    381  1.1  cgd tuncioctl (dev, cmd, data, flag)
    382  1.1  cgd dev_t           dev;
    383  1.1  cgd caddr_t         data;
    384  1.1  cgd {
    385  1.1  cgd         int     unit = minor(dev);
    386  1.1  cgd         struct tunctl *tp = &tunctl[unit];
    387  1.1  cgd         int     s;
    388  1.1  cgd 
    389  1.1  cgd         switch (cmd) {
    390  1.1  cgd             case TUNSDEBUG:
    391  1.1  cgd                 tundebug = *(int *)data;
    392  1.1  cgd                 break;
    393  1.1  cgd 
    394  1.1  cgd             case TUNGDEBUG:
    395  1.1  cgd                 *(int *)data = tundebug;
    396  1.1  cgd                 break;
    397  1.1  cgd 
    398  1.1  cgd             case FIONBIO:
    399  1.1  cgd                 if (*(int *)data)
    400  1.1  cgd                         tp->tun_flags |= TUN_NBIO;
    401  1.1  cgd                 else
    402  1.1  cgd                         tp->tun_flags &= ~TUN_NBIO;
    403  1.1  cgd                 break;
    404  1.1  cgd 
    405  1.1  cgd             case FIOASYNC:
    406  1.1  cgd                 if (*(int *)data)
    407  1.1  cgd                         tp->tun_flags |= TUN_ASYNC;
    408  1.1  cgd                 else
    409  1.1  cgd                         tp->tun_flags &= ~TUN_ASYNC;
    410  1.1  cgd                 break;
    411  1.1  cgd 
    412  1.1  cgd             case FIONREAD:
    413  1.1  cgd                 s = splimp ();
    414  1.1  cgd                 if (tp->tun_if.if_snd.ifq_head)
    415  1.1  cgd                         *(int *)data = tp->tun_if.if_snd.ifq_head->m_len;
    416  1.1  cgd                 else    *(int *)data = 0;
    417  1.1  cgd                 splx (s);
    418  1.1  cgd                 break;
    419  1.1  cgd 
    420  1.1  cgd             case TIOCSPGRP:
    421  1.1  cgd                 tp->tun_pgrp = *(int *)data;
    422  1.1  cgd                 break;
    423  1.1  cgd 
    424  1.1  cgd             case TIOCGPGRP:
    425  1.1  cgd                 *(int *)data = tp->tun_pgrp;
    426  1.1  cgd                 break;
    427  1.1  cgd 
    428  1.1  cgd             default:
    429  1.1  cgd                 return (ENOTTY);
    430  1.1  cgd         }
    431  1.1  cgd         return (0);
    432  1.1  cgd }
    433  1.1  cgd 
    434  1.1  cgd /*
    435  1.1  cgd  * The cdevsw read interface - reads a packet at a time, or at least as much
    436  1.1  cgd  * of a packet as can be read.
    437  1.1  cgd  */
    438  1.1  cgd tunread (dev, uio)
    439  1.1  cgd dev_t           dev;
    440  1.1  cgd struct uio     *uio;
    441  1.1  cgd {
    442  1.1  cgd         register struct ifnet *ifp;
    443  1.1  cgd         register struct mbuf *m, *m0;
    444  1.1  cgd         int             unit = minor (dev);
    445  1.1  cgd         int             len, s;
    446  1.1  cgd         int             error = 0;
    447  1.1  cgd         struct tunctl  *tp;
    448  1.1  cgd 
    449  1.1  cgd         tp = &tunctl[unit];
    450  1.1  cgd         ifp = &tp->tun_if;
    451  1.1  cgd         TUNDEBUG ("%s%d: read\n", ifp->if_name, ifp->if_unit);
    452  1.1  cgd         if ((tp->tun_flags & TUN_READY) != TUN_READY) {
    453  1.1  cgd                 if(tuncheckready(ifp) == 0) {
    454  1.1  cgd                         TUNDEBUG ("%s%d: not ready 0%o\n", ifp->if_name,
    455  1.1  cgd                                 ifp->if_unit, tp->tun_flags);
    456  1.1  cgd                         return EHOSTDOWN;
    457  1.1  cgd                 }
    458  1.1  cgd         }
    459  1.1  cgd 
    460  1.1  cgd         tp->tun_flags &= ~TUN_RWAIT;
    461  1.1  cgd 
    462  1.1  cgd         s = splimp ();
    463  1.1  cgd         do {
    464  1.1  cgd                 IF_DEQUEUE (&ifp->if_snd, m0);
    465  1.1  cgd                 if (m0 == 0) {
    466  1.1  cgd                         if (tp -> tun_flags & TUN_NBIO) {
    467  1.1  cgd                                 splx (s);
    468  1.1  cgd                                 return EWOULDBLOCK;
    469  1.1  cgd                         }
    470  1.1  cgd                         tp->tun_flags |= TUN_RWAIT;
    471  1.1  cgd                         sleep ((caddr_t) tp, PZERO + 1);
    472  1.1  cgd                 }
    473  1.1  cgd         } while (m0 == 0);
    474  1.1  cgd         splx (s);
    475  1.1  cgd 
    476  1.1  cgd         while (m0 && uio->uio_resid > 0 && error == 0) {
    477  1.1  cgd                 len = MIN (uio->uio_resid, m0->m_len);
    478  1.1  cgd                 if (len == 0)
    479  1.1  cgd                         break;
    480  1.1  cgd                 error = uiomove (mtod (m0, caddr_t), len,
    481  1.1  cgd                                  UIO_READ, uio);
    482  1.1  cgd                 MFREE (m0, m);
    483  1.1  cgd                 m0 = m;
    484  1.1  cgd         }
    485  1.1  cgd 
    486  1.1  cgd         if (m0 != 0) {
    487  1.1  cgd                 TUNDEBUG ("Dropping mbuf\n");
    488  1.1  cgd                 m_freem (m0);
    489  1.1  cgd         }
    490  1.1  cgd         return error;
    491  1.1  cgd }
    492  1.1  cgd 
    493  1.1  cgd /*
    494  1.1  cgd  * the cdevsw write interface - an atomic write is a packet - or else!
    495  1.1  cgd  */
    496  1.1  cgd 
    497  1.1  cgd tunwrite (dev, uio)
    498  1.1  cgd int             dev;
    499  1.1  cgd struct uio     *uio;
    500  1.1  cgd {
    501  1.1  cgd         int             error = 0;
    502  1.1  cgd         int             unit = minor (dev);
    503  1.1  cgd         struct mbuf    *top, **mp, *m;
    504  1.1  cgd         struct ifnet   *ifp = &(tunctl[unit].tun_if);
    505  1.1  cgd         int             s;
    506  1.1  cgd 
    507  1.1  cgd         TUNDEBUG ("%s%d: tunwrite\n", ifp->if_name, ifp->if_unit);
    508  1.1  cgd 
    509  1.1  cgd         if (uio->uio_resid < 0 || uio->uio_resid > TUNMTU) {
    510  1.1  cgd                 TUNDEBUG ("%s%d: len=%d!\n", ifp->if_name, ifp->if_unit,
    511  1.1  cgd                           uio->uio_resid);
    512  1.1  cgd                 return EIO;
    513  1.1  cgd         }
    514  1.1  cgd         top = 0;
    515  1.1  cgd         mp = &top;
    516  1.1  cgd         while (error == 0 && uio->uio_resid > 0) {
    517  1.1  cgd                 MGET (m, M_DONTWAIT, MT_DATA);
    518  1.1  cgd                 if (m == 0) {
    519  1.1  cgd                         error = ENOBUFS;
    520  1.1  cgd                         break;
    521  1.1  cgd                 }
    522  1.1  cgd                 m->m_len = MIN (MLEN, uio->uio_resid);
    523  1.1  cgd                 error = uiomove (mtod (m, caddr_t), m->m_len, UIO_WRITE, uio);
    524  1.1  cgd                 *mp = m;
    525  1.1  cgd                 mp = &m->m_next;
    526  1.1  cgd         }
    527  1.1  cgd         if (error) {
    528  1.1  cgd                 if (top)
    529  1.1  cgd                         m_freem (top);
    530  1.1  cgd                 return error;
    531  1.1  cgd         }
    532  1.1  cgd 
    533  1.1  cgd #ifdef BSD4_3
    534  1.1  cgd         /*
    535  1.1  cgd          * Place interface pointer before the data
    536  1.1  cgd          * for the receiving protocol.
    537  1.1  cgd          */
    538  1.1  cgd         if (top->m_off <= MMAXOFF &&
    539  1.1  cgd             top->m_off >= MMINOFF + sizeof(struct ifnet *)) {
    540  1.1  cgd                 top->m_off -= sizeof(struct ifnet *);
    541  1.1  cgd                 top->m_len += sizeof(struct ifnet *);
    542  1.1  cgd         } else {
    543  1.1  cgd                 MGET(m, M_DONTWAIT, MT_HEADER);
    544  1.1  cgd                 if (m == (struct mbuf *)0)
    545  1.1  cgd                         return (ENOBUFS);
    546  1.1  cgd                 m->m_len = sizeof(struct ifnet *);
    547  1.1  cgd                 m->m_next = top;
    548  1.1  cgd                 top = m;
    549  1.1  cgd         }
    550  1.1  cgd         *(mtod(top, struct ifnet **)) = ifp;
    551  1.1  cgd #endif /* BSD4_3 */
    552  1.1  cgd 
    553  1.1  cgd         s = splimp ();
    554  1.1  cgd         if (IF_QFULL (&ipintrq)) {
    555  1.1  cgd                 IF_DROP (&ipintrq);
    556  1.1  cgd                 splx (s);
    557  1.1  cgd                 ifp->if_collisions++;
    558  1.1  cgd                 m_freem (top);
    559  1.1  cgd                 return ENOBUFS;
    560  1.1  cgd         }
    561  1.1  cgd         IF_ENQUEUE (&ipintrq, top);
    562  1.1  cgd         splx (s);
    563  1.1  cgd         ifp->if_ipackets++;
    564  1.1  cgd         schednetisr (NETISR_IP);
    565  1.1  cgd         return error;
    566  1.1  cgd }
    567  1.1  cgd 
    568  1.1  cgd /*
    569  1.1  cgd  * tunselect - the select interface, this is only useful on reads really.
    570  1.1  cgd  * The write detect always returns true, write never blocks anyway, it either
    571  1.1  cgd  * accepts the packet or drops it.
    572  1.1  cgd  */
    573  1.1  cgd tunselect (dev, rw)
    574  1.1  cgd dev_t           dev;
    575  1.1  cgd int             rw;
    576  1.1  cgd {
    577  1.1  cgd         int             unit = minor (dev);
    578  1.1  cgd         register struct tunctl *tp = &tunctl[unit];
    579  1.1  cgd         struct ifnet   *ifp = &tp->tun_if;
    580  1.1  cgd         int             s = splimp ();
    581  1.1  cgd 
    582  1.1  cgd         TUNDEBUG ("%s%d: tunselect\n", ifp->if_name, ifp->if_unit);
    583  1.1  cgd         switch (rw) {
    584  1.1  cgd             case FREAD:
    585  1.1  cgd                 if (ifp->if_snd.ifq_len > 0) {
    586  1.1  cgd                         splx (s);
    587  1.1  cgd                         TUNDEBUG ("%s%d: tunselect q=%d\n", ifp->if_name,
    588  1.2  cgd                                   ifp->if_unit, ifp->if_snd.ifq_len);
    589  1.1  cgd                         return 1;
    590  1.1  cgd                 }
    591  1.1  cgd                 selrecord(p, &tp->tun_rsel);
    592  1.1  cgd                 break;
    593  1.1  cgd             case FWRITE:
    594  1.1  cgd                 splx (s);
    595  1.1  cgd                 return 1;
    596  1.1  cgd         }
    597  1.1  cgd         splx (s);
    598  1.1  cgd         TUNDEBUG ("%s%d: tunselect waiting\n", ifp->if_name, ifp->if_unit);
    599                   return 0;
    600           }
    601           #endif  NTUN
    602