root/netnatm/natm.c

DEFINITIONS

1. natm_usrreq
2. natmintr
3. natm0_sysctl
4. natm5_sysctl

    1 /*      $OpenBSD: natm.c,v 1.7 2006/03/04 22:40:16 brad Exp $   */
    3 /*
    4  *
    5  * Copyright (c) 1996 Charles D. Cranor and Washington University.
    6  * All rights reserved.
    7  *
    8  * Redistribution and use in source and binary forms, with or without
    9  * modification, are permitted provided that the following conditions
   10  * are met:
   11  * 1. Redistributions of source code must retain the above copyright
   12  *    notice, this list of conditions and the following disclaimer.
   13  * 2. Redistributions in binary form must reproduce the above copyright
   14  *    notice, this list of conditions and the following disclaimer in the
   15  *    documentation and/or other materials provided with the distribution.
   16  * 3. All advertising materials mentioning features or use of this software
   17  *    must display the following acknowledgement:
   18  *      This product includes software developed by Charles D. Cranor and
   19  *      Washington University.
   20  * 4. The name of the author may not be used to endorse or promote products
   21  *    derived from this software without specific prior written permission.
   22  *
   23  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
   24  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
   25  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
   26  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
   27  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
   28  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
   29  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
   30  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
   31  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
   32  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
   33  */
   35 /*
   36  * natm.c: native mode ATM access (both aal0 and aal5).
   37  */
   39 #include <sys/param.h>
   40 #include <sys/systm.h>
   41 #include <sys/kernel.h>
   42 #include <sys/domain.h>
   43 #include <sys/ioctl.h>
   44 #include <sys/proc.h>
   45 #include <sys/protosw.h>
   46 #include <sys/mbuf.h>
   47 #include <sys/socket.h>
   48 #include <sys/socketvar.h>
   50 #include <net/if.h>
   51 #include <net/if_atm.h>
   52 #include <net/netisr.h>
   53 #include <net/radix.h>
   54 #include <net/route.h>
   56 #include <netinet/in.h>
   58 #include <netnatm/natm.h>
