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