2 * Intel Wireless Multicomm 3200 WiFi driver
4 * Copyright (C) 2009 Intel Corporation. All rights reserved.
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
10 * * Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * * Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in
14 * the documentation and/or other materials provided with the
16 * * Neither the name of Intel Corporation nor the names of its
17 * contributors may be used to endorse or promote products derived
18 * from this software without specific prior written permission.
20 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
21 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
22 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
23 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
24 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
25 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
26 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
30 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 * Intel Corporation <ilw@linux.intel.com>
34 * Samuel Ortiz <samuel.ortiz@intel.com>
35 * Zhu Yi <yi.zhu@intel.com>
39 #include <linux/kernel.h>
40 #include <linux/wireless.h>
41 #include <linux/etherdevice.h>
42 #include <linux/ieee80211.h>
43 #include <linux/sched.h>
52 static int iwm_send_lmac_ptrough_cmd(struct iwm_priv
*iwm
,
54 const void *lmac_payload
,
55 u16 lmac_payload_size
,
58 struct iwm_udma_wifi_cmd udma_cmd
= UDMA_LMAC_INIT
;
59 struct iwm_umac_cmd umac_cmd
;
60 struct iwm_lmac_cmd lmac_cmd
;
62 lmac_cmd
.id
= lmac_cmd_id
;
64 umac_cmd
.id
= UMAC_CMD_OPCODE_WIFI_PASS_THROUGH
;
67 return iwm_hal_send_host_cmd(iwm
, &udma_cmd
, &umac_cmd
, &lmac_cmd
,
68 lmac_payload
, lmac_payload_size
);
71 int iwm_send_wifi_if_cmd(struct iwm_priv
*iwm
, void *payload
, u16 payload_size
,
74 struct iwm_umac_wifi_if
*hdr
= (struct iwm_umac_wifi_if
*)payload
;
75 struct iwm_udma_wifi_cmd udma_cmd
= UDMA_UMAC_INIT
;
76 struct iwm_umac_cmd umac_cmd
;
80 if (!test_bit(IWM_STATUS_READY
, &iwm
->status
)) {
81 IWM_ERR(iwm
, "Interface is not ready yet");
85 umac_cmd
.id
= UMAC_CMD_OPCODE_WIFI_IF_WRAPPER
;
88 ret
= iwm_hal_send_umac_cmd(iwm
, &udma_cmd
, &umac_cmd
,
89 payload
, payload_size
);
92 ret
= wait_event_interruptible_timeout(iwm
->wifi_ntfy_queue
,
93 test_and_clear_bit(oid
, &iwm
->wifi_ntfy
[0]),
96 return ret
? 0 : -EBUSY
;
102 static int modparam_wiwi
= COEX_MODE_CM
;
103 module_param_named(wiwi
, modparam_wiwi
, int, 0644);
104 MODULE_PARM_DESC(wiwi
, "Wifi-WiMAX coexistence: 1=SA, 2=XOR, 3=CM (default)");
106 static struct coex_event iwm_sta_xor_prio_tbl
[COEX_EVENTS_NUM
] =
108 {4, 3, 0, COEX_UNASSOC_IDLE_FLAGS
},
109 {4, 3, 0, COEX_UNASSOC_MANUAL_SCAN_FLAGS
},
110 {4, 3, 0, COEX_UNASSOC_AUTO_SCAN_FLAGS
},
111 {4, 3, 0, COEX_CALIBRATION_FLAGS
},
112 {4, 3, 0, COEX_PERIODIC_CALIBRATION_FLAGS
},
113 {4, 3, 0, COEX_CONNECTION_ESTAB_FLAGS
},
114 {4, 3, 0, COEX_ASSOCIATED_IDLE_FLAGS
},
115 {4, 3, 0, COEX_ASSOC_MANUAL_SCAN_FLAGS
},
116 {4, 3, 0, COEX_ASSOC_AUTO_SCAN_FLAGS
},
117 {4, 3, 0, COEX_ASSOC_ACTIVE_LEVEL_FLAGS
},
118 {6, 3, 0, COEX_XOR_RF_ON_FLAGS
},
119 {4, 3, 0, COEX_RF_OFF_FLAGS
},
120 {6, 6, 0, COEX_STAND_ALONE_DEBUG_FLAGS
},
121 {4, 3, 0, COEX_IPAN_ASSOC_LEVEL_FLAGS
},
122 {4, 3, 0, COEX_RSRVD1_FLAGS
},
123 {4, 3, 0, COEX_RSRVD2_FLAGS
}
126 static struct coex_event iwm_sta_cm_prio_tbl
[COEX_EVENTS_NUM
] =
128 {1, 1, 0, COEX_UNASSOC_IDLE_FLAGS
},
129 {4, 4, 0, COEX_UNASSOC_MANUAL_SCAN_FLAGS
},
130 {3, 3, 0, COEX_UNASSOC_AUTO_SCAN_FLAGS
},
131 {6, 6, 0, COEX_CALIBRATION_FLAGS
},
132 {3, 3, 0, COEX_PERIODIC_CALIBRATION_FLAGS
},
133 {6, 5, 0, COEX_CONNECTION_ESTAB_FLAGS
},
134 {4, 4, 0, COEX_ASSOCIATED_IDLE_FLAGS
},
135 {4, 4, 0, COEX_ASSOC_MANUAL_SCAN_FLAGS
},
136 {4, 4, 0, COEX_ASSOC_AUTO_SCAN_FLAGS
},
137 {4, 4, 0, COEX_ASSOC_ACTIVE_LEVEL_FLAGS
},
138 {1, 1, 0, COEX_RF_ON_FLAGS
},
139 {1, 1, 0, COEX_RF_OFF_FLAGS
},
140 {7, 7, 0, COEX_STAND_ALONE_DEBUG_FLAGS
},
141 {5, 4, 0, COEX_IPAN_ASSOC_LEVEL_FLAGS
},
142 {1, 1, 0, COEX_RSRVD1_FLAGS
},
143 {1, 1, 0, COEX_RSRVD2_FLAGS
}
146 int iwm_send_prio_table(struct iwm_priv
*iwm
)
148 struct iwm_coex_prio_table_cmd coex_table_cmd
;
149 u32 coex_enabled
, mode_enabled
;
151 memset(&coex_table_cmd
, 0, sizeof(struct iwm_coex_prio_table_cmd
));
153 coex_table_cmd
.flags
= COEX_FLAGS_STA_TABLE_VALID_MSK
;
155 switch (modparam_wiwi
) {
165 switch (iwm
->conf
.mode
) {
175 if (coex_enabled
&& mode_enabled
) {
176 coex_table_cmd
.flags
|= COEX_FLAGS_COEX_ENABLE_MSK
|
177 COEX_FLAGS_ASSOC_WAKEUP_UMASK_MSK
|
178 COEX_FLAGS_UNASSOC_WAKEUP_UMASK_MSK
;
180 switch (modparam_wiwi
) {
182 memcpy(coex_table_cmd
.sta_prio
, iwm_sta_xor_prio_tbl
,
183 sizeof(iwm_sta_xor_prio_tbl
));
186 memcpy(coex_table_cmd
.sta_prio
, iwm_sta_cm_prio_tbl
,
187 sizeof(iwm_sta_cm_prio_tbl
));
190 IWM_ERR(iwm
, "Invalid coex_mode 0x%x\n",
195 IWM_WARN(iwm
, "coexistense disabled\n");
197 return iwm_send_lmac_ptrough_cmd(iwm
, COEX_PRIORITY_TABLE_CMD
,
199 sizeof(struct iwm_coex_prio_table_cmd
), 0);
202 int iwm_send_init_calib_cfg(struct iwm_priv
*iwm
, u8 calib_requested
)
204 struct iwm_lmac_cal_cfg_cmd cal_cfg_cmd
;
206 memset(&cal_cfg_cmd
, 0, sizeof(struct iwm_lmac_cal_cfg_cmd
));
208 cal_cfg_cmd
.ucode_cfg
.init
.enable
= cpu_to_le32(calib_requested
);
209 cal_cfg_cmd
.ucode_cfg
.init
.start
= cpu_to_le32(calib_requested
);
210 cal_cfg_cmd
.ucode_cfg
.init
.send_res
= cpu_to_le32(calib_requested
);
211 cal_cfg_cmd
.ucode_cfg
.flags
=
212 cpu_to_le32(CALIB_CFG_FLAG_SEND_COMPLETE_NTFY_AFTER_MSK
);
214 return iwm_send_lmac_ptrough_cmd(iwm
, CALIBRATION_CFG_CMD
, &cal_cfg_cmd
,
215 sizeof(struct iwm_lmac_cal_cfg_cmd
), 1);
218 int iwm_send_periodic_calib_cfg(struct iwm_priv
*iwm
, u8 calib_requested
)
220 struct iwm_lmac_cal_cfg_cmd cal_cfg_cmd
;
222 memset(&cal_cfg_cmd
, 0, sizeof(struct iwm_lmac_cal_cfg_cmd
));
224 cal_cfg_cmd
.ucode_cfg
.periodic
.enable
= cpu_to_le32(calib_requested
);
225 cal_cfg_cmd
.ucode_cfg
.periodic
.start
= cpu_to_le32(calib_requested
);
227 return iwm_send_lmac_ptrough_cmd(iwm
, CALIBRATION_CFG_CMD
, &cal_cfg_cmd
,
228 sizeof(struct iwm_lmac_cal_cfg_cmd
), 0);
231 int iwm_store_rxiq_calib_result(struct iwm_priv
*iwm
)
233 struct iwm_calib_rxiq
*rxiq
;
234 u8
*eeprom_rxiq
= iwm_eeprom_access(iwm
, IWM_EEPROM_CALIB_RXIQ
);
235 int grplen
= sizeof(struct iwm_calib_rxiq_group
);
237 rxiq
= kzalloc(sizeof(struct iwm_calib_rxiq
), GFP_KERNEL
);
239 IWM_ERR(iwm
, "Couldn't alloc memory for RX IQ\n");
243 eeprom_rxiq
= iwm_eeprom_access(iwm
, IWM_EEPROM_CALIB_RXIQ
);
244 if (IS_ERR(eeprom_rxiq
)) {
245 IWM_ERR(iwm
, "Couldn't access EEPROM RX IQ entry\n");
247 return PTR_ERR(eeprom_rxiq
);
250 iwm
->calib_res
[SHILOH_PHY_CALIBRATE_RX_IQ_CMD
].buf
= (u8
*)rxiq
;
251 iwm
->calib_res
[SHILOH_PHY_CALIBRATE_RX_IQ_CMD
].size
= sizeof(*rxiq
);
253 rxiq
->hdr
.opcode
= SHILOH_PHY_CALIBRATE_RX_IQ_CMD
;
254 rxiq
->hdr
.first_grp
= 0;
255 rxiq
->hdr
.grp_num
= 1;
256 rxiq
->hdr
.all_data_valid
= 1;
258 memcpy(&rxiq
->group
[0], eeprom_rxiq
, 4 * grplen
);
259 memcpy(&rxiq
->group
[4], eeprom_rxiq
+ 6 * grplen
, grplen
);
264 int iwm_send_calib_results(struct iwm_priv
*iwm
)
268 for (i
= PHY_CALIBRATE_OPCODES_NUM
; i
< CALIBRATION_CMD_NUM
; i
++) {
269 if (test_bit(i
- PHY_CALIBRATE_OPCODES_NUM
,
270 &iwm
->calib_done_map
)) {
271 IWM_DBG_CMD(iwm
, DBG
,
272 "Send calibration %d result\n", i
);
273 ret
|= iwm_send_lmac_ptrough_cmd(iwm
,
274 REPLY_PHY_CALIBRATION_CMD
,
275 iwm
->calib_res
[i
].buf
,
276 iwm
->calib_res
[i
].size
, 0);
278 kfree(iwm
->calib_res
[i
].buf
);
279 iwm
->calib_res
[i
].buf
= NULL
;
280 iwm
->calib_res
[i
].size
= 0;
287 int iwm_send_ct_kill_cfg(struct iwm_priv
*iwm
, u8 entry
, u8 exit
)
289 struct iwm_ct_kill_cfg_cmd cmd
;
291 cmd
.entry_threshold
= entry
;
292 cmd
.exit_threshold
= exit
;
294 return iwm_send_lmac_ptrough_cmd(iwm
, REPLY_CT_KILL_CONFIG_CMD
, &cmd
,
295 sizeof(struct iwm_ct_kill_cfg_cmd
), 0);
298 int iwm_send_umac_reset(struct iwm_priv
*iwm
, __le32 reset_flags
, bool resp
)
300 struct iwm_udma_wifi_cmd udma_cmd
= UDMA_UMAC_INIT
;
301 struct iwm_umac_cmd umac_cmd
;
302 struct iwm_umac_cmd_reset reset
;
304 reset
.flags
= reset_flags
;
306 umac_cmd
.id
= UMAC_CMD_OPCODE_RESET
;
307 umac_cmd
.resp
= resp
;
309 return iwm_hal_send_umac_cmd(iwm
, &udma_cmd
, &umac_cmd
, &reset
,
310 sizeof(struct iwm_umac_cmd_reset
));
313 int iwm_umac_set_config_fix(struct iwm_priv
*iwm
, u16 tbl
, u16 key
, u32 value
)
315 struct iwm_udma_wifi_cmd udma_cmd
= UDMA_UMAC_INIT
;
316 struct iwm_umac_cmd umac_cmd
;
317 struct iwm_umac_cmd_set_param_fix param
;
319 if ((tbl
!= UMAC_PARAM_TBL_CFG_FIX
) &&
320 (tbl
!= UMAC_PARAM_TBL_FA_CFG_FIX
))
323 umac_cmd
.id
= UMAC_CMD_OPCODE_SET_PARAM_FIX
;
326 param
.tbl
= cpu_to_le16(tbl
);
327 param
.key
= cpu_to_le16(key
);
328 param
.value
= cpu_to_le32(value
);
330 return iwm_hal_send_umac_cmd(iwm
, &udma_cmd
, &umac_cmd
, ¶m
,
331 sizeof(struct iwm_umac_cmd_set_param_fix
));
334 int iwm_umac_set_config_var(struct iwm_priv
*iwm
, u16 key
,
335 void *payload
, u16 payload_size
)
337 struct iwm_udma_wifi_cmd udma_cmd
= UDMA_UMAC_INIT
;
338 struct iwm_umac_cmd umac_cmd
;
339 struct iwm_umac_cmd_set_param_var
*param_hdr
;
343 param
= kzalloc(payload_size
+
344 sizeof(struct iwm_umac_cmd_set_param_var
), GFP_KERNEL
);
346 IWM_ERR(iwm
, "Couldn't allocate param\n");
350 param_hdr
= (struct iwm_umac_cmd_set_param_var
*)param
;
352 umac_cmd
.id
= UMAC_CMD_OPCODE_SET_PARAM_VAR
;
355 param_hdr
->tbl
= cpu_to_le16(UMAC_PARAM_TBL_CFG_VAR
);
356 param_hdr
->key
= cpu_to_le16(key
);
357 param_hdr
->len
= cpu_to_le16(payload_size
);
358 memcpy(param
+ sizeof(struct iwm_umac_cmd_set_param_var
),
359 payload
, payload_size
);
361 ret
= iwm_hal_send_umac_cmd(iwm
, &udma_cmd
, &umac_cmd
, param
,
362 sizeof(struct iwm_umac_cmd_set_param_var
) +
369 int iwm_send_umac_config(struct iwm_priv
*iwm
, __le32 reset_flags
)
373 /* Use UMAC default values */
374 ret
= iwm_umac_set_config_fix(iwm
, UMAC_PARAM_TBL_CFG_FIX
,
375 CFG_POWER_INDEX
, iwm
->conf
.power_index
);
379 ret
= iwm_umac_set_config_fix(iwm
, UMAC_PARAM_TBL_FA_CFG_FIX
,
381 iwm
->conf
.frag_threshold
);
385 ret
= iwm_umac_set_config_fix(iwm
, UMAC_PARAM_TBL_CFG_FIX
,
387 iwm
->conf
.rts_threshold
);
391 ret
= iwm_umac_set_config_fix(iwm
, UMAC_PARAM_TBL_CFG_FIX
,
392 CFG_CTS_TO_SELF
, iwm
->conf
.cts_to_self
);
396 ret
= iwm_umac_set_config_fix(iwm
, UMAC_PARAM_TBL_CFG_FIX
,
398 iwm
->conf
.wireless_mode
);
402 ret
= iwm_umac_set_config_fix(iwm
, UMAC_PARAM_TBL_CFG_FIX
,
403 CFG_COEX_MODE
, modparam_wiwi
);
408 ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX,
409 CFG_ASSOCIATION_TIMEOUT,
410 iwm->conf.assoc_timeout);
414 ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX,
416 iwm->conf.roam_timeout);
420 ret = iwm_umac_set_config_fix(iwm, UMAC_PARAM_TBL_CFG_FIX,
422 WIRELESS_MODE_11A | WIRELESS_MODE_11G);
427 ret
= iwm_umac_set_config_var(iwm
, CFG_NET_ADDR
,
428 iwm_to_ndev(iwm
)->dev_addr
, ETH_ALEN
);
432 /* UMAC PM static configurations */
433 ret
= iwm_umac_set_config_fix(iwm
, UMAC_PARAM_TBL_CFG_FIX
,
434 CFG_PM_LEGACY_RX_TIMEOUT
, 0x12C);
438 ret
= iwm_umac_set_config_fix(iwm
, UMAC_PARAM_TBL_CFG_FIX
,
439 CFG_PM_LEGACY_TX_TIMEOUT
, 0x15E);
443 ret
= iwm_umac_set_config_fix(iwm
, UMAC_PARAM_TBL_CFG_FIX
,
444 CFG_PM_CTRL_FLAGS
, 0x1);
448 ret
= iwm_umac_set_config_fix(iwm
, UMAC_PARAM_TBL_CFG_FIX
,
449 CFG_PM_KEEP_ALIVE_IN_BEACONS
, 0x80);
454 ret
= iwm_send_umac_reset(iwm
, reset_flags
, 1);
458 ret
= iwm_notif_handle(iwm
, UMAC_CMD_OPCODE_RESET
, IWM_SRC_UMAC
,
461 IWM_ERR(iwm
, "Wait for UMAC RESET timeout\n");
468 int iwm_send_packet(struct iwm_priv
*iwm
, struct sk_buff
*skb
, int pool_id
)
470 struct iwm_udma_wifi_cmd udma_cmd
;
471 struct iwm_umac_cmd umac_cmd
;
472 struct iwm_tx_info
*tx_info
= skb_to_tx_info(skb
);
474 udma_cmd
.eop
= 1; /* always set eop for non-concatenated Tx */
475 udma_cmd
.credit_group
= pool_id
;
476 udma_cmd
.ra_tid
= tx_info
->sta
<< 4 | tx_info
->tid
;
477 udma_cmd
.lmac_offset
= 0;
479 umac_cmd
.id
= REPLY_TX
;
480 umac_cmd
.color
= tx_info
->color
;
483 return iwm_hal_send_umac_cmd(iwm
, &udma_cmd
, &umac_cmd
,
484 skb
->data
, skb
->len
);
487 static int iwm_target_read(struct iwm_priv
*iwm
, __le32 address
,
488 u8
*response
, u32 resp_size
)
490 struct iwm_udma_nonwifi_cmd target_cmd
;
491 struct iwm_nonwifi_cmd
*cmd
;
495 target_cmd
.opcode
= UMAC_HDI_OUT_OPCODE_READ
;
496 target_cmd
.addr
= address
;
497 target_cmd
.op1_sz
= cpu_to_le32(resp_size
);
499 target_cmd
.handle_by_hw
= 0;
503 ret
= iwm_hal_send_target_cmd(iwm
, &target_cmd
, NULL
);
505 IWM_ERR(iwm
, "Couldn't send READ command\n");
509 /* When succeding, the send_target routine returns the seq number */
512 ret
= wait_event_interruptible_timeout(iwm
->nonwifi_queue
,
513 (cmd
= iwm_get_pending_nonwifi_cmd(iwm
, seq_num
,
514 UMAC_HDI_OUT_OPCODE_READ
)) != NULL
,
518 IWM_ERR(iwm
, "Didn't receive a target READ answer\n");
522 memcpy(response
, cmd
->buf
.hdr
+ sizeof(struct iwm_udma_in_hdr
),
530 int iwm_read_mac(struct iwm_priv
*iwm
, u8
*mac
)
533 u8 mac_align
[ALIGN(ETH_ALEN
, 8)];
535 ret
= iwm_target_read(iwm
, cpu_to_le32(WICO_MAC_ADDRESS_ADDR
),
536 mac_align
, sizeof(mac_align
));
540 if (is_valid_ether_addr(mac_align
))
541 memcpy(mac
, mac_align
, ETH_ALEN
);
543 IWM_ERR(iwm
, "Invalid EEPROM MAC\n");
544 memcpy(mac
, iwm
->conf
.mac_addr
, ETH_ALEN
);
545 get_random_bytes(&mac
[3], 3);
551 static int iwm_check_profile(struct iwm_priv
*iwm
)
553 if (!iwm
->umac_profile_active
)
556 if (iwm
->umac_profile
->sec
.ucast_cipher
!= UMAC_CIPHER_TYPE_WEP_40
&&
557 iwm
->umac_profile
->sec
.ucast_cipher
!= UMAC_CIPHER_TYPE_WEP_104
&&
558 iwm
->umac_profile
->sec
.ucast_cipher
!= UMAC_CIPHER_TYPE_TKIP
&&
559 iwm
->umac_profile
->sec
.ucast_cipher
!= UMAC_CIPHER_TYPE_CCMP
) {
560 IWM_ERR(iwm
, "Wrong unicast cipher: 0x%x\n",
561 iwm
->umac_profile
->sec
.ucast_cipher
);
565 if (iwm
->umac_profile
->sec
.mcast_cipher
!= UMAC_CIPHER_TYPE_WEP_40
&&
566 iwm
->umac_profile
->sec
.mcast_cipher
!= UMAC_CIPHER_TYPE_WEP_104
&&
567 iwm
->umac_profile
->sec
.mcast_cipher
!= UMAC_CIPHER_TYPE_TKIP
&&
568 iwm
->umac_profile
->sec
.mcast_cipher
!= UMAC_CIPHER_TYPE_CCMP
) {
569 IWM_ERR(iwm
, "Wrong multicast cipher: 0x%x\n",
570 iwm
->umac_profile
->sec
.mcast_cipher
);
574 if ((iwm
->umac_profile
->sec
.ucast_cipher
== UMAC_CIPHER_TYPE_WEP_40
||
575 iwm
->umac_profile
->sec
.ucast_cipher
== UMAC_CIPHER_TYPE_WEP_104
) &&
576 (iwm
->umac_profile
->sec
.ucast_cipher
!=
577 iwm
->umac_profile
->sec
.mcast_cipher
)) {
578 IWM_ERR(iwm
, "Unicast and multicast ciphers differ for WEP\n");
584 int iwm_set_tx_key(struct iwm_priv
*iwm
, u8 key_idx
)
586 struct iwm_umac_tx_key_id tx_key_id
;
589 ret
= iwm_check_profile(iwm
);
593 /* UMAC only allows to set default key for WEP and auth type is
594 * NOT 802.1X or RSNA. */
595 if ((iwm
->umac_profile
->sec
.ucast_cipher
!= UMAC_CIPHER_TYPE_WEP_40
&&
596 iwm
->umac_profile
->sec
.ucast_cipher
!= UMAC_CIPHER_TYPE_WEP_104
) ||
597 iwm
->umac_profile
->sec
.auth_type
== UMAC_AUTH_TYPE_8021X
||
598 iwm
->umac_profile
->sec
.auth_type
== UMAC_AUTH_TYPE_RSNA_PSK
)
601 tx_key_id
.hdr
.oid
= UMAC_WIFI_IF_CMD_GLOBAL_TX_KEY_ID
;
602 tx_key_id
.hdr
.buf_size
= cpu_to_le16(sizeof(struct iwm_umac_tx_key_id
) -
603 sizeof(struct iwm_umac_wifi_if
));
605 tx_key_id
.key_idx
= key_idx
;
607 return iwm_send_wifi_if_cmd(iwm
, &tx_key_id
, sizeof(tx_key_id
), 1);
610 int iwm_set_key(struct iwm_priv
*iwm
, bool remove
, struct iwm_key
*key
)
613 u8 cmd
[64], *sta_addr
, *key_data
, key_len
;
616 struct iwm_umac_key_hdr
*key_hdr
= &key
->hdr
;
617 struct iwm_umac_key_wep40
*wep40
= (struct iwm_umac_key_wep40
*)cmd
;
618 struct iwm_umac_key_wep104
*wep104
= (struct iwm_umac_key_wep104
*)cmd
;
619 struct iwm_umac_key_tkip
*tkip
= (struct iwm_umac_key_tkip
*)cmd
;
620 struct iwm_umac_key_ccmp
*ccmp
= (struct iwm_umac_key_ccmp
*)cmd
;
623 ret
= iwm_check_profile(iwm
);
628 sta_addr
= key
->hdr
.mac
;
630 key_len
= key
->key_len
;
631 key_idx
= key
->hdr
.key_idx
;
634 u8 auth_type
= iwm
->umac_profile
->sec
.auth_type
;
636 IWM_DBG_WEXT(iwm
, DBG
, "key_idx:%d\n", key_idx
);
637 IWM_DBG_WEXT(iwm
, DBG
, "key_len:%d\n", key_len
);
638 IWM_DBG_WEXT(iwm
, DBG
, "MAC:%pM, idx:%d, multicast:%d\n",
639 key_hdr
->mac
, key_hdr
->key_idx
, key_hdr
->multicast
);
641 IWM_DBG_WEXT(iwm
, DBG
, "profile: mcast:0x%x, ucast:0x%x\n",
642 iwm
->umac_profile
->sec
.mcast_cipher
,
643 iwm
->umac_profile
->sec
.ucast_cipher
);
644 IWM_DBG_WEXT(iwm
, DBG
, "profile: auth_type:0x%x, flags:0x%x\n",
645 iwm
->umac_profile
->sec
.auth_type
,
646 iwm
->umac_profile
->sec
.flags
);
648 switch (key
->cipher
) {
649 case WLAN_CIPHER_SUITE_WEP40
:
650 wep40
->hdr
.oid
= UMAC_WIFI_IF_CMD_ADD_WEP40_KEY
;
651 wep40
->hdr
.buf_size
=
652 cpu_to_le16(sizeof(struct iwm_umac_key_wep40
) -
653 sizeof(struct iwm_umac_wifi_if
));
655 memcpy(&wep40
->key_hdr
, key_hdr
,
656 sizeof(struct iwm_umac_key_hdr
));
657 memcpy(wep40
->key
, key_data
, key_len
);
659 !!((auth_type
!= UMAC_AUTH_TYPE_8021X
) &&
660 (auth_type
!= UMAC_AUTH_TYPE_RSNA_PSK
));
662 cmd_size
= sizeof(struct iwm_umac_key_wep40
);
665 case WLAN_CIPHER_SUITE_WEP104
:
666 wep104
->hdr
.oid
= UMAC_WIFI_IF_CMD_ADD_WEP104_KEY
;
667 wep104
->hdr
.buf_size
=
668 cpu_to_le16(sizeof(struct iwm_umac_key_wep104
) -
669 sizeof(struct iwm_umac_wifi_if
));
671 memcpy(&wep104
->key_hdr
, key_hdr
,
672 sizeof(struct iwm_umac_key_hdr
));
673 memcpy(wep104
->key
, key_data
, key_len
);
675 !!((auth_type
!= UMAC_AUTH_TYPE_8021X
) &&
676 (auth_type
!= UMAC_AUTH_TYPE_RSNA_PSK
));
678 cmd_size
= sizeof(struct iwm_umac_key_wep104
);
681 case WLAN_CIPHER_SUITE_CCMP
:
683 ccmp
->hdr
.oid
= UMAC_WIFI_IF_CMD_ADD_CCMP_KEY
;
685 cpu_to_le16(sizeof(struct iwm_umac_key_ccmp
) -
686 sizeof(struct iwm_umac_wifi_if
));
688 memcpy(&ccmp
->key_hdr
, key_hdr
,
689 sizeof(struct iwm_umac_key_hdr
));
691 memcpy(ccmp
->key
, key_data
, key_len
);
694 memcpy(ccmp
->iv_count
, key
->seq
, key
->seq_len
);
696 cmd_size
= sizeof(struct iwm_umac_key_ccmp
);
699 case WLAN_CIPHER_SUITE_TKIP
:
701 tkip
->hdr
.oid
= UMAC_WIFI_IF_CMD_ADD_TKIP_KEY
;
703 cpu_to_le16(sizeof(struct iwm_umac_key_tkip
) -
704 sizeof(struct iwm_umac_wifi_if
));
706 memcpy(&tkip
->key_hdr
, key_hdr
,
707 sizeof(struct iwm_umac_key_hdr
));
709 memcpy(tkip
->tkip_key
, key_data
, IWM_TKIP_KEY_SIZE
);
710 memcpy(tkip
->mic_tx_key
, key_data
+ IWM_TKIP_KEY_SIZE
,
712 memcpy(tkip
->mic_rx_key
,
713 key_data
+ IWM_TKIP_KEY_SIZE
+ IWM_TKIP_MIC_SIZE
,
717 memcpy(ccmp
->iv_count
, key
->seq
, key
->seq_len
);
719 cmd_size
= sizeof(struct iwm_umac_key_tkip
);
726 if ((key
->cipher
== WLAN_CIPHER_SUITE_TKIP
) ||
727 (key
->cipher
== WLAN_CIPHER_SUITE_CCMP
))
730 * Copied HACK from the MWG driver.
731 * Without it, the key is set before the second
732 * EAPOL frame is sent, and the latter is thus
735 schedule_timeout_interruptible(usecs_to_jiffies(300));
737 ret
= iwm_send_wifi_if_cmd(iwm
, cmd
, cmd_size
, 1);
739 struct iwm_umac_key_remove key_remove
;
741 IWM_DBG_WEXT(iwm
, ERR
, "Removing key_idx:%d\n", key_idx
);
743 key_remove
.hdr
.oid
= UMAC_WIFI_IF_CMD_REMOVE_KEY
;
744 key_remove
.hdr
.buf_size
=
745 cpu_to_le16(sizeof(struct iwm_umac_key_remove
) -
746 sizeof(struct iwm_umac_wifi_if
));
747 memcpy(&key_remove
.key_hdr
, key_hdr
,
748 sizeof(struct iwm_umac_key_hdr
));
750 ret
= iwm_send_wifi_if_cmd(iwm
, &key_remove
,
751 sizeof(struct iwm_umac_key_remove
),
756 iwm
->keys
[key_idx
].key_len
= 0;
763 int iwm_send_mlme_profile(struct iwm_priv
*iwm
)
766 struct iwm_umac_profile profile
;
768 memcpy(&profile
, iwm
->umac_profile
, sizeof(profile
));
770 profile
.hdr
.oid
= UMAC_WIFI_IF_CMD_SET_PROFILE
;
771 profile
.hdr
.buf_size
= cpu_to_le16(sizeof(struct iwm_umac_profile
) -
772 sizeof(struct iwm_umac_wifi_if
));
774 ret
= iwm_send_wifi_if_cmd(iwm
, &profile
, sizeof(profile
), 1);
776 IWM_ERR(iwm
, "Send profile command failed\n");
780 set_bit(IWM_STATUS_SME_CONNECTING
, &iwm
->status
);
784 int iwm_invalidate_mlme_profile(struct iwm_priv
*iwm
)
786 struct iwm_umac_invalidate_profile invalid
;
789 invalid
.hdr
.oid
= UMAC_WIFI_IF_CMD_INVALIDATE_PROFILE
;
790 invalid
.hdr
.buf_size
=
791 cpu_to_le16(sizeof(struct iwm_umac_invalidate_profile
) -
792 sizeof(struct iwm_umac_wifi_if
));
794 invalid
.reason
= WLAN_REASON_UNSPECIFIED
;
796 ret
= iwm_send_wifi_if_cmd(iwm
, &invalid
, sizeof(invalid
), 1);
800 ret
= wait_event_interruptible_timeout(iwm
->mlme_queue
,
801 (iwm
->umac_profile_active
== 0), 5 * HZ
);
803 return ret
? 0 : -EBUSY
;
806 int iwm_tx_power_trigger(struct iwm_priv
*iwm
)
808 struct iwm_umac_pwr_trigger pwr_trigger
;
810 pwr_trigger
.hdr
.oid
= UMAC_WIFI_IF_CMD_TX_PWR_TRIGGER
;
811 pwr_trigger
.hdr
.buf_size
=
812 cpu_to_le16(sizeof(struct iwm_umac_pwr_trigger
) -
813 sizeof(struct iwm_umac_wifi_if
));
816 return iwm_send_wifi_if_cmd(iwm
, &pwr_trigger
, sizeof(pwr_trigger
), 1);
819 int iwm_send_umac_stats_req(struct iwm_priv
*iwm
, u32 flags
)
821 struct iwm_udma_wifi_cmd udma_cmd
= UDMA_UMAC_INIT
;
822 struct iwm_umac_cmd umac_cmd
;
823 struct iwm_umac_cmd_stats_req stats_req
;
825 stats_req
.flags
= cpu_to_le32(flags
);
827 umac_cmd
.id
= UMAC_CMD_OPCODE_STATISTIC_REQUEST
;
830 return iwm_hal_send_umac_cmd(iwm
, &udma_cmd
, &umac_cmd
, &stats_req
,
831 sizeof(struct iwm_umac_cmd_stats_req
));
834 int iwm_send_umac_channel_list(struct iwm_priv
*iwm
)
836 struct iwm_udma_wifi_cmd udma_cmd
= UDMA_UMAC_INIT
;
837 struct iwm_umac_cmd umac_cmd
;
838 struct iwm_umac_cmd_get_channel_list
*ch_list
;
839 int size
= sizeof(struct iwm_umac_cmd_get_channel_list
) +
840 sizeof(struct iwm_umac_channel_info
) * 4;
843 ch_list
= kzalloc(size
, GFP_KERNEL
);
845 IWM_ERR(iwm
, "Couldn't allocate channel list cmd\n");
849 ch_list
->ch
[0].band
= UMAC_BAND_2GHZ
;
850 ch_list
->ch
[0].type
= UMAC_CHANNEL_WIDTH_20MHZ
;
851 ch_list
->ch
[0].flags
= UMAC_CHANNEL_FLAG_VALID
;
853 ch_list
->ch
[1].band
= UMAC_BAND_5GHZ
;
854 ch_list
->ch
[1].type
= UMAC_CHANNEL_WIDTH_20MHZ
;
855 ch_list
->ch
[1].flags
= UMAC_CHANNEL_FLAG_VALID
;
857 ch_list
->ch
[2].band
= UMAC_BAND_2GHZ
;
858 ch_list
->ch
[2].type
= UMAC_CHANNEL_WIDTH_20MHZ
;
859 ch_list
->ch
[2].flags
= UMAC_CHANNEL_FLAG_VALID
| UMAC_CHANNEL_FLAG_IBSS
;
861 ch_list
->ch
[3].band
= UMAC_BAND_5GHZ
;
862 ch_list
->ch
[3].type
= UMAC_CHANNEL_WIDTH_20MHZ
;
863 ch_list
->ch
[3].flags
= UMAC_CHANNEL_FLAG_VALID
| UMAC_CHANNEL_FLAG_IBSS
;
865 ch_list
->count
= cpu_to_le16(4);
867 umac_cmd
.id
= UMAC_CMD_OPCODE_GET_CHAN_INFO_LIST
;
870 ret
= iwm_hal_send_umac_cmd(iwm
, &udma_cmd
, &umac_cmd
, ch_list
, size
);
877 int iwm_scan_ssids(struct iwm_priv
*iwm
, struct cfg80211_ssid
*ssids
,
880 struct iwm_umac_cmd_scan_request req
;
883 memset(&req
, 0, sizeof(struct iwm_umac_cmd_scan_request
));
885 req
.hdr
.oid
= UMAC_WIFI_IF_CMD_SCAN_REQUEST
;
886 req
.hdr
.buf_size
= cpu_to_le16(sizeof(struct iwm_umac_cmd_scan_request
)
887 - sizeof(struct iwm_umac_wifi_if
));
888 req
.type
= UMAC_WIFI_IF_SCAN_TYPE_USER
;
890 req
.seq_num
= iwm
->scan_id
;
891 req
.ssid_num
= min(ssid_num
, UMAC_WIFI_IF_PROBE_OPTION_MAX
);
893 for (i
= 0; i
< req
.ssid_num
; i
++) {
894 memcpy(req
.ssids
[i
].ssid
, ssids
[i
].ssid
, ssids
[i
].ssid_len
);
895 req
.ssids
[i
].ssid_len
= ssids
[i
].ssid_len
;
898 ret
= iwm_send_wifi_if_cmd(iwm
, &req
, sizeof(req
), 0);
900 IWM_ERR(iwm
, "Couldn't send scan request\n");
904 iwm
->scan_id
= iwm
->scan_id
++ % IWM_SCAN_ID_MAX
;
909 int iwm_scan_one_ssid(struct iwm_priv
*iwm
, u8
*ssid
, int ssid_len
)
911 struct cfg80211_ssid one_ssid
;
913 if (test_and_set_bit(IWM_STATUS_SCANNING
, &iwm
->status
))
916 one_ssid
.ssid_len
= min(ssid_len
, IEEE80211_MAX_SSID_LEN
);
917 memcpy(&one_ssid
.ssid
, ssid
, one_ssid
.ssid_len
);
919 return iwm_scan_ssids(iwm
, &one_ssid
, 1);
922 int iwm_target_reset(struct iwm_priv
*iwm
)
924 struct iwm_udma_nonwifi_cmd target_cmd
;
926 target_cmd
.opcode
= UMAC_HDI_OUT_OPCODE_REBOOT
;
928 target_cmd
.op1_sz
= 0;
930 target_cmd
.handle_by_hw
= 0;
934 return iwm_hal_send_target_cmd(iwm
, &target_cmd
, NULL
);
937 int iwm_send_umac_stop_resume_tx(struct iwm_priv
*iwm
,
938 struct iwm_umac_notif_stop_resume_tx
*ntf
)
940 struct iwm_udma_wifi_cmd udma_cmd
= UDMA_UMAC_INIT
;
941 struct iwm_umac_cmd umac_cmd
;
942 struct iwm_umac_cmd_stop_resume_tx stp_res_cmd
;
943 struct iwm_sta_info
*sta_info
;
944 u8 sta_id
= STA_ID_N_COLOR_ID(ntf
->sta_id
);
947 sta_info
= &iwm
->sta_table
[sta_id
];
948 if (!sta_info
->valid
) {
949 IWM_ERR(iwm
, "Invalid STA: %d\n", sta_id
);
953 umac_cmd
.id
= UMAC_CMD_OPCODE_STOP_RESUME_STA_TX
;
956 stp_res_cmd
.flags
= ntf
->flags
;
957 stp_res_cmd
.sta_id
= ntf
->sta_id
;
958 stp_res_cmd
.stop_resume_tid_msk
= ntf
->stop_resume_tid_msk
;
959 for (i
= 0; i
< IWM_UMAC_TID_NR
; i
++)
960 stp_res_cmd
.last_seq_num
[i
] =
961 sta_info
->tid_info
[i
].last_seq_num
;
963 return iwm_hal_send_umac_cmd(iwm
, &udma_cmd
, &umac_cmd
, &stp_res_cmd
,
964 sizeof(struct iwm_umac_cmd_stop_resume_tx
));
968 int iwm_send_pmkid_update(struct iwm_priv
*iwm
,
969 struct cfg80211_pmksa
*pmksa
, u32 command
)
971 struct iwm_umac_pmkid_update update
;
974 memset(&update
, 0, sizeof(struct iwm_umac_pmkid_update
));
976 update
.command
= cpu_to_le32(command
);
978 memcpy(&update
.bssid
, pmksa
->bssid
, ETH_ALEN
);
980 memcpy(&update
.pmkid
, pmksa
->pmkid
, WLAN_PMKID_LEN
);
982 ret
= iwm_send_wifi_if_cmd(iwm
, &update
,
983 sizeof(struct iwm_umac_pmkid_update
), 0);
985 IWM_ERR(iwm
, "PMKID update command failed\n");