if_atmsubr.c revision 117629
125603Skjc/* $NetBSD: if_atmsubr.c,v 1.10 1997/03/11 23:19:51 chuck Exp $ */ 225603Skjc 325603Skjc/* 425603Skjc * 525603Skjc * Copyright (c) 1996 Charles D. Cranor and Washington University. 625603Skjc * All rights reserved. 725603Skjc * 825603Skjc * Redistribution and use in source and binary forms, with or without 925603Skjc * modification, are permitted provided that the following conditions 1025603Skjc * are met: 1125603Skjc * 1. Redistributions of source code must retain the above copyright 1225603Skjc * notice, this list of conditions and the following disclaimer. 1325603Skjc * 2. Redistributions in binary form must reproduce the above copyright 1425603Skjc * notice, this list of conditions and the following disclaimer in the 1525603Skjc * documentation and/or other materials provided with the distribution. 1625603Skjc * 3. All advertising materials mentioning features or use of this software 1725603Skjc * must display the following acknowledgement: 1825603Skjc * This product includes software developed by Charles D. Cranor and 1925603Skjc * Washington University. 2025603Skjc * 4. The name of the author may not be used to endorse or promote products 2125603Skjc * derived from this software without specific prior written permission. 2225603Skjc * 2325603Skjc * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 2425603Skjc * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 2525603Skjc * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 2625603Skjc * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 2725603Skjc * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 2825603Skjc * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 2925603Skjc * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 3025603Skjc * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 3125603Skjc * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 3225603Skjc * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 3354263Sshin * 3425603Skjc * if_atmsubr.c 3525603Skjc */ 3625603Skjc 37116720Sharti#include <sys/cdefs.h> 38116720Sharti__FBSDID("$FreeBSD: head/sys/net/if_atmsubr.c 117629 2003-07-15 10:30:57Z harti $"); 39116720Sharti 4032350Seivind#include "opt_inet.h" 4154263Sshin#include "opt_inet6.h" 42105576Srwatson#include "opt_mac.h" 4332925Seivind#include "opt_natm.h" 4432350Seivind 4525603Skjc#include <sys/param.h> 4625603Skjc#include <sys/systm.h> 47114201Sharti#include <sys/kernel.h> 48114201Sharti#include <sys/module.h> 49105576Srwatson#include <sys/mac.h> 5025603Skjc#include <sys/mbuf.h> 5125603Skjc#include <sys/socket.h> 5237939Skjc#include <sys/sockio.h> 5337939Skjc#include <sys/errno.h> 54114201Sharti#include <sys/sysctl.h> 5525603Skjc 5625603Skjc#include <net/if.h> 5725603Skjc#include <net/netisr.h> 5825603Skjc#include <net/route.h> 5925603Skjc#include <net/if_dl.h> 6025603Skjc#include <net/if_types.h> 6125603Skjc#include <net/if_atm.h> 6225603Skjc 6325603Skjc#include <netinet/in.h> 6425603Skjc#include <netinet/if_atm.h> 6525603Skjc#include <netinet/if_ether.h> /* XXX: for ETHERTYPE_* */ 6637939Skjc#if defined(INET) || defined(INET6) 6725603Skjc#include <netinet/in_var.h> 6825603Skjc#endif 6925603Skjc#ifdef NATM 7025603Skjc#include <netnatm/natm.h> 7125603Skjc#endif 7225603Skjc 73116741Sharti/* 74116741Sharti * Netgraph interface functions. 75116741Sharti * These need not be protected by a lock, because ng_atm nodes are persitent. 76116741Sharti * The ng_atm module can be unloaded only if all ATM interfaces have been 77116741Sharti * unloaded, so nobody should be in the code paths accessing these function 78116741Sharti * pointers. 79116741Sharti */ 80116741Shartivoid (*ng_atm_attach_p)(struct ifnet *); 81116741Shartivoid (*ng_atm_detach_p)(struct ifnet *); 82116741Shartiint (*ng_atm_output_p)(struct ifnet *, struct mbuf **); 83116741Shartivoid (*ng_atm_input_p)(struct ifnet *, struct mbuf **, 84116741Sharti struct atm_pseudohdr *, void *); 85116741Shartivoid (*ng_atm_input_orphan_p)(struct ifnet *, struct mbuf *, 86116741Sharti struct atm_pseudohdr *, void *); 87116741Shartivoid (*ng_atm_message_p)(struct ifnet *, u_int32_t, u_int32_t); 88116741Sharti 89116741Sharti/* 90116741Sharti * Harp pseudo interface hooks 91116741Sharti */ 92116741Shartivoid (*atm_harp_input_p)(struct ifnet *ifp, struct mbuf **m, 93116741Sharti struct atm_pseudohdr *ah, void *rxhand); 94116741Shartivoid (*atm_harp_attach_p)(struct ifnet *); 95116741Shartivoid (*atm_harp_detach_p)(struct ifnet *); 96116741Sharti 97114201ShartiSYSCTL_NODE(_hw, OID_AUTO, atm, CTLFLAG_RW, 0, "ATM hardware"); 98114201Sharti 9937939Skjc#ifndef ETHERTYPE_IPV6 100116720Sharti#define ETHERTYPE_IPV6 0x86dd 10137939Skjc#endif 10225603Skjc 103116720Sharti#define senderr(e) do { error = (e); goto bad; } while (0) 10425603Skjc 10525603Skjc/* 10625603Skjc * atm_output: ATM output routine 10725603Skjc * inputs: 10825603Skjc * "ifp" = ATM interface to output to 10925603Skjc * "m0" = the packet to output 11025603Skjc * "dst" = the sockaddr to send to (either IP addr, or raw VPI/VCI) 11125603Skjc * "rt0" = the route to use 11225603Skjc * returns: error code [0 == ok] 11325603Skjc * 11425603Skjc * note: special semantic: if (dst == NULL) then we assume "m" already 11525603Skjc * has an atm_pseudohdr on it and just send it directly. 11625603Skjc * [for native mode ATM output] if dst is null, then 11725603Skjc * rt0 must also be NULL. 11825603Skjc */ 11925603Skjcint 120116720Shartiatm_output(struct ifnet *ifp, struct mbuf *m0, struct sockaddr *dst, 121116720Sharti struct rtentry *rt0) 12225603Skjc{ 12325603Skjc u_int16_t etype = 0; /* if using LLC/SNAP */ 12478249Speter int error = 0, sz; 12525603Skjc struct atm_pseudohdr atmdst, *ad; 12659633Skjc struct mbuf *m = m0; 12759633Skjc struct rtentry *rt; 12825603Skjc struct atmllc *atmllc; 12937939Skjc struct atmllc *llc_hdr = NULL; 13025603Skjc u_int32_t atm_flags; 13125603Skjc 132105576Srwatson#ifdef MAC 133105576Srwatson error = mac_check_ifnet_transmit(ifp, m); 134105576Srwatson if (error) 135105576Srwatson senderr(error); 136105576Srwatson#endif 137105576Srwatson 138116720Sharti if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) != (IFF_UP | IFF_RUNNING)) 13925603Skjc senderr(ENETDOWN); 14025603Skjc 14125603Skjc /* 14225603Skjc * check route 14325603Skjc */ 144111767Smdodd error = rt_check(&rt, &rt0, dst); 145111767Smdodd if (error) 146111767Smdodd goto bad; 14725603Skjc 14825603Skjc /* 14925603Skjc * check for non-native ATM traffic (dst != NULL) 15025603Skjc */ 15125603Skjc if (dst) { 15225603Skjc switch (dst->sa_family) { 153116720Sharti 15437939Skjc#if defined(INET) || defined(INET6) 15525603Skjc case AF_INET: 15637939Skjc case AF_INET6: 15746695Skjc if (dst->sa_family == AF_INET6) 158112193Sharti etype = ETHERTYPE_IPV6; 15946695Skjc else 160112193Sharti etype = ETHERTYPE_IP; 16125603Skjc if (!atmresolve(rt, m, dst, &atmdst)) { 16225603Skjc m = NULL; 16325603Skjc /* XXX: atmresolve already free'd it */ 16425603Skjc senderr(EHOSTUNREACH); 16525603Skjc /* XXX: put ATMARP stuff here */ 16625603Skjc /* XXX: watch who frees m on failure */ 16725603Skjc } 16825603Skjc break; 16937939Skjc#endif /* INET || INET6 */ 17025603Skjc 17137939Skjc case AF_UNSPEC: 17237939Skjc /* 17346695Skjc * XXX: bpfwrite. assuming dst contains 12 bytes 17446695Skjc * (atm pseudo header (4) + LLC/SNAP (8)) 17537939Skjc */ 17637939Skjc bcopy(dst->sa_data, &atmdst, sizeof(atmdst)); 177116720Sharti llc_hdr = (struct atmllc *)(dst->sa_data + 178116720Sharti sizeof(atmdst)); 17937939Skjc break; 18037939Skjc 18125603Skjc default: 18225603Skjc#if defined(__NetBSD__) || defined(__OpenBSD__) 18325603Skjc printf("%s: can't handle af%d\n", ifp->if_xname, 18425603Skjc dst->sa_family); 18525603Skjc#elif defined(__FreeBSD__) || defined(__bsdi__) 18625603Skjc printf("%s%d: can't handle af%d\n", ifp->if_name, 18725603Skjc ifp->if_unit, dst->sa_family); 18825603Skjc#endif 18925603Skjc senderr(EAFNOSUPPORT); 19025603Skjc } 19125603Skjc 19225603Skjc /* 19325603Skjc * must add atm_pseudohdr to data 19425603Skjc */ 19525603Skjc sz = sizeof(atmdst); 19625603Skjc atm_flags = ATM_PH_FLAGS(&atmdst); 197116720Sharti if (atm_flags & ATM_PH_LLCSNAP) 198116720Sharti sz += 8; /* sizeof snap == 8 */ 199111119Simp M_PREPEND(m, sz, M_DONTWAIT); 20025603Skjc if (m == 0) 20125603Skjc senderr(ENOBUFS); 20225603Skjc ad = mtod(m, struct atm_pseudohdr *); 20325603Skjc *ad = atmdst; 20425603Skjc if (atm_flags & ATM_PH_LLCSNAP) { 20525603Skjc atmllc = (struct atmllc *)(ad + 1); 20637939Skjc if (llc_hdr == NULL) { 20737939Skjc bcopy(ATMLLC_HDR, atmllc->llchdr, 20837939Skjc sizeof(atmllc->llchdr)); 209116720Sharti /* note: in host order */ 21037939Skjc ATM_LLC_SETTYPE(atmllc, etype); 21137939Skjc } 21237939Skjc else 21337939Skjc bcopy(llc_hdr, atmllc, sizeof(struct atmllc)); 21425603Skjc } 21525603Skjc } 21625603Skjc 217116741Sharti if (ng_atm_output_p != NULL) { 218116741Sharti if ((error = (*ng_atm_output_p)(ifp, &m)) != 0) { 219116741Sharti if (m != NULL) 220116741Sharti m_freem(m); 221116741Sharti return (error); 222116741Sharti } 223116741Sharti if (m == NULL) 224116741Sharti return (0); 225116741Sharti } 226116741Sharti 22725603Skjc /* 22825603Skjc * Queue message on interface, and start output if interface 22925603Skjc * not yet active. 23025603Skjc */ 231117629Sharti if (!IF_HANDOFF_ADJ(&ifp->if_snd, m, ifp, 232117629Sharti -(int)sizeof(struct atm_pseudohdr))) 23369152Sjlemon return (ENOBUFS); 23425603Skjc return (error); 23525603Skjc 23625603Skjcbad: 23725603Skjc if (m) 23825603Skjc m_freem(m); 23925603Skjc return (error); 24025603Skjc} 24125603Skjc 24225603Skjc/* 24325603Skjc * Process a received ATM packet; 24425603Skjc * the packet is in the mbuf chain m. 24525603Skjc */ 24625603Skjcvoid 247116720Shartiatm_input(struct ifnet *ifp, struct atm_pseudohdr *ah, struct mbuf *m, 248116720Sharti void *rxhand) 24925603Skjc{ 250111888Sjlemon int isr; 251116720Sharti u_int16_t etype = ETHERTYPE_IP; /* default */ 25225603Skjc int s; 25325603Skjc 25425603Skjc if ((ifp->if_flags & IFF_UP) == 0) { 25525603Skjc m_freem(m); 25625603Skjc return; 25725603Skjc } 258105576Srwatson#ifdef MAC 259105576Srwatson mac_create_mbuf_from_ifnet(ifp, m); 260105576Srwatson#endif 26125603Skjc ifp->if_ibytes += m->m_pkthdr.len; 26225603Skjc 263116741Sharti if (ng_atm_input_p != NULL) { 264116741Sharti (*ng_atm_input_p)(ifp, &m, ah, rxhand); 265116741Sharti if (m == NULL) 266116741Sharti return; 267116741Sharti } 268116741Sharti 269116741Sharti /* not eaten by ng_atm. Maybe it's a pseudo-harp PDU? */ 270116741Sharti if (atm_harp_input_p != NULL) { 271116741Sharti (*atm_harp_input_p)(ifp, &m, ah, rxhand); 272116741Sharti if (m == NULL) 273116741Sharti return; 274116741Sharti } 275116741Sharti 27625603Skjc if (rxhand) { 27725603Skjc#ifdef NATM 27837939Skjc struct natmpcb *npcb = rxhand; 279116720Sharti 28037939Skjc s = splimp(); /* in case 2 atm cards @ diff lvls */ 28137939Skjc npcb->npcb_inq++; /* count # in queue */ 28237939Skjc splx(s); 283111888Sjlemon isr = NETISR_NATM; 28437939Skjc m->m_pkthdr.rcvif = rxhand; /* XXX: overload */ 28525603Skjc#else 286116720Sharti printf("atm_input: NATM detected but not " 287116720Sharti "configured in kernel\n"); 288116741Sharti goto dropit; 28925603Skjc#endif 29025603Skjc } else { 29137939Skjc /* 29237939Skjc * handle LLC/SNAP header, if present 29337939Skjc */ 29437939Skjc if (ATM_PH_FLAGS(ah) & ATM_PH_LLCSNAP) { 29537939Skjc struct atmllc *alc; 296116720Sharti 29737939Skjc if (m->m_len < sizeof(*alc) && 29837939Skjc (m = m_pullup(m, sizeof(*alc))) == 0) 29937939Skjc return; /* failed */ 30037939Skjc alc = mtod(m, struct atmllc *); 30137939Skjc if (bcmp(alc, ATMLLC_HDR, 6)) { 30225603Skjc#if defined(__NetBSD__) || defined(__OpenBSD__) 303116720Sharti printf("%s: recv'd invalid LLC/SNAP frame " 304116720Sharti "[vp=%d,vc=%d]\n", ifp->if_xname, 305116720Sharti ATM_PH_VPI(ah), ATM_PH_VCI(ah)); 30625603Skjc#elif defined(__FreeBSD__) || defined(__bsdi__) 307116720Sharti printf("%s%d: recv'd invalid LLC/SNAP frame " 308116720Sharti "[vp=%d,vc=%d]\n", ifp->if_name, 309116720Sharti ifp->if_unit, ATM_PH_VPI(ah), 310116720Sharti ATM_PH_VCI(ah)); 31125603Skjc#endif 31237939Skjc m_freem(m); 31337939Skjc return; 31437939Skjc } 31537939Skjc etype = ATM_LLC_TYPE(alc); 31637939Skjc m_adj(m, sizeof(*alc)); 31737939Skjc } 31825603Skjc 31937939Skjc switch (etype) { 320116720Sharti 32125603Skjc#ifdef INET 32237939Skjc case ETHERTYPE_IP: 323111888Sjlemon isr = NETISR_IP; 32437939Skjc break; 32525603Skjc#endif 326116720Sharti 32737939Skjc#ifdef INET6 32837939Skjc case ETHERTYPE_IPV6: 329111888Sjlemon isr = NETISR_IPV6; 33037939Skjc break; 33137939Skjc#endif 33237939Skjc default: 333116741Sharti#ifndef NATM 334116741Sharti dropit: 335116741Sharti#endif 336116741Sharti if (ng_atm_input_orphan_p != NULL) 337116741Sharti (*ng_atm_input_orphan_p)(ifp, m, ah, rxhand); 338116741Sharti else 339116741Sharti m_freem(m); 34037939Skjc return; 34137939Skjc } 34225603Skjc } 343111888Sjlemon netisr_dispatch(isr, m); 34425603Skjc} 34525603Skjc 34625603Skjc/* 347114201Sharti * Perform common duties while attaching to interface list. 34825603Skjc */ 34925603Skjcvoid 350116720Shartiatm_ifattach(struct ifnet *ifp) 35125603Skjc{ 352111774Smdodd struct ifaddr *ifa; 353111774Smdodd struct sockaddr_dl *sdl; 354114739Sharti struct ifatm *ifatm = ifp->if_softc; 35525603Skjc 35625603Skjc ifp->if_type = IFT_ATM; 35725603Skjc ifp->if_addrlen = 0; 35825603Skjc ifp->if_hdrlen = 0; 359114201Sharti if_attach(ifp); 36025603Skjc ifp->if_mtu = ATMMTU; 36125603Skjc ifp->if_output = atm_output; 362106939Ssam#if 0 363106939Ssam ifp->if_input = atm_input; 364106939Ssam#endif 36546695Skjc ifp->if_snd.ifq_maxlen = 50; /* dummy */ 36625603Skjc 36725603Skjc#if defined(__NetBSD__) || defined(__OpenBSD__) 36872012Sphk TAILQ_FOREACH(ifa, &ifp->if_addrlist, ifa_list) 36937939Skjc#elif defined(__FreeBSD__) && (__FreeBSD__ > 2) 37071959Sphk for (ifa = TAILQ_FIRST(&ifp->if_addrhead); ifa; 37171959Sphk ifa = TAILQ_NEXT(ifa, ifa_link)) 37225603Skjc#elif defined(__FreeBSD__) || defined(__bsdi__) 37325603Skjc for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) 37425603Skjc#endif 37525603Skjc if ((sdl = (struct sockaddr_dl *)ifa->ifa_addr) && 37625603Skjc sdl->sdl_family == AF_LINK) { 37725603Skjc sdl->sdl_type = IFT_ATM; 37825603Skjc sdl->sdl_alen = ifp->if_addrlen; 37925603Skjc#ifdef notyet /* if using ATMARP, store hardware address using the next line */ 38025603Skjc bcopy(ifp->hw_addr, LLADDR(sdl), ifp->if_addrlen); 38125603Skjc#endif 38225603Skjc break; 38325603Skjc } 38437939Skjc 385114739Sharti ifp->if_linkmib = &ifatm->mib; 386114739Sharti ifp->if_linkmiblen = sizeof(ifatm->mib); 387116741Sharti 388116741Sharti if(ng_atm_attach_p) 389116741Sharti (*ng_atm_attach_p)(ifp); 390116741Sharti if (atm_harp_attach_p) 391116741Sharti (*atm_harp_attach_p)(ifp); 39237939Skjc} 393114201Sharti 394114201Sharti/* 395114201Sharti * Common stuff for detaching an ATM interface 396114201Sharti */ 397114201Shartivoid 398114201Shartiatm_ifdetach(struct ifnet *ifp) 399114201Sharti{ 400116741Sharti if (atm_harp_detach_p) 401116741Sharti (*atm_harp_detach_p)(ifp); 402116741Sharti if(ng_atm_detach_p) 403116741Sharti (*ng_atm_detach_p)(ifp); 404114201Sharti if_detach(ifp); 405114201Sharti} 406114201Sharti 407114201Shartistatic moduledata_t atm_mod = { 408114201Sharti "atm", 409114201Sharti NULL, 410114201Sharti 0 411114201Sharti}; 412114201Sharti 413114201ShartiDECLARE_MODULE(atm, atm_mod, SI_SUB_PSEUDO, SI_ORDER_ANY); 414114201ShartiMODULE_VERSION(atm, 1); 415