1 /******************************************************************************
5 * Copyright(c) 2008 - 2009 Intel Corporation. All rights reserved.
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of version 2 of the GNU General Public License as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful, but
12 * WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
21 * The full GNU General Public License is included in this distribution
22 * in the file called LICENSE.GPL.
24 * Contact Information:
25 * Intel Linux Wireless <ilw@linux.intel.com>
26 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
27 *****************************************************************************/
29 #include <linux/kernel.h>
30 #include <linux/module.h>
31 #include <linux/etherdevice.h>
32 #include <net/mac80211.h>
34 #include "iwl-eeprom.h"
35 #include "iwl-dev.h" /* FIXME: remove */
36 #include "iwl-debug.h"
39 #include "iwl-power.h"
41 #include "iwl-helpers.h"
44 MODULE_DESCRIPTION("iwl core");
45 MODULE_VERSION(IWLWIFI_VERSION
);
46 MODULE_AUTHOR(DRV_COPYRIGHT
" " DRV_AUTHOR
);
47 MODULE_LICENSE("GPL");
49 #define IWL_DECLARE_RATE_INFO(r, s, ip, in, rp, rn, pp, np) \
50 [IWL_RATE_##r##M_INDEX] = { IWL_RATE_##r##M_PLCP, \
51 IWL_RATE_SISO_##s##M_PLCP, \
52 IWL_RATE_MIMO2_##s##M_PLCP,\
53 IWL_RATE_MIMO3_##s##M_PLCP,\
54 IWL_RATE_##r##M_IEEE, \
55 IWL_RATE_##ip##M_INDEX, \
56 IWL_RATE_##in##M_INDEX, \
57 IWL_RATE_##rp##M_INDEX, \
58 IWL_RATE_##rn##M_INDEX, \
59 IWL_RATE_##pp##M_INDEX, \
60 IWL_RATE_##np##M_INDEX }
63 EXPORT_SYMBOL(iwl_debug_level
);
65 static irqreturn_t
iwl_isr(int irq
, void *data
);
69 * rate, ht rate, prev rate, next rate, prev tgg rate, next tgg rate
71 * If there isn't a valid next or previous rate then INV is used which
72 * maps to IWL_RATE_INVALID
75 const struct iwl_rate_info iwl_rates
[IWL_RATE_COUNT
] = {
76 IWL_DECLARE_RATE_INFO(1, INV
, INV
, 2, INV
, 2, INV
, 2), /* 1mbps */
77 IWL_DECLARE_RATE_INFO(2, INV
, 1, 5, 1, 5, 1, 5), /* 2mbps */
78 IWL_DECLARE_RATE_INFO(5, INV
, 2, 6, 2, 11, 2, 11), /*5.5mbps */
79 IWL_DECLARE_RATE_INFO(11, INV
, 9, 12, 9, 12, 5, 18), /* 11mbps */
80 IWL_DECLARE_RATE_INFO(6, 6, 5, 9, 5, 11, 5, 11), /* 6mbps */
81 IWL_DECLARE_RATE_INFO(9, 6, 6, 11, 6, 11, 5, 11), /* 9mbps */
82 IWL_DECLARE_RATE_INFO(12, 12, 11, 18, 11, 18, 11, 18), /* 12mbps */
83 IWL_DECLARE_RATE_INFO(18, 18, 12, 24, 12, 24, 11, 24), /* 18mbps */
84 IWL_DECLARE_RATE_INFO(24, 24, 18, 36, 18, 36, 18, 36), /* 24mbps */
85 IWL_DECLARE_RATE_INFO(36, 36, 24, 48, 24, 48, 24, 48), /* 36mbps */
86 IWL_DECLARE_RATE_INFO(48, 48, 36, 54, 36, 54, 36, 54), /* 48mbps */
87 IWL_DECLARE_RATE_INFO(54, 54, 48, INV
, 48, INV
, 48, INV
),/* 54mbps */
88 IWL_DECLARE_RATE_INFO(60, 60, 48, INV
, 48, INV
, 48, INV
),/* 60mbps */
89 /* FIXME:RS: ^^ should be INV (legacy) */
91 EXPORT_SYMBOL(iwl_rates
);
94 * translate ucode response to mac80211 tx status control values
96 void iwl_hwrate_to_tx_control(struct iwl_priv
*priv
, u32 rate_n_flags
,
97 struct ieee80211_tx_info
*info
)
99 struct ieee80211_tx_rate
*r
= &info
->control
.rates
[0];
101 info
->antenna_sel_tx
=
102 ((rate_n_flags
& RATE_MCS_ANT_ABC_MSK
) >> RATE_MCS_ANT_POS
);
103 if (rate_n_flags
& RATE_MCS_HT_MSK
)
104 r
->flags
|= IEEE80211_TX_RC_MCS
;
105 if (rate_n_flags
& RATE_MCS_GF_MSK
)
106 r
->flags
|= IEEE80211_TX_RC_GREEN_FIELD
;
107 if (rate_n_flags
& RATE_MCS_HT40_MSK
)
108 r
->flags
|= IEEE80211_TX_RC_40_MHZ_WIDTH
;
109 if (rate_n_flags
& RATE_MCS_DUP_MSK
)
110 r
->flags
|= IEEE80211_TX_RC_DUP_DATA
;
111 if (rate_n_flags
& RATE_MCS_SGI_MSK
)
112 r
->flags
|= IEEE80211_TX_RC_SHORT_GI
;
113 r
->idx
= iwl_hwrate_to_mac80211_idx(rate_n_flags
, info
->band
);
115 EXPORT_SYMBOL(iwl_hwrate_to_tx_control
);
117 int iwl_hwrate_to_plcp_idx(u32 rate_n_flags
)
122 if (rate_n_flags
& RATE_MCS_HT_MSK
) {
123 idx
= (rate_n_flags
& 0xff);
125 if (idx
>= IWL_RATE_MIMO3_6M_PLCP
)
126 idx
= idx
- IWL_RATE_MIMO3_6M_PLCP
;
127 else if (idx
>= IWL_RATE_MIMO2_6M_PLCP
)
128 idx
= idx
- IWL_RATE_MIMO2_6M_PLCP
;
130 idx
+= IWL_FIRST_OFDM_RATE
;
131 /* skip 9M not supported in ht*/
132 if (idx
>= IWL_RATE_9M_INDEX
)
134 if ((idx
>= IWL_FIRST_OFDM_RATE
) && (idx
<= IWL_LAST_OFDM_RATE
))
137 /* legacy rate format, search for match in table */
139 for (idx
= 0; idx
< ARRAY_SIZE(iwl_rates
); idx
++)
140 if (iwl_rates
[idx
].plcp
== (rate_n_flags
& 0xFF))
146 EXPORT_SYMBOL(iwl_hwrate_to_plcp_idx
);
148 int iwl_hwrate_to_mac80211_idx(u32 rate_n_flags
, enum ieee80211_band band
)
153 /* HT rate format: mac80211 wants an MCS number, which is just LSB */
154 if (rate_n_flags
& RATE_MCS_HT_MSK
) {
155 idx
= (rate_n_flags
& 0xff);
157 /* Legacy rate format, search for match in table */
159 if (band
== IEEE80211_BAND_5GHZ
)
160 band_offset
= IWL_FIRST_OFDM_RATE
;
161 for (idx
= band_offset
; idx
< IWL_RATE_COUNT_LEGACY
; idx
++)
162 if (iwl_rates
[idx
].plcp
== (rate_n_flags
& 0xFF))
163 return idx
- band_offset
;
169 u8
iwl_toggle_tx_ant(struct iwl_priv
*priv
, u8 ant
)
173 for (i
= 0; i
< RATE_ANT_NUM
- 1; i
++) {
174 ind
= (ind
+ 1) < RATE_ANT_NUM
? ind
+ 1 : 0;
175 if (priv
->hw_params
.valid_tx_ant
& BIT(ind
))
181 const u8 iwl_bcast_addr
[ETH_ALEN
] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF };
182 EXPORT_SYMBOL(iwl_bcast_addr
);
185 /* This function both allocates and initializes hw and priv. */
186 struct ieee80211_hw
*iwl_alloc_all(struct iwl_cfg
*cfg
,
187 struct ieee80211_ops
*hw_ops
)
189 struct iwl_priv
*priv
;
191 /* mac80211 allocates memory for this device instance, including
192 * space for this driver's private structure */
193 struct ieee80211_hw
*hw
=
194 ieee80211_alloc_hw(sizeof(struct iwl_priv
), hw_ops
);
196 printk(KERN_ERR
"%s: Can not allocate network device\n",
207 EXPORT_SYMBOL(iwl_alloc_all
);
209 void iwl_hw_detect(struct iwl_priv
*priv
)
211 priv
->hw_rev
= _iwl_read32(priv
, CSR_HW_REV
);
212 priv
->hw_wa_rev
= _iwl_read32(priv
, CSR_HW_REV_WA_REG
);
213 pci_read_config_byte(priv
->pci_dev
, PCI_REVISION_ID
, &priv
->rev_id
);
215 EXPORT_SYMBOL(iwl_hw_detect
);
217 int iwl_hw_nic_init(struct iwl_priv
*priv
)
220 struct iwl_rx_queue
*rxq
= &priv
->rxq
;
224 spin_lock_irqsave(&priv
->lock
, flags
);
225 priv
->cfg
->ops
->lib
->apm_ops
.init(priv
);
226 iwl_write32(priv
, CSR_INT_COALESCING
, 512 / 32);
227 spin_unlock_irqrestore(&priv
->lock
, flags
);
229 ret
= priv
->cfg
->ops
->lib
->apm_ops
.set_pwr_src(priv
, IWL_PWR_SRC_VMAIN
);
231 priv
->cfg
->ops
->lib
->apm_ops
.config(priv
);
233 /* Allocate the RX queue, or reset if it is already allocated */
235 ret
= iwl_rx_queue_alloc(priv
);
237 IWL_ERR(priv
, "Unable to initialize Rx queue\n");
241 iwl_rx_queue_reset(priv
, rxq
);
243 iwl_rx_replenish(priv
);
245 iwl_rx_init(priv
, rxq
);
247 spin_lock_irqsave(&priv
->lock
, flags
);
249 rxq
->need_update
= 1;
250 iwl_rx_queue_update_write_ptr(priv
, rxq
);
252 spin_unlock_irqrestore(&priv
->lock
, flags
);
254 /* Allocate and init all Tx and Command queues */
255 ret
= iwl_txq_ctx_reset(priv
);
259 set_bit(STATUS_INIT
, &priv
->status
);
263 EXPORT_SYMBOL(iwl_hw_nic_init
);
268 void iwl_activate_qos(struct iwl_priv
*priv
, u8 force
)
270 if (test_bit(STATUS_EXIT_PENDING
, &priv
->status
))
273 priv
->qos_data
.def_qos_parm
.qos_flags
= 0;
275 if (priv
->qos_data
.qos_cap
.q_AP
.queue_request
&&
276 !priv
->qos_data
.qos_cap
.q_AP
.txop_request
)
277 priv
->qos_data
.def_qos_parm
.qos_flags
|=
278 QOS_PARAM_FLG_TXOP_TYPE_MSK
;
279 if (priv
->qos_data
.qos_active
)
280 priv
->qos_data
.def_qos_parm
.qos_flags
|=
281 QOS_PARAM_FLG_UPDATE_EDCA_MSK
;
283 if (priv
->current_ht_config
.is_ht
)
284 priv
->qos_data
.def_qos_parm
.qos_flags
|= QOS_PARAM_FLG_TGN_MSK
;
286 if (force
|| iwl_is_associated(priv
)) {
287 IWL_DEBUG_QOS(priv
, "send QoS cmd with Qos active=%d FLAGS=0x%X\n",
288 priv
->qos_data
.qos_active
,
289 priv
->qos_data
.def_qos_parm
.qos_flags
);
291 iwl_send_cmd_pdu_async(priv
, REPLY_QOS_PARAM
,
292 sizeof(struct iwl_qosparam_cmd
),
293 &priv
->qos_data
.def_qos_parm
, NULL
);
296 EXPORT_SYMBOL(iwl_activate_qos
);
299 * AC CWmin CW max AIFSN TXOP Limit TXOP Limit
300 * (802.11b) (802.11a/g)
301 * AC_BK 15 1023 7 0 0
302 * AC_BE 15 1023 3 0 0
303 * AC_VI 7 15 2 6.016ms 3.008ms
304 * AC_VO 3 7 2 3.264ms 1.504ms
306 void iwl_reset_qos(struct iwl_priv
*priv
)
311 bool is_legacy
= false;
315 spin_lock_irqsave(&priv
->lock
, flags
);
316 /* QoS always active in AP and ADHOC mode
317 * In STA mode wait for association
319 if (priv
->iw_mode
== NL80211_IFTYPE_ADHOC
||
320 priv
->iw_mode
== NL80211_IFTYPE_AP
)
321 priv
->qos_data
.qos_active
= 1;
323 priv
->qos_data
.qos_active
= 0;
325 /* check for legacy mode */
326 if ((priv
->iw_mode
== NL80211_IFTYPE_ADHOC
&&
327 (priv
->active_rate
& IWL_OFDM_RATES_MASK
) == 0) ||
328 (priv
->iw_mode
== NL80211_IFTYPE_STATION
&&
329 (priv
->staging_rxon
.flags
& RXON_FLG_SHORT_SLOT_MSK
) == 0)) {
334 if (priv
->qos_data
.qos_active
)
338 priv
->qos_data
.def_qos_parm
.ac
[0].cw_min
= cpu_to_le16(cw_min
);
339 priv
->qos_data
.def_qos_parm
.ac
[0].cw_max
= cpu_to_le16(cw_max
);
340 priv
->qos_data
.def_qos_parm
.ac
[0].aifsn
= aifs
;
341 priv
->qos_data
.def_qos_parm
.ac
[0].edca_txop
= 0;
342 priv
->qos_data
.def_qos_parm
.ac
[0].reserved1
= 0;
344 if (priv
->qos_data
.qos_active
) {
347 priv
->qos_data
.def_qos_parm
.ac
[i
].cw_min
= cpu_to_le16(cw_min
);
348 priv
->qos_data
.def_qos_parm
.ac
[i
].cw_max
= cpu_to_le16(cw_max
);
349 priv
->qos_data
.def_qos_parm
.ac
[i
].aifsn
= 7;
350 priv
->qos_data
.def_qos_parm
.ac
[i
].edca_txop
= 0;
351 priv
->qos_data
.def_qos_parm
.ac
[i
].reserved1
= 0;
355 priv
->qos_data
.def_qos_parm
.ac
[i
].cw_min
=
356 cpu_to_le16((cw_min
+ 1) / 2 - 1);
357 priv
->qos_data
.def_qos_parm
.ac
[i
].cw_max
=
359 priv
->qos_data
.def_qos_parm
.ac
[i
].aifsn
= 2;
361 priv
->qos_data
.def_qos_parm
.ac
[i
].edca_txop
=
364 priv
->qos_data
.def_qos_parm
.ac
[i
].edca_txop
=
366 priv
->qos_data
.def_qos_parm
.ac
[i
].reserved1
= 0;
370 priv
->qos_data
.def_qos_parm
.ac
[i
].cw_min
=
371 cpu_to_le16((cw_min
+ 1) / 4 - 1);
372 priv
->qos_data
.def_qos_parm
.ac
[i
].cw_max
=
373 cpu_to_le16((cw_min
+ 1) / 2 - 1);
374 priv
->qos_data
.def_qos_parm
.ac
[i
].aifsn
= 2;
375 priv
->qos_data
.def_qos_parm
.ac
[i
].reserved1
= 0;
377 priv
->qos_data
.def_qos_parm
.ac
[i
].edca_txop
=
380 priv
->qos_data
.def_qos_parm
.ac
[i
].edca_txop
=
383 for (i
= 1; i
< 4; i
++) {
384 priv
->qos_data
.def_qos_parm
.ac
[i
].cw_min
=
386 priv
->qos_data
.def_qos_parm
.ac
[i
].cw_max
=
388 priv
->qos_data
.def_qos_parm
.ac
[i
].aifsn
= aifs
;
389 priv
->qos_data
.def_qos_parm
.ac
[i
].edca_txop
= 0;
390 priv
->qos_data
.def_qos_parm
.ac
[i
].reserved1
= 0;
393 IWL_DEBUG_QOS(priv
, "set QoS to default \n");
395 spin_unlock_irqrestore(&priv
->lock
, flags
);
397 EXPORT_SYMBOL(iwl_reset_qos
);
399 #define MAX_BIT_RATE_40_MHZ 150 /* Mbps */
400 #define MAX_BIT_RATE_20_MHZ 72 /* Mbps */
401 static void iwlcore_init_ht_hw_capab(const struct iwl_priv
*priv
,
402 struct ieee80211_sta_ht_cap
*ht_info
,
403 enum ieee80211_band band
)
405 u16 max_bit_rate
= 0;
406 u8 rx_chains_num
= priv
->hw_params
.rx_chains_num
;
407 u8 tx_chains_num
= priv
->hw_params
.tx_chains_num
;
410 memset(&ht_info
->mcs
, 0, sizeof(ht_info
->mcs
));
412 ht_info
->ht_supported
= true;
414 if (priv
->cfg
->ht_greenfield_support
)
415 ht_info
->cap
|= IEEE80211_HT_CAP_GRN_FLD
;
416 ht_info
->cap
|= IEEE80211_HT_CAP_SGI_20
;
417 ht_info
->cap
|= (IEEE80211_HT_CAP_SM_PS
&
418 (WLAN_HT_CAP_SM_PS_DISABLED
<< 2));
420 max_bit_rate
= MAX_BIT_RATE_20_MHZ
;
421 if (priv
->hw_params
.ht40_channel
& BIT(band
)) {
422 ht_info
->cap
|= IEEE80211_HT_CAP_SUP_WIDTH_20_40
;
423 ht_info
->cap
|= IEEE80211_HT_CAP_SGI_40
;
424 ht_info
->mcs
.rx_mask
[4] = 0x01;
425 max_bit_rate
= MAX_BIT_RATE_40_MHZ
;
428 if (priv
->cfg
->mod_params
->amsdu_size_8K
)
429 ht_info
->cap
|= IEEE80211_HT_CAP_MAX_AMSDU
;
431 ht_info
->ampdu_factor
= CFG_HT_RX_AMPDU_FACTOR_DEF
;
432 ht_info
->ampdu_density
= CFG_HT_MPDU_DENSITY_DEF
;
434 ht_info
->mcs
.rx_mask
[0] = 0xFF;
435 if (rx_chains_num
>= 2)
436 ht_info
->mcs
.rx_mask
[1] = 0xFF;
437 if (rx_chains_num
>= 3)
438 ht_info
->mcs
.rx_mask
[2] = 0xFF;
440 /* Highest supported Rx data rate */
441 max_bit_rate
*= rx_chains_num
;
442 WARN_ON(max_bit_rate
& ~IEEE80211_HT_MCS_RX_HIGHEST_MASK
);
443 ht_info
->mcs
.rx_highest
= cpu_to_le16(max_bit_rate
);
445 /* Tx MCS capabilities */
446 ht_info
->mcs
.tx_params
= IEEE80211_HT_MCS_TX_DEFINED
;
447 if (tx_chains_num
!= rx_chains_num
) {
448 ht_info
->mcs
.tx_params
|= IEEE80211_HT_MCS_TX_RX_DIFF
;
449 ht_info
->mcs
.tx_params
|= ((tx_chains_num
- 1) <<
450 IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT
);
454 static void iwlcore_init_hw_rates(struct iwl_priv
*priv
,
455 struct ieee80211_rate
*rates
)
459 for (i
= 0; i
< IWL_RATE_COUNT_LEGACY
; i
++) {
460 rates
[i
].bitrate
= iwl_rates
[i
].ieee
* 5;
461 rates
[i
].hw_value
= i
; /* Rate scaling will work on indexes */
462 rates
[i
].hw_value_short
= i
;
464 if ((i
>= IWL_FIRST_CCK_RATE
) && (i
<= IWL_LAST_CCK_RATE
)) {
466 * If CCK != 1M then set short preamble rate flag.
469 (iwl_rates
[i
].plcp
== IWL_RATE_1M_PLCP
) ?
470 0 : IEEE80211_RATE_SHORT_PREAMBLE
;
477 * iwlcore_init_geos - Initialize mac80211's geo/channel info based from eeprom
479 int iwlcore_init_geos(struct iwl_priv
*priv
)
481 struct iwl_channel_info
*ch
;
482 struct ieee80211_supported_band
*sband
;
483 struct ieee80211_channel
*channels
;
484 struct ieee80211_channel
*geo_ch
;
485 struct ieee80211_rate
*rates
;
488 if (priv
->bands
[IEEE80211_BAND_2GHZ
].n_bitrates
||
489 priv
->bands
[IEEE80211_BAND_5GHZ
].n_bitrates
) {
490 IWL_DEBUG_INFO(priv
, "Geography modes already initialized.\n");
491 set_bit(STATUS_GEO_CONFIGURED
, &priv
->status
);
495 channels
= kzalloc(sizeof(struct ieee80211_channel
) *
496 priv
->channel_count
, GFP_KERNEL
);
500 rates
= kzalloc((sizeof(struct ieee80211_rate
) * IWL_RATE_COUNT_LEGACY
),
507 /* 5.2GHz channels start after the 2.4GHz channels */
508 sband
= &priv
->bands
[IEEE80211_BAND_5GHZ
];
509 sband
->channels
= &channels
[ARRAY_SIZE(iwl_eeprom_band_1
)];
511 sband
->bitrates
= &rates
[IWL_FIRST_OFDM_RATE
];
512 sband
->n_bitrates
= IWL_RATE_COUNT_LEGACY
- IWL_FIRST_OFDM_RATE
;
514 if (priv
->cfg
->sku
& IWL_SKU_N
)
515 iwlcore_init_ht_hw_capab(priv
, &sband
->ht_cap
,
516 IEEE80211_BAND_5GHZ
);
518 sband
= &priv
->bands
[IEEE80211_BAND_2GHZ
];
519 sband
->channels
= channels
;
521 sband
->bitrates
= rates
;
522 sband
->n_bitrates
= IWL_RATE_COUNT_LEGACY
;
524 if (priv
->cfg
->sku
& IWL_SKU_N
)
525 iwlcore_init_ht_hw_capab(priv
, &sband
->ht_cap
,
526 IEEE80211_BAND_2GHZ
);
528 priv
->ieee_channels
= channels
;
529 priv
->ieee_rates
= rates
;
531 for (i
= 0; i
< priv
->channel_count
; i
++) {
532 ch
= &priv
->channel_info
[i
];
534 /* FIXME: might be removed if scan is OK */
535 if (!is_channel_valid(ch
))
538 if (is_channel_a_band(ch
))
539 sband
= &priv
->bands
[IEEE80211_BAND_5GHZ
];
541 sband
= &priv
->bands
[IEEE80211_BAND_2GHZ
];
543 geo_ch
= &sband
->channels
[sband
->n_channels
++];
545 geo_ch
->center_freq
=
546 ieee80211_channel_to_frequency(ch
->channel
);
547 geo_ch
->max_power
= ch
->max_power_avg
;
548 geo_ch
->max_antenna_gain
= 0xff;
549 geo_ch
->hw_value
= ch
->channel
;
551 if (is_channel_valid(ch
)) {
552 if (!(ch
->flags
& EEPROM_CHANNEL_IBSS
))
553 geo_ch
->flags
|= IEEE80211_CHAN_NO_IBSS
;
555 if (!(ch
->flags
& EEPROM_CHANNEL_ACTIVE
))
556 geo_ch
->flags
|= IEEE80211_CHAN_PASSIVE_SCAN
;
558 if (ch
->flags
& EEPROM_CHANNEL_RADAR
)
559 geo_ch
->flags
|= IEEE80211_CHAN_RADAR
;
561 geo_ch
->flags
|= ch
->ht40_extension_channel
;
563 if (ch
->max_power_avg
> priv
->tx_power_device_lmt
)
564 priv
->tx_power_device_lmt
= ch
->max_power_avg
;
566 geo_ch
->flags
|= IEEE80211_CHAN_DISABLED
;
569 IWL_DEBUG_INFO(priv
, "Channel %d Freq=%d[%sGHz] %s flag=0x%X\n",
570 ch
->channel
, geo_ch
->center_freq
,
571 is_channel_a_band(ch
) ? "5.2" : "2.4",
572 geo_ch
->flags
& IEEE80211_CHAN_DISABLED
?
573 "restricted" : "valid",
577 if ((priv
->bands
[IEEE80211_BAND_5GHZ
].n_channels
== 0) &&
578 priv
->cfg
->sku
& IWL_SKU_A
) {
579 IWL_INFO(priv
, "Incorrectly detected BG card as ABG. "
580 "Please send your PCI ID 0x%04X:0x%04X to maintainer.\n",
581 priv
->pci_dev
->device
,
582 priv
->pci_dev
->subsystem_device
);
583 priv
->cfg
->sku
&= ~IWL_SKU_A
;
586 IWL_INFO(priv
, "Tunable channels: %d 802.11bg, %d 802.11a channels\n",
587 priv
->bands
[IEEE80211_BAND_2GHZ
].n_channels
,
588 priv
->bands
[IEEE80211_BAND_5GHZ
].n_channels
);
590 set_bit(STATUS_GEO_CONFIGURED
, &priv
->status
);
594 EXPORT_SYMBOL(iwlcore_init_geos
);
597 * iwlcore_free_geos - undo allocations in iwlcore_init_geos
599 void iwlcore_free_geos(struct iwl_priv
*priv
)
601 kfree(priv
->ieee_channels
);
602 kfree(priv
->ieee_rates
);
603 clear_bit(STATUS_GEO_CONFIGURED
, &priv
->status
);
605 EXPORT_SYMBOL(iwlcore_free_geos
);
607 static bool is_single_rx_stream(struct iwl_priv
*priv
)
609 return !priv
->current_ht_config
.is_ht
||
610 ((priv
->current_ht_config
.mcs
.rx_mask
[1] == 0) &&
611 (priv
->current_ht_config
.mcs
.rx_mask
[2] == 0));
614 static u8
iwl_is_channel_extension(struct iwl_priv
*priv
,
615 enum ieee80211_band band
,
616 u16 channel
, u8 extension_chan_offset
)
618 const struct iwl_channel_info
*ch_info
;
620 ch_info
= iwl_get_channel_info(priv
, band
, channel
);
621 if (!is_channel_valid(ch_info
))
624 if (extension_chan_offset
== IEEE80211_HT_PARAM_CHA_SEC_ABOVE
)
625 return !(ch_info
->ht40_extension_channel
&
626 IEEE80211_CHAN_NO_HT40PLUS
);
627 else if (extension_chan_offset
== IEEE80211_HT_PARAM_CHA_SEC_BELOW
)
628 return !(ch_info
->ht40_extension_channel
&
629 IEEE80211_CHAN_NO_HT40MINUS
);
634 u8
iwl_is_ht40_tx_allowed(struct iwl_priv
*priv
,
635 struct ieee80211_sta_ht_cap
*sta_ht_inf
)
637 struct iwl_ht_info
*iwl_ht_conf
= &priv
->current_ht_config
;
639 if ((!iwl_ht_conf
->is_ht
) ||
640 (iwl_ht_conf
->supported_chan_width
!= IWL_CHANNEL_WIDTH_40MHZ
))
643 /* We do not check for IEEE80211_HT_CAP_SUP_WIDTH_20_40
644 * the bit will not set if it is pure 40MHz case
647 if (!sta_ht_inf
->ht_supported
)
650 #ifdef CONFIG_IWLWIFI_DEBUG
651 if (priv
->disable_ht40
)
654 return iwl_is_channel_extension(priv
, priv
->band
,
655 le16_to_cpu(priv
->staging_rxon
.channel
),
656 iwl_ht_conf
->extension_chan_offset
);
658 EXPORT_SYMBOL(iwl_is_ht40_tx_allowed
);
660 static u16
iwl_adjust_beacon_interval(u16 beacon_val
, u16 max_beacon_val
)
663 u16 beacon_factor
= 0;
665 beacon_factor
= (beacon_val
+ max_beacon_val
) / max_beacon_val
;
666 new_val
= beacon_val
/ beacon_factor
;
669 new_val
= max_beacon_val
;
674 void iwl_setup_rxon_timing(struct iwl_priv
*priv
)
677 s32 interval_tm
, rem
;
679 struct ieee80211_conf
*conf
= NULL
;
682 conf
= ieee80211_get_hw_conf(priv
->hw
);
684 spin_lock_irqsave(&priv
->lock
, flags
);
685 priv
->rxon_timing
.timestamp
= cpu_to_le64(priv
->timestamp
);
686 priv
->rxon_timing
.listen_interval
= cpu_to_le16(conf
->listen_interval
);
688 if (priv
->iw_mode
== NL80211_IFTYPE_STATION
) {
689 beacon_int
= priv
->beacon_int
;
690 priv
->rxon_timing
.atim_window
= 0;
692 beacon_int
= priv
->vif
->bss_conf
.beacon_int
;
694 /* TODO: we need to get atim_window from upper stack
695 * for now we set to 0 */
696 priv
->rxon_timing
.atim_window
= 0;
699 beacon_int
= iwl_adjust_beacon_interval(beacon_int
,
700 priv
->hw_params
.max_beacon_itrvl
* 1024);
701 priv
->rxon_timing
.beacon_interval
= cpu_to_le16(beacon_int
);
703 tsf
= priv
->timestamp
; /* tsf is modifed by do_div: copy it */
704 interval_tm
= beacon_int
* 1024;
705 rem
= do_div(tsf
, interval_tm
);
706 priv
->rxon_timing
.beacon_init_val
= cpu_to_le32(interval_tm
- rem
);
708 spin_unlock_irqrestore(&priv
->lock
, flags
);
709 IWL_DEBUG_ASSOC(priv
,
710 "beacon interval %d beacon timer %d beacon tim %d\n",
711 le16_to_cpu(priv
->rxon_timing
.beacon_interval
),
712 le32_to_cpu(priv
->rxon_timing
.beacon_init_val
),
713 le16_to_cpu(priv
->rxon_timing
.atim_window
));
715 EXPORT_SYMBOL(iwl_setup_rxon_timing
);
717 void iwl_set_rxon_hwcrypto(struct iwl_priv
*priv
, int hw_decrypt
)
719 struct iwl_rxon_cmd
*rxon
= &priv
->staging_rxon
;
722 rxon
->filter_flags
&= ~RXON_FILTER_DIS_DECRYPT_MSK
;
724 rxon
->filter_flags
|= RXON_FILTER_DIS_DECRYPT_MSK
;
727 EXPORT_SYMBOL(iwl_set_rxon_hwcrypto
);
730 * iwl_check_rxon_cmd - validate RXON structure is valid
732 * NOTE: This is really only useful during development and can eventually
733 * be #ifdef'd out once the driver is stable and folks aren't actively
736 int iwl_check_rxon_cmd(struct iwl_priv
*priv
)
740 struct iwl_rxon_cmd
*rxon
= &priv
->staging_rxon
;
742 if (rxon
->flags
& RXON_FLG_BAND_24G_MSK
) {
743 error
|= le32_to_cpu(rxon
->flags
&
744 (RXON_FLG_TGJ_NARROW_BAND_MSK
|
745 RXON_FLG_RADAR_DETECT_MSK
));
747 IWL_WARN(priv
, "check 24G fields %d | %d\n",
750 error
|= (rxon
->flags
& RXON_FLG_SHORT_SLOT_MSK
) ?
751 0 : le32_to_cpu(RXON_FLG_SHORT_SLOT_MSK
);
753 IWL_WARN(priv
, "check 52 fields %d | %d\n",
755 error
|= le32_to_cpu(rxon
->flags
& RXON_FLG_CCK_MSK
);
757 IWL_WARN(priv
, "check 52 CCK %d | %d\n",
760 error
|= (rxon
->node_addr
[0] | rxon
->bssid_addr
[0]) & 0x1;
762 IWL_WARN(priv
, "check mac addr %d | %d\n", counter
++, error
);
764 /* make sure basic rates 6Mbps and 1Mbps are supported */
765 error
|= (((rxon
->ofdm_basic_rates
& IWL_RATE_6M_MASK
) == 0) &&
766 ((rxon
->cck_basic_rates
& IWL_RATE_1M_MASK
) == 0));
768 IWL_WARN(priv
, "check basic rate %d | %d\n", counter
++, error
);
770 error
|= (le16_to_cpu(rxon
->assoc_id
) > 2007);
772 IWL_WARN(priv
, "check assoc id %d | %d\n", counter
++, error
);
774 error
|= ((rxon
->flags
& (RXON_FLG_CCK_MSK
| RXON_FLG_SHORT_SLOT_MSK
))
775 == (RXON_FLG_CCK_MSK
| RXON_FLG_SHORT_SLOT_MSK
));
777 IWL_WARN(priv
, "check CCK and short slot %d | %d\n",
780 error
|= ((rxon
->flags
& (RXON_FLG_CCK_MSK
| RXON_FLG_AUTO_DETECT_MSK
))
781 == (RXON_FLG_CCK_MSK
| RXON_FLG_AUTO_DETECT_MSK
));
783 IWL_WARN(priv
, "check CCK & auto detect %d | %d\n",
786 error
|= ((rxon
->flags
& (RXON_FLG_AUTO_DETECT_MSK
|
787 RXON_FLG_TGG_PROTECT_MSK
)) == RXON_FLG_TGG_PROTECT_MSK
);
789 IWL_WARN(priv
, "check TGG and auto detect %d | %d\n",
793 IWL_WARN(priv
, "Tuning to channel %d\n",
794 le16_to_cpu(rxon
->channel
));
797 IWL_ERR(priv
, "Not a valid iwl_rxon_assoc_cmd field values\n");
802 EXPORT_SYMBOL(iwl_check_rxon_cmd
);
805 * iwl_full_rxon_required - check if full RXON (vs RXON_ASSOC) cmd is needed
806 * @priv: staging_rxon is compared to active_rxon
808 * If the RXON structure is changing enough to require a new tune,
809 * or is clearing the RXON_FILTER_ASSOC_MSK, then return 1 to indicate that
810 * a new tune (full RXON command, rather than RXON_ASSOC cmd) is required.
812 int iwl_full_rxon_required(struct iwl_priv
*priv
)
815 /* These items are only settable from the full RXON command */
816 if (!(iwl_is_associated(priv
)) ||
817 compare_ether_addr(priv
->staging_rxon
.bssid_addr
,
818 priv
->active_rxon
.bssid_addr
) ||
819 compare_ether_addr(priv
->staging_rxon
.node_addr
,
820 priv
->active_rxon
.node_addr
) ||
821 compare_ether_addr(priv
->staging_rxon
.wlap_bssid_addr
,
822 priv
->active_rxon
.wlap_bssid_addr
) ||
823 (priv
->staging_rxon
.dev_type
!= priv
->active_rxon
.dev_type
) ||
824 (priv
->staging_rxon
.channel
!= priv
->active_rxon
.channel
) ||
825 (priv
->staging_rxon
.air_propagation
!=
826 priv
->active_rxon
.air_propagation
) ||
827 (priv
->staging_rxon
.ofdm_ht_single_stream_basic_rates
!=
828 priv
->active_rxon
.ofdm_ht_single_stream_basic_rates
) ||
829 (priv
->staging_rxon
.ofdm_ht_dual_stream_basic_rates
!=
830 priv
->active_rxon
.ofdm_ht_dual_stream_basic_rates
) ||
831 (priv
->staging_rxon
.ofdm_ht_triple_stream_basic_rates
!=
832 priv
->active_rxon
.ofdm_ht_triple_stream_basic_rates
) ||
833 (priv
->staging_rxon
.assoc_id
!= priv
->active_rxon
.assoc_id
))
836 /* flags, filter_flags, ofdm_basic_rates, and cck_basic_rates can
837 * be updated with the RXON_ASSOC command -- however only some
838 * flag transitions are allowed using RXON_ASSOC */
840 /* Check if we are not switching bands */
841 if ((priv
->staging_rxon
.flags
& RXON_FLG_BAND_24G_MSK
) !=
842 (priv
->active_rxon
.flags
& RXON_FLG_BAND_24G_MSK
))
845 /* Check if we are switching association toggle */
846 if ((priv
->staging_rxon
.filter_flags
& RXON_FILTER_ASSOC_MSK
) !=
847 (priv
->active_rxon
.filter_flags
& RXON_FILTER_ASSOC_MSK
))
852 EXPORT_SYMBOL(iwl_full_rxon_required
);
854 u8
iwl_rate_get_lowest_plcp(struct iwl_priv
*priv
)
860 if (priv
->staging_rxon
.flags
& RXON_FLG_BAND_24G_MSK
)
861 rate_mask
= priv
->active_rate_basic
& IWL_CCK_RATES_MASK
;
863 rate_mask
= priv
->active_rate_basic
& IWL_OFDM_RATES_MASK
;
865 /* Find lowest valid rate */
866 for (i
= IWL_RATE_1M_INDEX
; i
!= IWL_RATE_INVALID
;
867 i
= iwl_rates
[i
].next_ieee
) {
868 if (rate_mask
& (1 << i
))
869 return iwl_rates
[i
].plcp
;
872 /* No valid rate was found. Assign the lowest one */
873 if (priv
->staging_rxon
.flags
& RXON_FLG_BAND_24G_MSK
)
874 return IWL_RATE_1M_PLCP
;
876 return IWL_RATE_6M_PLCP
;
878 EXPORT_SYMBOL(iwl_rate_get_lowest_plcp
);
880 void iwl_set_rxon_ht(struct iwl_priv
*priv
, struct iwl_ht_info
*ht_info
)
882 struct iwl_rxon_cmd
*rxon
= &priv
->staging_rxon
;
884 if (!ht_info
->is_ht
) {
885 rxon
->flags
&= ~(RXON_FLG_CHANNEL_MODE_MSK
|
886 RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK
|
887 RXON_FLG_HT40_PROT_MSK
|
888 RXON_FLG_HT_PROT_MSK
);
892 /* FIXME: if the definition of ht_protection changed, the "translation"
893 * will be needed for rxon->flags
895 rxon
->flags
|= cpu_to_le32(ht_info
->ht_protection
<< RXON_FLG_HT_OPERATING_MODE_POS
);
897 /* Set up channel bandwidth:
898 * 20 MHz only, 20/40 mixed or pure 40 if ht40 ok */
899 /* clear the HT channel mode before set the mode */
900 rxon
->flags
&= ~(RXON_FLG_CHANNEL_MODE_MSK
|
901 RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK
);
902 if (iwl_is_ht40_tx_allowed(priv
, NULL
)) {
904 if (ht_info
->ht_protection
== IEEE80211_HT_OP_MODE_PROTECTION_20MHZ
) {
905 rxon
->flags
|= RXON_FLG_CHANNEL_MODE_PURE_40
;
906 /* Note: control channel is opposite of extension channel */
907 switch (ht_info
->extension_chan_offset
) {
908 case IEEE80211_HT_PARAM_CHA_SEC_ABOVE
:
909 rxon
->flags
&= ~RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK
;
911 case IEEE80211_HT_PARAM_CHA_SEC_BELOW
:
912 rxon
->flags
|= RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK
;
916 /* Note: control channel is opposite of extension channel */
917 switch (ht_info
->extension_chan_offset
) {
918 case IEEE80211_HT_PARAM_CHA_SEC_ABOVE
:
919 rxon
->flags
&= ~(RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK
);
920 rxon
->flags
|= RXON_FLG_CHANNEL_MODE_MIXED
;
922 case IEEE80211_HT_PARAM_CHA_SEC_BELOW
:
923 rxon
->flags
|= RXON_FLG_CTRL_CHANNEL_LOC_HI_MSK
;
924 rxon
->flags
|= RXON_FLG_CHANNEL_MODE_MIXED
;
926 case IEEE80211_HT_PARAM_CHA_SEC_NONE
:
928 /* channel location only valid if in Mixed mode */
929 IWL_ERR(priv
, "invalid extension channel offset\n");
934 rxon
->flags
|= RXON_FLG_CHANNEL_MODE_LEGACY
;
937 if (priv
->cfg
->ops
->hcmd
->set_rxon_chain
)
938 priv
->cfg
->ops
->hcmd
->set_rxon_chain(priv
);
940 IWL_DEBUG_ASSOC(priv
, "supported HT rate 0x%X 0x%X 0x%X "
941 "rxon flags 0x%X operation mode :0x%X "
942 "extension channel offset 0x%x\n",
943 ht_info
->mcs
.rx_mask
[0],
944 ht_info
->mcs
.rx_mask
[1],
945 ht_info
->mcs
.rx_mask
[2],
946 le32_to_cpu(rxon
->flags
), ht_info
->ht_protection
,
947 ht_info
->extension_chan_offset
);
950 EXPORT_SYMBOL(iwl_set_rxon_ht
);
952 #define IWL_NUM_RX_CHAINS_MULTIPLE 3
953 #define IWL_NUM_RX_CHAINS_SINGLE 2
954 #define IWL_NUM_IDLE_CHAINS_DUAL 2
955 #define IWL_NUM_IDLE_CHAINS_SINGLE 1
957 /* Determine how many receiver/antenna chains to use.
958 * More provides better reception via diversity. Fewer saves power.
959 * MIMO (dual stream) requires at least 2, but works better with 3.
960 * This does not determine *which* chains to use, just how many.
962 static int iwl_get_active_rx_chain_count(struct iwl_priv
*priv
)
964 bool is_single
= is_single_rx_stream(priv
);
965 bool is_cam
= !test_bit(STATUS_POWER_PMI
, &priv
->status
);
967 /* # of Rx chains to use when expecting MIMO. */
968 if (is_single
|| (!is_cam
&& (priv
->current_ht_config
.sm_ps
==
969 WLAN_HT_CAP_SM_PS_STATIC
)))
970 return IWL_NUM_RX_CHAINS_SINGLE
;
972 return IWL_NUM_RX_CHAINS_MULTIPLE
;
975 static int iwl_get_idle_rx_chain_count(struct iwl_priv
*priv
, int active_cnt
)
978 bool is_cam
= !test_bit(STATUS_POWER_PMI
, &priv
->status
);
979 /* # Rx chains when idling and maybe trying to save power */
980 switch (priv
->current_ht_config
.sm_ps
) {
981 case WLAN_HT_CAP_SM_PS_STATIC
:
982 case WLAN_HT_CAP_SM_PS_DYNAMIC
:
983 idle_cnt
= (is_cam
) ? IWL_NUM_IDLE_CHAINS_DUAL
:
984 IWL_NUM_IDLE_CHAINS_SINGLE
;
986 case WLAN_HT_CAP_SM_PS_DISABLED
:
987 idle_cnt
= (is_cam
) ? active_cnt
: IWL_NUM_IDLE_CHAINS_SINGLE
;
989 case WLAN_HT_CAP_SM_PS_INVALID
:
991 IWL_ERR(priv
, "invalid mimo ps mode %d\n",
992 priv
->current_ht_config
.sm_ps
);
1000 /* up to 4 chains */
1001 static u8
iwl_count_chain_bitmap(u32 chain_bitmap
)
1004 res
= (chain_bitmap
& BIT(0)) >> 0;
1005 res
+= (chain_bitmap
& BIT(1)) >> 1;
1006 res
+= (chain_bitmap
& BIT(2)) >> 2;
1007 res
+= (chain_bitmap
& BIT(4)) >> 4;
1012 * iwl_is_monitor_mode - Determine if interface in monitor mode
1014 * priv->iw_mode is set in add_interface, but add_interface is
1015 * never called for monitor mode. The only way mac80211 informs us about
1016 * monitor mode is through configuring filters (call to configure_filter).
1018 bool iwl_is_monitor_mode(struct iwl_priv
*priv
)
1020 return !!(priv
->staging_rxon
.filter_flags
& RXON_FILTER_PROMISC_MSK
);
1022 EXPORT_SYMBOL(iwl_is_monitor_mode
);
1025 * iwl_set_rxon_chain - Set up Rx chain usage in "staging" RXON image
1027 * Selects how many and which Rx receivers/antennas/chains to use.
1028 * This should not be used for scan command ... it puts data in wrong place.
1030 void iwl_set_rxon_chain(struct iwl_priv
*priv
)
1032 bool is_single
= is_single_rx_stream(priv
);
1033 bool is_cam
= !test_bit(STATUS_POWER_PMI
, &priv
->status
);
1034 u8 idle_rx_cnt
, active_rx_cnt
, valid_rx_cnt
;
1038 /* Tell uCode which antennas are actually connected.
1039 * Before first association, we assume all antennas are connected.
1040 * Just after first association, iwl_chain_noise_calibration()
1041 * checks which antennas actually *are* connected. */
1042 if (priv
->chain_noise_data
.active_chains
)
1043 active_chains
= priv
->chain_noise_data
.active_chains
;
1045 active_chains
= priv
->hw_params
.valid_rx_ant
;
1047 rx_chain
= active_chains
<< RXON_RX_CHAIN_VALID_POS
;
1049 /* How many receivers should we use? */
1050 active_rx_cnt
= iwl_get_active_rx_chain_count(priv
);
1051 idle_rx_cnt
= iwl_get_idle_rx_chain_count(priv
, active_rx_cnt
);
1054 /* correct rx chain count according hw settings
1055 * and chain noise calibration
1057 valid_rx_cnt
= iwl_count_chain_bitmap(active_chains
);
1058 if (valid_rx_cnt
< active_rx_cnt
)
1059 active_rx_cnt
= valid_rx_cnt
;
1061 if (valid_rx_cnt
< idle_rx_cnt
)
1062 idle_rx_cnt
= valid_rx_cnt
;
1064 rx_chain
|= active_rx_cnt
<< RXON_RX_CHAIN_MIMO_CNT_POS
;
1065 rx_chain
|= idle_rx_cnt
<< RXON_RX_CHAIN_CNT_POS
;
1067 /* copied from 'iwl_bg_request_scan()' */
1068 /* Force use of chains B and C (0x6) for Rx for 4965
1069 * Avoid A (0x1) because of its off-channel reception on A-band.
1070 * MIMO is not used here, but value is required */
1071 if (iwl_is_monitor_mode(priv
) &&
1072 !(priv
->staging_rxon
.flags
& RXON_FLG_BAND_24G_MSK
) &&
1073 ((priv
->hw_rev
& CSR_HW_REV_TYPE_MSK
) == CSR_HW_REV_TYPE_4965
)) {
1074 rx_chain
= ANT_ABC
<< RXON_RX_CHAIN_VALID_POS
;
1075 rx_chain
|= ANT_BC
<< RXON_RX_CHAIN_FORCE_SEL_POS
;
1076 rx_chain
|= ANT_ABC
<< RXON_RX_CHAIN_FORCE_MIMO_SEL_POS
;
1077 rx_chain
|= 0x1 << RXON_RX_CHAIN_DRIVER_FORCE_POS
;
1080 priv
->staging_rxon
.rx_chain
= cpu_to_le16(rx_chain
);
1082 if (!is_single
&& (active_rx_cnt
>= IWL_NUM_RX_CHAINS_SINGLE
) && is_cam
)
1083 priv
->staging_rxon
.rx_chain
|= RXON_RX_CHAIN_MIMO_FORCE_MSK
;
1085 priv
->staging_rxon
.rx_chain
&= ~RXON_RX_CHAIN_MIMO_FORCE_MSK
;
1087 IWL_DEBUG_ASSOC(priv
, "rx_chain=0x%X active=%d idle=%d\n",
1088 priv
->staging_rxon
.rx_chain
,
1089 active_rx_cnt
, idle_rx_cnt
);
1091 WARN_ON(active_rx_cnt
== 0 || idle_rx_cnt
== 0 ||
1092 active_rx_cnt
< idle_rx_cnt
);
1094 EXPORT_SYMBOL(iwl_set_rxon_chain
);
1097 * iwl_set_rxon_channel - Set the phymode and channel values in staging RXON
1098 * @phymode: MODE_IEEE80211A sets to 5.2GHz; all else set to 2.4GHz
1099 * @channel: Any channel valid for the requested phymode
1101 * In addition to setting the staging RXON, priv->phymode is also set.
1103 * NOTE: Does not commit to the hardware; it sets appropriate bit fields
1104 * in the staging RXON flag structure based on the phymode
1106 int iwl_set_rxon_channel(struct iwl_priv
*priv
, struct ieee80211_channel
*ch
)
1108 enum ieee80211_band band
= ch
->band
;
1109 u16 channel
= ieee80211_frequency_to_channel(ch
->center_freq
);
1111 if (!iwl_get_channel_info(priv
, band
, channel
)) {
1112 IWL_DEBUG_INFO(priv
, "Could not set channel to %d [%d]\n",
1117 if ((le16_to_cpu(priv
->staging_rxon
.channel
) == channel
) &&
1118 (priv
->band
== band
))
1121 priv
->staging_rxon
.channel
= cpu_to_le16(channel
);
1122 if (band
== IEEE80211_BAND_5GHZ
)
1123 priv
->staging_rxon
.flags
&= ~RXON_FLG_BAND_24G_MSK
;
1125 priv
->staging_rxon
.flags
|= RXON_FLG_BAND_24G_MSK
;
1129 IWL_DEBUG_INFO(priv
, "Staging channel set to %d [%d]\n", channel
, band
);
1133 EXPORT_SYMBOL(iwl_set_rxon_channel
);
1135 void iwl_set_flags_for_band(struct iwl_priv
*priv
,
1136 enum ieee80211_band band
)
1138 if (band
== IEEE80211_BAND_5GHZ
) {
1139 priv
->staging_rxon
.flags
&=
1140 ~(RXON_FLG_BAND_24G_MSK
| RXON_FLG_AUTO_DETECT_MSK
1141 | RXON_FLG_CCK_MSK
);
1142 priv
->staging_rxon
.flags
|= RXON_FLG_SHORT_SLOT_MSK
;
1144 /* Copied from iwl_post_associate() */
1145 if (priv
->assoc_capability
& WLAN_CAPABILITY_SHORT_SLOT_TIME
)
1146 priv
->staging_rxon
.flags
|= RXON_FLG_SHORT_SLOT_MSK
;
1148 priv
->staging_rxon
.flags
&= ~RXON_FLG_SHORT_SLOT_MSK
;
1150 if (priv
->iw_mode
== NL80211_IFTYPE_ADHOC
)
1151 priv
->staging_rxon
.flags
&= ~RXON_FLG_SHORT_SLOT_MSK
;
1153 priv
->staging_rxon
.flags
|= RXON_FLG_BAND_24G_MSK
;
1154 priv
->staging_rxon
.flags
|= RXON_FLG_AUTO_DETECT_MSK
;
1155 priv
->staging_rxon
.flags
&= ~RXON_FLG_CCK_MSK
;
1160 * initialize rxon structure with default values from eeprom
1162 void iwl_connection_init_rx_config(struct iwl_priv
*priv
, int mode
)
1164 const struct iwl_channel_info
*ch_info
;
1166 memset(&priv
->staging_rxon
, 0, sizeof(priv
->staging_rxon
));
1169 case NL80211_IFTYPE_AP
:
1170 priv
->staging_rxon
.dev_type
= RXON_DEV_TYPE_AP
;
1173 case NL80211_IFTYPE_STATION
:
1174 priv
->staging_rxon
.dev_type
= RXON_DEV_TYPE_ESS
;
1175 priv
->staging_rxon
.filter_flags
= RXON_FILTER_ACCEPT_GRP_MSK
;
1178 case NL80211_IFTYPE_ADHOC
:
1179 priv
->staging_rxon
.dev_type
= RXON_DEV_TYPE_IBSS
;
1180 priv
->staging_rxon
.flags
= RXON_FLG_SHORT_PREAMBLE_MSK
;
1181 priv
->staging_rxon
.filter_flags
= RXON_FILTER_BCON_AWARE_MSK
|
1182 RXON_FILTER_ACCEPT_GRP_MSK
;
1186 IWL_ERR(priv
, "Unsupported interface type %d\n", mode
);
1191 /* TODO: Figure out when short_preamble would be set and cache from
1193 if (!hw_to_local(priv
->hw
)->short_preamble
)
1194 priv
->staging_rxon
.flags
&= ~RXON_FLG_SHORT_PREAMBLE_MSK
;
1196 priv
->staging_rxon
.flags
|= RXON_FLG_SHORT_PREAMBLE_MSK
;
1199 ch_info
= iwl_get_channel_info(priv
, priv
->band
,
1200 le16_to_cpu(priv
->active_rxon
.channel
));
1203 ch_info
= &priv
->channel_info
[0];
1206 * in some case A channels are all non IBSS
1207 * in this case force B/G channel
1209 if ((priv
->iw_mode
== NL80211_IFTYPE_ADHOC
) &&
1210 !(is_channel_ibss(ch_info
)))
1211 ch_info
= &priv
->channel_info
[0];
1213 priv
->staging_rxon
.channel
= cpu_to_le16(ch_info
->channel
);
1214 priv
->band
= ch_info
->band
;
1216 iwl_set_flags_for_band(priv
, priv
->band
);
1218 priv
->staging_rxon
.ofdm_basic_rates
=
1219 (IWL_OFDM_RATES_MASK
>> IWL_FIRST_OFDM_RATE
) & 0xFF;
1220 priv
->staging_rxon
.cck_basic_rates
=
1221 (IWL_CCK_RATES_MASK
>> IWL_FIRST_CCK_RATE
) & 0xF;
1223 /* clear both MIX and PURE40 mode flag */
1224 priv
->staging_rxon
.flags
&= ~(RXON_FLG_CHANNEL_MODE_MIXED
|
1225 RXON_FLG_CHANNEL_MODE_PURE_40
);
1226 memcpy(priv
->staging_rxon
.node_addr
, priv
->mac_addr
, ETH_ALEN
);
1227 memcpy(priv
->staging_rxon
.wlap_bssid_addr
, priv
->mac_addr
, ETH_ALEN
);
1228 priv
->staging_rxon
.ofdm_ht_single_stream_basic_rates
= 0xff;
1229 priv
->staging_rxon
.ofdm_ht_dual_stream_basic_rates
= 0xff;
1230 priv
->staging_rxon
.ofdm_ht_triple_stream_basic_rates
= 0xff;
1232 EXPORT_SYMBOL(iwl_connection_init_rx_config
);
1234 static void iwl_set_rate(struct iwl_priv
*priv
)
1236 const struct ieee80211_supported_band
*hw
= NULL
;
1237 struct ieee80211_rate
*rate
;
1240 hw
= iwl_get_hw_mode(priv
, priv
->band
);
1242 IWL_ERR(priv
, "Failed to set rate: unable to get hw mode\n");
1246 priv
->active_rate
= 0;
1247 priv
->active_rate_basic
= 0;
1249 for (i
= 0; i
< hw
->n_bitrates
; i
++) {
1250 rate
= &(hw
->bitrates
[i
]);
1251 if (rate
->hw_value
< IWL_RATE_COUNT_LEGACY
)
1252 priv
->active_rate
|= (1 << rate
->hw_value
);
1255 IWL_DEBUG_RATE(priv
, "Set active_rate = %0x, active_rate_basic = %0x\n",
1256 priv
->active_rate
, priv
->active_rate_basic
);
1259 * If a basic rate is configured, then use it (adding IWL_RATE_1M_MASK)
1260 * otherwise set it to the default of all CCK rates and 6, 12, 24 for
1263 if (priv
->active_rate_basic
& IWL_CCK_BASIC_RATES_MASK
)
1264 priv
->staging_rxon
.cck_basic_rates
=
1265 ((priv
->active_rate_basic
&
1266 IWL_CCK_RATES_MASK
) >> IWL_FIRST_CCK_RATE
) & 0xF;
1268 priv
->staging_rxon
.cck_basic_rates
=
1269 (IWL_CCK_BASIC_RATES_MASK
>> IWL_FIRST_CCK_RATE
) & 0xF;
1271 if (priv
->active_rate_basic
& IWL_OFDM_BASIC_RATES_MASK
)
1272 priv
->staging_rxon
.ofdm_basic_rates
=
1273 ((priv
->active_rate_basic
&
1274 (IWL_OFDM_BASIC_RATES_MASK
| IWL_RATE_6M_MASK
)) >>
1275 IWL_FIRST_OFDM_RATE
) & 0xFF;
1277 priv
->staging_rxon
.ofdm_basic_rates
=
1278 (IWL_OFDM_BASIC_RATES_MASK
>> IWL_FIRST_OFDM_RATE
) & 0xFF;
1281 void iwl_rx_csa(struct iwl_priv
*priv
, struct iwl_rx_mem_buffer
*rxb
)
1283 struct iwl_rx_packet
*pkt
= (struct iwl_rx_packet
*)rxb
->skb
->data
;
1284 struct iwl_rxon_cmd
*rxon
= (void *)&priv
->active_rxon
;
1285 struct iwl_csa_notification
*csa
= &(pkt
->u
.csa_notif
);
1286 IWL_DEBUG_11H(priv
, "CSA notif: channel %d, status %d\n",
1287 le16_to_cpu(csa
->channel
), le32_to_cpu(csa
->status
));
1288 rxon
->channel
= csa
->channel
;
1289 priv
->staging_rxon
.channel
= csa
->channel
;
1291 EXPORT_SYMBOL(iwl_rx_csa
);
1293 #ifdef CONFIG_IWLWIFI_DEBUG
1294 static void iwl_print_rx_config_cmd(struct iwl_priv
*priv
)
1296 struct iwl_rxon_cmd
*rxon
= &priv
->staging_rxon
;
1298 IWL_DEBUG_RADIO(priv
, "RX CONFIG:\n");
1299 iwl_print_hex_dump(priv
, IWL_DL_RADIO
, (u8
*) rxon
, sizeof(*rxon
));
1300 IWL_DEBUG_RADIO(priv
, "u16 channel: 0x%x\n", le16_to_cpu(rxon
->channel
));
1301 IWL_DEBUG_RADIO(priv
, "u32 flags: 0x%08X\n", le32_to_cpu(rxon
->flags
));
1302 IWL_DEBUG_RADIO(priv
, "u32 filter_flags: 0x%08x\n",
1303 le32_to_cpu(rxon
->filter_flags
));
1304 IWL_DEBUG_RADIO(priv
, "u8 dev_type: 0x%x\n", rxon
->dev_type
);
1305 IWL_DEBUG_RADIO(priv
, "u8 ofdm_basic_rates: 0x%02x\n",
1306 rxon
->ofdm_basic_rates
);
1307 IWL_DEBUG_RADIO(priv
, "u8 cck_basic_rates: 0x%02x\n", rxon
->cck_basic_rates
);
1308 IWL_DEBUG_RADIO(priv
, "u8[6] node_addr: %pM\n", rxon
->node_addr
);
1309 IWL_DEBUG_RADIO(priv
, "u8[6] bssid_addr: %pM\n", rxon
->bssid_addr
);
1310 IWL_DEBUG_RADIO(priv
, "u16 assoc_id: 0x%x\n", le16_to_cpu(rxon
->assoc_id
));
1314 * iwl_irq_handle_error - called for HW or SW error interrupt from card
1316 void iwl_irq_handle_error(struct iwl_priv
*priv
)
1318 /* Set the FW error flag -- cleared on iwl_down */
1319 set_bit(STATUS_FW_ERROR
, &priv
->status
);
1321 /* Cancel currently queued command. */
1322 clear_bit(STATUS_HCMD_ACTIVE
, &priv
->status
);
1324 #ifdef CONFIG_IWLWIFI_DEBUG
1325 if (iwl_get_debug_level(priv
) & IWL_DL_FW_ERRORS
) {
1326 priv
->cfg
->ops
->lib
->dump_nic_error_log(priv
);
1327 priv
->cfg
->ops
->lib
->dump_nic_event_log(priv
);
1328 iwl_print_rx_config_cmd(priv
);
1332 wake_up_interruptible(&priv
->wait_command_queue
);
1334 /* Keep the restart process from trying to send host
1335 * commands by clearing the INIT status bit */
1336 clear_bit(STATUS_READY
, &priv
->status
);
1338 if (!test_bit(STATUS_EXIT_PENDING
, &priv
->status
)) {
1339 IWL_DEBUG(priv
, IWL_DL_FW_ERRORS
,
1340 "Restarting adapter due to uCode error.\n");
1342 if (priv
->cfg
->mod_params
->restart_fw
)
1343 queue_work(priv
->workqueue
, &priv
->restart
);
1346 EXPORT_SYMBOL(iwl_irq_handle_error
);
1348 void iwl_configure_filter(struct ieee80211_hw
*hw
,
1349 unsigned int changed_flags
,
1350 unsigned int *total_flags
,
1353 struct iwl_priv
*priv
= hw
->priv
;
1354 __le32
*filter_flags
= &priv
->staging_rxon
.filter_flags
;
1356 IWL_DEBUG_MAC80211(priv
, "Enter: changed: 0x%x, total: 0x%x\n",
1357 changed_flags
, *total_flags
);
1359 if (changed_flags
& (FIF_OTHER_BSS
| FIF_PROMISC_IN_BSS
)) {
1360 if (*total_flags
& (FIF_OTHER_BSS
| FIF_PROMISC_IN_BSS
))
1361 *filter_flags
|= RXON_FILTER_PROMISC_MSK
;
1363 *filter_flags
&= ~RXON_FILTER_PROMISC_MSK
;
1365 if (changed_flags
& FIF_ALLMULTI
) {
1366 if (*total_flags
& FIF_ALLMULTI
)
1367 *filter_flags
|= RXON_FILTER_ACCEPT_GRP_MSK
;
1369 *filter_flags
&= ~RXON_FILTER_ACCEPT_GRP_MSK
;
1371 if (changed_flags
& FIF_CONTROL
) {
1372 if (*total_flags
& FIF_CONTROL
)
1373 *filter_flags
|= RXON_FILTER_CTL2HOST_MSK
;
1375 *filter_flags
&= ~RXON_FILTER_CTL2HOST_MSK
;
1377 if (changed_flags
& FIF_BCN_PRBRESP_PROMISC
) {
1378 if (*total_flags
& FIF_BCN_PRBRESP_PROMISC
)
1379 *filter_flags
|= RXON_FILTER_BCON_AWARE_MSK
;
1381 *filter_flags
&= ~RXON_FILTER_BCON_AWARE_MSK
;
1384 /* We avoid iwl_commit_rxon here to commit the new filter flags
1385 * since mac80211 will call ieee80211_hw_config immediately.
1386 * (mc_list is not supported at this time). Otherwise, we need to
1387 * queue a background iwl_commit_rxon work.
1390 *total_flags
&= FIF_OTHER_BSS
| FIF_ALLMULTI
| FIF_PROMISC_IN_BSS
|
1391 FIF_BCN_PRBRESP_PROMISC
| FIF_CONTROL
;
1393 EXPORT_SYMBOL(iwl_configure_filter
);
1395 int iwl_setup_mac(struct iwl_priv
*priv
)
1398 struct ieee80211_hw
*hw
= priv
->hw
;
1399 hw
->rate_control_algorithm
= "iwl-agn-rs";
1401 /* Tell mac80211 our characteristics */
1402 hw
->flags
= IEEE80211_HW_SIGNAL_DBM
|
1403 IEEE80211_HW_NOISE_DBM
|
1404 IEEE80211_HW_AMPDU_AGGREGATION
|
1405 IEEE80211_HW_SPECTRUM_MGMT
;
1407 if (!priv
->cfg
->broken_powersave
)
1408 hw
->flags
|= IEEE80211_HW_SUPPORTS_PS
|
1409 IEEE80211_HW_SUPPORTS_DYNAMIC_PS
;
1411 hw
->wiphy
->interface_modes
=
1412 BIT(NL80211_IFTYPE_STATION
) |
1413 BIT(NL80211_IFTYPE_ADHOC
);
1415 hw
->wiphy
->custom_regulatory
= true;
1417 /* Firmware does not support this */
1418 hw
->wiphy
->disable_beacon_hints
= true;
1421 * For now, disable PS by default because it affects
1422 * RX performance significantly.
1424 hw
->wiphy
->ps_default
= false;
1426 hw
->wiphy
->max_scan_ssids
= PROBE_OPTION_MAX
;
1427 /* we create the 802.11 header and a zero-length SSID element */
1428 hw
->wiphy
->max_scan_ie_len
= IWL_MAX_PROBE_REQUEST
- 24 - 2;
1430 /* Default value; 4 EDCA QOS priorities */
1433 hw
->max_listen_interval
= IWL_CONN_MAX_LISTEN_INTERVAL
;
1435 if (priv
->bands
[IEEE80211_BAND_2GHZ
].n_channels
)
1436 priv
->hw
->wiphy
->bands
[IEEE80211_BAND_2GHZ
] =
1437 &priv
->bands
[IEEE80211_BAND_2GHZ
];
1438 if (priv
->bands
[IEEE80211_BAND_5GHZ
].n_channels
)
1439 priv
->hw
->wiphy
->bands
[IEEE80211_BAND_5GHZ
] =
1440 &priv
->bands
[IEEE80211_BAND_5GHZ
];
1442 ret
= ieee80211_register_hw(priv
->hw
);
1444 IWL_ERR(priv
, "Failed to register hw (error %d)\n", ret
);
1447 priv
->mac80211_registered
= 1;
1451 EXPORT_SYMBOL(iwl_setup_mac
);
1453 int iwl_set_hw_params(struct iwl_priv
*priv
)
1455 priv
->hw_params
.max_rxq_size
= RX_QUEUE_SIZE
;
1456 priv
->hw_params
.max_rxq_log
= RX_QUEUE_SIZE_LOG
;
1457 if (priv
->cfg
->mod_params
->amsdu_size_8K
)
1458 priv
->hw_params
.rx_buf_size
= IWL_RX_BUF_SIZE_8K
;
1460 priv
->hw_params
.rx_buf_size
= IWL_RX_BUF_SIZE_4K
;
1461 priv
->hw_params
.max_pkt_size
= priv
->hw_params
.rx_buf_size
- 256;
1463 priv
->hw_params
.max_beacon_itrvl
= IWL_MAX_UCODE_BEACON_INTERVAL
;
1465 if (priv
->cfg
->mod_params
->disable_11n
)
1466 priv
->cfg
->sku
&= ~IWL_SKU_N
;
1468 /* Device-specific setup */
1469 return priv
->cfg
->ops
->lib
->set_hw_params(priv
);
1471 EXPORT_SYMBOL(iwl_set_hw_params
);
1473 int iwl_init_drv(struct iwl_priv
*priv
)
1477 priv
->ibss_beacon
= NULL
;
1479 spin_lock_init(&priv
->lock
);
1480 spin_lock_init(&priv
->sta_lock
);
1481 spin_lock_init(&priv
->hcmd_lock
);
1483 INIT_LIST_HEAD(&priv
->free_frames
);
1485 mutex_init(&priv
->mutex
);
1487 /* Clear the driver's (not device's) station table */
1488 iwl_clear_stations_table(priv
);
1490 priv
->data_retry_limit
= -1;
1491 priv
->ieee_channels
= NULL
;
1492 priv
->ieee_rates
= NULL
;
1493 priv
->band
= IEEE80211_BAND_2GHZ
;
1495 priv
->iw_mode
= NL80211_IFTYPE_STATION
;
1497 priv
->current_ht_config
.sm_ps
= WLAN_HT_CAP_SM_PS_DISABLED
;
1499 /* Choose which receivers/antennas to use */
1500 if (priv
->cfg
->ops
->hcmd
->set_rxon_chain
)
1501 priv
->cfg
->ops
->hcmd
->set_rxon_chain(priv
);
1503 iwl_init_scan_params(priv
);
1505 iwl_reset_qos(priv
);
1507 priv
->qos_data
.qos_active
= 0;
1508 priv
->qos_data
.qos_cap
.val
= 0;
1510 priv
->rates_mask
= IWL_RATES_MASK
;
1511 /* Set the tx_power_user_lmt to the lowest power level
1512 * this value will get overwritten by channel max power avg
1514 priv
->tx_power_user_lmt
= IWL_TX_POWER_TARGET_POWER_MIN
;
1516 ret
= iwl_init_channel_map(priv
);
1518 IWL_ERR(priv
, "initializing regulatory failed: %d\n", ret
);
1522 ret
= iwlcore_init_geos(priv
);
1524 IWL_ERR(priv
, "initializing geos failed: %d\n", ret
);
1525 goto err_free_channel_map
;
1527 iwlcore_init_hw_rates(priv
, priv
->ieee_rates
);
1531 err_free_channel_map
:
1532 iwl_free_channel_map(priv
);
1536 EXPORT_SYMBOL(iwl_init_drv
);
1538 int iwl_set_tx_power(struct iwl_priv
*priv
, s8 tx_power
, bool force
)
1541 s8 prev_tx_power
= priv
->tx_power_user_lmt
;
1543 if (tx_power
< IWL_TX_POWER_TARGET_POWER_MIN
) {
1544 IWL_WARN(priv
, "Requested user TXPOWER %d below lower limit %d.\n",
1546 IWL_TX_POWER_TARGET_POWER_MIN
);
1550 if (tx_power
> priv
->tx_power_device_lmt
) {
1552 "Requested user TXPOWER %d above upper limit %d.\n",
1553 tx_power
, priv
->tx_power_device_lmt
);
1557 if (priv
->tx_power_user_lmt
!= tx_power
)
1560 /* if nic is not up don't send command */
1561 if (iwl_is_ready_rf(priv
)) {
1562 priv
->tx_power_user_lmt
= tx_power
;
1563 if (force
&& priv
->cfg
->ops
->lib
->send_tx_power
)
1564 ret
= priv
->cfg
->ops
->lib
->send_tx_power(priv
);
1565 else if (!priv
->cfg
->ops
->lib
->send_tx_power
)
1568 * if fail to set tx_power, restore the orig. tx power
1571 priv
->tx_power_user_lmt
= prev_tx_power
;
1575 * Even this is an async host command, the command
1576 * will always report success from uCode
1577 * So once driver can placing the command into the queue
1578 * successfully, driver can use priv->tx_power_user_lmt
1579 * to reflect the current tx power
1583 EXPORT_SYMBOL(iwl_set_tx_power
);
1585 void iwl_uninit_drv(struct iwl_priv
*priv
)
1587 iwl_calib_free_results(priv
);
1588 iwlcore_free_geos(priv
);
1589 iwl_free_channel_map(priv
);
1592 EXPORT_SYMBOL(iwl_uninit_drv
);
1594 #define ICT_COUNT (PAGE_SIZE/sizeof(u32))
1596 /* Free dram table */
1597 void iwl_free_isr_ict(struct iwl_priv
*priv
)
1599 if (priv
->ict_tbl_vir
) {
1600 pci_free_consistent(priv
->pci_dev
, (sizeof(u32
) * ICT_COUNT
) +
1601 PAGE_SIZE
, priv
->ict_tbl_vir
,
1603 priv
->ict_tbl_vir
= NULL
;
1606 EXPORT_SYMBOL(iwl_free_isr_ict
);
1609 /* allocate dram shared table it is a PAGE_SIZE aligned
1610 * also reset all data related to ICT table interrupt.
1612 int iwl_alloc_isr_ict(struct iwl_priv
*priv
)
1615 if (priv
->cfg
->use_isr_legacy
)
1617 /* allocate shrared data table */
1618 priv
->ict_tbl_vir
= pci_alloc_consistent(priv
->pci_dev
, (sizeof(u32
) *
1619 ICT_COUNT
) + PAGE_SIZE
,
1620 &priv
->ict_tbl_dma
);
1621 if (!priv
->ict_tbl_vir
)
1624 /* align table to PAGE_SIZE boundry */
1625 priv
->aligned_ict_tbl_dma
= ALIGN(priv
->ict_tbl_dma
, PAGE_SIZE
);
1627 IWL_DEBUG_ISR(priv
, "ict dma addr %Lx dma aligned %Lx diff %d\n",
1628 (unsigned long long)priv
->ict_tbl_dma
,
1629 (unsigned long long)priv
->aligned_ict_tbl_dma
,
1630 (int)(priv
->aligned_ict_tbl_dma
- priv
->ict_tbl_dma
));
1632 priv
->ict_tbl
= priv
->ict_tbl_vir
+
1633 (priv
->aligned_ict_tbl_dma
- priv
->ict_tbl_dma
);
1635 IWL_DEBUG_ISR(priv
, "ict vir addr %p vir aligned %p diff %d\n",
1636 priv
->ict_tbl
, priv
->ict_tbl_vir
,
1637 (int)(priv
->aligned_ict_tbl_dma
- priv
->ict_tbl_dma
));
1639 /* reset table and index to all 0 */
1640 memset(priv
->ict_tbl_vir
,0, (sizeof(u32
) * ICT_COUNT
) + PAGE_SIZE
);
1641 priv
->ict_index
= 0;
1643 /* add periodic RX interrupt */
1644 priv
->inta_mask
|= CSR_INT_BIT_RX_PERIODIC
;
1647 EXPORT_SYMBOL(iwl_alloc_isr_ict
);
1649 /* Device is going up inform it about using ICT interrupt table,
1650 * also we need to tell the driver to start using ICT interrupt.
1652 int iwl_reset_ict(struct iwl_priv
*priv
)
1655 unsigned long flags
;
1657 if (!priv
->ict_tbl_vir
)
1660 spin_lock_irqsave(&priv
->lock
, flags
);
1661 iwl_disable_interrupts(priv
);
1663 memset(&priv
->ict_tbl
[0], 0, sizeof(u32
) * ICT_COUNT
);
1665 val
= priv
->aligned_ict_tbl_dma
>> PAGE_SHIFT
;
1667 val
|= CSR_DRAM_INT_TBL_ENABLE
;
1668 val
|= CSR_DRAM_INIT_TBL_WRAP_CHECK
;
1670 IWL_DEBUG_ISR(priv
, "CSR_DRAM_INT_TBL_REG =0x%X "
1671 "aligned dma address %Lx\n",
1672 val
, (unsigned long long)priv
->aligned_ict_tbl_dma
);
1674 iwl_write32(priv
, CSR_DRAM_INT_TBL_REG
, val
);
1675 priv
->use_ict
= true;
1676 priv
->ict_index
= 0;
1677 iwl_write32(priv
, CSR_INT
, priv
->inta_mask
);
1678 iwl_enable_interrupts(priv
);
1679 spin_unlock_irqrestore(&priv
->lock
, flags
);
1683 EXPORT_SYMBOL(iwl_reset_ict
);
1685 /* Device is going down disable ict interrupt usage */
1686 void iwl_disable_ict(struct iwl_priv
*priv
)
1688 unsigned long flags
;
1690 spin_lock_irqsave(&priv
->lock
, flags
);
1691 priv
->use_ict
= false;
1692 spin_unlock_irqrestore(&priv
->lock
, flags
);
1694 EXPORT_SYMBOL(iwl_disable_ict
);
1696 /* interrupt handler using ict table, with this interrupt driver will
1697 * stop using INTA register to get device's interrupt, reading this register
1698 * is expensive, device will write interrupts in ICT dram table, increment
1699 * index then will fire interrupt to driver, driver will OR all ICT table
1700 * entries from current index up to table entry with 0 value. the result is
1701 * the interrupt we need to service, driver will set the entries back to 0 and
1704 irqreturn_t
iwl_isr_ict(int irq
, void *data
)
1706 struct iwl_priv
*priv
= data
;
1707 u32 inta
, inta_mask
;
1713 /* dram interrupt table not set yet,
1714 * use legacy interrupt.
1717 return iwl_isr(irq
, data
);
1719 spin_lock(&priv
->lock
);
1721 /* Disable (but don't clear!) interrupts here to avoid
1722 * back-to-back ISRs and sporadic interrupts from our NIC.
1723 * If we have something to service, the tasklet will re-enable ints.
1724 * If we *don't* have something, we'll re-enable before leaving here.
1726 inta_mask
= iwl_read32(priv
, CSR_INT_MASK
); /* just for debug */
1727 iwl_write32(priv
, CSR_INT_MASK
, 0x00000000);
1730 /* Ignore interrupt if there's nothing in NIC to service.
1731 * This may be due to IRQ shared with another device,
1732 * or due to sporadic interrupts thrown from our NIC. */
1733 if (!priv
->ict_tbl
[priv
->ict_index
]) {
1734 IWL_DEBUG_ISR(priv
, "Ignore interrupt, inta == 0\n");
1738 /* read all entries that not 0 start with ict_index */
1739 while (priv
->ict_tbl
[priv
->ict_index
]) {
1741 val
|= le32_to_cpu(priv
->ict_tbl
[priv
->ict_index
]);
1742 IWL_DEBUG_ISR(priv
, "ICT index %d value 0x%08X\n",
1744 le32_to_cpu(priv
->ict_tbl
[priv
->ict_index
]));
1745 priv
->ict_tbl
[priv
->ict_index
] = 0;
1746 priv
->ict_index
= iwl_queue_inc_wrap(priv
->ict_index
,
1751 /* We should not get this value, just ignore it. */
1752 if (val
== 0xffffffff)
1755 inta
= (0xff & val
) | ((0xff00 & val
) << 16);
1756 IWL_DEBUG_ISR(priv
, "ISR inta 0x%08x, enabled 0x%08x ict 0x%08x\n",
1757 inta
, inta_mask
, val
);
1759 inta
&= priv
->inta_mask
;
1762 /* iwl_irq_tasklet() will service interrupts and re-enable them */
1764 tasklet_schedule(&priv
->irq_tasklet
);
1765 else if (test_bit(STATUS_INT_ENABLED
, &priv
->status
) && !priv
->inta
) {
1766 /* Allow interrupt if was disabled by this handler and
1767 * no tasklet was schedules, We should not enable interrupt,
1768 * tasklet will enable it.
1770 iwl_enable_interrupts(priv
);
1773 spin_unlock(&priv
->lock
);
1777 /* re-enable interrupts here since we don't have anything to service.
1778 * only Re-enable if disabled by irq.
1780 if (test_bit(STATUS_INT_ENABLED
, &priv
->status
) && !priv
->inta
)
1781 iwl_enable_interrupts(priv
);
1783 spin_unlock(&priv
->lock
);
1786 EXPORT_SYMBOL(iwl_isr_ict
);
1789 static irqreturn_t
iwl_isr(int irq
, void *data
)
1791 struct iwl_priv
*priv
= data
;
1792 u32 inta
, inta_mask
;
1793 #ifdef CONFIG_IWLWIFI_DEBUG
1799 spin_lock(&priv
->lock
);
1801 /* Disable (but don't clear!) interrupts here to avoid
1802 * back-to-back ISRs and sporadic interrupts from our NIC.
1803 * If we have something to service, the tasklet will re-enable ints.
1804 * If we *don't* have something, we'll re-enable before leaving here. */
1805 inta_mask
= iwl_read32(priv
, CSR_INT_MASK
); /* just for debug */
1806 iwl_write32(priv
, CSR_INT_MASK
, 0x00000000);
1808 /* Discover which interrupts are active/pending */
1809 inta
= iwl_read32(priv
, CSR_INT
);
1811 /* Ignore interrupt if there's nothing in NIC to service.
1812 * This may be due to IRQ shared with another device,
1813 * or due to sporadic interrupts thrown from our NIC. */
1815 IWL_DEBUG_ISR(priv
, "Ignore interrupt, inta == 0\n");
1819 if ((inta
== 0xFFFFFFFF) || ((inta
& 0xFFFFFFF0) == 0xa5a5a5a0)) {
1820 /* Hardware disappeared. It might have already raised
1822 IWL_WARN(priv
, "HARDWARE GONE?? INTA == 0x%08x\n", inta
);
1826 #ifdef CONFIG_IWLWIFI_DEBUG
1827 if (iwl_get_debug_level(priv
) & (IWL_DL_ISR
)) {
1828 inta_fh
= iwl_read32(priv
, CSR_FH_INT_STATUS
);
1829 IWL_DEBUG_ISR(priv
, "ISR inta 0x%08x, enabled 0x%08x, "
1830 "fh 0x%08x\n", inta
, inta_mask
, inta_fh
);
1835 /* iwl_irq_tasklet() will service interrupts and re-enable them */
1837 tasklet_schedule(&priv
->irq_tasklet
);
1838 else if (test_bit(STATUS_INT_ENABLED
, &priv
->status
) && !priv
->inta
)
1839 iwl_enable_interrupts(priv
);
1842 spin_unlock(&priv
->lock
);
1846 /* re-enable interrupts here since we don't have anything to service. */
1847 /* only Re-enable if diabled by irq and no schedules tasklet. */
1848 if (test_bit(STATUS_INT_ENABLED
, &priv
->status
) && !priv
->inta
)
1849 iwl_enable_interrupts(priv
);
1851 spin_unlock(&priv
->lock
);
1855 irqreturn_t
iwl_isr_legacy(int irq
, void *data
)
1857 struct iwl_priv
*priv
= data
;
1858 u32 inta
, inta_mask
;
1863 spin_lock(&priv
->lock
);
1865 /* Disable (but don't clear!) interrupts here to avoid
1866 * back-to-back ISRs and sporadic interrupts from our NIC.
1867 * If we have something to service, the tasklet will re-enable ints.
1868 * If we *don't* have something, we'll re-enable before leaving here. */
1869 inta_mask
= iwl_read32(priv
, CSR_INT_MASK
); /* just for debug */
1870 iwl_write32(priv
, CSR_INT_MASK
, 0x00000000);
1872 /* Discover which interrupts are active/pending */
1873 inta
= iwl_read32(priv
, CSR_INT
);
1874 inta_fh
= iwl_read32(priv
, CSR_FH_INT_STATUS
);
1876 /* Ignore interrupt if there's nothing in NIC to service.
1877 * This may be due to IRQ shared with another device,
1878 * or due to sporadic interrupts thrown from our NIC. */
1879 if (!inta
&& !inta_fh
) {
1880 IWL_DEBUG_ISR(priv
, "Ignore interrupt, inta == 0, inta_fh == 0\n");
1884 if ((inta
== 0xFFFFFFFF) || ((inta
& 0xFFFFFFF0) == 0xa5a5a5a0)) {
1885 /* Hardware disappeared. It might have already raised
1887 IWL_WARN(priv
, "HARDWARE GONE?? INTA == 0x%08x\n", inta
);
1891 IWL_DEBUG_ISR(priv
, "ISR inta 0x%08x, enabled 0x%08x, fh 0x%08x\n",
1892 inta
, inta_mask
, inta_fh
);
1894 inta
&= ~CSR_INT_BIT_SCD
;
1896 /* iwl_irq_tasklet() will service interrupts and re-enable them */
1897 if (likely(inta
|| inta_fh
))
1898 tasklet_schedule(&priv
->irq_tasklet
);
1901 spin_unlock(&priv
->lock
);
1905 /* re-enable interrupts here since we don't have anything to service. */
1906 /* only Re-enable if diabled by irq */
1907 if (test_bit(STATUS_INT_ENABLED
, &priv
->status
))
1908 iwl_enable_interrupts(priv
);
1909 spin_unlock(&priv
->lock
);
1912 EXPORT_SYMBOL(iwl_isr_legacy
);
1914 int iwl_send_bt_config(struct iwl_priv
*priv
)
1916 struct iwl_bt_cmd bt_cmd
= {
1924 return iwl_send_cmd_pdu(priv
, REPLY_BT_CONFIG
,
1925 sizeof(struct iwl_bt_cmd
), &bt_cmd
);
1927 EXPORT_SYMBOL(iwl_send_bt_config
);
1929 int iwl_send_statistics_request(struct iwl_priv
*priv
, u8 flags
)
1932 struct iwl_host_cmd cmd
= {
1933 .id
= REPLY_STATISTICS_CMD
,
1935 .len
= sizeof(stat_flags
),
1936 .data
= (u8
*) &stat_flags
,
1938 return iwl_send_cmd(priv
, &cmd
);
1940 EXPORT_SYMBOL(iwl_send_statistics_request
);
1943 * iwl_verify_inst_sparse - verify runtime uCode image in card vs. host,
1944 * using sample data 100 bytes apart. If these sample points are good,
1945 * it's a pretty good bet that everything between them is good, too.
1947 static int iwlcore_verify_inst_sparse(struct iwl_priv
*priv
, __le32
*image
, u32 len
)
1954 IWL_DEBUG_INFO(priv
, "ucode inst image size is %u\n", len
);
1956 for (i
= 0; i
< len
; i
+= 100, image
+= 100/sizeof(u32
)) {
1957 /* read data comes through single port, auto-incr addr */
1958 /* NOTE: Use the debugless read so we don't flood kernel log
1959 * if IWL_DL_IO is set */
1960 iwl_write_direct32(priv
, HBUS_TARG_MEM_RADDR
,
1961 i
+ IWL49_RTC_INST_LOWER_BOUND
);
1962 val
= _iwl_read_direct32(priv
, HBUS_TARG_MEM_RDAT
);
1963 if (val
!= le32_to_cpu(*image
)) {
1975 * iwlcore_verify_inst_full - verify runtime uCode image in card vs. host,
1976 * looking at all data.
1978 static int iwl_verify_inst_full(struct iwl_priv
*priv
, __le32
*image
,
1986 IWL_DEBUG_INFO(priv
, "ucode inst image size is %u\n", len
);
1988 iwl_write_direct32(priv
, HBUS_TARG_MEM_RADDR
,
1989 IWL49_RTC_INST_LOWER_BOUND
);
1992 for (; len
> 0; len
-= sizeof(u32
), image
++) {
1993 /* read data comes through single port, auto-incr addr */
1994 /* NOTE: Use the debugless read so we don't flood kernel log
1995 * if IWL_DL_IO is set */
1996 val
= _iwl_read_direct32(priv
, HBUS_TARG_MEM_RDAT
);
1997 if (val
!= le32_to_cpu(*image
)) {
1998 IWL_ERR(priv
, "uCode INST section is invalid at "
1999 "offset 0x%x, is 0x%x, s/b 0x%x\n",
2000 save_len
- len
, val
, le32_to_cpu(*image
));
2009 IWL_DEBUG_INFO(priv
,
2010 "ucode image in INSTRUCTION memory is good\n");
2016 * iwl_verify_ucode - determine which instruction image is in SRAM,
2017 * and verify its contents
2019 int iwl_verify_ucode(struct iwl_priv
*priv
)
2026 image
= (__le32
*)priv
->ucode_boot
.v_addr
;
2027 len
= priv
->ucode_boot
.len
;
2028 ret
= iwlcore_verify_inst_sparse(priv
, image
, len
);
2030 IWL_DEBUG_INFO(priv
, "Bootstrap uCode is good in inst SRAM\n");
2034 /* Try initialize */
2035 image
= (__le32
*)priv
->ucode_init
.v_addr
;
2036 len
= priv
->ucode_init
.len
;
2037 ret
= iwlcore_verify_inst_sparse(priv
, image
, len
);
2039 IWL_DEBUG_INFO(priv
, "Initialize uCode is good in inst SRAM\n");
2043 /* Try runtime/protocol */
2044 image
= (__le32
*)priv
->ucode_code
.v_addr
;
2045 len
= priv
->ucode_code
.len
;
2046 ret
= iwlcore_verify_inst_sparse(priv
, image
, len
);
2048 IWL_DEBUG_INFO(priv
, "Runtime uCode is good in inst SRAM\n");
2052 IWL_ERR(priv
, "NO VALID UCODE IMAGE IN INSTRUCTION SRAM!!\n");
2054 /* Since nothing seems to match, show first several data entries in
2055 * instruction SRAM, so maybe visual inspection will give a clue.
2056 * Selection of bootstrap image (vs. other images) is arbitrary. */
2057 image
= (__le32
*)priv
->ucode_boot
.v_addr
;
2058 len
= priv
->ucode_boot
.len
;
2059 ret
= iwl_verify_inst_full(priv
, image
, len
);
2063 EXPORT_SYMBOL(iwl_verify_ucode
);
2066 void iwl_rf_kill_ct_config(struct iwl_priv
*priv
)
2068 struct iwl_ct_kill_config cmd
;
2069 struct iwl_ct_kill_throttling_config adv_cmd
;
2070 unsigned long flags
;
2073 spin_lock_irqsave(&priv
->lock
, flags
);
2074 iwl_write32(priv
, CSR_UCODE_DRV_GP1_CLR
,
2075 CSR_UCODE_DRV_GP1_REG_BIT_CT_KILL_EXIT
);
2076 spin_unlock_irqrestore(&priv
->lock
, flags
);
2077 priv
->thermal_throttle
.ct_kill_toggle
= false;
2079 switch (priv
->hw_rev
& CSR_HW_REV_TYPE_MSK
) {
2080 case CSR_HW_REV_TYPE_1000
:
2081 case CSR_HW_REV_TYPE_6x00
:
2082 case CSR_HW_REV_TYPE_6x50
:
2083 adv_cmd
.critical_temperature_enter
=
2084 cpu_to_le32(priv
->hw_params
.ct_kill_threshold
);
2085 adv_cmd
.critical_temperature_exit
=
2086 cpu_to_le32(priv
->hw_params
.ct_kill_exit_threshold
);
2088 ret
= iwl_send_cmd_pdu(priv
, REPLY_CT_KILL_CONFIG_CMD
,
2089 sizeof(adv_cmd
), &adv_cmd
);
2091 IWL_ERR(priv
, "REPLY_CT_KILL_CONFIG_CMD failed\n");
2093 IWL_DEBUG_INFO(priv
, "REPLY_CT_KILL_CONFIG_CMD "
2095 "critical temperature enter is %d,"
2097 priv
->hw_params
.ct_kill_threshold
,
2098 priv
->hw_params
.ct_kill_exit_threshold
);
2101 cmd
.critical_temperature_R
=
2102 cpu_to_le32(priv
->hw_params
.ct_kill_threshold
);
2104 ret
= iwl_send_cmd_pdu(priv
, REPLY_CT_KILL_CONFIG_CMD
,
2107 IWL_ERR(priv
, "REPLY_CT_KILL_CONFIG_CMD failed\n");
2109 IWL_DEBUG_INFO(priv
, "REPLY_CT_KILL_CONFIG_CMD "
2111 "critical temperature is %d\n",
2112 priv
->hw_params
.ct_kill_threshold
);
2116 EXPORT_SYMBOL(iwl_rf_kill_ct_config
);
2122 * Use: Sets the device's internal card state to enable, disable, or halt
2124 * When in the 'enable' state the card operates as normal.
2125 * When in the 'disable' state, the card enters into a low power mode.
2126 * When in the 'halt' state, the card is shut down and must be fully
2127 * restarted to come back on.
2129 int iwl_send_card_state(struct iwl_priv
*priv
, u32 flags
, u8 meta_flag
)
2131 struct iwl_host_cmd cmd
= {
2132 .id
= REPLY_CARD_STATE_CMD
,
2138 return iwl_send_cmd(priv
, &cmd
);
2141 void iwl_rx_pm_sleep_notif(struct iwl_priv
*priv
,
2142 struct iwl_rx_mem_buffer
*rxb
)
2144 #ifdef CONFIG_IWLWIFI_DEBUG
2145 struct iwl_rx_packet
*pkt
= (struct iwl_rx_packet
*)rxb
->skb
->data
;
2146 struct iwl_sleep_notification
*sleep
= &(pkt
->u
.sleep_notif
);
2147 IWL_DEBUG_RX(priv
, "sleep mode: %d, src: %d\n",
2148 sleep
->pm_sleep_mode
, sleep
->pm_wakeup_src
);
2151 EXPORT_SYMBOL(iwl_rx_pm_sleep_notif
);
2153 void iwl_rx_pm_debug_statistics_notif(struct iwl_priv
*priv
,
2154 struct iwl_rx_mem_buffer
*rxb
)
2156 struct iwl_rx_packet
*pkt
= (struct iwl_rx_packet
*)rxb
->skb
->data
;
2157 u32 len
= le32_to_cpu(pkt
->len_n_flags
) & FH_RSCSR_FRAME_SIZE_MSK
;
2158 IWL_DEBUG_RADIO(priv
, "Dumping %d bytes of unhandled "
2159 "notification for %s:\n", len
,
2160 get_cmd_string(pkt
->hdr
.cmd
));
2161 iwl_print_hex_dump(priv
, IWL_DL_RADIO
, pkt
->u
.raw
, len
);
2163 EXPORT_SYMBOL(iwl_rx_pm_debug_statistics_notif
);
2165 void iwl_rx_reply_error(struct iwl_priv
*priv
,
2166 struct iwl_rx_mem_buffer
*rxb
)
2168 struct iwl_rx_packet
*pkt
= (struct iwl_rx_packet
*)rxb
->skb
->data
;
2170 IWL_ERR(priv
, "Error Reply type 0x%08X cmd %s (0x%02X) "
2171 "seq 0x%04X ser 0x%08X\n",
2172 le32_to_cpu(pkt
->u
.err_resp
.error_type
),
2173 get_cmd_string(pkt
->u
.err_resp
.cmd_id
),
2174 pkt
->u
.err_resp
.cmd_id
,
2175 le16_to_cpu(pkt
->u
.err_resp
.bad_cmd_seq_num
),
2176 le32_to_cpu(pkt
->u
.err_resp
.error_info
));
2178 EXPORT_SYMBOL(iwl_rx_reply_error
);
2180 void iwl_clear_isr_stats(struct iwl_priv
*priv
)
2182 memset(&priv
->isr_stats
, 0, sizeof(priv
->isr_stats
));
2185 int iwl_mac_conf_tx(struct ieee80211_hw
*hw
, u16 queue
,
2186 const struct ieee80211_tx_queue_params
*params
)
2188 struct iwl_priv
*priv
= hw
->priv
;
2189 unsigned long flags
;
2192 IWL_DEBUG_MAC80211(priv
, "enter\n");
2194 if (!iwl_is_ready_rf(priv
)) {
2195 IWL_DEBUG_MAC80211(priv
, "leave - RF not ready\n");
2199 if (queue
>= AC_NUM
) {
2200 IWL_DEBUG_MAC80211(priv
, "leave - queue >= AC_NUM %d\n", queue
);
2204 q
= AC_NUM
- 1 - queue
;
2206 spin_lock_irqsave(&priv
->lock
, flags
);
2208 priv
->qos_data
.def_qos_parm
.ac
[q
].cw_min
= cpu_to_le16(params
->cw_min
);
2209 priv
->qos_data
.def_qos_parm
.ac
[q
].cw_max
= cpu_to_le16(params
->cw_max
);
2210 priv
->qos_data
.def_qos_parm
.ac
[q
].aifsn
= params
->aifs
;
2211 priv
->qos_data
.def_qos_parm
.ac
[q
].edca_txop
=
2212 cpu_to_le16((params
->txop
* 32));
2214 priv
->qos_data
.def_qos_parm
.ac
[q
].reserved1
= 0;
2215 priv
->qos_data
.qos_active
= 1;
2217 if (priv
->iw_mode
== NL80211_IFTYPE_AP
)
2218 iwl_activate_qos(priv
, 1);
2219 else if (priv
->assoc_id
&& iwl_is_associated(priv
))
2220 iwl_activate_qos(priv
, 0);
2222 spin_unlock_irqrestore(&priv
->lock
, flags
);
2224 IWL_DEBUG_MAC80211(priv
, "leave\n");
2227 EXPORT_SYMBOL(iwl_mac_conf_tx
);
2229 static void iwl_ht_conf(struct iwl_priv
*priv
,
2230 struct ieee80211_bss_conf
*bss_conf
)
2232 struct ieee80211_sta_ht_cap
*ht_conf
;
2233 struct iwl_ht_info
*iwl_conf
= &priv
->current_ht_config
;
2234 struct ieee80211_sta
*sta
;
2236 IWL_DEBUG_MAC80211(priv
, "enter: \n");
2238 if (!iwl_conf
->is_ht
)
2243 * It is totally wrong to base global information on something
2244 * that is valid only when associated, alas, this driver works
2245 * that way and I don't know how to fix it.
2249 sta
= ieee80211_find_sta(priv
->hw
, priv
->bssid
);
2254 ht_conf
= &sta
->ht_cap
;
2256 iwl_conf
->sm_ps
= (u8
)((ht_conf
->cap
& IEEE80211_HT_CAP_SM_PS
) >> 2);
2258 memcpy(&iwl_conf
->mcs
, &ht_conf
->mcs
, 16);
2260 iwl_conf
->ht_protection
=
2261 bss_conf
->ht_operation_mode
& IEEE80211_HT_OP_MODE_PROTECTION
;
2262 iwl_conf
->non_GF_STA_present
=
2263 !!(bss_conf
->ht_operation_mode
& IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT
);
2267 IWL_DEBUG_MAC80211(priv
, "leave\n");
2270 #define IWL_DELAY_NEXT_SCAN_AFTER_ASSOC (HZ*6)
2271 void iwl_bss_info_changed(struct ieee80211_hw
*hw
,
2272 struct ieee80211_vif
*vif
,
2273 struct ieee80211_bss_conf
*bss_conf
,
2276 struct iwl_priv
*priv
= hw
->priv
;
2279 IWL_DEBUG_MAC80211(priv
, "changes = 0x%X\n", changes
);
2281 if (!iwl_is_alive(priv
))
2284 mutex_lock(&priv
->mutex
);
2286 if (changes
& BSS_CHANGED_BEACON
&&
2287 priv
->iw_mode
== NL80211_IFTYPE_AP
) {
2288 dev_kfree_skb(priv
->ibss_beacon
);
2289 priv
->ibss_beacon
= ieee80211_beacon_get(hw
, vif
);
2292 if (changes
& BSS_CHANGED_BEACON_INT
) {
2293 priv
->beacon_int
= bss_conf
->beacon_int
;
2294 /* TODO: in AP mode, do something to make this take effect */
2297 if (changes
& BSS_CHANGED_BSSID
) {
2298 IWL_DEBUG_MAC80211(priv
, "BSSID %pM\n", bss_conf
->bssid
);
2301 * If there is currently a HW scan going on in the
2302 * background then we need to cancel it else the RXON
2303 * below/in post_associate will fail.
2305 if (iwl_scan_cancel_timeout(priv
, 100)) {
2306 IWL_WARN(priv
, "Aborted scan still in progress after 100ms\n");
2307 IWL_DEBUG_MAC80211(priv
, "leaving - scan abort failed.\n");
2308 mutex_unlock(&priv
->mutex
);
2312 /* mac80211 only sets assoc when in STATION mode */
2313 if (priv
->iw_mode
== NL80211_IFTYPE_ADHOC
||
2315 memcpy(priv
->staging_rxon
.bssid_addr
,
2316 bss_conf
->bssid
, ETH_ALEN
);
2318 /* currently needed in a few places */
2319 memcpy(priv
->bssid
, bss_conf
->bssid
, ETH_ALEN
);
2321 priv
->staging_rxon
.filter_flags
&=
2322 ~RXON_FILTER_ASSOC_MSK
;
2328 * This needs to be after setting the BSSID in case
2329 * mac80211 decides to do both changes at once because
2330 * it will invoke post_associate.
2332 if (priv
->iw_mode
== NL80211_IFTYPE_ADHOC
&&
2333 changes
& BSS_CHANGED_BEACON
) {
2334 struct sk_buff
*beacon
= ieee80211_beacon_get(hw
, vif
);
2337 iwl_mac_beacon_update(hw
, beacon
);
2340 if (changes
& BSS_CHANGED_ERP_PREAMBLE
) {
2341 IWL_DEBUG_MAC80211(priv
, "ERP_PREAMBLE %d\n",
2342 bss_conf
->use_short_preamble
);
2343 if (bss_conf
->use_short_preamble
)
2344 priv
->staging_rxon
.flags
|= RXON_FLG_SHORT_PREAMBLE_MSK
;
2346 priv
->staging_rxon
.flags
&= ~RXON_FLG_SHORT_PREAMBLE_MSK
;
2349 if (changes
& BSS_CHANGED_ERP_CTS_PROT
) {
2350 IWL_DEBUG_MAC80211(priv
, "ERP_CTS %d\n", bss_conf
->use_cts_prot
);
2351 if (bss_conf
->use_cts_prot
&& (priv
->band
!= IEEE80211_BAND_5GHZ
))
2352 priv
->staging_rxon
.flags
|= RXON_FLG_TGG_PROTECT_MSK
;
2354 priv
->staging_rxon
.flags
&= ~RXON_FLG_TGG_PROTECT_MSK
;
2357 if (changes
& BSS_CHANGED_BASIC_RATES
) {
2358 /* XXX use this information
2360 * To do that, remove code from iwl_set_rate() and put something
2364 priv->staging_rxon.ofdm_basic_rates =
2365 bss_conf->basic_rates;
2367 priv->staging_rxon.ofdm_basic_rates =
2368 bss_conf->basic_rates >> 4;
2369 priv->staging_rxon.cck_basic_rates =
2370 bss_conf->basic_rates & 0xF;
2374 if (changes
& BSS_CHANGED_HT
) {
2375 iwl_ht_conf(priv
, bss_conf
);
2377 if (priv
->cfg
->ops
->hcmd
->set_rxon_chain
)
2378 priv
->cfg
->ops
->hcmd
->set_rxon_chain(priv
);
2381 if (changes
& BSS_CHANGED_ASSOC
) {
2382 IWL_DEBUG_MAC80211(priv
, "ASSOC %d\n", bss_conf
->assoc
);
2383 if (bss_conf
->assoc
) {
2384 priv
->assoc_id
= bss_conf
->aid
;
2385 priv
->beacon_int
= bss_conf
->beacon_int
;
2386 priv
->timestamp
= bss_conf
->timestamp
;
2387 priv
->assoc_capability
= bss_conf
->assoc_capability
;
2390 * We have just associated, don't start scan too early
2391 * leave time for EAPOL exchange to complete.
2393 * XXX: do this in mac80211
2395 priv
->next_scan_jiffies
= jiffies
+
2396 IWL_DELAY_NEXT_SCAN_AFTER_ASSOC
;
2397 if (!iwl_is_rfkill(priv
))
2398 priv
->cfg
->ops
->lib
->post_associate(priv
);
2404 if (changes
&& iwl_is_associated(priv
) && priv
->assoc_id
) {
2405 IWL_DEBUG_MAC80211(priv
, "Changes (%#x) while associated\n",
2407 ret
= iwl_send_rxon_assoc(priv
);
2409 /* Sync active_rxon with latest change. */
2410 memcpy((void *)&priv
->active_rxon
,
2411 &priv
->staging_rxon
,
2412 sizeof(struct iwl_rxon_cmd
));
2416 mutex_unlock(&priv
->mutex
);
2418 IWL_DEBUG_MAC80211(priv
, "leave\n");
2420 EXPORT_SYMBOL(iwl_bss_info_changed
);
2422 int iwl_mac_beacon_update(struct ieee80211_hw
*hw
, struct sk_buff
*skb
)
2424 struct iwl_priv
*priv
= hw
->priv
;
2425 unsigned long flags
;
2428 IWL_DEBUG_MAC80211(priv
, "enter\n");
2430 if (!iwl_is_ready_rf(priv
)) {
2431 IWL_DEBUG_MAC80211(priv
, "leave - RF not ready\n");
2435 if (priv
->iw_mode
!= NL80211_IFTYPE_ADHOC
) {
2436 IWL_DEBUG_MAC80211(priv
, "leave - not IBSS\n");
2440 spin_lock_irqsave(&priv
->lock
, flags
);
2442 if (priv
->ibss_beacon
)
2443 dev_kfree_skb(priv
->ibss_beacon
);
2445 priv
->ibss_beacon
= skb
;
2448 timestamp
= ((struct ieee80211_mgmt
*)skb
->data
)->u
.beacon
.timestamp
;
2449 priv
->timestamp
= le64_to_cpu(timestamp
);
2451 IWL_DEBUG_MAC80211(priv
, "leave\n");
2452 spin_unlock_irqrestore(&priv
->lock
, flags
);
2454 iwl_reset_qos(priv
);
2456 priv
->cfg
->ops
->lib
->post_associate(priv
);
2461 EXPORT_SYMBOL(iwl_mac_beacon_update
);
2463 int iwl_set_mode(struct iwl_priv
*priv
, int mode
)
2465 if (mode
== NL80211_IFTYPE_ADHOC
) {
2466 const struct iwl_channel_info
*ch_info
;
2468 ch_info
= iwl_get_channel_info(priv
,
2470 le16_to_cpu(priv
->staging_rxon
.channel
));
2472 if (!ch_info
|| !is_channel_ibss(ch_info
)) {
2473 IWL_ERR(priv
, "channel %d not IBSS channel\n",
2474 le16_to_cpu(priv
->staging_rxon
.channel
));
2479 iwl_connection_init_rx_config(priv
, mode
);
2481 if (priv
->cfg
->ops
->hcmd
->set_rxon_chain
)
2482 priv
->cfg
->ops
->hcmd
->set_rxon_chain(priv
);
2484 memcpy(priv
->staging_rxon
.node_addr
, priv
->mac_addr
, ETH_ALEN
);
2486 iwl_clear_stations_table(priv
);
2488 /* dont commit rxon if rf-kill is on*/
2489 if (!iwl_is_ready_rf(priv
))
2492 iwlcore_commit_rxon(priv
);
2496 EXPORT_SYMBOL(iwl_set_mode
);
2498 int iwl_mac_add_interface(struct ieee80211_hw
*hw
,
2499 struct ieee80211_if_init_conf
*conf
)
2501 struct iwl_priv
*priv
= hw
->priv
;
2502 unsigned long flags
;
2504 IWL_DEBUG_MAC80211(priv
, "enter: type %d\n", conf
->type
);
2507 IWL_DEBUG_MAC80211(priv
, "leave - vif != NULL\n");
2511 spin_lock_irqsave(&priv
->lock
, flags
);
2512 priv
->vif
= conf
->vif
;
2513 priv
->iw_mode
= conf
->type
;
2515 spin_unlock_irqrestore(&priv
->lock
, flags
);
2517 mutex_lock(&priv
->mutex
);
2519 if (conf
->mac_addr
) {
2520 IWL_DEBUG_MAC80211(priv
, "Set %pM\n", conf
->mac_addr
);
2521 memcpy(priv
->mac_addr
, conf
->mac_addr
, ETH_ALEN
);
2524 if (iwl_set_mode(priv
, conf
->type
) == -EAGAIN
)
2525 /* we are not ready, will run again when ready */
2526 set_bit(STATUS_MODE_PENDING
, &priv
->status
);
2528 mutex_unlock(&priv
->mutex
);
2530 IWL_DEBUG_MAC80211(priv
, "leave\n");
2533 EXPORT_SYMBOL(iwl_mac_add_interface
);
2535 void iwl_mac_remove_interface(struct ieee80211_hw
*hw
,
2536 struct ieee80211_if_init_conf
*conf
)
2538 struct iwl_priv
*priv
= hw
->priv
;
2540 IWL_DEBUG_MAC80211(priv
, "enter\n");
2542 mutex_lock(&priv
->mutex
);
2544 if (iwl_is_ready_rf(priv
)) {
2545 iwl_scan_cancel_timeout(priv
, 100);
2546 priv
->staging_rxon
.filter_flags
&= ~RXON_FILTER_ASSOC_MSK
;
2547 iwlcore_commit_rxon(priv
);
2549 if (priv
->vif
== conf
->vif
) {
2551 memset(priv
->bssid
, 0, ETH_ALEN
);
2553 mutex_unlock(&priv
->mutex
);
2555 IWL_DEBUG_MAC80211(priv
, "leave\n");
2558 EXPORT_SYMBOL(iwl_mac_remove_interface
);
2561 * iwl_mac_config - mac80211 config callback
2563 * We ignore conf->flags & IEEE80211_CONF_SHORT_SLOT_TIME since it seems to
2564 * be set inappropriately and the driver currently sets the hardware up to
2565 * use it whenever needed.
2567 int iwl_mac_config(struct ieee80211_hw
*hw
, u32 changed
)
2569 struct iwl_priv
*priv
= hw
->priv
;
2570 const struct iwl_channel_info
*ch_info
;
2571 struct ieee80211_conf
*conf
= &hw
->conf
;
2572 struct iwl_ht_info
*ht_conf
= &priv
->current_ht_config
;
2573 unsigned long flags
= 0;
2576 int scan_active
= 0;
2578 mutex_lock(&priv
->mutex
);
2580 IWL_DEBUG_MAC80211(priv
, "enter to channel %d changed 0x%X\n",
2581 conf
->channel
->hw_value
, changed
);
2583 if (unlikely(!priv
->cfg
->mod_params
->disable_hw_scan
&&
2584 test_bit(STATUS_SCANNING
, &priv
->status
))) {
2586 IWL_DEBUG_MAC80211(priv
, "leave - scanning\n");
2590 /* during scanning mac80211 will delay channel setting until
2591 * scan finish with changed = 0
2593 if (!changed
|| (changed
& IEEE80211_CONF_CHANGE_CHANNEL
)) {
2597 ch
= ieee80211_frequency_to_channel(conf
->channel
->center_freq
);
2598 ch_info
= iwl_get_channel_info(priv
, conf
->channel
->band
, ch
);
2599 if (!is_channel_valid(ch_info
)) {
2600 IWL_DEBUG_MAC80211(priv
, "leave - invalid channel\n");
2605 if (priv
->iw_mode
== NL80211_IFTYPE_ADHOC
&&
2606 !is_channel_ibss(ch_info
)) {
2607 IWL_ERR(priv
, "channel %d in band %d not "
2609 conf
->channel
->hw_value
, conf
->channel
->band
);
2614 spin_lock_irqsave(&priv
->lock
, flags
);
2616 /* Configure HT40 channels */
2617 ht_conf
->is_ht
= conf_is_ht(conf
);
2618 if (ht_conf
->is_ht
) {
2619 if (conf_is_ht40_minus(conf
)) {
2620 ht_conf
->extension_chan_offset
=
2621 IEEE80211_HT_PARAM_CHA_SEC_BELOW
;
2622 ht_conf
->supported_chan_width
=
2623 IWL_CHANNEL_WIDTH_40MHZ
;
2624 } else if (conf_is_ht40_plus(conf
)) {
2625 ht_conf
->extension_chan_offset
=
2626 IEEE80211_HT_PARAM_CHA_SEC_ABOVE
;
2627 ht_conf
->supported_chan_width
=
2628 IWL_CHANNEL_WIDTH_40MHZ
;
2630 ht_conf
->extension_chan_offset
=
2631 IEEE80211_HT_PARAM_CHA_SEC_NONE
;
2632 ht_conf
->supported_chan_width
=
2633 IWL_CHANNEL_WIDTH_20MHZ
;
2636 ht_conf
->supported_chan_width
= IWL_CHANNEL_WIDTH_20MHZ
;
2637 /* Default to no protection. Protection mode will later be set
2638 * from BSS config in iwl_ht_conf */
2639 ht_conf
->ht_protection
= IEEE80211_HT_OP_MODE_PROTECTION_NONE
;
2641 /* if we are switching from ht to 2.4 clear flags
2642 * from any ht related info since 2.4 does not
2644 if ((le16_to_cpu(priv
->staging_rxon
.channel
) != ch
))
2645 priv
->staging_rxon
.flags
= 0;
2647 iwl_set_rxon_channel(priv
, conf
->channel
);
2649 iwl_set_flags_for_band(priv
, conf
->channel
->band
);
2650 spin_unlock_irqrestore(&priv
->lock
, flags
);
2652 /* The list of supported rates and rate mask can be different
2653 * for each band; since the band may have changed, reset
2654 * the rate mask to what mac80211 lists */
2658 if (changed
& IEEE80211_CONF_CHANGE_PS
) {
2659 ret
= iwl_power_update_mode(priv
, false);
2661 IWL_DEBUG_MAC80211(priv
, "Error setting sleep level\n");
2664 if (changed
& IEEE80211_CONF_CHANGE_POWER
) {
2665 IWL_DEBUG_MAC80211(priv
, "TX Power old=%d new=%d\n",
2666 priv
->tx_power_user_lmt
, conf
->power_level
);
2668 iwl_set_tx_power(priv
, conf
->power_level
, false);
2671 /* call to ensure that 4965 rx_chain is set properly in monitor mode */
2672 if (priv
->cfg
->ops
->hcmd
->set_rxon_chain
)
2673 priv
->cfg
->ops
->hcmd
->set_rxon_chain(priv
);
2675 if (!iwl_is_ready(priv
)) {
2676 IWL_DEBUG_MAC80211(priv
, "leave - not ready\n");
2683 if (memcmp(&priv
->active_rxon
,
2684 &priv
->staging_rxon
, sizeof(priv
->staging_rxon
)))
2685 iwlcore_commit_rxon(priv
);
2687 IWL_DEBUG_INFO(priv
, "Not re-sending same RXON configuration.\n");
2691 IWL_DEBUG_MAC80211(priv
, "leave\n");
2692 mutex_unlock(&priv
->mutex
);
2695 EXPORT_SYMBOL(iwl_mac_config
);
2697 int iwl_mac_get_tx_stats(struct ieee80211_hw
*hw
,
2698 struct ieee80211_tx_queue_stats
*stats
)
2700 struct iwl_priv
*priv
= hw
->priv
;
2702 struct iwl_tx_queue
*txq
;
2703 struct iwl_queue
*q
;
2704 unsigned long flags
;
2706 IWL_DEBUG_MAC80211(priv
, "enter\n");
2708 if (!iwl_is_ready_rf(priv
)) {
2709 IWL_DEBUG_MAC80211(priv
, "leave - RF not ready\n");
2713 spin_lock_irqsave(&priv
->lock
, flags
);
2715 for (i
= 0; i
< AC_NUM
; i
++) {
2716 txq
= &priv
->txq
[i
];
2718 avail
= iwl_queue_space(q
);
2720 stats
[i
].len
= q
->n_window
- avail
;
2721 stats
[i
].limit
= q
->n_window
- q
->high_mark
;
2722 stats
[i
].count
= q
->n_window
;
2725 spin_unlock_irqrestore(&priv
->lock
, flags
);
2727 IWL_DEBUG_MAC80211(priv
, "leave\n");
2731 EXPORT_SYMBOL(iwl_mac_get_tx_stats
);
2733 void iwl_mac_reset_tsf(struct ieee80211_hw
*hw
)
2735 struct iwl_priv
*priv
= hw
->priv
;
2736 unsigned long flags
;
2738 mutex_lock(&priv
->mutex
);
2739 IWL_DEBUG_MAC80211(priv
, "enter\n");
2741 spin_lock_irqsave(&priv
->lock
, flags
);
2742 memset(&priv
->current_ht_config
, 0, sizeof(struct iwl_ht_info
));
2743 spin_unlock_irqrestore(&priv
->lock
, flags
);
2745 iwl_reset_qos(priv
);
2747 spin_lock_irqsave(&priv
->lock
, flags
);
2749 priv
->assoc_capability
= 0;
2750 priv
->assoc_station_added
= 0;
2752 /* new association get rid of ibss beacon skb */
2753 if (priv
->ibss_beacon
)
2754 dev_kfree_skb(priv
->ibss_beacon
);
2756 priv
->ibss_beacon
= NULL
;
2758 priv
->beacon_int
= priv
->vif
->bss_conf
.beacon_int
;
2759 priv
->timestamp
= 0;
2760 if ((priv
->iw_mode
== NL80211_IFTYPE_STATION
))
2761 priv
->beacon_int
= 0;
2763 spin_unlock_irqrestore(&priv
->lock
, flags
);
2765 if (!iwl_is_ready_rf(priv
)) {
2766 IWL_DEBUG_MAC80211(priv
, "leave - not ready\n");
2767 mutex_unlock(&priv
->mutex
);
2771 /* we are restarting association process
2772 * clear RXON_FILTER_ASSOC_MSK bit
2774 if (priv
->iw_mode
!= NL80211_IFTYPE_AP
) {
2775 iwl_scan_cancel_timeout(priv
, 100);
2776 priv
->staging_rxon
.filter_flags
&= ~RXON_FILTER_ASSOC_MSK
;
2777 iwlcore_commit_rxon(priv
);
2780 if (priv
->iw_mode
!= NL80211_IFTYPE_ADHOC
) {
2781 IWL_DEBUG_MAC80211(priv
, "leave - not in IBSS\n");
2782 mutex_unlock(&priv
->mutex
);
2788 mutex_unlock(&priv
->mutex
);
2790 IWL_DEBUG_MAC80211(priv
, "leave\n");
2792 EXPORT_SYMBOL(iwl_mac_reset_tsf
);
2794 #ifdef CONFIG_IWLWIFI_DEBUGFS
2796 #define IWL_TRAFFIC_DUMP_SIZE (IWL_TRAFFIC_ENTRY_SIZE * IWL_TRAFFIC_ENTRIES)
2798 void iwl_reset_traffic_log(struct iwl_priv
*priv
)
2800 priv
->tx_traffic_idx
= 0;
2801 priv
->rx_traffic_idx
= 0;
2802 if (priv
->tx_traffic
)
2803 memset(priv
->tx_traffic
, 0, IWL_TRAFFIC_DUMP_SIZE
);
2804 if (priv
->rx_traffic
)
2805 memset(priv
->rx_traffic
, 0, IWL_TRAFFIC_DUMP_SIZE
);
2808 int iwl_alloc_traffic_mem(struct iwl_priv
*priv
)
2810 u32 traffic_size
= IWL_TRAFFIC_DUMP_SIZE
;
2812 if (iwl_debug_level
& IWL_DL_TX
) {
2813 if (!priv
->tx_traffic
) {
2815 kzalloc(traffic_size
, GFP_KERNEL
);
2816 if (!priv
->tx_traffic
)
2820 if (iwl_debug_level
& IWL_DL_RX
) {
2821 if (!priv
->rx_traffic
) {
2823 kzalloc(traffic_size
, GFP_KERNEL
);
2824 if (!priv
->rx_traffic
)
2828 iwl_reset_traffic_log(priv
);
2831 EXPORT_SYMBOL(iwl_alloc_traffic_mem
);
2833 void iwl_free_traffic_mem(struct iwl_priv
*priv
)
2835 kfree(priv
->tx_traffic
);
2836 priv
->tx_traffic
= NULL
;
2838 kfree(priv
->rx_traffic
);
2839 priv
->rx_traffic
= NULL
;
2841 EXPORT_SYMBOL(iwl_free_traffic_mem
);
2843 void iwl_dbg_log_tx_data_frame(struct iwl_priv
*priv
,
2844 u16 length
, struct ieee80211_hdr
*header
)
2849 if (likely(!(iwl_debug_level
& IWL_DL_TX
)))
2852 if (!priv
->tx_traffic
)
2855 fc
= header
->frame_control
;
2856 if (ieee80211_is_data(fc
)) {
2857 len
= (length
> IWL_TRAFFIC_ENTRY_SIZE
)
2858 ? IWL_TRAFFIC_ENTRY_SIZE
: length
;
2859 memcpy((priv
->tx_traffic
+
2860 (priv
->tx_traffic_idx
* IWL_TRAFFIC_ENTRY_SIZE
)),
2862 priv
->tx_traffic_idx
=
2863 (priv
->tx_traffic_idx
+ 1) % IWL_TRAFFIC_ENTRIES
;
2866 EXPORT_SYMBOL(iwl_dbg_log_tx_data_frame
);
2868 void iwl_dbg_log_rx_data_frame(struct iwl_priv
*priv
,
2869 u16 length
, struct ieee80211_hdr
*header
)
2874 if (likely(!(iwl_debug_level
& IWL_DL_RX
)))
2877 if (!priv
->rx_traffic
)
2880 fc
= header
->frame_control
;
2881 if (ieee80211_is_data(fc
)) {
2882 len
= (length
> IWL_TRAFFIC_ENTRY_SIZE
)
2883 ? IWL_TRAFFIC_ENTRY_SIZE
: length
;
2884 memcpy((priv
->rx_traffic
+
2885 (priv
->rx_traffic_idx
* IWL_TRAFFIC_ENTRY_SIZE
)),
2887 priv
->rx_traffic_idx
=
2888 (priv
->rx_traffic_idx
+ 1) % IWL_TRAFFIC_ENTRIES
;
2891 EXPORT_SYMBOL(iwl_dbg_log_rx_data_frame
);
2893 const char *get_mgmt_string(int cmd
)
2896 IWL_CMD(MANAGEMENT_ASSOC_REQ
);
2897 IWL_CMD(MANAGEMENT_ASSOC_RESP
);
2898 IWL_CMD(MANAGEMENT_REASSOC_REQ
);
2899 IWL_CMD(MANAGEMENT_REASSOC_RESP
);
2900 IWL_CMD(MANAGEMENT_PROBE_REQ
);
2901 IWL_CMD(MANAGEMENT_PROBE_RESP
);
2902 IWL_CMD(MANAGEMENT_BEACON
);
2903 IWL_CMD(MANAGEMENT_ATIM
);
2904 IWL_CMD(MANAGEMENT_DISASSOC
);
2905 IWL_CMD(MANAGEMENT_AUTH
);
2906 IWL_CMD(MANAGEMENT_DEAUTH
);
2907 IWL_CMD(MANAGEMENT_ACTION
);
2914 const char *get_ctrl_string(int cmd
)
2917 IWL_CMD(CONTROL_BACK_REQ
);
2918 IWL_CMD(CONTROL_BACK
);
2919 IWL_CMD(CONTROL_PSPOLL
);
2920 IWL_CMD(CONTROL_RTS
);
2921 IWL_CMD(CONTROL_CTS
);
2922 IWL_CMD(CONTROL_ACK
);
2923 IWL_CMD(CONTROL_CFEND
);
2924 IWL_CMD(CONTROL_CFENDACK
);
2931 void iwl_clear_tx_stats(struct iwl_priv
*priv
)
2933 memset(&priv
->tx_stats
, 0, sizeof(struct traffic_stats
));
2937 void iwl_clear_rx_stats(struct iwl_priv
*priv
)
2939 memset(&priv
->rx_stats
, 0, sizeof(struct traffic_stats
));
2943 * if CONFIG_IWLWIFI_DEBUGFS defined, iwl_update_stats function will
2944 * record all the MGMT, CTRL and DATA pkt for both TX and Rx pass.
2945 * Use debugFs to display the rx/rx_statistics
2946 * if CONFIG_IWLWIFI_DEBUGFS not being defined, then no MGMT and CTRL
2947 * information will be recorded, but DATA pkt still will be recorded
2948 * for the reason of iwl_led.c need to control the led blinking based on
2949 * number of tx and rx data.
2952 void iwl_update_stats(struct iwl_priv
*priv
, bool is_tx
, __le16 fc
, u16 len
)
2954 struct traffic_stats
*stats
;
2957 stats
= &priv
->tx_stats
;
2959 stats
= &priv
->rx_stats
;
2961 if (ieee80211_is_mgmt(fc
)) {
2962 switch (fc
& cpu_to_le16(IEEE80211_FCTL_STYPE
)) {
2963 case cpu_to_le16(IEEE80211_STYPE_ASSOC_REQ
):
2964 stats
->mgmt
[MANAGEMENT_ASSOC_REQ
]++;
2966 case cpu_to_le16(IEEE80211_STYPE_ASSOC_RESP
):
2967 stats
->mgmt
[MANAGEMENT_ASSOC_RESP
]++;
2969 case cpu_to_le16(IEEE80211_STYPE_REASSOC_REQ
):
2970 stats
->mgmt
[MANAGEMENT_REASSOC_REQ
]++;
2972 case cpu_to_le16(IEEE80211_STYPE_REASSOC_RESP
):
2973 stats
->mgmt
[MANAGEMENT_REASSOC_RESP
]++;
2975 case cpu_to_le16(IEEE80211_STYPE_PROBE_REQ
):
2976 stats
->mgmt
[MANAGEMENT_PROBE_REQ
]++;
2978 case cpu_to_le16(IEEE80211_STYPE_PROBE_RESP
):
2979 stats
->mgmt
[MANAGEMENT_PROBE_RESP
]++;
2981 case cpu_to_le16(IEEE80211_STYPE_BEACON
):
2982 stats
->mgmt
[MANAGEMENT_BEACON
]++;
2984 case cpu_to_le16(IEEE80211_STYPE_ATIM
):
2985 stats
->mgmt
[MANAGEMENT_ATIM
]++;
2987 case cpu_to_le16(IEEE80211_STYPE_DISASSOC
):
2988 stats
->mgmt
[MANAGEMENT_DISASSOC
]++;
2990 case cpu_to_le16(IEEE80211_STYPE_AUTH
):
2991 stats
->mgmt
[MANAGEMENT_AUTH
]++;
2993 case cpu_to_le16(IEEE80211_STYPE_DEAUTH
):
2994 stats
->mgmt
[MANAGEMENT_DEAUTH
]++;
2996 case cpu_to_le16(IEEE80211_STYPE_ACTION
):
2997 stats
->mgmt
[MANAGEMENT_ACTION
]++;
3000 } else if (ieee80211_is_ctl(fc
)) {
3001 switch (fc
& cpu_to_le16(IEEE80211_FCTL_STYPE
)) {
3002 case cpu_to_le16(IEEE80211_STYPE_BACK_REQ
):
3003 stats
->ctrl
[CONTROL_BACK_REQ
]++;
3005 case cpu_to_le16(IEEE80211_STYPE_BACK
):
3006 stats
->ctrl
[CONTROL_BACK
]++;
3008 case cpu_to_le16(IEEE80211_STYPE_PSPOLL
):
3009 stats
->ctrl
[CONTROL_PSPOLL
]++;
3011 case cpu_to_le16(IEEE80211_STYPE_RTS
):
3012 stats
->ctrl
[CONTROL_RTS
]++;
3014 case cpu_to_le16(IEEE80211_STYPE_CTS
):
3015 stats
->ctrl
[CONTROL_CTS
]++;
3017 case cpu_to_le16(IEEE80211_STYPE_ACK
):
3018 stats
->ctrl
[CONTROL_ACK
]++;
3020 case cpu_to_le16(IEEE80211_STYPE_CFEND
):
3021 stats
->ctrl
[CONTROL_CFEND
]++;
3023 case cpu_to_le16(IEEE80211_STYPE_CFENDACK
):
3024 stats
->ctrl
[CONTROL_CFENDACK
]++;
3030 stats
->data_bytes
+= len
;
3033 EXPORT_SYMBOL(iwl_update_stats
);
3038 int iwl_pci_suspend(struct pci_dev
*pdev
, pm_message_t state
)
3040 struct iwl_priv
*priv
= pci_get_drvdata(pdev
);
3043 * This function is called when system goes into suspend state
3044 * mac80211 will call iwl_mac_stop() from the mac80211 suspend function
3045 * first but since iwl_mac_stop() has no knowledge of who the caller is,
3046 * it will not call apm_ops.stop() to stop the DMA operation.
3047 * Calling apm_ops.stop here to make sure we stop the DMA.
3049 priv
->cfg
->ops
->lib
->apm_ops
.stop(priv
);
3051 pci_save_state(pdev
);
3052 pci_disable_device(pdev
);
3053 pci_set_power_state(pdev
, PCI_D3hot
);
3057 EXPORT_SYMBOL(iwl_pci_suspend
);
3059 int iwl_pci_resume(struct pci_dev
*pdev
)
3061 struct iwl_priv
*priv
= pci_get_drvdata(pdev
);
3064 pci_set_power_state(pdev
, PCI_D0
);
3065 ret
= pci_enable_device(pdev
);
3068 pci_restore_state(pdev
);
3069 iwl_enable_interrupts(priv
);
3073 EXPORT_SYMBOL(iwl_pci_resume
);
3075 #endif /* CONFIG_PM */