1 /* 2 * Interface handling (except master interface) 3 * 4 * Copyright 2002-2005, Instant802 Networks, Inc. 5 * Copyright 2005-2006, Devicescape Software, Inc. 6 * Copyright (c) 2006 Jiri Benc <jbenc@suse.cz> 7 * Copyright 2008, Johannes Berg <johannes@sipsolutions.net> 8 * 9 * This program is free software; you can redistribute it and/or modify 10 * it under the terms of the GNU General Public License version 2 as 11 * published by the Free Software Foundation. 12 */ 13 #include <linux/slab.h> 14 #include <linux/kernel.h> 15 #include <linux/if_arp.h> 16 #include <linux/netdevice.h> 17 #include <linux/rtnetlink.h> 18 #include <net/mac80211.h> 19 #include <net/ieee80211_radiotap.h> 20 #include "ieee80211_i.h" 21 #include "sta_info.h" 22 #include "debugfs_netdev.h" 23 #include "mesh.h" 24 #include "led.h" 25 #include "driver-ops.h" 26 #include "wme.h" 27 28 /** 29 * DOC: Interface list locking 30 * 31 * The interface list in each struct ieee80211_local is protected 32 * three-fold: 33 * 34 * (1) modifications may only be done under the RTNL 35 * (2) modifications and readers are protected against each other by 36 * the iflist_mtx. 37 * (3) modifications are done in an RCU manner so atomic readers 38 * can traverse the list in RCU-safe blocks. 39 * 40 * As a consequence, reads (traversals) of the list can be protected 41 * by either the RTNL, the iflist_mtx or RCU. 42 */ 43 44 45 static int ieee80211_change_mtu(struct net_device *dev, int new_mtu) 46 { 47 int meshhdrlen; 48 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 49 50 meshhdrlen = (sdata->vif.type == NL80211_IFTYPE_MESH_POINT) ? 5 : 0; 51 52 /* FIX: what would be proper limits for MTU? 53 * This interface uses 802.3 frames. */ 54 if (new_mtu < 256 || 55 new_mtu > IEEE80211_MAX_DATA_LEN - 24 - 6 - meshhdrlen) { 56 return -EINVAL; 57 } 58 59 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG 60 printk(KERN_DEBUG "%s: setting MTU %d\n", dev->name, new_mtu); 61 #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */ 62 dev->mtu = new_mtu; 63 return 0; 64 } 65 66 static int ieee80211_change_mac(struct net_device *dev, void *addr) 67 { 68 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 69 struct sockaddr *sa = addr; 70 int ret; 71 72 if (ieee80211_sdata_running(sdata)) 73 return -EBUSY; 74 75 ret = eth_mac_addr(dev, sa); 76 77 if (ret == 0) 78 memcpy(sdata->vif.addr, sa->sa_data, ETH_ALEN); 79 80 return ret; 81 } 82 83 static inline int identical_mac_addr_allowed(int type1, int type2) 84 { 85 return type1 == NL80211_IFTYPE_MONITOR || 86 type2 == NL80211_IFTYPE_MONITOR || 87 (type1 == NL80211_IFTYPE_AP && type2 == NL80211_IFTYPE_WDS) || 88 (type1 == NL80211_IFTYPE_WDS && 89 (type2 == NL80211_IFTYPE_WDS || 90 type2 == NL80211_IFTYPE_AP)) || 91 (type1 == NL80211_IFTYPE_AP && type2 == NL80211_IFTYPE_AP_VLAN) || 92 (type1 == NL80211_IFTYPE_AP_VLAN && 93 (type2 == NL80211_IFTYPE_AP || 94 type2 == NL80211_IFTYPE_AP_VLAN)); 95 } 96 97 static int ieee80211_open(struct net_device *dev) 98 { 99 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 100 struct ieee80211_sub_if_data *nsdata; 101 struct ieee80211_local *local = sdata->local; 102 struct sta_info *sta; 103 u32 changed = 0; 104 int res; 105 u32 hw_reconf_flags = 0; 106 u8 null_addr[ETH_ALEN] = {0}; 107 108 /* fail early if user set an invalid address */ 109 if (compare_ether_addr(dev->dev_addr, null_addr) && 110 !is_valid_ether_addr(dev->dev_addr)) 111 return -EADDRNOTAVAIL; 112 113 /* we hold the RTNL here so can safely walk the list */ 114 list_for_each_entry(nsdata, &local->interfaces, list) { 115 struct net_device *ndev = nsdata->dev; 116 117 if (ndev != dev && ieee80211_sdata_running(nsdata)) { 118 /* 119 * Allow only a single IBSS interface to be up at any 120 * time. This is restricted because beacon distribution 121 * cannot work properly if both are in the same IBSS. 122 * 123 * To remove this restriction we'd have to disallow them 124 * from setting the same SSID on different IBSS interfaces 125 * belonging to the same hardware. Then, however, we're 126 * faced with having to adopt two different TSF timers... 127 */ 128 if (sdata->vif.type == NL80211_IFTYPE_ADHOC && 129 nsdata->vif.type == NL80211_IFTYPE_ADHOC) 130 return -EBUSY; 131 132 /* 133 * The remaining checks are only performed for interfaces 134 * with the same MAC address. 135 */ 136 if (compare_ether_addr(dev->dev_addr, ndev->dev_addr)) 137 continue; 138 139 /* 140 * check whether it may have the same address 141 */ 142 if (!identical_mac_addr_allowed(sdata->vif.type, 143 nsdata->vif.type)) 144 return -ENOTUNIQ; 145 146 /* 147 * can only add VLANs to enabled APs 148 */ 149 if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN && 150 nsdata->vif.type == NL80211_IFTYPE_AP) 151 sdata->bss = &nsdata->u.ap; 152 } 153 } 154 155 switch (sdata->vif.type) { 156 case NL80211_IFTYPE_WDS: 157 if (!is_valid_ether_addr(sdata->u.wds.remote_addr)) 158 return -ENOLINK; 159 break; 160 case NL80211_IFTYPE_AP_VLAN: 161 if (!sdata->bss) 162 return -ENOLINK; 163 list_add(&sdata->u.vlan.list, &sdata->bss->vlans); 164 break; 165 case NL80211_IFTYPE_AP: 166 sdata->bss = &sdata->u.ap; 167 break; 168 case NL80211_IFTYPE_MESH_POINT: 169 if (!ieee80211_vif_is_mesh(&sdata->vif)) 170 break; 171 /* mesh ifaces must set allmulti to forward mcast traffic */ 172 atomic_inc(&local->iff_allmultis); 173 break; 174 case NL80211_IFTYPE_STATION: 175 case NL80211_IFTYPE_MONITOR: 176 case NL80211_IFTYPE_ADHOC: 177 /* no special treatment */ 178 break; 179 case NL80211_IFTYPE_UNSPECIFIED: 180 case __NL80211_IFTYPE_AFTER_LAST: 181 /* cannot happen */ 182 WARN_ON(1); 183 break; 184 } 185 186 if (local->open_count == 0) { 187 res = drv_start(local); 188 if (res) 189 goto err_del_bss; 190 /* we're brought up, everything changes */ 191 hw_reconf_flags = ~0; 192 ieee80211_led_radio(local, true); 193 } 194 195 /* 196 * Check all interfaces and copy the hopefully now-present 197 * MAC address to those that have the special null one. 198 */ 199 list_for_each_entry(nsdata, &local->interfaces, list) { 200 struct net_device *ndev = nsdata->dev; 201 202 /* 203 * No need to check running since we do not allow 204 * it to start up with this invalid address. 205 */ 206 if (compare_ether_addr(null_addr, ndev->dev_addr) == 0) { 207 memcpy(ndev->dev_addr, 208 local->hw.wiphy->perm_addr, 209 ETH_ALEN); 210 memcpy(ndev->perm_addr, ndev->dev_addr, ETH_ALEN); 211 } 212 } 213 214 /* 215 * Validate the MAC address for this device. 216 */ 217 if (!is_valid_ether_addr(dev->dev_addr)) { 218 if (!local->open_count) 219 drv_stop(local); 220 return -EADDRNOTAVAIL; 221 } 222 223 switch (sdata->vif.type) { 224 case NL80211_IFTYPE_AP_VLAN: 225 /* no need to tell driver */ 226 break; 227 case NL80211_IFTYPE_MONITOR: 228 if (sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES) { 229 local->cooked_mntrs++; 230 break; 231 } 232 233 /* must be before the call to ieee80211_configure_filter */ 234 local->monitors++; 235 if (local->monitors == 1) { 236 local->hw.conf.flags |= IEEE80211_CONF_MONITOR; 237 hw_reconf_flags |= IEEE80211_CONF_CHANGE_MONITOR; 238 } 239 240 if (sdata->u.mntr_flags & MONITOR_FLAG_FCSFAIL) 241 local->fif_fcsfail++; 242 if (sdata->u.mntr_flags & MONITOR_FLAG_PLCPFAIL) 243 local->fif_plcpfail++; 244 if (sdata->u.mntr_flags & MONITOR_FLAG_CONTROL) { 245 local->fif_control++; 246 local->fif_pspoll++; 247 } 248 if (sdata->u.mntr_flags & MONITOR_FLAG_OTHER_BSS) 249 local->fif_other_bss++; 250 251 ieee80211_configure_filter(local); 252 253 netif_carrier_on(dev); 254 break; 255 default: 256 res = drv_add_interface(local, &sdata->vif); 257 if (res) 258 goto err_stop; 259 260 if (ieee80211_vif_is_mesh(&sdata->vif)) { 261 local->fif_other_bss++; 262 ieee80211_configure_filter(local); 263 264 ieee80211_start_mesh(sdata); 265 } else if (sdata->vif.type == NL80211_IFTYPE_AP) { 266 local->fif_pspoll++; 267 268 ieee80211_configure_filter(local); 269 } 270 271 changed |= ieee80211_reset_erp_info(sdata); 272 ieee80211_bss_info_change_notify(sdata, changed); 273 274 if (sdata->vif.type == NL80211_IFTYPE_STATION) 275 netif_carrier_off(dev); 276 else 277 netif_carrier_on(dev); 278 } 279 280 if (sdata->vif.type == NL80211_IFTYPE_WDS) { 281 /* Create STA entry for the WDS peer */ 282 sta = sta_info_alloc(sdata, sdata->u.wds.remote_addr, 283 GFP_KERNEL); 284 if (!sta) { 285 res = -ENOMEM; 286 goto err_del_interface; 287 } 288 289 /* no locking required since STA is not live yet */ 290 sta->flags |= WLAN_STA_AUTHORIZED; 291 292 res = sta_info_insert(sta); 293 if (res) { 294 /* STA has been freed */ 295 goto err_del_interface; 296 } 297 } 298 299 /* 300 * set_multicast_list will be invoked by the networking core 301 * which will check whether any increments here were done in 302 * error and sync them down to the hardware as filter flags. 303 */ 304 if (sdata->flags & IEEE80211_SDATA_ALLMULTI) 305 atomic_inc(&local->iff_allmultis); 306 307 if (sdata->flags & IEEE80211_SDATA_PROMISC) 308 atomic_inc(&local->iff_promiscs); 309 310 hw_reconf_flags |= __ieee80211_recalc_idle(local); 311 312 local->open_count++; 313 if (hw_reconf_flags) { 314 ieee80211_hw_config(local, hw_reconf_flags); 315 /* 316 * set default queue parameters so drivers don't 317 * need to initialise the hardware if the hardware 318 * doesn't start up with sane defaults 319 */ 320 ieee80211_set_wmm_default(sdata); 321 } 322 323 ieee80211_recalc_ps(local, -1); 324 325 netif_tx_start_all_queues(dev); 326 327 return 0; 328 err_del_interface: 329 drv_remove_interface(local, &sdata->vif); 330 err_stop: 331 if (!local->open_count) 332 drv_stop(local); 333 err_del_bss: 334 sdata->bss = NULL; 335 if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN) 336 list_del(&sdata->u.vlan.list); 337 return res; 338 } 339 340 static int ieee80211_stop(struct net_device *dev) 341 { 342 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 343 struct ieee80211_local *local = sdata->local; 344 unsigned long flags; 345 struct sk_buff *skb, *tmp; 346 u32 hw_reconf_flags = 0; 347 int i; 348 349 /* 350 * Stop TX on this interface first. 351 */ 352 netif_tx_stop_all_queues(dev); 353 354 /* 355 * Purge work for this interface. 356 */ 357 ieee80211_work_purge(sdata); 358 359 /* 360 * Remove all stations associated with this interface. 361 * 362 * This must be done before calling ops->remove_interface() 363 * because otherwise we can later invoke ops->sta_notify() 364 * whenever the STAs are removed, and that invalidates driver 365 * assumptions about always getting a vif pointer that is valid 366 * (because if we remove a STA after ops->remove_interface() 367 * the driver will have removed the vif info already!) 368 * 369 * We could relax this and only unlink the stations from the 370 * hash table and list but keep them on a per-sdata list that 371 * will be inserted back again when the interface is brought 372 * up again, but I don't currently see a use case for that, 373 * except with WDS which gets a STA entry created when it is 374 * brought up. 375 */ 376 sta_info_flush(local, sdata); 377 378 /* 379 * Don't count this interface for promisc/allmulti while it 380 * is down. dev_mc_unsync() will invoke set_multicast_list 381 * on the master interface which will sync these down to the 382 * hardware as filter flags. 383 */ 384 if (sdata->flags & IEEE80211_SDATA_ALLMULTI) 385 atomic_dec(&local->iff_allmultis); 386 387 if (sdata->flags & IEEE80211_SDATA_PROMISC) 388 atomic_dec(&local->iff_promiscs); 389 390 if (sdata->vif.type == NL80211_IFTYPE_AP) 391 local->fif_pspoll--; 392 393 netif_addr_lock_bh(dev); 394 spin_lock_bh(&local->filter_lock); 395 __hw_addr_unsync(&local->mc_list, &dev->mc, dev->addr_len); 396 spin_unlock_bh(&local->filter_lock); 397 netif_addr_unlock_bh(dev); 398 399 ieee80211_configure_filter(local); 400 401 del_timer_sync(&local->dynamic_ps_timer); 402 cancel_work_sync(&local->dynamic_ps_enable_work); 403 404 /* APs need special treatment */ 405 if (sdata->vif.type == NL80211_IFTYPE_AP) { 406 struct ieee80211_sub_if_data *vlan, *tmpsdata; 407 struct beacon_data *old_beacon = sdata->u.ap.beacon; 408 409 /* remove beacon */ 410 rcu_assign_pointer(sdata->u.ap.beacon, NULL); 411 synchronize_rcu(); 412 kfree(old_beacon); 413 414 /* down all dependent devices, that is VLANs */ 415 list_for_each_entry_safe(vlan, tmpsdata, &sdata->u.ap.vlans, 416 u.vlan.list) 417 dev_close(vlan->dev); 418 WARN_ON(!list_empty(&sdata->u.ap.vlans)); 419 } 420 421 local->open_count--; 422 423 switch (sdata->vif.type) { 424 case NL80211_IFTYPE_AP_VLAN: 425 list_del(&sdata->u.vlan.list); 426 /* no need to tell driver */ 427 break; 428 case NL80211_IFTYPE_MONITOR: 429 if (sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES) { 430 local->cooked_mntrs--; 431 break; 432 } 433 434 local->monitors--; 435 if (local->monitors == 0) { 436 local->hw.conf.flags &= ~IEEE80211_CONF_MONITOR; 437 hw_reconf_flags |= IEEE80211_CONF_CHANGE_MONITOR; 438 } 439 440 if (sdata->u.mntr_flags & MONITOR_FLAG_FCSFAIL) 441 local->fif_fcsfail--; 442 if (sdata->u.mntr_flags & MONITOR_FLAG_PLCPFAIL) 443 local->fif_plcpfail--; 444 if (sdata->u.mntr_flags & MONITOR_FLAG_CONTROL) { 445 local->fif_pspoll--; 446 local->fif_control--; 447 } 448 if (sdata->u.mntr_flags & MONITOR_FLAG_OTHER_BSS) 449 local->fif_other_bss--; 450 451 ieee80211_configure_filter(local); 452 break; 453 case NL80211_IFTYPE_STATION: 454 del_timer_sync(&sdata->u.mgd.chswitch_timer); 455 del_timer_sync(&sdata->u.mgd.timer); 456 del_timer_sync(&sdata->u.mgd.conn_mon_timer); 457 del_timer_sync(&sdata->u.mgd.bcn_mon_timer); 458 /* 459 * If any of the timers fired while we waited for it, it will 460 * have queued its work. Now the work will be running again 461 * but will not rearm the timer again because it checks 462 * whether the interface is running, which, at this point, 463 * it no longer is. 464 */ 465 cancel_work_sync(&sdata->u.mgd.chswitch_work); 466 cancel_work_sync(&sdata->u.mgd.monitor_work); 467 cancel_work_sync(&sdata->u.mgd.beacon_connection_loss_work); 468 469 /* fall through */ 470 case NL80211_IFTYPE_ADHOC: 471 if (sdata->vif.type == NL80211_IFTYPE_ADHOC) 472 del_timer_sync(&sdata->u.ibss.timer); 473 /* fall through */ 474 case NL80211_IFTYPE_MESH_POINT: 475 if (ieee80211_vif_is_mesh(&sdata->vif)) { 476 /* other_bss and allmulti are always set on mesh 477 * ifaces */ 478 local->fif_other_bss--; 479 atomic_dec(&local->iff_allmultis); 480 481 ieee80211_configure_filter(local); 482 483 ieee80211_stop_mesh(sdata); 484 } 485 /* fall through */ 486 default: 487 flush_work(&sdata->work); 488 /* 489 * When we get here, the interface is marked down. 490 * Call synchronize_rcu() to wait for the RX path 491 * should it be using the interface and enqueuing 492 * frames at this very time on another CPU. 493 */ 494 synchronize_rcu(); 495 skb_queue_purge(&sdata->skb_queue); 496 497 if (local->scan_sdata == sdata) 498 ieee80211_scan_cancel(local); 499 500 /* 501 * Disable beaconing for AP and mesh, IBSS can't 502 * still be joined to a network at this point. 503 */ 504 if (sdata->vif.type == NL80211_IFTYPE_AP || 505 sdata->vif.type == NL80211_IFTYPE_MESH_POINT) { 506 ieee80211_bss_info_change_notify(sdata, 507 BSS_CHANGED_BEACON_ENABLED); 508 } 509 510 /* free all remaining keys, there shouldn't be any */ 511 ieee80211_free_keys(sdata); 512 drv_remove_interface(local, &sdata->vif); 513 } 514 515 sdata->bss = NULL; 516 517 hw_reconf_flags |= __ieee80211_recalc_idle(local); 518 519 ieee80211_recalc_ps(local, -1); 520 521 if (local->open_count == 0) { 522 ieee80211_clear_tx_pending(local); 523 ieee80211_stop_device(local); 524 525 /* no reconfiguring after stop! */ 526 hw_reconf_flags = 0; 527 } 528 529 /* do after stop to avoid reconfiguring when we stop anyway */ 530 if (hw_reconf_flags) 531 ieee80211_hw_config(local, hw_reconf_flags); 532 533 spin_lock_irqsave(&local->queue_stop_reason_lock, flags); 534 for (i = 0; i < IEEE80211_MAX_QUEUES; i++) { 535 skb_queue_walk_safe(&local->pending[i], skb, tmp) { 536 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 537 if (info->control.vif == &sdata->vif) { 538 __skb_unlink(skb, &local->pending[i]); 539 dev_kfree_skb_irq(skb); 540 } 541 } 542 } 543 spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags); 544 545 return 0; 546 } 547 548 static void ieee80211_set_multicast_list(struct net_device *dev) 549 { 550 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 551 struct ieee80211_local *local = sdata->local; 552 int allmulti, promisc, sdata_allmulti, sdata_promisc; 553 554 allmulti = !!(dev->flags & IFF_ALLMULTI); 555 promisc = !!(dev->flags & IFF_PROMISC); 556 sdata_allmulti = !!(sdata->flags & IEEE80211_SDATA_ALLMULTI); 557 sdata_promisc = !!(sdata->flags & IEEE80211_SDATA_PROMISC); 558 559 if (allmulti != sdata_allmulti) { 560 if (dev->flags & IFF_ALLMULTI) 561 atomic_inc(&local->iff_allmultis); 562 else 563 atomic_dec(&local->iff_allmultis); 564 sdata->flags ^= IEEE80211_SDATA_ALLMULTI; 565 } 566 567 if (promisc != sdata_promisc) { 568 if (dev->flags & IFF_PROMISC) 569 atomic_inc(&local->iff_promiscs); 570 else 571 atomic_dec(&local->iff_promiscs); 572 sdata->flags ^= IEEE80211_SDATA_PROMISC; 573 } 574 spin_lock_bh(&local->filter_lock); 575 __hw_addr_sync(&local->mc_list, &dev->mc, dev->addr_len); 576 spin_unlock_bh(&local->filter_lock); 577 ieee80211_queue_work(&local->hw, &local->reconfig_filter); 578 } 579 580 /* 581 * Called when the netdev is removed or, by the code below, before 582 * the interface type changes. 583 */ 584 static void ieee80211_teardown_sdata(struct net_device *dev) 585 { 586 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 587 struct ieee80211_local *local = sdata->local; 588 struct beacon_data *beacon; 589 struct sk_buff *skb; 590 int flushed; 591 int i; 592 593 /* free extra data */ 594 ieee80211_free_keys(sdata); 595 596 ieee80211_debugfs_remove_netdev(sdata); 597 598 for (i = 0; i < IEEE80211_FRAGMENT_MAX; i++) 599 __skb_queue_purge(&sdata->fragments[i].skb_list); 600 sdata->fragment_next = 0; 601 602 switch (sdata->vif.type) { 603 case NL80211_IFTYPE_AP: 604 beacon = sdata->u.ap.beacon; 605 rcu_assign_pointer(sdata->u.ap.beacon, NULL); 606 synchronize_rcu(); 607 kfree(beacon); 608 609 while ((skb = skb_dequeue(&sdata->u.ap.ps_bc_buf))) { 610 local->total_ps_buffered--; 611 dev_kfree_skb(skb); 612 } 613 614 break; 615 case NL80211_IFTYPE_MESH_POINT: 616 if (ieee80211_vif_is_mesh(&sdata->vif)) 617 mesh_rmc_free(sdata); 618 break; 619 case NL80211_IFTYPE_ADHOC: 620 if (WARN_ON(sdata->u.ibss.presp)) 621 kfree_skb(sdata->u.ibss.presp); 622 break; 623 case NL80211_IFTYPE_STATION: 624 case NL80211_IFTYPE_WDS: 625 case NL80211_IFTYPE_AP_VLAN: 626 case NL80211_IFTYPE_MONITOR: 627 break; 628 case NL80211_IFTYPE_UNSPECIFIED: 629 case __NL80211_IFTYPE_AFTER_LAST: 630 BUG(); 631 break; 632 } 633 634 flushed = sta_info_flush(local, sdata); 635 WARN_ON(flushed); 636 } 637 638 static u16 ieee80211_netdev_select_queue(struct net_device *dev, 639 struct sk_buff *skb) 640 { 641 return ieee80211_select_queue(IEEE80211_DEV_TO_SUB_IF(dev), skb); 642 } 643 644 static const struct net_device_ops ieee80211_dataif_ops = { 645 .ndo_open = ieee80211_open, 646 .ndo_stop = ieee80211_stop, 647 .ndo_uninit = ieee80211_teardown_sdata, 648 .ndo_start_xmit = ieee80211_subif_start_xmit, 649 .ndo_set_multicast_list = ieee80211_set_multicast_list, 650 .ndo_change_mtu = ieee80211_change_mtu, 651 .ndo_set_mac_address = ieee80211_change_mac, 652 .ndo_select_queue = ieee80211_netdev_select_queue, 653 }; 654 655 static u16 ieee80211_monitor_select_queue(struct net_device *dev, 656 struct sk_buff *skb) 657 { 658 struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); 659 struct ieee80211_local *local = sdata->local; 660 struct ieee80211_hdr *hdr; 661 struct ieee80211_radiotap_header *rtap = (void *)skb->data; 662 u8 *p; 663 664 if (local->hw.queues < 4) 665 return 0; 666 667 if (skb->len < 4 || 668 skb->len < le16_to_cpu(rtap->it_len) + 2 /* frame control */) 669 return 0; /* doesn't matter, frame will be dropped */ 670 671 hdr = (void *)((u8 *)skb->data + le16_to_cpu(rtap->it_len)); 672 673 if (!ieee80211_is_data(hdr->frame_control)) { 674 skb->priority = 7; 675 return ieee802_1d_to_ac[skb->priority]; 676 } 677 if (!ieee80211_is_data_qos(hdr->frame_control)) { 678 skb->priority = 0; 679 return ieee802_1d_to_ac[skb->priority]; 680 } 681 682 p = ieee80211_get_qos_ctl(hdr); 683 skb->priority = *p & IEEE80211_QOS_CTL_TAG1D_MASK; 684 685 return ieee80211_downgrade_queue(local, skb); 686 } 687 688 static const struct net_device_ops ieee80211_monitorif_ops = { 689 .ndo_open = ieee80211_open, 690 .ndo_stop = ieee80211_stop, 691 .ndo_uninit = ieee80211_teardown_sdata, 692 .ndo_start_xmit = ieee80211_monitor_start_xmit, 693 .ndo_set_multicast_list = ieee80211_set_multicast_list, 694 .ndo_change_mtu = ieee80211_change_mtu, 695 .ndo_set_mac_address = eth_mac_addr, 696 .ndo_select_queue = ieee80211_monitor_select_queue, 697 }; 698 699 static void ieee80211_if_setup(struct net_device *dev) 700 { 701 ether_setup(dev); 702 dev->netdev_ops = &ieee80211_dataif_ops; 703 dev->destructor = free_netdev; 704 } 705 706 static void ieee80211_iface_work(struct work_struct *work) 707 { 708 struct ieee80211_sub_if_data *sdata = 709 container_of(work, struct ieee80211_sub_if_data, work); 710 struct ieee80211_local *local = sdata->local; 711 struct sk_buff *skb; 712 struct sta_info *sta; 713 struct ieee80211_ra_tid *ra_tid; 714 715 if (!ieee80211_sdata_running(sdata)) 716 return; 717 718 if (local->scanning) 719 return; 720 721 /* 722 * ieee80211_queue_work() should have picked up most cases, 723 * here we'll pick the rest. 724 */ 725 if (WARN(local->suspended, 726 "interface work scheduled while going to suspend\n")) 727 return; 728 729 /* first process frames */ 730 while ((skb = skb_dequeue(&sdata->skb_queue))) { 731 struct ieee80211_mgmt *mgmt = (void *)skb->data; 732 733 if (skb->pkt_type == IEEE80211_SDATA_QUEUE_AGG_START) { 734 ra_tid = (void *)&skb->cb; 735 ieee80211_start_tx_ba_cb(&sdata->vif, ra_tid->ra, 736 ra_tid->tid); 737 } else if (skb->pkt_type == IEEE80211_SDATA_QUEUE_AGG_STOP) { 738 ra_tid = (void *)&skb->cb; 739 ieee80211_stop_tx_ba_cb(&sdata->vif, ra_tid->ra, 740 ra_tid->tid); 741 } else if (ieee80211_is_action(mgmt->frame_control) && 742 mgmt->u.action.category == WLAN_CATEGORY_BACK) { 743 int len = skb->len; 744 745 mutex_lock(&local->sta_mtx); 746 sta = sta_info_get_bss(sdata, mgmt->sa); 747 if (sta) { 748 switch (mgmt->u.action.u.addba_req.action_code) { 749 case WLAN_ACTION_ADDBA_REQ: 750 ieee80211_process_addba_request( 751 local, sta, mgmt, len); 752 break; 753 case WLAN_ACTION_ADDBA_RESP: 754 ieee80211_process_addba_resp(local, sta, 755 mgmt, len); 756 break; 757 case WLAN_ACTION_DELBA: 758 ieee80211_process_delba(sdata, sta, 759 mgmt, len); 760 break; 761 default: 762 WARN_ON(1); 763 break; 764 } 765 } 766 mutex_unlock(&local->sta_mtx); 767 } else if (ieee80211_is_data_qos(mgmt->frame_control)) { 768 struct ieee80211_hdr *hdr = (void *)mgmt; 769 /* 770 * So the frame isn't mgmt, but frame_control 771 * is at the right place anyway, of course, so 772 * the if statement is correct. 773 * 774 * Warn if we have other data frame types here, 775 * they must not get here. 776 */ 777 WARN_ON(hdr->frame_control & 778 cpu_to_le16(IEEE80211_STYPE_NULLFUNC)); 779 WARN_ON(!(hdr->seq_ctrl & 780 cpu_to_le16(IEEE80211_SCTL_FRAG))); 781 /* 782 * This was a fragment of a frame, received while 783 * a block-ack session was active. That cannot be 784 * right, so terminate the session. 785 */ 786 mutex_lock(&local->sta_mtx); 787 sta = sta_info_get_bss(sdata, mgmt->sa); 788 if (sta) { 789 u16 tid = *ieee80211_get_qos_ctl(hdr) & 790 IEEE80211_QOS_CTL_TID_MASK; 791 792 __ieee80211_stop_rx_ba_session( 793 sta, tid, WLAN_BACK_RECIPIENT, 794 WLAN_REASON_QSTA_REQUIRE_SETUP); 795 } 796 mutex_unlock(&local->sta_mtx); 797 } else switch (sdata->vif.type) { 798 case NL80211_IFTYPE_STATION: 799 ieee80211_sta_rx_queued_mgmt(sdata, skb); 800 break; 801 case NL80211_IFTYPE_ADHOC: 802 ieee80211_ibss_rx_queued_mgmt(sdata, skb); 803 break; 804 case NL80211_IFTYPE_MESH_POINT: 805 if (!ieee80211_vif_is_mesh(&sdata->vif)) 806 break; 807 ieee80211_mesh_rx_queued_mgmt(sdata, skb); 808 break; 809 default: 810 WARN(1, "frame for unexpected interface type"); 811 break; 812 } 813 814 kfree_skb(skb); 815 } 816 817 /* then other type-dependent work */ 818 switch (sdata->vif.type) { 819 case NL80211_IFTYPE_STATION: 820 ieee80211_sta_work(sdata); 821 break; 822 case NL80211_IFTYPE_ADHOC: 823 ieee80211_ibss_work(sdata); 824 break; 825 case NL80211_IFTYPE_MESH_POINT: 826 if (!ieee80211_vif_is_mesh(&sdata->vif)) 827 break; 828 ieee80211_mesh_work(sdata); 829 break; 830 default: 831 break; 832 } 833 } 834 835 836 /* 837 * Helper function to initialise an interface to a specific type. 838 */ 839 static void ieee80211_setup_sdata(struct ieee80211_sub_if_data *sdata, 840 enum nl80211_iftype type) 841 { 842 /* clear type-dependent union */ 843 memset(&sdata->u, 0, sizeof(sdata->u)); 844 845 /* and set some type-dependent values */ 846 sdata->vif.type = type; 847 sdata->dev->netdev_ops = &ieee80211_dataif_ops; 848 sdata->wdev.iftype = type; 849 850 /* only monitor differs */ 851 sdata->dev->type = ARPHRD_ETHER; 852 853 skb_queue_head_init(&sdata->skb_queue); 854 INIT_WORK(&sdata->work, ieee80211_iface_work); 855 856 switch (type) { 857 case NL80211_IFTYPE_AP: 858 skb_queue_head_init(&sdata->u.ap.ps_bc_buf); 859 INIT_LIST_HEAD(&sdata->u.ap.vlans); 860 break; 861 case NL80211_IFTYPE_STATION: 862 ieee80211_sta_setup_sdata(sdata); 863 break; 864 case NL80211_IFTYPE_ADHOC: 865 ieee80211_ibss_setup_sdata(sdata); 866 break; 867 case NL80211_IFTYPE_MESH_POINT: 868 if (ieee80211_vif_is_mesh(&sdata->vif)) 869 ieee80211_mesh_init_sdata(sdata); 870 break; 871 case NL80211_IFTYPE_MONITOR: 872 sdata->dev->type = ARPHRD_IEEE80211_RADIOTAP; 873 sdata->dev->netdev_ops = &ieee80211_monitorif_ops; 874 sdata->u.mntr_flags = MONITOR_FLAG_CONTROL | 875 MONITOR_FLAG_OTHER_BSS; 876 break; 877 case NL80211_IFTYPE_WDS: 878 case NL80211_IFTYPE_AP_VLAN: 879 break; 880 case NL80211_IFTYPE_UNSPECIFIED: 881 case __NL80211_IFTYPE_AFTER_LAST: 882 BUG(); 883 break; 884 } 885 886 ieee80211_debugfs_add_netdev(sdata); 887 } 888 889 int ieee80211_if_change_type(struct ieee80211_sub_if_data *sdata, 890 enum nl80211_iftype type) 891 { 892 ASSERT_RTNL(); 893 894 if (type == sdata->vif.type) 895 return 0; 896 897 /* Setting ad-hoc mode on non-IBSS channel is not supported. */ 898 if (sdata->local->oper_channel->flags & IEEE80211_CHAN_NO_IBSS && 899 type == NL80211_IFTYPE_ADHOC) 900 return -EOPNOTSUPP; 901 902 /* 903 * We could, here, on changes between IBSS/STA/MESH modes, 904 * invoke an MLME function instead that disassociates etc. 905 * and goes into the requested mode. 906 */ 907 908 if (ieee80211_sdata_running(sdata)) 909 return -EBUSY; 910 911 /* Purge and reset type-dependent state. */ 912 ieee80211_teardown_sdata(sdata->dev); 913 ieee80211_setup_sdata(sdata, type); 914 915 /* reset some values that shouldn't be kept across type changes */ 916 sdata->vif.bss_conf.basic_rates = 917 ieee80211_mandatory_rates(sdata->local, 918 sdata->local->hw.conf.channel->band); 919 sdata->drop_unencrypted = 0; 920 if (type == NL80211_IFTYPE_STATION) 921 sdata->u.mgd.use_4addr = false; 922 923 return 0; 924 } 925 926 static void ieee80211_assign_perm_addr(struct ieee80211_local *local, 927 struct net_device *dev, 928 enum nl80211_iftype type) 929 { 930 struct ieee80211_sub_if_data *sdata; 931 u64 mask, start, addr, val, inc; 932 u8 *m; 933 u8 tmp_addr[ETH_ALEN]; 934 int i; 935 936 /* default ... something at least */ 937 memcpy(dev->perm_addr, local->hw.wiphy->perm_addr, ETH_ALEN); 938 939 if (is_zero_ether_addr(local->hw.wiphy->addr_mask) && 940 local->hw.wiphy->n_addresses <= 1) 941 return; 942 943 944 mutex_lock(&local->iflist_mtx); 945 946 switch (type) { 947 case NL80211_IFTYPE_MONITOR: 948 /* doesn't matter */ 949 break; 950 case NL80211_IFTYPE_WDS: 951 case NL80211_IFTYPE_AP_VLAN: 952 /* match up with an AP interface */ 953 list_for_each_entry(sdata, &local->interfaces, list) { 954 if (sdata->vif.type != NL80211_IFTYPE_AP) 955 continue; 956 memcpy(dev->perm_addr, sdata->vif.addr, ETH_ALEN); 957 break; 958 } 959 /* keep default if no AP interface present */ 960 break; 961 default: 962 /* assign a new address if possible -- try n_addresses first */ 963 for (i = 0; i < local->hw.wiphy->n_addresses; i++) { 964 bool used = false; 965 966 list_for_each_entry(sdata, &local->interfaces, list) { 967 if (memcmp(local->hw.wiphy->addresses[i].addr, 968 sdata->vif.addr, ETH_ALEN) == 0) { 969 used = true; 970 break; 971 } 972 } 973 974 if (!used) { 975 memcpy(dev->perm_addr, 976 local->hw.wiphy->addresses[i].addr, 977 ETH_ALEN); 978 break; 979 } 980 } 981 982 /* try mask if available */ 983 if (is_zero_ether_addr(local->hw.wiphy->addr_mask)) 984 break; 985 986 m = local->hw.wiphy->addr_mask; 987 mask = ((u64)m[0] << 5*8) | ((u64)m[1] << 4*8) | 988 ((u64)m[2] << 3*8) | ((u64)m[3] << 2*8) | 989 ((u64)m[4] << 1*8) | ((u64)m[5] << 0*8); 990 991 if (__ffs64(mask) + hweight64(mask) != fls64(mask)) { 992 /* not a contiguous mask ... not handled now! */ 993 printk(KERN_DEBUG "not contiguous\n"); 994 break; 995 } 996 997 m = local->hw.wiphy->perm_addr; 998 start = ((u64)m[0] << 5*8) | ((u64)m[1] << 4*8) | 999 ((u64)m[2] << 3*8) | ((u64)m[3] << 2*8) | 1000 ((u64)m[4] << 1*8) | ((u64)m[5] << 0*8); 1001 1002 inc = 1ULL<<__ffs64(mask); 1003 val = (start & mask); 1004 addr = (start & ~mask) | (val & mask); 1005 do { 1006 bool used = false; 1007 1008 tmp_addr[5] = addr >> 0*8; 1009 tmp_addr[4] = addr >> 1*8; 1010 tmp_addr[3] = addr >> 2*8; 1011 tmp_addr[2] = addr >> 3*8; 1012 tmp_addr[1] = addr >> 4*8; 1013 tmp_addr[0] = addr >> 5*8; 1014 1015 val += inc; 1016 1017 list_for_each_entry(sdata, &local->interfaces, list) { 1018 if (memcmp(tmp_addr, sdata->vif.addr, 1019 ETH_ALEN) == 0) { 1020 used = true; 1021 break; 1022 } 1023 } 1024 1025 if (!used) { 1026 memcpy(dev->perm_addr, tmp_addr, ETH_ALEN); 1027 break; 1028 } 1029 addr = (start & ~mask) | (val & mask); 1030 } while (addr != start); 1031 1032 break; 1033 } 1034 1035 mutex_unlock(&local->iflist_mtx); 1036 } 1037 1038 int ieee80211_if_add(struct ieee80211_local *local, const char *name, 1039 struct net_device **new_dev, enum nl80211_iftype type, 1040 struct vif_params *params) 1041 { 1042 struct net_device *ndev; 1043 struct ieee80211_sub_if_data *sdata = NULL; 1044 int ret, i; 1045 1046 ASSERT_RTNL(); 1047 1048 ndev = alloc_netdev_mq(sizeof(*sdata) + local->hw.vif_data_size, 1049 name, ieee80211_if_setup, local->hw.queues); 1050 if (!ndev) 1051 return -ENOMEM; 1052 dev_net_set(ndev, wiphy_net(local->hw.wiphy)); 1053 1054 ndev->needed_headroom = local->tx_headroom + 1055 4*6 /* four MAC addresses */ 1056 + 2 + 2 + 2 + 2 /* ctl, dur, seq, qos */ 1057 + 6 /* mesh */ 1058 + 8 /* rfc1042/bridge tunnel */ 1059 - ETH_HLEN /* ethernet hard_header_len */ 1060 + IEEE80211_ENCRYPT_HEADROOM; 1061 ndev->needed_tailroom = IEEE80211_ENCRYPT_TAILROOM; 1062 1063 ret = dev_alloc_name(ndev, ndev->name); 1064 if (ret < 0) 1065 goto fail; 1066 1067 ieee80211_assign_perm_addr(local, ndev, type); 1068 memcpy(ndev->dev_addr, ndev->perm_addr, ETH_ALEN); 1069 SET_NETDEV_DEV(ndev, wiphy_dev(local->hw.wiphy)); 1070 1071 /* don't use IEEE80211_DEV_TO_SUB_IF because it checks too much */ 1072 sdata = netdev_priv(ndev); 1073 ndev->ieee80211_ptr = &sdata->wdev; 1074 memcpy(sdata->vif.addr, ndev->dev_addr, ETH_ALEN); 1075 memcpy(sdata->name, ndev->name, IFNAMSIZ); 1076 1077 /* initialise type-independent data */ 1078 sdata->wdev.wiphy = local->hw.wiphy; 1079 sdata->local = local; 1080 sdata->dev = ndev; 1081 #ifdef CONFIG_INET 1082 sdata->arp_filter_state = true; 1083 #endif 1084 1085 for (i = 0; i < IEEE80211_FRAGMENT_MAX; i++) 1086 skb_queue_head_init(&sdata->fragments[i].skb_list); 1087 1088 INIT_LIST_HEAD(&sdata->key_list); 1089 1090 for (i = 0; i < IEEE80211_NUM_BANDS; i++) { 1091 struct ieee80211_supported_band *sband; 1092 sband = local->hw.wiphy->bands[i]; 1093 sdata->rc_rateidx_mask[i] = 1094 sband ? (1 << sband->n_bitrates) - 1 : 0; 1095 } 1096 1097 /* setup type-dependent data */ 1098 ieee80211_setup_sdata(sdata, type); 1099 1100 if (params) { 1101 ndev->ieee80211_ptr->use_4addr = params->use_4addr; 1102 if (type == NL80211_IFTYPE_STATION) 1103 sdata->u.mgd.use_4addr = params->use_4addr; 1104 } 1105 1106 ret = register_netdevice(ndev); 1107 if (ret) 1108 goto fail; 1109 1110 if (ieee80211_vif_is_mesh(&sdata->vif) && 1111 params && params->mesh_id_len) 1112 ieee80211_sdata_set_mesh_id(sdata, 1113 params->mesh_id_len, 1114 params->mesh_id); 1115 1116 mutex_lock(&local->iflist_mtx); 1117 list_add_tail_rcu(&sdata->list, &local->interfaces); 1118 mutex_unlock(&local->iflist_mtx); 1119 1120 if (new_dev) 1121 *new_dev = ndev; 1122 1123 return 0; 1124 1125 fail: 1126 free_netdev(ndev); 1127 return ret; 1128 } 1129 1130 void ieee80211_if_remove(struct ieee80211_sub_if_data *sdata) 1131 { 1132 ASSERT_RTNL(); 1133 1134 mutex_lock(&sdata->local->iflist_mtx); 1135 list_del_rcu(&sdata->list); 1136 mutex_unlock(&sdata->local->iflist_mtx); 1137 1138 synchronize_rcu(); 1139 unregister_netdevice(sdata->dev); 1140 } 1141 1142 /* 1143 * Remove all interfaces, may only be called at hardware unregistration 1144 * time because it doesn't do RCU-safe list removals. 1145 */ 1146 void ieee80211_remove_interfaces(struct ieee80211_local *local) 1147 { 1148 struct ieee80211_sub_if_data *sdata, *tmp; 1149 LIST_HEAD(unreg_list); 1150 1151 ASSERT_RTNL(); 1152 1153 mutex_lock(&local->iflist_mtx); 1154 list_for_each_entry_safe(sdata, tmp, &local->interfaces, list) { 1155 list_del(&sdata->list); 1156 1157 unregister_netdevice_queue(sdata->dev, &unreg_list); 1158 } 1159 mutex_unlock(&local->iflist_mtx); 1160 unregister_netdevice_many(&unreg_list); 1161 } 1162 1163 static u32 ieee80211_idle_off(struct ieee80211_local *local, 1164 const char *reason) 1165 { 1166 if (!(local->hw.conf.flags & IEEE80211_CONF_IDLE)) 1167 return 0; 1168 1169 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG 1170 printk(KERN_DEBUG "%s: device no longer idle - %s\n", 1171 wiphy_name(local->hw.wiphy), reason); 1172 #endif 1173 1174 local->hw.conf.flags &= ~IEEE80211_CONF_IDLE; 1175 return IEEE80211_CONF_CHANGE_IDLE; 1176 } 1177 1178 static u32 ieee80211_idle_on(struct ieee80211_local *local) 1179 { 1180 if (local->hw.conf.flags & IEEE80211_CONF_IDLE) 1181 return 0; 1182 1183 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG 1184 printk(KERN_DEBUG "%s: device now idle\n", 1185 wiphy_name(local->hw.wiphy)); 1186 #endif 1187 1188 drv_flush(local, false); 1189 1190 local->hw.conf.flags |= IEEE80211_CONF_IDLE; 1191 return IEEE80211_CONF_CHANGE_IDLE; 1192 } 1193 1194 u32 __ieee80211_recalc_idle(struct ieee80211_local *local) 1195 { 1196 struct ieee80211_sub_if_data *sdata; 1197 int count = 0; 1198 1199 if (!list_empty(&local->work_list)) 1200 return ieee80211_idle_off(local, "working"); 1201 1202 if (local->scanning) 1203 return ieee80211_idle_off(local, "scanning"); 1204 1205 list_for_each_entry(sdata, &local->interfaces, list) { 1206 if (!ieee80211_sdata_running(sdata)) 1207 continue; 1208 /* do not count disabled managed interfaces */ 1209 if (sdata->vif.type == NL80211_IFTYPE_STATION && 1210 !sdata->u.mgd.associated) 1211 continue; 1212 /* do not count unused IBSS interfaces */ 1213 if (sdata->vif.type == NL80211_IFTYPE_ADHOC && 1214 !sdata->u.ibss.ssid_len) 1215 continue; 1216 /* count everything else */ 1217 count++; 1218 } 1219 1220 if (!count) 1221 return ieee80211_idle_on(local); 1222 else 1223 return ieee80211_idle_off(local, "in use"); 1224 1225 return 0; 1226 } 1227 1228 void ieee80211_recalc_idle(struct ieee80211_local *local) 1229 { 1230 u32 chg; 1231 1232 mutex_lock(&local->iflist_mtx); 1233 chg = __ieee80211_recalc_idle(local); 1234 mutex_unlock(&local->iflist_mtx); 1235 if (chg) 1236 ieee80211_hw_config(local, chg); 1237 } 1238 1239 static int netdev_notify(struct notifier_block *nb, 1240 unsigned long state, 1241 void *ndev) 1242 { 1243 struct net_device *dev = ndev; 1244 struct ieee80211_sub_if_data *sdata; 1245 1246 if (state != NETDEV_CHANGENAME) 1247 return 0; 1248 1249 if (!dev->ieee80211_ptr || !dev->ieee80211_ptr->wiphy) 1250 return 0; 1251 1252 if (dev->ieee80211_ptr->wiphy->privid != mac80211_wiphy_privid) 1253 return 0; 1254 1255 sdata = IEEE80211_DEV_TO_SUB_IF(dev); 1256 1257 memcpy(sdata->name, dev->name, IFNAMSIZ); 1258 1259 ieee80211_debugfs_rename_netdev(sdata); 1260 return 0; 1261 } 1262 1263 static struct notifier_block mac80211_netdev_notifier = { 1264 .notifier_call = netdev_notify, 1265 }; 1266 1267 int ieee80211_iface_init(void) 1268 { 1269 return register_netdevice_notifier(&mac80211_netdev_notifier); 1270 } 1271 1272 void ieee80211_iface_exit(void) 1273 { 1274 unregister_netdevice_notifier(&mac80211_netdev_notifier); 1275 } 1276