u_long natm5_sendspace = 16*1024;
u_long natm5_recvspace = 16*1024;
u_long natm0_sendspace = 16*1024;
u_long natm0_recvspace = 16*1024;
   66 /*
   67  * user requests
   68  */
   70 #if defined(__NetBSD__)
   71 int natm_usrreq(so, req, m, nam, control)
   72 #elif defined(__OpenBSD__) || defined(__FreeBSD__)
   73 int natm_usrreq(so, req, m, nam, control)
   74 #endif
   75 struct socket *so;
   76 int req;
   77 struct mbuf *m, *nam, *control;
   78 #if defined(__NetBSD__)
   79 struct proc *p;
   80 #endif
   81 {
   82   int error = 0, s, s2;
   83   struct natmpcb *npcb;
   84   struct sockaddr_natm *snatm;
   85   struct atm_pseudoioctl api;
   86   struct atm_pseudohdr *aph;
   87   struct atm_rawioctl ario;
   88   struct ifnet *ifp;
   89   int proto = so->so_proto->pr_protocol;
s = SPLSOFTNET();
npcb = (struct natmpcb *) so->so_pcb;
   95   if (npcb == NULL && req != PRU_ATTACH) {
error = EINVAL;
   97     goto done;
   98   }
  101   switch (req) {
  102     case PRU_ATTACH:                    /* attach protocol to up */
  104       if (npcb) {
error = EISCONN;
  106         break;
  107       }
  109       if (so->so_snd.sb_hiwat == 0 || so->so_rcv.sb_hiwat == 0) {
  110         if (proto == PROTO_NATMAAL5) 
error = soreserve(so, natm5_sendspace, natm5_recvspace);
  112         else
error = soreserve(so, natm0_sendspace, natm0_recvspace);
  114         if (error)
  115           break;
  116       }
so->so_pcb = (caddr_t) (npcb = npcb_alloc(M_WAITOK));
npcb->npcb_socket = so;
  121       break;
  123     case PRU_DETACH:                    /* detach protocol from up */
  125       /*
  126        * we turn on 'drain' *before* we sofree.
  127        */
npcb_free(npcb, NPCB_DESTROY);    /* drain */
so->so_pcb = NULL;
sofree(so);
  133       break;
  135     case PRU_CONNECT:                   /* establish connection to peer */
  137       /*
  138        * validate nam and npcb
  139        */
  141       if (nam->m_len != sizeof(*snatm)) {
error = EINVAL;
  143         break;
  144       }
snatm = mtod(nam, struct sockaddr_natm *);
  146       if (snatm->snatm_len != sizeof(*snatm) ||
  147                 (npcb->npcb_flags & NPCB_FREE) == 0) {
error = EINVAL;
  149         break;
  150       }
  151       if (snatm->snatm_family != AF_NATM) {
error = EAFNOSUPPORT;
  153         break;
  154       }
snatm->snatm_if[IFNAMSIZ-1] = '\0';  /* XXX ensure null termination
  157                                                 since ifunit() uses strcmp */
  159       /*
  160        * convert interface string to ifp, validate.
  161        */
ifp = ifunit(snatm->snatm_if);
  164       if (ifp == NULL || (ifp->if_flags & IFF_RUNNING) == 0) {
error = ENXIO;
  166         break;
  167       }
  168       if (ifp->if_output != atm_output) {
error = EAFNOSUPPORT;
  170         break;
  171       }
  174       /*
  175        * register us with the NATM PCB layer
  176        */
  178       if (npcb_add(npcb, ifp, snatm->snatm_vci, snatm->snatm_vpi) != npcb) {
error = EADDRINUSE;
  180         break;
  181       }
  183       /*
  184        * enable rx
  185        */
ATM_PH_FLAGS(&api.aph) = (proto == PROTO_NATMAAL5) ? ATM_PH_AAL5 : 0;
ATM_PH_VPI(&api.aph) = npcb->npcb_vpi;
ATM_PH_SETVCI(&api.aph, npcb->npcb_vci);
api.rxhand = npcb;
s2 = splnet();
  192       if (ifp->if_ioctl == NULL || 
ifp->if_ioctl(ifp, SIOCATMENA, (caddr_t) &api) != 0) {
splx(s2);
npcb_free(npcb, NPCB_REMOVE);
error = EIO;
  197         break;
  198       }
splx(s2);
soisconnected(so);
  203       break;
  205     case PRU_DISCONNECT:                /* disconnect from peer */
  207       if ((npcb->npcb_flags & NPCB_CONNECTED) == 0) {
printf("natm: disconnected check\n");
error = EIO;
  210         break;
  211       }
ifp = npcb->npcb_ifp;
  214       /*
  215        * disable rx
  216        */
ATM_PH_FLAGS(&api.aph) = ATM_PH_AAL5;
ATM_PH_VPI(&api.aph) = npcb->npcb_vpi;
ATM_PH_SETVCI(&api.aph, npcb->npcb_vci);
api.rxhand = npcb;
s2 = splnet();
  223       if (ifp->if_ioctl != NULL)
ifp->if_ioctl(ifp, SIOCATMDIS, (caddr_t) &api);
splx(s);
npcb_free(npcb, NPCB_REMOVE);
soisdisconnected(so);
  230       break;
  232     case PRU_SHUTDOWN:                  /* won't send any more data */
socantsendmore(so);
  234       break;
  236     case PRU_SEND:                      /* send this data */
  237       if (control && control->m_len) {
m_freem(control);
m_freem(m);
error = EINVAL;
  241         break;
  242       }
  244       /*
  245        * send the data.   we must put an atm_pseudohdr on first
  246        */
M_PREPEND(m, sizeof(*aph), M_WAITOK);
aph = mtod(m, struct atm_pseudohdr *);
ATM_PH_VPI(aph) = npcb->npcb_vpi;
ATM_PH_SETVCI(aph, npcb->npcb_vci);
ATM_PH_FLAGS(aph) = (proto == PROTO_NATMAAL5) ? ATM_PH_AAL5 : 0;
error = atm_output(npcb->npcb_ifp, m, NULL, NULL);
  256       break;
  258     case PRU_SENSE:                     /* return status into m */
  259       /* return zero? */
  260       break;
  262     case PRU_PEERADDR:                  /* fetch peer's address */
snatm = mtod(nam, struct sockaddr_natm *);
bzero(snatm, sizeof(*snatm));
nam->m_len = snatm->snatm_len = sizeof(*snatm);
snatm->snatm_family = AF_NATM;
  267 #if defined(__NetBSD__) || defined(__OpenBSD__)
bcopy(npcb->npcb_ifp->if_xname, snatm->snatm_if, sizeof(snatm->snatm_if));
  269 #elif defined(__FreeBSD__)
sprintf(snatm->snatm_if, "%s%d", npcb->npcb_ifp->if_name,
npcb->npcb_ifp->if_unit);
  272 #endif
snatm->snatm_vci = npcb->npcb_vci;
snatm->snatm_vpi = npcb->npcb_vpi;
  275       break;
  277     case PRU_CONTROL:                   /* control operations on protocol */
  278       /*
  279        * raw atm ioctl.   comes in as a SIOCRAWATM.   we convert it to
  280        * SIOCXRAWATM and pass it to the driver.
  281        */
  282       if ((u_long)m == SIOCRAWATM) {
  283         if (npcb->npcb_ifp == NULL) {
error = ENOTCONN;
  285           break;
  286         }
ario.npcb = npcb;
ario.rawvalue = *((int *)nam);
error = npcb->npcb_ifp->if_ioctl(npcb->npcb_ifp, 
SIOCXRAWATM, (caddr_t) &ario);
  291         if (!error) {
  292           if (ario.rawvalue) 
npcb->npcb_flags |= NPCB_RAW;
  294           else
npcb->npcb_flags &= ~(NPCB_RAW);
  296         }
  298         break;
  299       }
error = EOPNOTSUPP;
  302       break;
  304     case PRU_BIND:                      /* bind socket to address */
  305     case PRU_LISTEN:                    /* listen for connection */
  306     case PRU_ACCEPT:                    /* accept connection from peer */
  307     case PRU_CONNECT2:                  /* connect two sockets */
  308     case PRU_ABORT:                     /* abort (fast DISCONNECT, DETATCH) */
  309                                         /* (only happens if LISTEN socket) */
  310     case PRU_RCVD:                      /* have taken data; more room now */
  311     case PRU_FASTTIMO:                  /* 200ms timeout */
  312     case PRU_SLOWTIMO:                  /* 500ms timeout */
  313     case PRU_RCVOOB:                    /* retrieve out of band data */
  314     case PRU_SENDOOB:                   /* send out of band data */
  315     case PRU_PROTORCV:                  /* receive from below */
  316     case PRU_PROTOSEND:                 /* send to below */
  317     case PRU_SOCKADDR:                  /* fetch socket's address */
  318 #ifdef DIAGNOSTIC
printf("natm: PRU #%d unsupported\n", req);
  320 #endif
error = EOPNOTSUPP;
  322       break;
  324     default: panic("natm usrreq");
  325   }
done:
splx(s);
  329   return(error);
  330 }
  332 /*
  333  * natmintr: splsoftnet interrupt
  334  *
  335  * note: we expect a socket pointer in rcvif rather than an interface
  336  * pointer.    we can get the interface pointer from the so's PCB if
  337  * we really need it.
  338  */
  340 void
