1/* $NetBSD: if_atmsubr.c,v 1.10 1997/03/11 23:19:51 chuck Exp $ */ 2 3/* 4 * 5 * Copyright (c) 1996 Charles D. Cranor and Washington University. 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. All advertising materials mentioning features or use of this software 17 * must display the following acknowledgement: 18 * This product includes software developed by Charles D. Cranor and 19 * Washington University. 20 * 4. The name of the author may not be used to endorse or promote products 21 * derived from this software without specific prior written permission. 22 * 23 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 24 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 25 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 26 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 27 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 28 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 29 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 30 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 31 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 32 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 33 */ 34 35/* 36 * if_atmsubr.c 37 */ 38 39#include <sys/param.h> 40#include <sys/systm.h>
| 1/* $NetBSD: if_atmsubr.c,v 1.10 1997/03/11 23:19:51 chuck Exp $ */ 2 3/* 4 * 5 * Copyright (c) 1996 Charles D. Cranor and Washington University. 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. All advertising materials mentioning features or use of this software 17 * must display the following acknowledgement: 18 * This product includes software developed by Charles D. Cranor and 19 * Washington University. 20 * 4. The name of the author may not be used to endorse or promote products 21 * derived from this software without specific prior written permission. 22 * 23 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 24 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 25 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 26 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 27 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 28 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 29 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 30 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 31 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 32 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 33 */ 34 35/* 36 * if_atmsubr.c 37 */ 38 39#include <sys/param.h> 40#include <sys/systm.h>
|
41#include <sys/kernel.h>
| |
42#include <sys/mbuf.h> 43#include <sys/socket.h> 44 45#include <net/if.h> 46#include <net/netisr.h> 47#include <net/route.h> 48#include <net/if_dl.h> 49#include <net/if_types.h> 50#include <net/if_atm.h> 51 52#include <netinet/in.h> 53#include <netinet/if_atm.h> 54#include <netinet/if_ether.h> /* XXX: for ETHERTYPE_* */ 55#ifdef INET 56#include <netinet/in_var.h> 57#endif 58#ifdef NATM 59#include <netnatm/natm.h> 60#endif 61 62#include "bpfilter.h" 63#if NBPFILTER > 0 64/* 65 * bpf support. 66 * the code is derived from if_loop.c. 67 * bpf support should belong to the driver but it's easier to implement 68 * it here since we can call bpf_mtap before atm_output adds a pseudo 69 * header to the mbuf. 70 * --kjc 71 */ 72#include <net/bpf.h> 73#endif /* NBPFILTER > 0 */ 74 75#define senderr(e) { error = (e); goto bad;} 76 77/* 78 * atm_output: ATM output routine 79 * inputs: 80 * "ifp" = ATM interface to output to 81 * "m0" = the packet to output 82 * "dst" = the sockaddr to send to (either IP addr, or raw VPI/VCI) 83 * "rt0" = the route to use 84 * returns: error code [0 == ok] 85 * 86 * note: special semantic: if (dst == NULL) then we assume "m" already 87 * has an atm_pseudohdr on it and just send it directly. 88 * [for native mode ATM output] if dst is null, then 89 * rt0 must also be NULL. 90 */ 91 92int 93atm_output(ifp, m0, dst, rt0) 94 register struct ifnet *ifp; 95 struct mbuf *m0; 96 struct sockaddr *dst; 97 struct rtentry *rt0; 98{ 99 u_int16_t etype = 0; /* if using LLC/SNAP */ 100 int s, error = 0, sz; 101 struct atm_pseudohdr atmdst, *ad; 102 register struct mbuf *m = m0; 103 register struct rtentry *rt; 104 struct atmllc *atmllc; 105 u_int32_t atm_flags; 106 107 if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) 108 senderr(ENETDOWN);
| 41#include <sys/mbuf.h> 42#include <sys/socket.h> 43 44#include <net/if.h> 45#include <net/netisr.h> 46#include <net/route.h> 47#include <net/if_dl.h> 48#include <net/if_types.h> 49#include <net/if_atm.h> 50 51#include <netinet/in.h> 52#include <netinet/if_atm.h> 53#include <netinet/if_ether.h> /* XXX: for ETHERTYPE_* */ 54#ifdef INET 55#include <netinet/in_var.h> 56#endif 57#ifdef NATM 58#include <netnatm/natm.h> 59#endif 60 61#include "bpfilter.h" 62#if NBPFILTER > 0 63/* 64 * bpf support. 65 * the code is derived from if_loop.c. 66 * bpf support should belong to the driver but it's easier to implement 67 * it here since we can call bpf_mtap before atm_output adds a pseudo 68 * header to the mbuf. 69 * --kjc 70 */ 71#include <net/bpf.h> 72#endif /* NBPFILTER > 0 */ 73 74#define senderr(e) { error = (e); goto bad;} 75 76/* 77 * atm_output: ATM output routine 78 * inputs: 79 * "ifp" = ATM interface to output to 80 * "m0" = the packet to output 81 * "dst" = the sockaddr to send to (either IP addr, or raw VPI/VCI) 82 * "rt0" = the route to use 83 * returns: error code [0 == ok] 84 * 85 * note: special semantic: if (dst == NULL) then we assume "m" already 86 * has an atm_pseudohdr on it and just send it directly. 87 * [for native mode ATM output] if dst is null, then 88 * rt0 must also be NULL. 89 */ 90 91int 92atm_output(ifp, m0, dst, rt0) 93 register struct ifnet *ifp; 94 struct mbuf *m0; 95 struct sockaddr *dst; 96 struct rtentry *rt0; 97{ 98 u_int16_t etype = 0; /* if using LLC/SNAP */ 99 int s, error = 0, sz; 100 struct atm_pseudohdr atmdst, *ad; 101 register struct mbuf *m = m0; 102 register struct rtentry *rt; 103 struct atmllc *atmllc; 104 u_int32_t atm_flags; 105 106 if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) 107 senderr(ENETDOWN);
|
109 ifp->if_lastchange = time;
| 108 gettime(&ifp->if_lastchange);
|
110 111 /* 112 * check route 113 */ 114 if ((rt = rt0) != NULL) { 115 116 if ((rt->rt_flags & RTF_UP) == 0) { /* route went down! */ 117 if ((rt0 = rt = RTALLOC1(dst, 0)) != NULL) 118 rt->rt_refcnt--; 119 else 120 senderr(EHOSTUNREACH); 121 } 122 123 if (rt->rt_flags & RTF_GATEWAY) { 124 if (rt->rt_gwroute == 0) 125 goto lookup; 126 if (((rt = rt->rt_gwroute)->rt_flags & RTF_UP) == 0) { 127 rtfree(rt); rt = rt0; 128 lookup: rt->rt_gwroute = RTALLOC1(rt->rt_gateway, 0); 129 if ((rt = rt->rt_gwroute) == 0) 130 senderr(EHOSTUNREACH); 131 } 132 } 133 134 /* XXX: put RTF_REJECT code here if doing ATMARP */ 135 136 } 137 138 /* 139 * check for non-native ATM traffic (dst != NULL) 140 */ 141 if (dst) { 142 switch (dst->sa_family) { 143#ifdef INET 144 case AF_INET: 145 if (!atmresolve(rt, m, dst, &atmdst)) { 146 m = NULL; 147 /* XXX: atmresolve already free'd it */ 148 senderr(EHOSTUNREACH); 149 /* XXX: put ATMARP stuff here */ 150 /* XXX: watch who frees m on failure */ 151 } 152 etype = htons(ETHERTYPE_IP); 153 break; 154#endif 155 156 default: 157#if defined(__NetBSD__) || defined(__OpenBSD__) 158 printf("%s: can't handle af%d\n", ifp->if_xname, 159 dst->sa_family); 160#elif defined(__FreeBSD__) || defined(__bsdi__) 161 printf("%s%d: can't handle af%d\n", ifp->if_name, 162 ifp->if_unit, dst->sa_family); 163#endif 164 senderr(EAFNOSUPPORT); 165 } 166 167#if NBPFILTER > 0 168 /* BPF write needs to be handled specially */ 169 if (dst && dst->sa_family == AF_UNSPEC) { 170 dst->sa_family = *(mtod(m, int *)); 171 m->m_len -= sizeof(int); 172 m->m_pkthdr.len -= sizeof(int); 173 m->m_data += sizeof(int); 174 } 175 176 if (ifp->if_bpf) { 177 /* 178 * We need to prepend the address family as 179 * a four byte field. Cons up a dummy header 180 * to pacify bpf. This is safe because bpf 181 * will only read from the mbuf (i.e., it won't 182 * try to free it or keep a pointer a to it). 183 */ 184 struct mbuf m1; 185 u_int af = dst->sa_family; 186 187 m1.m_next = m; 188 m1.m_len = 4; 189 m1.m_data = (char *)⁡ 190 191 s = splimp(); 192#if defined(__NetBSD__) || defined(__OpenBSD__) 193 bpf_mtap(&ifp->if_bpf, &m0); 194#elif defined(__FreeBSD__) 195 bpf_mtap(ifp, &m1); 196#endif 197 splx(s); 198 } 199#endif /* NBPFILTER > 0 */ 200 201 /* 202 * must add atm_pseudohdr to data 203 */ 204 sz = sizeof(atmdst); 205 atm_flags = ATM_PH_FLAGS(&atmdst); 206 if (atm_flags & ATM_PH_LLCSNAP) sz += 8; /* sizeof snap == 8 */ 207 M_PREPEND(m, sz, M_DONTWAIT); 208 if (m == 0) 209 senderr(ENOBUFS); 210 ad = mtod(m, struct atm_pseudohdr *); 211 *ad = atmdst; 212 if (atm_flags & ATM_PH_LLCSNAP) { 213 atmllc = (struct atmllc *)(ad + 1); 214 bcopy(ATMLLC_HDR, atmllc->llchdr, 215 sizeof(atmllc->llchdr)); 216 ATM_LLC_SETTYPE(atmllc, etype); 217 /* note: already in network order */ 218 } 219 } 220 221 /* 222 * Queue message on interface, and start output if interface 223 * not yet active. 224 */ 225 226 s = splimp(); 227 if (IF_QFULL(&ifp->if_snd)) { 228 IF_DROP(&ifp->if_snd); 229 splx(s); 230 senderr(ENOBUFS); 231 } 232 ifp->if_obytes += m->m_pkthdr.len; 233 IF_ENQUEUE(&ifp->if_snd, m); 234 if ((ifp->if_flags & IFF_OACTIVE) == 0) 235 (*ifp->if_start)(ifp); 236 splx(s); 237 return (error); 238 239bad: 240 if (m) 241 m_freem(m); 242 return (error); 243} 244 245/* 246 * Process a received ATM packet; 247 * the packet is in the mbuf chain m. 248 */ 249void 250atm_input(ifp, ah, m, rxhand) 251 struct ifnet *ifp; 252 register struct atm_pseudohdr *ah; 253 struct mbuf *m; 254 void *rxhand; 255{ 256 register struct ifqueue *inq; 257 u_int16_t etype = ETHERTYPE_IP; /* default */ 258 int s; 259 260 if ((ifp->if_flags & IFF_UP) == 0) { 261 m_freem(m); 262 return; 263 }
| 109 110 /* 111 * check route 112 */ 113 if ((rt = rt0) != NULL) { 114 115 if ((rt->rt_flags & RTF_UP) == 0) { /* route went down! */ 116 if ((rt0 = rt = RTALLOC1(dst, 0)) != NULL) 117 rt->rt_refcnt--; 118 else 119 senderr(EHOSTUNREACH); 120 } 121 122 if (rt->rt_flags & RTF_GATEWAY) { 123 if (rt->rt_gwroute == 0) 124 goto lookup; 125 if (((rt = rt->rt_gwroute)->rt_flags & RTF_UP) == 0) { 126 rtfree(rt); rt = rt0; 127 lookup: rt->rt_gwroute = RTALLOC1(rt->rt_gateway, 0); 128 if ((rt = rt->rt_gwroute) == 0) 129 senderr(EHOSTUNREACH); 130 } 131 } 132 133 /* XXX: put RTF_REJECT code here if doing ATMARP */ 134 135 } 136 137 /* 138 * check for non-native ATM traffic (dst != NULL) 139 */ 140 if (dst) { 141 switch (dst->sa_family) { 142#ifdef INET 143 case AF_INET: 144 if (!atmresolve(rt, m, dst, &atmdst)) { 145 m = NULL; 146 /* XXX: atmresolve already free'd it */ 147 senderr(EHOSTUNREACH); 148 /* XXX: put ATMARP stuff here */ 149 /* XXX: watch who frees m on failure */ 150 } 151 etype = htons(ETHERTYPE_IP); 152 break; 153#endif 154 155 default: 156#if defined(__NetBSD__) || defined(__OpenBSD__) 157 printf("%s: can't handle af%d\n", ifp->if_xname, 158 dst->sa_family); 159#elif defined(__FreeBSD__) || defined(__bsdi__) 160 printf("%s%d: can't handle af%d\n", ifp->if_name, 161 ifp->if_unit, dst->sa_family); 162#endif 163 senderr(EAFNOSUPPORT); 164 } 165 166#if NBPFILTER > 0 167 /* BPF write needs to be handled specially */ 168 if (dst && dst->sa_family == AF_UNSPEC) { 169 dst->sa_family = *(mtod(m, int *)); 170 m->m_len -= sizeof(int); 171 m->m_pkthdr.len -= sizeof(int); 172 m->m_data += sizeof(int); 173 } 174 175 if (ifp->if_bpf) { 176 /* 177 * We need to prepend the address family as 178 * a four byte field. Cons up a dummy header 179 * to pacify bpf. This is safe because bpf 180 * will only read from the mbuf (i.e., it won't 181 * try to free it or keep a pointer a to it). 182 */ 183 struct mbuf m1; 184 u_int af = dst->sa_family; 185 186 m1.m_next = m; 187 m1.m_len = 4; 188 m1.m_data = (char *)⁡ 189 190 s = splimp(); 191#if defined(__NetBSD__) || defined(__OpenBSD__) 192 bpf_mtap(&ifp->if_bpf, &m0); 193#elif defined(__FreeBSD__) 194 bpf_mtap(ifp, &m1); 195#endif 196 splx(s); 197 } 198#endif /* NBPFILTER > 0 */ 199 200 /* 201 * must add atm_pseudohdr to data 202 */ 203 sz = sizeof(atmdst); 204 atm_flags = ATM_PH_FLAGS(&atmdst); 205 if (atm_flags & ATM_PH_LLCSNAP) sz += 8; /* sizeof snap == 8 */ 206 M_PREPEND(m, sz, M_DONTWAIT); 207 if (m == 0) 208 senderr(ENOBUFS); 209 ad = mtod(m, struct atm_pseudohdr *); 210 *ad = atmdst; 211 if (atm_flags & ATM_PH_LLCSNAP) { 212 atmllc = (struct atmllc *)(ad + 1); 213 bcopy(ATMLLC_HDR, atmllc->llchdr, 214 sizeof(atmllc->llchdr)); 215 ATM_LLC_SETTYPE(atmllc, etype); 216 /* note: already in network order */ 217 } 218 } 219 220 /* 221 * Queue message on interface, and start output if interface 222 * not yet active. 223 */ 224 225 s = splimp(); 226 if (IF_QFULL(&ifp->if_snd)) { 227 IF_DROP(&ifp->if_snd); 228 splx(s); 229 senderr(ENOBUFS); 230 } 231 ifp->if_obytes += m->m_pkthdr.len; 232 IF_ENQUEUE(&ifp->if_snd, m); 233 if ((ifp->if_flags & IFF_OACTIVE) == 0) 234 (*ifp->if_start)(ifp); 235 splx(s); 236 return (error); 237 238bad: 239 if (m) 240 m_freem(m); 241 return (error); 242} 243 244/* 245 * Process a received ATM packet; 246 * the packet is in the mbuf chain m. 247 */ 248void 249atm_input(ifp, ah, m, rxhand) 250 struct ifnet *ifp; 251 register struct atm_pseudohdr *ah; 252 struct mbuf *m; 253 void *rxhand; 254{ 255 register struct ifqueue *inq; 256 u_int16_t etype = ETHERTYPE_IP; /* default */ 257 int s; 258 259 if ((ifp->if_flags & IFF_UP) == 0) { 260 m_freem(m); 261 return; 262 }
|
264 ifp->if_lastchange = time;
| 263 gettime(&ifp->if_lastchange);
|
265 ifp->if_ibytes += m->m_pkthdr.len; 266 267#if NBPFILTER > 0 268 if (ifp->if_bpf) { 269 /* 270 * We need to prepend the address family as 271 * a four byte field. Cons up a dummy header 272 * to pacify bpf. This is safe because bpf 273 * will only read from the mbuf (i.e., it won't 274 * try to free it or keep a pointer to it). 275 */ 276 struct mbuf m0; 277 u_int af = AF_INET; 278 279 m0.m_next = m; 280 m0.m_len = 4; 281 m0.m_data = (char *)⁡ 282 283#if defined(__NetBSD__) || defined(__OpenBSD__) 284 bpf_mtap(&ifp->if_bpf, &m0); 285#elif defined(__FreeBSD__) 286 bpf_mtap(ifp, &m0); 287#endif 288 } 289#endif /* NBPFILTER > 0 */ 290 291 if (rxhand) { 292#ifdef NATM 293 struct natmpcb *npcb = rxhand; 294 s = splimp(); /* in case 2 atm cards @ diff lvls */ 295 npcb->npcb_inq++; /* count # in queue */ 296 splx(s); 297 schednetisr(NETISR_NATM); 298 inq = &natmintrq; 299 m->m_pkthdr.rcvif = rxhand; /* XXX: overload */ 300#else 301 printf("atm_input: NATM detected but not configured in kernel\n"); 302 m_freem(m); 303 return; 304#endif 305 } else { 306 /* 307 * handle LLC/SNAP header, if present 308 */ 309 if (ATM_PH_FLAGS(ah) & ATM_PH_LLCSNAP) { 310 struct atmllc *alc; 311 if (m->m_len < sizeof(*alc) && (m = m_pullup(m, sizeof(*alc))) == 0) 312 return; /* failed */ 313 alc = mtod(m, struct atmllc *); 314 if (bcmp(alc, ATMLLC_HDR, 6)) { 315#if defined(__NetBSD__) || defined(__OpenBSD__) 316 printf("%s: recv'd invalid LLC/SNAP frame [vp=%d,vc=%d]\n", 317 ifp->if_xname, ATM_PH_VPI(ah), ATM_PH_VCI(ah)); 318#elif defined(__FreeBSD__) || defined(__bsdi__) 319 printf("%s%d: recv'd invalid LLC/SNAP frame [vp=%d,vc=%d]\n", 320 ifp->if_name, ifp->if_unit, ATM_PH_VPI(ah), ATM_PH_VCI(ah)); 321#endif 322 m_freem(m); 323 return; 324 } 325 etype = ATM_LLC_TYPE(alc); 326 m_adj(m, sizeof(*alc)); 327 } 328 329 switch (etype) { 330#ifdef INET 331 case ETHERTYPE_IP: 332 schednetisr(NETISR_IP); 333 inq = &ipintrq; 334 break; 335#endif 336 default: 337 m_freem(m); 338 return; 339 } 340 } 341 342 s = splimp(); 343 if (IF_QFULL(inq)) { 344 IF_DROP(inq); 345 m_freem(m); 346 } else 347 IF_ENQUEUE(inq, m); 348 splx(s); 349} 350 351/* 352 * Perform common duties while attaching to interface list 353 */ 354void 355atm_ifattach(ifp) 356 register struct ifnet *ifp; 357{ 358 register struct ifaddr *ifa; 359 register struct sockaddr_dl *sdl; 360 361 ifp->if_type = IFT_ATM; 362 ifp->if_addrlen = 0; 363 ifp->if_hdrlen = 0; 364 ifp->if_mtu = ATMMTU; 365 ifp->if_output = atm_output; 366 367#if defined(__NetBSD__) || defined(__OpenBSD__) 368 for (ifa = ifp->if_addrlist.tqh_first; ifa != 0; 369 ifa = ifa->ifa_list.tqe_next) 370#elif defined(__FreeBSD__) && ((__FreeBSD__ > 2) || defined(_NET_IF_VAR_H_)) 371/* 372 * for FreeBSD-3.0. 3.0-SNAP-970124 still sets -D__FreeBSD__=2! 373 * XXX -- for now, use newly-introduced "net/if_var.h" as an identifier. 374 * need a better way to identify 3.0. -- kjc 375 */ 376 for (ifa = ifp->if_addrhead.tqh_first; ifa; 377 ifa = ifa->ifa_link.tqe_next) 378#elif defined(__FreeBSD__) || defined(__bsdi__) 379 for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) 380#endif 381 382 if ((sdl = (struct sockaddr_dl *)ifa->ifa_addr) && 383 sdl->sdl_family == AF_LINK) { 384 sdl->sdl_type = IFT_ATM; 385 sdl->sdl_alen = ifp->if_addrlen; 386#ifdef notyet /* if using ATMARP, store hardware address using the next line */ 387 bcopy(ifp->hw_addr, LLADDR(sdl), ifp->if_addrlen); 388#endif 389 break; 390 } 391#if NBPFILTER > 0 392#if defined(__NetBSD__) || defined(__OpenBSD__) 393 bpfattach(&ifp->if_bpf, ifp, DLT_NULL, sizeof(u_int)); 394#elif defined(__FreeBSD__) 395 bpfattach(ifp, DLT_NULL, sizeof(u_int)); 396#endif 397#endif /* NBPFILTER > 0 */ 398}
| 264 ifp->if_ibytes += m->m_pkthdr.len; 265 266#if NBPFILTER > 0 267 if (ifp->if_bpf) { 268 /* 269 * We need to prepend the address family as 270 * a four byte field. Cons up a dummy header 271 * to pacify bpf. This is safe because bpf 272 * will only read from the mbuf (i.e., it won't 273 * try to free it or keep a pointer to it). 274 */ 275 struct mbuf m0; 276 u_int af = AF_INET; 277 278 m0.m_next = m; 279 m0.m_len = 4; 280 m0.m_data = (char *)⁡ 281 282#if defined(__NetBSD__) || defined(__OpenBSD__) 283 bpf_mtap(&ifp->if_bpf, &m0); 284#elif defined(__FreeBSD__) 285 bpf_mtap(ifp, &m0); 286#endif 287 } 288#endif /* NBPFILTER > 0 */ 289 290 if (rxhand) { 291#ifdef NATM 292 struct natmpcb *npcb = rxhand; 293 s = splimp(); /* in case 2 atm cards @ diff lvls */ 294 npcb->npcb_inq++; /* count # in queue */ 295 splx(s); 296 schednetisr(NETISR_NATM); 297 inq = &natmintrq; 298 m->m_pkthdr.rcvif = rxhand; /* XXX: overload */ 299#else 300 printf("atm_input: NATM detected but not configured in kernel\n"); 301 m_freem(m); 302 return; 303#endif 304 } else { 305 /* 306 * handle LLC/SNAP header, if present 307 */ 308 if (ATM_PH_FLAGS(ah) & ATM_PH_LLCSNAP) { 309 struct atmllc *alc; 310 if (m->m_len < sizeof(*alc) && (m = m_pullup(m, sizeof(*alc))) == 0) 311 return; /* failed */ 312 alc = mtod(m, struct atmllc *); 313 if (bcmp(alc, ATMLLC_HDR, 6)) { 314#if defined(__NetBSD__) || defined(__OpenBSD__) 315 printf("%s: recv'd invalid LLC/SNAP frame [vp=%d,vc=%d]\n", 316 ifp->if_xname, ATM_PH_VPI(ah), ATM_PH_VCI(ah)); 317#elif defined(__FreeBSD__) || defined(__bsdi__) 318 printf("%s%d: recv'd invalid LLC/SNAP frame [vp=%d,vc=%d]\n", 319 ifp->if_name, ifp->if_unit, ATM_PH_VPI(ah), ATM_PH_VCI(ah)); 320#endif 321 m_freem(m); 322 return; 323 } 324 etype = ATM_LLC_TYPE(alc); 325 m_adj(m, sizeof(*alc)); 326 } 327 328 switch (etype) { 329#ifdef INET 330 case ETHERTYPE_IP: 331 schednetisr(NETISR_IP); 332 inq = &ipintrq; 333 break; 334#endif 335 default: 336 m_freem(m); 337 return; 338 } 339 } 340 341 s = splimp(); 342 if (IF_QFULL(inq)) { 343 IF_DROP(inq); 344 m_freem(m); 345 } else 346 IF_ENQUEUE(inq, m); 347 splx(s); 348} 349 350/* 351 * Perform common duties while attaching to interface list 352 */ 353void 354atm_ifattach(ifp) 355 register struct ifnet *ifp; 356{ 357 register struct ifaddr *ifa; 358 register struct sockaddr_dl *sdl; 359 360 ifp->if_type = IFT_ATM; 361 ifp->if_addrlen = 0; 362 ifp->if_hdrlen = 0; 363 ifp->if_mtu = ATMMTU; 364 ifp->if_output = atm_output; 365 366#if defined(__NetBSD__) || defined(__OpenBSD__) 367 for (ifa = ifp->if_addrlist.tqh_first; ifa != 0; 368 ifa = ifa->ifa_list.tqe_next) 369#elif defined(__FreeBSD__) && ((__FreeBSD__ > 2) || defined(_NET_IF_VAR_H_)) 370/* 371 * for FreeBSD-3.0. 3.0-SNAP-970124 still sets -D__FreeBSD__=2! 372 * XXX -- for now, use newly-introduced "net/if_var.h" as an identifier. 373 * need a better way to identify 3.0. -- kjc 374 */ 375 for (ifa = ifp->if_addrhead.tqh_first; ifa; 376 ifa = ifa->ifa_link.tqe_next) 377#elif defined(__FreeBSD__) || defined(__bsdi__) 378 for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) 379#endif 380 381 if ((sdl = (struct sockaddr_dl *)ifa->ifa_addr) && 382 sdl->sdl_family == AF_LINK) { 383 sdl->sdl_type = IFT_ATM; 384 sdl->sdl_alen = ifp->if_addrlen; 385#ifdef notyet /* if using ATMARP, store hardware address using the next line */ 386 bcopy(ifp->hw_addr, LLADDR(sdl), ifp->if_addrlen); 387#endif 388 break; 389 } 390#if NBPFILTER > 0 391#if defined(__NetBSD__) || defined(__OpenBSD__) 392 bpfattach(&ifp->if_bpf, ifp, DLT_NULL, sizeof(u_int)); 393#elif defined(__FreeBSD__) 394 bpfattach(ifp, DLT_NULL, sizeof(u_int)); 395#endif 396#endif /* NBPFILTER > 0 */ 397}
|