/* $NetBSD: llc_input.c,v 1.16 2005/12/11 12:24:54 christos Exp $ */ /* * Copyright (c) 1992, 1993 * The Regents of the University of California. All rights reserved. * * This code is derived from software contributed to Berkeley by * Dirk Husemann and the Computer Science Department (IV) of * the University of Erlangen-Nuremberg, Germany. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. Neither the name of the University nor the names of its contributors * may be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * @(#)llc_input.c 8.1 (Berkeley) 6/10/93 */ /* * Copyright (c) 1990, 1991, 1992 * Dirk Husemann, Computer Science Department IV, * University of Erlangen-Nuremberg, Germany. * * This code is derived from software contributed to Berkeley by * Dirk Husemann and the Computer Science Department (IV) of * the University of Erlangen-Nuremberg, Germany. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by the University of * California, Berkeley and its contributors. * 4. Neither the name of the University nor the names of its contributors * may be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * @(#)llc_input.c 8.1 (Berkeley) 6/10/93 */ #include __KERNEL_RCSID(0, "$NetBSD: llc_input.c,v 1.16 2005/12/11 12:24:54 christos Exp $"); #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include struct ifqueue llcintrq; /* * This module implements LLC as specified by ISO 8802-2. */ /* * llcintr() handles all LLC frames (except ISO CLNS ones for the time being) * and tries to pass them on to the appropriate network layer entity. */ void llcintr() { struct mbuf *m; int i; int frame_kind; u_char cmdrsp; struct llc_linkcb *linkp; struct npaidbentry *sapinfo = NULL; struct sdl_hdr *sdlhdr; struct llc *frame; long expected_len; struct ifnet *ifp; struct rtentry *llrt; struct rtentry *nlrt; for (;;) { i = splnet(); IF_DEQUEUE(&llcintrq, m); splx(i); if (m == 0) break; #ifdef DIAGNOSTIC if ((m->m_flags & M_PKTHDR) == 0) panic("llcintr no HDR"); #endif /* * Get ifp this packet was received on */ ifp = m->m_pkthdr.rcvif; sdlhdr = mtod(m, struct sdl_hdr *); /* * [Copied from net/ip_input.c] * * Check that the amount of data in the buffers is * at least as much as the LLC header tells us. * Trim mbufs if longer than expected. * Drop packets if shorter than we think they are. * * Layout of mbuf chain at this point: * * +-------------------------------+----+ -\ * | sockaddr_dl src - sdlhdr_src | 20 | \ * +-------------------------------+----+ | * | sockaddr_dl dst - sdlhdr_dst | 20 | > sizeof(struct sdl_hdr) == 44 * +-------------------------------+----+ | * | LLC frame len - sdlhdr_len | 04 | / * +-------------------------------+----+ -/ * / * | m_next * \ * +----------------------------+----+ -\ * | llc DSAP | 01 | \ * +----------------------------+----+ | * | llc SSAP | 01 | | * +----------------------------+----+ > sdlhdr_len * | llc control | 01 | | * +----------------------------+----+ | * | ... | | / * -/ * * Thus the we expect to have exactly * (sdlhdr->sdlhdr_len+sizeof(struct sdl_hdr)) in the mbuf chain */ expected_len = sdlhdr->sdlhdr_len + sizeof(struct sdl_hdr); if (m->m_pkthdr.len < expected_len) { m_freem(m); continue; } if (m->m_pkthdr.len > expected_len) { if (m->m_len == m->m_pkthdr.len) { m->m_len = expected_len; m->m_pkthdr.len = expected_len; } else m_adj(m, expected_len - m->m_pkthdr.len); } /* * Get llc header */ if (m->m_len > sizeof(struct sdl_hdr)) frame = mtod((struct mbuf *)((struct sdl_hdr*)(m+1)), struct llc *); else frame = mtod(m->m_next, struct llc *); if (frame == (struct llc *) NULL) panic("llcintr no llc header"); /* * Now check for bogus I/S frame, i.e. those with a control * field telling us they're an I/S frame yet their length * is less than the established I/S frame length (DSAP + SSAP + * control + N(R)&P/F = 4) --- we drop those suckers */ if (((frame->llc_control & 0x03) != 0x03) && ((expected_len - sizeof(struct sdl_hdr)) < LLC_ISFRAMELEN)) { m_freem(m); printf("llc: hurz error\n"); continue; } /* * Get link control block for the addressed link connection. * If there is none we take care of it later on. */ cmdrsp = (frame->llc_ssap & 0x01); frame->llc_ssap &= ~0x01; llrt = rtalloc1((struct sockaddr *)&sdlhdr->sdlhdr_src, 0); if (llrt) llrt->rt_refcnt--; #ifdef notyet else llrt = npaidb_enter(&sdlhdr->sdlhdr_src, 0, 0, 0); #endif /* notyet */ else { /* * We cannot do anything currently here as we * don't `know' this link --- drop it */ m_freem(m); continue; } linkp = ((struct npaidbentry *)(llrt->rt_llinfo))->np_link; nlrt = ((struct npaidbentry *)(llrt->rt_llinfo))->np_rt; /* * If the link is not existing right now, we can try and look up * the SAP info block. */ if ((linkp == 0) && frame->llc_ssap) sapinfo = llc_getsapinfo(frame->llc_dsap, ifp); /* * Handle XID and TEST frames * XID: if DLSAP == 0, return type-of-services * window-0 * DLSAP-0 * format-identifier-? * if DLSAP != 0, locate sapcb and return * type-of-services * SAP-window * format-identifier-? * TEST: swap (snpah_dst, snpah_src) and return frame * * Also toggle the CMD/RESP bit * * Is this behaviour correct? Check ISO 8802-2 (90)! */ frame_kind = llc_decode(frame, (struct llc_linkcb *)0); switch(frame_kind) { case LLCFT_XID: if (linkp || sapinfo) { if (linkp) frame->llc_window = linkp->llcl_window; else frame->llc_window = sapinfo->si_window; frame->llc_fid = 9; /* XXX */ frame->llc_class = sapinfo->si_class; frame->llc_ssap = frame->llc_dsap; } else { frame->llc_window = 0; frame->llc_fid = 9; frame->llc_class = 1; frame->llc_dsap = frame->llc_ssap = 0; } /* fall thru to */ case LLCFT_TEST: sdl_swapaddr(&(mtod(m, struct sdl_hdr *)->sdlhdr_dst), &(mtod(m, struct sdl_hdr *)->sdlhdr_src)); /* Now set the CMD/RESP bit */ frame->llc_ssap |= (cmdrsp == 0x0 ? 0x1 : 0x0); /* Ship it out again */ (*ifp->if_output)(ifp, m, (struct sockaddr *) &(mtod(m, struct sdl_hdr *)->sdlhdr_dst), (struct rtentry *) 0); continue; } /* * Create link control block in case it is not existing */ if (linkp == 0 && sapinfo) { if ((linkp = llc_newlink(&sdlhdr->sdlhdr_src, ifp, nlrt, (nlrt == 0) ? 0 : nlrt->rt_llinfo, llrt)) == 0) { printf("llcintr: couldn't create new link\n"); m_freem(m); continue; } ((struct npaidbentry *)llrt->rt_llinfo)->np_link = linkp; } else if (linkp == 0) { /* The link is not known to us, drop the frame and continue */ m_freem(m); continue; } /* * Drop SNPA header and get rid of empty mbuf at the * front of the mbuf chain (I don't like 'em) */ m_adj(m, sizeof(struct sdl_hdr)); /* * LLC_UFRAMELEN is sufficient, m_pullup() will pull up * the min(m->m_len, maxprotohdr_len [=40]) thus doing * the trick ... */ if ((m = m_pullup(m, LLC_UFRAMELEN))) /* * Pass it on thru the elements of procedure */ llc_input(m, linkp, cmdrsp); } return; } /* * llc_input() --- We deal with the various incoming frames here. * Basically we (indirectly) call the appropriate * state handler function that's pointed to by * llcl_statehandler. * * The statehandler returns an action code --- * further actions like * o notify network layer * o block further sending * o deblock link * o ... * are then enacted accordingly. */ int llc_input(struct mbuf *m, ...) { int frame_kind; int pollfinal; int action = 0; struct llc *frame; struct llc_linkcb *linkp; u_int cmdrsp; va_list ap; va_start(ap, m); linkp = va_arg(ap, struct llc_linkcb *); cmdrsp = va_arg(ap, u_int); va_end(ap); if ((frame = mtod(m, struct llc *)) == (struct llc *) 0) { m_freem(m); return 0; } pollfinal = ((frame->llc_control & 0x03) == 0x03) ? LLCGBITS(frame->llc_control, u_pf) : LLCGBITS(frame->llc_control_ext, s_pf); /* * first decode the frame */ frame_kind = llc_decode(frame, linkp); switch (action = llc_statehandler(linkp, frame, frame_kind, cmdrsp, pollfinal)) { case LLC_DATA_INDICATION: m_adj(m, LLC_ISFRAMELEN); if ((m = m_pullup(m, NLHDRSIZEGUESS)) != NULL) { m->m_pkthdr.rcvif = (struct ifnet *)linkp->llcl_nlnext; (*linkp->llcl_sapinfo->si_input)(m, NULL, NULL, NULL); } break; } /* release mbuf if not an info frame */ if (action != LLC_DATA_INDICATION && m) m_freem(m); /* try to get frames out ... */ llc_start(linkp); return 0; } /* * This routine is called by configuration setup. It sets up a station control * block and notifies all registered upper level protocols. */ void * llc_ctlinput(prc, addr, info) int prc; struct sockaddr *addr; void *info; { struct ifnet *ifp = NULL; struct ifaddr *ifa; struct dll_ctlinfo *ctlinfo = (struct dll_ctlinfo *)info; u_char sap; struct dllconfig *config; caddr_t pcb; struct rtentry *nlrt; struct rtentry *llrt = NULL; struct llc_linkcb *linkp = NULL; int i; /* info must point to something valid at all times */ if (info == 0) return 0; if (prc == PRC_IFUP || prc == PRC_IFDOWN) { /* we use either this set ... */ ifa = ifa_ifwithaddr(addr); if (ifa == NULL) return (0); ifp = ifa->ifa_ifp; if (ifp == NULL) return (0); sap = ctlinfo->dlcti_lsap; config = ctlinfo->dlcti_cfg; pcb = (caddr_t) 0; nlrt = (struct rtentry *) 0; } else { /* or this one */ sap = 0; config = (struct dllconfig *) 0; pcb = ctlinfo->dlcti_pcb; nlrt = ctlinfo->dlcti_rt; if ((llrt = rtalloc1(nlrt->rt_gateway, 0))) llrt->rt_refcnt--; else return 0; linkp = ((struct npaidbentry *)llrt->rt_llinfo)->np_link; } switch (prc) { case PRC_IFUP: (void) llc_setsapinfo(ifp, addr->sa_family, sap, config); return 0; case PRC_IFDOWN: { struct llc_linkcb *xlinkp; struct llc_linkcb *nlinkp; int xi; /* * All links are accessible over the doubly linked list llccb_q */ if (!LQEMPTY) { /* * A for-loop is not that great an idea as the linkp * will get deleted by llc_timer() */ xlinkp = LQFIRST; while (LQVALID(xlinkp)) { nlinkp = LQNEXT(xlinkp); if ((xlinkp->llcl_if = ifp) != NULL) { xi = splnet(); (void)llc_statehandler(xlinkp, NULL, NL_DISCONNECT_REQUEST, 0, 1); splx(xi); } xlinkp = nlinkp; } } } case PRC_CONNECT_REQUEST: if (linkp == 0) { if ((linkp = llc_newlink((struct sockaddr_dl *) nlrt->rt_gateway, nlrt->rt_ifp, nlrt, pcb, llrt)) == 0) return (0); ((struct npaidbentry *)llrt->rt_llinfo)->np_link = linkp; i = splnet(); (void)llc_statehandler(linkp, (struct llc *) 0, NL_CONNECT_REQUEST, 0, 1); splx(i); } return ((caddr_t)linkp); case PRC_DISCONNECT_REQUEST: if (linkp == 0) panic("no link control block!"); i = splnet(); (void)llc_statehandler(linkp, (struct llc *) 0, NL_DISCONNECT_REQUEST, 0, 1); splx(i); /* * The actual removal of the link control block is done by the * cleaning neutrum (i.e. llc_timer()). */ break; case PRC_RESET_REQUEST: if (linkp == 0) panic("no link control block!"); i = splnet(); (void)llc_statehandler(linkp, (struct llc *) 0, NL_RESET_REQUEST, 0, 1); splx(i); break; } return 0; }