if_wtap.c revision 300060
1/*- 2 * Copyright (c) 2010-2011 Monthadar Al Jaberi, TerraNet AB 3 * All rights reserved. 4 * 5 * Copyright (c) 2002-2009 Sam Leffler, Errno Consulting 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 * without modification. 14 * 2. Redistributions in binary form must reproduce at minimum a disclaimer 15 * similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any 16 * redistribution must be conditioned upon including a substantially 17 * similar Disclaimer requirement for further binary redistribution. 18 * 19 * NO WARRANTY 20 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 21 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 22 * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY 23 * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL 24 * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, 25 * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 26 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 27 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER 28 * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 29 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 30 * THE POSSIBILITY OF SUCH DAMAGES. 31 * 32 * $FreeBSD: stable/10/sys/dev/wtap/if_wtap.c 300060 2016-05-17 15:18:01Z pfg $ 33 */ 34#include "if_wtapvar.h" 35#include <sys/uio.h> /* uio struct */ 36#include <sys/jail.h> 37#include <net/if_var.h> 38#include <net/vnet.h> 39 40#include <net80211/ieee80211_ratectl.h> 41#include "if_medium.h" 42 43/* 44 * This _requires_ vimage to be useful. 45 */ 46#ifndef VIMAGE 47#error if_wtap requires VIMAGE. 48#endif /* VIMAGE */ 49 50/* device for IOCTL and read/write for debuggin purposes */ 51/* Function prototypes */ 52static d_open_t wtap_node_open; 53static d_close_t wtap_node_close; 54static d_write_t wtap_node_write; 55static d_ioctl_t wtap_node_ioctl; 56 57static struct cdevsw wtap_cdevsw = { 58 .d_version = D_VERSION, 59 .d_flags = 0, 60 .d_open = wtap_node_open, 61 .d_close = wtap_node_close, 62 .d_write = wtap_node_write, 63 .d_ioctl = wtap_node_ioctl, 64 .d_name = "wtapnode", 65}; 66 67static int 68wtap_node_open(struct cdev *dev, int oflags, int devtype, struct thread *p) 69{ 70 71 int err = 0; 72 uprintf("Opened device \"echo\" successfully.\n"); 73 return(err); 74} 75 76static int 77wtap_node_close(struct cdev *dev, int fflag, int devtype, struct thread *p) 78{ 79 80 uprintf("Closing device \"echo.\"\n"); 81 return(0); 82} 83 84static int 85wtap_node_write(struct cdev *dev, struct uio *uio, int ioflag) 86{ 87 int err = 0; 88 struct mbuf *m; 89 struct ifnet *ifp; 90 struct wtap_softc *sc; 91 uint8_t buf[1024]; 92 int buf_len; 93 94 uprintf("write device %s \"echo.\"\n", devtoname(dev)); 95 buf_len = MIN(uio->uio_iov->iov_len, 1024); 96 err = copyin(uio->uio_iov->iov_base, buf, buf_len); 97 98 if (err != 0) { 99 uprintf("Write failed: bad address!\n"); 100 return (err); 101 } 102 103 MGETHDR(m, M_NOWAIT, MT_DATA); 104 m_copyback(m, 0, buf_len, buf); 105 106 CURVNET_SET(TD_TO_VNET(curthread)); 107 IFNET_RLOCK_NOSLEEP(); 108 109 TAILQ_FOREACH(ifp, &V_ifnet, if_link) { 110 printf("ifp->if_xname = %s\n", ifp->if_xname); 111 if(strcmp(devtoname(dev), ifp->if_xname) == 0){ 112 printf("found match, correspoding wtap = %s\n", 113 ifp->if_xname); 114 sc = (struct wtap_softc *)ifp->if_softc; 115 printf("wtap id = %d\n", sc->id); 116 wtap_inject(sc, m); 117 } 118 } 119 120 IFNET_RUNLOCK_NOSLEEP(); 121 CURVNET_RESTORE(); 122 123 return(err); 124} 125 126int 127wtap_node_ioctl(struct cdev *dev, u_long cmd, caddr_t data, 128 int fflag, struct thread *td) 129{ 130 int error = 0; 131 132 switch(cmd) { 133 default: 134 DWTAP_PRINTF("Unknown WTAP IOCTL\n"); 135 error = EINVAL; 136 } 137 return error; 138} 139 140static int wtap_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 141 const struct ieee80211_bpf_params *params); 142 143static int 144wtap_medium_enqueue(struct wtap_vap *avp, struct mbuf *m) 145{ 146 147 return medium_transmit(avp->av_md, avp->id, m); 148} 149 150static int 151wtap_media_change(struct ifnet *ifp) 152{ 153 154 DWTAP_PRINTF("%s\n", __func__); 155 int error = ieee80211_media_change(ifp); 156 /* NB: only the fixed rate can change and that doesn't need a reset */ 157 return (error == ENETRESET ? 0 : error); 158} 159 160/* 161 * Intercept management frames to collect beacon rssi data 162 * and to do ibss merges. 163 */ 164static void 165wtap_recv_mgmt(struct ieee80211_node *ni, struct mbuf *m, 166 int subtype, int rssi, int nf) 167{ 168 struct ieee80211vap *vap = ni->ni_vap; 169#if 0 170 DWTAP_PRINTF("[%d] %s\n", myath_id(ni), __func__); 171#endif 172 WTAP_VAP(vap)->av_recv_mgmt(ni, m, subtype, rssi, nf); 173} 174 175static int 176wtap_reset_vap(struct ieee80211vap *vap, u_long cmd) 177{ 178 179 DWTAP_PRINTF("%s\n", __func__); 180 return 0; 181} 182 183static void 184wtap_beacon_update(struct ieee80211vap *vap, int item) 185{ 186 struct ieee80211_beacon_offsets *bo = &WTAP_VAP(vap)->av_boff; 187 188 DWTAP_PRINTF("%s\n", __func__); 189 setbit(bo->bo_flags, item); 190} 191 192/* 193 * Allocate and setup an initial beacon frame. 194 */ 195static int 196wtap_beacon_alloc(struct wtap_softc *sc, struct ieee80211_node *ni) 197{ 198 struct ieee80211vap *vap = ni->ni_vap; 199 struct wtap_vap *avp = WTAP_VAP(vap); 200 201 DWTAP_PRINTF("[%s] %s\n", ether_sprintf(ni->ni_macaddr), __func__); 202 203 /* 204 * NB: the beacon data buffer must be 32-bit aligned; 205 * we assume the mbuf routines will return us something 206 * with this alignment (perhaps should assert). 207 */ 208 avp->beacon = ieee80211_beacon_alloc(ni, &avp->av_boff); 209 if (avp->beacon == NULL) { 210 printf("%s: cannot get mbuf\n", __func__); 211 return ENOMEM; 212 } 213 callout_init(&avp->av_swba, 0); 214 avp->bf_node = ieee80211_ref_node(ni); 215 216 return 0; 217} 218 219static void 220wtap_beacon_config(struct wtap_softc *sc, struct ieee80211vap *vap) 221{ 222 223 DWTAP_PRINTF("%s\n", __func__); 224} 225 226static void 227wtap_beacon_intrp(void *arg) 228{ 229 struct wtap_vap *avp = arg; 230 struct ieee80211vap *vap = arg; 231 struct mbuf *m; 232 233 if (vap->iv_state < IEEE80211_S_RUN) { 234 DWTAP_PRINTF("Skip beacon, not running, state %d", vap->iv_state); 235 return ; 236 } 237 DWTAP_PRINTF("[%d] beacon intrp\n", avp->id); //burst mode 238 /* 239 * Update dynamic beacon contents. If this returns 240 * non-zero then we need to remap the memory because 241 * the beacon frame changed size (probably because 242 * of the TIM bitmap). 243 */ 244 m = m_dup(avp->beacon, M_NOWAIT); 245 if (ieee80211_beacon_update(avp->bf_node, &avp->av_boff, m, 0)) { 246 printf("%s, need to remap the memory because the beacon frame" 247 " changed size.\n",__func__); 248 } 249 250 if (ieee80211_radiotap_active_vap(vap)) 251 ieee80211_radiotap_tx(vap, m); 252 253#if 0 254 medium_transmit(avp->av_md, avp->id, m); 255#endif 256 wtap_medium_enqueue(avp, m); 257 callout_schedule(&avp->av_swba, avp->av_bcinterval); 258} 259 260static int 261wtap_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg) 262{ 263 struct ieee80211com *ic = vap->iv_ic; 264 struct wtap_softc *sc = ic->ic_ifp->if_softc; 265 struct wtap_vap *avp = WTAP_VAP(vap); 266 struct ieee80211_node *ni = NULL; 267 int error; 268 269 DWTAP_PRINTF("%s\n", __func__); 270 271 ni = ieee80211_ref_node(vap->iv_bss); 272 /* 273 * Invoke the parent method to do net80211 work. 274 */ 275 error = avp->av_newstate(vap, nstate, arg); 276 if (error != 0) 277 goto bad; 278 279 if (nstate == IEEE80211_S_RUN) { 280 /* NB: collect bss node again, it may have changed */ 281 ieee80211_free_node(ni); 282 ni = ieee80211_ref_node(vap->iv_bss); 283 switch (vap->iv_opmode) { 284 case IEEE80211_M_MBSS: 285 error = wtap_beacon_alloc(sc, ni); 286 if (error != 0) 287 goto bad; 288 wtap_beacon_config(sc, vap); 289 callout_reset(&avp->av_swba, avp->av_bcinterval, 290 wtap_beacon_intrp, vap); 291 break; 292 default: 293 goto bad; 294 } 295 } else if (nstate == IEEE80211_S_INIT) { 296 callout_stop(&avp->av_swba); 297 } 298 ieee80211_free_node(ni); 299 return 0; 300bad: 301 printf("%s: bad\n", __func__); 302 ieee80211_free_node(ni); 303 return error; 304} 305 306static void 307wtap_bmiss(struct ieee80211vap *vap) 308{ 309 struct wtap_vap *avp = (struct wtap_vap *)vap; 310 311 DWTAP_PRINTF("%s\n", __func__); 312 avp->av_bmiss(vap); 313} 314 315static struct ieee80211vap * 316wtap_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ], 317 int unit, enum ieee80211_opmode opmode, int flags, 318 const uint8_t bssid[IEEE80211_ADDR_LEN], 319 const uint8_t mac[IEEE80211_ADDR_LEN]) 320{ 321 struct wtap_softc *sc = ic->ic_ifp->if_softc; 322 struct ieee80211vap *vap; 323 struct wtap_vap *avp; 324 int error; 325 struct ieee80211_node *ni; 326 327 DWTAP_PRINTF("%s\n", __func__); 328 329 avp = malloc(sizeof(struct wtap_vap), M_80211_VAP, M_NOWAIT | M_ZERO); 330 if (avp == NULL) 331 return (NULL); 332 avp->id = sc->id; 333 avp->av_md = sc->sc_md; 334 avp->av_bcinterval = msecs_to_ticks(BEACON_INTRERVAL + 100*sc->id); 335 vap = (struct ieee80211vap *) avp; 336 error = ieee80211_vap_setup(ic, vap, name, unit, IEEE80211_M_MBSS, 337 flags | IEEE80211_CLONE_NOBEACONS, bssid, mac); 338 if (error) { 339 free(avp, M_80211_VAP); 340 return (NULL); 341 } 342 343 /* override various methods */ 344 avp->av_recv_mgmt = vap->iv_recv_mgmt; 345 vap->iv_recv_mgmt = wtap_recv_mgmt; 346 vap->iv_reset = wtap_reset_vap; 347 vap->iv_update_beacon = wtap_beacon_update; 348 avp->av_newstate = vap->iv_newstate; 349 vap->iv_newstate = wtap_newstate; 350 avp->av_bmiss = vap->iv_bmiss; 351 vap->iv_bmiss = wtap_bmiss; 352 353 /* complete setup */ 354 ieee80211_vap_attach(vap, wtap_media_change, ieee80211_media_status); 355 avp->av_dev = make_dev(&wtap_cdevsw, 0, UID_ROOT, GID_WHEEL, 0600, 356 "%s", (const char *)ic->ic_ifp->if_xname); 357 358 /* TODO this is a hack to force it to choose the rate we want */ 359 ni = ieee80211_ref_node(vap->iv_bss); 360 ni->ni_txrate = 130; 361 ieee80211_free_node(ni); 362 return vap; 363} 364 365static void 366wtap_vap_delete(struct ieee80211vap *vap) 367{ 368 struct wtap_vap *avp = WTAP_VAP(vap); 369 370 DWTAP_PRINTF("%s\n", __func__); 371 destroy_dev(avp->av_dev); 372 callout_stop(&avp->av_swba); 373 ieee80211_vap_detach(vap); 374 free((struct wtap_vap*) vap, M_80211_VAP); 375} 376 377/* NB: This function is not used. 378 * I had the problem of the queue 379 * being empty all the time. 380 * Maybe I am setting the queue wrong? 381 */ 382static void 383wtap_start(struct ifnet *ifp) 384{ 385 struct ieee80211com *ic = ifp->if_l2com; 386 struct ifnet *icifp = ic->ic_ifp; 387 struct wtap_softc *sc = icifp->if_softc; 388 struct ieee80211_node *ni; 389 struct mbuf *m; 390 391 DWTAP_PRINTF("my_start, with id=%u\n", sc->id); 392 393 if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0 || sc->up == 0) 394 return; 395 for (;;) { 396 if(IFQ_IS_EMPTY(&ifp->if_snd)){ 397 printf("queue empty, just trying to see " 398 "if the other queue is empty\n"); 399#if 0 400 printf("queue for id=1, %u\n", 401 IFQ_IS_EMPTY(&global_mscs[1]->ifp->if_snd)); 402 printf("queue for id=0, %u\n", 403 IFQ_IS_EMPTY(&global_mscs[0]->ifp->if_snd)); 404#endif 405 break; 406 } 407 IFQ_DEQUEUE(&ifp->if_snd, m); 408 if (m == NULL) { 409 printf("error dequeueing from ifp->snd\n"); 410 break; 411 } 412 ni = (struct ieee80211_node *) m->m_pkthdr.rcvif; 413 /* 414 * Check for fragmentation. If this frame 415 * has been broken up verify we have enough 416 * buffers to send all the fragments so all 417 * go out or none... 418 */ 419#if 0 420 STAILQ_INIT(&frags); 421#endif 422 if ((m->m_flags & M_FRAG)){ 423 printf("dont support frags\n"); 424 ifp->if_oerrors++; 425 return; 426 } 427 ifp->if_opackets++; 428 if(wtap_raw_xmit(ni, m, NULL) < 0){ 429 printf("error raw_xmiting\n"); 430 ifp->if_oerrors++; 431 return; 432 } 433 } 434} 435 436static int 437wtap_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data) 438{ 439#if 0 440 DWTAP_PRINTF("%s\n", __func__); 441 uprintf("%s, command %lu\n", __func__, cmd); 442#endif 443#define IS_RUNNING(ifp) \ 444 ((ifp->if_flags & IFF_UP) && (ifp->if_drv_flags & IFF_DRV_RUNNING)) 445 struct ieee80211com *ic = ifp->if_l2com; 446 struct wtap_softc *sc = ifp->if_softc; 447 struct ifreq *ifr = (struct ifreq *)data; 448 int error = 0; 449 450 switch (cmd) { 451 case SIOCSIFFLAGS: 452 //printf("%s: %s\n", __func__, "SIOCSIFFLAGS"); 453 if (IS_RUNNING(ifp)) { 454 DWTAP_PRINTF("running\n"); 455#if 0 456 /* 457 * To avoid rescanning another access point, 458 * do not call ath_init() here. Instead, 459 * only reflect promisc mode settings. 460 */ 461 //ath_mode_init(sc); 462#endif 463 } else if (ifp->if_flags & IFF_UP) { 464 DWTAP_PRINTF("up\n"); 465 sc->up = 1; 466#if 0 467 /* 468 * Beware of being called during attach/detach 469 * to reset promiscuous mode. In that case we 470 * will still be marked UP but not RUNNING. 471 * However trying to re-init the interface 472 * is the wrong thing to do as we've already 473 * torn down much of our state. There's 474 * probably a better way to deal with this. 475 */ 476 //if (!sc->sc_invalid) 477 // ath_init(sc); /* XXX lose error */ 478#endif 479 ifp->if_drv_flags |= IFF_DRV_RUNNING; 480 ieee80211_start_all(ic); 481 } else { 482 DWTAP_PRINTF("stoping\n"); 483#if 0 484 ath_stop_locked(ifp); 485#ifdef notyet 486 /* XXX must wakeup in places like ath_vap_delete */ 487 if (!sc->sc_invalid) 488 ath_hal_setpower(sc->sc_ah, HAL_PM_FULL_SLEEP); 489#endif 490#endif 491 } 492 break; 493 case SIOCGIFMEDIA: 494 case SIOCSIFMEDIA: 495#if 0 496 DWTAP_PRINTF("%s: %s\n", __func__, "SIOCGIFMEDIA|SIOCSIFMEDIA"); 497#endif 498 error = ifmedia_ioctl(ifp, ifr, &ic->ic_media, cmd); 499 break; 500 case SIOCGIFADDR: 501#if 0 502 DWTAP_PRINTF("%s: %s\n", __func__, "SIOCGIFADDR"); 503#endif 504 error = ether_ioctl(ifp, cmd, data); 505 break; 506 default: 507 DWTAP_PRINTF("%s: %s [%lu]\n", __func__, "EINVAL", cmd); 508 error = EINVAL; 509 break; 510 } 511 return error; 512#undef IS_RUNNING 513} 514 515static void 516wtap_init(void *arg){ 517 518 DWTAP_PRINTF("%s\n", __func__); 519} 520 521static void 522wtap_scan_start(struct ieee80211com *ic) 523{ 524 525#if 0 526 DWTAP_PRINTF("%s\n", __func__); 527#endif 528} 529 530static void 531wtap_scan_end(struct ieee80211com *ic) 532{ 533 534#if 0 535 DWTAP_PRINTF("%s\n", __func__); 536#endif 537} 538 539static void 540wtap_set_channel(struct ieee80211com *ic) 541{ 542 543#if 0 544 DWTAP_PRINTF("%s\n", __func__); 545#endif 546} 547 548static int 549wtap_raw_xmit(struct ieee80211_node *ni, struct mbuf *m, 550 const struct ieee80211_bpf_params *params) 551{ 552#if 0 553 DWTAP_PRINTF("%s, %p\n", __func__, m); 554#endif 555 struct ieee80211vap *vap = ni->ni_vap; 556 struct wtap_vap *avp = WTAP_VAP(vap); 557 558 if (ieee80211_radiotap_active_vap(vap)) { 559 ieee80211_radiotap_tx(vap, m); 560 } 561 if (m->m_flags & M_TXCB) 562 ieee80211_process_callback(ni, m, 0); 563 ieee80211_free_node(ni); 564 return wtap_medium_enqueue(avp, m); 565} 566 567void 568wtap_inject(struct wtap_softc *sc, struct mbuf *m) 569{ 570 struct wtap_buf *bf = (struct wtap_buf *)malloc(sizeof(struct wtap_buf), 571 M_WTAP_RXBUF, M_NOWAIT | M_ZERO); 572 KASSERT(bf != NULL, ("could not allocated a new wtap_buf\n")); 573 bf->m = m; 574 575 mtx_lock(&sc->sc_mtx); 576 STAILQ_INSERT_TAIL(&sc->sc_rxbuf, bf, bf_list); 577 taskqueue_enqueue(sc->sc_tq, &sc->sc_rxtask); 578 mtx_unlock(&sc->sc_mtx); 579} 580 581void 582wtap_rx_deliver(struct wtap_softc *sc, struct mbuf *m) 583{ 584 struct ifnet *ifp = sc->sc_ifp; 585 struct ieee80211com *ic = ifp->if_l2com; 586 struct ieee80211_node *ni; 587 int type; 588#if 0 589 DWTAP_PRINTF("%s\n", __func__); 590#endif 591 592 DWTAP_PRINTF("[%d] receiving m=%p\n", sc->id, m); 593 if (m == NULL) { /* NB: shouldn't happen */ 594 if_printf(ifp, "%s: no mbuf!\n", __func__); 595 } 596 597 ifp->if_ipackets++; 598 599 ieee80211_dump_pkt(ic, mtod(m, caddr_t), 0,0,0); 600 601 /* 602 * Locate the node for sender, track state, and then 603 * pass the (referenced) node up to the 802.11 layer 604 * for its use. 605 */ 606 ni = ieee80211_find_rxnode_withkey(ic, 607 mtod(m, const struct ieee80211_frame_min *),IEEE80211_KEYIX_NONE); 608 if (ni != NULL) { 609 /* 610 * Sending station is known, dispatch directly. 611 */ 612 type = ieee80211_input(ni, m, 1<<7, 10); 613 ieee80211_free_node(ni); 614 } else { 615 type = ieee80211_input_all(ic, m, 1<<7, 10); 616 } 617} 618 619static void 620wtap_rx_proc(void *arg, int npending) 621{ 622 struct wtap_softc *sc = (struct wtap_softc *)arg; 623 struct ifnet *ifp = sc->sc_ifp; 624 struct ieee80211com *ic = ifp->if_l2com; 625 struct mbuf *m; 626 struct ieee80211_node *ni; 627 int type; 628 struct wtap_buf *bf; 629 630#if 0 631 DWTAP_PRINTF("%s\n", __func__); 632#endif 633 634 for(;;) { 635 mtx_lock(&sc->sc_mtx); 636 bf = STAILQ_FIRST(&sc->sc_rxbuf); 637 if (bf == NULL) { 638 mtx_unlock(&sc->sc_mtx); 639 return; 640 } 641 STAILQ_REMOVE_HEAD(&sc->sc_rxbuf, bf_list); 642 mtx_unlock(&sc->sc_mtx); 643 KASSERT(bf != NULL, ("wtap_buf is NULL\n")); 644 m = bf->m; 645 DWTAP_PRINTF("[%d] receiving m=%p\n", sc->id, bf->m); 646 if (m == NULL) { /* NB: shouldn't happen */ 647 if_printf(ifp, "%s: no mbuf!\n", __func__); 648 free(bf, M_WTAP_RXBUF); 649 return; 650 } 651 652 ifp->if_ipackets++; 653#if 0 654 ieee80211_dump_pkt(ic, mtod(m, caddr_t), 0,0,0); 655#endif 656 657 /* 658 * Locate the node for sender, track state, and then 659 * pass the (referenced) node up to the 802.11 layer 660 * for its use. 661 */ 662 ni = ieee80211_find_rxnode_withkey(ic, 663 mtod(m, const struct ieee80211_frame_min *), 664 IEEE80211_KEYIX_NONE); 665 if (ni != NULL) { 666 /* 667 * Sending station is known, dispatch directly. 668 */ 669#if 0 670 ieee80211_radiotap_rx(ni->ni_vap, m); 671#endif 672 type = ieee80211_input(ni, m, 1<<7, 10); 673 ieee80211_free_node(ni); 674 } else { 675#if 0 676 ieee80211_radiotap_rx_all(ic, m); 677#endif 678 type = ieee80211_input_all(ic, m, 1<<7, 10); 679 } 680 681 /* The mbufs are freed by the Net80211 stack */ 682 free(bf, M_WTAP_RXBUF); 683 } 684} 685 686static void 687wtap_newassoc(struct ieee80211_node *ni, int isnew) 688{ 689 690 DWTAP_PRINTF("%s\n", __func__); 691} 692 693/* 694 * Callback from the 802.11 layer to update WME parameters. 695 */ 696static int 697wtap_wme_update(struct ieee80211com *ic) 698{ 699 700 DWTAP_PRINTF("%s\n", __func__); 701 return 0; 702} 703 704static void 705wtap_update_mcast(struct ifnet *ifp) 706{ 707 708 DWTAP_PRINTF("%s\n", __func__); 709} 710 711static void 712wtap_update_promisc(struct ifnet *ifp) 713{ 714 715 DWTAP_PRINTF("%s\n", __func__); 716} 717 718static int 719wtap_if_transmit(struct ifnet *ifp, struct mbuf *m) 720{ 721 struct ieee80211_node *ni = 722 (struct ieee80211_node *) m->m_pkthdr.rcvif; 723 struct ieee80211vap *vap = ni->ni_vap; 724 struct wtap_vap *avp = WTAP_VAP(vap); 725 726 if(ni == NULL){ 727 printf("m->m_pkthdr.rcvif is NULL we cant radiotap_tx\n"); 728 }else{ 729 if (ieee80211_radiotap_active_vap(vap)) 730 ieee80211_radiotap_tx(vap, m); 731 } 732 if (m->m_flags & M_TXCB) 733 ieee80211_process_callback(ni, m, 0); 734 ieee80211_free_node(ni); 735 return wtap_medium_enqueue(avp, m); 736} 737 738static struct ieee80211_node * 739wtap_node_alloc(struct ieee80211vap *vap, const uint8_t mac[IEEE80211_ADDR_LEN]) 740{ 741 struct ieee80211_node *ni; 742 743 DWTAP_PRINTF("%s\n", __func__); 744 745 ni = malloc(sizeof(struct ieee80211_node), M_80211_NODE, 746 M_NOWAIT|M_ZERO); 747 748 ni->ni_txrate = 130; 749 return ni; 750} 751 752static void 753wtap_node_free(struct ieee80211_node *ni) 754{ 755 struct ieee80211com *ic = ni->ni_ic; 756 struct wtap_softc *sc = ic->ic_ifp->if_softc; 757 758 DWTAP_PRINTF("%s\n", __func__); 759 sc->sc_node_free(ni); 760} 761 762int32_t 763wtap_attach(struct wtap_softc *sc, const uint8_t *macaddr) 764{ 765 struct ifnet *ifp; 766 struct ieee80211com *ic; 767 char wtap_name[] = {'w','T','a','p',sc->id, 768 '_','t','a','s','k','q','\0'}; 769 770 DWTAP_PRINTF("%s\n", __func__); 771 772 ifp = if_alloc(IFT_IEEE80211); 773 if (ifp == NULL) { 774 printf("can not if_alloc()\n"); 775 return -1; 776 } 777 ic = ifp->if_l2com; 778 if_initname(ifp, "wtap", sc->id); 779 780 sc->sc_ifp = ifp; 781 sc->up = 0; 782 783 STAILQ_INIT(&sc->sc_rxbuf); 784 sc->sc_tq = taskqueue_create(wtap_name, M_NOWAIT | M_ZERO, 785 taskqueue_thread_enqueue, &sc->sc_tq); 786 taskqueue_start_threads(&sc->sc_tq, 1, PI_SOFT, "%s taskQ", 787 ifp->if_xname); 788 TASK_INIT(&sc->sc_rxtask, 0, wtap_rx_proc, sc); 789 790 ifp->if_softc = sc; 791 ifp->if_flags = IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST; 792 ifp->if_start = wtap_start; 793 ifp->if_ioctl = wtap_ioctl; 794 ifp->if_init = wtap_init; 795 IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); 796 ifp->if_snd.ifq_drv_maxlen = ifqmaxlen; 797 IFQ_SET_READY(&ifp->if_snd); 798 799 ic->ic_ifp = ifp; 800 ic->ic_phytype = IEEE80211_T_DS; 801 ic->ic_opmode = IEEE80211_M_MBSS; 802 ic->ic_caps = IEEE80211_C_MBSS; 803 804 ic->ic_max_keyix = 128; /* A value read from Atheros ATH_KEYMAX */ 805 806 ic->ic_regdomain.regdomain = SKU_ETSI; 807 ic->ic_regdomain.country = CTRY_SWEDEN; 808 ic->ic_regdomain.location = 1; /* Indoors */ 809 ic->ic_regdomain.isocc[0] = 'S'; 810 ic->ic_regdomain.isocc[1] = 'E'; 811 812 ic->ic_nchans = 1; 813 ic->ic_channels[0].ic_flags = IEEE80211_CHAN_B; 814 ic->ic_channels[0].ic_freq = 2412; 815 816 ieee80211_ifattach(ic, macaddr); 817 818#if 0 819 /* new prototype hook-ups */ 820 msc->if_input = ifp->if_input; 821 ifp->if_input = myath_if_input; 822 msc->if_output = ifp->if_output; 823 ifp->if_output = myath_if_output; 824#endif 825 sc->if_transmit = ifp->if_transmit; 826 ifp->if_transmit = wtap_if_transmit; 827 828 /* override default methods */ 829 ic->ic_newassoc = wtap_newassoc; 830#if 0 831 ic->ic_updateslot = myath_updateslot; 832#endif 833 ic->ic_wme.wme_update = wtap_wme_update; 834 ic->ic_vap_create = wtap_vap_create; 835 ic->ic_vap_delete = wtap_vap_delete; 836 ic->ic_raw_xmit = wtap_raw_xmit; 837 ic->ic_update_mcast = wtap_update_mcast; 838 ic->ic_update_promisc = wtap_update_promisc; 839 840 sc->sc_node_alloc = ic->ic_node_alloc; 841 ic->ic_node_alloc = wtap_node_alloc; 842 sc->sc_node_free = ic->ic_node_free; 843 ic->ic_node_free = wtap_node_free; 844 845#if 0 846 ic->ic_node_getsignal = myath_node_getsignal; 847#endif 848 ic->ic_scan_start = wtap_scan_start; 849 ic->ic_scan_end = wtap_scan_end; 850 ic->ic_set_channel = wtap_set_channel; 851 852 ieee80211_radiotap_attach(ic, 853 &sc->sc_tx_th.wt_ihdr, sizeof(sc->sc_tx_th), 854 WTAP_TX_RADIOTAP_PRESENT, 855 &sc->sc_rx_th.wr_ihdr, sizeof(sc->sc_rx_th), 856 WTAP_RX_RADIOTAP_PRESENT); 857 858 /* Work here, we must find a way to populate the rate table */ 859#if 0 860 if(ic->ic_rt == NULL){ 861 printf("no table for ic_curchan\n"); 862 ic->ic_rt = ieee80211_get_ratetable(&ic->ic_channels[0]); 863 } 864 printf("ic->ic_rt =%p\n", ic->ic_rt); 865 printf("rate count %d\n", ic->ic_rt->rateCount); 866 867 uint8_t code = ic->ic_rt->info[0].dot11Rate; 868 uint8_t cix = ic->ic_rt->info[0].ctlRateIndex; 869 uint8_t ctl_rate = ic->ic_rt->info[cix].dot11Rate; 870 printf("code=%d, cix=%d, ctl_rate=%d\n", code, cix, ctl_rate); 871 872 uint8_t rix0 = ic->ic_rt->rateCodeToIndex[130]; 873 uint8_t rix1 = ic->ic_rt->rateCodeToIndex[132]; 874 uint8_t rix2 = ic->ic_rt->rateCodeToIndex[139]; 875 uint8_t rix3 = ic->ic_rt->rateCodeToIndex[150]; 876 printf("rix0 %u,rix1 %u,rix2 %u,rix3 %u\n", rix0,rix1,rix2,rix3); 877 printf("lpAckDuration=%u\n", ic->ic_rt->info[0].lpAckDuration); 878 printf("rate=%d\n", ic->ic_rt->info[0].rateKbps); 879#endif 880 return 0; 881} 882 883int32_t 884wtap_detach(struct wtap_softc *sc) 885{ 886 struct ifnet *ifp = sc->sc_ifp; 887 struct ieee80211com *ic = ifp->if_l2com; 888 889 DWTAP_PRINTF("%s\n", __func__); 890 ieee80211_ageq_drain(&ic->ic_stageq); 891 ieee80211_ifdetach(ic); 892 if_free(ifp); 893 return 0; 894} 895 896void 897wtap_resume(struct wtap_softc *sc) 898{ 899 900 DWTAP_PRINTF("%s\n", __func__); 901} 902 903void 904wtap_suspend(struct wtap_softc *sc) 905{ 906 907 DWTAP_PRINTF("%s\n", __func__); 908} 909 910void 911wtap_shutdown(struct wtap_softc *sc) 912{ 913 914 DWTAP_PRINTF("%s\n", __func__); 915} 916 917void 918wtap_intr(struct wtap_softc *sc) 919{ 920 921 DWTAP_PRINTF("%s\n", __func__); 922} 923