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  * $FreeBSD: src/sys/net/if_atmsubr.c,v 1.10.2.1 2001/03/06 00:29:26 obrien Exp $
   35  * $DragonFly: src/sys/net/if_atmsubr.c,v 1.20 2008/06/05 18:06:32 swildner Exp $
   36  */
   37 
   38 /*
   39  * if_atmsubr.c
   40  */
   41 
   42 #include "opt_inet.h"
   43 #include "opt_inet6.h"
   44 #include "opt_natm.h"
   45 
   46 #include <sys/param.h>
   47 #include <sys/systm.h>
   48 #include <sys/mbuf.h>
   49 #include <sys/socket.h>
   50 #include <sys/sockio.h>
   51 #include <sys/errno.h>
   52 #include <sys/serialize.h>
   53 
   54 #include <sys/thread2.h>
   55 
   56 #include <net/if.h>
   57 #include <net/if_var.h>
   58 #include <net/ifq_var.h>
   59 #include <net/bpf.h>
   60 #include <net/netisr.h>
   61 #include <net/route.h>
   62 #include <net/if_dl.h>
   63 #include <net/if_types.h>
   64 #include <net/if_atm.h>
   65 
   66 #include <netinet/in.h>
   67 #include <netinet/if_atm.h>
   68 #include <netinet/if_ether.h> /* XXX: for ETHERTYPE_* */
   69 #if defined(INET) || defined(INET6)
   70 #include <netinet/in_var.h>
   71 #endif
   72 #ifdef NATM
   73 #include <netproto/natm/natm.h>
   74 #endif
   75 
   76 #ifndef ETHERTYPE_IPV6
   77 #define ETHERTYPE_IPV6  0x86dd
   78 #endif
   79 
   80 #define gotoerr(e) { error = (e); goto bad;}
   81 
   82 /*
   83  * atm_output: ATM output routine
   84  *   inputs:
   85  *     "ifp" = ATM interface to output to
   86  *     "m0" = the packet to output
   87  *     "dst" = the sockaddr to send to (either IP addr, or raw VPI/VCI)
   88  *     "rt0" = the route to use
   89  *   returns: error code   [0 == ok]
   90  *
   91  *   note: special semantic: if (dst == NULL) then we assume "m" already
   92  *              has an atm_pseudohdr on it and just send it directly.
   93  *              [for native mode ATM output]   if dst is null, then
   94  *              rt0 must also be NULL.
   95  */
   96 
   97 int
   98 atm_output(struct ifnet *ifp, struct mbuf *m0, struct sockaddr *dst,
   99            struct rtentry *rt0)
  100 {
  101         u_int16_t etype = 0;                    /* if using LLC/SNAP */
  102         int error = 0, sz;
  103         struct atm_pseudohdr atmdst, *ad;
  104         struct mbuf *m = m0;
  105         struct rtentry *rt;
  106         struct atmllc *atmllc;
  107         struct atmllc *llc_hdr = NULL;
  108         u_int32_t atm_flags;
  109         struct altq_pktattr pktattr;
  110 
  111         if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
  112                 gotoerr(ENETDOWN);
  113 
  114         /*
  115          * if the queueing discipline needs packet classification,
  116          * do it before prepending link headers.
  117          */
  118         ifq_classify(&ifp->if_snd, m,
  119                      (dst != NULL ? dst->sa_family : AF_UNSPEC), &pktattr);
  120 
  121         /*
  122          * check route
  123          */
  124         if ((rt = rt0) != NULL) {
  125 
  126                 if (!(rt->rt_flags & RTF_UP)) { /* route went down! */
  127                         if ((rt0 = rt = RTALLOC1(dst, 0)) != NULL)
  128                                 rt->rt_refcnt--;
  129                         else 
  130                                 gotoerr(EHOSTUNREACH);
  131                 }
  132 
  133                 if (rt->rt_flags & RTF_GATEWAY) {
  134                         if (rt->rt_gwroute == NULL)
  135                                 goto lookup;
  136                         if (((rt = rt->rt_gwroute)->rt_flags & RTF_UP) == 0) {
  137                                 rtfree(rt); rt = rt0;
  138                         lookup: rt->rt_gwroute = RTALLOC1(rt->rt_gateway, 0);
  139                                 if ((rt = rt->rt_gwroute) == NULL)
  140                                         gotoerr(EHOSTUNREACH);
  141                         }
  142                 }
  143 
  144                 /* XXX: put RTF_REJECT code here if doing ATMARP */
  145 
  146         }
  147 
  148         /*
  149          * check for non-native ATM traffic   (dst != NULL)
  150          */
  151         if (dst) {
  152                 switch (dst->sa_family) {
  153 #if defined(INET) || defined(INET6)
  154                 case AF_INET:
  155                 case AF_INET6:
  156                         if (dst->sa_family == AF_INET6)
  157                                 etype = htons(ETHERTYPE_IPV6);
  158                         else
  159                                 etype = htons(ETHERTYPE_IP);
  160                         if (!atmresolve(rt, m, dst, &atmdst)) {
  161                                 m = NULL; 
  162                                 /* XXX: atmresolve already free'd it */
  163                                 gotoerr(EHOSTUNREACH);
  164                                 /* XXX: put ATMARP stuff here */
  165                                 /* XXX: watch who frees m on failure */
  166                         }
  167                         break;
  168 #endif /* INET || INET6 */
  169 
  170                 case AF_UNSPEC:
  171                         /*
  172                          * XXX: bpfwrite. assuming dst contains 12 bytes
  173                          * (atm pseudo header (4) + LLC/SNAP (8))
  174                          */
  175                         bcopy(dst->sa_data, &atmdst, sizeof(atmdst));
  176                         llc_hdr = (struct atmllc *)(dst->sa_data + sizeof(atmdst));
  177                         break;
  178                         
  179                 default:
  180 #if defined(__NetBSD__) || defined(__OpenBSD__)
  181                         kprintf("%s: can't handle af%d\n", ifp->if_xname, 
  182                             dst->sa_family);
  183 #elif defined(__DragonFly__) || defined(__FreeBSD__) || defined(__bsdi__)
  184                         kprintf("%s: can't handle af%d\n", ifp->if_xname, 
  185                             dst->sa_family);
  186 #endif
  187                         gotoerr(EAFNOSUPPORT);
  188                 }
  189 
  190                 /*
  191                  * must add atm_pseudohdr to data
  192                  */
  193                 sz = sizeof(atmdst);
  194                 atm_flags = ATM_PH_FLAGS(&atmdst);
  195                 if (atm_flags & ATM_PH_LLCSNAP) sz += 8; /* sizeof snap == 8 */
  196                 M_PREPEND(m, sz, MB_DONTWAIT);
  197                 if (m == NULL)
  198                         gotoerr(ENOBUFS);
  199                 ad = mtod(m, struct atm_pseudohdr *);
  200                 *ad = atmdst;
  201                 if (atm_flags & ATM_PH_LLCSNAP) {
  202                         atmllc = (struct atmllc *)(ad + 1);
  203                         if (llc_hdr == NULL) {
  204                                 bcopy(ATMLLC_HDR, atmllc->llchdr, 
  205                                       sizeof(atmllc->llchdr));
  206                                 ATM_LLC_SETTYPE(atmllc, etype); 
  207                                         /* note: already in network order */
  208                         }
  209                         else
  210                                 bcopy(llc_hdr, atmllc, sizeof(struct atmllc));
  211                 }
  212         }
  213 
  214         /*
  215          * Dispatch message to the interface.
  216          */
  217         error = ifq_dispatch(ifp, m, &pktattr);
  218         return error;
  219 
  220 bad:
  221         if (m != NULL)
  222                 m_freem(m);
  223         return (error);
  224 }
  225 
  226 /*
  227  * Process a received ATM packet;
  228  * the packet is in the mbuf chain m.
  229  */
  230 void
  231 atm_input(struct ifnet *ifp, struct atm_pseudohdr *ah, struct mbuf *m,
  232           void *rxhand)
  233 {
  234         u_int16_t etype = ETHERTYPE_IP; /* default */
  235         int isr;
  236 
  237         if (!(ifp->if_flags & IFF_UP)) {
  238                 m_freem(m);
  239                 return;
  240         }
  241         IFNET_STAT_INC(ifp, ibytes, m->m_pkthdr.len);
  242 
  243         if (rxhand) {
  244 #ifdef NATM
  245                 struct natmpcb *npcb = rxhand;
  246                 crit_enter();           /* in case 2 atm cards @ diff lvls */
  247                 npcb->npcb_inq++;       /* count # in queue */
  248                 crit_exit();
  249                 isr = NETISR_NATM;
  250                 m->m_pkthdr.rcvif = rxhand; /* XXX: overload */
  251 #else
  252                 kprintf("atm_input: NATM detected but not configured in kernel\n");
  253                 m_freem(m);
  254                 return;
  255 #endif
  256         } else {
  257                 /*
  258                  * handle LLC/SNAP header, if present
  259                  */
  260                 if (ATM_PH_FLAGS(ah) & ATM_PH_LLCSNAP) {
  261                         struct atmllc *alc;
  262                         if (m->m_len < sizeof(*alc) &&
  263                             (m = m_pullup(m, sizeof(*alc))) == NULL)
  264                                 return; /* failed */
  265                         alc = mtod(m, struct atmllc *);
  266                         if (bcmp(alc, ATMLLC_HDR, 6)) {
  267 #if defined(__NetBSD__) || defined(__OpenBSD__)
  268                                 kprintf("%s: recv'd invalid LLC/SNAP frame [vp=%d,vc=%d]\n",
  269                                        ifp->if_xname, ATM_PH_VPI(ah), ATM_PH_VCI(ah));
  270 #elif defined(__DragonFly__) || defined(__FreeBSD__) || defined(__bsdi__)
  271                                 kprintf("%s: recv'd invalid LLC/SNAP frame [vp=%d,vc=%d]\n",
  272                                        ifp->if_xname, ATM_PH_VPI(ah), ATM_PH_VCI(ah));
  273 #endif
  274                                 m_freem(m);
  275                                 return;
  276                         }
  277                         etype = ATM_LLC_TYPE(alc);
  278                         m_adj(m, sizeof(*alc));
  279                 }
  280 
  281                 switch (etype) {
  282 #ifdef INET
  283                 case ETHERTYPE_IP:
  284                         isr = NETISR_IP;
  285                         break;
  286 #endif
  287 #ifdef INET6
  288                 case ETHERTYPE_IPV6:
  289                         isr = NETISR_IPV6;
  290                         break;
  291 #endif
  292                 default:
  293                         m_freem(m);
  294                         return;
  295                 }
  296         }
  297 
  298         m->m_flags &= ~M_HASH;
  299         netisr_queue(isr, m);
  300 }
  301 
  302 /*
  303  * Perform common duties while attaching to interface list
  304  */
  305 void
  306 atm_ifattach(struct ifnet *ifp, lwkt_serialize_t serializer)
  307 {
  308         struct ifaddr_container *ifac;
  309         struct sockaddr_dl *sdl;
  310 
  311         ifp->if_type = IFT_ATM;
  312         ifp->if_addrlen = 0;
  313         ifp->if_hdrlen = 0;
  314         ifp->if_mtu = ATMMTU;
  315 #if 0 /* XXX */
  316         ifp->if_input = atm_input;
  317 #endif
  318         ifp->if_output = atm_output;
  319         ifq_set_maxlen(&ifp->if_snd, 50);
  320         if_attach(ifp, serializer);
  321 
  322         TAILQ_FOREACH(ifac, &ifp->if_addrheads[mycpuid], ifa_link) {
  323                 struct ifaddr *ifa = ifac->ifa;
  324 
  325                 if ((sdl = (struct sockaddr_dl *)ifa->ifa_addr) &&
  326                     sdl->sdl_family == AF_LINK) {
  327                         sdl->sdl_type = IFT_ATM;
  328                         sdl->sdl_alen = ifp->if_addrlen;
  329 #ifdef notyet /* if using ATMARP, store hardware address using the next line */
  330                         bcopy(ifp->hw_addr, LLADDR(sdl), ifp->if_addrlen);
  331 #endif
  332                         break;
  333                 }
  334         }
  335         bpfattach(ifp, DLT_ATM_RFC1483, sizeof(struct atmllc));
  336 }
Cache object: 63ce26c28413179a0c8e6537266a4ba8
[ 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.
FreeBSD/Linux Kernel Cross Reference sys/net/if_atmsubr.c

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