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