natmintr()
  343 {
  344   int s;
  345   struct mbuf *m;
  346   struct socket *so;
  347   struct natmpcb *npcb;
next:
s = splnet();
IF_DEQUEUE(&natmintrq, m);
splx(s);
  353   if (m == NULL)
  354     return;
  356 #ifdef DIAGNOSTIC
  357   if ((m->m_flags & M_PKTHDR) == 0)
panic("natmintr no HDR");
  359 #endif
npcb = (struct natmpcb *) m->m_pkthdr.rcvif; /* XXX: overloaded */
so = npcb->npcb_socket;
s = splnet();                 /* could have atm devs @ different levels */
npcb->npcb_inq--;
splx(s);
  368   if (npcb->npcb_flags & NPCB_DRAIN) {
m_freem(m);
  370     if (npcb->npcb_inq == 0)
FREE(npcb, M_PCB);                        /* done! */
  372     goto next;
  373   }
  375   if (npcb->npcb_flags & NPCB_FREE) {
m_freem(m);                                 /* drop */
  377     goto next;
  378   }
  380 #ifdef NEED_TO_RESTORE_IFP
m->m_pkthdr.rcvif = npcb->npcb_ifp;
  382 #else
  383 #ifdef DIAGNOSTIC
m->m_pkthdr.rcvif = NULL;       /* null it out to be safe */
  385 #endif
  386 #endif
  388   if (sbspace(&so->so_rcv) > m->m_pkthdr.len ||
  389      ((npcb->npcb_flags & NPCB_RAW) != 0 && so->so_rcv.sb_cc < NPCB_RAWCC) ) {
  390 #ifdef NATM_STAT
natm_sookcnt++;
natm_sookbytes += m->m_pkthdr.len;
  393 #endif
sbappendrecord(&so->so_rcv, m);
sorwakeup(so);
  396   } else {
  397 #ifdef NATM_STAT
natm_sodropcnt++;
natm_sodropbytes += m->m_pkthdr.len;
  400 #endif
m_freem(m);
  402   }
  404   goto next;
  405 }
  407 #if defined(__FreeBSD__)
  408 NETISR_SET(NETISR_NATM, natmintr);
  409 #endif
  412 /* 
  413  * natm0_sysctl: not used, but here in case we want to add something
  414  * later...
  415  */
  417 int natm0_sysctl(name, namelen, oldp, oldlenp, newp, newlen)
  419 int *name;
u_int namelen;
  421 void *oldp;
size_t *oldlenp;
  423 void *newp;
size_t newlen;
  426 {
  427   /* All sysctl names at this level are terminal. */
  428   if (namelen != 1)
  429     return (ENOTDIR);
  430   return (ENOPROTOOPT);
  431 }
  433 /* 
  434  * natm5_sysctl: not used, but here in case we want to add something
  435  * later...
  436  */
  438 int natm5_sysctl(name, namelen, oldp, oldlenp, newp, newlen)
  440 int *name;
u_int namelen;
  442 void *oldp;
size_t *oldlenp;
  444 void *newp;
size_t newlen;
  447 {
  448   /* All sysctl names at this level are terminal. */
  449   if (namelen != 1)
  450     return (ENOTDIR);
  451   return (ENOPROTOOPT);
  452 }