1 /******************************************************************************
2 *
3 * Copyright(c) 2003 - 2014 Intel Corporation. All rights reserved.
4 *
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.
8 *
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
12 * more details.
13 *
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
17 *
18 * The full GNU General Public License is included in this distribution in the
19 * file called LICENSE.
20 *
21 * Contact Information:
22 * Intel Linux Wireless <ilw@linux.intel.com>
23 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
24 *
25 *****************************************************************************/
26
27 #include <linux/etherdevice.h>
28 #include "iwl-trans.h"
29 #include "iwl-modparams.h"
30 #include "dev.h"
31 #include "agn.h"
32 #include "calib.h"
33
34 /*
35 * initialize rxon structure with default values from eeprom
36 */
iwl_connection_init_rx_config(struct iwl_priv * priv,struct iwl_rxon_context * ctx)37 void iwl_connection_init_rx_config(struct iwl_priv *priv,
38 struct iwl_rxon_context *ctx)
39 {
40 memset(&ctx->staging, 0, sizeof(ctx->staging));
41
42 if (!ctx->vif) {
43 ctx->staging.dev_type = ctx->unused_devtype;
44 } else
45 switch (ctx->vif->type) {
46 case NL80211_IFTYPE_AP:
47 ctx->staging.dev_type = ctx->ap_devtype;
48 break;
49
50 case NL80211_IFTYPE_STATION:
51 ctx->staging.dev_type = ctx->station_devtype;
52 ctx->staging.filter_flags = RXON_FILTER_ACCEPT_GRP_MSK;
53 break;
54
55 case NL80211_IFTYPE_ADHOC:
56 ctx->staging.dev_type = ctx->ibss_devtype;
57 ctx->staging.flags = RXON_FLG_SHORT_PREAMBLE_MSK;
58 ctx->staging.filter_flags = RXON_FILTER_BCON_AWARE_MSK |
59 RXON_FILTER_ACCEPT_GRP_MSK;
60 break;
61
62 case NL80211_IFTYPE_MONITOR:
63 ctx->staging.dev_type = RXON_DEV_TYPE_SNIFFER;
64 break;
65
66 default:
67 IWL_ERR(priv, "Unsupported interface type %d\n",
68 ctx->vif->type);
69 break;
70 }
71
72 #if 0
73 /* TODO: Figure out when short_preamble would be set and cache from
74 * that */
75 if (!hw_to_local(priv->hw)->short_preamble)
76 ctx->staging.flags &= ~RXON_FLG_SHORT_PREAMBLE_MSK;
77 else
78 ctx->staging.flags |= RXON_FLG_SHORT_PREAMBLE_MSK;
79 #endif
80
81 ctx->staging.channel =
82 cpu_to_le16(priv->hw->conf.chandef.chan->hw_value);
83 priv->band = priv->hw->conf.chandef.chan->band;
84
85 iwl_set_flags_for_band(priv, ctx, priv->band, ctx->vif);
86
87 /* clear both MIX and PURE40 mode flag */
88 ctx->staging.flags &= ~(RXON_FLG_CHANNEL_MODE_MIXED |
89 RXON_FLG_CHANNEL_MODE_PURE_40);
90 if (ctx->vif)
91 memcpy(ctx->staging.node_addr, ctx->vif->addr, ETH_ALEN);
92
93 ctx->staging.ofdm_ht_single_stream_basic_rates = 0xff;
94 ctx->staging.ofdm_ht_dual_stream_basic_rates = 0xff;
95 ctx->staging.ofdm_ht_triple_stream_basic_rates = 0xff;
96 }
97
iwlagn_disable_bss(struct iwl_priv * priv,struct iwl_rxon_context * ctx,struct iwl_rxon_cmd * send)98 static int iwlagn_disable_bss(struct iwl_priv *priv,
99 struct iwl_rxon_context *ctx,
100 struct iwl_rxon_cmd *send)
101 {
102 __le32 old_filter = send->filter_flags;
103 int ret;
104
105 send->filter_flags &= ~RXON_FILTER_ASSOC_MSK;
106 ret = iwl_dvm_send_cmd_pdu(priv, ctx->rxon_cmd,
107 0, sizeof(*send), send);
108
109 send->filter_flags = old_filter;
110
111 if (ret)
112 IWL_DEBUG_QUIET_RFKILL(priv,
113 "Error clearing ASSOC_MSK on BSS (%d)\n", ret);
114
115 return ret;
116 }
117
iwlagn_disable_pan(struct iwl_priv * priv,struct iwl_rxon_context * ctx,struct iwl_rxon_cmd * send)118 static int iwlagn_disable_pan(struct iwl_priv *priv,
119 struct iwl_rxon_context *ctx,
120 struct iwl_rxon_cmd *send)
121 {
122 struct iwl_notification_wait disable_wait;
123 __le32 old_filter = send->filter_flags;
124 u8 old_dev_type = send->dev_type;
125 int ret;
126 static const u8 deactivate_cmd[] = {
127 REPLY_WIPAN_DEACTIVATION_COMPLETE
128 };
129
130 iwl_init_notification_wait(&priv->notif_wait, &disable_wait,
131 deactivate_cmd, ARRAY_SIZE(deactivate_cmd),
132 NULL, NULL);
133
134 send->filter_flags &= ~RXON_FILTER_ASSOC_MSK;
135 send->dev_type = RXON_DEV_TYPE_P2P;
136 ret = iwl_dvm_send_cmd_pdu(priv, ctx->rxon_cmd,
137 0, sizeof(*send), send);
138
139 send->filter_flags = old_filter;
140 send->dev_type = old_dev_type;
141
142 if (ret) {
143 IWL_ERR(priv, "Error disabling PAN (%d)\n", ret);
144 iwl_remove_notification(&priv->notif_wait, &disable_wait);
145 } else {
146 ret = iwl_wait_notification(&priv->notif_wait,
147 &disable_wait, HZ);
148 if (ret)
149 IWL_ERR(priv, "Timed out waiting for PAN disable\n");
150 }
151
152 return ret;
153 }
154
iwlagn_disconn_pan(struct iwl_priv * priv,struct iwl_rxon_context * ctx,struct iwl_rxon_cmd * send)155 static int iwlagn_disconn_pan(struct iwl_priv *priv,
156 struct iwl_rxon_context *ctx,
157 struct iwl_rxon_cmd *send)
158 {
159 __le32 old_filter = send->filter_flags;
160 int ret;
161
162 send->filter_flags &= ~RXON_FILTER_ASSOC_MSK;
163 ret = iwl_dvm_send_cmd_pdu(priv, ctx->rxon_cmd, 0,
164 sizeof(*send), send);
165
166 send->filter_flags = old_filter;
167
168 return ret;
169 }
170
iwlagn_update_qos(struct iwl_priv * priv,struct iwl_rxon_context * ctx)171 static void iwlagn_update_qos(struct iwl_priv *priv,
172 struct iwl_rxon_context *ctx)
173 {
174 int ret;
175
176 if (!ctx->is_active)
177 return;
178
179 ctx->qos_data.def_qos_parm.qos_flags = 0;
180
181 if (ctx->qos_data.qos_active)
182 ctx->qos_data.def_qos_parm.qos_flags |=
183 QOS_PARAM_FLG_UPDATE_EDCA_MSK;
184
185 if (ctx->ht.enabled)
186 ctx->qos_data.def_qos_parm.qos_flags |= QOS_PARAM_FLG_TGN_MSK;
187
188 IWL_DEBUG_INFO(priv, "send QoS cmd with Qos active=%d FLAGS=0x%X\n",
189 ctx->qos_data.qos_active,
190 ctx->qos_data.def_qos_parm.qos_flags);
191
192 ret = iwl_dvm_send_cmd_pdu(priv, ctx->qos_cmd, 0,
193 sizeof(struct iwl_qosparam_cmd),
194 &ctx->qos_data.def_qos_parm);
195 if (ret)
196 IWL_DEBUG_QUIET_RFKILL(priv, "Failed to update QoS\n");
197 }
198
iwlagn_update_beacon(struct iwl_priv * priv,struct ieee80211_vif * vif)199 static int iwlagn_update_beacon(struct iwl_priv *priv,
200 struct ieee80211_vif *vif)
201 {
202 lockdep_assert_held(&priv->mutex);
203
204 dev_kfree_skb(priv->beacon_skb);
205 priv->beacon_skb = ieee80211_beacon_get(priv->hw, vif);
206 if (!priv->beacon_skb)
207 return -ENOMEM;
208 return iwlagn_send_beacon_cmd(priv);
209 }
210
iwlagn_send_rxon_assoc(struct iwl_priv * priv,struct iwl_rxon_context * ctx)211 static int iwlagn_send_rxon_assoc(struct iwl_priv *priv,
212 struct iwl_rxon_context *ctx)
213 {
214 int ret = 0;
215 struct iwl_rxon_assoc_cmd rxon_assoc;
216 const struct iwl_rxon_cmd *rxon1 = &ctx->staging;
217 const struct iwl_rxon_cmd *rxon2 = &ctx->active;
218
219 if ((rxon1->flags == rxon2->flags) &&
220 (rxon1->filter_flags == rxon2->filter_flags) &&
221 (rxon1->cck_basic_rates == rxon2->cck_basic_rates) &&
222 (rxon1->ofdm_ht_single_stream_basic_rates ==
223 rxon2->ofdm_ht_single_stream_basic_rates) &&
224 (rxon1->ofdm_ht_dual_stream_basic_rates ==
225 rxon2->ofdm_ht_dual_stream_basic_rates) &&
226 (rxon1->ofdm_ht_triple_stream_basic_rates ==
227 rxon2->ofdm_ht_triple_stream_basic_rates) &&
228 (rxon1->acquisition_data == rxon2->acquisition_data) &&
229 (rxon1->rx_chain == rxon2->rx_chain) &&
230 (rxon1->ofdm_basic_rates == rxon2->ofdm_basic_rates)) {
231 IWL_DEBUG_INFO(priv, "Using current RXON_ASSOC. Not resending.\n");
232 return 0;
233 }
234
235 rxon_assoc.flags = ctx->staging.flags;
236 rxon_assoc.filter_flags = ctx->staging.filter_flags;
237 rxon_assoc.ofdm_basic_rates = ctx->staging.ofdm_basic_rates;
238 rxon_assoc.cck_basic_rates = ctx->staging.cck_basic_rates;
239 rxon_assoc.reserved1 = 0;
240 rxon_assoc.reserved2 = 0;
241 rxon_assoc.reserved3 = 0;
242 rxon_assoc.ofdm_ht_single_stream_basic_rates =
243 ctx->staging.ofdm_ht_single_stream_basic_rates;
244 rxon_assoc.ofdm_ht_dual_stream_basic_rates =
245 ctx->staging.ofdm_ht_dual_stream_basic_rates;
246 rxon_assoc.rx_chain_select_flags = ctx->staging.rx_chain;
247 rxon_assoc.ofdm_ht_triple_stream_basic_rates =
248 ctx->staging.ofdm_ht_triple_stream_basic_rates;
249 rxon_assoc.acquisition_data = ctx->staging.acquisition_data;
250
251 ret = iwl_dvm_send_cmd_pdu(priv, ctx->rxon_assoc_cmd,
252 CMD_ASYNC, sizeof(rxon_assoc), &rxon_assoc);
253 return ret;
254 }
255
iwl_adjust_beacon_interval(u16 beacon_val,u16 max_beacon_val)256 static u16 iwl_adjust_beacon_interval(u16 beacon_val, u16 max_beacon_val)
257 {
258 u16 new_val;
259 u16 beacon_factor;
260
261 /*
262 * If mac80211 hasn't given us a beacon interval, program
263 * the default into the device (not checking this here
264 * would cause the adjustment below to return the maximum
265 * value, which may break PAN.)
266 */
267 if (!beacon_val)
268 return DEFAULT_BEACON_INTERVAL;
269
270 /*
271 * If the beacon interval we obtained from the peer
272 * is too large, we'll have to wake up more often
273 * (and in IBSS case, we'll beacon too much)
274 *
275 * For example, if max_beacon_val is 4096, and the
276 * requested beacon interval is 7000, we'll have to
277 * use 3500 to be able to wake up on the beacons.
278 *
279 * This could badly influence beacon detection stats.
280 */
281
282 beacon_factor = (beacon_val + max_beacon_val) / max_beacon_val;
283 new_val = beacon_val / beacon_factor;
284
285 if (!new_val)
286 new_val = max_beacon_val;
287
288 return new_val;
289 }
290
iwl_send_rxon_timing(struct iwl_priv * priv,struct iwl_rxon_context * ctx)291 static int iwl_send_rxon_timing(struct iwl_priv *priv,
292 struct iwl_rxon_context *ctx)
293 {
294 u64 tsf;
295 s32 interval_tm, rem;
296 struct ieee80211_conf *conf = NULL;
297 u16 beacon_int;
298 struct ieee80211_vif *vif = ctx->vif;
299
300 conf = &priv->hw->conf;
301
302 lockdep_assert_held(&priv->mutex);
303
304 memset(&ctx->timing, 0, sizeof(struct iwl_rxon_time_cmd));
305
306 ctx->timing.timestamp = cpu_to_le64(priv->timestamp);
307 ctx->timing.listen_interval = cpu_to_le16(conf->listen_interval);
308
309 beacon_int = vif ? vif->bss_conf.beacon_int : 0;
310
311 /*
312 * TODO: For IBSS we need to get atim_window from mac80211,
313 * for now just always use 0
314 */
315 ctx->timing.atim_window = 0;
316
317 if (ctx->ctxid == IWL_RXON_CTX_PAN &&
318 (!ctx->vif || ctx->vif->type != NL80211_IFTYPE_STATION) &&
319 iwl_is_associated(priv, IWL_RXON_CTX_BSS) &&
320 priv->contexts[IWL_RXON_CTX_BSS].vif &&
321 priv->contexts[IWL_RXON_CTX_BSS].vif->bss_conf.beacon_int) {
322 ctx->timing.beacon_interval =
323 priv->contexts[IWL_RXON_CTX_BSS].timing.beacon_interval;
324 beacon_int = le16_to_cpu(ctx->timing.beacon_interval);
325 } else if (ctx->ctxid == IWL_RXON_CTX_BSS &&
326 iwl_is_associated(priv, IWL_RXON_CTX_PAN) &&
327 priv->contexts[IWL_RXON_CTX_PAN].vif &&
328 priv->contexts[IWL_RXON_CTX_PAN].vif->bss_conf.beacon_int &&
329 (!iwl_is_associated_ctx(ctx) || !ctx->vif ||
330 !ctx->vif->bss_conf.beacon_int)) {
331 ctx->timing.beacon_interval =
332 priv->contexts[IWL_RXON_CTX_PAN].timing.beacon_interval;
333 beacon_int = le16_to_cpu(ctx->timing.beacon_interval);
334 } else {
335 beacon_int = iwl_adjust_beacon_interval(beacon_int,
336 IWL_MAX_UCODE_BEACON_INTERVAL * TIME_UNIT);
337 ctx->timing.beacon_interval = cpu_to_le16(beacon_int);
338 }
339
340 ctx->beacon_int = beacon_int;
341
342 tsf = priv->timestamp; /* tsf is modifed by do_div: copy it */
343 interval_tm = beacon_int * TIME_UNIT;
344 rem = do_div(tsf, interval_tm);
345 ctx->timing.beacon_init_val = cpu_to_le32(interval_tm - rem);
346
347 ctx->timing.dtim_period = vif ? (vif->bss_conf.dtim_period ?: 1) : 1;
348
349 IWL_DEBUG_ASSOC(priv,
350 "beacon interval %d beacon timer %d beacon tim %d\n",
351 le16_to_cpu(ctx->timing.beacon_interval),
352 le32_to_cpu(ctx->timing.beacon_init_val),
353 le16_to_cpu(ctx->timing.atim_window));
354
355 return iwl_dvm_send_cmd_pdu(priv, ctx->rxon_timing_cmd,
356 0, sizeof(ctx->timing), &ctx->timing);
357 }
358
iwlagn_rxon_disconn(struct iwl_priv * priv,struct iwl_rxon_context * ctx)359 static int iwlagn_rxon_disconn(struct iwl_priv *priv,
360 struct iwl_rxon_context *ctx)
361 {
362 int ret;
363 struct iwl_rxon_cmd *active = (void *)&ctx->active;
364
365 if (ctx->ctxid == IWL_RXON_CTX_BSS) {
366 ret = iwlagn_disable_bss(priv, ctx, &ctx->staging);
367 } else {
368 ret = iwlagn_disable_pan(priv, ctx, &ctx->staging);
369 if (ret)
370 return ret;
371 if (ctx->vif) {
372 ret = iwl_send_rxon_timing(priv, ctx);
373 if (ret) {
374 IWL_ERR(priv, "Failed to send timing (%d)!\n", ret);
375 return ret;
376 }
377 ret = iwlagn_disconn_pan(priv, ctx, &ctx->staging);
378 }
379 }
380 if (ret)
381 return ret;
382
383 /*
384 * Un-assoc RXON clears the station table and WEP
385 * keys, so we have to restore those afterwards.
386 */
387 iwl_clear_ucode_stations(priv, ctx);
388 /* update -- might need P2P now */
389 iwl_update_bcast_station(priv, ctx);
390 iwl_restore_stations(priv, ctx);
391 ret = iwl_restore_default_wep_keys(priv, ctx);
392 if (ret) {
393 IWL_ERR(priv, "Failed to restore WEP keys (%d)\n", ret);
394 return ret;
395 }
396
397 memcpy(active, &ctx->staging, sizeof(*active));
398 return 0;
399 }
400
iwl_set_tx_power(struct iwl_priv * priv,s8 tx_power,bool force)401 static int iwl_set_tx_power(struct iwl_priv *priv, s8 tx_power, bool force)
402 {
403 int ret;
404 s8 prev_tx_power;
405 bool defer;
406 struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
407
408 if (priv->calib_disabled & IWL_TX_POWER_CALIB_DISABLED)
409 return 0;
410
411 lockdep_assert_held(&priv->mutex);
412
413 if (priv->tx_power_user_lmt == tx_power && !force)
414 return 0;
415
416 if (tx_power < IWLAGN_TX_POWER_TARGET_POWER_MIN) {
417 IWL_WARN(priv,
418 "Requested user TXPOWER %d below lower limit %d.\n",
419 tx_power,
420 IWLAGN_TX_POWER_TARGET_POWER_MIN);
421 return -EINVAL;
422 }
423
424 if (tx_power > DIV_ROUND_UP(priv->nvm_data->max_tx_pwr_half_dbm, 2)) {
425 IWL_WARN(priv,
426 "Requested user TXPOWER %d above upper limit %d.\n",
427 tx_power, priv->nvm_data->max_tx_pwr_half_dbm);
428 return -EINVAL;
429 }
430
431 if (!iwl_is_ready_rf(priv))
432 return -EIO;
433
434 /* scan complete and commit_rxon use tx_power_next value,
435 * it always need to be updated for newest request */
436 priv->tx_power_next = tx_power;
437
438 /* do not set tx power when scanning or channel changing */
439 defer = test_bit(STATUS_SCANNING, &priv->status) ||
440 memcmp(&ctx->active, &ctx->staging, sizeof(ctx->staging));
441 if (defer && !force) {
442 IWL_DEBUG_INFO(priv, "Deferring tx power set\n");
443 return 0;
444 }
445
446 prev_tx_power = priv->tx_power_user_lmt;
447 priv->tx_power_user_lmt = tx_power;
448
449 ret = iwlagn_send_tx_power(priv);
450
451 /* if fail to set tx_power, restore the orig. tx power */
452 if (ret) {
453 priv->tx_power_user_lmt = prev_tx_power;
454 priv->tx_power_next = prev_tx_power;
455 }
456 return ret;
457 }
458
iwlagn_rxon_connect(struct iwl_priv * priv,struct iwl_rxon_context * ctx)459 static int iwlagn_rxon_connect(struct iwl_priv *priv,
460 struct iwl_rxon_context *ctx)
461 {
462 int ret;
463 struct iwl_rxon_cmd *active = (void *)&ctx->active;
464
465 /* RXON timing must be before associated RXON */
466 if (ctx->ctxid == IWL_RXON_CTX_BSS) {
467 ret = iwl_send_rxon_timing(priv, ctx);
468 if (ret) {
469 IWL_ERR(priv, "Failed to send timing (%d)!\n", ret);
470 return ret;
471 }
472 }
473 /* QoS info may be cleared by previous un-assoc RXON */
474 iwlagn_update_qos(priv, ctx);
475
476 /*
477 * We'll run into this code path when beaconing is
478 * enabled, but then we also need to send the beacon
479 * to the device.
480 */
481 if (ctx->vif && (ctx->vif->type == NL80211_IFTYPE_AP)) {
482 ret = iwlagn_update_beacon(priv, ctx->vif);
483 if (ret) {
484 IWL_ERR(priv,
485 "Error sending required beacon (%d)!\n",
486 ret);
487 return ret;
488 }
489 }
490
491 priv->start_calib = 0;
492 /*
493 * Apply the new configuration.
494 *
495 * Associated RXON doesn't clear the station table in uCode,
496 * so we don't need to restore stations etc. after this.
497 */
498 ret = iwl_dvm_send_cmd_pdu(priv, ctx->rxon_cmd, 0,
499 sizeof(struct iwl_rxon_cmd), &ctx->staging);
500 if (ret) {
501 IWL_ERR(priv, "Error setting new RXON (%d)\n", ret);
502 return ret;
503 }
504 memcpy(active, &ctx->staging, sizeof(*active));
505
506 /* IBSS beacon needs to be sent after setting assoc */
507 if (ctx->vif && (ctx->vif->type == NL80211_IFTYPE_ADHOC))
508 if (iwlagn_update_beacon(priv, ctx->vif))
509 IWL_ERR(priv, "Error sending IBSS beacon\n");
510 iwl_init_sensitivity(priv);
511
512 /*
513 * If we issue a new RXON command which required a tune then
514 * we must send a new TXPOWER command or we won't be able to
515 * Tx any frames.
516 *
517 * It's expected we set power here if channel is changing.
518 */
519 ret = iwl_set_tx_power(priv, priv->tx_power_next, true);
520 if (ret) {
521 IWL_ERR(priv, "Error sending TX power (%d)\n", ret);
522 return ret;
523 }
524
525 if (ctx->vif && ctx->vif->type == NL80211_IFTYPE_STATION &&
526 priv->cfg->ht_params && priv->cfg->ht_params->smps_mode)
527 ieee80211_request_smps(ctx->vif,
528 priv->cfg->ht_params->smps_mode);
529
530 return 0;
531 }
532
iwlagn_set_pan_params(struct iwl_priv * priv)533 int iwlagn_set_pan_params(struct iwl_priv *priv)
534 {
535 struct iwl_wipan_params_cmd cmd;
536 struct iwl_rxon_context *ctx_bss, *ctx_pan;
537 int slot0 = 300, slot1 = 0;
538 int ret;
539
540 if (priv->valid_contexts == BIT(IWL_RXON_CTX_BSS))
541 return 0;
542
543 BUILD_BUG_ON(NUM_IWL_RXON_CTX != 2);
544
545 lockdep_assert_held(&priv->mutex);
546
547 ctx_bss = &priv->contexts[IWL_RXON_CTX_BSS];
548 ctx_pan = &priv->contexts[IWL_RXON_CTX_PAN];
549
550 /*
551 * If the PAN context is inactive, then we don't need
552 * to update the PAN parameters, the last thing we'll
553 * have done before it goes inactive is making the PAN
554 * parameters be WLAN-only.
555 */
556 if (!ctx_pan->is_active)
557 return 0;
558
559 memset(&cmd, 0, sizeof(cmd));
560
561 /* only 2 slots are currently allowed */
562 cmd.num_slots = 2;
563
564 cmd.slots[0].type = 0; /* BSS */
565 cmd.slots[1].type = 1; /* PAN */
566
567 if (ctx_bss->vif && ctx_pan->vif) {
568 int bcnint = ctx_pan->beacon_int;
569 int dtim = ctx_pan->vif->bss_conf.dtim_period ?: 1;
570
571 /* should be set, but seems unused?? */
572 cmd.flags |= cpu_to_le16(IWL_WIPAN_PARAMS_FLG_SLOTTED_MODE);
573
574 if (ctx_pan->vif->type == NL80211_IFTYPE_AP &&
575 bcnint &&
576 bcnint != ctx_bss->beacon_int) {
577 IWL_ERR(priv,
578 "beacon intervals don't match (%d, %d)\n",
579 ctx_bss->beacon_int, ctx_pan->beacon_int);
580 } else
581 bcnint = max_t(int, bcnint,
582 ctx_bss->beacon_int);
583 if (!bcnint)
584 bcnint = DEFAULT_BEACON_INTERVAL;
585 slot0 = bcnint / 2;
586 slot1 = bcnint - slot0;
587
588 if (test_bit(STATUS_SCAN_HW, &priv->status) ||
589 (!ctx_bss->vif->bss_conf.idle &&
590 !ctx_bss->vif->bss_conf.assoc)) {
591 slot0 = dtim * bcnint * 3 - IWL_MIN_SLOT_TIME;
592 slot1 = IWL_MIN_SLOT_TIME;
593 } else if (!ctx_pan->vif->bss_conf.idle &&
594 !ctx_pan->vif->bss_conf.assoc) {
595 slot1 = dtim * bcnint * 3 - IWL_MIN_SLOT_TIME;
596 slot0 = IWL_MIN_SLOT_TIME;
597 }
598 } else if (ctx_pan->vif) {
599 slot0 = 0;
600 slot1 = max_t(int, 1, ctx_pan->vif->bss_conf.dtim_period) *
601 ctx_pan->beacon_int;
602 slot1 = max_t(int, DEFAULT_BEACON_INTERVAL, slot1);
603
604 if (test_bit(STATUS_SCAN_HW, &priv->status)) {
605 slot0 = slot1 * 3 - IWL_MIN_SLOT_TIME;
606 slot1 = IWL_MIN_SLOT_TIME;
607 }
608 }
609
610 cmd.slots[0].width = cpu_to_le16(slot0);
611 cmd.slots[1].width = cpu_to_le16(slot1);
612
613 ret = iwl_dvm_send_cmd_pdu(priv, REPLY_WIPAN_PARAMS, 0,
614 sizeof(cmd), &cmd);
615 if (ret)
616 IWL_ERR(priv, "Error setting PAN parameters (%d)\n", ret);
617
618 return ret;
619 }
620
_iwl_set_rxon_ht(struct iwl_priv * priv,struct iwl_ht_config * ht_conf,struct iwl_rxon_context * ctx)621 static void _iwl_set_rxon_ht(struct iwl_priv *priv,
622 struct iwl_ht_config *ht_conf,
623 struct iwl_rxon_context *ctx)
624 {
625 struct iwl_rxon_cmd *rxon = &ctx->staging;
626
627 if (!ctx->ht.enabled) {
628 rxon->flags &= ~(RXON_FLG_CHANNEL_MODE_MSK |
629 RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK |
630 RXON_FLG_HT40_PROT_MSK |
631 RXON_FLG_HT_PROT_MSK);
632 return;
633 }
634
635 /* FIXME: if the definition of ht.protection changed, the "translation"
636 * will be needed for rxon->flags
637 */
638 rxon->flags |= cpu_to_le32(ctx->ht.protection <<
639 RXON_FLG_HT_OPERATING_MODE_POS);
640
641 /* Set up channel bandwidth:
642 * 20 MHz only, 20/40 mixed or pure 40 if ht40 ok */
643 /* clear the HT channel mode before set the mode */
644 rxon->flags &= ~(RXON_FLG_CHANNEL_MODE_MSK |
645 RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK);
646 if (iwl_is_ht40_tx_allowed(priv, ctx, NULL)) {
647 /* pure ht40 */
648 if (ctx->ht.protection ==
649 IEEE80211_HT_OP_MODE_PROTECTION_20MHZ) {
650 rxon->flags |= RXON_FLG_CHANNEL_MODE_PURE_40;
651 /*
652 * Note: control channel is opposite of extension
653 * channel
654 */
655 switch (ctx->ht.extension_chan_offset) {
656 case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
657 rxon->flags &=
658 ~RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK;
659 break;
660 case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
661 rxon->flags |=
662 RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK;
663 break;
664 }
665 } else {
666 /*
667 * Note: control channel is opposite of extension
668 * channel
669 */
670 switch (ctx->ht.extension_chan_offset) {
671 case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
672 rxon->flags &=
673 ~(RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK);
674 rxon->flags |= RXON_FLG_CHANNEL_MODE_MIXED;
675 break;
676 case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
677 rxon->flags |= RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK;
678 rxon->flags |= RXON_FLG_CHANNEL_MODE_MIXED;
679 break;
680 case IEEE80211_HT_PARAM_CHA_SEC_NONE:
681 default:
682 /*
683 * channel location only valid if in Mixed
684 * mode
685 */
686 IWL_ERR(priv,
687 "invalid extension channel offset\n");
688 break;
689 }
690 }
691 } else {
692 rxon->flags |= RXON_FLG_CHANNEL_MODE_LEGACY;
693 }
694
695 iwlagn_set_rxon_chain(priv, ctx);
696
697 IWL_DEBUG_ASSOC(priv, "rxon flags 0x%X operation mode :0x%X "
698 "extension channel offset 0x%x\n",
699 le32_to_cpu(rxon->flags), ctx->ht.protection,
700 ctx->ht.extension_chan_offset);
701 }
702
iwl_set_rxon_ht(struct iwl_priv * priv,struct iwl_ht_config * ht_conf)703 void iwl_set_rxon_ht(struct iwl_priv *priv, struct iwl_ht_config *ht_conf)
704 {
705 struct iwl_rxon_context *ctx;
706
707 for_each_context(priv, ctx)
708 _iwl_set_rxon_ht(priv, ht_conf, ctx);
709 }
710
711 /**
712 * iwl_set_rxon_channel - Set the band and channel values in staging RXON
713 * @ch: requested channel as a pointer to struct ieee80211_channel
714
715 * NOTE: Does not commit to the hardware; it sets appropriate bit fields
716 * in the staging RXON flag structure based on the ch->band
717 */
iwl_set_rxon_channel(struct iwl_priv * priv,struct ieee80211_channel * ch,struct iwl_rxon_context * ctx)718 void iwl_set_rxon_channel(struct iwl_priv *priv, struct ieee80211_channel *ch,
719 struct iwl_rxon_context *ctx)
720 {
721 enum ieee80211_band band = ch->band;
722 u16 channel = ch->hw_value;
723
724 if ((le16_to_cpu(ctx->staging.channel) == channel) &&
725 (priv->band == band))
726 return;
727
728 ctx->staging.channel = cpu_to_le16(channel);
729 if (band == IEEE80211_BAND_5GHZ)
730 ctx->staging.flags &= ~RXON_FLG_BAND_24G_MSK;
731 else
732 ctx->staging.flags |= RXON_FLG_BAND_24G_MSK;
733
734 priv->band = band;
735
736 IWL_DEBUG_INFO(priv, "Staging channel set to %d [%d]\n", channel, band);
737
738 }
739
iwl_set_flags_for_band(struct iwl_priv * priv,struct iwl_rxon_context * ctx,enum ieee80211_band band,struct ieee80211_vif * vif)740 void iwl_set_flags_for_band(struct iwl_priv *priv,
741 struct iwl_rxon_context *ctx,
742 enum ieee80211_band band,
743 struct ieee80211_vif *vif)
744 {
745 if (band == IEEE80211_BAND_5GHZ) {
746 ctx->staging.flags &=
747 ~(RXON_FLG_BAND_24G_MSK | RXON_FLG_AUTO_DETECT_MSK
748 | RXON_FLG_CCK_MSK);
749 ctx->staging.flags |= RXON_FLG_SHORT_SLOT_MSK;
750 } else {
751 /* Copied from iwl_post_associate() */
752 if (vif && vif->bss_conf.use_short_slot)
753 ctx->staging.flags |= RXON_FLG_SHORT_SLOT_MSK;
754 else
755 ctx->staging.flags &= ~RXON_FLG_SHORT_SLOT_MSK;
756
757 ctx->staging.flags |= RXON_FLG_BAND_24G_MSK;
758 ctx->staging.flags |= RXON_FLG_AUTO_DETECT_MSK;
759 ctx->staging.flags &= ~RXON_FLG_CCK_MSK;
760 }
761 }
762
iwl_set_rxon_hwcrypto(struct iwl_priv * priv,struct iwl_rxon_context * ctx,int hw_decrypt)763 static void iwl_set_rxon_hwcrypto(struct iwl_priv *priv,
764 struct iwl_rxon_context *ctx, int hw_decrypt)
765 {
766 struct iwl_rxon_cmd *rxon = &ctx->staging;
767
768 if (hw_decrypt)
769 rxon->filter_flags &= ~RXON_FILTER_DIS_DECRYPT_MSK;
770 else
771 rxon->filter_flags |= RXON_FILTER_DIS_DECRYPT_MSK;
772
773 }
774
775 /* validate RXON structure is valid */
iwl_check_rxon_cmd(struct iwl_priv * priv,struct iwl_rxon_context * ctx)776 static int iwl_check_rxon_cmd(struct iwl_priv *priv,
777 struct iwl_rxon_context *ctx)
778 {
779 struct iwl_rxon_cmd *rxon = &ctx->staging;
780 u32 errors = 0;
781
782 if (rxon->flags & RXON_FLG_BAND_24G_MSK) {
783 if (rxon->flags & RXON_FLG_TGJ_NARROW_BAND_MSK) {
784 IWL_WARN(priv, "check 2.4G: wrong narrow\n");
785 errors |= BIT(0);
786 }
787 if (rxon->flags & RXON_FLG_RADAR_DETECT_MSK) {
788 IWL_WARN(priv, "check 2.4G: wrong radar\n");
789 errors |= BIT(1);
790 }
791 } else {
792 if (!(rxon->flags & RXON_FLG_SHORT_SLOT_MSK)) {
793 IWL_WARN(priv, "check 5.2G: not short slot!\n");
794 errors |= BIT(2);
795 }
796 if (rxon->flags & RXON_FLG_CCK_MSK) {
797 IWL_WARN(priv, "check 5.2G: CCK!\n");
798 errors |= BIT(3);
799 }
800 }
801 if ((rxon->node_addr[0] | rxon->bssid_addr[0]) & 0x1) {
802 IWL_WARN(priv, "mac/bssid mcast!\n");
803 errors |= BIT(4);
804 }
805
806 /* make sure basic rates 6Mbps and 1Mbps are supported */
807 if ((rxon->ofdm_basic_rates & IWL_RATE_6M_MASK) == 0 &&
808 (rxon->cck_basic_rates & IWL_RATE_1M_MASK) == 0) {
809 IWL_WARN(priv, "neither 1 nor 6 are basic\n");
810 errors |= BIT(5);
811 }
812
813 if (le16_to_cpu(rxon->assoc_id) > 2007) {
814 IWL_WARN(priv, "aid > 2007\n");
815 errors |= BIT(6);
816 }
817
818 if ((rxon->flags & (RXON_FLG_CCK_MSK | RXON_FLG_SHORT_SLOT_MSK))
819 == (RXON_FLG_CCK_MSK | RXON_FLG_SHORT_SLOT_MSK)) {
820 IWL_WARN(priv, "CCK and short slot\n");
821 errors |= BIT(7);
822 }
823
824 if ((rxon->flags & (RXON_FLG_CCK_MSK | RXON_FLG_AUTO_DETECT_MSK))
825 == (RXON_FLG_CCK_MSK | RXON_FLG_AUTO_DETECT_MSK)) {
826 IWL_WARN(priv, "CCK and auto detect\n");
827 errors |= BIT(8);
828 }
829
830 if ((rxon->flags & (RXON_FLG_AUTO_DETECT_MSK |
831 RXON_FLG_TGG_PROTECT_MSK)) ==
832 RXON_FLG_TGG_PROTECT_MSK) {
833 IWL_WARN(priv, "TGg but no auto-detect\n");
834 errors |= BIT(9);
835 }
836
837 if (rxon->channel == 0) {
838 IWL_WARN(priv, "zero channel is invalid\n");
839 errors |= BIT(10);
840 }
841
842 WARN(errors, "Invalid RXON (%#x), channel %d",
843 errors, le16_to_cpu(rxon->channel));
844
845 return errors ? -EINVAL : 0;
846 }
847
848 /**
849 * iwl_full_rxon_required - check if full RXON (vs RXON_ASSOC) cmd is needed
850 * @priv: staging_rxon is compared to active_rxon
851 *
852 * If the RXON structure is changing enough to require a new tune,
853 * or is clearing the RXON_FILTER_ASSOC_MSK, then return 1 to indicate that
854 * a new tune (full RXON command, rather than RXON_ASSOC cmd) is required.
855 */
iwl_full_rxon_required(struct iwl_priv * priv,struct iwl_rxon_context * ctx)856 static int iwl_full_rxon_required(struct iwl_priv *priv,
857 struct iwl_rxon_context *ctx)
858 {
859 const struct iwl_rxon_cmd *staging = &ctx->staging;
860 const struct iwl_rxon_cmd *active = &ctx->active;
861
862 #define CHK(cond) \
863 if ((cond)) { \
864 IWL_DEBUG_INFO(priv, "need full RXON - " #cond "\n"); \
865 return 1; \
866 }
867
868 #define CHK_NEQ(c1, c2) \
869 if ((c1) != (c2)) { \
870 IWL_DEBUG_INFO(priv, "need full RXON - " \
871 #c1 " != " #c2 " - %d != %d\n", \
872 (c1), (c2)); \
873 return 1; \
874 }
875
876 /* These items are only settable from the full RXON command */
877 CHK(!iwl_is_associated_ctx(ctx));
878 CHK(!ether_addr_equal(staging->bssid_addr, active->bssid_addr));
879 CHK(!ether_addr_equal(staging->node_addr, active->node_addr));
880 CHK(!ether_addr_equal(staging->wlap_bssid_addr,
881 active->wlap_bssid_addr));
882 CHK_NEQ(staging->dev_type, active->dev_type);
883 CHK_NEQ(staging->channel, active->channel);
884 CHK_NEQ(staging->air_propagation, active->air_propagation);
885 CHK_NEQ(staging->ofdm_ht_single_stream_basic_rates,
886 active->ofdm_ht_single_stream_basic_rates);
887 CHK_NEQ(staging->ofdm_ht_dual_stream_basic_rates,
888 active->ofdm_ht_dual_stream_basic_rates);
889 CHK_NEQ(staging->ofdm_ht_triple_stream_basic_rates,
890 active->ofdm_ht_triple_stream_basic_rates);
891 CHK_NEQ(staging->assoc_id, active->assoc_id);
892
893 /* flags, filter_flags, ofdm_basic_rates, and cck_basic_rates can
894 * be updated with the RXON_ASSOC command -- however only some
895 * flag transitions are allowed using RXON_ASSOC */
896
897 /* Check if we are not switching bands */
898 CHK_NEQ(staging->flags & RXON_FLG_BAND_24G_MSK,
899 active->flags & RXON_FLG_BAND_24G_MSK);
900
901 /* Check if we are switching association toggle */
902 CHK_NEQ(staging->filter_flags & RXON_FILTER_ASSOC_MSK,
903 active->filter_flags & RXON_FILTER_ASSOC_MSK);
904
905 #undef CHK
906 #undef CHK_NEQ
907
908 return 0;
909 }
910
911 #ifdef CONFIG_IWLWIFI_DEBUG
iwl_print_rx_config_cmd(struct iwl_priv * priv,enum iwl_rxon_context_id ctxid)912 void iwl_print_rx_config_cmd(struct iwl_priv *priv,
913 enum iwl_rxon_context_id ctxid)
914 {
915 struct iwl_rxon_context *ctx = &priv->contexts[ctxid];
916 struct iwl_rxon_cmd *rxon = &ctx->staging;
917
918 IWL_DEBUG_RADIO(priv, "RX CONFIG:\n");
919 iwl_print_hex_dump(priv, IWL_DL_RADIO, (u8 *) rxon, sizeof(*rxon));
920 IWL_DEBUG_RADIO(priv, "u16 channel: 0x%x\n",
921 le16_to_cpu(rxon->channel));
922 IWL_DEBUG_RADIO(priv, "u32 flags: 0x%08X\n",
923 le32_to_cpu(rxon->flags));
924 IWL_DEBUG_RADIO(priv, "u32 filter_flags: 0x%08x\n",
925 le32_to_cpu(rxon->filter_flags));
926 IWL_DEBUG_RADIO(priv, "u8 dev_type: 0x%x\n", rxon->dev_type);
927 IWL_DEBUG_RADIO(priv, "u8 ofdm_basic_rates: 0x%02x\n",
928 rxon->ofdm_basic_rates);
929 IWL_DEBUG_RADIO(priv, "u8 cck_basic_rates: 0x%02x\n",
930 rxon->cck_basic_rates);
931 IWL_DEBUG_RADIO(priv, "u8[6] node_addr: %pM\n", rxon->node_addr);
932 IWL_DEBUG_RADIO(priv, "u8[6] bssid_addr: %pM\n", rxon->bssid_addr);
933 IWL_DEBUG_RADIO(priv, "u16 assoc_id: 0x%x\n",
934 le16_to_cpu(rxon->assoc_id));
935 }
936 #endif
937
iwl_calc_basic_rates(struct iwl_priv * priv,struct iwl_rxon_context * ctx)938 static void iwl_calc_basic_rates(struct iwl_priv *priv,
939 struct iwl_rxon_context *ctx)
940 {
941 int lowest_present_ofdm = 100;
942 int lowest_present_cck = 100;
943 u8 cck = 0;
944 u8 ofdm = 0;
945
946 if (ctx->vif) {
947 struct ieee80211_supported_band *sband;
948 unsigned long basic = ctx->vif->bss_conf.basic_rates;
949 int i;
950
951 sband = priv->hw->wiphy->bands[priv->hw->conf.chandef.chan->band];
952
953 for_each_set_bit(i, &basic, BITS_PER_LONG) {
954 int hw = sband->bitrates[i].hw_value;
955 if (hw >= IWL_FIRST_OFDM_RATE) {
956 ofdm |= BIT(hw - IWL_FIRST_OFDM_RATE);
957 if (lowest_present_ofdm > hw)
958 lowest_present_ofdm = hw;
959 } else {
960 BUILD_BUG_ON(IWL_FIRST_CCK_RATE != 0);
961
962 cck |= BIT(hw);
963 if (lowest_present_cck > hw)
964 lowest_present_cck = hw;
965 }
966 }
967 }
968
969 /*
970 * Now we've got the basic rates as bitmaps in the ofdm and cck
971 * variables. This isn't sufficient though, as there might not
972 * be all the right rates in the bitmap. E.g. if the only basic
973 * rates are 5.5 Mbps and 11 Mbps, we still need to add 1 Mbps
974 * and 6 Mbps because the 802.11-2007 standard says in 9.6:
975 *
976 * [...] a STA responding to a received frame shall transmit
977 * its Control Response frame [...] at the highest rate in the
978 * BSSBasicRateSet parameter that is less than or equal to the
979 * rate of the immediately previous frame in the frame exchange
980 * sequence ([...]) and that is of the same modulation class
981 * ([...]) as the received frame. If no rate contained in the
982 * BSSBasicRateSet parameter meets these conditions, then the
983 * control frame sent in response to a received frame shall be
984 * transmitted at the highest mandatory rate of the PHY that is
985 * less than or equal to the rate of the received frame, and
986 * that is of the same modulation class as the received frame.
987 *
988 * As a consequence, we need to add all mandatory rates that are
989 * lower than all of the basic rates to these bitmaps.
990 */
991
992 if (IWL_RATE_24M_INDEX < lowest_present_ofdm)
993 ofdm |= IWL_RATE_24M_MASK >> IWL_FIRST_OFDM_RATE;
994 if (IWL_RATE_12M_INDEX < lowest_present_ofdm)
995 ofdm |= IWL_RATE_12M_MASK >> IWL_FIRST_OFDM_RATE;
996 /* 6M already there or needed so always add */
997 ofdm |= IWL_RATE_6M_MASK >> IWL_FIRST_OFDM_RATE;
998
999 /*
1000 * CCK is a bit more complex with DSSS vs. HR/DSSS vs. ERP.
1001 * Note, however:
1002 * - if no CCK rates are basic, it must be ERP since there must
1003 * be some basic rates at all, so they're OFDM => ERP PHY
1004 * (or we're in 5 GHz, and the cck bitmap will never be used)
1005 * - if 11M is a basic rate, it must be ERP as well, so add 5.5M
1006 * - if 5.5M is basic, 1M and 2M are mandatory
1007 * - if 2M is basic, 1M is mandatory
1008 * - if 1M is basic, that's the only valid ACK rate.
1009 * As a consequence, it's not as complicated as it sounds, just add
1010 * any lower rates to the ACK rate bitmap.
1011 */
1012 if (IWL_RATE_11M_INDEX < lowest_present_cck)
1013 cck |= IWL_RATE_11M_MASK >> IWL_FIRST_CCK_RATE;
1014 if (IWL_RATE_5M_INDEX < lowest_present_cck)
1015 cck |= IWL_RATE_5M_MASK >> IWL_FIRST_CCK_RATE;
1016 if (IWL_RATE_2M_INDEX < lowest_present_cck)
1017 cck |= IWL_RATE_2M_MASK >> IWL_FIRST_CCK_RATE;
1018 /* 1M already there or needed so always add */
1019 cck |= IWL_RATE_1M_MASK >> IWL_FIRST_CCK_RATE;
1020
1021 IWL_DEBUG_RATE(priv, "Set basic rates cck:0x%.2x ofdm:0x%.2x\n",
1022 cck, ofdm);
1023
1024 /* "basic_rates" is a misnomer here -- should be called ACK rates */
1025 ctx->staging.cck_basic_rates = cck;
1026 ctx->staging.ofdm_basic_rates = ofdm;
1027 }
1028
1029 /**
1030 * iwlagn_commit_rxon - commit staging_rxon to hardware
1031 *
1032 * The RXON command in staging_rxon is committed to the hardware and
1033 * the active_rxon structure is updated with the new data. This
1034 * function correctly transitions out of the RXON_ASSOC_MSK state if
1035 * a HW tune is required based on the RXON structure changes.
1036 *
1037 * The connect/disconnect flow should be as the following:
1038 *
1039 * 1. make sure send RXON command with association bit unset if not connect
1040 * this should include the channel and the band for the candidate
1041 * to be connected to
1042 * 2. Add Station before RXON association with the AP
1043 * 3. RXON_timing has to send before RXON for connection
1044 * 4. full RXON command - associated bit set
1045 * 5. use RXON_ASSOC command to update any flags changes
1046 */
iwlagn_commit_rxon(struct iwl_priv * priv,struct iwl_rxon_context * ctx)1047 int iwlagn_commit_rxon(struct iwl_priv *priv, struct iwl_rxon_context *ctx)
1048 {
1049 /* cast away the const for active_rxon in this function */
1050 struct iwl_rxon_cmd *active = (void *)&ctx->active;
1051 bool new_assoc = !!(ctx->staging.filter_flags & RXON_FILTER_ASSOC_MSK);
1052 int ret;
1053
1054 lockdep_assert_held(&priv->mutex);
1055
1056 if (!iwl_is_alive(priv))
1057 return -EBUSY;
1058
1059 /* This function hardcodes a bunch of dual-mode assumptions */
1060 BUILD_BUG_ON(NUM_IWL_RXON_CTX != 2);
1061
1062 if (!ctx->is_active)
1063 return 0;
1064
1065 /* always get timestamp with Rx frame */
1066 ctx->staging.flags |= RXON_FLG_TSF2HOST_MSK;
1067
1068 /* recalculate basic rates */
1069 iwl_calc_basic_rates(priv, ctx);
1070
1071 /*
1072 * force CTS-to-self frames protection if RTS-CTS is not preferred
1073 * one aggregation protection method
1074 */
1075 if (!priv->hw_params.use_rts_for_aggregation)
1076 ctx->staging.flags |= RXON_FLG_SELF_CTS_EN;
1077
1078 if ((ctx->vif && ctx->vif->bss_conf.use_short_slot) ||
1079 !(ctx->staging.flags & RXON_FLG_BAND_24G_MSK))
1080 ctx->staging.flags |= RXON_FLG_SHORT_SLOT_MSK;
1081 else
1082 ctx->staging.flags &= ~RXON_FLG_SHORT_SLOT_MSK;
1083
1084 iwl_print_rx_config_cmd(priv, ctx->ctxid);
1085 ret = iwl_check_rxon_cmd(priv, ctx);
1086 if (ret) {
1087 IWL_ERR(priv, "Invalid RXON configuration. Not committing.\n");
1088 return -EINVAL;
1089 }
1090
1091 /*
1092 * receive commit_rxon request
1093 * abort any previous channel switch if still in process
1094 */
1095 if (test_bit(STATUS_CHANNEL_SWITCH_PENDING, &priv->status) &&
1096 (priv->switch_channel != ctx->staging.channel)) {
1097 IWL_DEBUG_11H(priv, "abort channel switch on %d\n",
1098 le16_to_cpu(priv->switch_channel));
1099 iwl_chswitch_done(priv, false);
1100 }
1101
1102 /*
1103 * If we don't need to send a full RXON, we can use
1104 * iwl_rxon_assoc_cmd which is used to reconfigure filter
1105 * and other flags for the current radio configuration.
1106 */
1107 if (!iwl_full_rxon_required(priv, ctx)) {
1108 ret = iwlagn_send_rxon_assoc(priv, ctx);
1109 if (ret) {
1110 IWL_ERR(priv, "Error setting RXON_ASSOC (%d)\n", ret);
1111 return ret;
1112 }
1113
1114 memcpy(active, &ctx->staging, sizeof(*active));
1115 /*
1116 * We do not commit tx power settings while channel changing,
1117 * do it now if after settings changed.
1118 */
1119 iwl_set_tx_power(priv, priv->tx_power_next, false);
1120
1121 /* make sure we are in the right PS state */
1122 iwl_power_update_mode(priv, true);
1123
1124 return 0;
1125 }
1126
1127 iwl_set_rxon_hwcrypto(priv, ctx, !iwlwifi_mod_params.sw_crypto);
1128
1129 IWL_DEBUG_INFO(priv,
1130 "Going to commit RXON\n"
1131 " * with%s RXON_FILTER_ASSOC_MSK\n"
1132 " * channel = %d\n"
1133 " * bssid = %pM\n",
1134 (new_assoc ? "" : "out"),
1135 le16_to_cpu(ctx->staging.channel),
1136 ctx->staging.bssid_addr);
1137
1138 /*
1139 * Always clear associated first, but with the correct config.
1140 * This is required as for example station addition for the
1141 * AP station must be done after the BSSID is set to correctly
1142 * set up filters in the device.
1143 */
1144 ret = iwlagn_rxon_disconn(priv, ctx);
1145 if (ret)
1146 return ret;
1147
1148 ret = iwlagn_set_pan_params(priv);
1149 if (ret)
1150 return ret;
1151
1152 if (new_assoc)
1153 return iwlagn_rxon_connect(priv, ctx);
1154
1155 return 0;
1156 }
1157
iwlagn_config_ht40(struct ieee80211_conf * conf,struct iwl_rxon_context * ctx)1158 void iwlagn_config_ht40(struct ieee80211_conf *conf,
1159 struct iwl_rxon_context *ctx)
1160 {
1161 if (conf_is_ht40_minus(conf)) {
1162 ctx->ht.extension_chan_offset =
1163 IEEE80211_HT_PARAM_CHA_SEC_BELOW;
1164 ctx->ht.is_40mhz = true;
1165 } else if (conf_is_ht40_plus(conf)) {
1166 ctx->ht.extension_chan_offset =
1167 IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
1168 ctx->ht.is_40mhz = true;
1169 } else {
1170 ctx->ht.extension_chan_offset =
1171 IEEE80211_HT_PARAM_CHA_SEC_NONE;
1172 ctx->ht.is_40mhz = false;
1173 }
1174 }
1175
iwlagn_mac_config(struct ieee80211_hw * hw,u32 changed)1176 int iwlagn_mac_config(struct ieee80211_hw *hw, u32 changed)
1177 {
1178 struct iwl_priv *priv = IWL_MAC80211_GET_DVM(hw);
1179 struct iwl_rxon_context *ctx;
1180 struct ieee80211_conf *conf = &hw->conf;
1181 struct ieee80211_channel *channel = conf->chandef.chan;
1182 int ret = 0;
1183
1184 IWL_DEBUG_MAC80211(priv, "enter: changed %#x\n", changed);
1185
1186 mutex_lock(&priv->mutex);
1187
1188 if (unlikely(test_bit(STATUS_SCANNING, &priv->status))) {
1189 IWL_DEBUG_MAC80211(priv, "leave - scanning\n");
1190 goto out;
1191 }
1192
1193 if (!iwl_is_ready(priv)) {
1194 IWL_DEBUG_MAC80211(priv, "leave - not ready\n");
1195 goto out;
1196 }
1197
1198 if (changed & (IEEE80211_CONF_CHANGE_SMPS |
1199 IEEE80211_CONF_CHANGE_CHANNEL)) {
1200 /* mac80211 uses static for non-HT which is what we want */
1201 priv->current_ht_config.smps = conf->smps_mode;
1202
1203 /*
1204 * Recalculate chain counts.
1205 *
1206 * If monitor mode is enabled then mac80211 will
1207 * set up the SM PS mode to OFF if an HT channel is
1208 * configured.
1209 */
1210 for_each_context(priv, ctx)
1211 iwlagn_set_rxon_chain(priv, ctx);
1212 }
1213
1214 if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
1215 for_each_context(priv, ctx) {
1216 /* Configure HT40 channels */
1217 if (ctx->ht.enabled != conf_is_ht(conf))
1218 ctx->ht.enabled = conf_is_ht(conf);
1219
1220 if (ctx->ht.enabled) {
1221 /* if HT40 is used, it should not change
1222 * after associated except channel switch */
1223 if (!ctx->ht.is_40mhz ||
1224 !iwl_is_associated_ctx(ctx))
1225 iwlagn_config_ht40(conf, ctx);
1226 } else
1227 ctx->ht.is_40mhz = false;
1228
1229 /*
1230 * Default to no protection. Protection mode will
1231 * later be set from BSS config in iwl_ht_conf
1232 */
1233 ctx->ht.protection = IEEE80211_HT_OP_MODE_PROTECTION_NONE;
1234
1235 /* if we are switching from ht to 2.4 clear flags
1236 * from any ht related info since 2.4 does not
1237 * support ht */
1238 if (le16_to_cpu(ctx->staging.channel) !=
1239 channel->hw_value)
1240 ctx->staging.flags = 0;
1241
1242 iwl_set_rxon_channel(priv, channel, ctx);
1243 iwl_set_rxon_ht(priv, &priv->current_ht_config);
1244
1245 iwl_set_flags_for_band(priv, ctx, channel->band,
1246 ctx->vif);
1247 }
1248
1249 iwl_update_bcast_stations(priv);
1250 }
1251
1252 if (changed & (IEEE80211_CONF_CHANGE_PS |
1253 IEEE80211_CONF_CHANGE_IDLE)) {
1254 ret = iwl_power_update_mode(priv, false);
1255 if (ret)
1256 IWL_DEBUG_MAC80211(priv, "Error setting sleep level\n");
1257 }
1258
1259 if (changed & IEEE80211_CONF_CHANGE_POWER) {
1260 IWL_DEBUG_MAC80211(priv, "TX Power old=%d new=%d\n",
1261 priv->tx_power_user_lmt, conf->power_level);
1262
1263 iwl_set_tx_power(priv, conf->power_level, false);
1264 }
1265
1266 for_each_context(priv, ctx) {
1267 if (!memcmp(&ctx->staging, &ctx->active, sizeof(ctx->staging)))
1268 continue;
1269 iwlagn_commit_rxon(priv, ctx);
1270 }
1271 out:
1272 mutex_unlock(&priv->mutex);
1273 IWL_DEBUG_MAC80211(priv, "leave\n");
1274
1275 return ret;
1276 }
1277
iwlagn_check_needed_chains(struct iwl_priv * priv,struct iwl_rxon_context * ctx,struct ieee80211_bss_conf * bss_conf)1278 static void iwlagn_check_needed_chains(struct iwl_priv *priv,
1279 struct iwl_rxon_context *ctx,
1280 struct ieee80211_bss_conf *bss_conf)
1281 {
1282 struct ieee80211_vif *vif = ctx->vif;
1283 struct iwl_rxon_context *tmp;
1284 struct ieee80211_sta *sta;
1285 struct iwl_ht_config *ht_conf = &priv->current_ht_config;
1286 struct ieee80211_sta_ht_cap *ht_cap;
1287 bool need_multiple;
1288
1289 lockdep_assert_held(&priv->mutex);
1290
1291 switch (vif->type) {
1292 case NL80211_IFTYPE_STATION:
1293 rcu_read_lock();
1294 sta = ieee80211_find_sta(vif, bss_conf->bssid);
1295 if (!sta) {
1296 /*
1297 * If at all, this can only happen through a race
1298 * when the AP disconnects us while we're still
1299 * setting up the connection, in that case mac80211
1300 * will soon tell us about that.
1301 */
1302 need_multiple = false;
1303 rcu_read_unlock();
1304 break;
1305 }
1306
1307 ht_cap = &sta->ht_cap;
1308
1309 need_multiple = true;
1310
1311 /*
1312 * If the peer advertises no support for receiving 2 and 3
1313 * stream MCS rates, it can't be transmitting them either.
1314 */
1315 if (ht_cap->mcs.rx_mask[1] == 0 &&
1316 ht_cap->mcs.rx_mask[2] == 0) {
1317 need_multiple = false;
1318 } else if (!(ht_cap->mcs.tx_params &
1319 IEEE80211_HT_MCS_TX_DEFINED)) {
1320 /* If it can't TX MCS at all ... */
1321 need_multiple = false;
1322 } else if (ht_cap->mcs.tx_params &
1323 IEEE80211_HT_MCS_TX_RX_DIFF) {
1324 int maxstreams;
1325
1326 /*
1327 * But if it can receive them, it might still not
1328 * be able to transmit them, which is what we need
1329 * to check here -- so check the number of streams
1330 * it advertises for TX (if different from RX).
1331 */
1332
1333 maxstreams = (ht_cap->mcs.tx_params &
1334 IEEE80211_HT_MCS_TX_MAX_STREAMS_MASK);
1335 maxstreams >>=
1336 IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT;
1337 maxstreams += 1;
1338
1339 if (maxstreams <= 1)
1340 need_multiple = false;
1341 }
1342
1343 rcu_read_unlock();
1344 break;
1345 case NL80211_IFTYPE_ADHOC:
1346 /* currently */
1347 need_multiple = false;
1348 break;
1349 default:
1350 /* only AP really */
1351 need_multiple = true;
1352 break;
1353 }
1354
1355 ctx->ht_need_multiple_chains = need_multiple;
1356
1357 if (!need_multiple) {
1358 /* check all contexts */
1359 for_each_context(priv, tmp) {
1360 if (!tmp->vif)
1361 continue;
1362 if (tmp->ht_need_multiple_chains) {
1363 need_multiple = true;
1364 break;
1365 }
1366 }
1367 }
1368
1369 ht_conf->single_chain_sufficient = !need_multiple;
1370 }
1371
iwlagn_chain_noise_reset(struct iwl_priv * priv)1372 static void iwlagn_chain_noise_reset(struct iwl_priv *priv)
1373 {
1374 struct iwl_chain_noise_data *data = &priv->chain_noise_data;
1375 int ret;
1376
1377 if (priv->calib_disabled & IWL_CHAIN_NOISE_CALIB_DISABLED)
1378 return;
1379
1380 if ((data->state == IWL_CHAIN_NOISE_ALIVE) &&
1381 iwl_is_any_associated(priv)) {
1382 struct iwl_calib_chain_noise_reset_cmd cmd;
1383
1384 /* clear data for chain noise calibration algorithm */
1385 data->chain_noise_a = 0;
1386 data->chain_noise_b = 0;
1387 data->chain_noise_c = 0;
1388 data->chain_signal_a = 0;
1389 data->chain_signal_b = 0;
1390 data->chain_signal_c = 0;
1391 data->beacon_count = 0;
1392
1393 memset(&cmd, 0, sizeof(cmd));
1394 iwl_set_calib_hdr(&cmd.hdr,
1395 priv->phy_calib_chain_noise_reset_cmd);
1396 ret = iwl_dvm_send_cmd_pdu(priv,
1397 REPLY_PHY_CALIBRATION_CMD,
1398 0, sizeof(cmd), &cmd);
1399 if (ret)
1400 IWL_ERR(priv,
1401 "Could not send REPLY_PHY_CALIBRATION_CMD\n");
1402 data->state = IWL_CHAIN_NOISE_ACCUMULATE;
1403 IWL_DEBUG_CALIB(priv, "Run chain_noise_calibrate\n");
1404 }
1405 }
1406
iwlagn_bss_info_changed(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_bss_conf * bss_conf,u32 changes)1407 void iwlagn_bss_info_changed(struct ieee80211_hw *hw,
1408 struct ieee80211_vif *vif,
1409 struct ieee80211_bss_conf *bss_conf,
1410 u32 changes)
1411 {
1412 struct iwl_priv *priv = IWL_MAC80211_GET_DVM(hw);
1413 struct iwl_rxon_context *ctx = iwl_rxon_ctx_from_vif(vif);
1414 int ret;
1415 bool force = false;
1416
1417 mutex_lock(&priv->mutex);
1418
1419 if (changes & BSS_CHANGED_IDLE && bss_conf->idle) {
1420 /*
1421 * If we go idle, then clearly no "passive-no-rx"
1422 * workaround is needed any more, this is a reset.
1423 */
1424 iwlagn_lift_passive_no_rx(priv);
1425 }
1426
1427 if (unlikely(!iwl_is_ready(priv))) {
1428 IWL_DEBUG_MAC80211(priv, "leave - not ready\n");
1429 mutex_unlock(&priv->mutex);
1430 return;
1431 }
1432
1433 if (unlikely(!ctx->vif)) {
1434 IWL_DEBUG_MAC80211(priv, "leave - vif is NULL\n");
1435 mutex_unlock(&priv->mutex);
1436 return;
1437 }
1438
1439 if (changes & BSS_CHANGED_BEACON_INT)
1440 force = true;
1441
1442 if (changes & BSS_CHANGED_QOS) {
1443 ctx->qos_data.qos_active = bss_conf->qos;
1444 iwlagn_update_qos(priv, ctx);
1445 }
1446
1447 ctx->staging.assoc_id = cpu_to_le16(vif->bss_conf.aid);
1448 if (vif->bss_conf.use_short_preamble)
1449 ctx->staging.flags |= RXON_FLG_SHORT_PREAMBLE_MSK;
1450 else
1451 ctx->staging.flags &= ~RXON_FLG_SHORT_PREAMBLE_MSK;
1452
1453 if (changes & BSS_CHANGED_ASSOC) {
1454 if (bss_conf->assoc) {
1455 priv->timestamp = bss_conf->sync_tsf;
1456 ctx->staging.filter_flags |= RXON_FILTER_ASSOC_MSK;
1457 } else {
1458 ctx->staging.filter_flags &= ~RXON_FILTER_ASSOC_MSK;
1459
1460 if (ctx->ctxid == IWL_RXON_CTX_BSS)
1461 priv->have_rekey_data = false;
1462 }
1463
1464 iwlagn_bt_coex_rssi_monitor(priv);
1465 }
1466
1467 if (ctx->ht.enabled) {
1468 ctx->ht.protection = bss_conf->ht_operation_mode &
1469 IEEE80211_HT_OP_MODE_PROTECTION;
1470 ctx->ht.non_gf_sta_present = !!(bss_conf->ht_operation_mode &
1471 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT);
1472 iwlagn_check_needed_chains(priv, ctx, bss_conf);
1473 iwl_set_rxon_ht(priv, &priv->current_ht_config);
1474 }
1475
1476 iwlagn_set_rxon_chain(priv, ctx);
1477
1478 if (bss_conf->use_cts_prot && (priv->band != IEEE80211_BAND_5GHZ))
1479 ctx->staging.flags |= RXON_FLG_TGG_PROTECT_MSK;
1480 else
1481 ctx->staging.flags &= ~RXON_FLG_TGG_PROTECT_MSK;
1482
1483 if (bss_conf->use_cts_prot)
1484 ctx->staging.flags |= RXON_FLG_SELF_CTS_EN;
1485 else
1486 ctx->staging.flags &= ~RXON_FLG_SELF_CTS_EN;
1487
1488 memcpy(ctx->staging.bssid_addr, bss_conf->bssid, ETH_ALEN);
1489
1490 if (vif->type == NL80211_IFTYPE_AP ||
1491 vif->type == NL80211_IFTYPE_ADHOC) {
1492 if (vif->bss_conf.enable_beacon) {
1493 ctx->staging.filter_flags |= RXON_FILTER_ASSOC_MSK;
1494 priv->beacon_ctx = ctx;
1495 } else {
1496 ctx->staging.filter_flags &= ~RXON_FILTER_ASSOC_MSK;
1497 priv->beacon_ctx = NULL;
1498 }
1499 }
1500
1501 /*
1502 * If the ucode decides to do beacon filtering before
1503 * association, it will lose beacons that are needed
1504 * before sending frames out on passive channels. This
1505 * causes association failures on those channels. Enable
1506 * receiving beacons in such cases.
1507 */
1508
1509 if (vif->type == NL80211_IFTYPE_STATION) {
1510 if (!bss_conf->assoc)
1511 ctx->staging.filter_flags |= RXON_FILTER_BCON_AWARE_MSK;
1512 else
1513 ctx->staging.filter_flags &=
1514 ~RXON_FILTER_BCON_AWARE_MSK;
1515 }
1516
1517 if (force || memcmp(&ctx->staging, &ctx->active, sizeof(ctx->staging)))
1518 iwlagn_commit_rxon(priv, ctx);
1519
1520 if (changes & BSS_CHANGED_ASSOC && bss_conf->assoc) {
1521 /*
1522 * The chain noise calibration will enable PM upon
1523 * completion. If calibration has already been run
1524 * then we need to enable power management here.
1525 */
1526 if (priv->chain_noise_data.state == IWL_CHAIN_NOISE_DONE)
1527 iwl_power_update_mode(priv, false);
1528
1529 /* Enable RX differential gain and sensitivity calibrations */
1530 iwlagn_chain_noise_reset(priv);
1531 priv->start_calib = 1;
1532 }
1533
1534 if (changes & BSS_CHANGED_IBSS) {
1535 ret = iwlagn_manage_ibss_station(priv, vif,
1536 bss_conf->ibss_joined);
1537 if (ret)
1538 IWL_ERR(priv, "failed to %s IBSS station %pM\n",
1539 bss_conf->ibss_joined ? "add" : "remove",
1540 bss_conf->bssid);
1541 }
1542
1543 if (changes & BSS_CHANGED_BEACON && priv->beacon_ctx == ctx) {
1544 if (iwlagn_update_beacon(priv, vif))
1545 IWL_ERR(priv, "Error updating beacon\n");
1546 }
1547
1548 mutex_unlock(&priv->mutex);
1549 }
1550
iwlagn_post_scan(struct iwl_priv * priv)1551 void iwlagn_post_scan(struct iwl_priv *priv)
1552 {
1553 struct iwl_rxon_context *ctx;
1554
1555 /*
1556 * We do not commit power settings while scan is pending,
1557 * do it now if the settings changed.
1558 */
1559 iwl_power_set_mode(priv, &priv->power_data.sleep_cmd_next, false);
1560 iwl_set_tx_power(priv, priv->tx_power_next, false);
1561
1562 /*
1563 * Since setting the RXON may have been deferred while
1564 * performing the scan, fire one off if needed
1565 */
1566 for_each_context(priv, ctx)
1567 if (memcmp(&ctx->staging, &ctx->active, sizeof(ctx->staging)))
1568 iwlagn_commit_rxon(priv, ctx);
1569
1570 iwlagn_set_pan_params(priv);
1571 }
1572