2 * Copyright 2002-2005, Instant802 Networks, Inc.
3 * Copyright 2005-2006, Devicescape Software, Inc.
4 * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz>
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.
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/wireless.h>
21 #include <linux/rtnetlink.h>
22 #include <linux/bitmap.h>
23 #include <linux/pm_qos_params.h>
24 #include <net/net_namespace.h>
25 #include <net/cfg80211.h>
27 #include "ieee80211_i.h"
28 #include "driver-ops.h"
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");
42 void ieee80211_configure_filter(struct ieee80211_local
*local
)
45 unsigned int changed_flags
;
46 unsigned int new_flags
= 0;
48 if (atomic_read(&local
->iff_promiscs
))
49 new_flags
|= FIF_PROMISC_IN_BSS
;
51 if (atomic_read(&local
->iff_allmultis
))
52 new_flags
|= FIF_ALLMULTI
;
54 if (local
->monitors
|| local
->scanning
)
55 new_flags
|= FIF_BCN_PRBRESP_PROMISC
;
57 if (local
->fif_fcsfail
)
58 new_flags
|= FIF_FCSFAIL
;
60 if (local
->fif_plcpfail
)
61 new_flags
|= FIF_PLCPFAIL
;
63 if (local
->fif_control
)
64 new_flags
|= FIF_CONTROL
;
66 if (local
->fif_other_bss
)
67 new_flags
|= FIF_OTHER_BSS
;
69 if (local
->fif_pspoll
)
70 new_flags
|= FIF_PSPOLL
;
72 spin_lock_bh(&local
->filter_lock
);
73 changed_flags
= local
->filter_flags
^ new_flags
;
75 mc
= drv_prepare_multicast(local
, local
->mc_count
, local
->mc_list
);
76 spin_unlock_bh(&local
->filter_lock
);
81 drv_configure_filter(local
, changed_flags
, &new_flags
, mc
);
83 WARN_ON(new_flags
& (1<<31));
85 local
->filter_flags
= new_flags
& ~(1<<31);
88 static void ieee80211_reconfig_filter(struct work_struct
*work
)
90 struct ieee80211_local
*local
=
91 container_of(work
, struct ieee80211_local
, reconfig_filter
);
93 ieee80211_configure_filter(local
);
96 int ieee80211_hw_config(struct ieee80211_local
*local
, u32 changed
)
98 struct ieee80211_channel
*chan
, *scan_chan
;
101 enum nl80211_channel_type channel_type
;
105 scan_chan
= local
->scan_channel
;
109 channel_type
= NL80211_CHAN_NO_HT
;
110 } else if (local
->tmp_channel
) {
111 chan
= scan_chan
= local
->tmp_channel
;
112 channel_type
= local
->tmp_channel_type
;
114 chan
= local
->oper_channel
;
115 channel_type
= local
->oper_channel_type
;
118 if (chan
!= local
->hw
.conf
.channel
||
119 channel_type
!= local
->hw
.conf
.channel_type
) {
120 local
->hw
.conf
.channel
= chan
;
121 local
->hw
.conf
.channel_type
= channel_type
;
122 changed
|= IEEE80211_CONF_CHANGE_CHANNEL
;
125 if (!conf_is_ht(&local
->hw
.conf
)) {
127 * mac80211.h documents that this is only valid
128 * when the channel is set to an HT type, and
129 * that otherwise STATIC is used.
131 local
->hw
.conf
.smps_mode
= IEEE80211_SMPS_STATIC
;
132 } else if (local
->hw
.conf
.smps_mode
!= local
->smps_mode
) {
133 local
->hw
.conf
.smps_mode
= local
->smps_mode
;
134 changed
|= IEEE80211_CONF_CHANGE_SMPS
;
138 power
= chan
->max_power
;
140 power
= local
->power_constr_level
?
141 (chan
->max_power
- local
->power_constr_level
) :
144 if (local
->user_power_level
>= 0)
145 power
= min(power
, local
->user_power_level
);
147 if (local
->hw
.conf
.power_level
!= power
) {
148 changed
|= IEEE80211_CONF_CHANGE_POWER
;
149 local
->hw
.conf
.power_level
= power
;
152 if (changed
&& local
->open_count
) {
153 ret
= drv_config(local
, changed
);
156 * HW reconfiguration should never fail, the driver has told
157 * us what it can support so it should live up to that promise.
160 * rfkill is not integrated with mac80211 and a
161 * configuration command can thus fail if hardware rfkill
164 * FIXME: integrate rfkill with mac80211 and then add this
174 void ieee80211_bss_info_change_notify(struct ieee80211_sub_if_data
*sdata
,
177 struct ieee80211_local
*local
= sdata
->local
;
178 static const u8 zero
[ETH_ALEN
] = { 0 };
183 if (sdata
->vif
.type
== NL80211_IFTYPE_STATION
) {
185 * While not associated, claim a BSSID of all-zeroes
186 * so that drivers don't do any weird things with the
187 * BSSID at that time.
189 if (sdata
->vif
.bss_conf
.assoc
)
190 sdata
->vif
.bss_conf
.bssid
= sdata
->u
.mgd
.bssid
;
192 sdata
->vif
.bss_conf
.bssid
= zero
;
193 } else if (sdata
->vif
.type
== NL80211_IFTYPE_ADHOC
)
194 sdata
->vif
.bss_conf
.bssid
= sdata
->u
.ibss
.bssid
;
195 else if (sdata
->vif
.type
== NL80211_IFTYPE_AP
)
196 sdata
->vif
.bss_conf
.bssid
= sdata
->vif
.addr
;
197 else if (ieee80211_vif_is_mesh(&sdata
->vif
)) {
198 sdata
->vif
.bss_conf
.bssid
= zero
;
204 switch (sdata
->vif
.type
) {
205 case NL80211_IFTYPE_AP
:
206 case NL80211_IFTYPE_ADHOC
:
207 case NL80211_IFTYPE_MESH_POINT
:
210 /* do not warn to simplify caller in scan.c */
211 changed
&= ~BSS_CHANGED_BEACON_ENABLED
;
212 if (WARN_ON(changed
& BSS_CHANGED_BEACON
))
217 if (changed
& BSS_CHANGED_BEACON_ENABLED
) {
218 if (local
->quiescing
|| !ieee80211_sdata_running(sdata
) ||
219 test_bit(SCAN_SW_SCANNING
, &local
->scanning
)) {
220 sdata
->vif
.bss_conf
.enable_beacon
= false;
223 * Beacon should be enabled, but AP mode must
224 * check whether there is a beacon configured.
226 switch (sdata
->vif
.type
) {
227 case NL80211_IFTYPE_AP
:
228 sdata
->vif
.bss_conf
.enable_beacon
=
229 !!rcu_dereference(sdata
->u
.ap
.beacon
);
231 case NL80211_IFTYPE_ADHOC
:
232 sdata
->vif
.bss_conf
.enable_beacon
=
233 !!rcu_dereference(sdata
->u
.ibss
.presp
);
235 case NL80211_IFTYPE_MESH_POINT
:
236 sdata
->vif
.bss_conf
.enable_beacon
= true;
246 drv_bss_info_changed(local
, sdata
, &sdata
->vif
.bss_conf
, changed
);
249 u32
ieee80211_reset_erp_info(struct ieee80211_sub_if_data
*sdata
)
251 sdata
->vif
.bss_conf
.use_cts_prot
= false;
252 sdata
->vif
.bss_conf
.use_short_preamble
= false;
253 sdata
->vif
.bss_conf
.use_short_slot
= false;
254 return BSS_CHANGED_ERP_CTS_PROT
|
255 BSS_CHANGED_ERP_PREAMBLE
|
256 BSS_CHANGED_ERP_SLOT
;
259 static void ieee80211_tasklet_handler(unsigned long data
)
261 struct ieee80211_local
*local
= (struct ieee80211_local
*) data
;
263 struct ieee80211_ra_tid
*ra_tid
;
265 while ((skb
= skb_dequeue(&local
->skb_queue
)) ||
266 (skb
= skb_dequeue(&local
->skb_queue_unreliable
))) {
267 switch (skb
->pkt_type
) {
268 case IEEE80211_RX_MSG
:
269 /* Clear skb->pkt_type in order to not confuse kernel
272 ieee80211_rx(local_to_hw(local
), skb
);
274 case IEEE80211_TX_STATUS_MSG
:
276 ieee80211_tx_status(local_to_hw(local
), skb
);
278 case IEEE80211_DELBA_MSG
:
279 ra_tid
= (struct ieee80211_ra_tid
*) &skb
->cb
;
280 ieee80211_stop_tx_ba_cb(ra_tid
->vif
, ra_tid
->ra
,
284 case IEEE80211_ADDBA_MSG
:
285 ra_tid
= (struct ieee80211_ra_tid
*) &skb
->cb
;
286 ieee80211_start_tx_ba_cb(ra_tid
->vif
, ra_tid
->ra
,
291 WARN(1, "mac80211: Packet is of unknown type %d\n",
299 static void ieee80211_restart_work(struct work_struct
*work
)
301 struct ieee80211_local
*local
=
302 container_of(work
, struct ieee80211_local
, restart_work
);
305 ieee80211_reconfig(local
);
309 void ieee80211_restart_hw(struct ieee80211_hw
*hw
)
311 struct ieee80211_local
*local
= hw_to_local(hw
);
313 /* use this reason, __ieee80211_resume will unblock it */
314 ieee80211_stop_queues_by_reason(hw
,
315 IEEE80211_QUEUE_STOP_REASON_SUSPEND
);
317 schedule_work(&local
->restart_work
);
319 EXPORT_SYMBOL(ieee80211_restart_hw
);
321 static void ieee80211_recalc_smps_work(struct work_struct
*work
)
323 struct ieee80211_local
*local
=
324 container_of(work
, struct ieee80211_local
, recalc_smps
);
326 mutex_lock(&local
->iflist_mtx
);
327 ieee80211_recalc_smps(local
, NULL
);
328 mutex_unlock(&local
->iflist_mtx
);
331 struct ieee80211_hw
*ieee80211_alloc_hw(size_t priv_data_len
,
332 const struct ieee80211_ops
*ops
)
334 struct ieee80211_local
*local
;
338 /* Ensure 32-byte alignment of our private data and hw private data.
339 * We use the wiphy priv data for both our ieee80211_local and for
340 * the driver's private data
342 * In memory it'll be like this:
344 * +-------------------------+
346 * +-------------------------+
347 * | struct ieee80211_local |
348 * +-------------------------+
349 * | driver's private data |
350 * +-------------------------+
353 priv_size
= ALIGN(sizeof(*local
), NETDEV_ALIGN
) + priv_data_len
;
355 wiphy
= wiphy_new(&mac80211_config_ops
, priv_size
);
360 wiphy
->flags
|= WIPHY_FLAG_NETNS_OK
|
361 WIPHY_FLAG_4ADDR_AP
|
362 WIPHY_FLAG_4ADDR_STATION
;
363 wiphy
->privid
= mac80211_wiphy_privid
;
365 wiphy
->bss_priv_size
= sizeof(struct ieee80211_bss
);
367 local
= wiphy_priv(wiphy
);
369 local
->hw
.wiphy
= wiphy
;
371 local
->hw
.priv
= (char *)local
+ ALIGN(sizeof(*local
), NETDEV_ALIGN
);
376 BUG_ON(!ops
->config
);
377 BUG_ON(!ops
->add_interface
);
378 BUG_ON(!ops
->remove_interface
);
379 BUG_ON(!ops
->configure_filter
);
382 /* set up some defaults */
383 local
->hw
.queues
= 1;
384 local
->hw
.max_rates
= 1;
385 local
->hw
.conf
.long_frame_max_tx_count
= wiphy
->retry_long
;
386 local
->hw
.conf
.short_frame_max_tx_count
= wiphy
->retry_short
;
387 local
->user_power_level
= -1;
389 INIT_LIST_HEAD(&local
->interfaces
);
390 mutex_init(&local
->iflist_mtx
);
391 mutex_init(&local
->scan_mtx
);
393 spin_lock_init(&local
->key_lock
);
394 spin_lock_init(&local
->filter_lock
);
395 spin_lock_init(&local
->queue_stop_reason_lock
);
397 INIT_DELAYED_WORK(&local
->scan_work
, ieee80211_scan_work
);
399 ieee80211_work_init(local
);
401 INIT_WORK(&local
->restart_work
, ieee80211_restart_work
);
403 INIT_WORK(&local
->reconfig_filter
, ieee80211_reconfig_filter
);
404 INIT_WORK(&local
->recalc_smps
, ieee80211_recalc_smps_work
);
405 local
->smps_mode
= IEEE80211_SMPS_OFF
;
407 INIT_WORK(&local
->dynamic_ps_enable_work
,
408 ieee80211_dynamic_ps_enable_work
);
409 INIT_WORK(&local
->dynamic_ps_disable_work
,
410 ieee80211_dynamic_ps_disable_work
);
411 setup_timer(&local
->dynamic_ps_timer
,
412 ieee80211_dynamic_ps_timer
, (unsigned long) local
);
414 sta_info_init(local
);
416 for (i
= 0; i
< IEEE80211_MAX_QUEUES
; i
++)
417 skb_queue_head_init(&local
->pending
[i
]);
418 tasklet_init(&local
->tx_pending_tasklet
, ieee80211_tx_pending
,
419 (unsigned long)local
);
421 tasklet_init(&local
->tasklet
,
422 ieee80211_tasklet_handler
,
423 (unsigned long) local
);
425 skb_queue_head_init(&local
->skb_queue
);
426 skb_queue_head_init(&local
->skb_queue_unreliable
);
428 spin_lock_init(&local
->ampdu_lock
);
430 return local_to_hw(local
);
432 EXPORT_SYMBOL(ieee80211_alloc_hw
);
434 int ieee80211_register_hw(struct ieee80211_hw
*hw
)
436 struct ieee80211_local
*local
= hw_to_local(hw
);
438 enum ieee80211_band band
;
439 int channels
, i
, j
, max_bitrates
;
441 static const u32 cipher_suites
[] = {
442 WLAN_CIPHER_SUITE_WEP40
,
443 WLAN_CIPHER_SUITE_WEP104
,
444 WLAN_CIPHER_SUITE_TKIP
,
445 WLAN_CIPHER_SUITE_CCMP
,
447 /* keep last -- depends on hw flags! */
448 WLAN_CIPHER_SUITE_AES_CMAC
452 * generic code guarantees at least one band,
453 * set this very early because much code assumes
454 * that hw.conf.channel is assigned
459 for (band
= 0; band
< IEEE80211_NUM_BANDS
; band
++) {
460 struct ieee80211_supported_band
*sband
;
462 sband
= local
->hw
.wiphy
->bands
[band
];
465 if (!local
->oper_channel
) {
466 /* init channel we're on */
467 local
->hw
.conf
.channel
=
468 local
->oper_channel
= &sband
->channels
[0];
469 local
->hw
.conf
.channel_type
= NL80211_CHAN_NO_HT
;
471 channels
+= sband
->n_channels
;
473 if (max_bitrates
< sband
->n_bitrates
)
474 max_bitrates
= sband
->n_bitrates
;
475 supp_ht
= supp_ht
|| sband
->ht_cap
.ht_supported
;
478 local
->int_scan_req
= kzalloc(sizeof(*local
->int_scan_req
) +
479 sizeof(void *) * channels
, GFP_KERNEL
);
480 if (!local
->int_scan_req
)
483 /* if low-level driver supports AP, we also support VLAN */
484 if (local
->hw
.wiphy
->interface_modes
& BIT(NL80211_IFTYPE_AP
))
485 local
->hw
.wiphy
->interface_modes
|= BIT(NL80211_IFTYPE_AP_VLAN
);
487 /* mac80211 always supports monitor */
488 local
->hw
.wiphy
->interface_modes
|= BIT(NL80211_IFTYPE_MONITOR
);
490 if (local
->hw
.flags
& IEEE80211_HW_SIGNAL_DBM
)
491 local
->hw
.wiphy
->signal_type
= CFG80211_SIGNAL_TYPE_MBM
;
492 else if (local
->hw
.flags
& IEEE80211_HW_SIGNAL_UNSPEC
)
493 local
->hw
.wiphy
->signal_type
= CFG80211_SIGNAL_TYPE_UNSPEC
;
496 * Calculate scan IE length -- we need this to alloc
497 * memory and to subtract from the driver limit. It
498 * includes the (extended) supported rates and HT
499 * information -- SSID is the driver's responsibility.
501 local
->scan_ies_len
= 4 + max_bitrates
; /* (ext) supp rates */
503 local
->scan_ies_len
+= 2 + sizeof(struct ieee80211_ht_cap
);
505 if (!local
->ops
->hw_scan
) {
506 /* For hw_scan, driver needs to set these up. */
507 local
->hw
.wiphy
->max_scan_ssids
= 4;
508 local
->hw
.wiphy
->max_scan_ie_len
= IEEE80211_MAX_DATA_LEN
;
512 * If the driver supports any scan IEs, then assume the
513 * limit includes the IEs mac80211 will add, otherwise
514 * leave it at zero and let the driver sort it out; we
515 * still pass our IEs to the driver but userspace will
516 * not be allowed to in that case.
518 if (local
->hw
.wiphy
->max_scan_ie_len
)
519 local
->hw
.wiphy
->max_scan_ie_len
-= local
->scan_ies_len
;
521 local
->hw
.wiphy
->cipher_suites
= cipher_suites
;
522 local
->hw
.wiphy
->n_cipher_suites
= ARRAY_SIZE(cipher_suites
);
523 if (!(local
->hw
.flags
& IEEE80211_HW_MFP_CAPABLE
))
524 local
->hw
.wiphy
->n_cipher_suites
--;
526 result
= wiphy_register(local
->hw
.wiphy
);
528 goto fail_wiphy_register
;
531 * We use the number of queues for feature tests (QoS, HT) internally
532 * so restrict them appropriately.
534 if (hw
->queues
> IEEE80211_MAX_QUEUES
)
535 hw
->queues
= IEEE80211_MAX_QUEUES
;
538 create_singlethread_workqueue(wiphy_name(local
->hw
.wiphy
));
539 if (!local
->workqueue
) {
545 * The hardware needs headroom for sending the frame,
546 * and we need some headroom for passing the frame to monitor
547 * interfaces, but never both at the same time.
549 BUILD_BUG_ON(IEEE80211_TX_STATUS_HEADROOM
!=
550 sizeof(struct ieee80211_tx_status_rtap_hdr
));
551 local
->tx_headroom
= max_t(unsigned int , local
->hw
.extra_tx_headroom
,
552 sizeof(struct ieee80211_tx_status_rtap_hdr
));
554 debugfs_hw_add(local
);
556 if (local
->hw
.max_listen_interval
== 0)
557 local
->hw
.max_listen_interval
= 1;
559 local
->hw
.conf
.listen_interval
= local
->hw
.max_listen_interval
;
561 result
= sta_info_start(local
);
565 result
= ieee80211_wep_init(local
);
567 printk(KERN_DEBUG
"%s: Failed to initialize wep: %d\n",
568 wiphy_name(local
->hw
.wiphy
), result
);
574 result
= ieee80211_init_rate_ctrl_alg(local
,
575 hw
->rate_control_algorithm
);
577 printk(KERN_DEBUG
"%s: Failed to initialize rate control "
578 "algorithm\n", wiphy_name(local
->hw
.wiphy
));
582 /* add one default STA interface if supported */
583 if (local
->hw
.wiphy
->interface_modes
& BIT(NL80211_IFTYPE_STATION
)) {
584 result
= ieee80211_if_add(local
, "wlan%d", NULL
,
585 NL80211_IFTYPE_STATION
, NULL
);
587 printk(KERN_WARNING
"%s: Failed to add default virtual iface\n",
588 wiphy_name(local
->hw
.wiphy
));
593 ieee80211_led_init(local
);
595 /* alloc internal scan request */
597 local
->int_scan_req
->ssids
= &local
->scan_ssid
;
598 local
->int_scan_req
->n_ssids
= 1;
599 for (band
= 0; band
< IEEE80211_NUM_BANDS
; band
++) {
600 if (!hw
->wiphy
->bands
[band
])
602 for (j
= 0; j
< hw
->wiphy
->bands
[band
]->n_channels
; j
++) {
603 local
->int_scan_req
->channels
[i
] =
604 &hw
->wiphy
->bands
[band
]->channels
[j
];
608 local
->int_scan_req
->n_channels
= i
;
610 local
->network_latency_notifier
.notifier_call
=
611 ieee80211_max_network_latency
;
612 result
= pm_qos_add_notifier(PM_QOS_NETWORK_LATENCY
,
613 &local
->network_latency_notifier
);
623 ieee80211_led_exit(local
);
624 ieee80211_remove_interfaces(local
);
627 ieee80211_wep_free(local
);
629 sta_info_stop(local
);
631 destroy_workqueue(local
->workqueue
);
633 wiphy_unregister(local
->hw
.wiphy
);
635 kfree(local
->int_scan_req
);
638 EXPORT_SYMBOL(ieee80211_register_hw
);
640 void ieee80211_unregister_hw(struct ieee80211_hw
*hw
)
642 struct ieee80211_local
*local
= hw_to_local(hw
);
644 tasklet_kill(&local
->tx_pending_tasklet
);
645 tasklet_kill(&local
->tasklet
);
647 pm_qos_remove_notifier(PM_QOS_NETWORK_LATENCY
,
648 &local
->network_latency_notifier
);
653 * At this point, interface list manipulations are fine
654 * because the driver cannot be handing us frames any
655 * more and the tasklet is killed.
657 ieee80211_remove_interfaces(local
);
661 cancel_work_sync(&local
->reconfig_filter
);
663 ieee80211_clear_tx_pending(local
);
664 sta_info_stop(local
);
665 rate_control_deinitialize(local
);
667 if (skb_queue_len(&local
->skb_queue
) ||
668 skb_queue_len(&local
->skb_queue_unreliable
))
669 printk(KERN_WARNING
"%s: skb_queue not empty\n",
670 wiphy_name(local
->hw
.wiphy
));
671 skb_queue_purge(&local
->skb_queue
);
672 skb_queue_purge(&local
->skb_queue_unreliable
);
674 destroy_workqueue(local
->workqueue
);
675 wiphy_unregister(local
->hw
.wiphy
);
676 ieee80211_wep_free(local
);
677 ieee80211_led_exit(local
);
678 kfree(local
->int_scan_req
);
680 EXPORT_SYMBOL(ieee80211_unregister_hw
);
682 void ieee80211_free_hw(struct ieee80211_hw
*hw
)
684 struct ieee80211_local
*local
= hw_to_local(hw
);
686 mutex_destroy(&local
->iflist_mtx
);
687 mutex_destroy(&local
->scan_mtx
);
689 wiphy_free(local
->hw
.wiphy
);
691 EXPORT_SYMBOL(ieee80211_free_hw
);
693 static int __init
ieee80211_init(void)
698 BUILD_BUG_ON(sizeof(struct ieee80211_tx_info
) > sizeof(skb
->cb
));
699 BUILD_BUG_ON(offsetof(struct ieee80211_tx_info
, driver_data
) +
700 IEEE80211_TX_INFO_DRIVER_DATA_SIZE
> sizeof(skb
->cb
));
702 ret
= rc80211_minstrel_init();
706 ret
= rc80211_pid_init();
710 ret
= ieee80211_iface_init();
718 rc80211_minstrel_exit();
723 static void __exit
ieee80211_exit(void)
726 rc80211_minstrel_exit();
729 * For key todo, it'll be empty by now but the work
730 * might still be scheduled.
732 flush_scheduled_work();
737 ieee80211_iface_exit();
741 subsys_initcall(ieee80211_init
);
742 module_exit(ieee80211_exit
);
744 MODULE_DESCRIPTION("IEEE 802.11 subsystem");
745 MODULE_LICENSE("GPL");