1 /******************************************************************************
3 * Copyright(c) 2003 - 2011 Intel Corporation. All rights reserved.
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of version 2 of the GNU General Public License as
7 * published by the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
18 * The full GNU General Public License is included in this distribution in the
19 * file called LICENSE.
21 * Contact Information:
22 * Intel Linux Wireless <ilw@linux.intel.com>
23 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
25 *****************************************************************************/
31 #include "iwl-agn-calib.h"
32 #include "iwl-helpers.h"
34 static int iwlagn_disable_bss(struct iwl_priv
*priv
,
35 struct iwl_rxon_context
*ctx
,
36 struct iwl_rxon_cmd
*send
)
38 __le32 old_filter
= send
->filter_flags
;
41 send
->filter_flags
&= ~RXON_FILTER_ASSOC_MSK
;
42 ret
= iwl_send_cmd_pdu(priv
, ctx
->rxon_cmd
, sizeof(*send
), send
);
44 send
->filter_flags
= old_filter
;
47 IWL_ERR(priv
, "Error clearing ASSOC_MSK on BSS (%d)\n", ret
);
52 static int iwlagn_disable_pan(struct iwl_priv
*priv
,
53 struct iwl_rxon_context
*ctx
,
54 struct iwl_rxon_cmd
*send
)
56 struct iwl_notification_wait disable_wait
;
57 __le32 old_filter
= send
->filter_flags
;
58 u8 old_dev_type
= send
->dev_type
;
61 iwlagn_init_notification_wait(priv
, &disable_wait
,
62 REPLY_WIPAN_DEACTIVATION_COMPLETE
,
65 send
->filter_flags
&= ~RXON_FILTER_ASSOC_MSK
;
66 send
->dev_type
= RXON_DEV_TYPE_P2P
;
67 ret
= iwl_send_cmd_pdu(priv
, ctx
->rxon_cmd
, sizeof(*send
), send
);
69 send
->filter_flags
= old_filter
;
70 send
->dev_type
= old_dev_type
;
73 IWL_ERR(priv
, "Error disabling PAN (%d)\n", ret
);
74 iwlagn_remove_notification(priv
, &disable_wait
);
78 wait_res
= iwlagn_wait_notification(priv
, &disable_wait
, HZ
);
80 IWL_ERR(priv
, "Timed out waiting for PAN disable\n");
88 static void iwlagn_update_qos(struct iwl_priv
*priv
,
89 struct iwl_rxon_context
*ctx
)
96 ctx
->qos_data
.def_qos_parm
.qos_flags
= 0;
98 if (ctx
->qos_data
.qos_active
)
99 ctx
->qos_data
.def_qos_parm
.qos_flags
|=
100 QOS_PARAM_FLG_UPDATE_EDCA_MSK
;
103 ctx
->qos_data
.def_qos_parm
.qos_flags
|= QOS_PARAM_FLG_TGN_MSK
;
105 IWL_DEBUG_QOS(priv
, "send QoS cmd with Qos active=%d FLAGS=0x%X\n",
106 ctx
->qos_data
.qos_active
,
107 ctx
->qos_data
.def_qos_parm
.qos_flags
);
109 ret
= iwl_send_cmd_pdu(priv
, ctx
->qos_cmd
,
110 sizeof(struct iwl_qosparam_cmd
),
111 &ctx
->qos_data
.def_qos_parm
);
113 IWL_ERR(priv
, "Failed to update QoS\n");
116 static int iwlagn_update_beacon(struct iwl_priv
*priv
,
117 struct ieee80211_vif
*vif
)
119 lockdep_assert_held(&priv
->mutex
);
121 dev_kfree_skb(priv
->beacon_skb
);
122 priv
->beacon_skb
= ieee80211_beacon_get(priv
->hw
, vif
);
123 if (!priv
->beacon_skb
)
125 return iwlagn_send_beacon_cmd(priv
);
129 * iwlagn_commit_rxon - commit staging_rxon to hardware
131 * The RXON command in staging_rxon is committed to the hardware and
132 * the active_rxon structure is updated with the new data. This
133 * function correctly transitions out of the RXON_ASSOC_MSK state if
134 * a HW tune is required based on the RXON structure changes.
136 int iwlagn_commit_rxon(struct iwl_priv
*priv
, struct iwl_rxon_context
*ctx
)
138 /* cast away the const for active_rxon in this function */
139 struct iwl_rxon_cmd
*active
= (void *)&ctx
->active
;
140 bool new_assoc
= !!(ctx
->staging
.filter_flags
& RXON_FILTER_ASSOC_MSK
);
141 bool old_assoc
= !!(ctx
->active
.filter_flags
& RXON_FILTER_ASSOC_MSK
);
144 lockdep_assert_held(&priv
->mutex
);
146 if (test_bit(STATUS_EXIT_PENDING
, &priv
->status
))
149 if (!iwl_is_alive(priv
))
152 /* This function hardcodes a bunch of dual-mode assumptions */
153 BUILD_BUG_ON(NUM_IWL_RXON_CTX
!= 2);
158 /* always get timestamp with Rx frame */
159 ctx
->staging
.flags
|= RXON_FLG_TSF2HOST_MSK
;
161 if (ctx
->ctxid
== IWL_RXON_CTX_PAN
&& priv
->_agn
.hw_roc_channel
) {
162 struct ieee80211_channel
*chan
= priv
->_agn
.hw_roc_channel
;
164 iwl_set_rxon_channel(priv
, chan
, ctx
);
165 iwl_set_flags_for_band(priv
, ctx
, chan
->band
, NULL
);
166 ctx
->staging
.filter_flags
|=
167 RXON_FILTER_ASSOC_MSK
|
168 RXON_FILTER_PROMISC_MSK
|
169 RXON_FILTER_CTL2HOST_MSK
;
170 ctx
->staging
.dev_type
= RXON_DEV_TYPE_P2P
;
173 if (memcmp(&ctx
->staging
, &ctx
->active
,
174 sizeof(ctx
->staging
)) == 0)
178 if ((ctx
->vif
&& ctx
->vif
->bss_conf
.use_short_slot
) ||
179 !(ctx
->staging
.flags
& RXON_FLG_BAND_24G_MSK
))
180 ctx
->staging
.flags
|= RXON_FLG_SHORT_SLOT_MSK
;
182 ctx
->staging
.flags
&= ~RXON_FLG_SHORT_SLOT_MSK
;
184 ret
= iwl_check_rxon_cmd(priv
, ctx
);
186 IWL_ERR(priv
, "Invalid RXON configuration. Not committing.\n");
191 * receive commit_rxon request
192 * abort any previous channel switch if still in process
194 if (priv
->switch_rxon
.switch_in_progress
&&
195 (priv
->switch_rxon
.channel
!= ctx
->staging
.channel
)) {
196 IWL_DEBUG_11H(priv
, "abort channel switch on %d\n",
197 le16_to_cpu(priv
->switch_rxon
.channel
));
198 iwl_chswitch_done(priv
, false);
202 * If we don't need to send a full RXON, we can use
203 * iwl_rxon_assoc_cmd which is used to reconfigure filter
204 * and other flags for the current radio configuration.
206 if (!iwl_full_rxon_required(priv
, ctx
)) {
207 ret
= iwl_send_rxon_assoc(priv
, ctx
);
209 IWL_ERR(priv
, "Error setting RXON_ASSOC (%d)\n", ret
);
213 memcpy(active
, &ctx
->staging
, sizeof(*active
));
214 iwl_print_rx_config_cmd(priv
, ctx
);
218 if (priv
->cfg
->ops
->hcmd
->set_pan_params
) {
219 ret
= priv
->cfg
->ops
->hcmd
->set_pan_params(priv
);
224 iwl_set_rxon_hwcrypto(priv
, ctx
, !priv
->cfg
->mod_params
->sw_crypto
);
227 "Going to commit RXON\n"
228 " * with%s RXON_FILTER_ASSOC_MSK\n"
231 (new_assoc
? "" : "out"),
232 le16_to_cpu(ctx
->staging
.channel
),
233 ctx
->staging
.bssid_addr
);
236 * Always clear associated first, but with the correct config.
237 * This is required as for example station addition for the
238 * AP station must be done after the BSSID is set to correctly
239 * set up filters in the device.
241 if ((old_assoc
&& new_assoc
) || !new_assoc
) {
242 if (ctx
->ctxid
== IWL_RXON_CTX_BSS
)
243 ret
= iwlagn_disable_bss(priv
, ctx
, &ctx
->staging
);
245 ret
= iwlagn_disable_pan(priv
, ctx
, &ctx
->staging
);
249 memcpy(active
, &ctx
->staging
, sizeof(*active
));
252 * Un-assoc RXON clears the station table and WEP
253 * keys, so we have to restore those afterwards.
255 iwl_clear_ucode_stations(priv
, ctx
);
256 iwl_restore_stations(priv
, ctx
);
257 ret
= iwl_restore_default_wep_keys(priv
, ctx
);
259 IWL_ERR(priv
, "Failed to restore WEP keys (%d)\n", ret
);
264 /* RXON timing must be before associated RXON */
265 ret
= iwl_send_rxon_timing(priv
, ctx
);
267 IWL_ERR(priv
, "Failed to send timing (%d)!\n", ret
);
272 /* QoS info may be cleared by previous un-assoc RXON */
273 iwlagn_update_qos(priv
, ctx
);
276 * We'll run into this code path when beaconing is
277 * enabled, but then we also need to send the beacon
280 if (ctx
->vif
&& (ctx
->vif
->type
== NL80211_IFTYPE_AP
)) {
281 ret
= iwlagn_update_beacon(priv
, ctx
->vif
);
284 "Error sending required beacon (%d)!\n",
290 priv
->start_calib
= 0;
292 * Apply the new configuration.
294 * Associated RXON doesn't clear the station table in uCode,
295 * so we don't need to restore stations etc. after this.
297 ret
= iwl_send_cmd_pdu(priv
, ctx
->rxon_cmd
,
298 sizeof(struct iwl_rxon_cmd
), &ctx
->staging
);
300 IWL_ERR(priv
, "Error setting new RXON (%d)\n", ret
);
303 memcpy(active
, &ctx
->staging
, sizeof(*active
));
305 iwl_reprogram_ap_sta(priv
, ctx
);
307 /* IBSS beacon needs to be sent after setting assoc */
308 if (ctx
->vif
&& (ctx
->vif
->type
== NL80211_IFTYPE_ADHOC
))
309 if (iwlagn_update_beacon(priv
, ctx
->vif
))
310 IWL_ERR(priv
, "Error sending IBSS beacon\n");
313 iwl_print_rx_config_cmd(priv
, ctx
);
315 iwl_init_sensitivity(priv
);
318 * If we issue a new RXON command which required a tune then we must
319 * send a new TXPOWER command or we won't be able to Tx any frames.
321 * It's expected we set power here if channel is changing.
323 ret
= iwl_set_tx_power(priv
, priv
->tx_power_next
, true);
325 IWL_ERR(priv
, "Error sending TX power (%d)\n", ret
);
332 int iwlagn_mac_config(struct ieee80211_hw
*hw
, u32 changed
)
334 struct iwl_priv
*priv
= hw
->priv
;
335 struct iwl_rxon_context
*ctx
;
336 struct ieee80211_conf
*conf
= &hw
->conf
;
337 struct ieee80211_channel
*channel
= conf
->channel
;
338 const struct iwl_channel_info
*ch_info
;
340 bool ht_changed
[NUM_IWL_RXON_CTX
] = {};
342 IWL_DEBUG_MAC80211(priv
, "changed %#x", changed
);
344 mutex_lock(&priv
->mutex
);
346 if (unlikely(test_bit(STATUS_SCANNING
, &priv
->status
))) {
347 IWL_DEBUG_MAC80211(priv
, "leave - scanning\n");
351 if (!iwl_is_ready(priv
)) {
352 IWL_DEBUG_MAC80211(priv
, "leave - not ready\n");
356 if (changed
& (IEEE80211_CONF_CHANGE_SMPS
|
357 IEEE80211_CONF_CHANGE_CHANNEL
)) {
358 /* mac80211 uses static for non-HT which is what we want */
359 priv
->current_ht_config
.smps
= conf
->smps_mode
;
362 * Recalculate chain counts.
364 * If monitor mode is enabled then mac80211 will
365 * set up the SM PS mode to OFF if an HT channel is
368 if (priv
->cfg
->ops
->hcmd
->set_rxon_chain
)
369 for_each_context(priv
, ctx
)
370 priv
->cfg
->ops
->hcmd
->set_rxon_chain(priv
, ctx
);
373 if (changed
& IEEE80211_CONF_CHANGE_CHANNEL
) {
376 ch_info
= iwl_get_channel_info(priv
, channel
->band
,
378 if (!is_channel_valid(ch_info
)) {
379 IWL_DEBUG_MAC80211(priv
, "leave - invalid channel\n");
384 spin_lock_irqsave(&priv
->lock
, flags
);
386 for_each_context(priv
, ctx
) {
387 /* Configure HT40 channels */
388 if (ctx
->ht
.enabled
!= conf_is_ht(conf
)) {
389 ctx
->ht
.enabled
= conf_is_ht(conf
);
390 ht_changed
[ctx
->ctxid
] = true;
393 if (ctx
->ht
.enabled
) {
394 if (conf_is_ht40_minus(conf
)) {
395 ctx
->ht
.extension_chan_offset
=
396 IEEE80211_HT_PARAM_CHA_SEC_BELOW
;
397 ctx
->ht
.is_40mhz
= true;
398 } else if (conf_is_ht40_plus(conf
)) {
399 ctx
->ht
.extension_chan_offset
=
400 IEEE80211_HT_PARAM_CHA_SEC_ABOVE
;
401 ctx
->ht
.is_40mhz
= true;
403 ctx
->ht
.extension_chan_offset
=
404 IEEE80211_HT_PARAM_CHA_SEC_NONE
;
405 ctx
->ht
.is_40mhz
= false;
408 ctx
->ht
.is_40mhz
= false;
411 * Default to no protection. Protection mode will
412 * later be set from BSS config in iwl_ht_conf
414 ctx
->ht
.protection
= IEEE80211_HT_OP_MODE_PROTECTION_NONE
;
416 /* if we are switching from ht to 2.4 clear flags
417 * from any ht related info since 2.4 does not
419 if (le16_to_cpu(ctx
->staging
.channel
) !=
421 ctx
->staging
.flags
= 0;
423 iwl_set_rxon_channel(priv
, channel
, ctx
);
424 iwl_set_rxon_ht(priv
, &priv
->current_ht_config
);
426 iwl_set_flags_for_band(priv
, ctx
, channel
->band
,
430 spin_unlock_irqrestore(&priv
->lock
, flags
);
432 iwl_update_bcast_stations(priv
);
435 * The list of supported rates and rate mask can be different
436 * for each band; since the band may have changed, reset
437 * the rate mask to what mac80211 lists.
442 if (changed
& (IEEE80211_CONF_CHANGE_PS
|
443 IEEE80211_CONF_CHANGE_IDLE
)) {
444 ret
= iwl_power_update_mode(priv
, false);
446 IWL_DEBUG_MAC80211(priv
, "Error setting sleep level\n");
449 if (changed
& IEEE80211_CONF_CHANGE_POWER
) {
450 IWL_DEBUG_MAC80211(priv
, "TX Power old=%d new=%d\n",
451 priv
->tx_power_user_lmt
, conf
->power_level
);
453 iwl_set_tx_power(priv
, conf
->power_level
, false);
456 for_each_context(priv
, ctx
) {
457 if (!memcmp(&ctx
->staging
, &ctx
->active
, sizeof(ctx
->staging
)))
459 iwlagn_commit_rxon(priv
, ctx
);
460 if (ht_changed
[ctx
->ctxid
])
461 iwlagn_update_qos(priv
, ctx
);
464 mutex_unlock(&priv
->mutex
);
468 static void iwlagn_check_needed_chains(struct iwl_priv
*priv
,
469 struct iwl_rxon_context
*ctx
,
470 struct ieee80211_bss_conf
*bss_conf
)
472 struct ieee80211_vif
*vif
= ctx
->vif
;
473 struct iwl_rxon_context
*tmp
;
474 struct ieee80211_sta
*sta
;
475 struct iwl_ht_config
*ht_conf
= &priv
->current_ht_config
;
476 struct ieee80211_sta_ht_cap
*ht_cap
;
479 lockdep_assert_held(&priv
->mutex
);
482 case NL80211_IFTYPE_STATION
:
484 sta
= ieee80211_find_sta(vif
, bss_conf
->bssid
);
487 * If at all, this can only happen through a race
488 * when the AP disconnects us while we're still
489 * setting up the connection, in that case mac80211
490 * will soon tell us about that.
492 need_multiple
= false;
497 ht_cap
= &sta
->ht_cap
;
499 need_multiple
= true;
502 * If the peer advertises no support for receiving 2 and 3
503 * stream MCS rates, it can't be transmitting them either.
505 if (ht_cap
->mcs
.rx_mask
[1] == 0 &&
506 ht_cap
->mcs
.rx_mask
[2] == 0) {
507 need_multiple
= false;
508 } else if (!(ht_cap
->mcs
.tx_params
&
509 IEEE80211_HT_MCS_TX_DEFINED
)) {
510 /* If it can't TX MCS at all ... */
511 need_multiple
= false;
512 } else if (ht_cap
->mcs
.tx_params
&
513 IEEE80211_HT_MCS_TX_RX_DIFF
) {
517 * But if it can receive them, it might still not
518 * be able to transmit them, which is what we need
519 * to check here -- so check the number of streams
520 * it advertises for TX (if different from RX).
523 maxstreams
= (ht_cap
->mcs
.tx_params
&
524 IEEE80211_HT_MCS_TX_MAX_STREAMS_MASK
);
526 IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT
;
530 need_multiple
= false;
535 case NL80211_IFTYPE_ADHOC
:
537 need_multiple
= false;
541 need_multiple
= true;
545 ctx
->ht_need_multiple_chains
= need_multiple
;
547 if (!need_multiple
) {
548 /* check all contexts */
549 for_each_context(priv
, tmp
) {
552 if (tmp
->ht_need_multiple_chains
) {
553 need_multiple
= true;
559 ht_conf
->single_chain_sufficient
= !need_multiple
;
562 void iwlagn_bss_info_changed(struct ieee80211_hw
*hw
,
563 struct ieee80211_vif
*vif
,
564 struct ieee80211_bss_conf
*bss_conf
,
567 struct iwl_priv
*priv
= hw
->priv
;
568 struct iwl_rxon_context
*ctx
= iwl_rxon_ctx_from_vif(vif
);
572 mutex_lock(&priv
->mutex
);
574 if (unlikely(!iwl_is_ready(priv
))) {
575 IWL_DEBUG_MAC80211(priv
, "leave - not ready\n");
576 mutex_unlock(&priv
->mutex
);
580 if (unlikely(!ctx
->vif
)) {
581 IWL_DEBUG_MAC80211(priv
, "leave - vif is NULL\n");
582 mutex_unlock(&priv
->mutex
);
586 if (changes
& BSS_CHANGED_BEACON_INT
)
589 if (changes
& BSS_CHANGED_QOS
) {
590 ctx
->qos_data
.qos_active
= bss_conf
->qos
;
591 iwlagn_update_qos(priv
, ctx
);
594 ctx
->staging
.assoc_id
= cpu_to_le16(vif
->bss_conf
.aid
);
595 if (vif
->bss_conf
.use_short_preamble
)
596 ctx
->staging
.flags
|= RXON_FLG_SHORT_PREAMBLE_MSK
;
598 ctx
->staging
.flags
&= ~RXON_FLG_SHORT_PREAMBLE_MSK
;
600 if (changes
& BSS_CHANGED_ASSOC
) {
601 if (bss_conf
->assoc
) {
602 priv
->timestamp
= bss_conf
->timestamp
;
603 ctx
->staging
.filter_flags
|= RXON_FILTER_ASSOC_MSK
;
606 * If we disassociate while there are pending
607 * frames, just wake up the queues and let the
608 * frames "escape" ... This shouldn't really
609 * be happening to start with, but we should
610 * not get stuck in this case either since it
611 * can happen if userspace gets confused.
613 if (ctx
->last_tx_rejected
) {
614 ctx
->last_tx_rejected
= false;
615 iwl_wake_any_queue(priv
, ctx
);
617 ctx
->staging
.filter_flags
&= ~RXON_FILTER_ASSOC_MSK
;
621 if (ctx
->ht
.enabled
) {
622 ctx
->ht
.protection
= bss_conf
->ht_operation_mode
&
623 IEEE80211_HT_OP_MODE_PROTECTION
;
624 ctx
->ht
.non_gf_sta_present
= !!(bss_conf
->ht_operation_mode
&
625 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT
);
626 iwlagn_check_needed_chains(priv
, ctx
, bss_conf
);
627 iwl_set_rxon_ht(priv
, &priv
->current_ht_config
);
630 if (priv
->cfg
->ops
->hcmd
->set_rxon_chain
)
631 priv
->cfg
->ops
->hcmd
->set_rxon_chain(priv
, ctx
);
633 if (bss_conf
->use_cts_prot
&& (priv
->band
!= IEEE80211_BAND_5GHZ
))
634 ctx
->staging
.flags
|= RXON_FLG_TGG_PROTECT_MSK
;
636 ctx
->staging
.flags
&= ~RXON_FLG_TGG_PROTECT_MSK
;
638 if (bss_conf
->use_cts_prot
)
639 ctx
->staging
.flags
|= RXON_FLG_SELF_CTS_EN
;
641 ctx
->staging
.flags
&= ~RXON_FLG_SELF_CTS_EN
;
643 memcpy(ctx
->staging
.bssid_addr
, bss_conf
->bssid
, ETH_ALEN
);
645 if (vif
->type
== NL80211_IFTYPE_AP
||
646 vif
->type
== NL80211_IFTYPE_ADHOC
) {
647 if (vif
->bss_conf
.enable_beacon
) {
648 ctx
->staging
.filter_flags
|= RXON_FILTER_ASSOC_MSK
;
649 priv
->beacon_ctx
= ctx
;
651 ctx
->staging
.filter_flags
&= ~RXON_FILTER_ASSOC_MSK
;
652 priv
->beacon_ctx
= NULL
;
656 if (force
|| memcmp(&ctx
->staging
, &ctx
->active
, sizeof(ctx
->staging
)))
657 iwlagn_commit_rxon(priv
, ctx
);
659 if (changes
& BSS_CHANGED_ASSOC
&& bss_conf
->assoc
) {
661 * The chain noise calibration will enable PM upon
662 * completion. If calibration has already been run
663 * then we need to enable power management here.
665 if (priv
->chain_noise_data
.state
== IWL_CHAIN_NOISE_DONE
)
666 iwl_power_update_mode(priv
, false);
668 /* Enable RX differential gain and sensitivity calibrations */
669 iwl_chain_noise_reset(priv
);
670 priv
->start_calib
= 1;
673 if (changes
& BSS_CHANGED_IBSS
) {
674 ret
= iwlagn_manage_ibss_station(priv
, vif
,
675 bss_conf
->ibss_joined
);
677 IWL_ERR(priv
, "failed to %s IBSS station %pM\n",
678 bss_conf
->ibss_joined
? "add" : "remove",
682 if (changes
& BSS_CHANGED_BEACON
&& vif
->type
== NL80211_IFTYPE_ADHOC
&&
684 if (iwlagn_update_beacon(priv
, vif
))
685 IWL_ERR(priv
, "Error sending IBSS beacon\n");
688 mutex_unlock(&priv
->mutex
);
691 void iwlagn_post_scan(struct iwl_priv
*priv
)
693 struct iwl_rxon_context
*ctx
;
696 * Since setting the RXON may have been deferred while
697 * performing the scan, fire one off if needed
699 for_each_context(priv
, ctx
)
700 if (memcmp(&ctx
->staging
, &ctx
->active
, sizeof(ctx
->staging
)))
701 iwlagn_commit_rxon(priv
, ctx
);
703 if (priv
->cfg
->ops
->hcmd
->set_pan_params
)
704 priv
->cfg
->ops
->hcmd
->set_pan_params(priv
);