The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/net/if_atmsubr.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /*      $NetBSD: if_atmsubr.c,v 1.10 1997/03/11 23:19:51 chuck Exp $       */
    2 
    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  *
   34  * if_atmsubr.c
   35  */
   36 
   37 #include <sys/cdefs.h>
   38 __FBSDID("$FreeBSD$");
   39 
   40 #include "opt_inet.h"
   41 #include "opt_inet6.h"
   42 #include "opt_mac.h"
   43 #include "opt_natm.h"
   44 
   45 #include <sys/param.h>
   46 #include <sys/systm.h>
   47 #include <sys/kernel.h>
   48 #include <sys/module.h>
   49 #include <sys/mac.h>
   50 #include <sys/mbuf.h>
   51 #include <sys/socket.h>
   52 #include <sys/sockio.h>
   53 #include <sys/errno.h>
   54 #include <sys/sysctl.h>
   55 #include <sys/malloc.h>
   56 
   57 #include <net/if.h>
   58 #include <net/netisr.h>
   59 #include <net/route.h>
   60 #include <net/if_dl.h>
   61 #include <net/if_types.h>
   62 #include <net/if_atm.h>
   63 
   64 #include <netinet/in.h>
   65 #include <netinet/if_atm.h>
   66 #include <netinet/if_ether.h> /* XXX: for ETHERTYPE_* */
   67 #if defined(INET) || defined(INET6)
   68 #include <netinet/in_var.h>
   69 #endif
   70 #ifdef NATM
   71 #include <netnatm/natm.h>
   72 #endif
   73 
   74 /*
   75  * Netgraph interface functions.
   76  * These need not be protected by a lock, because ng_atm nodes are persitent.
   77  * The ng_atm module can be unloaded only if all ATM interfaces have been
   78  * unloaded, so nobody should be in the code paths accessing these function
   79  * pointers.
   80  */
   81 void    (*ng_atm_attach_p)(struct ifnet *);
   82 void    (*ng_atm_detach_p)(struct ifnet *);
   83 int     (*ng_atm_output_p)(struct ifnet *, struct mbuf **);
   84 void    (*ng_atm_input_p)(struct ifnet *, struct mbuf **,
   85             struct atm_pseudohdr *, void *);
   86 void    (*ng_atm_input_orphan_p)(struct ifnet *, struct mbuf *,
   87             struct atm_pseudohdr *, void *);
   88 void    (*ng_atm_event_p)(struct ifnet *, uint32_t, void *);
   89 
   90 /*
   91  * Harp pseudo interface hooks
   92  */
   93 void    (*atm_harp_input_p)(struct ifnet *ifp, struct mbuf **m,
   94             struct atm_pseudohdr *ah, void *rxhand);
   95 void    (*atm_harp_attach_p)(struct ifnet *);
   96 void    (*atm_harp_detach_p)(struct ifnet *);
   97 void    (*atm_harp_event_p)(struct ifnet *, uint32_t, void *);
   98 
   99 SYSCTL_NODE(_hw, OID_AUTO, atm, CTLFLAG_RW, 0, "ATM hardware");
  100 
  101 MALLOC_DEFINE(M_IFATM, "ifatm", "atm interface internals");
  102 
  103 #ifndef ETHERTYPE_IPV6
  104 #define ETHERTYPE_IPV6  0x86dd
  105 #endif
  106 
  107 #define senderr(e) do { error = (e); goto bad; } while (0)
  108 
  109 /*
  110  * atm_output: ATM output routine
  111  *   inputs:
  112  *     "ifp" = ATM interface to output to
  113  *     "m0" = the packet to output
  114  *     "dst" = the sockaddr to send to (either IP addr, or raw VPI/VCI)
  115  *     "rt0" = the route to use
  116  *   returns: error code   [0 == ok]
  117  *
  118  *   note: special semantic: if (dst == NULL) then we assume "m" already
  119  *              has an atm_pseudohdr on it and just send it directly.
  120  *              [for native mode ATM output]   if dst is null, then
  121  *              rt0 must also be NULL.
  122  */
  123 int
  124 atm_output(struct ifnet *ifp, struct mbuf *m0, struct sockaddr *dst,
  125     struct rtentry *rt0)
  126 {
  127         u_int16_t etype = 0;                    /* if using LLC/SNAP */
  128         int error = 0, sz;
  129         struct atm_pseudohdr atmdst, *ad;
  130         struct mbuf *m = m0;
  131         struct atmllc *atmllc;
  132         struct atmllc *llc_hdr = NULL;
  133         u_int32_t atm_flags;
  134 
  135 #ifdef MAC
  136         error = mac_check_ifnet_transmit(ifp, m);
  137         if (error)
  138                 senderr(error);
  139 #endif
  140 
  141         if (!((ifp->if_flags & IFF_UP) &&
  142             (ifp->if_drv_flags & IFF_DRV_RUNNING)))
  143                 senderr(ENETDOWN);
  144 
  145         /*
  146          * check for non-native ATM traffic   (dst != NULL)
  147          */
  148         if (dst) {
  149                 switch (dst->sa_family) {
  150 
  151 #if defined(INET) || defined(INET6)
  152                 case AF_INET:
  153                 case AF_INET6:
  154                 {
  155                         struct rtentry *rt = NULL;
  156                         /*  
  157                          * check route
  158                          */
  159                         if (rt0 != NULL) {
  160                                 error = rt_check(&rt, &rt0, dst);
  161                                 if (error)
  162                                         goto bad;
  163                                 RT_UNLOCK(rt);
  164                         }
  165 
  166                         if (dst->sa_family == AF_INET6)
  167                                 etype = ETHERTYPE_IPV6;
  168                         else
  169                                 etype = ETHERTYPE_IP;
  170                         if (!atmresolve(rt, m, dst, &atmdst)) {
  171                                 m = NULL; 
  172                                 /* XXX: atmresolve already free'd it */
  173                                 senderr(EHOSTUNREACH);
  174                                 /* XXX: put ATMARP stuff here */
  175                                 /* XXX: watch who frees m on failure */
  176                         }
  177                 }
  178                         break;
  179 #endif /* INET || INET6 */
  180 
  181                 case AF_UNSPEC:
  182                         /*
  183                          * XXX: bpfwrite. assuming dst contains 12 bytes
  184                          * (atm pseudo header (4) + LLC/SNAP (8))
  185                          */
  186                         bcopy(dst->sa_data, &atmdst, sizeof(atmdst));
  187                         llc_hdr = (struct atmllc *)(dst->sa_data +
  188                             sizeof(atmdst));
  189                         break;
  190                         
  191                 default:
  192 #if (defined(__FreeBSD__) && __FreeBSD_version >= 501113) || \
  193     defined(__NetBSD__) || defined(__OpenBSD__)
  194                         printf("%s: can't handle af%d\n", ifp->if_xname, 
  195                             dst->sa_family);
  196 #elif defined(__FreeBSD__) || defined(__bsdi__)
  197                         printf("%s%d: can't handle af%d\n", ifp->if_name, 
  198                             ifp->if_unit, dst->sa_family);
  199 #endif
  200                         senderr(EAFNOSUPPORT);
  201                 }
  202 
  203                 /*
  204                  * must add atm_pseudohdr to data
  205                  */
  206                 sz = sizeof(atmdst);
  207                 atm_flags = ATM_PH_FLAGS(&atmdst);
  208                 if (atm_flags & ATM_PH_LLCSNAP)
  209                         sz += 8;        /* sizeof snap == 8 */
  210                 M_PREPEND(m, sz, M_DONTWAIT);
  211                 if (m == 0)
  212                         senderr(ENOBUFS);
  213                 ad = mtod(m, struct atm_pseudohdr *);
  214                 *ad = atmdst;
  215                 if (atm_flags & ATM_PH_LLCSNAP) {
  216                         atmllc = (struct atmllc *)(ad + 1);
  217                         if (llc_hdr == NULL) {
  218                                 bcopy(ATMLLC_HDR, atmllc->llchdr, 
  219                                       sizeof(atmllc->llchdr));
  220                                 /* note: in host order */
  221                                 ATM_LLC_SETTYPE(atmllc, etype); 
  222                         }
  223                         else
  224                                 bcopy(llc_hdr, atmllc, sizeof(struct atmllc));
  225                 }
  226         }
  227 
  228         if (ng_atm_output_p != NULL) {
  229                 if ((error = (*ng_atm_output_p)(ifp, &m)) != 0) {
  230                         if (m != NULL)
  231                                 m_freem(m);
  232                         return (error);
  233                 }
  234                 if (m == NULL)
  235                         return (0);
  236         }
  237 
  238         /*
  239          * Queue message on interface, and start output if interface
  240          * not yet active.
  241          */
  242         if (!IF_HANDOFF_ADJ(&ifp->if_snd, m, ifp,
  243             -(int)sizeof(struct atm_pseudohdr)))
  244                 return (ENOBUFS);
  245         return (error);
  246 
  247 bad:
  248         if (m)
  249                 m_freem(m);
  250         return (error);
  251 }
  252 
  253 /*
  254  * Process a received ATM packet;
  255  * the packet is in the mbuf chain m.
  256  */
  257 void
  258 atm_input(struct ifnet *ifp, struct atm_pseudohdr *ah, struct mbuf *m,
  259     void *rxhand)
  260 {
  261         int isr;
  262         u_int16_t etype = ETHERTYPE_IP;         /* default */
  263 
  264         if ((ifp->if_flags & IFF_UP) == 0) {
  265                 m_freem(m);
  266                 return;
  267         }
  268 #ifdef MAC
  269         mac_create_mbuf_from_ifnet(ifp, m);
  270 #endif
  271         ifp->if_ibytes += m->m_pkthdr.len;
  272 
  273         if (ng_atm_input_p != NULL) {
  274                 (*ng_atm_input_p)(ifp, &m, ah, rxhand);
  275                 if (m == NULL)
  276                         return;
  277         }
  278 
  279         /* not eaten by ng_atm. Maybe it's a pseudo-harp PDU? */
  280         if (atm_harp_input_p != NULL) {
  281                 (*atm_harp_input_p)(ifp, &m, ah, rxhand);
  282                 if (m == NULL)
  283                         return;
  284         }
  285 
  286         if (rxhand) {
  287 #ifdef NATM
  288                 struct natmpcb *npcb;
  289 
  290                 /*
  291                  * XXXRW: this use of 'rxhand' is not a very good idea, and
  292                  * was subject to races even before SMPng due to the release
  293                  * of spl here.
  294                  */
  295                 NATM_LOCK();
  296                 npcb = rxhand;
  297                 npcb->npcb_inq++;       /* count # in queue */
  298                 isr = NETISR_NATM;
  299                 m->m_pkthdr.rcvif = rxhand; /* XXX: overload */
  300                 NATM_UNLOCK();
  301 #else
  302                 printf("atm_input: NATM detected but not "
  303                     "configured in kernel\n");
  304                 goto dropit;
  305 #endif
  306         } else {
  307                 /*
  308                  * handle LLC/SNAP header, if present
  309                  */
  310                 if (ATM_PH_FLAGS(ah) & ATM_PH_LLCSNAP) {
  311                         struct atmllc *alc;
  312 
  313                         if (m->m_len < sizeof(*alc) &&
  314                             (m = m_pullup(m, sizeof(*alc))) == 0)
  315                                 return; /* failed */
  316                         alc = mtod(m, struct atmllc *);
  317                         if (bcmp(alc, ATMLLC_HDR, 6)) {
  318 #if (defined(__FreeBSD__) && __FreeBSD_version >= 501113) || \
  319     defined(__NetBSD__) || defined(__OpenBSD__)
  320                                 printf("%s: recv'd invalid LLC/SNAP frame "
  321                                     "[vp=%d,vc=%d]\n", ifp->if_xname,
  322                                     ATM_PH_VPI(ah), ATM_PH_VCI(ah));
  323 #elif defined(__FreeBSD__) || defined(__bsdi__)
  324                                 printf("%s%d: recv'd invalid LLC/SNAP frame "
  325                                     "[vp=%d,vc=%d]\n", ifp->if_name,
  326                                     ifp->if_unit, ATM_PH_VPI(ah),
  327                                     ATM_PH_VCI(ah));
  328 #endif
  329                                 m_freem(m);
  330                                 return;
  331                         }
  332                         etype = ATM_LLC_TYPE(alc);
  333                         m_adj(m, sizeof(*alc));
  334                 }
  335 
  336                 switch (etype) {
  337 
  338 #ifdef INET
  339                 case ETHERTYPE_IP:
  340                         isr = NETISR_IP;
  341                         break;
  342 #endif
  343 
  344 #ifdef INET6
  345                 case ETHERTYPE_IPV6:
  346                         isr = NETISR_IPV6;
  347                         break;
  348 #endif
  349                 default:
  350 #ifndef NATM
  351   dropit:
  352 #endif
  353                         if (ng_atm_input_orphan_p != NULL)
  354                                 (*ng_atm_input_orphan_p)(ifp, m, ah, rxhand);
  355                         else
  356                                 m_freem(m);
  357                         return;
  358                 }
  359         }
  360         netisr_dispatch(isr, m);
  361 }
  362 
  363 /*
  364  * Perform common duties while attaching to interface list.
  365  */
  366 void
  367 atm_ifattach(struct ifnet *ifp)
  368 {
  369         struct ifaddr *ifa;
  370         struct sockaddr_dl *sdl;
  371         struct ifatm *ifatm = ifp->if_l2com;
  372 
  373         ifp->if_addrlen = 0;
  374         ifp->if_hdrlen = 0;
  375         if_attach(ifp);
  376         ifp->if_mtu = ATMMTU;
  377         ifp->if_output = atm_output;
  378 #if 0
  379         ifp->if_input = atm_input;
  380 #endif
  381         ifp->if_snd.ifq_maxlen = 50;    /* dummy */
  382 
  383 #if defined(__NetBSD__) || defined(__OpenBSD__)
  384         TAILQ_FOREACH(ifa, &ifp->if_addrlist, ifa_list)
  385 #elif defined(__FreeBSD__) && (__FreeBSD__ > 2)
  386         for (ifa = TAILQ_FIRST(&ifp->if_addrhead); ifa; 
  387             ifa = TAILQ_NEXT(ifa, ifa_link))
  388 #elif defined(__FreeBSD__) || defined(__bsdi__)
  389         for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) 
  390 #endif
  391                 if ((sdl = (struct sockaddr_dl *)ifa->ifa_addr) &&
  392                     sdl->sdl_family == AF_LINK) {
  393                         sdl->sdl_type = IFT_ATM;
  394                         sdl->sdl_alen = ifp->if_addrlen;
  395 #ifdef notyet /* if using ATMARP, store hardware address using the next line */
  396                         bcopy(ifp->hw_addr, LLADDR(sdl), ifp->if_addrlen);
  397 #endif
  398                         break;
  399                 }
  400 
  401         ifp->if_linkmib = &ifatm->mib;
  402         ifp->if_linkmiblen = sizeof(ifatm->mib);
  403 
  404         if(ng_atm_attach_p)
  405                 (*ng_atm_attach_p)(ifp);
  406         if (atm_harp_attach_p)
  407                 (*atm_harp_attach_p)(ifp);
  408 }
  409 
  410 /*
  411  * Common stuff for detaching an ATM interface
  412  */
  413 void
  414 atm_ifdetach(struct ifnet *ifp)
  415 {
  416         if (atm_harp_detach_p)
  417                 (*atm_harp_detach_p)(ifp);
  418         if(ng_atm_detach_p)
  419                 (*ng_atm_detach_p)(ifp);
  420         if_detach(ifp);
  421 }
  422 
  423 /*
  424  * Support routine for the SIOCATMGVCCS ioctl().
  425  *
  426  * This routine assumes, that the private VCC structures used by the driver
  427  * begin with a struct atmio_vcc.
  428  *
  429  * Return a table of VCCs in a freshly allocated memory area.
  430  * Here we have a problem: we first count, how many vccs we need
  431  * to return. The we allocate the memory and finally fill it in.
  432  * Because we cannot lock while calling malloc, the number of active
  433  * vccs may change while we're in malloc. So we allocate a couple of
  434  * vccs more and if space anyway is not enough re-iterate.
  435  *
  436  * We could use an sx lock for the vcc tables.
  437  */
  438 struct atmio_vcctable *
  439 atm_getvccs(struct atmio_vcc **table, u_int size, u_int start,
  440     struct mtx *lock, int waitok)
  441 {
  442         u_int cid, alloc;
  443         size_t len;
  444         struct atmio_vcctable *vccs;
  445         struct atmio_vcc *v;
  446 
  447         alloc = start + 10;
  448         vccs = NULL;
  449 
  450         for (;;) {
  451                 len = sizeof(*vccs) + alloc * sizeof(vccs->vccs[0]);
  452                 vccs = reallocf(vccs, len, M_TEMP,
  453                     waitok ? M_WAITOK : M_NOWAIT);
  454                 if (vccs == NULL)
  455                         return (NULL);
  456                 bzero(vccs, len);
  457 
  458                 vccs->count = 0;
  459                 v = vccs->vccs;
  460 
  461                 mtx_lock(lock);
  462                 for (cid = 0; cid < size; cid++)
  463                         if (table[cid] != NULL) {
  464                                 if (++vccs->count == alloc)
  465                                         /* too many - try again */
  466                                         break;
  467                                 *v++ = *table[cid];
  468                         }
  469                 mtx_unlock(lock);
  470 
  471                 if (cid == size)
  472                         break;
  473 
  474                 alloc *= 2;
  475         }
  476         return (vccs);
  477 }
  478 
  479 /*
  480  * Driver or channel state has changed. Inform whoever is interested
  481  * in these events.
  482  */
  483 void
  484 atm_event(struct ifnet *ifp, u_int event, void *arg)
  485 {
  486         if (ng_atm_event_p != NULL)
  487                 (*ng_atm_event_p)(ifp, event, arg);
  488         if (atm_harp_event_p != NULL)
  489                 (*atm_harp_event_p)(ifp, event, arg);
  490 }
  491 
  492 static void *
  493 atm_alloc(u_char type, struct ifnet *ifp)
  494 {
  495         struct ifatm    *ifatm;
  496 
  497         ifatm = malloc(sizeof(struct ifatm), M_IFATM, M_WAITOK | M_ZERO);
  498         ifatm->ifp = ifp;
  499 
  500         return (ifatm);
  501 }
  502 
  503 static void
  504 atm_free(void *com, u_char type)
  505 {
  506 
  507         free(com, M_IFATM);
  508 }
  509 
  510 static int
  511 atm_modevent(module_t mod, int type, void *data)
  512 {
  513         switch (type) {
  514         case MOD_LOAD:
  515                 if_register_com_alloc(IFT_ATM, atm_alloc, atm_free);
  516                 break;
  517         case MOD_UNLOAD:
  518                 if_deregister_com_alloc(IFT_ATM);
  519                 break;
  520         default:
  521                 return (EOPNOTSUPP);
  522         }
  523 
  524         return (0);
  525 }
  526 
  527 static moduledata_t atm_mod = {
  528         "atm",
  529         atm_modevent,
  530         0
  531 };
  532                 
  533 DECLARE_MODULE(atm, atm_mod, SI_SUB_INIT_IF, SI_ORDER_ANY);
  534 MODULE_VERSION(atm, 1);

Cache object: ed5c67773ad2d43e8c6727a749f2d212


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.