Annotation of sys/net/if_fddisubr.c, Revision 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