[BACK]Return to if_fddisubr.c CVS log [TXT][DIR] Up to [local] / sys / net

Annotation of sys/net/if_fddisubr.c, Revision 1.1.1.1

1.1       nbrk        1: /*     $OpenBSD: if_fddisubr.c,v 1.52 2007/06/06 10:04:36 henning Exp $        */
                      2: /*     $NetBSD: if_fddisubr.c,v 1.5 1996/05/07 23:20:21 christos Exp $ */
                      3:
                      4: /*
                      5:  * Copyright (c) 1995
                      6:  *     Matt Thomas.  All rights reserved.
                      7:  * Copyright (c) 1982, 1989, 1993
                      8:  *     The Regents of the University of California.  All rights reserved.
                      9:  *
                     10:  * Redistribution and use in source and binary forms, with or without
                     11:  * modification, are permitted provided that the following conditions
                     12:  * are met:
                     13:  * 1. Redistributions of source code must retain the above copyright
                     14:  *    notice, this list of conditions and the following disclaimer.
                     15:  * 2. Redistributions in binary form must reproduce the above copyright
                     16:  *    notice, this list of conditions and the following disclaimer in the
                     17:  *    documentation and/or other materials provided with the distribution.
                     18:  * 3. Neither the name of the University nor the names of its contributors
                     19:  *    may be used to endorse or promote products derived from this software
                     20:  *    without specific prior written permission.
                     21:  *
                     22:  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
                     23:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
                     24:  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
                     25:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
                     26:  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
                     27:  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
                     28:  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
                     29:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
                     30:  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
                     31:  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
                     32:  * SUCH DAMAGE.
                     33:  *
                     34:  *     @(#)if_fddisubr.c       8.1 (Berkeley) 6/10/93
                     35:  */
                     36:
                     37: /*
                     38:  *     @(#)COPYRIGHT   1.1 (NRL) January 1997
                     39:  *
                     40:  * NRL grants permission for redistribution and use in source and binary
                     41:  * forms, with or without modification, of the software and documentation
                     42:  * created at NRL provided that the following conditions are met:
                     43:  *
                     44:  * 1. Redistributions of source code must retain the above copyright
                     45:  *    notice, this list of conditions and the following disclaimer.
                     46:  * 2. Redistributions in binary form must reproduce the above copyright
                     47:  *    notice, this list of conditions and the following disclaimer in the
                     48:  *    documentation and/or other materials provided with the distribution.
                     49:  * 3. All advertising materials mentioning features or use of this software
                     50:  *    must display the following acknowledgements:
                     51:  *     This product includes software developed by the University of
                     52:  *     California, Berkeley and its contributors.
                     53:  *     This product includes software developed at the Information
                     54:  *     Technology Division, US Naval Research Laboratory.
                     55:  * 4. Neither the name of the NRL nor the names of its contributors
                     56:  *    may be used to endorse or promote products derived from this software
                     57:  *    without specific prior written permission.
                     58:  *
                     59:  * THE SOFTWARE PROVIDED BY NRL IS PROVIDED BY NRL AND CONTRIBUTORS ``AS
                     60:  * IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
                     61:  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
                     62:  * PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL NRL OR
                     63:  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
                     64:  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
                     65:  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
                     66:  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
                     67:  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
                     68:  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
                     69:  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
                     70:  *
                     71:  * The views and conclusions contained in the software and documentation
                     72:  * are those of the authors and should not be interpreted as representing
                     73:  * official policies, either expressed or implied, of the US Naval
                     74:  * Research Laboratory (NRL).
                     75:  */
                     76:
                     77: #include <sys/param.h>
                     78: #include <sys/systm.h>
                     79: #include <sys/kernel.h>
                     80: #include <sys/malloc.h>
                     81: #include <sys/mbuf.h>
                     82: #include <sys/protosw.h>
                     83: #include <sys/socket.h>
                     84: #include <sys/ioctl.h>
                     85: #include <sys/errno.h>
                     86: #include <sys/syslog.h>
                     87:
                     88: #include <machine/cpu.h>
                     89:
                     90: #include <net/if.h>
                     91: #include <net/netisr.h>
                     92: #include <net/route.h>
                     93: #include <net/if_llc.h>
                     94: #include <net/if_dl.h>
                     95: #include <net/if_types.h>
                     96:
                     97: #ifdef INET
                     98: #include <netinet/in.h>
                     99: #include <netinet/in_var.h>
                    100: #endif
                    101: #include <netinet/if_ether.h>
                    102: #include <net/if_fddi.h>
                    103:
                    104: #ifdef INET6
                    105: #ifndef INET
                    106: #include <netinet/in.h>
                    107: #include <netinet/in_var.h>
                    108: #endif
                    109: #include <netinet6/nd6.h>
                    110: #endif
                    111:
                    112: #include "bpfilter.h"
                    113:
                    114: #include "carp.h"
                    115: #if NCARP > 0
                    116: #include <netinet/ip_carp.h>
                    117: #endif
                    118:
                    119: #define senderr(e) { error = (e); goto bad;}
                    120:
                    121: /*
                    122:  * This really should be defined in if_llc.h but in case it isn't.
                    123:  */
                    124: #ifndef llc_snap
                    125: #define        llc_snap        llc_un.type_snap
                    126: #endif
                    127:
                    128: /*
                    129:  * FDDI output routine.
                    130:  * Encapsulate a packet of type family for the local net.
                    131:  * Assumes that ifp is actually pointer to arpcom structure.
                    132:  */
                    133: int
                    134: fddi_output(ifp0, m0, dst, rt0)
                    135:        struct ifnet *ifp0;
                    136:        struct mbuf *m0;
                    137:        struct sockaddr *dst;
                    138:        struct rtentry *rt0;
                    139: {
                    140:        u_int16_t type;
                    141:        int s, len, error = 0, hdrcmplt = 0;
                    142:        u_char edst[6], esrc[6];
                    143:        struct mbuf *m = m0;
                    144:        struct rtentry *rt;
                    145:        struct mbuf *mcopy = (struct mbuf *)0;
                    146:        struct fddi_header *fh;
                    147:        struct arpcom *ac = (struct arpcom *)ifp0;
                    148:        short mflags;
                    149:        struct ifnet *ifp = ifp0;
                    150:
                    151: #if NCARP > 0
                    152:        if (ifp->if_type == IFT_CARP) {
                    153:                struct ifaddr *ifa;
                    154:
                    155:                /* loop back if this is going to the carp interface */
                    156:                if (dst != NULL && LINK_STATE_IS_UP(ifp0->if_link_state) &&
                    157:                    (ifa = ifa_ifwithaddr(dst)) != NULL &&
                    158:                    ifa->ifa_ifp == ifp0)
                    159:                        return (looutput(ifp0, m, dst, rt0));
                    160:
                    161:                ifp = ifp->if_carpdev;
                    162:                ac = (struct arpcom *)ifp;
                    163:
                    164:                if ((ifp0->if_flags & (IFF_UP|IFF_RUNNING)) !=
                    165:                    (IFF_UP|IFF_RUNNING))
                    166:                        senderr(ENETDOWN);
                    167:        }
                    168: #endif /* NCARP > 0 */
                    169:        if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
                    170:                senderr(ENETDOWN);
                    171:        if ((rt = rt0) != NULL) {
                    172:                if ((rt->rt_flags & RTF_UP) == 0) {
                    173:                        if ((rt0 = rt = rtalloc1(dst, 1, 0)) != NULL)
                    174:                                rt->rt_refcnt--;
                    175:                        else
                    176:                                senderr(EHOSTUNREACH);
                    177:                }
                    178:                if (rt->rt_flags & RTF_GATEWAY) {
                    179:                        if (rt->rt_gwroute == 0)
                    180:                                goto lookup;
                    181:                        if (((rt = rt->rt_gwroute)->rt_flags & RTF_UP) == 0) {
                    182:                                rtfree(rt); rt = rt0;
                    183:                        lookup: rt->rt_gwroute = rtalloc1(rt->rt_gateway, 1, 0);
                    184:                                if ((rt = rt->rt_gwroute) == 0)
                    185:                                        senderr(EHOSTUNREACH);
                    186:                        }
                    187:                }
                    188:                if (rt->rt_flags & RTF_REJECT)
                    189:                        if (rt->rt_rmx.rmx_expire == 0 ||
                    190:                            time_second < rt->rt_rmx.rmx_expire)
                    191:                                senderr(rt == rt0 ? EHOSTDOWN : EHOSTUNREACH);
                    192:        }
                    193:
                    194:        switch (dst->sa_family) {
                    195:
                    196: #ifdef INET
                    197:        case AF_INET:
                    198:                if (!arpresolve(ac, rt, m, dst, edst))
                    199:                        return (0);     /* if not yet resolved */
                    200:                /* If broadcasting on a simplex interface, loopback a copy */
                    201:                if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX) &&
                    202:                    !m->m_pkthdr.pf.routed)
                    203:                        mcopy = m_copy(m, 0, (int)M_COPYALL);
                    204:                type = htons(ETHERTYPE_IP);
                    205:                break;
                    206: #endif
                    207: #ifdef INET6
                    208:        case AF_INET6:
                    209:                if (!nd6_storelladdr(ifp, rt, m, dst, (u_char *)edst))
                    210:                        return (0);     /* if not yet resolved */
                    211:                type = htons(ETHERTYPE_IPV6);
                    212:                break;
                    213: #endif
                    214: #if 0  /*NRL IPv6*/
                    215: #ifdef INET6
                    216:        case AF_INET6:
                    217:                /*
                    218:                 * The bottom line here is to either queue the outgoing packet
                    219:                 * in the discovery engine, or fill in edst with something
                    220:                 * that'll work.
                    221:                 */
                    222:                if (m->m_flags & M_MCAST) {
                    223:                        /*
                    224:                         * If multicast dest., then use IPv6 -> Ethernet mcast
                    225:                         * mapping.  Really simple.
                    226:                         */
                    227:                        ETHER_MAP_IN6_MULTICAST(((struct sockaddr_in6 *)dst)->sin6_addr,
                    228:                            edst);
                    229:                } else {
                    230:                        /* Do unicast neighbor discovery stuff. */
                    231:                        if (!ipv6_discov_resolve(ifp, rt, m, dst, edst))
                    232:                                return 0;
                    233:                }
                    234:                type = htons(ETHERTYPE_IPV6);
                    235:                break;
                    236: #endif /* INET6 */
                    237: #endif
                    238:
                    239:        case pseudo_AF_HDRCMPLT:
                    240:        {
                    241:                struct fddi_header *fh = (struct fddi_header *)dst->sa_data;
                    242:                hdrcmplt = 1;
                    243:                bcopy((caddr_t)fh->fddi_shost, (caddr_t)esrc, sizeof (esrc));
                    244:                /* FALLTHROUGH */
                    245:        }
                    246:
                    247:        case AF_UNSPEC:
                    248:        {
                    249:                struct ether_header *eh;
                    250:                eh = (struct ether_header *)dst->sa_data;
                    251:                bcopy((caddr_t)eh->ether_dhost, (caddr_t)edst, sizeof (edst));
                    252:                if (*edst & 1)
                    253:                        m->m_flags |= (M_BCAST|M_MCAST);
                    254:                type = eh->ether_type;
                    255:                break;
                    256:        }
                    257:
                    258: #if NBPFILTER > 0
                    259:        case AF_IMPLINK:
                    260:        {
                    261:                fh = mtod(m, struct fddi_header *);
                    262:                error = EPROTONOSUPPORT;
                    263:                switch (fh->fddi_fc & (FDDIFC_C|FDDIFC_L|FDDIFC_F)) {
                    264:                        case FDDIFC_LLC_ASYNC: {
                    265:                                /* legal priorities are 0 through 7 */
                    266:                                if ((fh->fddi_fc & FDDIFC_Z) > 7)
                    267:                                        goto bad;
                    268:                                break;
                    269:                        }
                    270:                        case FDDIFC_LLC_SYNC: {
                    271:                                /* FDDIFC_Z bits reserved, must be zero */
                    272:                                if (fh->fddi_fc & FDDIFC_Z)
                    273:                                        goto bad;
                    274:                                break;
                    275:                        }
                    276:                        case FDDIFC_SMT: {
                    277:                                /* FDDIFC_Z bits must be non zero */
                    278:                                if ((fh->fddi_fc & FDDIFC_Z) == 0)
                    279:                                        goto bad;
                    280:                                break;
                    281:                        }
                    282:                        default: {
                    283:                                /* anything else is too dangerous */
                    284:                                        goto bad;
                    285:                        }
                    286:                }
                    287:                error = 0;
                    288:                if (fh->fddi_dhost[0] & 1)
                    289:                        m->m_flags |= (M_BCAST|M_MCAST);
                    290:                goto queue_it;
                    291:        }
                    292: #endif
                    293:        default:
                    294:                printf("%s: can't handle af%d\n", ifp->if_xname,
                    295:                        dst->sa_family);
                    296:                senderr(EAFNOSUPPORT);
                    297:        }
                    298:
                    299:        if (mcopy)
                    300:                (void) looutput(ifp, mcopy, dst, rt);
                    301:
                    302:        if (type != 0) {
                    303:                struct llc *l;
                    304:                M_PREPEND(m, sizeof (struct llc), M_DONTWAIT);
                    305:                if (m == 0)
                    306:                        senderr(ENOBUFS);
                    307:                l = mtod(m, struct llc *);
                    308:                l->llc_control = LLC_UI;
                    309:                l->llc_dsap = l->llc_ssap = LLC_SNAP_LSAP;
                    310:                l->llc_snap.org_code[0] = l->llc_snap.org_code[1] = l->llc_snap.org_code[2] = 0;
                    311:                bcopy((caddr_t) &type, (caddr_t) &l->llc_snap.ether_type,
                    312:                        sizeof(u_short));
                    313:        }
                    314:        /*
                    315:         * Add local net header.  If no space in first mbuf,
                    316:         * allocate another.
                    317:         */
                    318:        M_PREPEND(m, sizeof (struct fddi_header), M_DONTWAIT);
                    319:        if (m == 0)
                    320:                senderr(ENOBUFS);
                    321:        fh = mtod(m, struct fddi_header *);
                    322:        fh->fddi_fc = FDDIFC_LLC_ASYNC|FDDIFC_LLC_PRIO4;
                    323:        bcopy((caddr_t)edst, (caddr_t)fh->fddi_dhost, sizeof (edst));
                    324: #if NBPFILTER > 0
                    325:   queue_it:
                    326: #endif
                    327:        if (hdrcmplt)
                    328:                bcopy((caddr_t)esrc, (caddr_t)fh->fddi_shost,
                    329:                    sizeof(fh->fddi_shost));
                    330:        else
                    331:                bcopy((caddr_t)ac->ac_enaddr, (caddr_t)fh->fddi_shost,
                    332:                    sizeof(fh->fddi_shost));
                    333: #if NCARP > 0
                    334:        if (ifp0 != ifp && ifp0->if_type == IFT_CARP) {
                    335:                bcopy((caddr_t)((struct arpcom *)ifp0)->ac_enaddr,
                    336:                    (caddr_t)fh->fddi_shost, sizeof(fh->fddi_shost));
                    337:        }
                    338: #endif
                    339:        mflags = m->m_flags;
                    340:        len = m->m_pkthdr.len;
                    341:        s = splnet();
                    342:        /*
                    343:         * Queue message on interface, and start output if interface
                    344:         * not yet active.
                    345:         */
                    346:        IFQ_ENQUEUE(&ifp->if_snd, m, NULL, error);
                    347:        if (error) {
                    348:                /* mbuf is already freed */
                    349:                splx(s);
                    350:                return (error);
                    351:        }
                    352:        ifp->if_obytes += len;
                    353: #if NCARP > 0
                    354:        if (ifp != ifp0)
                    355:                ifp0->if_obytes += len;
                    356: #endif /* NCARP > 0 */
                    357:        if (mflags & M_MCAST)
                    358:                ifp->if_omcasts++;
                    359:        if ((ifp->if_flags & IFF_OACTIVE) == 0)
                    360:                (*ifp->if_start)(ifp);
                    361:        splx(s);
                    362:        return (error);
                    363:
                    364: bad:
                    365:        if (m)
                    366:                m_freem(m);
                    367:        return (error);
                    368: }
                    369:
                    370: /*
                    371:  * Process a received FDDI packet;
                    372:  * the packet is in the mbuf chain m without
                    373:  * the fddi header, which is provided separately.
                    374:  */
                    375: void
                    376: fddi_input(ifp, fh, m)
                    377:        struct ifnet *ifp;
                    378:        struct fddi_header *fh;
                    379:        struct mbuf *m;
                    380: {
                    381:        struct ifqueue *inq;
                    382:        struct llc *l;
                    383:        int s;
                    384:
                    385:        if ((ifp->if_flags & IFF_UP) == 0) {
                    386:                m_freem(m);
                    387:                return;
                    388:        }
                    389:        ifp->if_ibytes += m->m_pkthdr.len + sizeof (*fh);
                    390:        if (bcmp((caddr_t)fddibroadcastaddr, (caddr_t)fh->fddi_dhost,
                    391:            sizeof(fddibroadcastaddr)) == 0)
                    392:                m->m_flags |= M_BCAST;
                    393:        else if (fh->fddi_dhost[0] & 1)
                    394:                m->m_flags |= M_MCAST;
                    395:        if (m->m_flags & (M_BCAST|M_MCAST))
                    396:                ifp->if_imcasts++;
                    397:
                    398:        l = mtod(m, struct llc *);
                    399:        switch (l->llc_dsap) {
                    400: #if defined(INET) || defined(INET6)
                    401:        case LLC_SNAP_LSAP:
                    402:        {
                    403:                u_int16_t etype;
                    404:                if (l->llc_control != LLC_UI || l->llc_ssap != LLC_SNAP_LSAP)
                    405:                        goto dropanyway;
                    406:                if (l->llc_snap.org_code[0] != 0 || l->llc_snap.org_code[1] != 0|| l->llc_snap.org_code[2] != 0)
                    407:                        goto dropanyway;
                    408:                etype = ntohs(l->llc_snap.ether_type);
                    409:                m_adj(m, LLC_SNAPFRAMELEN);
                    410:
                    411: #if NCARP > 0
                    412:                if (ifp->if_carp && ifp->if_type != IFT_CARP &&
                    413:                    (carp_input(m, (u_int8_t *)&fh->fddi_shost,
                    414:                    (u_int8_t *)&fh->fddi_dhost, l->llc_snap.ether_type) == 0))
                    415:                        return;
                    416: #endif
                    417:
                    418:                switch (etype) {
                    419: #ifdef INET
                    420:                case ETHERTYPE_IP:
                    421:                        schednetisr(NETISR_IP);
                    422:                        inq = &ipintrq;
                    423:                        break;
                    424:
                    425:                case ETHERTYPE_ARP:
                    426:                        if (ifp->if_flags & IFF_NOARP)
                    427:                                goto dropanyway;
                    428:                        schednetisr(NETISR_ARP);
                    429:                        inq = &arpintrq;
                    430:                        break;
                    431: #endif
                    432: #ifdef INET6
                    433:                case ETHERTYPE_IPV6:
                    434:                        schednetisr(NETISR_IPV6);
                    435:                        inq = &ip6intrq;
                    436:                        break;
                    437: #endif /* INET6 */
                    438:                default:
                    439:                        /* printf("fddi_input: unknown protocol 0x%x\n", etype); */
                    440:                        ifp->if_noproto++;
                    441:                        goto dropanyway;
                    442:                }
                    443:                break;
                    444:        }
                    445: #endif /* INET || INET6 */
                    446:
                    447:        default:
                    448:                /* printf("fddi_input: unknown dsap 0x%x\n", l->llc_dsap); */
                    449:                ifp->if_noproto++;
                    450:        dropanyway:
                    451:                m_freem(m);
                    452:                return;
                    453:        }
                    454:
                    455:        s = splnet();
                    456:        IF_INPUT_ENQUEUE(inq, m);
                    457:        splx(s);
                    458: }
                    459: /*
                    460:  * Perform common duties while attaching to interface list
                    461:  */
                    462: void
                    463: fddi_ifattach(ifp)
                    464:        struct ifnet *ifp;
                    465: {
                    466:
                    467:        ifp->if_type = IFT_FDDI;
                    468:        ifp->if_addrlen = 6;
                    469:        ifp->if_hdrlen = 21;
                    470:        ifp->if_mtu = FDDIMTU;
                    471:        ifp->if_output = fddi_output;
                    472:        if_alloc_sadl(ifp);
                    473:        bcopy((caddr_t)((struct arpcom *)ifp)->ac_enaddr,
                    474:              LLADDR(ifp->if_sadl), ifp->if_addrlen);
                    475: }

CVSweb