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 *****************************************************************************/
30 #include "iwl-agn-calib.h"
31 #include "iwl-trans.h"
32 #include "iwl-shared.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_trans_send_cmd_pdu(trans(priv
), ctx
->rxon_cmd
,
43 CMD_SYNC
, sizeof(*send
), send
);
45 send
->filter_flags
= old_filter
;
48 IWL_ERR(priv
, "Error clearing ASSOC_MSK on BSS (%d)\n", ret
);
53 static int iwlagn_disable_pan(struct iwl_priv
*priv
,
54 struct iwl_rxon_context
*ctx
,
55 struct iwl_rxon_cmd
*send
)
57 struct iwl_notification_wait disable_wait
;
58 __le32 old_filter
= send
->filter_flags
;
59 u8 old_dev_type
= send
->dev_type
;
62 iwlagn_init_notification_wait(priv
, &disable_wait
,
63 REPLY_WIPAN_DEACTIVATION_COMPLETE
,
66 send
->filter_flags
&= ~RXON_FILTER_ASSOC_MSK
;
67 send
->dev_type
= RXON_DEV_TYPE_P2P
;
68 ret
= iwl_trans_send_cmd_pdu(trans(priv
), ctx
->rxon_cmd
,
69 CMD_SYNC
, sizeof(*send
), send
);
71 send
->filter_flags
= old_filter
;
72 send
->dev_type
= old_dev_type
;
75 IWL_ERR(priv
, "Error disabling PAN (%d)\n", ret
);
76 iwlagn_remove_notification(priv
, &disable_wait
);
78 ret
= iwlagn_wait_notification(priv
, &disable_wait
, HZ
);
80 IWL_ERR(priv
, "Timed out waiting for PAN disable\n");
86 static int iwlagn_disconn_pan(struct iwl_priv
*priv
,
87 struct iwl_rxon_context
*ctx
,
88 struct iwl_rxon_cmd
*send
)
90 __le32 old_filter
= send
->filter_flags
;
93 send
->filter_flags
&= ~RXON_FILTER_ASSOC_MSK
;
94 ret
= iwl_trans_send_cmd_pdu(trans(priv
), ctx
->rxon_cmd
, CMD_SYNC
,
97 send
->filter_flags
= old_filter
;
102 static void iwlagn_update_qos(struct iwl_priv
*priv
,
103 struct iwl_rxon_context
*ctx
)
110 ctx
->qos_data
.def_qos_parm
.qos_flags
= 0;
112 if (ctx
->qos_data
.qos_active
)
113 ctx
->qos_data
.def_qos_parm
.qos_flags
|=
114 QOS_PARAM_FLG_UPDATE_EDCA_MSK
;
117 ctx
->qos_data
.def_qos_parm
.qos_flags
|= QOS_PARAM_FLG_TGN_MSK
;
119 IWL_DEBUG_QOS(priv
, "send QoS cmd with Qos active=%d FLAGS=0x%X\n",
120 ctx
->qos_data
.qos_active
,
121 ctx
->qos_data
.def_qos_parm
.qos_flags
);
123 ret
= iwl_trans_send_cmd_pdu(trans(priv
), ctx
->qos_cmd
, CMD_SYNC
,
124 sizeof(struct iwl_qosparam_cmd
),
125 &ctx
->qos_data
.def_qos_parm
);
127 IWL_ERR(priv
, "Failed to update QoS\n");
130 static int iwlagn_update_beacon(struct iwl_priv
*priv
,
131 struct ieee80211_vif
*vif
)
133 lockdep_assert_held(&priv
->shrd
->mutex
);
135 dev_kfree_skb(priv
->beacon_skb
);
136 priv
->beacon_skb
= ieee80211_beacon_get(priv
->hw
, vif
);
137 if (!priv
->beacon_skb
)
139 return iwlagn_send_beacon_cmd(priv
);
142 static int iwlagn_send_rxon_assoc(struct iwl_priv
*priv
,
143 struct iwl_rxon_context
*ctx
)
146 struct iwl_rxon_assoc_cmd rxon_assoc
;
147 const struct iwl_rxon_cmd
*rxon1
= &ctx
->staging
;
148 const struct iwl_rxon_cmd
*rxon2
= &ctx
->active
;
150 if ((rxon1
->flags
== rxon2
->flags
) &&
151 (rxon1
->filter_flags
== rxon2
->filter_flags
) &&
152 (rxon1
->cck_basic_rates
== rxon2
->cck_basic_rates
) &&
153 (rxon1
->ofdm_ht_single_stream_basic_rates
==
154 rxon2
->ofdm_ht_single_stream_basic_rates
) &&
155 (rxon1
->ofdm_ht_dual_stream_basic_rates
==
156 rxon2
->ofdm_ht_dual_stream_basic_rates
) &&
157 (rxon1
->ofdm_ht_triple_stream_basic_rates
==
158 rxon2
->ofdm_ht_triple_stream_basic_rates
) &&
159 (rxon1
->acquisition_data
== rxon2
->acquisition_data
) &&
160 (rxon1
->rx_chain
== rxon2
->rx_chain
) &&
161 (rxon1
->ofdm_basic_rates
== rxon2
->ofdm_basic_rates
)) {
162 IWL_DEBUG_INFO(priv
, "Using current RXON_ASSOC. Not resending.\n");
166 rxon_assoc
.flags
= ctx
->staging
.flags
;
167 rxon_assoc
.filter_flags
= ctx
->staging
.filter_flags
;
168 rxon_assoc
.ofdm_basic_rates
= ctx
->staging
.ofdm_basic_rates
;
169 rxon_assoc
.cck_basic_rates
= ctx
->staging
.cck_basic_rates
;
170 rxon_assoc
.reserved1
= 0;
171 rxon_assoc
.reserved2
= 0;
172 rxon_assoc
.reserved3
= 0;
173 rxon_assoc
.ofdm_ht_single_stream_basic_rates
=
174 ctx
->staging
.ofdm_ht_single_stream_basic_rates
;
175 rxon_assoc
.ofdm_ht_dual_stream_basic_rates
=
176 ctx
->staging
.ofdm_ht_dual_stream_basic_rates
;
177 rxon_assoc
.rx_chain_select_flags
= ctx
->staging
.rx_chain
;
178 rxon_assoc
.ofdm_ht_triple_stream_basic_rates
=
179 ctx
->staging
.ofdm_ht_triple_stream_basic_rates
;
180 rxon_assoc
.acquisition_data
= ctx
->staging
.acquisition_data
;
182 ret
= iwl_trans_send_cmd_pdu(trans(priv
), ctx
->rxon_assoc_cmd
,
183 CMD_ASYNC
, sizeof(rxon_assoc
), &rxon_assoc
);
187 static int iwlagn_rxon_disconn(struct iwl_priv
*priv
,
188 struct iwl_rxon_context
*ctx
)
191 struct iwl_rxon_cmd
*active
= (void *)&ctx
->active
;
193 if (ctx
->ctxid
== IWL_RXON_CTX_BSS
) {
194 ret
= iwlagn_disable_bss(priv
, ctx
, &ctx
->staging
);
196 ret
= iwlagn_disable_pan(priv
, ctx
, &ctx
->staging
);
200 ret
= iwl_send_rxon_timing(priv
, ctx
);
202 IWL_ERR(priv
, "Failed to send timing (%d)!\n", ret
);
205 ret
= iwlagn_disconn_pan(priv
, ctx
, &ctx
->staging
);
212 * Un-assoc RXON clears the station table and WEP
213 * keys, so we have to restore those afterwards.
215 iwl_clear_ucode_stations(priv
, ctx
);
216 /* update -- might need P2P now */
217 iwl_update_bcast_station(priv
, ctx
);
218 iwl_restore_stations(priv
, ctx
);
219 ret
= iwl_restore_default_wep_keys(priv
, ctx
);
221 IWL_ERR(priv
, "Failed to restore WEP keys (%d)\n", ret
);
225 memcpy(active
, &ctx
->staging
, sizeof(*active
));
229 static int iwlagn_rxon_connect(struct iwl_priv
*priv
,
230 struct iwl_rxon_context
*ctx
)
233 struct iwl_rxon_cmd
*active
= (void *)&ctx
->active
;
235 /* RXON timing must be before associated RXON */
236 if (ctx
->ctxid
== IWL_RXON_CTX_BSS
) {
237 ret
= iwl_send_rxon_timing(priv
, ctx
);
239 IWL_ERR(priv
, "Failed to send timing (%d)!\n", ret
);
243 /* QoS info may be cleared by previous un-assoc RXON */
244 iwlagn_update_qos(priv
, ctx
);
247 * We'll run into this code path when beaconing is
248 * enabled, but then we also need to send the beacon
251 if (ctx
->vif
&& (ctx
->vif
->type
== NL80211_IFTYPE_AP
)) {
252 ret
= iwlagn_update_beacon(priv
, ctx
->vif
);
255 "Error sending required beacon (%d)!\n",
261 priv
->start_calib
= 0;
263 * Apply the new configuration.
265 * Associated RXON doesn't clear the station table in uCode,
266 * so we don't need to restore stations etc. after this.
268 ret
= iwl_trans_send_cmd_pdu(trans(priv
), ctx
->rxon_cmd
, CMD_SYNC
,
269 sizeof(struct iwl_rxon_cmd
), &ctx
->staging
);
271 IWL_ERR(priv
, "Error setting new RXON (%d)\n", ret
);
274 memcpy(active
, &ctx
->staging
, sizeof(*active
));
276 iwl_reprogram_ap_sta(priv
, ctx
);
278 /* IBSS beacon needs to be sent after setting assoc */
279 if (ctx
->vif
&& (ctx
->vif
->type
== NL80211_IFTYPE_ADHOC
))
280 if (iwlagn_update_beacon(priv
, ctx
->vif
))
281 IWL_ERR(priv
, "Error sending IBSS beacon\n");
282 iwl_init_sensitivity(priv
);
285 * If we issue a new RXON command which required a tune then
286 * we must send a new TXPOWER command or we won't be able to
289 * It's expected we set power here if channel is changing.
291 ret
= iwl_set_tx_power(priv
, priv
->tx_power_next
, true);
293 IWL_ERR(priv
, "Error sending TX power (%d)\n", ret
);
297 if (ctx
->vif
&& ctx
->vif
->type
== NL80211_IFTYPE_STATION
&&
298 priv
->cfg
->ht_params
&& priv
->cfg
->ht_params
->smps_mode
)
299 ieee80211_request_smps(ctx
->vif
,
300 priv
->cfg
->ht_params
->smps_mode
);
305 int iwlagn_set_pan_params(struct iwl_priv
*priv
)
307 struct iwl_wipan_params_cmd cmd
;
308 struct iwl_rxon_context
*ctx_bss
, *ctx_pan
;
309 int slot0
= 300, slot1
= 0;
312 if (priv
->shrd
->valid_contexts
== BIT(IWL_RXON_CTX_BSS
))
315 BUILD_BUG_ON(NUM_IWL_RXON_CTX
!= 2);
317 lockdep_assert_held(&priv
->shrd
->mutex
);
319 ctx_bss
= &priv
->contexts
[IWL_RXON_CTX_BSS
];
320 ctx_pan
= &priv
->contexts
[IWL_RXON_CTX_PAN
];
323 * If the PAN context is inactive, then we don't need
324 * to update the PAN parameters, the last thing we'll
325 * have done before it goes inactive is making the PAN
326 * parameters be WLAN-only.
328 if (!ctx_pan
->is_active
)
331 memset(&cmd
, 0, sizeof(cmd
));
333 /* only 2 slots are currently allowed */
336 cmd
.slots
[0].type
= 0; /* BSS */
337 cmd
.slots
[1].type
= 1; /* PAN */
339 if (priv
->hw_roc_setup
) {
340 /* both contexts must be used for this to happen */
341 slot1
= IWL_MIN_SLOT_TIME
;
343 } else if (ctx_bss
->vif
&& ctx_pan
->vif
) {
344 int bcnint
= ctx_pan
->beacon_int
;
345 int dtim
= ctx_pan
->vif
->bss_conf
.dtim_period
?: 1;
347 /* should be set, but seems unused?? */
348 cmd
.flags
|= cpu_to_le16(IWL_WIPAN_PARAMS_FLG_SLOTTED_MODE
);
350 if (ctx_pan
->vif
->type
== NL80211_IFTYPE_AP
&&
352 bcnint
!= ctx_bss
->beacon_int
) {
354 "beacon intervals don't match (%d, %d)\n",
355 ctx_bss
->beacon_int
, ctx_pan
->beacon_int
);
357 bcnint
= max_t(int, bcnint
,
358 ctx_bss
->beacon_int
);
360 bcnint
= DEFAULT_BEACON_INTERVAL
;
362 slot1
= bcnint
- slot0
;
364 if (test_bit(STATUS_SCAN_HW
, &priv
->shrd
->status
) ||
365 (!ctx_bss
->vif
->bss_conf
.idle
&&
366 !ctx_bss
->vif
->bss_conf
.assoc
)) {
367 slot0
= dtim
* bcnint
* 3 - IWL_MIN_SLOT_TIME
;
368 slot1
= IWL_MIN_SLOT_TIME
;
369 } else if (!ctx_pan
->vif
->bss_conf
.idle
&&
370 !ctx_pan
->vif
->bss_conf
.assoc
) {
371 slot1
= dtim
* bcnint
* 3 - IWL_MIN_SLOT_TIME
;
372 slot0
= IWL_MIN_SLOT_TIME
;
374 } else if (ctx_pan
->vif
) {
376 slot1
= max_t(int, 1, ctx_pan
->vif
->bss_conf
.dtim_period
) *
378 slot1
= max_t(int, DEFAULT_BEACON_INTERVAL
, slot1
);
380 if (test_bit(STATUS_SCAN_HW
, &priv
->shrd
->status
)) {
381 slot0
= slot1
* 3 - IWL_MIN_SLOT_TIME
;
382 slot1
= IWL_MIN_SLOT_TIME
;
386 cmd
.slots
[0].width
= cpu_to_le16(slot0
);
387 cmd
.slots
[1].width
= cpu_to_le16(slot1
);
389 ret
= iwl_trans_send_cmd_pdu(trans(priv
), REPLY_WIPAN_PARAMS
, CMD_SYNC
,
392 IWL_ERR(priv
, "Error setting PAN parameters (%d)\n", ret
);
398 * iwlagn_commit_rxon - commit staging_rxon to hardware
400 * The RXON command in staging_rxon is committed to the hardware and
401 * the active_rxon structure is updated with the new data. This
402 * function correctly transitions out of the RXON_ASSOC_MSK state if
403 * a HW tune is required based on the RXON structure changes.
405 * The connect/disconnect flow should be as the following:
407 * 1. make sure send RXON command with association bit unset if not connect
408 * this should include the channel and the band for the candidate
410 * 2. Add Station before RXON association with the AP
411 * 3. RXON_timing has to send before RXON for connection
412 * 4. full RXON command - associated bit set
413 * 5. use RXON_ASSOC command to update any flags changes
415 int iwlagn_commit_rxon(struct iwl_priv
*priv
, struct iwl_rxon_context
*ctx
)
417 /* cast away the const for active_rxon in this function */
418 struct iwl_rxon_cmd
*active
= (void *)&ctx
->active
;
419 bool new_assoc
= !!(ctx
->staging
.filter_flags
& RXON_FILTER_ASSOC_MSK
);
422 lockdep_assert_held(&priv
->shrd
->mutex
);
424 if (test_bit(STATUS_EXIT_PENDING
, &priv
->shrd
->status
))
427 if (!iwl_is_alive(priv
->shrd
))
430 /* This function hardcodes a bunch of dual-mode assumptions */
431 BUILD_BUG_ON(NUM_IWL_RXON_CTX
!= 2);
436 /* override BSSID if necessary due to preauth */
437 if (ctx
->preauth_bssid
)
438 memcpy(ctx
->staging
.bssid_addr
, ctx
->bssid
, ETH_ALEN
);
440 /* always get timestamp with Rx frame */
441 ctx
->staging
.flags
|= RXON_FLG_TSF2HOST_MSK
;
444 * force CTS-to-self frames protection if RTS-CTS is not preferred
445 * one aggregation protection method
447 if (!(priv
->cfg
->ht_params
&&
448 priv
->cfg
->ht_params
->use_rts_for_aggregation
))
449 ctx
->staging
.flags
|= RXON_FLG_SELF_CTS_EN
;
451 if ((ctx
->vif
&& ctx
->vif
->bss_conf
.use_short_slot
) ||
452 !(ctx
->staging
.flags
& RXON_FLG_BAND_24G_MSK
))
453 ctx
->staging
.flags
|= RXON_FLG_SHORT_SLOT_MSK
;
455 ctx
->staging
.flags
&= ~RXON_FLG_SHORT_SLOT_MSK
;
457 iwl_print_rx_config_cmd(priv
, ctx
->ctxid
);
458 ret
= iwl_check_rxon_cmd(priv
, ctx
);
460 IWL_ERR(priv
, "Invalid RXON configuration. Not committing.\n");
465 * receive commit_rxon request
466 * abort any previous channel switch if still in process
468 if (test_bit(STATUS_CHANNEL_SWITCH_PENDING
, &priv
->shrd
->status
) &&
469 (priv
->switch_channel
!= ctx
->staging
.channel
)) {
470 IWL_DEBUG_11H(priv
, "abort channel switch on %d\n",
471 le16_to_cpu(priv
->switch_channel
));
472 iwl_chswitch_done(priv
, false);
476 * If we don't need to send a full RXON, we can use
477 * iwl_rxon_assoc_cmd which is used to reconfigure filter
478 * and other flags for the current radio configuration.
480 if (!iwl_full_rxon_required(priv
, ctx
)) {
481 ret
= iwlagn_send_rxon_assoc(priv
, ctx
);
483 IWL_ERR(priv
, "Error setting RXON_ASSOC (%d)\n", ret
);
487 memcpy(active
, &ctx
->staging
, sizeof(*active
));
489 * We do not commit tx power settings while channel changing,
490 * do it now if after settings changed.
492 iwl_set_tx_power(priv
, priv
->tx_power_next
, false);
494 /* make sure we are in the right PS state */
495 iwl_power_update_mode(priv
, true);
500 iwl_set_rxon_hwcrypto(priv
, ctx
, !iwlagn_mod_params
.sw_crypto
);
503 "Going to commit RXON\n"
504 " * with%s RXON_FILTER_ASSOC_MSK\n"
507 (new_assoc
? "" : "out"),
508 le16_to_cpu(ctx
->staging
.channel
),
509 ctx
->staging
.bssid_addr
);
512 * Always clear associated first, but with the correct config.
513 * This is required as for example station addition for the
514 * AP station must be done after the BSSID is set to correctly
515 * set up filters in the device.
517 ret
= iwlagn_rxon_disconn(priv
, ctx
);
521 ret
= iwlagn_set_pan_params(priv
);
526 return iwlagn_rxon_connect(priv
, ctx
);
531 void iwlagn_config_ht40(struct ieee80211_conf
*conf
,
532 struct iwl_rxon_context
*ctx
)
534 if (conf_is_ht40_minus(conf
)) {
535 ctx
->ht
.extension_chan_offset
=
536 IEEE80211_HT_PARAM_CHA_SEC_BELOW
;
537 ctx
->ht
.is_40mhz
= true;
538 } else if (conf_is_ht40_plus(conf
)) {
539 ctx
->ht
.extension_chan_offset
=
540 IEEE80211_HT_PARAM_CHA_SEC_ABOVE
;
541 ctx
->ht
.is_40mhz
= true;
543 ctx
->ht
.extension_chan_offset
=
544 IEEE80211_HT_PARAM_CHA_SEC_NONE
;
545 ctx
->ht
.is_40mhz
= false;
549 int iwlagn_mac_config(struct ieee80211_hw
*hw
, u32 changed
)
551 struct iwl_priv
*priv
= hw
->priv
;
552 struct iwl_rxon_context
*ctx
;
553 struct ieee80211_conf
*conf
= &hw
->conf
;
554 struct ieee80211_channel
*channel
= conf
->channel
;
555 const struct iwl_channel_info
*ch_info
;
558 IWL_DEBUG_MAC80211(priv
, "enter: changed %#x", changed
);
560 mutex_lock(&priv
->shrd
->mutex
);
562 if (test_bit(STATUS_EXIT_PENDING
, &priv
->shrd
->status
))
565 if (unlikely(test_bit(STATUS_SCANNING
, &priv
->shrd
->status
))) {
566 IWL_DEBUG_MAC80211(priv
, "leave - scanning\n");
570 if (!iwl_is_ready(priv
->shrd
)) {
571 IWL_DEBUG_MAC80211(priv
, "leave - not ready\n");
575 if (changed
& (IEEE80211_CONF_CHANGE_SMPS
|
576 IEEE80211_CONF_CHANGE_CHANNEL
)) {
577 /* mac80211 uses static for non-HT which is what we want */
578 priv
->current_ht_config
.smps
= conf
->smps_mode
;
581 * Recalculate chain counts.
583 * If monitor mode is enabled then mac80211 will
584 * set up the SM PS mode to OFF if an HT channel is
587 for_each_context(priv
, ctx
)
588 iwlagn_set_rxon_chain(priv
, ctx
);
591 if (changed
& IEEE80211_CONF_CHANGE_CHANNEL
) {
594 ch_info
= iwl_get_channel_info(priv
, channel
->band
,
596 if (!is_channel_valid(ch_info
)) {
597 IWL_DEBUG_MAC80211(priv
, "leave - invalid channel\n");
602 spin_lock_irqsave(&priv
->shrd
->lock
, flags
);
604 for_each_context(priv
, ctx
) {
605 /* Configure HT40 channels */
606 if (ctx
->ht
.enabled
!= conf_is_ht(conf
))
607 ctx
->ht
.enabled
= conf_is_ht(conf
);
609 if (ctx
->ht
.enabled
) {
610 /* if HT40 is used, it should not change
611 * after associated except channel switch */
612 if (!ctx
->ht
.is_40mhz
||
613 !iwl_is_associated_ctx(ctx
))
614 iwlagn_config_ht40(conf
, ctx
);
616 ctx
->ht
.is_40mhz
= false;
619 * Default to no protection. Protection mode will
620 * later be set from BSS config in iwl_ht_conf
622 ctx
->ht
.protection
= IEEE80211_HT_OP_MODE_PROTECTION_NONE
;
624 /* if we are switching from ht to 2.4 clear flags
625 * from any ht related info since 2.4 does not
627 if (le16_to_cpu(ctx
->staging
.channel
) !=
629 ctx
->staging
.flags
= 0;
631 iwl_set_rxon_channel(priv
, channel
, ctx
);
632 iwl_set_rxon_ht(priv
, &priv
->current_ht_config
);
634 iwl_set_flags_for_band(priv
, ctx
, channel
->band
,
638 spin_unlock_irqrestore(&priv
->shrd
->lock
, flags
);
640 iwl_update_bcast_stations(priv
);
643 * The list of supported rates and rate mask can be different
644 * for each band; since the band may have changed, reset
645 * the rate mask to what mac80211 lists.
650 if (changed
& (IEEE80211_CONF_CHANGE_PS
|
651 IEEE80211_CONF_CHANGE_IDLE
)) {
652 ret
= iwl_power_update_mode(priv
, false);
654 IWL_DEBUG_MAC80211(priv
, "Error setting sleep level\n");
657 if (changed
& IEEE80211_CONF_CHANGE_POWER
) {
658 IWL_DEBUG_MAC80211(priv
, "TX Power old=%d new=%d\n",
659 priv
->tx_power_user_lmt
, conf
->power_level
);
661 iwl_set_tx_power(priv
, conf
->power_level
, false);
664 for_each_context(priv
, ctx
) {
665 if (!memcmp(&ctx
->staging
, &ctx
->active
, sizeof(ctx
->staging
)))
667 iwlagn_commit_rxon(priv
, ctx
);
670 mutex_unlock(&priv
->shrd
->mutex
);
671 IWL_DEBUG_MAC80211(priv
, "leave\n");
676 static void iwlagn_check_needed_chains(struct iwl_priv
*priv
,
677 struct iwl_rxon_context
*ctx
,
678 struct ieee80211_bss_conf
*bss_conf
)
680 struct ieee80211_vif
*vif
= ctx
->vif
;
681 struct iwl_rxon_context
*tmp
;
682 struct ieee80211_sta
*sta
;
683 struct iwl_ht_config
*ht_conf
= &priv
->current_ht_config
;
684 struct ieee80211_sta_ht_cap
*ht_cap
;
687 lockdep_assert_held(&priv
->shrd
->mutex
);
690 case NL80211_IFTYPE_STATION
:
692 sta
= ieee80211_find_sta(vif
, bss_conf
->bssid
);
695 * If at all, this can only happen through a race
696 * when the AP disconnects us while we're still
697 * setting up the connection, in that case mac80211
698 * will soon tell us about that.
700 need_multiple
= false;
705 ht_cap
= &sta
->ht_cap
;
707 need_multiple
= true;
710 * If the peer advertises no support for receiving 2 and 3
711 * stream MCS rates, it can't be transmitting them either.
713 if (ht_cap
->mcs
.rx_mask
[1] == 0 &&
714 ht_cap
->mcs
.rx_mask
[2] == 0) {
715 need_multiple
= false;
716 } else if (!(ht_cap
->mcs
.tx_params
&
717 IEEE80211_HT_MCS_TX_DEFINED
)) {
718 /* If it can't TX MCS at all ... */
719 need_multiple
= false;
720 } else if (ht_cap
->mcs
.tx_params
&
721 IEEE80211_HT_MCS_TX_RX_DIFF
) {
725 * But if it can receive them, it might still not
726 * be able to transmit them, which is what we need
727 * to check here -- so check the number of streams
728 * it advertises for TX (if different from RX).
731 maxstreams
= (ht_cap
->mcs
.tx_params
&
732 IEEE80211_HT_MCS_TX_MAX_STREAMS_MASK
);
734 IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT
;
738 need_multiple
= false;
743 case NL80211_IFTYPE_ADHOC
:
745 need_multiple
= false;
749 need_multiple
= true;
753 ctx
->ht_need_multiple_chains
= need_multiple
;
755 if (!need_multiple
) {
756 /* check all contexts */
757 for_each_context(priv
, tmp
) {
760 if (tmp
->ht_need_multiple_chains
) {
761 need_multiple
= true;
767 ht_conf
->single_chain_sufficient
= !need_multiple
;
770 static void iwlagn_chain_noise_reset(struct iwl_priv
*priv
)
772 struct iwl_chain_noise_data
*data
= &priv
->chain_noise_data
;
775 if ((data
->state
== IWL_CHAIN_NOISE_ALIVE
) &&
776 iwl_is_any_associated(priv
)) {
777 struct iwl_calib_chain_noise_reset_cmd cmd
;
779 /* clear data for chain noise calibration algorithm */
780 data
->chain_noise_a
= 0;
781 data
->chain_noise_b
= 0;
782 data
->chain_noise_c
= 0;
783 data
->chain_signal_a
= 0;
784 data
->chain_signal_b
= 0;
785 data
->chain_signal_c
= 0;
786 data
->beacon_count
= 0;
788 memset(&cmd
, 0, sizeof(cmd
));
789 iwl_set_calib_hdr(&cmd
.hdr
,
790 priv
->phy_calib_chain_noise_reset_cmd
);
791 ret
= iwl_trans_send_cmd_pdu(trans(priv
),
792 REPLY_PHY_CALIBRATION_CMD
,
793 CMD_SYNC
, sizeof(cmd
), &cmd
);
796 "Could not send REPLY_PHY_CALIBRATION_CMD\n");
797 data
->state
= IWL_CHAIN_NOISE_ACCUMULATE
;
798 IWL_DEBUG_CALIB(priv
, "Run chain_noise_calibrate\n");
802 void iwlagn_bss_info_changed(struct ieee80211_hw
*hw
,
803 struct ieee80211_vif
*vif
,
804 struct ieee80211_bss_conf
*bss_conf
,
807 struct iwl_priv
*priv
= hw
->priv
;
808 struct iwl_rxon_context
*ctx
= iwl_rxon_ctx_from_vif(vif
);
812 mutex_lock(&priv
->shrd
->mutex
);
814 if (unlikely(!iwl_is_ready(priv
->shrd
))) {
815 IWL_DEBUG_MAC80211(priv
, "leave - not ready\n");
816 mutex_unlock(&priv
->shrd
->mutex
);
820 if (unlikely(!ctx
->vif
)) {
821 IWL_DEBUG_MAC80211(priv
, "leave - vif is NULL\n");
822 mutex_unlock(&priv
->shrd
->mutex
);
826 if (changes
& BSS_CHANGED_BEACON_INT
)
829 if (changes
& BSS_CHANGED_QOS
) {
830 ctx
->qos_data
.qos_active
= bss_conf
->qos
;
831 iwlagn_update_qos(priv
, ctx
);
834 ctx
->staging
.assoc_id
= cpu_to_le16(vif
->bss_conf
.aid
);
835 if (vif
->bss_conf
.use_short_preamble
)
836 ctx
->staging
.flags
|= RXON_FLG_SHORT_PREAMBLE_MSK
;
838 ctx
->staging
.flags
&= ~RXON_FLG_SHORT_PREAMBLE_MSK
;
840 if (changes
& BSS_CHANGED_ASSOC
) {
841 if (bss_conf
->assoc
) {
842 priv
->timestamp
= bss_conf
->timestamp
;
843 ctx
->staging
.filter_flags
|= RXON_FILTER_ASSOC_MSK
;
846 * If we disassociate while there are pending
847 * frames, just wake up the queues and let the
848 * frames "escape" ... This shouldn't really
849 * be happening to start with, but we should
850 * not get stuck in this case either since it
851 * can happen if userspace gets confused.
853 if (ctx
->last_tx_rejected
) {
854 ctx
->last_tx_rejected
= false;
855 iwl_trans_wake_any_queue(trans(priv
),
858 ctx
->staging
.filter_flags
&= ~RXON_FILTER_ASSOC_MSK
;
860 if (ctx
->ctxid
== IWL_RXON_CTX_BSS
)
861 priv
->have_rekey_data
= false;
864 iwlagn_bt_coex_rssi_monitor(priv
);
867 if (ctx
->ht
.enabled
) {
868 ctx
->ht
.protection
= bss_conf
->ht_operation_mode
&
869 IEEE80211_HT_OP_MODE_PROTECTION
;
870 ctx
->ht
.non_gf_sta_present
= !!(bss_conf
->ht_operation_mode
&
871 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT
);
872 iwlagn_check_needed_chains(priv
, ctx
, bss_conf
);
873 iwl_set_rxon_ht(priv
, &priv
->current_ht_config
);
876 iwlagn_set_rxon_chain(priv
, ctx
);
878 if (bss_conf
->use_cts_prot
&& (priv
->band
!= IEEE80211_BAND_5GHZ
))
879 ctx
->staging
.flags
|= RXON_FLG_TGG_PROTECT_MSK
;
881 ctx
->staging
.flags
&= ~RXON_FLG_TGG_PROTECT_MSK
;
883 if (bss_conf
->use_cts_prot
)
884 ctx
->staging
.flags
|= RXON_FLG_SELF_CTS_EN
;
886 ctx
->staging
.flags
&= ~RXON_FLG_SELF_CTS_EN
;
888 memcpy(ctx
->staging
.bssid_addr
, bss_conf
->bssid
, ETH_ALEN
);
890 if (vif
->type
== NL80211_IFTYPE_AP
||
891 vif
->type
== NL80211_IFTYPE_ADHOC
) {
892 if (vif
->bss_conf
.enable_beacon
) {
893 ctx
->staging
.filter_flags
|= RXON_FILTER_ASSOC_MSK
;
894 priv
->beacon_ctx
= ctx
;
896 ctx
->staging
.filter_flags
&= ~RXON_FILTER_ASSOC_MSK
;
897 priv
->beacon_ctx
= NULL
;
901 if (force
|| memcmp(&ctx
->staging
, &ctx
->active
, sizeof(ctx
->staging
)))
902 iwlagn_commit_rxon(priv
, ctx
);
904 if (changes
& BSS_CHANGED_ASSOC
&& bss_conf
->assoc
) {
906 * The chain noise calibration will enable PM upon
907 * completion. If calibration has already been run
908 * then we need to enable power management here.
910 if (priv
->chain_noise_data
.state
== IWL_CHAIN_NOISE_DONE
)
911 iwl_power_update_mode(priv
, false);
913 /* Enable RX differential gain and sensitivity calibrations */
914 if (!priv
->disable_chain_noise_cal
)
915 iwlagn_chain_noise_reset(priv
);
916 priv
->start_calib
= 1;
917 WARN_ON(ctx
->preauth_bssid
);
920 if (changes
& BSS_CHANGED_IBSS
) {
921 ret
= iwlagn_manage_ibss_station(priv
, vif
,
922 bss_conf
->ibss_joined
);
924 IWL_ERR(priv
, "failed to %s IBSS station %pM\n",
925 bss_conf
->ibss_joined
? "add" : "remove",
929 if (changes
& BSS_CHANGED_BEACON
&& vif
->type
== NL80211_IFTYPE_ADHOC
&&
931 if (iwlagn_update_beacon(priv
, vif
))
932 IWL_ERR(priv
, "Error sending IBSS beacon\n");
935 mutex_unlock(&priv
->shrd
->mutex
);
938 void iwlagn_post_scan(struct iwl_priv
*priv
)
940 struct iwl_rxon_context
*ctx
;
943 * We do not commit power settings while scan is pending,
944 * do it now if the settings changed.
946 iwl_power_set_mode(priv
, &priv
->power_data
.sleep_cmd_next
, false);
947 iwl_set_tx_power(priv
, priv
->tx_power_next
, false);
950 * Since setting the RXON may have been deferred while
951 * performing the scan, fire one off if needed
953 for_each_context(priv
, ctx
)
954 if (memcmp(&ctx
->staging
, &ctx
->active
, sizeof(ctx
->staging
)))
955 iwlagn_commit_rxon(priv
, ctx
);
957 iwlagn_set_pan_params(priv
);