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 <linux/module.h> 13 #include <linux/init.h> 14 #include <linux/netdevice.h> 15 #include <linux/types.h> 16 #include <linux/slab.h> 17 #include <linux/skbuff.h> 18 #include <linux/etherdevice.h> 19 #include <linux/if_arp.h> 20 #include <linux/rtnetlink.h> 21 #include <linux/bitmap.h> 22 #include <linux/pm_qos_params.h> 23 #include <linux/inetdevice.h> 24 #include <net/net_namespace.h> 25 #include <net/cfg80211.h> 26 27 #include "ieee80211_i.h" 28 #include "driver-ops.h" 29 #include "rate.h" 30 #include "mesh.h" 31 #include "wep.h" 32 #include "led.h" 33 #include "cfg.h" 34 #include "debugfs.h" 35 36 37 bool ieee80211_disable_40mhz_24ghz; 38 module_param(ieee80211_disable_40mhz_24ghz, bool, 0644); 39 MODULE_PARM_DESC(ieee80211_disable_40mhz_24ghz, 40 "Disable 40MHz support in the 2.4GHz band"); 41 42 void ieee80211_configure_filter(struct ieee80211_local *local) 43 { 44 u64 mc; 45 unsigned int changed_flags; 46 unsigned int new_flags = 0; 47 48 if (atomic_read(&local->iff_promiscs)) 49 new_flags |= FIF_PROMISC_IN_BSS; 50 51 if (atomic_read(&local->iff_allmultis)) 52 new_flags |= FIF_ALLMULTI; 53 54 if (local->monitors || local->scanning) 55 new_flags |= FIF_BCN_PRBRESP_PROMISC; 56 57 if (local->fif_probe_req || local->probe_req_reg) 58 new_flags |= FIF_PROBE_REQ; 59 60 if (local->fif_fcsfail) 61 new_flags |= FIF_FCSFAIL; 62 63 if (local->fif_plcpfail) 64 new_flags |= FIF_PLCPFAIL; 65 66 if (local->fif_control) 67 new_flags |= FIF_CONTROL; 68 69 if (local->fif_other_bss) 70 new_flags |= FIF_OTHER_BSS; 71 72 if (local->fif_pspoll) 73 new_flags |= FIF_PSPOLL; 74 75 spin_lock_bh(&local->filter_lock); 76 changed_flags = local->filter_flags ^ new_flags; 77 78 mc = drv_prepare_multicast(local, &local->mc_list); 79 spin_unlock_bh(&local->filter_lock); 80 81 /* be a bit nasty */ 82 new_flags |= (1<<31); 83 84 drv_configure_filter(local, changed_flags, &new_flags, mc); 85 86 WARN_ON(new_flags & (1<<31)); 87 88 local->filter_flags = new_flags & ~(1<<31); 89 } 90 91 static void ieee80211_reconfig_filter(struct work_struct *work) 92 { 93 struct ieee80211_local *local = 94 container_of(work, struct ieee80211_local, reconfig_filter); 95 96 ieee80211_configure_filter(local); 97 } 98 99 int ieee80211_hw_config(struct ieee80211_local *local, u32 changed) 100 { 101 struct ieee80211_channel *chan, *scan_chan; 102 int ret = 0; 103 int power; 104 enum nl80211_channel_type channel_type; 105 u32 offchannel_flag; 106 107 might_sleep(); 108 109 scan_chan = local->scan_channel; 110 111 offchannel_flag = local->hw.conf.flags & IEEE80211_CONF_OFFCHANNEL; 112 if (scan_chan) { 113 chan = scan_chan; 114 channel_type = NL80211_CHAN_NO_HT; 115 local->hw.conf.flags |= IEEE80211_CONF_OFFCHANNEL; 116 } else if (local->tmp_channel && 117 local->oper_channel != local->tmp_channel) { 118 chan = scan_chan = local->tmp_channel; 119 channel_type = local->tmp_channel_type; 120 local->hw.conf.flags |= IEEE80211_CONF_OFFCHANNEL; 121 } else { 122 chan = local->oper_channel; 123 channel_type = local->_oper_channel_type; 124 local->hw.conf.flags &= ~IEEE80211_CONF_OFFCHANNEL; 125 } 126 offchannel_flag ^= local->hw.conf.flags & IEEE80211_CONF_OFFCHANNEL; 127 128 if (offchannel_flag || chan != local->hw.conf.channel || 129 channel_type != local->hw.conf.channel_type) { 130 local->hw.conf.channel = chan; 131 local->hw.conf.channel_type = channel_type; 132 changed |= IEEE80211_CONF_CHANGE_CHANNEL; 133 } 134 135 if (!conf_is_ht(&local->hw.conf)) { 136 /* 137 * mac80211.h documents that this is only valid 138 * when the channel is set to an HT type, and 139 * that otherwise STATIC is used. 140 */ 141 local->hw.conf.smps_mode = IEEE80211_SMPS_STATIC; 142 } else if (local->hw.conf.smps_mode != local->smps_mode) { 143 local->hw.conf.smps_mode = local->smps_mode; 144 changed |= IEEE80211_CONF_CHANGE_SMPS; 145 } 146 147 if (scan_chan) 148 power = chan->max_power; 149 else 150 power = local->power_constr_level ? 151 (chan->max_power - local->power_constr_level) : 152 chan->max_power; 153 154 if (local->user_power_level >= 0) 155 power = min(power, local->user_power_level); 156 157 if (local->hw.conf.power_level != power) { 158 changed |= IEEE80211_CONF_CHANGE_POWER; 159 local->hw.conf.power_level = power; 160 } 161 162 if (changed && local->open_count) { 163 ret = drv_config(local, changed); 164 /* 165 * Goal: 166 * HW reconfiguration should never fail, the driver has told 167 * us what it can support so it should live up to that promise. 168 * 169 * Current status: 170 * rfkill is not integrated with mac80211 and a 171 * configuration command can thus fail if hardware rfkill 172 * is enabled 173 * 174 * FIXME: integrate rfkill with mac80211 and then add this 175 * WARN_ON() back 176 * 177 */ 178 /* WARN_ON(ret); */ 179 } 180 181 return ret; 182 } 183 184 void ieee80211_bss_info_change_notify(struct ieee80211_sub_if_data *sdata, 185 u32 changed) 186 { 187 struct ieee80211_local *local = sdata->local; 188 static const u8 zero[ETH_ALEN] = { 0 }; 189 190 if (!changed) 191 return; 192 193 if (sdata->vif.type == NL80211_IFTYPE_STATION) { 194 /* 195 * While not associated, claim a BSSID of all-zeroes 196 * so that drivers don't do any weird things with the 197 * BSSID at that time. 198 */ 199 if (sdata->vif.bss_conf.assoc) 200 sdata->vif.bss_conf.bssid = sdata->u.mgd.bssid; 201 else 202 sdata->vif.bss_conf.bssid = zero; 203 } else if (sdata->vif.type == NL80211_IFTYPE_ADHOC) 204 sdata->vif.bss_conf.bssid = sdata->u.ibss.bssid; 205 else if (sdata->vif.type == NL80211_IFTYPE_AP) 206 sdata->vif.bss_conf.bssid = sdata->vif.addr; 207 else if (sdata->vif.type == NL80211_IFTYPE_WDS) 208 sdata->vif.bss_conf.bssid = NULL; 209 else if (ieee80211_vif_is_mesh(&sdata->vif)) { 210 sdata->vif.bss_conf.bssid = zero; 211 } else { 212 WARN_ON(1); 213 return; 214 } 215 216 switch (sdata->vif.type) { 217 case NL80211_IFTYPE_AP: 218 case NL80211_IFTYPE_ADHOC: 219 case NL80211_IFTYPE_WDS: 220 case NL80211_IFTYPE_MESH_POINT: 221 break; 222 default: 223 /* do not warn to simplify caller in scan.c */ 224 changed &= ~BSS_CHANGED_BEACON_ENABLED; 225 if (WARN_ON(changed & BSS_CHANGED_BEACON)) 226 return; 227 break; 228 } 229 230 if (changed & BSS_CHANGED_BEACON_ENABLED) { 231 if (local->quiescing || !ieee80211_sdata_running(sdata) || 232 test_bit(SCAN_SW_SCANNING, &local->scanning)) { 233 sdata->vif.bss_conf.enable_beacon = false; 234 } else { 235 /* 236 * Beacon should be enabled, but AP mode must 237 * check whether there is a beacon configured. 238 */ 239 switch (sdata->vif.type) { 240 case NL80211_IFTYPE_AP: 241 sdata->vif.bss_conf.enable_beacon = 242 !!sdata->u.ap.beacon; 243 break; 244 case NL80211_IFTYPE_ADHOC: 245 sdata->vif.bss_conf.enable_beacon = 246 !!sdata->u.ibss.presp; 247 break; 248 #ifdef CONFIG_MAC80211_MESH 249 case NL80211_IFTYPE_MESH_POINT: 250 sdata->vif.bss_conf.enable_beacon = 251 !!sdata->u.mesh.mesh_id_len; 252 break; 253 #endif 254 default: 255 /* not reached */ 256 WARN_ON(1); 257 break; 258 } 259 } 260 } 261 262 drv_bss_info_changed(local, sdata, &sdata->vif.bss_conf, changed); 263 } 264 265 u32 ieee80211_reset_erp_info(struct ieee80211_sub_if_data *sdata) 266 { 267 sdata->vif.bss_conf.use_cts_prot = false; 268 sdata->vif.bss_conf.use_short_preamble = false; 269 sdata->vif.bss_conf.use_short_slot = false; 270 return BSS_CHANGED_ERP_CTS_PROT | 271 BSS_CHANGED_ERP_PREAMBLE | 272 BSS_CHANGED_ERP_SLOT; 273 } 274 275 static void ieee80211_tasklet_handler(unsigned long data) 276 { 277 struct ieee80211_local *local = (struct ieee80211_local *) data; 278 struct sk_buff *skb; 279 280 while ((skb = skb_dequeue(&local->skb_queue)) || 281 (skb = skb_dequeue(&local->skb_queue_unreliable))) { 282 switch (skb->pkt_type) { 283 case IEEE80211_RX_MSG: 284 /* Clear skb->pkt_type in order to not confuse kernel 285 * netstack. */ 286 skb->pkt_type = 0; 287 ieee80211_rx(local_to_hw(local), skb); 288 break; 289 case IEEE80211_TX_STATUS_MSG: 290 skb->pkt_type = 0; 291 ieee80211_tx_status(local_to_hw(local), skb); 292 break; 293 default: 294 WARN(1, "mac80211: Packet is of unknown type %d\n", 295 skb->pkt_type); 296 dev_kfree_skb(skb); 297 break; 298 } 299 } 300 } 301 302 static void ieee80211_restart_work(struct work_struct *work) 303 { 304 struct ieee80211_local *local = 305 container_of(work, struct ieee80211_local, restart_work); 306 307 /* wait for scan work complete */ 308 flush_workqueue(local->workqueue); 309 310 mutex_lock(&local->mtx); 311 WARN(test_bit(SCAN_HW_SCANNING, &local->scanning), 312 "%s called with hardware scan in progress\n", __func__); 313 mutex_unlock(&local->mtx); 314 315 rtnl_lock(); 316 ieee80211_scan_cancel(local); 317 ieee80211_reconfig(local); 318 rtnl_unlock(); 319 } 320 321 void ieee80211_restart_hw(struct ieee80211_hw *hw) 322 { 323 struct ieee80211_local *local = hw_to_local(hw); 324 325 trace_api_restart_hw(local); 326 327 /* use this reason, ieee80211_reconfig will unblock it */ 328 ieee80211_stop_queues_by_reason(hw, 329 IEEE80211_QUEUE_STOP_REASON_SUSPEND); 330 331 schedule_work(&local->restart_work); 332 } 333 EXPORT_SYMBOL(ieee80211_restart_hw); 334 335 static void ieee80211_recalc_smps_work(struct work_struct *work) 336 { 337 struct ieee80211_local *local = 338 container_of(work, struct ieee80211_local, recalc_smps); 339 340 mutex_lock(&local->iflist_mtx); 341 ieee80211_recalc_smps(local); 342 mutex_unlock(&local->iflist_mtx); 343 } 344 345 #ifdef CONFIG_INET 346 static int ieee80211_ifa_changed(struct notifier_block *nb, 347 unsigned long data, void *arg) 348 { 349 struct in_ifaddr *ifa = arg; 350 struct ieee80211_local *local = 351 container_of(nb, struct ieee80211_local, 352 ifa_notifier); 353 struct net_device *ndev = ifa->ifa_dev->dev; 354 struct wireless_dev *wdev = ndev->ieee80211_ptr; 355 struct in_device *idev; 356 struct ieee80211_sub_if_data *sdata; 357 struct ieee80211_bss_conf *bss_conf; 358 struct ieee80211_if_managed *ifmgd; 359 int c = 0; 360 361 /* Make sure it's our interface that got changed */ 362 if (!wdev) 363 return NOTIFY_DONE; 364 365 if (wdev->wiphy != local->hw.wiphy) 366 return NOTIFY_DONE; 367 368 sdata = IEEE80211_DEV_TO_SUB_IF(ndev); 369 bss_conf = &sdata->vif.bss_conf; 370 371 if (!ieee80211_sdata_running(sdata)) 372 return NOTIFY_DONE; 373 374 /* ARP filtering is only supported in managed mode */ 375 if (sdata->vif.type != NL80211_IFTYPE_STATION) 376 return NOTIFY_DONE; 377 378 idev = __in_dev_get_rtnl(sdata->dev); 379 if (!idev) 380 return NOTIFY_DONE; 381 382 ifmgd = &sdata->u.mgd; 383 mutex_lock(&ifmgd->mtx); 384 385 /* Copy the addresses to the bss_conf list */ 386 ifa = idev->ifa_list; 387 while (c < IEEE80211_BSS_ARP_ADDR_LIST_LEN && ifa) { 388 bss_conf->arp_addr_list[c] = ifa->ifa_address; 389 ifa = ifa->ifa_next; 390 c++; 391 } 392 393 /* If not all addresses fit the list, disable filtering */ 394 if (ifa) { 395 sdata->arp_filter_state = false; 396 c = 0; 397 } else { 398 sdata->arp_filter_state = true; 399 } 400 bss_conf->arp_addr_cnt = c; 401 402 /* Configure driver only if associated */ 403 if (ifmgd->associated) { 404 bss_conf->arp_filter_enabled = sdata->arp_filter_state; 405 ieee80211_bss_info_change_notify(sdata, 406 BSS_CHANGED_ARP_FILTER); 407 } 408 409 mutex_unlock(&ifmgd->mtx); 410 411 return NOTIFY_DONE; 412 } 413 #endif 414 415 static int ieee80211_napi_poll(struct napi_struct *napi, int budget) 416 { 417 struct ieee80211_local *local = 418 container_of(napi, struct ieee80211_local, napi); 419 420 return local->ops->napi_poll(&local->hw, budget); 421 } 422 423 void ieee80211_napi_schedule(struct ieee80211_hw *hw) 424 { 425 struct ieee80211_local *local = hw_to_local(hw); 426 427 napi_schedule(&local->napi); 428 } 429 EXPORT_SYMBOL(ieee80211_napi_schedule); 430 431 void ieee80211_napi_complete(struct ieee80211_hw *hw) 432 { 433 struct ieee80211_local *local = hw_to_local(hw); 434 435 napi_complete(&local->napi); 436 } 437 EXPORT_SYMBOL(ieee80211_napi_complete); 438 439 /* There isn't a lot of sense in it, but you can transmit anything you like */ 440 static const struct ieee80211_txrx_stypes 441 ieee80211_default_mgmt_stypes[NUM_NL80211_IFTYPES] = { 442 [NL80211_IFTYPE_ADHOC] = { 443 .tx = 0xffff, 444 .rx = BIT(IEEE80211_STYPE_ACTION >> 4), 445 }, 446 [NL80211_IFTYPE_STATION] = { 447 .tx = 0xffff, 448 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 449 BIT(IEEE80211_STYPE_PROBE_REQ >> 4), 450 }, 451 [NL80211_IFTYPE_AP] = { 452 .tx = 0xffff, 453 .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | 454 BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | 455 BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | 456 BIT(IEEE80211_STYPE_DISASSOC >> 4) | 457 BIT(IEEE80211_STYPE_AUTH >> 4) | 458 BIT(IEEE80211_STYPE_DEAUTH >> 4) | 459 BIT(IEEE80211_STYPE_ACTION >> 4), 460 }, 461 [NL80211_IFTYPE_AP_VLAN] = { 462 /* copy AP */ 463 .tx = 0xffff, 464 .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | 465 BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | 466 BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | 467 BIT(IEEE80211_STYPE_DISASSOC >> 4) | 468 BIT(IEEE80211_STYPE_AUTH >> 4) | 469 BIT(IEEE80211_STYPE_DEAUTH >> 4) | 470 BIT(IEEE80211_STYPE_ACTION >> 4), 471 }, 472 [NL80211_IFTYPE_P2P_CLIENT] = { 473 .tx = 0xffff, 474 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 475 BIT(IEEE80211_STYPE_PROBE_REQ >> 4), 476 }, 477 [NL80211_IFTYPE_P2P_GO] = { 478 .tx = 0xffff, 479 .rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) | 480 BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) | 481 BIT(IEEE80211_STYPE_PROBE_REQ >> 4) | 482 BIT(IEEE80211_STYPE_DISASSOC >> 4) | 483 BIT(IEEE80211_STYPE_AUTH >> 4) | 484 BIT(IEEE80211_STYPE_DEAUTH >> 4) | 485 BIT(IEEE80211_STYPE_ACTION >> 4), 486 }, 487 [NL80211_IFTYPE_MESH_POINT] = { 488 .tx = 0xffff, 489 .rx = BIT(IEEE80211_STYPE_ACTION >> 4), 490 }, 491 }; 492 493 struct ieee80211_hw *ieee80211_alloc_hw(size_t priv_data_len, 494 const struct ieee80211_ops *ops) 495 { 496 struct ieee80211_local *local; 497 int priv_size, i; 498 struct wiphy *wiphy; 499 500 /* Ensure 32-byte alignment of our private data and hw private data. 501 * We use the wiphy priv data for both our ieee80211_local and for 502 * the driver's private data 503 * 504 * In memory it'll be like this: 505 * 506 * +-------------------------+ 507 * | struct wiphy | 508 * +-------------------------+ 509 * | struct ieee80211_local | 510 * +-------------------------+ 511 * | driver's private data | 512 * +-------------------------+ 513 * 514 */ 515 priv_size = ALIGN(sizeof(*local), NETDEV_ALIGN) + priv_data_len; 516 517 wiphy = wiphy_new(&mac80211_config_ops, priv_size); 518 519 if (!wiphy) 520 return NULL; 521 522 wiphy->mgmt_stypes = ieee80211_default_mgmt_stypes; 523 524 wiphy->privid = mac80211_wiphy_privid; 525 526 wiphy->flags |= WIPHY_FLAG_NETNS_OK | 527 WIPHY_FLAG_4ADDR_AP | 528 WIPHY_FLAG_4ADDR_STATION | 529 WIPHY_FLAG_SUPPORTS_SEPARATE_DEFAULT_KEYS; 530 531 if (!ops->set_key) 532 wiphy->flags |= WIPHY_FLAG_IBSS_RSN; 533 534 wiphy->bss_priv_size = sizeof(struct ieee80211_bss); 535 536 local = wiphy_priv(wiphy); 537 538 local->hw.wiphy = wiphy; 539 540 local->hw.priv = (char *)local + ALIGN(sizeof(*local), NETDEV_ALIGN); 541 542 BUG_ON(!ops->tx); 543 BUG_ON(!ops->start); 544 BUG_ON(!ops->stop); 545 BUG_ON(!ops->config); 546 BUG_ON(!ops->add_interface); 547 BUG_ON(!ops->remove_interface); 548 BUG_ON(!ops->configure_filter); 549 local->ops = ops; 550 551 /* set up some defaults */ 552 local->hw.queues = 1; 553 local->hw.max_rates = 1; 554 local->hw.max_report_rates = 0; 555 local->hw.conf.long_frame_max_tx_count = wiphy->retry_long; 556 local->hw.conf.short_frame_max_tx_count = wiphy->retry_short; 557 local->user_power_level = -1; 558 local->uapsd_queues = IEEE80211_DEFAULT_UAPSD_QUEUES; 559 local->uapsd_max_sp_len = IEEE80211_DEFAULT_MAX_SP_LEN; 560 561 INIT_LIST_HEAD(&local->interfaces); 562 563 __hw_addr_init(&local->mc_list); 564 565 mutex_init(&local->iflist_mtx); 566 mutex_init(&local->mtx); 567 568 mutex_init(&local->key_mtx); 569 spin_lock_init(&local->filter_lock); 570 spin_lock_init(&local->queue_stop_reason_lock); 571 572 skb_queue_head_init(&local->rx_skb_queue); 573 574 INIT_DELAYED_WORK(&local->scan_work, ieee80211_scan_work); 575 576 ieee80211_work_init(local); 577 578 INIT_WORK(&local->restart_work, ieee80211_restart_work); 579 580 INIT_WORK(&local->reconfig_filter, ieee80211_reconfig_filter); 581 INIT_WORK(&local->recalc_smps, ieee80211_recalc_smps_work); 582 local->smps_mode = IEEE80211_SMPS_OFF; 583 584 INIT_WORK(&local->dynamic_ps_enable_work, 585 ieee80211_dynamic_ps_enable_work); 586 INIT_WORK(&local->dynamic_ps_disable_work, 587 ieee80211_dynamic_ps_disable_work); 588 setup_timer(&local->dynamic_ps_timer, 589 ieee80211_dynamic_ps_timer, (unsigned long) local); 590 591 sta_info_init(local); 592 593 for (i = 0; i < IEEE80211_MAX_QUEUES; i++) { 594 skb_queue_head_init(&local->pending[i]); 595 atomic_set(&local->agg_queue_stop[i], 0); 596 } 597 tasklet_init(&local->tx_pending_tasklet, ieee80211_tx_pending, 598 (unsigned long)local); 599 600 tasklet_init(&local->tasklet, 601 ieee80211_tasklet_handler, 602 (unsigned long) local); 603 604 skb_queue_head_init(&local->skb_queue); 605 skb_queue_head_init(&local->skb_queue_unreliable); 606 607 /* init dummy netdev for use w/ NAPI */ 608 init_dummy_netdev(&local->napi_dev); 609 610 ieee80211_led_names(local); 611 612 ieee80211_hw_roc_setup(local); 613 614 return local_to_hw(local); 615 } 616 EXPORT_SYMBOL(ieee80211_alloc_hw); 617 618 int ieee80211_register_hw(struct ieee80211_hw *hw) 619 { 620 struct ieee80211_local *local = hw_to_local(hw); 621 int result; 622 enum ieee80211_band band; 623 int channels, max_bitrates; 624 bool supp_ht; 625 static const u32 cipher_suites[] = { 626 /* keep WEP first, it may be removed below */ 627 WLAN_CIPHER_SUITE_WEP40, 628 WLAN_CIPHER_SUITE_WEP104, 629 WLAN_CIPHER_SUITE_TKIP, 630 WLAN_CIPHER_SUITE_CCMP, 631 632 /* keep last -- depends on hw flags! */ 633 WLAN_CIPHER_SUITE_AES_CMAC 634 }; 635 636 if (hw->max_report_rates == 0) 637 hw->max_report_rates = hw->max_rates; 638 639 /* 640 * generic code guarantees at least one band, 641 * set this very early because much code assumes 642 * that hw.conf.channel is assigned 643 */ 644 channels = 0; 645 max_bitrates = 0; 646 supp_ht = false; 647 for (band = 0; band < IEEE80211_NUM_BANDS; band++) { 648 struct ieee80211_supported_band *sband; 649 650 sband = local->hw.wiphy->bands[band]; 651 if (!sband) 652 continue; 653 if (!local->oper_channel) { 654 /* init channel we're on */ 655 local->hw.conf.channel = 656 local->oper_channel = &sband->channels[0]; 657 local->hw.conf.channel_type = NL80211_CHAN_NO_HT; 658 } 659 channels += sband->n_channels; 660 661 if (max_bitrates < sband->n_bitrates) 662 max_bitrates = sband->n_bitrates; 663 supp_ht = supp_ht || sband->ht_cap.ht_supported; 664 } 665 666 local->int_scan_req = kzalloc(sizeof(*local->int_scan_req) + 667 sizeof(void *) * channels, GFP_KERNEL); 668 if (!local->int_scan_req) 669 return -ENOMEM; 670 671 /* if low-level driver supports AP, we also support VLAN */ 672 if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_AP)) 673 local->hw.wiphy->interface_modes |= BIT(NL80211_IFTYPE_AP_VLAN); 674 675 /* mac80211 always supports monitor */ 676 local->hw.wiphy->interface_modes |= BIT(NL80211_IFTYPE_MONITOR); 677 678 #ifndef CONFIG_MAC80211_MESH 679 /* mesh depends on Kconfig, but drivers should set it if they want */ 680 local->hw.wiphy->interface_modes &= ~BIT(NL80211_IFTYPE_MESH_POINT); 681 #endif 682 683 /* mac80211 supports control port protocol changing */ 684 local->hw.wiphy->flags |= WIPHY_FLAG_CONTROL_PORT_PROTOCOL; 685 686 if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM) 687 local->hw.wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 688 else if (local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC) 689 local->hw.wiphy->signal_type = CFG80211_SIGNAL_TYPE_UNSPEC; 690 691 WARN((local->hw.flags & IEEE80211_HW_SUPPORTS_UAPSD) 692 && (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK), 693 "U-APSD not supported with HW_PS_NULLFUNC_STACK\n"); 694 695 /* 696 * Calculate scan IE length -- we need this to alloc 697 * memory and to subtract from the driver limit. It 698 * includes the DS Params, (extended) supported rates, and HT 699 * information -- SSID is the driver's responsibility. 700 */ 701 local->scan_ies_len = 4 + max_bitrates /* (ext) supp rates */ + 702 3 /* DS Params */; 703 if (supp_ht) 704 local->scan_ies_len += 2 + sizeof(struct ieee80211_ht_cap); 705 706 if (!local->ops->hw_scan) { 707 /* For hw_scan, driver needs to set these up. */ 708 local->hw.wiphy->max_scan_ssids = 4; 709 local->hw.wiphy->max_scan_ie_len = IEEE80211_MAX_DATA_LEN; 710 } 711 712 /* 713 * If the driver supports any scan IEs, then assume the 714 * limit includes the IEs mac80211 will add, otherwise 715 * leave it at zero and let the driver sort it out; we 716 * still pass our IEs to the driver but userspace will 717 * not be allowed to in that case. 718 */ 719 if (local->hw.wiphy->max_scan_ie_len) 720 local->hw.wiphy->max_scan_ie_len -= local->scan_ies_len; 721 722 /* Set up cipher suites unless driver already did */ 723 if (!local->hw.wiphy->cipher_suites) { 724 local->hw.wiphy->cipher_suites = cipher_suites; 725 local->hw.wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 726 if (!(local->hw.flags & IEEE80211_HW_MFP_CAPABLE)) 727 local->hw.wiphy->n_cipher_suites--; 728 } 729 if (IS_ERR(local->wep_tx_tfm) || IS_ERR(local->wep_rx_tfm)) { 730 if (local->hw.wiphy->cipher_suites == cipher_suites) { 731 local->hw.wiphy->cipher_suites += 2; 732 local->hw.wiphy->n_cipher_suites -= 2; 733 } else { 734 u32 *suites; 735 int r, w = 0; 736 737 /* Filter out WEP */ 738 739 suites = kmemdup( 740 local->hw.wiphy->cipher_suites, 741 sizeof(u32) * local->hw.wiphy->n_cipher_suites, 742 GFP_KERNEL); 743 if (!suites) 744 return -ENOMEM; 745 for (r = 0; r < local->hw.wiphy->n_cipher_suites; r++) { 746 u32 suite = local->hw.wiphy->cipher_suites[r]; 747 if (suite == WLAN_CIPHER_SUITE_WEP40 || 748 suite == WLAN_CIPHER_SUITE_WEP104) 749 continue; 750 suites[w++] = suite; 751 } 752 local->hw.wiphy->cipher_suites = suites; 753 local->hw.wiphy->n_cipher_suites = w; 754 local->wiphy_ciphers_allocated = true; 755 } 756 } 757 758 if (!local->ops->remain_on_channel) 759 local->hw.wiphy->max_remain_on_channel_duration = 5000; 760 761 result = wiphy_register(local->hw.wiphy); 762 if (result < 0) 763 goto fail_wiphy_register; 764 765 /* 766 * We use the number of queues for feature tests (QoS, HT) internally 767 * so restrict them appropriately. 768 */ 769 if (hw->queues > IEEE80211_MAX_QUEUES) 770 hw->queues = IEEE80211_MAX_QUEUES; 771 772 local->workqueue = 773 alloc_ordered_workqueue(wiphy_name(local->hw.wiphy), 0); 774 if (!local->workqueue) { 775 result = -ENOMEM; 776 goto fail_workqueue; 777 } 778 779 /* 780 * The hardware needs headroom for sending the frame, 781 * and we need some headroom for passing the frame to monitor 782 * interfaces, but never both at the same time. 783 */ 784 BUILD_BUG_ON(IEEE80211_TX_STATUS_HEADROOM != 785 sizeof(struct ieee80211_tx_status_rtap_hdr)); 786 local->tx_headroom = max_t(unsigned int , local->hw.extra_tx_headroom, 787 sizeof(struct ieee80211_tx_status_rtap_hdr)); 788 789 debugfs_hw_add(local); 790 791 /* 792 * if the driver doesn't specify a max listen interval we 793 * use 5 which should be a safe default 794 */ 795 if (local->hw.max_listen_interval == 0) 796 local->hw.max_listen_interval = 5; 797 798 local->hw.conf.listen_interval = local->hw.max_listen_interval; 799 800 local->dynamic_ps_forced_timeout = -1; 801 802 result = sta_info_start(local); 803 if (result < 0) 804 goto fail_sta_info; 805 806 result = ieee80211_wep_init(local); 807 if (result < 0) 808 wiphy_debug(local->hw.wiphy, "Failed to initialize wep: %d\n", 809 result); 810 811 rtnl_lock(); 812 813 result = ieee80211_init_rate_ctrl_alg(local, 814 hw->rate_control_algorithm); 815 if (result < 0) { 816 wiphy_debug(local->hw.wiphy, 817 "Failed to initialize rate control algorithm\n"); 818 goto fail_rate; 819 } 820 821 /* add one default STA interface if supported */ 822 if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_STATION)) { 823 result = ieee80211_if_add(local, "wlan%d", NULL, 824 NL80211_IFTYPE_STATION, NULL); 825 if (result) 826 wiphy_warn(local->hw.wiphy, 827 "Failed to add default virtual iface\n"); 828 } 829 830 rtnl_unlock(); 831 832 ieee80211_led_init(local); 833 834 local->network_latency_notifier.notifier_call = 835 ieee80211_max_network_latency; 836 result = pm_qos_add_notifier(PM_QOS_NETWORK_LATENCY, 837 &local->network_latency_notifier); 838 if (result) { 839 rtnl_lock(); 840 goto fail_pm_qos; 841 } 842 843 #ifdef CONFIG_INET 844 local->ifa_notifier.notifier_call = ieee80211_ifa_changed; 845 result = register_inetaddr_notifier(&local->ifa_notifier); 846 if (result) 847 goto fail_ifa; 848 #endif 849 850 netif_napi_add(&local->napi_dev, &local->napi, ieee80211_napi_poll, 851 local->hw.napi_weight); 852 853 return 0; 854 855 #ifdef CONFIG_INET 856 fail_ifa: 857 pm_qos_remove_notifier(PM_QOS_NETWORK_LATENCY, 858 &local->network_latency_notifier); 859 rtnl_lock(); 860 #endif 861 fail_pm_qos: 862 ieee80211_led_exit(local); 863 ieee80211_remove_interfaces(local); 864 fail_rate: 865 rtnl_unlock(); 866 ieee80211_wep_free(local); 867 sta_info_stop(local); 868 fail_sta_info: 869 destroy_workqueue(local->workqueue); 870 fail_workqueue: 871 wiphy_unregister(local->hw.wiphy); 872 fail_wiphy_register: 873 if (local->wiphy_ciphers_allocated) 874 kfree(local->hw.wiphy->cipher_suites); 875 kfree(local->int_scan_req); 876 return result; 877 } 878 EXPORT_SYMBOL(ieee80211_register_hw); 879 880 void ieee80211_unregister_hw(struct ieee80211_hw *hw) 881 { 882 struct ieee80211_local *local = hw_to_local(hw); 883 884 tasklet_kill(&local->tx_pending_tasklet); 885 tasklet_kill(&local->tasklet); 886 887 pm_qos_remove_notifier(PM_QOS_NETWORK_LATENCY, 888 &local->network_latency_notifier); 889 #ifdef CONFIG_INET 890 unregister_inetaddr_notifier(&local->ifa_notifier); 891 #endif 892 893 rtnl_lock(); 894 895 /* 896 * At this point, interface list manipulations are fine 897 * because the driver cannot be handing us frames any 898 * more and the tasklet is killed. 899 */ 900 ieee80211_remove_interfaces(local); 901 902 rtnl_unlock(); 903 904 /* 905 * Now all work items will be gone, but the 906 * timer might still be armed, so delete it 907 */ 908 del_timer_sync(&local->work_timer); 909 910 cancel_work_sync(&local->restart_work); 911 cancel_work_sync(&local->reconfig_filter); 912 913 ieee80211_clear_tx_pending(local); 914 sta_info_stop(local); 915 rate_control_deinitialize(local); 916 917 if (skb_queue_len(&local->skb_queue) || 918 skb_queue_len(&local->skb_queue_unreliable)) 919 wiphy_warn(local->hw.wiphy, "skb_queue not empty\n"); 920 skb_queue_purge(&local->skb_queue); 921 skb_queue_purge(&local->skb_queue_unreliable); 922 skb_queue_purge(&local->rx_skb_queue); 923 924 destroy_workqueue(local->workqueue); 925 wiphy_unregister(local->hw.wiphy); 926 ieee80211_wep_free(local); 927 ieee80211_led_exit(local); 928 kfree(local->int_scan_req); 929 } 930 EXPORT_SYMBOL(ieee80211_unregister_hw); 931 932 void ieee80211_free_hw(struct ieee80211_hw *hw) 933 { 934 struct ieee80211_local *local = hw_to_local(hw); 935 936 mutex_destroy(&local->iflist_mtx); 937 mutex_destroy(&local->mtx); 938 939 if (local->wiphy_ciphers_allocated) 940 kfree(local->hw.wiphy->cipher_suites); 941 942 wiphy_free(local->hw.wiphy); 943 } 944 EXPORT_SYMBOL(ieee80211_free_hw); 945 946 static int __init ieee80211_init(void) 947 { 948 struct sk_buff *skb; 949 int ret; 950 951 BUILD_BUG_ON(sizeof(struct ieee80211_tx_info) > sizeof(skb->cb)); 952 BUILD_BUG_ON(offsetof(struct ieee80211_tx_info, driver_data) + 953 IEEE80211_TX_INFO_DRIVER_DATA_SIZE > sizeof(skb->cb)); 954 955 ret = rc80211_minstrel_init(); 956 if (ret) 957 return ret; 958 959 ret = rc80211_minstrel_ht_init(); 960 if (ret) 961 goto err_minstrel; 962 963 ret = rc80211_pid_init(); 964 if (ret) 965 goto err_pid; 966 967 ret = ieee80211_iface_init(); 968 if (ret) 969 goto err_netdev; 970 971 return 0; 972 err_netdev: 973 rc80211_pid_exit(); 974 err_pid: 975 rc80211_minstrel_ht_exit(); 976 err_minstrel: 977 rc80211_minstrel_exit(); 978 979 return ret; 980 } 981 982 static void __exit ieee80211_exit(void) 983 { 984 rc80211_pid_exit(); 985 rc80211_minstrel_ht_exit(); 986 rc80211_minstrel_exit(); 987 988 if (mesh_allocated) 989 ieee80211s_stop(); 990 991 ieee80211_iface_exit(); 992 } 993 994 995 subsys_initcall(ieee80211_init); 996 module_exit(ieee80211_exit); 997 998 MODULE_DESCRIPTION("IEEE 802.11 subsystem"); 999 MODULE_LICENSE("GPL"); 1000