41 */ 42 43#include "bpf.h" 44 45#ifndef __GNUC__ 46#define inline 47#else 48#define inline __inline 49#endif 50 51#include <sys/param.h> 52#include <sys/systm.h> 53#include <sys/conf.h> 54#include <sys/malloc.h> 55#include <sys/mbuf.h> 56#include <sys/time.h> 57#include <sys/proc.h> 58#include <sys/signalvar.h> 59#include <sys/filio.h> 60#include <sys/sockio.h> 61#include <sys/ttycom.h> 62#include <sys/filedesc.h> 63 64#if defined(sparc) && BSD < 199103 65#include <sys/stream.h> 66#endif 67#include <sys/poll.h> 68 69#include <sys/socket.h> 70#include <sys/vnode.h> 71 72#include <net/if.h> 73#include <net/bpf.h> 74#include <net/bpfdesc.h> 75 76#include <netinet/in.h> 77#include <netinet/if_ether.h> 78#include <sys/kernel.h> 79#include <sys/sysctl.h> 80 81MALLOC_DEFINE(M_BPF, "BPF", "BPF data"); 82 83#if NBPF > 0 84 85/* 86 * Older BSDs don't have kernel malloc. 87 */ 88#if BSD < 199103 89extern bcopy(); 90static caddr_t bpf_alloc(); 91#include <net/bpf_compat.h> 92#define BPF_BUFSIZE (MCLBYTES-8) 93#define UIOMOVE(cp, len, code, uio) uiomove(cp, len, code, uio) 94#else 95#define BPF_BUFSIZE 4096 96#define UIOMOVE(cp, len, code, uio) uiomove(cp, len, uio) 97#endif 98 99#define PRINET 26 /* interruptible */ 100 101/* 102 * The default read buffer size is patchable. 103 */ 104static int bpf_bufsize = BPF_BUFSIZE; 105SYSCTL_INT(_debug, OID_AUTO, bpf_bufsize, CTLFLAG_RW, 106 &bpf_bufsize, 0, ""); 107static int bpf_maxbufsize = BPF_MAXBUFSIZE; 108SYSCTL_INT(_debug, OID_AUTO, bpf_maxbufsize, CTLFLAG_RW, 109 &bpf_maxbufsize, 0, ""); 110 111/* 112 * bpf_iflist is the list of interfaces; each corresponds to an ifnet 113 */ 114static struct bpf_if *bpf_iflist; 115 116static int bpf_allocbufs __P((struct bpf_d *)); 117static void bpf_attachd __P((struct bpf_d *d, struct bpf_if *bp)); 118static void bpf_detachd __P((struct bpf_d *d)); 119static void bpf_freed __P((struct bpf_d *)); 120static void bpf_mcopy __P((const void *, void *, size_t)); 121static int bpf_movein __P((struct uio *, int, 122 struct mbuf **, struct sockaddr *, int *)); 123static int bpf_setif __P((struct bpf_d *, struct ifreq *)); 124static inline void 125 bpf_wakeup __P((struct bpf_d *)); 126static void catchpacket __P((struct bpf_d *, u_char *, u_int, 127 u_int, void (*)(const void *, void *, size_t))); 128static void reset_d __P((struct bpf_d *)); 129static int bpf_setf __P((struct bpf_d *, struct bpf_program *)); 130 131static d_open_t bpfopen; 132static d_close_t bpfclose; 133static d_read_t bpfread; 134static d_write_t bpfwrite; 135static d_ioctl_t bpfioctl; 136static d_poll_t bpfpoll; 137 138#define CDEV_MAJOR 23 139static struct cdevsw bpf_cdevsw = { 140 /* open */ bpfopen, 141 /* close */ bpfclose, 142 /* read */ bpfread, 143 /* write */ bpfwrite, 144 /* ioctl */ bpfioctl, 145 /* poll */ bpfpoll, 146 /* mmap */ nommap, 147 /* strategy */ nostrategy, 148 /* name */ "bpf", 149 /* maj */ CDEV_MAJOR, 150 /* dump */ nodump, 151 /* psize */ nopsize, 152 /* flags */ 0, 153 /* bmaj */ -1 154}; 155 156 157static int 158bpf_movein(uio, linktype, mp, sockp, datlen) 159 register struct uio *uio; 160 int linktype, *datlen; 161 register struct mbuf **mp; 162 register struct sockaddr *sockp; 163{ 164 struct mbuf *m; 165 int error; 166 int len; 167 int hlen; 168 169 /* 170 * Build a sockaddr based on the data link layer type. 171 * We do this at this level because the ethernet header 172 * is copied directly into the data field of the sockaddr. 173 * In the case of SLIP, there is no header and the packet 174 * is forwarded as is. 175 * Also, we are careful to leave room at the front of the mbuf 176 * for the link level header. 177 */ 178 switch (linktype) { 179 180 case DLT_SLIP: 181 sockp->sa_family = AF_INET; 182 hlen = 0; 183 break; 184 185 case DLT_EN10MB: 186 sockp->sa_family = AF_UNSPEC; 187 /* XXX Would MAXLINKHDR be better? */ 188 hlen = sizeof(struct ether_header); 189 break; 190 191 case DLT_FDDI: 192#if defined(__FreeBSD__) || defined(__bsdi__) 193 sockp->sa_family = AF_IMPLINK; 194 hlen = 0; 195#else 196 sockp->sa_family = AF_UNSPEC; 197 /* XXX 4(FORMAC)+6(dst)+6(src)+3(LLC)+5(SNAP) */ 198 hlen = 24; 199#endif 200 break; 201 202 case DLT_RAW: 203 case DLT_NULL: 204 sockp->sa_family = AF_UNSPEC; 205 hlen = 0; 206 break; 207 208#ifdef __FreeBSD__ 209 case DLT_ATM_RFC1483: 210 /* 211 * en atm driver requires 4-byte atm pseudo header. 212 * though it isn't standard, vpi:vci needs to be 213 * specified anyway. 214 */ 215 sockp->sa_family = AF_UNSPEC; 216 hlen = 12; /* XXX 4(ATM_PH) + 3(LLC) + 5(SNAP) */ 217 break; 218#endif 219 220 case DLT_PPP: 221 sockp->sa_family = AF_UNSPEC; 222 hlen = 4; /* This should match PPP_HDRLEN */ 223 break; 224 225 default: 226 return (EIO); 227 } 228 229 len = uio->uio_resid; 230 *datlen = len - hlen; 231 if ((unsigned)len > MCLBYTES) 232 return (EIO); 233 234 MGETHDR(m, M_WAIT, MT_DATA); 235 if (m == 0) 236 return (ENOBUFS); 237 if (len > MHLEN) { 238#if BSD >= 199103 239 MCLGET(m, M_WAIT); 240 if ((m->m_flags & M_EXT) == 0) { 241#else 242 MCLGET(m); 243 if (m->m_len != MCLBYTES) { 244#endif 245 error = ENOBUFS; 246 goto bad; 247 } 248 } 249 m->m_pkthdr.len = m->m_len = len; 250 m->m_pkthdr.rcvif = NULL; 251 *mp = m; 252 /* 253 * Make room for link header. 254 */ 255 if (hlen != 0) { 256 m->m_pkthdr.len -= hlen; 257 m->m_len -= hlen; 258#if BSD >= 199103 259 m->m_data += hlen; /* XXX */ 260#else 261 m->m_off += hlen; 262#endif 263 error = UIOMOVE((caddr_t)sockp->sa_data, hlen, UIO_WRITE, uio); 264 if (error) 265 goto bad; 266 } 267 error = UIOMOVE(mtod(m, caddr_t), len - hlen, UIO_WRITE, uio); 268 if (!error) 269 return (0); 270 bad: 271 m_freem(m); 272 return (error); 273} 274 275/* 276 * Attach file to the bpf interface, i.e. make d listen on bp. 277 * Must be called at splimp. 278 */ 279static void 280bpf_attachd(d, bp) 281 struct bpf_d *d; 282 struct bpf_if *bp; 283{ 284 /* 285 * Point d at bp, and add d to the interface's list of listeners. 286 * Finally, point the driver's bpf cookie at the interface so 287 * it will divert packets to bpf. 288 */ 289 d->bd_bif = bp; 290 d->bd_next = bp->bif_dlist; 291 bp->bif_dlist = d; 292 293 bp->bif_ifp->if_bpf = bp; 294} 295 296/* 297 * Detach a file from its interface. 298 */ 299static void 300bpf_detachd(d) 301 struct bpf_d *d; 302{ 303 int error; 304 struct bpf_d **p; 305 struct bpf_if *bp; 306 307 bp = d->bd_bif; 308 /* 309 * Check if this descriptor had requested promiscuous mode. 310 * If so, turn it off. 311 */ 312 if (d->bd_promisc) { 313 d->bd_promisc = 0; 314 error = ifpromisc(bp->bif_ifp, 0); 315 if (error != 0 && error != ENXIO) { 316 /* 317 * ENXIO can happen if a pccard is unplugged 318 * Something is really wrong if we were able to put 319 * the driver into promiscuous mode, but can't 320 * take it out. 321 */ 322 printf("%s%d: ifpromisc failed %d\n", 323 bp->bif_ifp->if_name, bp->bif_ifp->if_unit, error); 324 } 325 } 326 /* Remove d from the interface's descriptor list. */ 327 p = &bp->bif_dlist; 328 while (*p != d) { 329 p = &(*p)->bd_next; 330 if (*p == 0) 331 panic("bpf_detachd: descriptor not in list"); 332 } 333 *p = (*p)->bd_next; 334 if (bp->bif_dlist == 0) 335 /* 336 * Let the driver know that there are no more listeners. 337 */ 338 d->bd_bif->bif_ifp->if_bpf = 0; 339 d->bd_bif = 0; 340} 341 342/* 343 * Open ethernet device. Returns ENXIO for illegal minor device number, 344 * EBUSY if file is open by another process. 345 */ 346/* ARGSUSED */ 347static int 348bpfopen(dev, flags, fmt, p) 349 dev_t dev; 350 int flags; 351 int fmt; 352 struct proc *p; 353{ 354 register struct bpf_d *d; 355 356 if (p->p_prison) 357 return (EPERM); 358 359 d = dev->si_drv1; 360 /* 361 * Each minor can be opened by only one process. If the requested 362 * minor is in use, return EBUSY. 363 */ 364 if (d) 365 return (EBUSY);
| 41 */ 42 43#include "bpf.h" 44 45#ifndef __GNUC__ 46#define inline 47#else 48#define inline __inline 49#endif 50 51#include <sys/param.h> 52#include <sys/systm.h> 53#include <sys/conf.h> 54#include <sys/malloc.h> 55#include <sys/mbuf.h> 56#include <sys/time.h> 57#include <sys/proc.h> 58#include <sys/signalvar.h> 59#include <sys/filio.h> 60#include <sys/sockio.h> 61#include <sys/ttycom.h> 62#include <sys/filedesc.h> 63 64#if defined(sparc) && BSD < 199103 65#include <sys/stream.h> 66#endif 67#include <sys/poll.h> 68 69#include <sys/socket.h> 70#include <sys/vnode.h> 71 72#include <net/if.h> 73#include <net/bpf.h> 74#include <net/bpfdesc.h> 75 76#include <netinet/in.h> 77#include <netinet/if_ether.h> 78#include <sys/kernel.h> 79#include <sys/sysctl.h> 80 81MALLOC_DEFINE(M_BPF, "BPF", "BPF data"); 82 83#if NBPF > 0 84 85/* 86 * Older BSDs don't have kernel malloc. 87 */ 88#if BSD < 199103 89extern bcopy(); 90static caddr_t bpf_alloc(); 91#include <net/bpf_compat.h> 92#define BPF_BUFSIZE (MCLBYTES-8) 93#define UIOMOVE(cp, len, code, uio) uiomove(cp, len, code, uio) 94#else 95#define BPF_BUFSIZE 4096 96#define UIOMOVE(cp, len, code, uio) uiomove(cp, len, uio) 97#endif 98 99#define PRINET 26 /* interruptible */ 100 101/* 102 * The default read buffer size is patchable. 103 */ 104static int bpf_bufsize = BPF_BUFSIZE; 105SYSCTL_INT(_debug, OID_AUTO, bpf_bufsize, CTLFLAG_RW, 106 &bpf_bufsize, 0, ""); 107static int bpf_maxbufsize = BPF_MAXBUFSIZE; 108SYSCTL_INT(_debug, OID_AUTO, bpf_maxbufsize, CTLFLAG_RW, 109 &bpf_maxbufsize, 0, ""); 110 111/* 112 * bpf_iflist is the list of interfaces; each corresponds to an ifnet 113 */ 114static struct bpf_if *bpf_iflist; 115 116static int bpf_allocbufs __P((struct bpf_d *)); 117static void bpf_attachd __P((struct bpf_d *d, struct bpf_if *bp)); 118static void bpf_detachd __P((struct bpf_d *d)); 119static void bpf_freed __P((struct bpf_d *)); 120static void bpf_mcopy __P((const void *, void *, size_t)); 121static int bpf_movein __P((struct uio *, int, 122 struct mbuf **, struct sockaddr *, int *)); 123static int bpf_setif __P((struct bpf_d *, struct ifreq *)); 124static inline void 125 bpf_wakeup __P((struct bpf_d *)); 126static void catchpacket __P((struct bpf_d *, u_char *, u_int, 127 u_int, void (*)(const void *, void *, size_t))); 128static void reset_d __P((struct bpf_d *)); 129static int bpf_setf __P((struct bpf_d *, struct bpf_program *)); 130 131static d_open_t bpfopen; 132static d_close_t bpfclose; 133static d_read_t bpfread; 134static d_write_t bpfwrite; 135static d_ioctl_t bpfioctl; 136static d_poll_t bpfpoll; 137 138#define CDEV_MAJOR 23 139static struct cdevsw bpf_cdevsw = { 140 /* open */ bpfopen, 141 /* close */ bpfclose, 142 /* read */ bpfread, 143 /* write */ bpfwrite, 144 /* ioctl */ bpfioctl, 145 /* poll */ bpfpoll, 146 /* mmap */ nommap, 147 /* strategy */ nostrategy, 148 /* name */ "bpf", 149 /* maj */ CDEV_MAJOR, 150 /* dump */ nodump, 151 /* psize */ nopsize, 152 /* flags */ 0, 153 /* bmaj */ -1 154}; 155 156 157static int 158bpf_movein(uio, linktype, mp, sockp, datlen) 159 register struct uio *uio; 160 int linktype, *datlen; 161 register struct mbuf **mp; 162 register struct sockaddr *sockp; 163{ 164 struct mbuf *m; 165 int error; 166 int len; 167 int hlen; 168 169 /* 170 * Build a sockaddr based on the data link layer type. 171 * We do this at this level because the ethernet header 172 * is copied directly into the data field of the sockaddr. 173 * In the case of SLIP, there is no header and the packet 174 * is forwarded as is. 175 * Also, we are careful to leave room at the front of the mbuf 176 * for the link level header. 177 */ 178 switch (linktype) { 179 180 case DLT_SLIP: 181 sockp->sa_family = AF_INET; 182 hlen = 0; 183 break; 184 185 case DLT_EN10MB: 186 sockp->sa_family = AF_UNSPEC; 187 /* XXX Would MAXLINKHDR be better? */ 188 hlen = sizeof(struct ether_header); 189 break; 190 191 case DLT_FDDI: 192#if defined(__FreeBSD__) || defined(__bsdi__) 193 sockp->sa_family = AF_IMPLINK; 194 hlen = 0; 195#else 196 sockp->sa_family = AF_UNSPEC; 197 /* XXX 4(FORMAC)+6(dst)+6(src)+3(LLC)+5(SNAP) */ 198 hlen = 24; 199#endif 200 break; 201 202 case DLT_RAW: 203 case DLT_NULL: 204 sockp->sa_family = AF_UNSPEC; 205 hlen = 0; 206 break; 207 208#ifdef __FreeBSD__ 209 case DLT_ATM_RFC1483: 210 /* 211 * en atm driver requires 4-byte atm pseudo header. 212 * though it isn't standard, vpi:vci needs to be 213 * specified anyway. 214 */ 215 sockp->sa_family = AF_UNSPEC; 216 hlen = 12; /* XXX 4(ATM_PH) + 3(LLC) + 5(SNAP) */ 217 break; 218#endif 219 220 case DLT_PPP: 221 sockp->sa_family = AF_UNSPEC; 222 hlen = 4; /* This should match PPP_HDRLEN */ 223 break; 224 225 default: 226 return (EIO); 227 } 228 229 len = uio->uio_resid; 230 *datlen = len - hlen; 231 if ((unsigned)len > MCLBYTES) 232 return (EIO); 233 234 MGETHDR(m, M_WAIT, MT_DATA); 235 if (m == 0) 236 return (ENOBUFS); 237 if (len > MHLEN) { 238#if BSD >= 199103 239 MCLGET(m, M_WAIT); 240 if ((m->m_flags & M_EXT) == 0) { 241#else 242 MCLGET(m); 243 if (m->m_len != MCLBYTES) { 244#endif 245 error = ENOBUFS; 246 goto bad; 247 } 248 } 249 m->m_pkthdr.len = m->m_len = len; 250 m->m_pkthdr.rcvif = NULL; 251 *mp = m; 252 /* 253 * Make room for link header. 254 */ 255 if (hlen != 0) { 256 m->m_pkthdr.len -= hlen; 257 m->m_len -= hlen; 258#if BSD >= 199103 259 m->m_data += hlen; /* XXX */ 260#else 261 m->m_off += hlen; 262#endif 263 error = UIOMOVE((caddr_t)sockp->sa_data, hlen, UIO_WRITE, uio); 264 if (error) 265 goto bad; 266 } 267 error = UIOMOVE(mtod(m, caddr_t), len - hlen, UIO_WRITE, uio); 268 if (!error) 269 return (0); 270 bad: 271 m_freem(m); 272 return (error); 273} 274 275/* 276 * Attach file to the bpf interface, i.e. make d listen on bp. 277 * Must be called at splimp. 278 */ 279static void 280bpf_attachd(d, bp) 281 struct bpf_d *d; 282 struct bpf_if *bp; 283{ 284 /* 285 * Point d at bp, and add d to the interface's list of listeners. 286 * Finally, point the driver's bpf cookie at the interface so 287 * it will divert packets to bpf. 288 */ 289 d->bd_bif = bp; 290 d->bd_next = bp->bif_dlist; 291 bp->bif_dlist = d; 292 293 bp->bif_ifp->if_bpf = bp; 294} 295 296/* 297 * Detach a file from its interface. 298 */ 299static void 300bpf_detachd(d) 301 struct bpf_d *d; 302{ 303 int error; 304 struct bpf_d **p; 305 struct bpf_if *bp; 306 307 bp = d->bd_bif; 308 /* 309 * Check if this descriptor had requested promiscuous mode. 310 * If so, turn it off. 311 */ 312 if (d->bd_promisc) { 313 d->bd_promisc = 0; 314 error = ifpromisc(bp->bif_ifp, 0); 315 if (error != 0 && error != ENXIO) { 316 /* 317 * ENXIO can happen if a pccard is unplugged 318 * Something is really wrong if we were able to put 319 * the driver into promiscuous mode, but can't 320 * take it out. 321 */ 322 printf("%s%d: ifpromisc failed %d\n", 323 bp->bif_ifp->if_name, bp->bif_ifp->if_unit, error); 324 } 325 } 326 /* Remove d from the interface's descriptor list. */ 327 p = &bp->bif_dlist; 328 while (*p != d) { 329 p = &(*p)->bd_next; 330 if (*p == 0) 331 panic("bpf_detachd: descriptor not in list"); 332 } 333 *p = (*p)->bd_next; 334 if (bp->bif_dlist == 0) 335 /* 336 * Let the driver know that there are no more listeners. 337 */ 338 d->bd_bif->bif_ifp->if_bpf = 0; 339 d->bd_bif = 0; 340} 341 342/* 343 * Open ethernet device. Returns ENXIO for illegal minor device number, 344 * EBUSY if file is open by another process. 345 */ 346/* ARGSUSED */ 347static int 348bpfopen(dev, flags, fmt, p) 349 dev_t dev; 350 int flags; 351 int fmt; 352 struct proc *p; 353{ 354 register struct bpf_d *d; 355 356 if (p->p_prison) 357 return (EPERM); 358 359 d = dev->si_drv1; 360 /* 361 * Each minor can be opened by only one process. If the requested 362 * minor is in use, return EBUSY. 363 */ 364 if (d) 365 return (EBUSY);
|
367 MALLOC(d, struct bpf_d *, sizeof(*d), M_BPF, M_WAITOK); 368 bzero(d, sizeof(*d)); 369 dev->si_drv1 = d; 370 d->bd_bufsize = bpf_bufsize; 371 d->bd_sig = SIGIO; 372 d->bd_seesent = 1; 373 374 return (0); 375} 376 377/* 378 * Close the descriptor by detaching it from its interface, 379 * deallocating its buffers, and marking it free. 380 */ 381/* ARGSUSED */ 382static int 383bpfclose(dev, flags, fmt, p) 384 dev_t dev; 385 int flags; 386 int fmt; 387 struct proc *p; 388{ 389 register struct bpf_d *d = dev->si_drv1; 390 register int s; 391 392 funsetown(d->bd_sigio); 393 s = splimp(); 394 if (d->bd_bif) 395 bpf_detachd(d); 396 splx(s); 397 bpf_freed(d); 398 dev->si_drv1 = 0; 399 FREE(d, M_BPF); 400 401 return (0); 402} 403 404/* 405 * Support for SunOS, which does not have tsleep. 406 */ 407#if BSD < 199103 408static 409bpf_timeout(arg) 410 caddr_t arg; 411{ 412 struct bpf_d *d = (struct bpf_d *)arg; 413 d->bd_timedout = 1; 414 wakeup(arg); 415} 416 417#define BPF_SLEEP(chan, pri, s, t) bpf_sleep((struct bpf_d *)chan) 418 419int 420bpf_sleep(d) 421 register struct bpf_d *d; 422{ 423 register int rto = d->bd_rtout; 424 register int st; 425 426 if (rto != 0) { 427 d->bd_timedout = 0; 428 timeout(bpf_timeout, (caddr_t)d, rto); 429 } 430 st = sleep((caddr_t)d, PRINET|PCATCH); 431 if (rto != 0) { 432 if (d->bd_timedout == 0) 433 untimeout(bpf_timeout, (caddr_t)d); 434 else if (st == 0) 435 return EWOULDBLOCK; 436 } 437 return (st != 0) ? EINTR : 0; 438} 439#else 440#define BPF_SLEEP tsleep 441#endif 442 443/* 444 * Rotate the packet buffers in descriptor d. Move the store buffer 445 * into the hold slot, and the free buffer into the store slot. 446 * Zero the length of the new store buffer. 447 */ 448#define ROTATE_BUFFERS(d) \ 449 (d)->bd_hbuf = (d)->bd_sbuf; \ 450 (d)->bd_hlen = (d)->bd_slen; \ 451 (d)->bd_sbuf = (d)->bd_fbuf; \ 452 (d)->bd_slen = 0; \ 453 (d)->bd_fbuf = 0; 454/* 455 * bpfread - read next chunk of packets from buffers 456 */ 457static int 458bpfread(dev, uio, ioflag) 459 dev_t dev; 460 register struct uio *uio; 461 int ioflag; 462{ 463 register struct bpf_d *d = dev->si_drv1; 464 int error; 465 int s; 466 467 /* 468 * Restrict application to use a buffer the same size as 469 * as kernel buffers. 470 */ 471 if (uio->uio_resid != d->bd_bufsize) 472 return (EINVAL); 473 474 s = splimp(); 475 /* 476 * If the hold buffer is empty, then do a timed sleep, which 477 * ends when the timeout expires or when enough packets 478 * have arrived to fill the store buffer. 479 */ 480 while (d->bd_hbuf == 0) { 481 if (d->bd_immediate && d->bd_slen != 0) { 482 /* 483 * A packet(s) either arrived since the previous 484 * read or arrived while we were asleep. 485 * Rotate the buffers and return what's here. 486 */ 487 ROTATE_BUFFERS(d); 488 break; 489 } 490 491 /* 492 * No data is available, check to see if the bpf device 493 * is still pointed at a real interface. If not, return 494 * ENXIO so that the userland process knows to rebind 495 * it before using it again. 496 */ 497 if (d->bd_bif == NULL) { 498 splx(s); 499 return (ENXIO); 500 } 501 502 if (ioflag & IO_NDELAY) 503 error = EWOULDBLOCK; 504 else 505 error = BPF_SLEEP((caddr_t)d, PRINET|PCATCH, "bpf", 506 d->bd_rtout); 507 if (error == EINTR || error == ERESTART) { 508 splx(s); 509 return (error); 510 } 511 if (error == EWOULDBLOCK) { 512 /* 513 * On a timeout, return what's in the buffer, 514 * which may be nothing. If there is something 515 * in the store buffer, we can rotate the buffers. 516 */ 517 if (d->bd_hbuf) 518 /* 519 * We filled up the buffer in between 520 * getting the timeout and arriving 521 * here, so we don't need to rotate. 522 */ 523 break; 524 525 if (d->bd_slen == 0) { 526 splx(s); 527 return (0); 528 } 529 ROTATE_BUFFERS(d); 530 break; 531 } 532 } 533 /* 534 * At this point, we know we have something in the hold slot. 535 */ 536 splx(s); 537 538 /* 539 * Move data from hold buffer into user space. 540 * We know the entire buffer is transferred since 541 * we checked above that the read buffer is bpf_bufsize bytes. 542 */ 543 error = UIOMOVE(d->bd_hbuf, d->bd_hlen, UIO_READ, uio); 544 545 s = splimp(); 546 d->bd_fbuf = d->bd_hbuf; 547 d->bd_hbuf = 0; 548 d->bd_hlen = 0; 549 splx(s); 550 551 return (error); 552} 553 554 555/* 556 * If there are processes sleeping on this descriptor, wake them up. 557 */ 558static inline void 559bpf_wakeup(d) 560 register struct bpf_d *d; 561{ 562 wakeup((caddr_t)d); 563 if (d->bd_async && d->bd_sig && d->bd_sigio) 564 pgsigio(d->bd_sigio, d->bd_sig, 0); 565 566#if BSD >= 199103 567 selwakeup(&d->bd_sel); 568 /* XXX */ 569 d->bd_sel.si_pid = 0; 570#else 571 if (d->bd_selproc) { 572 selwakeup(d->bd_selproc, (int)d->bd_selcoll); 573 d->bd_selcoll = 0; 574 d->bd_selproc = 0; 575 } 576#endif 577} 578 579static int 580bpfwrite(dev, uio, ioflag) 581 dev_t dev; 582 struct uio *uio; 583 int ioflag; 584{ 585 register struct bpf_d *d = dev->si_drv1; 586 struct ifnet *ifp; 587 struct mbuf *m; 588 int error, s; 589 static struct sockaddr dst; 590 int datlen; 591 592 if (d->bd_bif == 0) 593 return (ENXIO); 594 595 ifp = d->bd_bif->bif_ifp; 596 597 if (uio->uio_resid == 0) 598 return (0); 599 600 error = bpf_movein(uio, (int)d->bd_bif->bif_dlt, &m, &dst, &datlen); 601 if (error) 602 return (error); 603 604 if (datlen > ifp->if_mtu) 605 return (EMSGSIZE); 606 607 if (d->bd_hdrcmplt) 608 dst.sa_family = pseudo_AF_HDRCMPLT; 609 610 s = splnet(); 611#if BSD >= 199103 612 error = (*ifp->if_output)(ifp, m, &dst, (struct rtentry *)0); 613#else 614 error = (*ifp->if_output)(ifp, m, &dst); 615#endif 616 splx(s); 617 /* 618 * The driver frees the mbuf. 619 */ 620 return (error); 621} 622 623/* 624 * Reset a descriptor by flushing its packet buffer and clearing the 625 * receive and drop counts. Should be called at splimp. 626 */ 627static void 628reset_d(d) 629 struct bpf_d *d; 630{ 631 if (d->bd_hbuf) { 632 /* Free the hold buffer. */ 633 d->bd_fbuf = d->bd_hbuf; 634 d->bd_hbuf = 0; 635 } 636 d->bd_slen = 0; 637 d->bd_hlen = 0; 638 d->bd_rcount = 0; 639 d->bd_dcount = 0; 640} 641 642/* 643 * FIONREAD Check for read packet available. 644 * SIOCGIFADDR Get interface address - convenient hook to driver. 645 * BIOCGBLEN Get buffer len [for read()]. 646 * BIOCSETF Set ethernet read filter. 647 * BIOCFLUSH Flush read packet buffer. 648 * BIOCPROMISC Put interface into promiscuous mode. 649 * BIOCGDLT Get link layer type. 650 * BIOCGETIF Get interface name. 651 * BIOCSETIF Set interface. 652 * BIOCSRTIMEOUT Set read timeout. 653 * BIOCGRTIMEOUT Get read timeout. 654 * BIOCGSTATS Get packet stats. 655 * BIOCIMMEDIATE Set immediate mode. 656 * BIOCVERSION Get filter language version. 657 * BIOCGHDRCMPLT Get "header already complete" flag 658 * BIOCSHDRCMPLT Set "header already complete" flag 659 * BIOCGSEESENT Get "see packets sent" flag 660 * BIOCSSEESENT Set "see packets sent" flag 661 */ 662/* ARGSUSED */ 663static int 664bpfioctl(dev, cmd, addr, flags, p) 665 dev_t dev; 666 u_long cmd; 667 caddr_t addr; 668 int flags; 669 struct proc *p; 670{ 671 register struct bpf_d *d = dev->si_drv1; 672 int s, error = 0; 673 674 switch (cmd) { 675 676 default: 677 error = EINVAL; 678 break; 679 680 /* 681 * Check for read packet available. 682 */ 683 case FIONREAD: 684 { 685 int n; 686 687 s = splimp(); 688 n = d->bd_slen; 689 if (d->bd_hbuf) 690 n += d->bd_hlen; 691 splx(s); 692 693 *(int *)addr = n; 694 break; 695 } 696 697 case SIOCGIFADDR: 698 { 699 struct ifnet *ifp; 700 701 if (d->bd_bif == 0) 702 error = EINVAL; 703 else { 704 ifp = d->bd_bif->bif_ifp; 705 error = (*ifp->if_ioctl)(ifp, cmd, addr); 706 } 707 break; 708 } 709 710 /* 711 * Get buffer len [for read()]. 712 */ 713 case BIOCGBLEN: 714 *(u_int *)addr = d->bd_bufsize; 715 break; 716 717 /* 718 * Set buffer length. 719 */ 720 case BIOCSBLEN: 721#if BSD < 199103 722 error = EINVAL; 723#else 724 if (d->bd_bif != 0) 725 error = EINVAL; 726 else { 727 register u_int size = *(u_int *)addr; 728 729 if (size > bpf_maxbufsize) 730 *(u_int *)addr = size = bpf_maxbufsize; 731 else if (size < BPF_MINBUFSIZE) 732 *(u_int *)addr = size = BPF_MINBUFSIZE; 733 d->bd_bufsize = size; 734 } 735#endif 736 break; 737 738 /* 739 * Set link layer read filter. 740 */ 741 case BIOCSETF: 742 error = bpf_setf(d, (struct bpf_program *)addr); 743 break; 744 745 /* 746 * Flush read packet buffer. 747 */ 748 case BIOCFLUSH: 749 s = splimp(); 750 reset_d(d); 751 splx(s); 752 break; 753 754 /* 755 * Put interface into promiscuous mode. 756 */ 757 case BIOCPROMISC: 758 if (d->bd_bif == 0) { 759 /* 760 * No interface attached yet. 761 */ 762 error = EINVAL; 763 break; 764 } 765 s = splimp(); 766 if (d->bd_promisc == 0) { 767 error = ifpromisc(d->bd_bif->bif_ifp, 1); 768 if (error == 0) 769 d->bd_promisc = 1; 770 } 771 splx(s); 772 break; 773 774 /* 775 * Get device parameters. 776 */ 777 case BIOCGDLT: 778 if (d->bd_bif == 0) 779 error = EINVAL; 780 else 781 *(u_int *)addr = d->bd_bif->bif_dlt; 782 break; 783 784 /* 785 * Get interface name. 786 */ 787 case BIOCGETIF: 788 if (d->bd_bif == 0) 789 error = EINVAL; 790 else { 791 struct ifnet *const ifp = d->bd_bif->bif_ifp; 792 struct ifreq *const ifr = (struct ifreq *)addr; 793 794 snprintf(ifr->ifr_name, sizeof(ifr->ifr_name), 795 "%s%d", ifp->if_name, ifp->if_unit); 796 } 797 break; 798 799 /* 800 * Set interface. 801 */ 802 case BIOCSETIF: 803 error = bpf_setif(d, (struct ifreq *)addr); 804 break; 805 806 /* 807 * Set read timeout. 808 */ 809 case BIOCSRTIMEOUT: 810 { 811 struct timeval *tv = (struct timeval *)addr; 812 813 /* 814 * Subtract 1 tick from tvtohz() since this isn't 815 * a one-shot timer. 816 */ 817 if ((error = itimerfix(tv)) == 0) 818 d->bd_rtout = tvtohz(tv) - 1; 819 break; 820 } 821 822 /* 823 * Get read timeout. 824 */ 825 case BIOCGRTIMEOUT: 826 { 827 struct timeval *tv = (struct timeval *)addr; 828 829 tv->tv_sec = d->bd_rtout / hz; 830 tv->tv_usec = (d->bd_rtout % hz) * tick; 831 break; 832 } 833 834 /* 835 * Get packet stats. 836 */ 837 case BIOCGSTATS: 838 { 839 struct bpf_stat *bs = (struct bpf_stat *)addr; 840 841 bs->bs_recv = d->bd_rcount; 842 bs->bs_drop = d->bd_dcount; 843 break; 844 } 845 846 /* 847 * Set immediate mode. 848 */ 849 case BIOCIMMEDIATE: 850 d->bd_immediate = *(u_int *)addr; 851 break; 852 853 case BIOCVERSION: 854 { 855 struct bpf_version *bv = (struct bpf_version *)addr; 856 857 bv->bv_major = BPF_MAJOR_VERSION; 858 bv->bv_minor = BPF_MINOR_VERSION; 859 break; 860 } 861 862 /* 863 * Get "header already complete" flag 864 */ 865 case BIOCGHDRCMPLT: 866 *(u_int *)addr = d->bd_hdrcmplt; 867 break; 868 869 /* 870 * Set "header already complete" flag 871 */ 872 case BIOCSHDRCMPLT: 873 d->bd_hdrcmplt = *(u_int *)addr ? 1 : 0; 874 break; 875 876 /* 877 * Get "see sent packets" flag 878 */ 879 case BIOCGSEESENT: 880 *(u_int *)addr = d->bd_seesent; 881 break; 882 883 /* 884 * Set "see sent packets" flag 885 */ 886 case BIOCSSEESENT: 887 d->bd_seesent = *(u_int *)addr; 888 break; 889 890 case FIONBIO: /* Non-blocking I/O */ 891 break; 892 893 case FIOASYNC: /* Send signal on receive packets */ 894 d->bd_async = *(int *)addr; 895 break; 896 897 case FIOSETOWN: 898 error = fsetown(*(int *)addr, &d->bd_sigio); 899 break; 900 901 case FIOGETOWN: 902 *(int *)addr = fgetown(d->bd_sigio); 903 break; 904 905 /* This is deprecated, FIOSETOWN should be used instead. */ 906 case TIOCSPGRP: 907 error = fsetown(-(*(int *)addr), &d->bd_sigio); 908 break; 909 910 /* This is deprecated, FIOGETOWN should be used instead. */ 911 case TIOCGPGRP: 912 *(int *)addr = -fgetown(d->bd_sigio); 913 break; 914 915 case BIOCSRSIG: /* Set receive signal */ 916 { 917 u_int sig; 918 919 sig = *(u_int *)addr; 920 921 if (sig >= NSIG) 922 error = EINVAL; 923 else 924 d->bd_sig = sig; 925 break; 926 } 927 case BIOCGRSIG: 928 *(u_int *)addr = d->bd_sig; 929 break; 930 } 931 return (error); 932} 933 934/* 935 * Set d's packet filter program to fp. If this file already has a filter, 936 * free it and replace it. Returns EINVAL for bogus requests. 937 */ 938static int 939bpf_setf(d, fp) 940 struct bpf_d *d; 941 struct bpf_program *fp; 942{ 943 struct bpf_insn *fcode, *old; 944 u_int flen, size; 945 int s; 946 947 old = d->bd_filter; 948 if (fp->bf_insns == 0) { 949 if (fp->bf_len != 0) 950 return (EINVAL); 951 s = splimp(); 952 d->bd_filter = 0; 953 reset_d(d); 954 splx(s); 955 if (old != 0) 956 free((caddr_t)old, M_BPF); 957 return (0); 958 } 959 flen = fp->bf_len; 960 if (flen > BPF_MAXINSNS) 961 return (EINVAL); 962 963 size = flen * sizeof(*fp->bf_insns); 964 fcode = (struct bpf_insn *)malloc(size, M_BPF, M_WAITOK); 965 if (copyin((caddr_t)fp->bf_insns, (caddr_t)fcode, size) == 0 && 966 bpf_validate(fcode, (int)flen)) { 967 s = splimp(); 968 d->bd_filter = fcode; 969 reset_d(d); 970 splx(s); 971 if (old != 0) 972 free((caddr_t)old, M_BPF); 973 974 return (0); 975 } 976 free((caddr_t)fcode, M_BPF); 977 return (EINVAL); 978} 979 980/* 981 * Detach a file from its current interface (if attached at all) and attach 982 * to the interface indicated by the name stored in ifr. 983 * Return an errno or 0. 984 */ 985static int 986bpf_setif(d, ifr) 987 struct bpf_d *d; 988 struct ifreq *ifr; 989{ 990 struct bpf_if *bp; 991 int s, error; 992 struct ifnet *theywant; 993 994 theywant = ifunit(ifr->ifr_name); 995 if (theywant == 0) 996 return ENXIO; 997 998 /* 999 * Look through attached interfaces for the named one. 1000 */ 1001 for (bp = bpf_iflist; bp != 0; bp = bp->bif_next) { 1002 struct ifnet *ifp = bp->bif_ifp; 1003 1004 if (ifp == 0 || ifp != theywant) 1005 continue; 1006 /* 1007 * We found the requested interface. 1008 * If it's not up, return an error. 1009 * Allocate the packet buffers if we need to. 1010 * If we're already attached to requested interface, 1011 * just flush the buffer. 1012 */ 1013 if ((ifp->if_flags & IFF_UP) == 0) 1014 return (ENETDOWN); 1015 1016 if (d->bd_sbuf == 0) { 1017 error = bpf_allocbufs(d); 1018 if (error != 0) 1019 return (error); 1020 } 1021 s = splimp(); 1022 if (bp != d->bd_bif) { 1023 if (d->bd_bif) 1024 /* 1025 * Detach if attached to something else. 1026 */ 1027 bpf_detachd(d); 1028 1029 bpf_attachd(d, bp); 1030 } 1031 reset_d(d); 1032 splx(s); 1033 return (0); 1034 } 1035 /* Not found. */ 1036 return (ENXIO); 1037} 1038 1039/* 1040 * Support for select() and poll() system calls 1041 * 1042 * Return true iff the specific operation will not block indefinitely. 1043 * Otherwise, return false but make a note that a selwakeup() must be done. 1044 */ 1045int 1046bpfpoll(dev, events, p) 1047 register dev_t dev; 1048 int events; 1049 struct proc *p; 1050{ 1051 register struct bpf_d *d; 1052 register int s; 1053 int revents = 0; 1054 1055 /* 1056 * An imitation of the FIONREAD ioctl code. 1057 */ 1058 d = dev->si_drv1; 1059 1060 if (d->bd_bif == NULL) 1061 return (ENXIO); 1062 1063 s = splimp(); 1064 if (events & (POLLIN | POLLRDNORM)) { 1065 if (d->bd_hlen != 0 || (d->bd_immediate && d->bd_slen != 0)) 1066 revents |= events & (POLLIN | POLLRDNORM); 1067 else 1068 selrecord(p, &d->bd_sel); 1069 } 1070 splx(s); 1071 return (revents); 1072} 1073 1074/* 1075 * Incoming linkage from device drivers. Process the packet pkt, of length 1076 * pktlen, which is stored in a contiguous buffer. The packet is parsed 1077 * by each process' filter, and if accepted, stashed into the corresponding 1078 * buffer. 1079 */ 1080void 1081bpf_tap(ifp, pkt, pktlen) 1082 struct ifnet *ifp; 1083 register u_char *pkt; 1084 register u_int pktlen; 1085{ 1086 struct bpf_if *bp; 1087 register struct bpf_d *d; 1088 register u_int slen; 1089 /* 1090 * Note that the ipl does not have to be raised at this point. 1091 * The only problem that could arise here is that if two different 1092 * interfaces shared any data. This is not the case. 1093 */ 1094 bp = ifp->if_bpf; 1095 for (d = bp->bif_dlist; d != 0; d = d->bd_next) { 1096 ++d->bd_rcount; 1097 slen = bpf_filter(d->bd_filter, pkt, pktlen, pktlen); 1098 if (slen != 0) 1099 catchpacket(d, pkt, pktlen, slen, bcopy); 1100 } 1101} 1102 1103/* 1104 * Copy data from an mbuf chain into a buffer. This code is derived 1105 * from m_copydata in sys/uipc_mbuf.c. 1106 */ 1107static void 1108bpf_mcopy(src_arg, dst_arg, len) 1109 const void *src_arg; 1110 void *dst_arg; 1111 register size_t len; 1112{ 1113 register const struct mbuf *m; 1114 register u_int count; 1115 u_char *dst; 1116 1117 m = src_arg; 1118 dst = dst_arg; 1119 while (len > 0) { 1120 if (m == 0) 1121 panic("bpf_mcopy"); 1122 count = min(m->m_len, len); 1123 bcopy(mtod(m, void *), dst, count); 1124 m = m->m_next; 1125 dst += count; 1126 len -= count; 1127 } 1128} 1129 1130/* 1131 * Incoming linkage from device drivers, when packet is in an mbuf chain. 1132 */ 1133void 1134bpf_mtap(ifp, m) 1135 struct ifnet *ifp; 1136 struct mbuf *m; 1137{ 1138 struct bpf_if *bp = ifp->if_bpf; 1139 struct bpf_d *d; 1140 u_int pktlen, slen; 1141 struct mbuf *m0; 1142 1143 pktlen = 0; 1144 for (m0 = m; m0 != 0; m0 = m0->m_next) 1145 pktlen += m0->m_len; 1146 1147 for (d = bp->bif_dlist; d != 0; d = d->bd_next) { 1148 if (!d->bd_seesent && (m->m_pkthdr.rcvif == NULL)) 1149 continue; 1150 ++d->bd_rcount; 1151 slen = bpf_filter(d->bd_filter, (u_char *)m, pktlen, 0); 1152 if (slen != 0) 1153 catchpacket(d, (u_char *)m, pktlen, slen, bpf_mcopy); 1154 } 1155} 1156 1157/* 1158 * Move the packet data from interface memory (pkt) into the 1159 * store buffer. Return 1 if it's time to wakeup a listener (buffer full), 1160 * otherwise 0. "copy" is the routine called to do the actual data 1161 * transfer. bcopy is passed in to copy contiguous chunks, while 1162 * bpf_mcopy is passed in to copy mbuf chains. In the latter case, 1163 * pkt is really an mbuf. 1164 */ 1165static void 1166catchpacket(d, pkt, pktlen, snaplen, cpfn) 1167 register struct bpf_d *d; 1168 register u_char *pkt; 1169 register u_int pktlen, snaplen; 1170 register void (*cpfn) __P((const void *, void *, size_t)); 1171{ 1172 register struct bpf_hdr *hp; 1173 register int totlen, curlen; 1174 register int hdrlen = d->bd_bif->bif_hdrlen; 1175 /* 1176 * Figure out how many bytes to move. If the packet is 1177 * greater or equal to the snapshot length, transfer that 1178 * much. Otherwise, transfer the whole packet (unless 1179 * we hit the buffer size limit). 1180 */ 1181 totlen = hdrlen + min(snaplen, pktlen); 1182 if (totlen > d->bd_bufsize) 1183 totlen = d->bd_bufsize; 1184 1185 /* 1186 * Round up the end of the previous packet to the next longword. 1187 */ 1188 curlen = BPF_WORDALIGN(d->bd_slen); 1189 if (curlen + totlen > d->bd_bufsize) { 1190 /* 1191 * This packet will overflow the storage buffer. 1192 * Rotate the buffers if we can, then wakeup any 1193 * pending reads. 1194 */ 1195 if (d->bd_fbuf == 0) { 1196 /* 1197 * We haven't completed the previous read yet, 1198 * so drop the packet. 1199 */ 1200 ++d->bd_dcount; 1201 return; 1202 } 1203 ROTATE_BUFFERS(d); 1204 bpf_wakeup(d); 1205 curlen = 0; 1206 } 1207 else if (d->bd_immediate) 1208 /* 1209 * Immediate mode is set. A packet arrived so any 1210 * reads should be woken up. 1211 */ 1212 bpf_wakeup(d); 1213 1214 /* 1215 * Append the bpf header. 1216 */ 1217 hp = (struct bpf_hdr *)(d->bd_sbuf + curlen); 1218#if BSD >= 199103 1219 microtime(&hp->bh_tstamp); 1220#elif defined(sun) 1221 uniqtime(&hp->bh_tstamp); 1222#else 1223 hp->bh_tstamp = time; 1224#endif 1225 hp->bh_datalen = pktlen; 1226 hp->bh_hdrlen = hdrlen; 1227 /* 1228 * Copy the packet data into the store buffer and update its length. 1229 */ 1230 (*cpfn)(pkt, (u_char *)hp + hdrlen, (hp->bh_caplen = totlen - hdrlen)); 1231 d->bd_slen = curlen + totlen; 1232} 1233 1234/* 1235 * Initialize all nonzero fields of a descriptor. 1236 */ 1237static int 1238bpf_allocbufs(d) 1239 register struct bpf_d *d; 1240{ 1241 d->bd_fbuf = (caddr_t)malloc(d->bd_bufsize, M_BPF, M_WAITOK); 1242 if (d->bd_fbuf == 0) 1243 return (ENOBUFS); 1244 1245 d->bd_sbuf = (caddr_t)malloc(d->bd_bufsize, M_BPF, M_WAITOK); 1246 if (d->bd_sbuf == 0) { 1247 free(d->bd_fbuf, M_BPF); 1248 return (ENOBUFS); 1249 } 1250 d->bd_slen = 0; 1251 d->bd_hlen = 0; 1252 return (0); 1253} 1254 1255/* 1256 * Free buffers currently in use by a descriptor. 1257 * Called on close. 1258 */ 1259static void 1260bpf_freed(d) 1261 register struct bpf_d *d; 1262{ 1263 /* 1264 * We don't need to lock out interrupts since this descriptor has 1265 * been detached from its interface and it yet hasn't been marked 1266 * free. 1267 */ 1268 if (d->bd_sbuf != 0) { 1269 free(d->bd_sbuf, M_BPF); 1270 if (d->bd_hbuf != 0) 1271 free(d->bd_hbuf, M_BPF); 1272 if (d->bd_fbuf != 0) 1273 free(d->bd_fbuf, M_BPF); 1274 } 1275 if (d->bd_filter) 1276 free((caddr_t)d->bd_filter, M_BPF); 1277} 1278 1279/* 1280 * Attach an interface to bpf. driverp is a pointer to a (struct bpf_if *) 1281 * in the driver's softc; dlt is the link layer type; hdrlen is the fixed 1282 * size of the link header (variable length headers not yet supported). 1283 */ 1284void 1285bpfattach(ifp, dlt, hdrlen) 1286 struct ifnet *ifp; 1287 u_int dlt, hdrlen; 1288{ 1289 struct bpf_if *bp; 1290 bp = (struct bpf_if *)malloc(sizeof(*bp), M_BPF, M_DONTWAIT); 1291 if (bp == 0) 1292 panic("bpfattach"); 1293 1294 bp->bif_dlist = 0; 1295 bp->bif_ifp = ifp; 1296 bp->bif_dlt = dlt; 1297 1298 bp->bif_next = bpf_iflist; 1299 bpf_iflist = bp; 1300 1301 bp->bif_ifp->if_bpf = 0; 1302 1303 /* 1304 * Compute the length of the bpf header. This is not necessarily 1305 * equal to SIZEOF_BPF_HDR because we want to insert spacing such 1306 * that the network layer header begins on a longword boundary (for 1307 * performance reasons and to alleviate alignment restrictions). 1308 */ 1309 bp->bif_hdrlen = BPF_WORDALIGN(hdrlen + SIZEOF_BPF_HDR) - hdrlen; 1310 1311 if (bootverbose) 1312 printf("bpf: %s%d attached\n", ifp->if_name, ifp->if_unit); 1313} 1314 1315/* 1316 * Detach bpf from an interface. This involves detaching each descriptor 1317 * associated with the interface, and leaving bd_bif NULL. Notify each 1318 * descriptor as it's detached so that any sleepers wake up and get 1319 * ENXIO. 1320 */ 1321void 1322bpfdetach(ifp) 1323 struct ifnet *ifp; 1324{ 1325 struct bpf_if *bp, *bp_prev; 1326 struct bpf_d *d; 1327 int s; 1328 1329 s = splimp(); 1330 1331 /* Locate BPF interface information */ 1332 bp_prev = NULL; 1333 for (bp = bpf_iflist; bp != NULL; bp = bp->bif_next) { 1334 if (ifp == bp->bif_ifp) 1335 break; 1336 bp_prev = bp; 1337 } 1338 1339 /* Interface wasn't attached */ 1340 if (bp->bif_ifp == NULL) { 1341 splx(s); 1342 printf("bpfdetach: %s%d was not attached\n", ifp->if_name, 1343 ifp->if_unit); 1344 return; 1345 } 1346 1347 while ((d = bp->bif_dlist) != NULL) { 1348 bpf_detachd(d); 1349 bpf_wakeup(d); 1350 } 1351 1352 if (bp_prev) { 1353 bp_prev->bif_next = bp->bif_next; 1354 } else { 1355 bpf_iflist = bp->bif_next; 1356 } 1357 1358 free(bp, M_BPF); 1359 1360 splx(s); 1361} 1362 1363static void bpf_drvinit __P((void *unused)); 1364 1365static void bpf_clone __P((void *arg, char *name, int namelen, dev_t *dev)); 1366 1367static void 1368bpf_clone(arg, name, namelen, dev) 1369 void *arg; 1370 char *name; 1371 int namelen; 1372 dev_t *dev; 1373{ 1374 int u; 1375 1376 if (*dev != NODEV) 1377 return; 1378 if (dev_stdclone(name, NULL, "bpf", &u) != 1) 1379 return;
| 368 MALLOC(d, struct bpf_d *, sizeof(*d), M_BPF, M_WAITOK); 369 bzero(d, sizeof(*d)); 370 dev->si_drv1 = d; 371 d->bd_bufsize = bpf_bufsize; 372 d->bd_sig = SIGIO; 373 d->bd_seesent = 1; 374 375 return (0); 376} 377 378/* 379 * Close the descriptor by detaching it from its interface, 380 * deallocating its buffers, and marking it free. 381 */ 382/* ARGSUSED */ 383static int 384bpfclose(dev, flags, fmt, p) 385 dev_t dev; 386 int flags; 387 int fmt; 388 struct proc *p; 389{ 390 register struct bpf_d *d = dev->si_drv1; 391 register int s; 392 393 funsetown(d->bd_sigio); 394 s = splimp(); 395 if (d->bd_bif) 396 bpf_detachd(d); 397 splx(s); 398 bpf_freed(d); 399 dev->si_drv1 = 0; 400 FREE(d, M_BPF); 401 402 return (0); 403} 404 405/* 406 * Support for SunOS, which does not have tsleep. 407 */ 408#if BSD < 199103 409static 410bpf_timeout(arg) 411 caddr_t arg; 412{ 413 struct bpf_d *d = (struct bpf_d *)arg; 414 d->bd_timedout = 1; 415 wakeup(arg); 416} 417 418#define BPF_SLEEP(chan, pri, s, t) bpf_sleep((struct bpf_d *)chan) 419 420int 421bpf_sleep(d) 422 register struct bpf_d *d; 423{ 424 register int rto = d->bd_rtout; 425 register int st; 426 427 if (rto != 0) { 428 d->bd_timedout = 0; 429 timeout(bpf_timeout, (caddr_t)d, rto); 430 } 431 st = sleep((caddr_t)d, PRINET|PCATCH); 432 if (rto != 0) { 433 if (d->bd_timedout == 0) 434 untimeout(bpf_timeout, (caddr_t)d); 435 else if (st == 0) 436 return EWOULDBLOCK; 437 } 438 return (st != 0) ? EINTR : 0; 439} 440#else 441#define BPF_SLEEP tsleep 442#endif 443 444/* 445 * Rotate the packet buffers in descriptor d. Move the store buffer 446 * into the hold slot, and the free buffer into the store slot. 447 * Zero the length of the new store buffer. 448 */ 449#define ROTATE_BUFFERS(d) \ 450 (d)->bd_hbuf = (d)->bd_sbuf; \ 451 (d)->bd_hlen = (d)->bd_slen; \ 452 (d)->bd_sbuf = (d)->bd_fbuf; \ 453 (d)->bd_slen = 0; \ 454 (d)->bd_fbuf = 0; 455/* 456 * bpfread - read next chunk of packets from buffers 457 */ 458static int 459bpfread(dev, uio, ioflag) 460 dev_t dev; 461 register struct uio *uio; 462 int ioflag; 463{ 464 register struct bpf_d *d = dev->si_drv1; 465 int error; 466 int s; 467 468 /* 469 * Restrict application to use a buffer the same size as 470 * as kernel buffers. 471 */ 472 if (uio->uio_resid != d->bd_bufsize) 473 return (EINVAL); 474 475 s = splimp(); 476 /* 477 * If the hold buffer is empty, then do a timed sleep, which 478 * ends when the timeout expires or when enough packets 479 * have arrived to fill the store buffer. 480 */ 481 while (d->bd_hbuf == 0) { 482 if (d->bd_immediate && d->bd_slen != 0) { 483 /* 484 * A packet(s) either arrived since the previous 485 * read or arrived while we were asleep. 486 * Rotate the buffers and return what's here. 487 */ 488 ROTATE_BUFFERS(d); 489 break; 490 } 491 492 /* 493 * No data is available, check to see if the bpf device 494 * is still pointed at a real interface. If not, return 495 * ENXIO so that the userland process knows to rebind 496 * it before using it again. 497 */ 498 if (d->bd_bif == NULL) { 499 splx(s); 500 return (ENXIO); 501 } 502 503 if (ioflag & IO_NDELAY) 504 error = EWOULDBLOCK; 505 else 506 error = BPF_SLEEP((caddr_t)d, PRINET|PCATCH, "bpf", 507 d->bd_rtout); 508 if (error == EINTR || error == ERESTART) { 509 splx(s); 510 return (error); 511 } 512 if (error == EWOULDBLOCK) { 513 /* 514 * On a timeout, return what's in the buffer, 515 * which may be nothing. If there is something 516 * in the store buffer, we can rotate the buffers. 517 */ 518 if (d->bd_hbuf) 519 /* 520 * We filled up the buffer in between 521 * getting the timeout and arriving 522 * here, so we don't need to rotate. 523 */ 524 break; 525 526 if (d->bd_slen == 0) { 527 splx(s); 528 return (0); 529 } 530 ROTATE_BUFFERS(d); 531 break; 532 } 533 } 534 /* 535 * At this point, we know we have something in the hold slot. 536 */ 537 splx(s); 538 539 /* 540 * Move data from hold buffer into user space. 541 * We know the entire buffer is transferred since 542 * we checked above that the read buffer is bpf_bufsize bytes. 543 */ 544 error = UIOMOVE(d->bd_hbuf, d->bd_hlen, UIO_READ, uio); 545 546 s = splimp(); 547 d->bd_fbuf = d->bd_hbuf; 548 d->bd_hbuf = 0; 549 d->bd_hlen = 0; 550 splx(s); 551 552 return (error); 553} 554 555 556/* 557 * If there are processes sleeping on this descriptor, wake them up. 558 */ 559static inline void 560bpf_wakeup(d) 561 register struct bpf_d *d; 562{ 563 wakeup((caddr_t)d); 564 if (d->bd_async && d->bd_sig && d->bd_sigio) 565 pgsigio(d->bd_sigio, d->bd_sig, 0); 566 567#if BSD >= 199103 568 selwakeup(&d->bd_sel); 569 /* XXX */ 570 d->bd_sel.si_pid = 0; 571#else 572 if (d->bd_selproc) { 573 selwakeup(d->bd_selproc, (int)d->bd_selcoll); 574 d->bd_selcoll = 0; 575 d->bd_selproc = 0; 576 } 577#endif 578} 579 580static int 581bpfwrite(dev, uio, ioflag) 582 dev_t dev; 583 struct uio *uio; 584 int ioflag; 585{ 586 register struct bpf_d *d = dev->si_drv1; 587 struct ifnet *ifp; 588 struct mbuf *m; 589 int error, s; 590 static struct sockaddr dst; 591 int datlen; 592 593 if (d->bd_bif == 0) 594 return (ENXIO); 595 596 ifp = d->bd_bif->bif_ifp; 597 598 if (uio->uio_resid == 0) 599 return (0); 600 601 error = bpf_movein(uio, (int)d->bd_bif->bif_dlt, &m, &dst, &datlen); 602 if (error) 603 return (error); 604 605 if (datlen > ifp->if_mtu) 606 return (EMSGSIZE); 607 608 if (d->bd_hdrcmplt) 609 dst.sa_family = pseudo_AF_HDRCMPLT; 610 611 s = splnet(); 612#if BSD >= 199103 613 error = (*ifp->if_output)(ifp, m, &dst, (struct rtentry *)0); 614#else 615 error = (*ifp->if_output)(ifp, m, &dst); 616#endif 617 splx(s); 618 /* 619 * The driver frees the mbuf. 620 */ 621 return (error); 622} 623 624/* 625 * Reset a descriptor by flushing its packet buffer and clearing the 626 * receive and drop counts. Should be called at splimp. 627 */ 628static void 629reset_d(d) 630 struct bpf_d *d; 631{ 632 if (d->bd_hbuf) { 633 /* Free the hold buffer. */ 634 d->bd_fbuf = d->bd_hbuf; 635 d->bd_hbuf = 0; 636 } 637 d->bd_slen = 0; 638 d->bd_hlen = 0; 639 d->bd_rcount = 0; 640 d->bd_dcount = 0; 641} 642 643/* 644 * FIONREAD Check for read packet available. 645 * SIOCGIFADDR Get interface address - convenient hook to driver. 646 * BIOCGBLEN Get buffer len [for read()]. 647 * BIOCSETF Set ethernet read filter. 648 * BIOCFLUSH Flush read packet buffer. 649 * BIOCPROMISC Put interface into promiscuous mode. 650 * BIOCGDLT Get link layer type. 651 * BIOCGETIF Get interface name. 652 * BIOCSETIF Set interface. 653 * BIOCSRTIMEOUT Set read timeout. 654 * BIOCGRTIMEOUT Get read timeout. 655 * BIOCGSTATS Get packet stats. 656 * BIOCIMMEDIATE Set immediate mode. 657 * BIOCVERSION Get filter language version. 658 * BIOCGHDRCMPLT Get "header already complete" flag 659 * BIOCSHDRCMPLT Set "header already complete" flag 660 * BIOCGSEESENT Get "see packets sent" flag 661 * BIOCSSEESENT Set "see packets sent" flag 662 */ 663/* ARGSUSED */ 664static int 665bpfioctl(dev, cmd, addr, flags, p) 666 dev_t dev; 667 u_long cmd; 668 caddr_t addr; 669 int flags; 670 struct proc *p; 671{ 672 register struct bpf_d *d = dev->si_drv1; 673 int s, error = 0; 674 675 switch (cmd) { 676 677 default: 678 error = EINVAL; 679 break; 680 681 /* 682 * Check for read packet available. 683 */ 684 case FIONREAD: 685 { 686 int n; 687 688 s = splimp(); 689 n = d->bd_slen; 690 if (d->bd_hbuf) 691 n += d->bd_hlen; 692 splx(s); 693 694 *(int *)addr = n; 695 break; 696 } 697 698 case SIOCGIFADDR: 699 { 700 struct ifnet *ifp; 701 702 if (d->bd_bif == 0) 703 error = EINVAL; 704 else { 705 ifp = d->bd_bif->bif_ifp; 706 error = (*ifp->if_ioctl)(ifp, cmd, addr); 707 } 708 break; 709 } 710 711 /* 712 * Get buffer len [for read()]. 713 */ 714 case BIOCGBLEN: 715 *(u_int *)addr = d->bd_bufsize; 716 break; 717 718 /* 719 * Set buffer length. 720 */ 721 case BIOCSBLEN: 722#if BSD < 199103 723 error = EINVAL; 724#else 725 if (d->bd_bif != 0) 726 error = EINVAL; 727 else { 728 register u_int size = *(u_int *)addr; 729 730 if (size > bpf_maxbufsize) 731 *(u_int *)addr = size = bpf_maxbufsize; 732 else if (size < BPF_MINBUFSIZE) 733 *(u_int *)addr = size = BPF_MINBUFSIZE; 734 d->bd_bufsize = size; 735 } 736#endif 737 break; 738 739 /* 740 * Set link layer read filter. 741 */ 742 case BIOCSETF: 743 error = bpf_setf(d, (struct bpf_program *)addr); 744 break; 745 746 /* 747 * Flush read packet buffer. 748 */ 749 case BIOCFLUSH: 750 s = splimp(); 751 reset_d(d); 752 splx(s); 753 break; 754 755 /* 756 * Put interface into promiscuous mode. 757 */ 758 case BIOCPROMISC: 759 if (d->bd_bif == 0) { 760 /* 761 * No interface attached yet. 762 */ 763 error = EINVAL; 764 break; 765 } 766 s = splimp(); 767 if (d->bd_promisc == 0) { 768 error = ifpromisc(d->bd_bif->bif_ifp, 1); 769 if (error == 0) 770 d->bd_promisc = 1; 771 } 772 splx(s); 773 break; 774 775 /* 776 * Get device parameters. 777 */ 778 case BIOCGDLT: 779 if (d->bd_bif == 0) 780 error = EINVAL; 781 else 782 *(u_int *)addr = d->bd_bif->bif_dlt; 783 break; 784 785 /* 786 * Get interface name. 787 */ 788 case BIOCGETIF: 789 if (d->bd_bif == 0) 790 error = EINVAL; 791 else { 792 struct ifnet *const ifp = d->bd_bif->bif_ifp; 793 struct ifreq *const ifr = (struct ifreq *)addr; 794 795 snprintf(ifr->ifr_name, sizeof(ifr->ifr_name), 796 "%s%d", ifp->if_name, ifp->if_unit); 797 } 798 break; 799 800 /* 801 * Set interface. 802 */ 803 case BIOCSETIF: 804 error = bpf_setif(d, (struct ifreq *)addr); 805 break; 806 807 /* 808 * Set read timeout. 809 */ 810 case BIOCSRTIMEOUT: 811 { 812 struct timeval *tv = (struct timeval *)addr; 813 814 /* 815 * Subtract 1 tick from tvtohz() since this isn't 816 * a one-shot timer. 817 */ 818 if ((error = itimerfix(tv)) == 0) 819 d->bd_rtout = tvtohz(tv) - 1; 820 break; 821 } 822 823 /* 824 * Get read timeout. 825 */ 826 case BIOCGRTIMEOUT: 827 { 828 struct timeval *tv = (struct timeval *)addr; 829 830 tv->tv_sec = d->bd_rtout / hz; 831 tv->tv_usec = (d->bd_rtout % hz) * tick; 832 break; 833 } 834 835 /* 836 * Get packet stats. 837 */ 838 case BIOCGSTATS: 839 { 840 struct bpf_stat *bs = (struct bpf_stat *)addr; 841 842 bs->bs_recv = d->bd_rcount; 843 bs->bs_drop = d->bd_dcount; 844 break; 845 } 846 847 /* 848 * Set immediate mode. 849 */ 850 case BIOCIMMEDIATE: 851 d->bd_immediate = *(u_int *)addr; 852 break; 853 854 case BIOCVERSION: 855 { 856 struct bpf_version *bv = (struct bpf_version *)addr; 857 858 bv->bv_major = BPF_MAJOR_VERSION; 859 bv->bv_minor = BPF_MINOR_VERSION; 860 break; 861 } 862 863 /* 864 * Get "header already complete" flag 865 */ 866 case BIOCGHDRCMPLT: 867 *(u_int *)addr = d->bd_hdrcmplt; 868 break; 869 870 /* 871 * Set "header already complete" flag 872 */ 873 case BIOCSHDRCMPLT: 874 d->bd_hdrcmplt = *(u_int *)addr ? 1 : 0; 875 break; 876 877 /* 878 * Get "see sent packets" flag 879 */ 880 case BIOCGSEESENT: 881 *(u_int *)addr = d->bd_seesent; 882 break; 883 884 /* 885 * Set "see sent packets" flag 886 */ 887 case BIOCSSEESENT: 888 d->bd_seesent = *(u_int *)addr; 889 break; 890 891 case FIONBIO: /* Non-blocking I/O */ 892 break; 893 894 case FIOASYNC: /* Send signal on receive packets */ 895 d->bd_async = *(int *)addr; 896 break; 897 898 case FIOSETOWN: 899 error = fsetown(*(int *)addr, &d->bd_sigio); 900 break; 901 902 case FIOGETOWN: 903 *(int *)addr = fgetown(d->bd_sigio); 904 break; 905 906 /* This is deprecated, FIOSETOWN should be used instead. */ 907 case TIOCSPGRP: 908 error = fsetown(-(*(int *)addr), &d->bd_sigio); 909 break; 910 911 /* This is deprecated, FIOGETOWN should be used instead. */ 912 case TIOCGPGRP: 913 *(int *)addr = -fgetown(d->bd_sigio); 914 break; 915 916 case BIOCSRSIG: /* Set receive signal */ 917 { 918 u_int sig; 919 920 sig = *(u_int *)addr; 921 922 if (sig >= NSIG) 923 error = EINVAL; 924 else 925 d->bd_sig = sig; 926 break; 927 } 928 case BIOCGRSIG: 929 *(u_int *)addr = d->bd_sig; 930 break; 931 } 932 return (error); 933} 934 935/* 936 * Set d's packet filter program to fp. If this file already has a filter, 937 * free it and replace it. Returns EINVAL for bogus requests. 938 */ 939static int 940bpf_setf(d, fp) 941 struct bpf_d *d; 942 struct bpf_program *fp; 943{ 944 struct bpf_insn *fcode, *old; 945 u_int flen, size; 946 int s; 947 948 old = d->bd_filter; 949 if (fp->bf_insns == 0) { 950 if (fp->bf_len != 0) 951 return (EINVAL); 952 s = splimp(); 953 d->bd_filter = 0; 954 reset_d(d); 955 splx(s); 956 if (old != 0) 957 free((caddr_t)old, M_BPF); 958 return (0); 959 } 960 flen = fp->bf_len; 961 if (flen > BPF_MAXINSNS) 962 return (EINVAL); 963 964 size = flen * sizeof(*fp->bf_insns); 965 fcode = (struct bpf_insn *)malloc(size, M_BPF, M_WAITOK); 966 if (copyin((caddr_t)fp->bf_insns, (caddr_t)fcode, size) == 0 && 967 bpf_validate(fcode, (int)flen)) { 968 s = splimp(); 969 d->bd_filter = fcode; 970 reset_d(d); 971 splx(s); 972 if (old != 0) 973 free((caddr_t)old, M_BPF); 974 975 return (0); 976 } 977 free((caddr_t)fcode, M_BPF); 978 return (EINVAL); 979} 980 981/* 982 * Detach a file from its current interface (if attached at all) and attach 983 * to the interface indicated by the name stored in ifr. 984 * Return an errno or 0. 985 */ 986static int 987bpf_setif(d, ifr) 988 struct bpf_d *d; 989 struct ifreq *ifr; 990{ 991 struct bpf_if *bp; 992 int s, error; 993 struct ifnet *theywant; 994 995 theywant = ifunit(ifr->ifr_name); 996 if (theywant == 0) 997 return ENXIO; 998 999 /* 1000 * Look through attached interfaces for the named one. 1001 */ 1002 for (bp = bpf_iflist; bp != 0; bp = bp->bif_next) { 1003 struct ifnet *ifp = bp->bif_ifp; 1004 1005 if (ifp == 0 || ifp != theywant) 1006 continue; 1007 /* 1008 * We found the requested interface. 1009 * If it's not up, return an error. 1010 * Allocate the packet buffers if we need to. 1011 * If we're already attached to requested interface, 1012 * just flush the buffer. 1013 */ 1014 if ((ifp->if_flags & IFF_UP) == 0) 1015 return (ENETDOWN); 1016 1017 if (d->bd_sbuf == 0) { 1018 error = bpf_allocbufs(d); 1019 if (error != 0) 1020 return (error); 1021 } 1022 s = splimp(); 1023 if (bp != d->bd_bif) { 1024 if (d->bd_bif) 1025 /* 1026 * Detach if attached to something else. 1027 */ 1028 bpf_detachd(d); 1029 1030 bpf_attachd(d, bp); 1031 } 1032 reset_d(d); 1033 splx(s); 1034 return (0); 1035 } 1036 /* Not found. */ 1037 return (ENXIO); 1038} 1039 1040/* 1041 * Support for select() and poll() system calls 1042 * 1043 * Return true iff the specific operation will not block indefinitely. 1044 * Otherwise, return false but make a note that a selwakeup() must be done. 1045 */ 1046int 1047bpfpoll(dev, events, p) 1048 register dev_t dev; 1049 int events; 1050 struct proc *p; 1051{ 1052 register struct bpf_d *d; 1053 register int s; 1054 int revents = 0; 1055 1056 /* 1057 * An imitation of the FIONREAD ioctl code. 1058 */ 1059 d = dev->si_drv1; 1060 1061 if (d->bd_bif == NULL) 1062 return (ENXIO); 1063 1064 s = splimp(); 1065 if (events & (POLLIN | POLLRDNORM)) { 1066 if (d->bd_hlen != 0 || (d->bd_immediate && d->bd_slen != 0)) 1067 revents |= events & (POLLIN | POLLRDNORM); 1068 else 1069 selrecord(p, &d->bd_sel); 1070 } 1071 splx(s); 1072 return (revents); 1073} 1074 1075/* 1076 * Incoming linkage from device drivers. Process the packet pkt, of length 1077 * pktlen, which is stored in a contiguous buffer. The packet is parsed 1078 * by each process' filter, and if accepted, stashed into the corresponding 1079 * buffer. 1080 */ 1081void 1082bpf_tap(ifp, pkt, pktlen) 1083 struct ifnet *ifp; 1084 register u_char *pkt; 1085 register u_int pktlen; 1086{ 1087 struct bpf_if *bp; 1088 register struct bpf_d *d; 1089 register u_int slen; 1090 /* 1091 * Note that the ipl does not have to be raised at this point. 1092 * The only problem that could arise here is that if two different 1093 * interfaces shared any data. This is not the case. 1094 */ 1095 bp = ifp->if_bpf; 1096 for (d = bp->bif_dlist; d != 0; d = d->bd_next) { 1097 ++d->bd_rcount; 1098 slen = bpf_filter(d->bd_filter, pkt, pktlen, pktlen); 1099 if (slen != 0) 1100 catchpacket(d, pkt, pktlen, slen, bcopy); 1101 } 1102} 1103 1104/* 1105 * Copy data from an mbuf chain into a buffer. This code is derived 1106 * from m_copydata in sys/uipc_mbuf.c. 1107 */ 1108static void 1109bpf_mcopy(src_arg, dst_arg, len) 1110 const void *src_arg; 1111 void *dst_arg; 1112 register size_t len; 1113{ 1114 register const struct mbuf *m; 1115 register u_int count; 1116 u_char *dst; 1117 1118 m = src_arg; 1119 dst = dst_arg; 1120 while (len > 0) { 1121 if (m == 0) 1122 panic("bpf_mcopy"); 1123 count = min(m->m_len, len); 1124 bcopy(mtod(m, void *), dst, count); 1125 m = m->m_next; 1126 dst += count; 1127 len -= count; 1128 } 1129} 1130 1131/* 1132 * Incoming linkage from device drivers, when packet is in an mbuf chain. 1133 */ 1134void 1135bpf_mtap(ifp, m) 1136 struct ifnet *ifp; 1137 struct mbuf *m; 1138{ 1139 struct bpf_if *bp = ifp->if_bpf; 1140 struct bpf_d *d; 1141 u_int pktlen, slen; 1142 struct mbuf *m0; 1143 1144 pktlen = 0; 1145 for (m0 = m; m0 != 0; m0 = m0->m_next) 1146 pktlen += m0->m_len; 1147 1148 for (d = bp->bif_dlist; d != 0; d = d->bd_next) { 1149 if (!d->bd_seesent && (m->m_pkthdr.rcvif == NULL)) 1150 continue; 1151 ++d->bd_rcount; 1152 slen = bpf_filter(d->bd_filter, (u_char *)m, pktlen, 0); 1153 if (slen != 0) 1154 catchpacket(d, (u_char *)m, pktlen, slen, bpf_mcopy); 1155 } 1156} 1157 1158/* 1159 * Move the packet data from interface memory (pkt) into the 1160 * store buffer. Return 1 if it's time to wakeup a listener (buffer full), 1161 * otherwise 0. "copy" is the routine called to do the actual data 1162 * transfer. bcopy is passed in to copy contiguous chunks, while 1163 * bpf_mcopy is passed in to copy mbuf chains. In the latter case, 1164 * pkt is really an mbuf. 1165 */ 1166static void 1167catchpacket(d, pkt, pktlen, snaplen, cpfn) 1168 register struct bpf_d *d; 1169 register u_char *pkt; 1170 register u_int pktlen, snaplen; 1171 register void (*cpfn) __P((const void *, void *, size_t)); 1172{ 1173 register struct bpf_hdr *hp; 1174 register int totlen, curlen; 1175 register int hdrlen = d->bd_bif->bif_hdrlen; 1176 /* 1177 * Figure out how many bytes to move. If the packet is 1178 * greater or equal to the snapshot length, transfer that 1179 * much. Otherwise, transfer the whole packet (unless 1180 * we hit the buffer size limit). 1181 */ 1182 totlen = hdrlen + min(snaplen, pktlen); 1183 if (totlen > d->bd_bufsize) 1184 totlen = d->bd_bufsize; 1185 1186 /* 1187 * Round up the end of the previous packet to the next longword. 1188 */ 1189 curlen = BPF_WORDALIGN(d->bd_slen); 1190 if (curlen + totlen > d->bd_bufsize) { 1191 /* 1192 * This packet will overflow the storage buffer. 1193 * Rotate the buffers if we can, then wakeup any 1194 * pending reads. 1195 */ 1196 if (d->bd_fbuf == 0) { 1197 /* 1198 * We haven't completed the previous read yet, 1199 * so drop the packet. 1200 */ 1201 ++d->bd_dcount; 1202 return; 1203 } 1204 ROTATE_BUFFERS(d); 1205 bpf_wakeup(d); 1206 curlen = 0; 1207 } 1208 else if (d->bd_immediate) 1209 /* 1210 * Immediate mode is set. A packet arrived so any 1211 * reads should be woken up. 1212 */ 1213 bpf_wakeup(d); 1214 1215 /* 1216 * Append the bpf header. 1217 */ 1218 hp = (struct bpf_hdr *)(d->bd_sbuf + curlen); 1219#if BSD >= 199103 1220 microtime(&hp->bh_tstamp); 1221#elif defined(sun) 1222 uniqtime(&hp->bh_tstamp); 1223#else 1224 hp->bh_tstamp = time; 1225#endif 1226 hp->bh_datalen = pktlen; 1227 hp->bh_hdrlen = hdrlen; 1228 /* 1229 * Copy the packet data into the store buffer and update its length. 1230 */ 1231 (*cpfn)(pkt, (u_char *)hp + hdrlen, (hp->bh_caplen = totlen - hdrlen)); 1232 d->bd_slen = curlen + totlen; 1233} 1234 1235/* 1236 * Initialize all nonzero fields of a descriptor. 1237 */ 1238static int 1239bpf_allocbufs(d) 1240 register struct bpf_d *d; 1241{ 1242 d->bd_fbuf = (caddr_t)malloc(d->bd_bufsize, M_BPF, M_WAITOK); 1243 if (d->bd_fbuf == 0) 1244 return (ENOBUFS); 1245 1246 d->bd_sbuf = (caddr_t)malloc(d->bd_bufsize, M_BPF, M_WAITOK); 1247 if (d->bd_sbuf == 0) { 1248 free(d->bd_fbuf, M_BPF); 1249 return (ENOBUFS); 1250 } 1251 d->bd_slen = 0; 1252 d->bd_hlen = 0; 1253 return (0); 1254} 1255 1256/* 1257 * Free buffers currently in use by a descriptor. 1258 * Called on close. 1259 */ 1260static void 1261bpf_freed(d) 1262 register struct bpf_d *d; 1263{ 1264 /* 1265 * We don't need to lock out interrupts since this descriptor has 1266 * been detached from its interface and it yet hasn't been marked 1267 * free. 1268 */ 1269 if (d->bd_sbuf != 0) { 1270 free(d->bd_sbuf, M_BPF); 1271 if (d->bd_hbuf != 0) 1272 free(d->bd_hbuf, M_BPF); 1273 if (d->bd_fbuf != 0) 1274 free(d->bd_fbuf, M_BPF); 1275 } 1276 if (d->bd_filter) 1277 free((caddr_t)d->bd_filter, M_BPF); 1278} 1279 1280/* 1281 * Attach an interface to bpf. driverp is a pointer to a (struct bpf_if *) 1282 * in the driver's softc; dlt is the link layer type; hdrlen is the fixed 1283 * size of the link header (variable length headers not yet supported). 1284 */ 1285void 1286bpfattach(ifp, dlt, hdrlen) 1287 struct ifnet *ifp; 1288 u_int dlt, hdrlen; 1289{ 1290 struct bpf_if *bp; 1291 bp = (struct bpf_if *)malloc(sizeof(*bp), M_BPF, M_DONTWAIT); 1292 if (bp == 0) 1293 panic("bpfattach"); 1294 1295 bp->bif_dlist = 0; 1296 bp->bif_ifp = ifp; 1297 bp->bif_dlt = dlt; 1298 1299 bp->bif_next = bpf_iflist; 1300 bpf_iflist = bp; 1301 1302 bp->bif_ifp->if_bpf = 0; 1303 1304 /* 1305 * Compute the length of the bpf header. This is not necessarily 1306 * equal to SIZEOF_BPF_HDR because we want to insert spacing such 1307 * that the network layer header begins on a longword boundary (for 1308 * performance reasons and to alleviate alignment restrictions). 1309 */ 1310 bp->bif_hdrlen = BPF_WORDALIGN(hdrlen + SIZEOF_BPF_HDR) - hdrlen; 1311 1312 if (bootverbose) 1313 printf("bpf: %s%d attached\n", ifp->if_name, ifp->if_unit); 1314} 1315 1316/* 1317 * Detach bpf from an interface. This involves detaching each descriptor 1318 * associated with the interface, and leaving bd_bif NULL. Notify each 1319 * descriptor as it's detached so that any sleepers wake up and get 1320 * ENXIO. 1321 */ 1322void 1323bpfdetach(ifp) 1324 struct ifnet *ifp; 1325{ 1326 struct bpf_if *bp, *bp_prev; 1327 struct bpf_d *d; 1328 int s; 1329 1330 s = splimp(); 1331 1332 /* Locate BPF interface information */ 1333 bp_prev = NULL; 1334 for (bp = bpf_iflist; bp != NULL; bp = bp->bif_next) { 1335 if (ifp == bp->bif_ifp) 1336 break; 1337 bp_prev = bp; 1338 } 1339 1340 /* Interface wasn't attached */ 1341 if (bp->bif_ifp == NULL) { 1342 splx(s); 1343 printf("bpfdetach: %s%d was not attached\n", ifp->if_name, 1344 ifp->if_unit); 1345 return; 1346 } 1347 1348 while ((d = bp->bif_dlist) != NULL) { 1349 bpf_detachd(d); 1350 bpf_wakeup(d); 1351 } 1352 1353 if (bp_prev) { 1354 bp_prev->bif_next = bp->bif_next; 1355 } else { 1356 bpf_iflist = bp->bif_next; 1357 } 1358 1359 free(bp, M_BPF); 1360 1361 splx(s); 1362} 1363 1364static void bpf_drvinit __P((void *unused)); 1365 1366static void bpf_clone __P((void *arg, char *name, int namelen, dev_t *dev)); 1367 1368static void 1369bpf_clone(arg, name, namelen, dev) 1370 void *arg; 1371 char *name; 1372 int namelen; 1373 dev_t *dev; 1374{ 1375 int u; 1376 1377 if (*dev != NODEV) 1378 return; 1379 if (dev_stdclone(name, NULL, "bpf", &u) != 1) 1380 return;
|