main.c revision 59959a6150c8af737898e83f727e824dbed7b0fa
1/* 2 * Copyright 2002-2005, Instant802 Networks, Inc. 3 * Copyright 2005-2006, Devicescape Software, Inc. 4 * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz> 5 * 6 * This program is free software; you can redistribute it and/or modify 7 * it under the terms of the GNU General Public License version 2 as 8 * published by the Free Software Foundation. 9 */ 10 11#include <net/mac80211.h> 12#include <net/ieee80211_radiotap.h> 13#include <linux/module.h> 14#include <linux/init.h> 15#include <linux/netdevice.h> 16#include <linux/types.h> 17#include <linux/slab.h> 18#include <linux/skbuff.h> 19#include <linux/etherdevice.h> 20#include <linux/if_arp.h> 21#include <linux/wireless.h> 22#include <linux/rtnetlink.h> 23#include <linux/bitmap.h> 24#include <net/net_namespace.h> 25#include <net/cfg80211.h> 26 27#include "ieee80211_i.h" 28#include "rate.h" 29#include "mesh.h" 30#include "wep.h" 31#include "wme.h" 32#include "aes_ccm.h" 33#include "led.h" 34#include "cfg.h" 35#include "debugfs.h" 36#include "debugfs_netdev.h" 37 38/* 39 * For seeing transmitted packets on monitor interfaces 40 * we have a radiotap header too. 41 */ 42struct ieee80211_tx_status_rtap_hdr { 43 struct ieee80211_radiotap_header hdr; 44 __le16 tx_flags; 45 u8 data_retries; 46} __attribute__ ((packed)); 47 48/* common interface routines */ 49 50static int header_parse_80211(const struct sk_buff *skb, unsigned char *haddr) 51{ 52 memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN); /* addr2 */ 53 return ETH_ALEN; 54} 55 56/* must be called under mdev tx lock */ 57static void ieee80211_configure_filter(struct ieee80211_local *local) 58{ 59 unsigned int changed_flags; 60 unsigned int new_flags = 0; 61 62 if (atomic_read(&local->iff_promiscs)) 63 new_flags |= FIF_PROMISC_IN_BSS; 64 65 if (atomic_read(&local->iff_allmultis)) 66 new_flags |= FIF_ALLMULTI; 67 68 if (local->monitors) 69 new_flags |= FIF_BCN_PRBRESP_PROMISC; 70 71 if (local->fif_fcsfail) 72 new_flags |= FIF_FCSFAIL; 73 74 if (local->fif_plcpfail) 75 new_flags |= FIF_PLCPFAIL; 76 77 if (local->fif_control) 78 new_flags |= FIF_CONTROL; 79 80 if (local->fif_other_bss) 81 new_flags |= FIF_OTHER_BSS; 82 83 changed_flags = local->filter_flags ^ new_flags; 84 85 /* be a bit nasty */ 86 new_flags |= (1<<31); 87 88 local->ops->configure_filter(local_to_hw(local), 89 changed_flags, &new_flags, 90 local->mdev->mc_count, 91 local->mdev->mc_list); 92 93 WARN_ON(new_flags & (1<<31)); 94 95 local->filter_flags = new_flags & ~(1<<31); 96} 97 98/* master interface */ 99 100static int ieee80211_master_open(struct net_device *dev) 101{ 102 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); 103 struct ieee80211_sub_if_data *sdata; 104 int res = -EOPNOTSUPP; 105 106 /* we hold the RTNL here so can safely walk the list */ 107 list_for_each_entry(sdata, &local->interfaces, list) { 108 if (sdata->dev != dev && netif_running(sdata->dev)) { 109 res = 0; 110 break; 111 } 112 } 113 114 if (res) 115 return res; 116 117 netif_start_queue(local->mdev); 118 119 return 0; 120} 121 122static int ieee80211_master_stop(struct net_device *dev) 123{ 124 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); 125 struct ieee80211_sub_if_data *sdata; 126 127 /* we hold the RTNL here so can safely walk the list */ 128 list_for_each_entry(sdata, &local->interfaces, list) 129 if (sdata->dev != dev && netif_running(sdata->dev)) 130 dev_close(sdata->dev); 131 132 return 0; 133} 134 135static void ieee80211_master_set_multicast_list(struct net_device *dev) 136{ 137 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); 138 139 ieee80211_configure_filter(local); 140} 141 142/* regular interfaces */ 143 144static int ieee80211_change_mtu(struct net_device *dev, int new_mtu) 145{ 146 int meshhdrlen; 147 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 148 149 meshhdrlen = (sdata->vif.type == IEEE80211_IF_TYPE_MESH_POINT) ? 5 : 0; 150 151 /* FIX: what would be proper limits for MTU? 152 * This interface uses 802.3 frames. */ 153 if (new_mtu < 256 || 154 new_mtu > IEEE80211_MAX_DATA_LEN - 24 - 6 - meshhdrlen) { 155 printk(KERN_WARNING "%s: invalid MTU %d\n", 156 dev->name, new_mtu); 157 return -EINVAL; 158 } 159 160#ifdef CONFIG_MAC80211_VERBOSE_DEBUG 161 printk(KERN_DEBUG "%s: setting MTU %d\n", dev->name, new_mtu); 162#endif /* CONFIG_MAC80211_VERBOSE_DEBUG */ 163 dev->mtu = new_mtu; 164 return 0; 165} 166 167static inline int identical_mac_addr_allowed(int type1, int type2) 168{ 169 return (type1 == IEEE80211_IF_TYPE_MNTR || 170 type2 == IEEE80211_IF_TYPE_MNTR || 171 (type1 == IEEE80211_IF_TYPE_AP && 172 type2 == IEEE80211_IF_TYPE_WDS) || 173 (type1 == IEEE80211_IF_TYPE_WDS && 174 (type2 == IEEE80211_IF_TYPE_WDS || 175 type2 == IEEE80211_IF_TYPE_AP)) || 176 (type1 == IEEE80211_IF_TYPE_AP && 177 type2 == IEEE80211_IF_TYPE_VLAN) || 178 (type1 == IEEE80211_IF_TYPE_VLAN && 179 (type2 == IEEE80211_IF_TYPE_AP || 180 type2 == IEEE80211_IF_TYPE_VLAN))); 181} 182 183static int ieee80211_open(struct net_device *dev) 184{ 185 struct ieee80211_sub_if_data *sdata, *nsdata; 186 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); 187 struct ieee80211_if_init_conf conf; 188 int res; 189 bool need_hw_reconfig = 0; 190 struct sta_info *sta; 191 192 sdata = IEEE80211_DEV_TO_SUB_IF(dev); 193 194 /* we hold the RTNL here so can safely walk the list */ 195 list_for_each_entry(nsdata, &local->interfaces, list) { 196 struct net_device *ndev = nsdata->dev; 197 198 if (ndev != dev && ndev != local->mdev && netif_running(ndev)) { 199 /* 200 * Allow only a single IBSS interface to be up at any 201 * time. This is restricted because beacon distribution 202 * cannot work properly if both are in the same IBSS. 203 * 204 * To remove this restriction we'd have to disallow them 205 * from setting the same SSID on different IBSS interfaces 206 * belonging to the same hardware. Then, however, we're 207 * faced with having to adopt two different TSF timers... 208 */ 209 if (sdata->vif.type == IEEE80211_IF_TYPE_IBSS && 210 nsdata->vif.type == IEEE80211_IF_TYPE_IBSS) 211 return -EBUSY; 212 213 /* 214 * Disallow multiple IBSS/STA mode interfaces. 215 * 216 * This is a technical restriction, it is possible although 217 * most likely not IEEE 802.11 compliant to have multiple 218 * STAs with just a single hardware (the TSF timer will not 219 * be adjusted properly.) 220 * 221 * However, because mac80211 uses the master device's BSS 222 * information for each STA/IBSS interface, doing this will 223 * currently corrupt that BSS information completely, unless, 224 * a not very useful case, both STAs are associated to the 225 * same BSS. 226 * 227 * To remove this restriction, the BSS information needs to 228 * be embedded in the STA/IBSS mode sdata instead of using 229 * the master device's BSS structure. 230 */ 231 if ((sdata->vif.type == IEEE80211_IF_TYPE_STA || 232 sdata->vif.type == IEEE80211_IF_TYPE_IBSS) && 233 (nsdata->vif.type == IEEE80211_IF_TYPE_STA || 234 nsdata->vif.type == IEEE80211_IF_TYPE_IBSS)) 235 return -EBUSY; 236 237 /* 238 * The remaining checks are only performed for interfaces 239 * with the same MAC address. 240 */ 241 if (compare_ether_addr(dev->dev_addr, ndev->dev_addr)) 242 continue; 243 244 /* 245 * check whether it may have the same address 246 */ 247 if (!identical_mac_addr_allowed(sdata->vif.type, 248 nsdata->vif.type)) 249 return -ENOTUNIQ; 250 251 /* 252 * can only add VLANs to enabled APs 253 */ 254 if (sdata->vif.type == IEEE80211_IF_TYPE_VLAN && 255 nsdata->vif.type == IEEE80211_IF_TYPE_AP) 256 sdata->u.vlan.ap = nsdata; 257 } 258 } 259 260 switch (sdata->vif.type) { 261 case IEEE80211_IF_TYPE_WDS: 262 if (!is_valid_ether_addr(sdata->u.wds.remote_addr)) 263 return -ENOLINK; 264 break; 265 case IEEE80211_IF_TYPE_VLAN: 266 if (!sdata->u.vlan.ap) 267 return -ENOLINK; 268 break; 269 case IEEE80211_IF_TYPE_AP: 270 case IEEE80211_IF_TYPE_STA: 271 case IEEE80211_IF_TYPE_MNTR: 272 case IEEE80211_IF_TYPE_IBSS: 273 case IEEE80211_IF_TYPE_MESH_POINT: 274 /* no special treatment */ 275 break; 276 case IEEE80211_IF_TYPE_INVALID: 277 /* cannot happen */ 278 WARN_ON(1); 279 break; 280 } 281 282 if (local->open_count == 0) { 283 res = 0; 284 if (local->ops->start) 285 res = local->ops->start(local_to_hw(local)); 286 if (res) 287 return res; 288 need_hw_reconfig = 1; 289 ieee80211_led_radio(local, local->hw.conf.radio_enabled); 290 } 291 292 switch (sdata->vif.type) { 293 case IEEE80211_IF_TYPE_VLAN: 294 list_add(&sdata->u.vlan.list, &sdata->u.vlan.ap->u.ap.vlans); 295 /* no need to tell driver */ 296 break; 297 case IEEE80211_IF_TYPE_MNTR: 298 if (sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES) { 299 local->cooked_mntrs++; 300 break; 301 } 302 303 /* must be before the call to ieee80211_configure_filter */ 304 local->monitors++; 305 if (local->monitors == 1) 306 local->hw.conf.flags |= IEEE80211_CONF_RADIOTAP; 307 308 if (sdata->u.mntr_flags & MONITOR_FLAG_FCSFAIL) 309 local->fif_fcsfail++; 310 if (sdata->u.mntr_flags & MONITOR_FLAG_PLCPFAIL) 311 local->fif_plcpfail++; 312 if (sdata->u.mntr_flags & MONITOR_FLAG_CONTROL) 313 local->fif_control++; 314 if (sdata->u.mntr_flags & MONITOR_FLAG_OTHER_BSS) 315 local->fif_other_bss++; 316 317 netif_tx_lock_bh(local->mdev); 318 ieee80211_configure_filter(local); 319 netif_tx_unlock_bh(local->mdev); 320 break; 321 case IEEE80211_IF_TYPE_STA: 322 case IEEE80211_IF_TYPE_IBSS: 323 sdata->u.sta.flags &= ~IEEE80211_STA_PREV_BSSID_SET; 324 /* fall through */ 325 default: 326 conf.vif = &sdata->vif; 327 conf.type = sdata->vif.type; 328 conf.mac_addr = dev->dev_addr; 329 res = local->ops->add_interface(local_to_hw(local), &conf); 330 if (res) 331 goto err_stop; 332 333 ieee80211_if_config(dev); 334 ieee80211_reset_erp_info(dev); 335 ieee80211_enable_keys(sdata); 336 337 if (sdata->vif.type == IEEE80211_IF_TYPE_STA && 338 !(sdata->flags & IEEE80211_SDATA_USERSPACE_MLME)) 339 netif_carrier_off(dev); 340 else 341 netif_carrier_on(dev); 342 } 343 344 if (sdata->vif.type == IEEE80211_IF_TYPE_WDS) { 345 /* Create STA entry for the WDS peer */ 346 sta = sta_info_alloc(sdata, sdata->u.wds.remote_addr, 347 GFP_KERNEL); 348 if (!sta) { 349 res = -ENOMEM; 350 goto err_del_interface; 351 } 352 353 /* no locking required since STA is not live yet */ 354 sta->flags |= WLAN_STA_AUTHORIZED; 355 356 res = sta_info_insert(sta); 357 if (res) { 358 /* STA has been freed */ 359 goto err_del_interface; 360 } 361 } 362 363 if (local->open_count == 0) { 364 res = dev_open(local->mdev); 365 WARN_ON(res); 366 if (res) 367 goto err_del_interface; 368 tasklet_enable(&local->tx_pending_tasklet); 369 tasklet_enable(&local->tasklet); 370 } 371 372 /* 373 * set_multicast_list will be invoked by the networking core 374 * which will check whether any increments here were done in 375 * error and sync them down to the hardware as filter flags. 376 */ 377 if (sdata->flags & IEEE80211_SDATA_ALLMULTI) 378 atomic_inc(&local->iff_allmultis); 379 380 if (sdata->flags & IEEE80211_SDATA_PROMISC) 381 atomic_inc(&local->iff_promiscs); 382 383 local->open_count++; 384 if (need_hw_reconfig) 385 ieee80211_hw_config(local); 386 387 /* 388 * ieee80211_sta_work is disabled while network interface 389 * is down. Therefore, some configuration changes may not 390 * yet be effective. Trigger execution of ieee80211_sta_work 391 * to fix this. 392 */ 393 if (sdata->vif.type == IEEE80211_IF_TYPE_STA || 394 sdata->vif.type == IEEE80211_IF_TYPE_IBSS) { 395 struct ieee80211_if_sta *ifsta = &sdata->u.sta; 396 queue_work(local->hw.workqueue, &ifsta->work); 397 } 398 399 netif_start_queue(dev); 400 401 return 0; 402 err_del_interface: 403 local->ops->remove_interface(local_to_hw(local), &conf); 404 err_stop: 405 if (!local->open_count && local->ops->stop) 406 local->ops->stop(local_to_hw(local)); 407 return res; 408} 409 410static int ieee80211_stop(struct net_device *dev) 411{ 412 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 413 struct ieee80211_local *local = sdata->local; 414 struct ieee80211_if_init_conf conf; 415 struct sta_info *sta; 416 417 /* 418 * Stop TX on this interface first. 419 */ 420 netif_stop_queue(dev); 421 422 /* 423 * Now delete all active aggregation sessions. 424 */ 425 rcu_read_lock(); 426 427 list_for_each_entry_rcu(sta, &local->sta_list, list) { 428 if (sta->sdata == sdata) 429 ieee80211_sta_tear_down_BA_sessions(dev, sta->addr); 430 } 431 432 rcu_read_unlock(); 433 434 /* 435 * Remove all stations associated with this interface. 436 * 437 * This must be done before calling ops->remove_interface() 438 * because otherwise we can later invoke ops->sta_notify() 439 * whenever the STAs are removed, and that invalidates driver 440 * assumptions about always getting a vif pointer that is valid 441 * (because if we remove a STA after ops->remove_interface() 442 * the driver will have removed the vif info already!) 443 * 444 * We could relax this and only unlink the stations from the 445 * hash table and list but keep them on a per-sdata list that 446 * will be inserted back again when the interface is brought 447 * up again, but I don't currently see a use case for that, 448 * except with WDS which gets a STA entry created when it is 449 * brought up. 450 */ 451 sta_info_flush(local, sdata); 452 453 /* 454 * Don't count this interface for promisc/allmulti while it 455 * is down. dev_mc_unsync() will invoke set_multicast_list 456 * on the master interface which will sync these down to the 457 * hardware as filter flags. 458 */ 459 if (sdata->flags & IEEE80211_SDATA_ALLMULTI) 460 atomic_dec(&local->iff_allmultis); 461 462 if (sdata->flags & IEEE80211_SDATA_PROMISC) 463 atomic_dec(&local->iff_promiscs); 464 465 dev_mc_unsync(local->mdev, dev); 466 467 /* APs need special treatment */ 468 if (sdata->vif.type == IEEE80211_IF_TYPE_AP) { 469 struct ieee80211_sub_if_data *vlan, *tmp; 470 struct beacon_data *old_beacon = sdata->u.ap.beacon; 471 472 /* remove beacon */ 473 rcu_assign_pointer(sdata->u.ap.beacon, NULL); 474 synchronize_rcu(); 475 kfree(old_beacon); 476 477 /* down all dependent devices, that is VLANs */ 478 list_for_each_entry_safe(vlan, tmp, &sdata->u.ap.vlans, 479 u.vlan.list) 480 dev_close(vlan->dev); 481 WARN_ON(!list_empty(&sdata->u.ap.vlans)); 482 } 483 484 local->open_count--; 485 486 switch (sdata->vif.type) { 487 case IEEE80211_IF_TYPE_VLAN: 488 list_del(&sdata->u.vlan.list); 489 sdata->u.vlan.ap = NULL; 490 /* no need to tell driver */ 491 break; 492 case IEEE80211_IF_TYPE_MNTR: 493 if (sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES) { 494 local->cooked_mntrs--; 495 break; 496 } 497 498 local->monitors--; 499 if (local->monitors == 0) 500 local->hw.conf.flags &= ~IEEE80211_CONF_RADIOTAP; 501 502 if (sdata->u.mntr_flags & MONITOR_FLAG_FCSFAIL) 503 local->fif_fcsfail--; 504 if (sdata->u.mntr_flags & MONITOR_FLAG_PLCPFAIL) 505 local->fif_plcpfail--; 506 if (sdata->u.mntr_flags & MONITOR_FLAG_CONTROL) 507 local->fif_control--; 508 if (sdata->u.mntr_flags & MONITOR_FLAG_OTHER_BSS) 509 local->fif_other_bss--; 510 511 netif_tx_lock_bh(local->mdev); 512 ieee80211_configure_filter(local); 513 netif_tx_unlock_bh(local->mdev); 514 break; 515 case IEEE80211_IF_TYPE_MESH_POINT: 516 case IEEE80211_IF_TYPE_STA: 517 case IEEE80211_IF_TYPE_IBSS: 518 sdata->u.sta.state = IEEE80211_DISABLED; 519 memset(sdata->u.sta.bssid, 0, ETH_ALEN); 520 del_timer_sync(&sdata->u.sta.timer); 521 /* 522 * When we get here, the interface is marked down. 523 * Call synchronize_rcu() to wait for the RX path 524 * should it be using the interface and enqueuing 525 * frames at this very time on another CPU. 526 */ 527 synchronize_rcu(); 528 skb_queue_purge(&sdata->u.sta.skb_queue); 529 530 if (local->scan_dev == sdata->dev) { 531 if (!local->ops->hw_scan) { 532 local->sta_sw_scanning = 0; 533 cancel_delayed_work(&local->scan_work); 534 } else 535 local->sta_hw_scanning = 0; 536 } 537 538 flush_workqueue(local->hw.workqueue); 539 540 sdata->u.sta.flags &= ~IEEE80211_STA_PRIVACY_INVOKED; 541 kfree(sdata->u.sta.extra_ie); 542 sdata->u.sta.extra_ie = NULL; 543 sdata->u.sta.extra_ie_len = 0; 544 /* fall through */ 545 default: 546 conf.vif = &sdata->vif; 547 conf.type = sdata->vif.type; 548 conf.mac_addr = dev->dev_addr; 549 /* disable all keys for as long as this netdev is down */ 550 ieee80211_disable_keys(sdata); 551 local->ops->remove_interface(local_to_hw(local), &conf); 552 } 553 554 if (local->open_count == 0) { 555 if (netif_running(local->mdev)) 556 dev_close(local->mdev); 557 558 if (local->ops->stop) 559 local->ops->stop(local_to_hw(local)); 560 561 ieee80211_led_radio(local, 0); 562 563 tasklet_disable(&local->tx_pending_tasklet); 564 tasklet_disable(&local->tasklet); 565 } 566 567 return 0; 568} 569 570int ieee80211_start_tx_ba_session(struct ieee80211_hw *hw, u8 *ra, u16 tid) 571{ 572 struct ieee80211_local *local = hw_to_local(hw); 573 struct sta_info *sta; 574 struct ieee80211_sub_if_data *sdata; 575 u16 start_seq_num = 0; 576 u8 *state; 577 int ret; 578 DECLARE_MAC_BUF(mac); 579 580 if (tid >= STA_TID_NUM) 581 return -EINVAL; 582 583#ifdef CONFIG_MAC80211_HT_DEBUG 584 printk(KERN_DEBUG "Open BA session requested for %s tid %u\n", 585 print_mac(mac, ra), tid); 586#endif /* CONFIG_MAC80211_HT_DEBUG */ 587 588 rcu_read_lock(); 589 590 sta = sta_info_get(local, ra); 591 if (!sta) { 592 printk(KERN_DEBUG "Could not find the station\n"); 593 ret = -ENOENT; 594 goto exit; 595 } 596 597 spin_lock_bh(&sta->lock); 598 599 /* we have tried too many times, receiver does not want A-MPDU */ 600 if (sta->ampdu_mlme.addba_req_num[tid] > HT_AGG_MAX_RETRIES) { 601 ret = -EBUSY; 602 goto err_unlock_sta; 603 } 604 605 state = &sta->ampdu_mlme.tid_state_tx[tid]; 606 /* check if the TID is not in aggregation flow already */ 607 if (*state != HT_AGG_STATE_IDLE) { 608#ifdef CONFIG_MAC80211_HT_DEBUG 609 printk(KERN_DEBUG "BA request denied - session is not " 610 "idle on tid %u\n", tid); 611#endif /* CONFIG_MAC80211_HT_DEBUG */ 612 ret = -EAGAIN; 613 goto err_unlock_sta; 614 } 615 616 /* prepare A-MPDU MLME for Tx aggregation */ 617 sta->ampdu_mlme.tid_tx[tid] = 618 kmalloc(sizeof(struct tid_ampdu_tx), GFP_ATOMIC); 619 if (!sta->ampdu_mlme.tid_tx[tid]) { 620 if (net_ratelimit()) 621 printk(KERN_ERR "allocate tx mlme to tid %d failed\n", 622 tid); 623 ret = -ENOMEM; 624 goto err_unlock_sta; 625 } 626 /* Tx timer */ 627 sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer.function = 628 sta_addba_resp_timer_expired; 629 sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer.data = 630 (unsigned long)&sta->timer_to_tid[tid]; 631 init_timer(&sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer); 632 633 /* ensure that TX flow won't interrupt us 634 * until the end of the call to requeue function */ 635 spin_lock_bh(&local->mdev->queue_lock); 636 637 /* create a new queue for this aggregation */ 638 ret = ieee80211_ht_agg_queue_add(local, sta, tid); 639 640 /* case no queue is available to aggregation 641 * don't switch to aggregation */ 642 if (ret) { 643#ifdef CONFIG_MAC80211_HT_DEBUG 644 printk(KERN_DEBUG "BA request denied - queue unavailable for" 645 " tid %d\n", tid); 646#endif /* CONFIG_MAC80211_HT_DEBUG */ 647 goto err_unlock_queue; 648 } 649 sdata = sta->sdata; 650 651 /* Ok, the Addba frame hasn't been sent yet, but if the driver calls the 652 * call back right away, it must see that the flow has begun */ 653 *state |= HT_ADDBA_REQUESTED_MSK; 654 655 if (local->ops->ampdu_action) 656 ret = local->ops->ampdu_action(hw, IEEE80211_AMPDU_TX_START, 657 ra, tid, &start_seq_num); 658 659 if (ret) { 660 /* No need to requeue the packets in the agg queue, since we 661 * held the tx lock: no packet could be enqueued to the newly 662 * allocated queue */ 663 ieee80211_ht_agg_queue_remove(local, sta, tid, 0); 664#ifdef CONFIG_MAC80211_HT_DEBUG 665 printk(KERN_DEBUG "BA request denied - HW unavailable for" 666 " tid %d\n", tid); 667#endif /* CONFIG_MAC80211_HT_DEBUG */ 668 *state = HT_AGG_STATE_IDLE; 669 goto err_unlock_queue; 670 } 671 672 /* Will put all the packets in the new SW queue */ 673 ieee80211_requeue(local, ieee802_1d_to_ac[tid]); 674 spin_unlock_bh(&local->mdev->queue_lock); 675 spin_unlock_bh(&sta->lock); 676 677 /* send an addBA request */ 678 sta->ampdu_mlme.dialog_token_allocator++; 679 sta->ampdu_mlme.tid_tx[tid]->dialog_token = 680 sta->ampdu_mlme.dialog_token_allocator; 681 sta->ampdu_mlme.tid_tx[tid]->ssn = start_seq_num; 682 683 684 ieee80211_send_addba_request(sta->sdata->dev, ra, tid, 685 sta->ampdu_mlme.tid_tx[tid]->dialog_token, 686 sta->ampdu_mlme.tid_tx[tid]->ssn, 687 0x40, 5000); 688 /* activate the timer for the recipient's addBA response */ 689 sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer.expires = 690 jiffies + ADDBA_RESP_INTERVAL; 691 add_timer(&sta->ampdu_mlme.tid_tx[tid]->addba_resp_timer); 692 printk(KERN_DEBUG "activated addBA response timer on tid %d\n", tid); 693 goto exit; 694 695err_unlock_queue: 696 kfree(sta->ampdu_mlme.tid_tx[tid]); 697 sta->ampdu_mlme.tid_tx[tid] = NULL; 698 spin_unlock_bh(&local->mdev->queue_lock); 699 ret = -EBUSY; 700err_unlock_sta: 701 spin_unlock_bh(&sta->lock); 702exit: 703 rcu_read_unlock(); 704 return ret; 705} 706EXPORT_SYMBOL(ieee80211_start_tx_ba_session); 707 708int ieee80211_stop_tx_ba_session(struct ieee80211_hw *hw, 709 u8 *ra, u16 tid, 710 enum ieee80211_back_parties initiator) 711{ 712 struct ieee80211_local *local = hw_to_local(hw); 713 struct sta_info *sta; 714 u8 *state; 715 int ret = 0; 716 DECLARE_MAC_BUF(mac); 717 718 if (tid >= STA_TID_NUM) 719 return -EINVAL; 720 721 rcu_read_lock(); 722 sta = sta_info_get(local, ra); 723 if (!sta) { 724 rcu_read_unlock(); 725 return -ENOENT; 726 } 727 728 /* check if the TID is in aggregation */ 729 state = &sta->ampdu_mlme.tid_state_tx[tid]; 730 spin_lock_bh(&sta->lock); 731 732 if (*state != HT_AGG_STATE_OPERATIONAL) { 733 ret = -ENOENT; 734 goto stop_BA_exit; 735 } 736 737#ifdef CONFIG_MAC80211_HT_DEBUG 738 printk(KERN_DEBUG "Tx BA session stop requested for %s tid %u\n", 739 print_mac(mac, ra), tid); 740#endif /* CONFIG_MAC80211_HT_DEBUG */ 741 742 ieee80211_stop_queue(hw, sta->tid_to_tx_q[tid]); 743 744 *state = HT_AGG_STATE_REQ_STOP_BA_MSK | 745 (initiator << HT_AGG_STATE_INITIATOR_SHIFT); 746 747 if (local->ops->ampdu_action) 748 ret = local->ops->ampdu_action(hw, IEEE80211_AMPDU_TX_STOP, 749 ra, tid, NULL); 750 751 /* case HW denied going back to legacy */ 752 if (ret) { 753 WARN_ON(ret != -EBUSY); 754 *state = HT_AGG_STATE_OPERATIONAL; 755 ieee80211_wake_queue(hw, sta->tid_to_tx_q[tid]); 756 goto stop_BA_exit; 757 } 758 759stop_BA_exit: 760 spin_unlock_bh(&sta->lock); 761 rcu_read_unlock(); 762 return ret; 763} 764EXPORT_SYMBOL(ieee80211_stop_tx_ba_session); 765 766void ieee80211_start_tx_ba_cb(struct ieee80211_hw *hw, u8 *ra, u16 tid) 767{ 768 struct ieee80211_local *local = hw_to_local(hw); 769 struct sta_info *sta; 770 u8 *state; 771 DECLARE_MAC_BUF(mac); 772 773 if (tid >= STA_TID_NUM) { 774 printk(KERN_DEBUG "Bad TID value: tid = %d (>= %d)\n", 775 tid, STA_TID_NUM); 776 return; 777 } 778 779 rcu_read_lock(); 780 sta = sta_info_get(local, ra); 781 if (!sta) { 782 rcu_read_unlock(); 783 printk(KERN_DEBUG "Could not find station: %s\n", 784 print_mac(mac, ra)); 785 return; 786 } 787 788 state = &sta->ampdu_mlme.tid_state_tx[tid]; 789 spin_lock_bh(&sta->lock); 790 791 if (!(*state & HT_ADDBA_REQUESTED_MSK)) { 792 printk(KERN_DEBUG "addBA was not requested yet, state is %d\n", 793 *state); 794 spin_unlock_bh(&sta->lock); 795 rcu_read_unlock(); 796 return; 797 } 798 799 WARN_ON_ONCE(*state & HT_ADDBA_DRV_READY_MSK); 800 801 *state |= HT_ADDBA_DRV_READY_MSK; 802 803 if (*state == HT_AGG_STATE_OPERATIONAL) { 804 printk(KERN_DEBUG "Aggregation is on for tid %d \n", tid); 805 ieee80211_wake_queue(hw, sta->tid_to_tx_q[tid]); 806 } 807 spin_unlock_bh(&sta->lock); 808 rcu_read_unlock(); 809} 810EXPORT_SYMBOL(ieee80211_start_tx_ba_cb); 811 812void ieee80211_stop_tx_ba_cb(struct ieee80211_hw *hw, u8 *ra, u8 tid) 813{ 814 struct ieee80211_local *local = hw_to_local(hw); 815 struct sta_info *sta; 816 u8 *state; 817 int agg_queue; 818 DECLARE_MAC_BUF(mac); 819 820 if (tid >= STA_TID_NUM) { 821 printk(KERN_DEBUG "Bad TID value: tid = %d (>= %d)\n", 822 tid, STA_TID_NUM); 823 return; 824 } 825 826#ifdef CONFIG_MAC80211_HT_DEBUG 827 printk(KERN_DEBUG "Stopping Tx BA session for %s tid %d\n", 828 print_mac(mac, ra), tid); 829#endif /* CONFIG_MAC80211_HT_DEBUG */ 830 831 rcu_read_lock(); 832 sta = sta_info_get(local, ra); 833 if (!sta) { 834 printk(KERN_DEBUG "Could not find station: %s\n", 835 print_mac(mac, ra)); 836 rcu_read_unlock(); 837 return; 838 } 839 state = &sta->ampdu_mlme.tid_state_tx[tid]; 840 841 /* NOTE: no need to use sta->lock in this state check, as 842 * ieee80211_stop_tx_ba_session will let only 843 * one stop call to pass through per sta/tid */ 844 if ((*state & HT_AGG_STATE_REQ_STOP_BA_MSK) == 0) { 845 printk(KERN_DEBUG "unexpected callback to A-MPDU stop\n"); 846 rcu_read_unlock(); 847 return; 848 } 849 850 if (*state & HT_AGG_STATE_INITIATOR_MSK) 851 ieee80211_send_delba(sta->sdata->dev, ra, tid, 852 WLAN_BACK_INITIATOR, WLAN_REASON_QSTA_NOT_USE); 853 854 agg_queue = sta->tid_to_tx_q[tid]; 855 856 /* avoid ordering issues: we are the only one that can modify 857 * the content of the qdiscs */ 858 spin_lock_bh(&local->mdev->queue_lock); 859 /* remove the queue for this aggregation */ 860 ieee80211_ht_agg_queue_remove(local, sta, tid, 1); 861 spin_unlock_bh(&local->mdev->queue_lock); 862 863 /* we just requeued the all the frames that were in the removed 864 * queue, and since we might miss a softirq we do netif_schedule. 865 * ieee80211_wake_queue is not used here as this queue is not 866 * necessarily stopped */ 867 netif_schedule(local->mdev); 868 spin_lock_bh(&sta->lock); 869 *state = HT_AGG_STATE_IDLE; 870 sta->ampdu_mlme.addba_req_num[tid] = 0; 871 kfree(sta->ampdu_mlme.tid_tx[tid]); 872 sta->ampdu_mlme.tid_tx[tid] = NULL; 873 spin_unlock_bh(&sta->lock); 874 875 rcu_read_unlock(); 876} 877EXPORT_SYMBOL(ieee80211_stop_tx_ba_cb); 878 879void ieee80211_start_tx_ba_cb_irqsafe(struct ieee80211_hw *hw, 880 const u8 *ra, u16 tid) 881{ 882 struct ieee80211_local *local = hw_to_local(hw); 883 struct ieee80211_ra_tid *ra_tid; 884 struct sk_buff *skb = dev_alloc_skb(0); 885 886 if (unlikely(!skb)) { 887 if (net_ratelimit()) 888 printk(KERN_WARNING "%s: Not enough memory, " 889 "dropping start BA session", skb->dev->name); 890 return; 891 } 892 ra_tid = (struct ieee80211_ra_tid *) &skb->cb; 893 memcpy(&ra_tid->ra, ra, ETH_ALEN); 894 ra_tid->tid = tid; 895 896 skb->pkt_type = IEEE80211_ADDBA_MSG; 897 skb_queue_tail(&local->skb_queue, skb); 898 tasklet_schedule(&local->tasklet); 899} 900EXPORT_SYMBOL(ieee80211_start_tx_ba_cb_irqsafe); 901 902void ieee80211_stop_tx_ba_cb_irqsafe(struct ieee80211_hw *hw, 903 const u8 *ra, u16 tid) 904{ 905 struct ieee80211_local *local = hw_to_local(hw); 906 struct ieee80211_ra_tid *ra_tid; 907 struct sk_buff *skb = dev_alloc_skb(0); 908 909 if (unlikely(!skb)) { 910 if (net_ratelimit()) 911 printk(KERN_WARNING "%s: Not enough memory, " 912 "dropping stop BA session", skb->dev->name); 913 return; 914 } 915 ra_tid = (struct ieee80211_ra_tid *) &skb->cb; 916 memcpy(&ra_tid->ra, ra, ETH_ALEN); 917 ra_tid->tid = tid; 918 919 skb->pkt_type = IEEE80211_DELBA_MSG; 920 skb_queue_tail(&local->skb_queue, skb); 921 tasklet_schedule(&local->tasklet); 922} 923EXPORT_SYMBOL(ieee80211_stop_tx_ba_cb_irqsafe); 924 925static void ieee80211_set_multicast_list(struct net_device *dev) 926{ 927 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); 928 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 929 int allmulti, promisc, sdata_allmulti, sdata_promisc; 930 931 allmulti = !!(dev->flags & IFF_ALLMULTI); 932 promisc = !!(dev->flags & IFF_PROMISC); 933 sdata_allmulti = !!(sdata->flags & IEEE80211_SDATA_ALLMULTI); 934 sdata_promisc = !!(sdata->flags & IEEE80211_SDATA_PROMISC); 935 936 if (allmulti != sdata_allmulti) { 937 if (dev->flags & IFF_ALLMULTI) 938 atomic_inc(&local->iff_allmultis); 939 else 940 atomic_dec(&local->iff_allmultis); 941 sdata->flags ^= IEEE80211_SDATA_ALLMULTI; 942 } 943 944 if (promisc != sdata_promisc) { 945 if (dev->flags & IFF_PROMISC) 946 atomic_inc(&local->iff_promiscs); 947 else 948 atomic_dec(&local->iff_promiscs); 949 sdata->flags ^= IEEE80211_SDATA_PROMISC; 950 } 951 952 dev_mc_sync(local->mdev, dev); 953} 954 955static const struct header_ops ieee80211_header_ops = { 956 .create = eth_header, 957 .parse = header_parse_80211, 958 .rebuild = eth_rebuild_header, 959 .cache = eth_header_cache, 960 .cache_update = eth_header_cache_update, 961}; 962 963/* Must not be called for mdev */ 964void ieee80211_if_setup(struct net_device *dev) 965{ 966 ether_setup(dev); 967 dev->hard_start_xmit = ieee80211_subif_start_xmit; 968 dev->wireless_handlers = &ieee80211_iw_handler_def; 969 dev->set_multicast_list = ieee80211_set_multicast_list; 970 dev->change_mtu = ieee80211_change_mtu; 971 dev->open = ieee80211_open; 972 dev->stop = ieee80211_stop; 973 dev->destructor = ieee80211_if_free; 974} 975 976/* everything else */ 977 978static int __ieee80211_if_config(struct net_device *dev, 979 struct sk_buff *beacon) 980{ 981 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 982 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); 983 struct ieee80211_if_conf conf; 984 985 if (!local->ops->config_interface || !netif_running(dev)) 986 return 0; 987 988 memset(&conf, 0, sizeof(conf)); 989 conf.type = sdata->vif.type; 990 if (sdata->vif.type == IEEE80211_IF_TYPE_STA || 991 sdata->vif.type == IEEE80211_IF_TYPE_IBSS) { 992 conf.bssid = sdata->u.sta.bssid; 993 conf.ssid = sdata->u.sta.ssid; 994 conf.ssid_len = sdata->u.sta.ssid_len; 995 } else if (ieee80211_vif_is_mesh(&sdata->vif)) { 996 conf.beacon = beacon; 997 ieee80211_start_mesh(dev); 998 } else if (sdata->vif.type == IEEE80211_IF_TYPE_AP) { 999 conf.ssid = sdata->u.ap.ssid; 1000 conf.ssid_len = sdata->u.ap.ssid_len; 1001 conf.beacon = beacon; 1002 } 1003 return local->ops->config_interface(local_to_hw(local), 1004 &sdata->vif, &conf); 1005} 1006 1007int ieee80211_if_config(struct net_device *dev) 1008{ 1009 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 1010 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); 1011 if (sdata->vif.type == IEEE80211_IF_TYPE_MESH_POINT && 1012 (local->hw.flags & IEEE80211_HW_HOST_GEN_BEACON_TEMPLATE)) 1013 return ieee80211_if_config_beacon(dev); 1014 return __ieee80211_if_config(dev, NULL); 1015} 1016 1017int ieee80211_if_config_beacon(struct net_device *dev) 1018{ 1019 struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); 1020 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 1021 struct sk_buff *skb; 1022 1023 if (!(local->hw.flags & IEEE80211_HW_HOST_GEN_BEACON_TEMPLATE)) 1024 return 0; 1025 skb = ieee80211_beacon_get(local_to_hw(local), &sdata->vif); 1026 if (!skb) 1027 return -ENOMEM; 1028 return __ieee80211_if_config(dev, skb); 1029} 1030 1031int ieee80211_hw_config(struct ieee80211_local *local) 1032{ 1033 struct ieee80211_channel *chan; 1034 int ret = 0; 1035 1036 if (local->sta_sw_scanning) 1037 chan = local->scan_channel; 1038 else 1039 chan = local->oper_channel; 1040 1041 local->hw.conf.channel = chan; 1042 1043 if (!local->hw.conf.power_level) 1044 local->hw.conf.power_level = chan->max_power; 1045 else 1046 local->hw.conf.power_level = min(chan->max_power, 1047 local->hw.conf.power_level); 1048 1049 local->hw.conf.max_antenna_gain = chan->max_antenna_gain; 1050 1051#ifdef CONFIG_MAC80211_VERBOSE_DEBUG 1052 printk(KERN_DEBUG "%s: HW CONFIG: freq=%d\n", 1053 wiphy_name(local->hw.wiphy), chan->center_freq); 1054#endif 1055 1056 if (local->open_count) 1057 ret = local->ops->config(local_to_hw(local), &local->hw.conf); 1058 1059 return ret; 1060} 1061 1062/** 1063 * ieee80211_handle_ht should be used only after legacy configuration 1064 * has been determined namely band, as ht configuration depends upon 1065 * the hardware's HT abilities for a _specific_ band. 1066 */ 1067u32 ieee80211_handle_ht(struct ieee80211_local *local, int enable_ht, 1068 struct ieee80211_ht_info *req_ht_cap, 1069 struct ieee80211_ht_bss_info *req_bss_cap) 1070{ 1071 struct ieee80211_conf *conf = &local->hw.conf; 1072 struct ieee80211_supported_band *sband; 1073 struct ieee80211_ht_info ht_conf; 1074 struct ieee80211_ht_bss_info ht_bss_conf; 1075 u32 changed = 0; 1076 int i; 1077 u8 max_tx_streams = IEEE80211_HT_CAP_MAX_STREAMS; 1078 u8 tx_mcs_set_cap; 1079 1080 sband = local->hw.wiphy->bands[conf->channel->band]; 1081 1082 memset(&ht_conf, 0, sizeof(struct ieee80211_ht_info)); 1083 memset(&ht_bss_conf, 0, sizeof(struct ieee80211_ht_bss_info)); 1084 1085 /* HT is not supported */ 1086 if (!sband->ht_info.ht_supported) { 1087 conf->flags &= ~IEEE80211_CONF_SUPPORT_HT_MODE; 1088 goto out; 1089 } 1090 1091 /* disable HT */ 1092 if (!enable_ht) { 1093 if (conf->flags & IEEE80211_CONF_SUPPORT_HT_MODE) 1094 changed |= BSS_CHANGED_HT; 1095 conf->flags &= ~IEEE80211_CONF_SUPPORT_HT_MODE; 1096 conf->ht_conf.ht_supported = 0; 1097 goto out; 1098 } 1099 1100 1101 if (!(conf->flags & IEEE80211_CONF_SUPPORT_HT_MODE)) 1102 changed |= BSS_CHANGED_HT; 1103 1104 conf->flags |= IEEE80211_CONF_SUPPORT_HT_MODE; 1105 ht_conf.ht_supported = 1; 1106 1107 ht_conf.cap = req_ht_cap->cap & sband->ht_info.cap; 1108 ht_conf.cap &= ~(IEEE80211_HT_CAP_MIMO_PS); 1109 ht_conf.cap |= sband->ht_info.cap & IEEE80211_HT_CAP_MIMO_PS; 1110 ht_bss_conf.primary_channel = req_bss_cap->primary_channel; 1111 ht_bss_conf.bss_cap = req_bss_cap->bss_cap; 1112 ht_bss_conf.bss_op_mode = req_bss_cap->bss_op_mode; 1113 1114 ht_conf.ampdu_factor = req_ht_cap->ampdu_factor; 1115 ht_conf.ampdu_density = req_ht_cap->ampdu_density; 1116 1117 /* Bits 96-100 */ 1118 tx_mcs_set_cap = sband->ht_info.supp_mcs_set[12]; 1119 1120 /* configure suppoerted Tx MCS according to requested MCS 1121 * (based in most cases on Rx capabilities of peer) and self 1122 * Tx MCS capabilities (as defined by low level driver HW 1123 * Tx capabilities) */ 1124 if (!(tx_mcs_set_cap & IEEE80211_HT_CAP_MCS_TX_DEFINED)) 1125 goto check_changed; 1126 1127 /* Counting from 0 therfore + 1 */ 1128 if (tx_mcs_set_cap & IEEE80211_HT_CAP_MCS_TX_RX_DIFF) 1129 max_tx_streams = ((tx_mcs_set_cap & 1130 IEEE80211_HT_CAP_MCS_TX_STREAMS) >> 2) + 1; 1131 1132 for (i = 0; i < max_tx_streams; i++) 1133 ht_conf.supp_mcs_set[i] = 1134 sband->ht_info.supp_mcs_set[i] & 1135 req_ht_cap->supp_mcs_set[i]; 1136 1137 if (tx_mcs_set_cap & IEEE80211_HT_CAP_MCS_TX_UEQM) 1138 for (i = IEEE80211_SUPP_MCS_SET_UEQM; 1139 i < IEEE80211_SUPP_MCS_SET_LEN; i++) 1140 ht_conf.supp_mcs_set[i] = 1141 sband->ht_info.supp_mcs_set[i] & 1142 req_ht_cap->supp_mcs_set[i]; 1143 1144check_changed: 1145 /* if bss configuration changed store the new one */ 1146 if (memcmp(&conf->ht_conf, &ht_conf, sizeof(ht_conf)) || 1147 memcmp(&conf->ht_bss_conf, &ht_bss_conf, sizeof(ht_bss_conf))) { 1148 changed |= BSS_CHANGED_HT; 1149 memcpy(&conf->ht_conf, &ht_conf, sizeof(ht_conf)); 1150 memcpy(&conf->ht_bss_conf, &ht_bss_conf, sizeof(ht_bss_conf)); 1151 } 1152out: 1153 return changed; 1154} 1155 1156void ieee80211_bss_info_change_notify(struct ieee80211_sub_if_data *sdata, 1157 u32 changed) 1158{ 1159 struct ieee80211_local *local = sdata->local; 1160 1161 if (!changed) 1162 return; 1163 1164 if (local->ops->bss_info_changed) 1165 local->ops->bss_info_changed(local_to_hw(local), 1166 &sdata->vif, 1167 &sdata->bss_conf, 1168 changed); 1169} 1170 1171void ieee80211_reset_erp_info(struct net_device *dev) 1172{ 1173 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 1174 1175 sdata->bss_conf.use_cts_prot = 0; 1176 sdata->bss_conf.use_short_preamble = 0; 1177 ieee80211_bss_info_change_notify(sdata, 1178 BSS_CHANGED_ERP_CTS_PROT | 1179 BSS_CHANGED_ERP_PREAMBLE); 1180} 1181 1182void ieee80211_tx_status_irqsafe(struct ieee80211_hw *hw, 1183 struct sk_buff *skb) 1184{ 1185 struct ieee80211_local *local = hw_to_local(hw); 1186 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 1187 int tmp; 1188 1189 skb->dev = local->mdev; 1190 skb->pkt_type = IEEE80211_TX_STATUS_MSG; 1191 skb_queue_tail(info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS ? 1192 &local->skb_queue : &local->skb_queue_unreliable, skb); 1193 tmp = skb_queue_len(&local->skb_queue) + 1194 skb_queue_len(&local->skb_queue_unreliable); 1195 while (tmp > IEEE80211_IRQSAFE_QUEUE_LIMIT && 1196 (skb = skb_dequeue(&local->skb_queue_unreliable))) { 1197 dev_kfree_skb_irq(skb); 1198 tmp--; 1199 I802_DEBUG_INC(local->tx_status_drop); 1200 } 1201 tasklet_schedule(&local->tasklet); 1202} 1203EXPORT_SYMBOL(ieee80211_tx_status_irqsafe); 1204 1205static void ieee80211_tasklet_handler(unsigned long data) 1206{ 1207 struct ieee80211_local *local = (struct ieee80211_local *) data; 1208 struct sk_buff *skb; 1209 struct ieee80211_rx_status rx_status; 1210 struct ieee80211_ra_tid *ra_tid; 1211 1212 while ((skb = skb_dequeue(&local->skb_queue)) || 1213 (skb = skb_dequeue(&local->skb_queue_unreliable))) { 1214 switch (skb->pkt_type) { 1215 case IEEE80211_RX_MSG: 1216 /* status is in skb->cb */ 1217 memcpy(&rx_status, skb->cb, sizeof(rx_status)); 1218 /* Clear skb->pkt_type in order to not confuse kernel 1219 * netstack. */ 1220 skb->pkt_type = 0; 1221 __ieee80211_rx(local_to_hw(local), skb, &rx_status); 1222 break; 1223 case IEEE80211_TX_STATUS_MSG: 1224 skb->pkt_type = 0; 1225 ieee80211_tx_status(local_to_hw(local), skb); 1226 break; 1227 case IEEE80211_DELBA_MSG: 1228 ra_tid = (struct ieee80211_ra_tid *) &skb->cb; 1229 ieee80211_stop_tx_ba_cb(local_to_hw(local), 1230 ra_tid->ra, ra_tid->tid); 1231 dev_kfree_skb(skb); 1232 break; 1233 case IEEE80211_ADDBA_MSG: 1234 ra_tid = (struct ieee80211_ra_tid *) &skb->cb; 1235 ieee80211_start_tx_ba_cb(local_to_hw(local), 1236 ra_tid->ra, ra_tid->tid); 1237 dev_kfree_skb(skb); 1238 break ; 1239 default: /* should never get here! */ 1240 printk(KERN_ERR "%s: Unknown message type (%d)\n", 1241 wiphy_name(local->hw.wiphy), skb->pkt_type); 1242 dev_kfree_skb(skb); 1243 break; 1244 } 1245 } 1246} 1247 1248/* Remove added headers (e.g., QoS control), encryption header/MIC, etc. to 1249 * make a prepared TX frame (one that has been given to hw) to look like brand 1250 * new IEEE 802.11 frame that is ready to go through TX processing again. 1251 * Also, tx_packet_data in cb is restored from tx_control. */ 1252static void ieee80211_remove_tx_extra(struct ieee80211_local *local, 1253 struct ieee80211_key *key, 1254 struct sk_buff *skb) 1255{ 1256 int hdrlen, iv_len, mic_len; 1257 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 1258 1259 info->flags &= IEEE80211_TX_CTL_REQ_TX_STATUS | 1260 IEEE80211_TX_CTL_DO_NOT_ENCRYPT | 1261 IEEE80211_TX_CTL_REQUEUE | 1262 IEEE80211_TX_CTL_EAPOL_FRAME; 1263 1264 hdrlen = ieee80211_get_hdrlen_from_skb(skb); 1265 1266 if (!key) 1267 goto no_key; 1268 1269 switch (key->conf.alg) { 1270 case ALG_WEP: 1271 iv_len = WEP_IV_LEN; 1272 mic_len = WEP_ICV_LEN; 1273 break; 1274 case ALG_TKIP: 1275 iv_len = TKIP_IV_LEN; 1276 mic_len = TKIP_ICV_LEN; 1277 break; 1278 case ALG_CCMP: 1279 iv_len = CCMP_HDR_LEN; 1280 mic_len = CCMP_MIC_LEN; 1281 break; 1282 default: 1283 goto no_key; 1284 } 1285 1286 if (skb->len >= mic_len && 1287 !(key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE)) 1288 skb_trim(skb, skb->len - mic_len); 1289 if (skb->len >= iv_len && skb->len > hdrlen) { 1290 memmove(skb->data + iv_len, skb->data, hdrlen); 1291 skb_pull(skb, iv_len); 1292 } 1293 1294no_key: 1295 { 1296 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data; 1297 u16 fc = le16_to_cpu(hdr->frame_control); 1298 if ((fc & 0x8C) == 0x88) /* QoS Control Field */ { 1299 fc &= ~IEEE80211_STYPE_QOS_DATA; 1300 hdr->frame_control = cpu_to_le16(fc); 1301 memmove(skb->data + 2, skb->data, hdrlen - 2); 1302 skb_pull(skb, 2); 1303 } 1304 } 1305} 1306 1307static void ieee80211_handle_filtered_frame(struct ieee80211_local *local, 1308 struct sta_info *sta, 1309 struct sk_buff *skb) 1310{ 1311 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 1312 1313 sta->tx_filtered_count++; 1314 1315 /* 1316 * Clear the TX filter mask for this STA when sending the next 1317 * packet. If the STA went to power save mode, this will happen 1318 * when it wakes up for the next time. 1319 */ 1320 set_sta_flags(sta, WLAN_STA_CLEAR_PS_FILT); 1321 1322 /* 1323 * This code races in the following way: 1324 * 1325 * (1) STA sends frame indicating it will go to sleep and does so 1326 * (2) hardware/firmware adds STA to filter list, passes frame up 1327 * (3) hardware/firmware processes TX fifo and suppresses a frame 1328 * (4) we get TX status before having processed the frame and 1329 * knowing that the STA has gone to sleep. 1330 * 1331 * This is actually quite unlikely even when both those events are 1332 * processed from interrupts coming in quickly after one another or 1333 * even at the same time because we queue both TX status events and 1334 * RX frames to be processed by a tasklet and process them in the 1335 * same order that they were received or TX status last. Hence, there 1336 * is no race as long as the frame RX is processed before the next TX 1337 * status, which drivers can ensure, see below. 1338 * 1339 * Note that this can only happen if the hardware or firmware can 1340 * actually add STAs to the filter list, if this is done by the 1341 * driver in response to set_tim() (which will only reduce the race 1342 * this whole filtering tries to solve, not completely solve it) 1343 * this situation cannot happen. 1344 * 1345 * To completely solve this race drivers need to make sure that they 1346 * (a) don't mix the irq-safe/not irq-safe TX status/RX processing 1347 * functions and 1348 * (b) always process RX events before TX status events if ordering 1349 * can be unknown, for example with different interrupt status 1350 * bits. 1351 */ 1352 if (test_sta_flags(sta, WLAN_STA_PS) && 1353 skb_queue_len(&sta->tx_filtered) < STA_MAX_TX_BUFFER) { 1354 ieee80211_remove_tx_extra(local, sta->key, skb); 1355 skb_queue_tail(&sta->tx_filtered, skb); 1356 return; 1357 } 1358 1359 if (!test_sta_flags(sta, WLAN_STA_PS) && 1360 !(info->flags & IEEE80211_TX_CTL_REQUEUE)) { 1361 /* Software retry the packet once */ 1362 info->flags |= IEEE80211_TX_CTL_REQUEUE; 1363 ieee80211_remove_tx_extra(local, sta->key, skb); 1364 dev_queue_xmit(skb); 1365 return; 1366 } 1367 1368 if (net_ratelimit()) 1369 printk(KERN_DEBUG "%s: dropped TX filtered frame, " 1370 "queue_len=%d PS=%d @%lu\n", 1371 wiphy_name(local->hw.wiphy), 1372 skb_queue_len(&sta->tx_filtered), 1373 !!test_sta_flags(sta, WLAN_STA_PS), jiffies); 1374 dev_kfree_skb(skb); 1375} 1376 1377void ieee80211_tx_status(struct ieee80211_hw *hw, struct sk_buff *skb) 1378{ 1379 struct sk_buff *skb2; 1380 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data; 1381 struct ieee80211_local *local = hw_to_local(hw); 1382 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 1383 u16 frag, type; 1384 struct ieee80211_tx_status_rtap_hdr *rthdr; 1385 struct ieee80211_sub_if_data *sdata; 1386 struct net_device *prev_dev = NULL; 1387 1388 rcu_read_lock(); 1389 1390 if (info->status.excessive_retries) { 1391 struct sta_info *sta; 1392 sta = sta_info_get(local, hdr->addr1); 1393 if (sta) { 1394 if (test_sta_flags(sta, WLAN_STA_PS)) { 1395 /* 1396 * The STA is in power save mode, so assume 1397 * that this TX packet failed because of that. 1398 */ 1399 ieee80211_handle_filtered_frame(local, sta, skb); 1400 rcu_read_unlock(); 1401 return; 1402 } 1403 } 1404 } 1405 1406 if (info->flags & IEEE80211_TX_STAT_TX_FILTERED) { 1407 struct sta_info *sta; 1408 sta = sta_info_get(local, hdr->addr1); 1409 if (sta) { 1410 ieee80211_handle_filtered_frame(local, sta, skb); 1411 rcu_read_unlock(); 1412 return; 1413 } 1414 } else 1415 rate_control_tx_status(local->mdev, skb); 1416 1417 rcu_read_unlock(); 1418 1419 ieee80211_led_tx(local, 0); 1420 1421 /* SNMP counters 1422 * Fragments are passed to low-level drivers as separate skbs, so these 1423 * are actually fragments, not frames. Update frame counters only for 1424 * the first fragment of the frame. */ 1425 1426 frag = le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_FRAG; 1427 type = le16_to_cpu(hdr->frame_control) & IEEE80211_FCTL_FTYPE; 1428 1429 if (info->flags & IEEE80211_TX_STAT_ACK) { 1430 if (frag == 0) { 1431 local->dot11TransmittedFrameCount++; 1432 if (is_multicast_ether_addr(hdr->addr1)) 1433 local->dot11MulticastTransmittedFrameCount++; 1434 if (info->status.retry_count > 0) 1435 local->dot11RetryCount++; 1436 if (info->status.retry_count > 1) 1437 local->dot11MultipleRetryCount++; 1438 } 1439 1440 /* This counter shall be incremented for an acknowledged MPDU 1441 * with an individual address in the address 1 field or an MPDU 1442 * with a multicast address in the address 1 field of type Data 1443 * or Management. */ 1444 if (!is_multicast_ether_addr(hdr->addr1) || 1445 type == IEEE80211_FTYPE_DATA || 1446 type == IEEE80211_FTYPE_MGMT) 1447 local->dot11TransmittedFragmentCount++; 1448 } else { 1449 if (frag == 0) 1450 local->dot11FailedCount++; 1451 } 1452 1453 /* this was a transmitted frame, but now we want to reuse it */ 1454 skb_orphan(skb); 1455 1456 /* 1457 * This is a bit racy but we can avoid a lot of work 1458 * with this test... 1459 */ 1460 if (!local->monitors && !local->cooked_mntrs) { 1461 dev_kfree_skb(skb); 1462 return; 1463 } 1464 1465 /* send frame to monitor interfaces now */ 1466 1467 if (skb_headroom(skb) < sizeof(*rthdr)) { 1468 printk(KERN_ERR "ieee80211_tx_status: headroom too small\n"); 1469 dev_kfree_skb(skb); 1470 return; 1471 } 1472 1473 rthdr = (struct ieee80211_tx_status_rtap_hdr *) 1474 skb_push(skb, sizeof(*rthdr)); 1475 1476 memset(rthdr, 0, sizeof(*rthdr)); 1477 rthdr->hdr.it_len = cpu_to_le16(sizeof(*rthdr)); 1478 rthdr->hdr.it_present = 1479 cpu_to_le32((1 << IEEE80211_RADIOTAP_TX_FLAGS) | 1480 (1 << IEEE80211_RADIOTAP_DATA_RETRIES)); 1481 1482 if (!(info->flags & IEEE80211_TX_STAT_ACK) && 1483 !is_multicast_ether_addr(hdr->addr1)) 1484 rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_FAIL); 1485 1486 if ((info->flags & IEEE80211_TX_CTL_USE_RTS_CTS) && 1487 (info->flags & IEEE80211_TX_CTL_USE_CTS_PROTECT)) 1488 rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_CTS); 1489 else if (info->flags & IEEE80211_TX_CTL_USE_RTS_CTS) 1490 rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_RTS); 1491 1492 rthdr->data_retries = info->status.retry_count; 1493 1494 /* XXX: is this sufficient for BPF? */ 1495 skb_set_mac_header(skb, 0); 1496 skb->ip_summed = CHECKSUM_UNNECESSARY; 1497 skb->pkt_type = PACKET_OTHERHOST; 1498 skb->protocol = htons(ETH_P_802_2); 1499 memset(skb->cb, 0, sizeof(skb->cb)); 1500 1501 rcu_read_lock(); 1502 list_for_each_entry_rcu(sdata, &local->interfaces, list) { 1503 if (sdata->vif.type == IEEE80211_IF_TYPE_MNTR) { 1504 if (!netif_running(sdata->dev)) 1505 continue; 1506 1507 if (prev_dev) { 1508 skb2 = skb_clone(skb, GFP_ATOMIC); 1509 if (skb2) { 1510 skb2->dev = prev_dev; 1511 netif_rx(skb2); 1512 } 1513 } 1514 1515 prev_dev = sdata->dev; 1516 } 1517 } 1518 if (prev_dev) { 1519 skb->dev = prev_dev; 1520 netif_rx(skb); 1521 skb = NULL; 1522 } 1523 rcu_read_unlock(); 1524 dev_kfree_skb(skb); 1525} 1526EXPORT_SYMBOL(ieee80211_tx_status); 1527 1528struct ieee80211_hw *ieee80211_alloc_hw(size_t priv_data_len, 1529 const struct ieee80211_ops *ops) 1530{ 1531 struct ieee80211_local *local; 1532 int priv_size; 1533 struct wiphy *wiphy; 1534 1535 /* Ensure 32-byte alignment of our private data and hw private data. 1536 * We use the wiphy priv data for both our ieee80211_local and for 1537 * the driver's private data 1538 * 1539 * In memory it'll be like this: 1540 * 1541 * +-------------------------+ 1542 * | struct wiphy | 1543 * +-------------------------+ 1544 * | struct ieee80211_local | 1545 * +-------------------------+ 1546 * | driver's private data | 1547 * +-------------------------+ 1548 * 1549 */ 1550 priv_size = ((sizeof(struct ieee80211_local) + 1551 NETDEV_ALIGN_CONST) & ~NETDEV_ALIGN_CONST) + 1552 priv_data_len; 1553 1554 wiphy = wiphy_new(&mac80211_config_ops, priv_size); 1555 1556 if (!wiphy) 1557 return NULL; 1558 1559 wiphy->privid = mac80211_wiphy_privid; 1560 1561 local = wiphy_priv(wiphy); 1562 local->hw.wiphy = wiphy; 1563 1564 local->hw.priv = (char *)local + 1565 ((sizeof(struct ieee80211_local) + 1566 NETDEV_ALIGN_CONST) & ~NETDEV_ALIGN_CONST); 1567 1568 BUG_ON(!ops->tx); 1569 BUG_ON(!ops->start); 1570 BUG_ON(!ops->stop); 1571 BUG_ON(!ops->config); 1572 BUG_ON(!ops->add_interface); 1573 BUG_ON(!ops->remove_interface); 1574 BUG_ON(!ops->configure_filter); 1575 local->ops = ops; 1576 1577 local->hw.queues = 1; /* default */ 1578 1579 local->bridge_packets = 1; 1580 1581 local->rts_threshold = IEEE80211_MAX_RTS_THRESHOLD; 1582 local->fragmentation_threshold = IEEE80211_MAX_FRAG_THRESHOLD; 1583 local->short_retry_limit = 7; 1584 local->long_retry_limit = 4; 1585 local->hw.conf.radio_enabled = 1; 1586 1587 INIT_LIST_HEAD(&local->interfaces); 1588 1589 spin_lock_init(&local->key_lock); 1590 1591 INIT_DELAYED_WORK(&local->scan_work, ieee80211_sta_scan_work); 1592 1593 sta_info_init(local); 1594 1595 tasklet_init(&local->tx_pending_tasklet, ieee80211_tx_pending, 1596 (unsigned long)local); 1597 tasklet_disable(&local->tx_pending_tasklet); 1598 1599 tasklet_init(&local->tasklet, 1600 ieee80211_tasklet_handler, 1601 (unsigned long) local); 1602 tasklet_disable(&local->tasklet); 1603 1604 skb_queue_head_init(&local->skb_queue); 1605 skb_queue_head_init(&local->skb_queue_unreliable); 1606 1607 return local_to_hw(local); 1608} 1609EXPORT_SYMBOL(ieee80211_alloc_hw); 1610 1611int ieee80211_register_hw(struct ieee80211_hw *hw) 1612{ 1613 struct ieee80211_local *local = hw_to_local(hw); 1614 const char *name; 1615 int result; 1616 enum ieee80211_band band; 1617 struct net_device *mdev; 1618 struct ieee80211_sub_if_data *sdata; 1619 1620 /* 1621 * generic code guarantees at least one band, 1622 * set this very early because much code assumes 1623 * that hw.conf.channel is assigned 1624 */ 1625 for (band = 0; band < IEEE80211_NUM_BANDS; band++) { 1626 struct ieee80211_supported_band *sband; 1627 1628 sband = local->hw.wiphy->bands[band]; 1629 if (sband) { 1630 /* init channel we're on */ 1631 local->hw.conf.channel = 1632 local->oper_channel = 1633 local->scan_channel = &sband->channels[0]; 1634 break; 1635 } 1636 } 1637 1638 result = wiphy_register(local->hw.wiphy); 1639 if (result < 0) 1640 return result; 1641 1642 /* 1643 * We use the number of queues for feature tests (QoS, HT) internally 1644 * so restrict them appropriately. 1645 */ 1646#ifdef CONFIG_MAC80211_QOS 1647 if (hw->queues > IEEE80211_MAX_QUEUES) 1648 hw->queues = IEEE80211_MAX_QUEUES; 1649 if (hw->ampdu_queues > IEEE80211_MAX_AMPDU_QUEUES) 1650 hw->ampdu_queues = IEEE80211_MAX_AMPDU_QUEUES; 1651 if (hw->queues < 4) 1652 hw->ampdu_queues = 0; 1653#else 1654 hw->queues = 1; 1655 hw->ampdu_queues = 0; 1656#endif 1657 1658 /* for now, mdev needs sub_if_data :/ */ 1659 mdev = alloc_netdev_mq(sizeof(struct ieee80211_sub_if_data), 1660 "wmaster%d", ether_setup, 1661 ieee80211_num_queues(hw)); 1662 if (!mdev) 1663 goto fail_mdev_alloc; 1664 1665 if (ieee80211_num_queues(hw) > 1) 1666 mdev->features |= NETIF_F_MULTI_QUEUE; 1667 1668 sdata = IEEE80211_DEV_TO_SUB_IF(mdev); 1669 mdev->ieee80211_ptr = &sdata->wdev; 1670 sdata->wdev.wiphy = local->hw.wiphy; 1671 1672 local->mdev = mdev; 1673 1674 ieee80211_rx_bss_list_init(mdev); 1675 1676 mdev->hard_start_xmit = ieee80211_master_start_xmit; 1677 mdev->open = ieee80211_master_open; 1678 mdev->stop = ieee80211_master_stop; 1679 mdev->type = ARPHRD_IEEE80211; 1680 mdev->header_ops = &ieee80211_header_ops; 1681 mdev->set_multicast_list = ieee80211_master_set_multicast_list; 1682 1683 sdata->vif.type = IEEE80211_IF_TYPE_AP; 1684 sdata->dev = mdev; 1685 sdata->local = local; 1686 sdata->u.ap.force_unicast_rateidx = -1; 1687 sdata->u.ap.max_ratectrl_rateidx = -1; 1688 ieee80211_if_sdata_init(sdata); 1689 1690 /* no RCU needed since we're still during init phase */ 1691 list_add_tail(&sdata->list, &local->interfaces); 1692 1693 name = wiphy_dev(local->hw.wiphy)->driver->name; 1694 local->hw.workqueue = create_freezeable_workqueue(name); 1695 if (!local->hw.workqueue) { 1696 result = -ENOMEM; 1697 goto fail_workqueue; 1698 } 1699 1700 /* 1701 * The hardware needs headroom for sending the frame, 1702 * and we need some headroom for passing the frame to monitor 1703 * interfaces, but never both at the same time. 1704 */ 1705 local->tx_headroom = max_t(unsigned int , local->hw.extra_tx_headroom, 1706 sizeof(struct ieee80211_tx_status_rtap_hdr)); 1707 1708 debugfs_hw_add(local); 1709 1710 if (local->hw.conf.beacon_int < 10) 1711 local->hw.conf.beacon_int = 100; 1712 1713 local->wstats_flags |= local->hw.flags & (IEEE80211_HW_SIGNAL_UNSPEC | 1714 IEEE80211_HW_SIGNAL_DB | 1715 IEEE80211_HW_SIGNAL_DBM) ? 1716 IW_QUAL_QUAL_UPDATED : IW_QUAL_QUAL_INVALID; 1717 local->wstats_flags |= local->hw.flags & IEEE80211_HW_NOISE_DBM ? 1718 IW_QUAL_NOISE_UPDATED : IW_QUAL_NOISE_INVALID; 1719 if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM) 1720 local->wstats_flags |= IW_QUAL_DBM; 1721 1722 result = sta_info_start(local); 1723 if (result < 0) 1724 goto fail_sta_info; 1725 1726 rtnl_lock(); 1727 result = dev_alloc_name(local->mdev, local->mdev->name); 1728 if (result < 0) 1729 goto fail_dev; 1730 1731 memcpy(local->mdev->dev_addr, local->hw.wiphy->perm_addr, ETH_ALEN); 1732 SET_NETDEV_DEV(local->mdev, wiphy_dev(local->hw.wiphy)); 1733 1734 result = register_netdevice(local->mdev); 1735 if (result < 0) 1736 goto fail_dev; 1737 1738 ieee80211_debugfs_add_netdev(IEEE80211_DEV_TO_SUB_IF(local->mdev)); 1739 ieee80211_if_set_type(local->mdev, IEEE80211_IF_TYPE_AP); 1740 1741 result = ieee80211_init_rate_ctrl_alg(local, 1742 hw->rate_control_algorithm); 1743 if (result < 0) { 1744 printk(KERN_DEBUG "%s: Failed to initialize rate control " 1745 "algorithm\n", wiphy_name(local->hw.wiphy)); 1746 goto fail_rate; 1747 } 1748 1749 result = ieee80211_wep_init(local); 1750 1751 if (result < 0) { 1752 printk(KERN_DEBUG "%s: Failed to initialize wep\n", 1753 wiphy_name(local->hw.wiphy)); 1754 goto fail_wep; 1755 } 1756 1757 ieee80211_install_qdisc(local->mdev); 1758 1759 /* add one default STA interface */ 1760 result = ieee80211_if_add(local->mdev, "wlan%d", NULL, 1761 IEEE80211_IF_TYPE_STA, NULL); 1762 if (result) 1763 printk(KERN_WARNING "%s: Failed to add default virtual iface\n", 1764 wiphy_name(local->hw.wiphy)); 1765 1766 local->reg_state = IEEE80211_DEV_REGISTERED; 1767 rtnl_unlock(); 1768 1769 ieee80211_led_init(local); 1770 1771 return 0; 1772 1773fail_wep: 1774 rate_control_deinitialize(local); 1775fail_rate: 1776 ieee80211_debugfs_remove_netdev(IEEE80211_DEV_TO_SUB_IF(local->mdev)); 1777 unregister_netdevice(local->mdev); 1778 local->mdev = NULL; 1779fail_dev: 1780 rtnl_unlock(); 1781 sta_info_stop(local); 1782fail_sta_info: 1783 debugfs_hw_del(local); 1784 destroy_workqueue(local->hw.workqueue); 1785fail_workqueue: 1786 if (local->mdev != NULL) { 1787 ieee80211_if_free(local->mdev); 1788 local->mdev = NULL; 1789 } 1790fail_mdev_alloc: 1791 wiphy_unregister(local->hw.wiphy); 1792 return result; 1793} 1794EXPORT_SYMBOL(ieee80211_register_hw); 1795 1796void ieee80211_unregister_hw(struct ieee80211_hw *hw) 1797{ 1798 struct ieee80211_local *local = hw_to_local(hw); 1799 struct ieee80211_sub_if_data *sdata, *tmp; 1800 1801 tasklet_kill(&local->tx_pending_tasklet); 1802 tasklet_kill(&local->tasklet); 1803 1804 rtnl_lock(); 1805 1806 BUG_ON(local->reg_state != IEEE80211_DEV_REGISTERED); 1807 1808 local->reg_state = IEEE80211_DEV_UNREGISTERED; 1809 1810 /* 1811 * At this point, interface list manipulations are fine 1812 * because the driver cannot be handing us frames any 1813 * more and the tasklet is killed. 1814 */ 1815 1816 /* 1817 * First, we remove all non-master interfaces. Do this because they 1818 * may have bss pointer dependency on the master, and when we free 1819 * the master these would be freed as well, breaking our list 1820 * iteration completely. 1821 */ 1822 list_for_each_entry_safe(sdata, tmp, &local->interfaces, list) { 1823 if (sdata->dev == local->mdev) 1824 continue; 1825 list_del(&sdata->list); 1826 __ieee80211_if_del(local, sdata); 1827 } 1828 1829 /* then, finally, remove the master interface */ 1830 __ieee80211_if_del(local, IEEE80211_DEV_TO_SUB_IF(local->mdev)); 1831 1832 rtnl_unlock(); 1833 1834 ieee80211_rx_bss_list_deinit(local->mdev); 1835 ieee80211_clear_tx_pending(local); 1836 sta_info_stop(local); 1837 rate_control_deinitialize(local); 1838 debugfs_hw_del(local); 1839 1840 if (skb_queue_len(&local->skb_queue) 1841 || skb_queue_len(&local->skb_queue_unreliable)) 1842 printk(KERN_WARNING "%s: skb_queue not empty\n", 1843 wiphy_name(local->hw.wiphy)); 1844 skb_queue_purge(&local->skb_queue); 1845 skb_queue_purge(&local->skb_queue_unreliable); 1846 1847 destroy_workqueue(local->hw.workqueue); 1848 wiphy_unregister(local->hw.wiphy); 1849 ieee80211_wep_free(local); 1850 ieee80211_led_exit(local); 1851 ieee80211_if_free(local->mdev); 1852 local->mdev = NULL; 1853} 1854EXPORT_SYMBOL(ieee80211_unregister_hw); 1855 1856void ieee80211_free_hw(struct ieee80211_hw *hw) 1857{ 1858 struct ieee80211_local *local = hw_to_local(hw); 1859 1860 wiphy_free(local->hw.wiphy); 1861} 1862EXPORT_SYMBOL(ieee80211_free_hw); 1863 1864static int __init ieee80211_init(void) 1865{ 1866 struct sk_buff *skb; 1867 int ret; 1868 1869 BUILD_BUG_ON(sizeof(struct ieee80211_tx_info) > sizeof(skb->cb)); 1870 BUILD_BUG_ON(offsetof(struct ieee80211_tx_info, driver_data) + 1871 IEEE80211_TX_INFO_DRIVER_DATA_SIZE > sizeof(skb->cb)); 1872 1873 ret = rc80211_pid_init(); 1874 if (ret) 1875 goto out; 1876 1877 ret = ieee80211_wme_register(); 1878 if (ret) { 1879 printk(KERN_DEBUG "ieee80211_init: failed to " 1880 "initialize WME (err=%d)\n", ret); 1881 goto out_cleanup_pid; 1882 } 1883 1884 ieee80211_debugfs_netdev_init(); 1885 1886 return 0; 1887 1888 out_cleanup_pid: 1889 rc80211_pid_exit(); 1890 out: 1891 return ret; 1892} 1893 1894static void __exit ieee80211_exit(void) 1895{ 1896 rc80211_pid_exit(); 1897 1898 /* 1899 * For key todo, it'll be empty by now but the work 1900 * might still be scheduled. 1901 */ 1902 flush_scheduled_work(); 1903 1904 if (mesh_allocated) 1905 ieee80211s_stop(); 1906 1907 ieee80211_wme_unregister(); 1908 ieee80211_debugfs_netdev_exit(); 1909} 1910 1911 1912subsys_initcall(ieee80211_init); 1913module_exit(ieee80211_exit); 1914 1915MODULE_DESCRIPTION("IEEE 802.11 subsystem"); 1916MODULE_LICENSE("GPL"); 1917