if_hippisubr.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_hippisubr.c,v 1.34 2008/02/20 17:05:53 matt Exp $   */
    2 
    3 /*
    4  * Copyright (c) 1982, 1989, 1993
    5  *      The Regents of the University of California.  All rights reserved.
    6  *
    7  * Redistribution and use in source and binary forms, with or without
    8  * modification, are permitted provided that the following conditions
    9  * are met:
   10  * 1. Redistributions of source code must retain the above copyright
   11  *    notice, this list of conditions and the following disclaimer.
   12  * 2. Redistributions in binary form must reproduce the above copyright
   13  *    notice, this list of conditions and the following disclaimer in the
   14  *    documentation and/or other materials provided with the distribution.
   15  * 3. Neither the name of the University nor the names of its contributors
   16  *    may be used to endorse or promote products derived from this software
   17  *    without specific prior written permission.
   18  *
   19  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
   20  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   22  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
   23  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   24  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   25  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   29  * SUCH DAMAGE.
   30  */
   31 
   32 #include <sys/cdefs.h>
   33 __KERNEL_RCSID(0, "$NetBSD: if_hippisubr.c,v 1.34 2008/02/20 17:05:53 matt Exp $");
   34 
   35 #include "opt_inet.h"
   36 
   37 #include "bpfilter.h"
   38 
   39 #include <sys/param.h>
   40 #include <sys/systm.h>
   41 #include <sys/kernel.h>
   42 #include <sys/malloc.h>
   43 #include <sys/mbuf.h>
   44 #include <sys/protosw.h>
   45 #include <sys/socket.h>
   46 #include <sys/ioctl.h>
   47 #include <sys/errno.h>
   48 #include <sys/syslog.h>
   49 
   50 #include <sys/cpu.h>
   51 
   52 #include <net/if.h>
   53 #include <net/netisr.h>
   54 #include <net/route.h>
   55 #include <net/if_llc.h>
   56 #include <net/if_dl.h>
   57 #include <net/if_types.h>
   58 
   59 #if NBPFILTER > 0
   60 #include <net/bpf.h>
   61 #endif
   62 
   63 #include <net/if_hippi.h>
   64 
   65 #include <netinet/in.h>
   66 #if defined(INET) || defined(INET6)
   67 #include <netinet/in_var.h>
   68 #endif
   69 
   70 #define senderr(e) { error = (e); goto bad;}
   71 
   72 #ifndef llc_snap
   73 #define llc_snap        llc_un.type_snap
   74 #endif
   75 
   76 static int      hippi_output(struct ifnet *, struct mbuf *,
   77                              const struct sockaddr *, struct rtentry *);
   78 static void     hippi_input(struct ifnet *, struct mbuf *);
   79 
   80 /*
   81  * HIPPI output routine.
   82  * Encapsulate a packet of type family for the local net.
   83  * I don't know anything about the mapping of AppleTalk or OSI
   84  * protocols to HIPPI, so I don't include any code for them.
   85  */
   86 
   87 static int
   88 hippi_output(struct ifnet *ifp, struct mbuf *m0, const struct sockaddr *dst,
   89     struct rtentry *rt0)
   90 {
   91         uint16_t htype;
   92         uint32_t ifield = 0;
   93         int error = 0;
   94         struct mbuf *m = m0;
   95         struct rtentry *rt;
   96         struct hippi_header *hh;
   97         uint32_t *cci;
   98         uint32_t d2_len;
   99         ALTQ_DECL(struct altq_pktattr pktattr;)
  100 
  101         if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
  102                 senderr(ENETDOWN);
  103 
  104         /* HIPPI doesn't really do broadcast or multicast right now */
  105         if (m->m_flags & (M_BCAST | M_MCAST))
  106                 senderr(EOPNOTSUPP);  /* XXX: some other error? */
  107 
  108         if ((rt = rt0) != NULL) {
  109                 if ((rt->rt_flags & RTF_UP) == 0) {
  110                         if ((rt0 = rt = rtalloc1(dst, 1)) != NULL) {
  111                                 rt->rt_refcnt--;
  112                                 if (rt->rt_ifp != ifp)
  113                                         return (*rt->rt_ifp->if_output)
  114                                                         (ifp, m0, dst, rt);
  115                         } else
  116                                 senderr(EHOSTUNREACH);
  117                 }
  118                 if ((rt->rt_flags & RTF_GATEWAY) && dst->sa_family != AF_NS) {
  119                         if (rt->rt_gwroute == 0)
  120                                 goto lookup;
  121                         if (((rt = rt->rt_gwroute)->rt_flags & RTF_UP) == 0) {
  122                                 rtfree(rt); rt = rt0;
  123                         lookup: rt->rt_gwroute = rtalloc1(rt->rt_gateway, 1);
  124                                 if ((rt = rt->rt_gwroute) == 0)
  125                                         senderr(EHOSTUNREACH);
  126                                 /* the "G" test below also prevents rt == rt0 */
  127                                 if ((rt->rt_flags & RTF_GATEWAY) ||
  128                                     (rt->rt_ifp != ifp)) {
  129                                         rt->rt_refcnt--;
  130                                         rt0->rt_gwroute = 0;
  131                                         senderr(EHOSTUNREACH);
  132                                 }
  133                         }
  134                 }
  135                 if (rt->rt_flags & RTF_REJECT)
  136                         if (rt->rt_rmx.rmx_expire == 0 ||   /* XXX:  no ARP */
  137                             time_second < rt->rt_rmx.rmx_expire)
  138                                 senderr(rt == rt0 ? EHOSTDOWN : EHOSTUNREACH);
  139         }
  140 
  141         /*
  142          * If the queueing discipline needs packet classification,
  143          * do it before prepending link headers.
  144          */
  145         IFQ_CLASSIFY(&ifp->if_snd, m, dst->sa_family, &pktattr);
  146 
  147         switch (dst->sa_family) {
  148 #ifdef INET
  149         case AF_INET:
  150                 if (rt) {
  151                         const struct sockaddr_dl *sdl =
  152                             satocsdl(rt->rt_gateway);
  153                         if (sdl->sdl_family == AF_LINK && sdl->sdl_alen != 0)
  154                                 memcpy(&ifield, CLLADDR(sdl), sizeof(ifield));
  155                 }
  156                 if (!ifield)  /* XXX:  bogus check, but helps us get going */
  157                         senderr(EHOSTUNREACH);
  158                 htype = htons(ETHERTYPE_IP);
  159                 break;
  160 #endif
  161 
  162 #ifdef INET6
  163         case AF_INET6:
  164                 if (rt) {
  165                         const struct sockaddr_dl *sdl =
  166                             satocsdl(rt->rt_gateway);
  167                         if (sdl->sdl_family == AF_LINK && sdl->sdl_alen != 0)
  168                                 memcpy(&ifield, CLLADDR(sdl), sizeof(ifield));
  169                 }
  170                 if (!ifield)  /* XXX:  bogus check, but helps us get going */
  171                         senderr(EHOSTUNREACH);
  172                 htype = htons(ETHERTYPE_IPV6);
  173                 break;
  174 #endif
  175 
  176         default:
  177                 printf("%s: can't handle af%d\n", ifp->if_xname,
  178                        dst->sa_family);
  179                 senderr(EAFNOSUPPORT);
  180         }
  181 
  182         if (htype != 0) {
  183                 struct llc *l;
  184                 M_PREPEND(m, sizeof (struct llc), M_DONTWAIT);
  185                 if (m == 0)
  186                         senderr(ENOBUFS);
  187                 l = mtod(m, struct llc *);
  188                 l->llc_control = LLC_UI;
  189                 l->llc_dsap = l->llc_ssap = LLC_SNAP_LSAP;
  190                 l->llc_snap.org_code[0] = l->llc_snap.org_code[1] =
  191                         l->llc_snap.org_code[2] = 0;
  192                 bcopy((void *) &htype, (void *) &l->llc_snap.ether_type,
  193                       sizeof(uint16_t));
  194         }
  195 
  196         d2_len = m->m_pkthdr.len;
  197 
  198         /*
  199          * Add local net header.  If no space in first mbuf,
  200          * allocate another.
  201          */
  202 
  203         M_PREPEND(m, sizeof (struct hippi_header) + 8, M_DONTWAIT);
  204         if (m == 0)
  205                 senderr(ENOBUFS);
  206         cci = mtod(m, uint32_t *);
  207         memset(cci, 0, sizeof(struct hippi_header) + 8);
  208         cci[0] = 0;
  209         cci[1] = ifield;
  210         hh = (struct hippi_header *) &cci[2];
  211         hh->hi_fp.fp_ulp = HIPPI_ULP_802;
  212         hh->hi_fp.fp_flags = HIPPI_FP_D1_PRESENT;
  213         hh->hi_fp.fp_offsets = htons(sizeof(struct hippi_le));
  214         hh->hi_fp.fp_d2_len = htonl(d2_len);
  215 
  216         /* Pad out the D2 area to end on a quadword (64-bit) boundry. */
  217 
  218         if (d2_len % 8 != 0) {
  219                 static uint32_t buffer[2] = {0, 0};
  220                 m_copyback(m, m->m_pkthdr.len, 8 - d2_len % 8, (void *) buffer);
  221         }
  222 
  223         return ifq_enqueue(ifp, m ALTQ_COMMA ALTQ_DECL(&pktattr));
  224 
  225  bad:
  226         if (m)
  227                 m_freem(m);
  228         return (error);
  229 }
  230 
  231 /*
  232  * Process a received HIPPI packet;
  233  * the packet is in the mbuf chain m with
  234  * the HIPPI header.
  235  */
  236 
  237 static void
  238 hippi_input(struct ifnet *ifp, struct mbuf *m)
  239 {
  240         struct ifqueue *inq;
  241         struct llc *l;
  242         uint16_t htype;
  243         struct hippi_header *hh;
  244         int s;
  245 
  246         if ((ifp->if_flags & IFF_UP) == 0) {
  247                 m_freem(m);
  248                 return;
  249         }
  250 
  251         /* XXX:  need to check flags and drop if bogus! */
  252 
  253         hh = mtod(m, struct hippi_header *);
  254 
  255         ifp->if_ibytes += m->m_pkthdr.len;
  256         if (hh->hi_le.le_dest_addr[0] & 1) {
  257                 if (memcmp(etherbroadcastaddr, hh->hi_le.le_dest_addr,
  258                     sizeof(etherbroadcastaddr)) == 0)
  259                         m->m_flags |= M_BCAST;
  260                 else
  261                         m->m_flags |= M_MCAST;
  262         }
  263         if (m->m_flags & (M_BCAST|M_MCAST))
  264                 ifp->if_imcasts++;
  265 
  266         /* Skip past the HIPPI header. */
  267         m_adj(m, sizeof(struct hippi_header));
  268 
  269         l = mtod(m, struct llc *);
  270         if (l->llc_dsap != LLC_SNAP_LSAP) {
  271                 m_freem(m);
  272                 return;
  273         }
  274         htype = ntohs(l->llc_snap.ether_type);
  275         m_adj(m, 8);
  276         switch (htype) {
  277 #ifdef INET
  278         case ETHERTYPE_IP:
  279                 schednetisr(NETISR_IP);
  280                 inq = &ipintrq;
  281                 break;
  282 #endif
  283 #ifdef INET6
  284         case ETHERTYPE_IPV6:
  285                 schednetisr(NETISR_IPV6);
  286                 inq = &ip6intrq;
  287                 break;
  288 #endif
  289         default:
  290                 m_freem(m);
  291                 return;
  292         }
  293 
  294         s = splnet();
  295         if (IF_QFULL(inq)) {
  296                 IF_DROP(inq);
  297                 m_freem(m);
  298         } else
  299                 IF_ENQUEUE(inq, m);
  300         splx(s);
  301 }
  302 
  303 /*
  304  * Handle packet from HIPPI that has no MAC header
  305  */
  306 
  307 #ifdef INET
  308 void
  309 hippi_ip_input(struct ifnet *ifp, struct mbuf *m)
  310 {
  311         struct ifqueue *inq;
  312         int s;
  313 
  314         schednetisr(NETISR_IP);
  315         inq = &ipintrq;
  316 
  317         s = splnet();
  318         if (IF_QFULL(inq)) {
  319                 IF_DROP(inq);
  320                 m_freem(m);
  321         } else
  322                 IF_ENQUEUE(inq, m);
  323         splx(s);
  324 }
  325 #endif
  326 
  327 /*
  328  * Perform common duties while attaching to interface list
  329  */
  330 void
  331 hippi_ifattach(struct ifnet *ifp, void *lla)
  332 {
  333 
  334         ifp->if_type = IFT_HIPPI;
  335         ifp->if_hdrlen = sizeof(struct hippi_header) + 8; /* add CCI */
  336         ifp->if_dlt = DLT_HIPPI;
  337         ifp->if_mtu = HIPPIMTU;
  338         ifp->if_output = hippi_output;
  339         ifp->if_input = hippi_input;
  340         ifp->if_baudrate = IF_Mbps(800);        /* XXX double-check */
  341 
  342         if_set_sadl(ifp, lla, 6);
  343 
  344 #if NBPFILTER > 0
  345         bpfattach(ifp, DLT_HIPPI, sizeof(struct hippi_header));
  346 #endif
  347 }
Cache object: d11e7cab51c2590e7a14d4f15ba28857
[ 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_hippisubr.c

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