2 * Marvell Wireless LAN device driver: station command handling
4 * Copyright (C) 2011, Marvell International Ltd.
6 * This software file (the "File") is distributed by Marvell International
7 * Ltd. under the terms of the GNU General Public License Version 2, June 1991
8 * (the "License"). You may use, redistribute and/or modify this File in
9 * accordance with the terms and conditions of the License, a copy of which
10 * is available by writing to the Free Software Foundation, Inc.,
11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
12 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
14 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
15 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
16 * ARE EXPRESSLY DISCLAIMED. The License provides additional details about
17 * this warranty disclaimer.
30 * This function prepares command to set/get RSSI information.
32 * Preparation includes -
33 * - Setting command ID, action and proper size
34 * - Setting data/beacon average factors
35 * - Resetting SNR/NF/RSSI values in private structure
36 * - Ensuring correct endian-ness
39 mwifiex_cmd_802_11_rssi_info(struct mwifiex_private
*priv
,
40 struct host_cmd_ds_command
*cmd
, u16 cmd_action
)
42 cmd
->command
= cpu_to_le16(HostCmd_CMD_RSSI_INFO
);
43 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_802_11_rssi_info
) +
45 cmd
->params
.rssi_info
.action
= cpu_to_le16(cmd_action
);
46 cmd
->params
.rssi_info
.ndata
= cpu_to_le16(priv
->data_avg_factor
);
47 cmd
->params
.rssi_info
.nbcn
= cpu_to_le16(priv
->bcn_avg_factor
);
49 /* Reset SNR/NF/RSSI values in private structure */
50 priv
->data_rssi_last
= 0;
51 priv
->data_nf_last
= 0;
52 priv
->data_rssi_avg
= 0;
53 priv
->data_nf_avg
= 0;
54 priv
->bcn_rssi_last
= 0;
55 priv
->bcn_nf_last
= 0;
56 priv
->bcn_rssi_avg
= 0;
63 * This function prepares command to set MAC control.
65 * Preparation includes -
66 * - Setting command ID, action and proper size
67 * - Ensuring correct endian-ness
69 static int mwifiex_cmd_mac_control(struct mwifiex_private
*priv
,
70 struct host_cmd_ds_command
*cmd
,
71 u16 cmd_action
, u16
*action
)
73 struct host_cmd_ds_mac_control
*mac_ctrl
= &cmd
->params
.mac_ctrl
;
75 if (cmd_action
!= HostCmd_ACT_GEN_SET
) {
76 dev_err(priv
->adapter
->dev
,
77 "mac_control: only support set cmd\n");
81 cmd
->command
= cpu_to_le16(HostCmd_CMD_MAC_CONTROL
);
83 cpu_to_le16(sizeof(struct host_cmd_ds_mac_control
) + S_DS_GEN
);
84 mac_ctrl
->action
= cpu_to_le16(*action
);
90 * This function prepares command to set/get SNMP MIB.
92 * Preparation includes -
93 * - Setting command ID, action and proper size
94 * - Setting SNMP MIB OID number and value
96 * - Ensuring correct endian-ness
98 * The following SNMP MIB OIDs are supported -
99 * - FRAG_THRESH_I : Fragmentation threshold
100 * - RTS_THRESH_I : RTS threshold
101 * - SHORT_RETRY_LIM_I : Short retry limit
102 * - DOT11D_I : 11d support
104 static int mwifiex_cmd_802_11_snmp_mib(struct mwifiex_private
*priv
,
105 struct host_cmd_ds_command
*cmd
,
106 u16 cmd_action
, u32 cmd_oid
,
109 struct host_cmd_ds_802_11_snmp_mib
*snmp_mib
= &cmd
->params
.smib
;
111 dev_dbg(priv
->adapter
->dev
, "cmd: SNMP_CMD: cmd_oid = 0x%x\n", cmd_oid
);
112 cmd
->command
= cpu_to_le16(HostCmd_CMD_802_11_SNMP_MIB
);
113 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_802_11_snmp_mib
)
116 snmp_mib
->oid
= cpu_to_le16((u16
)cmd_oid
);
117 if (cmd_action
== HostCmd_ACT_GEN_GET
) {
118 snmp_mib
->query_type
= cpu_to_le16(HostCmd_ACT_GEN_GET
);
119 snmp_mib
->buf_size
= cpu_to_le16(MAX_SNMP_BUF_SIZE
);
120 le16_add_cpu(&cmd
->size
, MAX_SNMP_BUF_SIZE
);
121 } else if (cmd_action
== HostCmd_ACT_GEN_SET
) {
122 snmp_mib
->query_type
= cpu_to_le16(HostCmd_ACT_GEN_SET
);
123 snmp_mib
->buf_size
= cpu_to_le16(sizeof(u16
));
124 *((__le16
*) (snmp_mib
->value
)) = cpu_to_le16(*ul_temp
);
125 le16_add_cpu(&cmd
->size
, sizeof(u16
));
128 dev_dbg(priv
->adapter
->dev
,
129 "cmd: SNMP_CMD: Action=0x%x, OID=0x%x, OIDSize=0x%x,"
131 cmd_action
, cmd_oid
, le16_to_cpu(snmp_mib
->buf_size
),
132 le16_to_cpu(*(__le16
*) snmp_mib
->value
));
137 * This function prepares command to get log.
139 * Preparation includes -
140 * - Setting command ID and proper size
141 * - Ensuring correct endian-ness
144 mwifiex_cmd_802_11_get_log(struct host_cmd_ds_command
*cmd
)
146 cmd
->command
= cpu_to_le16(HostCmd_CMD_802_11_GET_LOG
);
147 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_802_11_get_log
) +
153 * This function prepares command to set/get Tx data rate configuration.
155 * Preparation includes -
156 * - Setting command ID, action and proper size
157 * - Setting configuration index, rate scope and rate drop pattern
158 * parameters (as required)
159 * - Ensuring correct endian-ness
161 static int mwifiex_cmd_tx_rate_cfg(struct mwifiex_private
*priv
,
162 struct host_cmd_ds_command
*cmd
,
163 u16 cmd_action
, u16
*pbitmap_rates
)
165 struct host_cmd_ds_tx_rate_cfg
*rate_cfg
= &cmd
->params
.tx_rate_cfg
;
166 struct mwifiex_rate_scope
*rate_scope
;
167 struct mwifiex_rate_drop_pattern
*rate_drop
;
170 cmd
->command
= cpu_to_le16(HostCmd_CMD_TX_RATE_CFG
);
172 rate_cfg
->action
= cpu_to_le16(cmd_action
);
173 rate_cfg
->cfg_index
= 0;
175 rate_scope
= (struct mwifiex_rate_scope
*) ((u8
*) rate_cfg
+
176 sizeof(struct host_cmd_ds_tx_rate_cfg
));
177 rate_scope
->type
= cpu_to_le16(TLV_TYPE_RATE_SCOPE
);
178 rate_scope
->length
= cpu_to_le16
179 (sizeof(*rate_scope
) - sizeof(struct mwifiex_ie_types_header
));
180 if (pbitmap_rates
!= NULL
) {
181 rate_scope
->hr_dsss_rate_bitmap
= cpu_to_le16(pbitmap_rates
[0]);
182 rate_scope
->ofdm_rate_bitmap
= cpu_to_le16(pbitmap_rates
[1]);
184 i
< sizeof(rate_scope
->ht_mcs_rate_bitmap
) / sizeof(u16
);
186 rate_scope
->ht_mcs_rate_bitmap
[i
] =
187 cpu_to_le16(pbitmap_rates
[2 + i
]);
189 rate_scope
->hr_dsss_rate_bitmap
=
190 cpu_to_le16(priv
->bitmap_rates
[0]);
191 rate_scope
->ofdm_rate_bitmap
=
192 cpu_to_le16(priv
->bitmap_rates
[1]);
194 i
< sizeof(rate_scope
->ht_mcs_rate_bitmap
) / sizeof(u16
);
196 rate_scope
->ht_mcs_rate_bitmap
[i
] =
197 cpu_to_le16(priv
->bitmap_rates
[2 + i
]);
200 rate_drop
= (struct mwifiex_rate_drop_pattern
*) ((u8
*) rate_scope
+
201 sizeof(struct mwifiex_rate_scope
));
202 rate_drop
->type
= cpu_to_le16(TLV_TYPE_RATE_DROP_CONTROL
);
203 rate_drop
->length
= cpu_to_le16(sizeof(rate_drop
->rate_drop_mode
));
204 rate_drop
->rate_drop_mode
= 0;
207 cpu_to_le16(S_DS_GEN
+ sizeof(struct host_cmd_ds_tx_rate_cfg
) +
208 sizeof(struct mwifiex_rate_scope
) +
209 sizeof(struct mwifiex_rate_drop_pattern
));
215 * This function prepares command to set/get Tx power configuration.
217 * Preparation includes -
218 * - Setting command ID, action and proper size
219 * - Setting Tx power mode, power group TLV
221 * - Ensuring correct endian-ness
223 static int mwifiex_cmd_tx_power_cfg(struct host_cmd_ds_command
*cmd
,
225 struct host_cmd_ds_txpwr_cfg
*txp
)
227 struct mwifiex_types_power_group
*pg_tlv
;
228 struct host_cmd_ds_txpwr_cfg
*cmd_txp_cfg
= &cmd
->params
.txp_cfg
;
230 cmd
->command
= cpu_to_le16(HostCmd_CMD_TXPWR_CFG
);
232 cpu_to_le16(S_DS_GEN
+ sizeof(struct host_cmd_ds_txpwr_cfg
));
233 switch (cmd_action
) {
234 case HostCmd_ACT_GEN_SET
:
236 pg_tlv
= (struct mwifiex_types_power_group
237 *) ((unsigned long) txp
+
238 sizeof(struct host_cmd_ds_txpwr_cfg
));
239 memmove(cmd_txp_cfg
, txp
,
240 sizeof(struct host_cmd_ds_txpwr_cfg
) +
241 sizeof(struct mwifiex_types_power_group
) +
244 pg_tlv
= (struct mwifiex_types_power_group
*) ((u8
*)
246 sizeof(struct host_cmd_ds_txpwr_cfg
));
247 cmd
->size
= cpu_to_le16(le16_to_cpu(cmd
->size
) +
248 sizeof(struct mwifiex_types_power_group
) +
251 memmove(cmd_txp_cfg
, txp
, sizeof(*txp
));
253 cmd_txp_cfg
->action
= cpu_to_le16(cmd_action
);
255 case HostCmd_ACT_GEN_GET
:
256 cmd_txp_cfg
->action
= cpu_to_le16(cmd_action
);
264 * This function prepares command to get RF Tx power.
266 static int mwifiex_cmd_rf_tx_power(struct mwifiex_private
*priv
,
267 struct host_cmd_ds_command
*cmd
,
268 u16 cmd_action
, void *data_buf
)
270 struct host_cmd_ds_rf_tx_pwr
*txp
= &cmd
->params
.txp
;
272 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_rf_tx_pwr
)
274 cmd
->command
= cpu_to_le16(HostCmd_CMD_RF_TX_PWR
);
275 txp
->action
= cpu_to_le16(cmd_action
);
281 * This function prepares command to set rf antenna.
283 static int mwifiex_cmd_rf_antenna(struct mwifiex_private
*priv
,
284 struct host_cmd_ds_command
*cmd
,
286 struct mwifiex_ds_ant_cfg
*ant_cfg
)
288 struct host_cmd_ds_rf_ant_mimo
*ant_mimo
= &cmd
->params
.ant_mimo
;
289 struct host_cmd_ds_rf_ant_siso
*ant_siso
= &cmd
->params
.ant_siso
;
291 cmd
->command
= cpu_to_le16(HostCmd_CMD_RF_ANTENNA
);
293 if (cmd_action
!= HostCmd_ACT_GEN_SET
)
296 if (priv
->adapter
->hw_dev_mcs_support
== HT_STREAM_2X2
) {
297 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_rf_ant_mimo
) +
299 ant_mimo
->action_tx
= cpu_to_le16(HostCmd_ACT_SET_TX
);
300 ant_mimo
->tx_ant_mode
= cpu_to_le16((u16
)ant_cfg
->tx_ant
);
301 ant_mimo
->action_rx
= cpu_to_le16(HostCmd_ACT_SET_RX
);
302 ant_mimo
->rx_ant_mode
= cpu_to_le16((u16
)ant_cfg
->rx_ant
);
304 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_rf_ant_siso
) +
306 ant_siso
->action
= cpu_to_le16(HostCmd_ACT_SET_BOTH
);
307 ant_siso
->ant_mode
= cpu_to_le16((u16
)ant_cfg
->tx_ant
);
314 * This function prepares command to set Host Sleep configuration.
316 * Preparation includes -
317 * - Setting command ID and proper size
318 * - Setting Host Sleep action, conditions, ARP filters
320 * - Ensuring correct endian-ness
323 mwifiex_cmd_802_11_hs_cfg(struct mwifiex_private
*priv
,
324 struct host_cmd_ds_command
*cmd
,
326 struct mwifiex_hs_config_param
*hscfg_param
)
328 struct mwifiex_adapter
*adapter
= priv
->adapter
;
329 struct host_cmd_ds_802_11_hs_cfg_enh
*hs_cfg
= &cmd
->params
.opt_hs_cfg
;
330 u16 hs_activate
= false;
333 /* New Activate command */
335 cmd
->command
= cpu_to_le16(HostCmd_CMD_802_11_HS_CFG_ENH
);
338 (hscfg_param
->conditions
!= cpu_to_le32(HS_CFG_CANCEL
)) &&
339 ((adapter
->arp_filter_size
> 0) &&
340 (adapter
->arp_filter_size
<= ARP_FILTER_MAX_BUF_SIZE
))) {
341 dev_dbg(adapter
->dev
,
342 "cmd: Attach %d bytes ArpFilter to HSCfg cmd\n",
343 adapter
->arp_filter_size
);
344 memcpy(((u8
*) hs_cfg
) +
345 sizeof(struct host_cmd_ds_802_11_hs_cfg_enh
),
346 adapter
->arp_filter
, adapter
->arp_filter_size
);
347 cmd
->size
= cpu_to_le16
348 (adapter
->arp_filter_size
+
349 sizeof(struct host_cmd_ds_802_11_hs_cfg_enh
)
352 cmd
->size
= cpu_to_le16(S_DS_GEN
+ sizeof(struct
353 host_cmd_ds_802_11_hs_cfg_enh
));
356 hs_cfg
->action
= cpu_to_le16(HS_ACTIVATE
);
357 hs_cfg
->params
.hs_activate
.resp_ctrl
= RESP_NEEDED
;
359 hs_cfg
->action
= cpu_to_le16(HS_CONFIGURE
);
360 hs_cfg
->params
.hs_config
.conditions
= hscfg_param
->conditions
;
361 hs_cfg
->params
.hs_config
.gpio
= hscfg_param
->gpio
;
362 hs_cfg
->params
.hs_config
.gap
= hscfg_param
->gap
;
363 dev_dbg(adapter
->dev
,
364 "cmd: HS_CFG_CMD: condition:0x%x gpio:0x%x gap:0x%x\n",
365 hs_cfg
->params
.hs_config
.conditions
,
366 hs_cfg
->params
.hs_config
.gpio
,
367 hs_cfg
->params
.hs_config
.gap
);
374 * This function prepares command to set/get MAC address.
376 * Preparation includes -
377 * - Setting command ID, action and proper size
378 * - Setting MAC address (for SET only)
379 * - Ensuring correct endian-ness
381 static int mwifiex_cmd_802_11_mac_address(struct mwifiex_private
*priv
,
382 struct host_cmd_ds_command
*cmd
,
385 cmd
->command
= cpu_to_le16(HostCmd_CMD_802_11_MAC_ADDRESS
);
386 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_802_11_mac_address
) +
390 cmd
->params
.mac_addr
.action
= cpu_to_le16(cmd_action
);
392 if (cmd_action
== HostCmd_ACT_GEN_SET
)
393 memcpy(cmd
->params
.mac_addr
.mac_addr
, priv
->curr_addr
,
399 * This function prepares command to set MAC multicast address.
401 * Preparation includes -
402 * - Setting command ID, action and proper size
403 * - Setting MAC multicast address
404 * - Ensuring correct endian-ness
407 mwifiex_cmd_mac_multicast_adr(struct host_cmd_ds_command
*cmd
,
409 struct mwifiex_multicast_list
*mcast_list
)
411 struct host_cmd_ds_mac_multicast_adr
*mcast_addr
= &cmd
->params
.mc_addr
;
413 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_mac_multicast_adr
) +
415 cmd
->command
= cpu_to_le16(HostCmd_CMD_MAC_MULTICAST_ADR
);
417 mcast_addr
->action
= cpu_to_le16(cmd_action
);
418 mcast_addr
->num_of_adrs
=
419 cpu_to_le16((u16
) mcast_list
->num_multicast_addr
);
420 memcpy(mcast_addr
->mac_list
, mcast_list
->mac_list
,
421 mcast_list
->num_multicast_addr
* ETH_ALEN
);
427 * This function prepares command to deauthenticate.
429 * Preparation includes -
430 * - Setting command ID and proper size
431 * - Setting AP MAC address and reason code
432 * - Ensuring correct endian-ness
434 static int mwifiex_cmd_802_11_deauthenticate(struct mwifiex_private
*priv
,
435 struct host_cmd_ds_command
*cmd
,
438 struct host_cmd_ds_802_11_deauthenticate
*deauth
= &cmd
->params
.deauth
;
440 cmd
->command
= cpu_to_le16(HostCmd_CMD_802_11_DEAUTHENTICATE
);
441 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_802_11_deauthenticate
)
444 /* Set AP MAC address */
445 memcpy(deauth
->mac_addr
, mac
, ETH_ALEN
);
447 dev_dbg(priv
->adapter
->dev
, "cmd: Deauth: %pM\n", deauth
->mac_addr
);
449 deauth
->reason_code
= cpu_to_le16(WLAN_REASON_DEAUTH_LEAVING
);
455 * This function prepares command to stop Ad-Hoc network.
457 * Preparation includes -
458 * - Setting command ID and proper size
459 * - Ensuring correct endian-ness
461 static int mwifiex_cmd_802_11_ad_hoc_stop(struct host_cmd_ds_command
*cmd
)
463 cmd
->command
= cpu_to_le16(HostCmd_CMD_802_11_AD_HOC_STOP
);
464 cmd
->size
= cpu_to_le16(S_DS_GEN
);
469 * This function sets WEP key(s) to key parameter TLV(s).
471 * Multi-key parameter TLVs are supported, so we can send multiple
472 * WEP keys in a single buffer.
475 mwifiex_set_keyparamset_wep(struct mwifiex_private
*priv
,
476 struct mwifiex_ie_type_key_param_set
*key_param_set
,
479 int cur_key_param_len
;
482 /* Multi-key_param_set TLV is supported */
483 for (i
= 0; i
< NUM_WEP_KEYS
; i
++) {
484 if ((priv
->wep_key
[i
].key_length
== WLAN_KEY_LEN_WEP40
) ||
485 (priv
->wep_key
[i
].key_length
== WLAN_KEY_LEN_WEP104
)) {
486 key_param_set
->type
=
487 cpu_to_le16(TLV_TYPE_KEY_MATERIAL
);
488 /* Key_param_set WEP fixed length */
489 #define KEYPARAMSET_WEP_FIXED_LEN 8
490 key_param_set
->length
= cpu_to_le16((u16
)
493 KEYPARAMSET_WEP_FIXED_LEN
));
494 key_param_set
->key_type_id
=
495 cpu_to_le16(KEY_TYPE_ID_WEP
);
496 key_param_set
->key_info
=
497 cpu_to_le16(KEY_ENABLED
| KEY_UNICAST
|
499 key_param_set
->key_len
=
500 cpu_to_le16(priv
->wep_key
[i
].key_length
);
501 /* Set WEP key index */
502 key_param_set
->key
[0] = i
;
503 /* Set default Tx key flag */
506 wep_key_curr_index
& HostCmd_WEP_KEY_INDEX_MASK
))
507 key_param_set
->key
[1] = 1;
509 key_param_set
->key
[1] = 0;
510 memmove(&key_param_set
->key
[2],
511 priv
->wep_key
[i
].key_material
,
512 priv
->wep_key
[i
].key_length
);
514 cur_key_param_len
= priv
->wep_key
[i
].key_length
+
515 KEYPARAMSET_WEP_FIXED_LEN
+
516 sizeof(struct mwifiex_ie_types_header
);
517 *key_param_len
+= (u16
) cur_key_param_len
;
519 (struct mwifiex_ie_type_key_param_set
*)
520 ((u8
*)key_param_set
+
522 } else if (!priv
->wep_key
[i
].key_length
) {
525 dev_err(priv
->adapter
->dev
,
526 "key%d Length = %d is incorrect\n",
527 (i
+ 1), priv
->wep_key
[i
].key_length
);
536 * This function prepares command to set/get/reset network key(s).
538 * Preparation includes -
539 * - Setting command ID, action and proper size
540 * - Setting WEP keys, WAPI keys or WPA keys along with required
541 * encryption (TKIP, AES) (as required)
542 * - Ensuring correct endian-ness
545 mwifiex_cmd_802_11_key_material(struct mwifiex_private
*priv
,
546 struct host_cmd_ds_command
*cmd
,
547 u16 cmd_action
, u32 cmd_oid
,
548 struct mwifiex_ds_encrypt_key
*enc_key
)
550 struct host_cmd_ds_802_11_key_material
*key_material
=
551 &cmd
->params
.key_material
;
552 struct host_cmd_tlv_mac_addr
*tlv_mac
;
553 u16 key_param_len
= 0, cmd_size
;
556 cmd
->command
= cpu_to_le16(HostCmd_CMD_802_11_KEY_MATERIAL
);
557 key_material
->action
= cpu_to_le16(cmd_action
);
559 if (cmd_action
== HostCmd_ACT_GEN_GET
) {
561 cpu_to_le16(sizeof(key_material
->action
) + S_DS_GEN
);
566 memset(&key_material
->key_param_set
, 0,
568 sizeof(struct mwifiex_ie_type_key_param_set
)));
569 ret
= mwifiex_set_keyparamset_wep(priv
,
570 &key_material
->key_param_set
,
572 cmd
->size
= cpu_to_le16(key_param_len
+
573 sizeof(key_material
->action
) + S_DS_GEN
);
576 memset(&key_material
->key_param_set
, 0,
577 sizeof(struct mwifiex_ie_type_key_param_set
));
578 if (enc_key
->is_wapi_key
) {
579 dev_dbg(priv
->adapter
->dev
, "info: Set WAPI Key\n");
580 key_material
->key_param_set
.key_type_id
=
581 cpu_to_le16(KEY_TYPE_ID_WAPI
);
582 if (cmd_oid
== KEY_INFO_ENABLED
)
583 key_material
->key_param_set
.key_info
=
584 cpu_to_le16(KEY_ENABLED
);
586 key_material
->key_param_set
.key_info
=
587 cpu_to_le16(!KEY_ENABLED
);
589 key_material
->key_param_set
.key
[0] = enc_key
->key_index
;
590 if (!priv
->sec_info
.wapi_key_on
)
591 key_material
->key_param_set
.key
[1] = 1;
593 /* set 0 when re-key */
594 key_material
->key_param_set
.key
[1] = 0;
596 if (!is_broadcast_ether_addr(enc_key
->mac_addr
)) {
597 /* WAPI pairwise key: unicast */
598 key_material
->key_param_set
.key_info
|=
599 cpu_to_le16(KEY_UNICAST
);
600 } else { /* WAPI group key: multicast */
601 key_material
->key_param_set
.key_info
|=
602 cpu_to_le16(KEY_MCAST
);
603 priv
->sec_info
.wapi_key_on
= true;
606 key_material
->key_param_set
.type
=
607 cpu_to_le16(TLV_TYPE_KEY_MATERIAL
);
608 key_material
->key_param_set
.key_len
=
609 cpu_to_le16(WAPI_KEY_LEN
);
610 memcpy(&key_material
->key_param_set
.key
[2],
611 enc_key
->key_material
, enc_key
->key_len
);
612 memcpy(&key_material
->key_param_set
.key
[2 + enc_key
->key_len
],
613 enc_key
->pn
, PN_LEN
);
614 key_material
->key_param_set
.length
=
615 cpu_to_le16(WAPI_KEY_LEN
+ KEYPARAMSET_FIXED_LEN
);
617 key_param_len
= (WAPI_KEY_LEN
+ KEYPARAMSET_FIXED_LEN
) +
618 sizeof(struct mwifiex_ie_types_header
);
619 cmd
->size
= cpu_to_le16(sizeof(key_material
->action
)
620 + S_DS_GEN
+ key_param_len
);
623 if (enc_key
->key_len
== WLAN_KEY_LEN_CCMP
) {
624 if (enc_key
->is_igtk_key
) {
625 dev_dbg(priv
->adapter
->dev
, "cmd: CMAC_AES\n");
626 key_material
->key_param_set
.key_type_id
=
627 cpu_to_le16(KEY_TYPE_ID_AES_CMAC
);
628 if (cmd_oid
== KEY_INFO_ENABLED
)
629 key_material
->key_param_set
.key_info
=
630 cpu_to_le16(KEY_ENABLED
);
632 key_material
->key_param_set
.key_info
=
633 cpu_to_le16(!KEY_ENABLED
);
635 key_material
->key_param_set
.key_info
|=
636 cpu_to_le16(KEY_IGTK
);
638 dev_dbg(priv
->adapter
->dev
, "cmd: WPA_AES\n");
639 key_material
->key_param_set
.key_type_id
=
640 cpu_to_le16(KEY_TYPE_ID_AES
);
641 if (cmd_oid
== KEY_INFO_ENABLED
)
642 key_material
->key_param_set
.key_info
=
643 cpu_to_le16(KEY_ENABLED
);
645 key_material
->key_param_set
.key_info
=
646 cpu_to_le16(!KEY_ENABLED
);
648 if (enc_key
->key_index
& MWIFIEX_KEY_INDEX_UNICAST
)
649 /* AES pairwise key: unicast */
650 key_material
->key_param_set
.key_info
|=
651 cpu_to_le16(KEY_UNICAST
);
652 else /* AES group key: multicast */
653 key_material
->key_param_set
.key_info
|=
654 cpu_to_le16(KEY_MCAST
);
656 } else if (enc_key
->key_len
== WLAN_KEY_LEN_TKIP
) {
657 dev_dbg(priv
->adapter
->dev
, "cmd: WPA_TKIP\n");
658 key_material
->key_param_set
.key_type_id
=
659 cpu_to_le16(KEY_TYPE_ID_TKIP
);
660 key_material
->key_param_set
.key_info
=
661 cpu_to_le16(KEY_ENABLED
);
663 if (enc_key
->key_index
& MWIFIEX_KEY_INDEX_UNICAST
)
664 /* TKIP pairwise key: unicast */
665 key_material
->key_param_set
.key_info
|=
666 cpu_to_le16(KEY_UNICAST
);
667 else /* TKIP group key: multicast */
668 key_material
->key_param_set
.key_info
|=
669 cpu_to_le16(KEY_MCAST
);
672 if (key_material
->key_param_set
.key_type_id
) {
673 key_material
->key_param_set
.type
=
674 cpu_to_le16(TLV_TYPE_KEY_MATERIAL
);
675 key_material
->key_param_set
.key_len
=
676 cpu_to_le16((u16
) enc_key
->key_len
);
677 memcpy(key_material
->key_param_set
.key
, enc_key
->key_material
,
679 key_material
->key_param_set
.length
=
680 cpu_to_le16((u16
) enc_key
->key_len
+
681 KEYPARAMSET_FIXED_LEN
);
683 key_param_len
= (u16
)(enc_key
->key_len
+ KEYPARAMSET_FIXED_LEN
)
684 + sizeof(struct mwifiex_ie_types_header
);
686 if (le16_to_cpu(key_material
->key_param_set
.key_type_id
) ==
687 KEY_TYPE_ID_AES_CMAC
) {
688 struct mwifiex_cmac_param
*param
=
689 (void *)key_material
->key_param_set
.key
;
691 memcpy(param
->ipn
, enc_key
->pn
, IGTK_PN_LEN
);
692 memcpy(param
->key
, enc_key
->key_material
,
693 WLAN_KEY_LEN_AES_CMAC
);
695 key_param_len
= sizeof(struct mwifiex_cmac_param
);
696 key_material
->key_param_set
.key_len
=
697 cpu_to_le16(key_param_len
);
698 key_param_len
+= KEYPARAMSET_FIXED_LEN
;
699 key_material
->key_param_set
.length
=
700 cpu_to_le16(key_param_len
);
701 key_param_len
+= sizeof(struct mwifiex_ie_types_header
);
704 cmd
->size
= cpu_to_le16(sizeof(key_material
->action
) + S_DS_GEN
707 if (priv
->bss_type
== MWIFIEX_BSS_TYPE_UAP
) {
708 tlv_mac
= (void *)((u8
*)&key_material
->key_param_set
+
710 tlv_mac
->header
.type
=
711 cpu_to_le16(TLV_TYPE_STA_MAC_ADDR
);
712 tlv_mac
->header
.len
= cpu_to_le16(ETH_ALEN
);
713 memcpy(tlv_mac
->mac_addr
, enc_key
->mac_addr
, ETH_ALEN
);
714 cmd_size
= key_param_len
+ S_DS_GEN
+
715 sizeof(key_material
->action
) +
716 sizeof(struct host_cmd_tlv_mac_addr
);
718 cmd_size
= key_param_len
+ S_DS_GEN
+
719 sizeof(key_material
->action
);
721 cmd
->size
= cpu_to_le16(cmd_size
);
728 * This function prepares command to set/get 11d domain information.
730 * Preparation includes -
731 * - Setting command ID, action and proper size
732 * - Setting domain information fields (for SET only)
733 * - Ensuring correct endian-ness
735 static int mwifiex_cmd_802_11d_domain_info(struct mwifiex_private
*priv
,
736 struct host_cmd_ds_command
*cmd
,
739 struct mwifiex_adapter
*adapter
= priv
->adapter
;
740 struct host_cmd_ds_802_11d_domain_info
*domain_info
=
741 &cmd
->params
.domain_info
;
742 struct mwifiex_ietypes_domain_param_set
*domain
=
743 &domain_info
->domain
;
744 u8 no_of_triplet
= adapter
->domain_reg
.no_of_triplet
;
746 dev_dbg(adapter
->dev
, "info: 11D: no_of_triplet=0x%x\n", no_of_triplet
);
748 cmd
->command
= cpu_to_le16(HostCmd_CMD_802_11D_DOMAIN_INFO
);
749 domain_info
->action
= cpu_to_le16(cmd_action
);
750 if (cmd_action
== HostCmd_ACT_GEN_GET
) {
751 cmd
->size
= cpu_to_le16(sizeof(domain_info
->action
) + S_DS_GEN
);
755 /* Set domain info fields */
756 domain
->header
.type
= cpu_to_le16(WLAN_EID_COUNTRY
);
757 memcpy(domain
->country_code
, adapter
->domain_reg
.country_code
,
758 sizeof(domain
->country_code
));
761 cpu_to_le16((no_of_triplet
*
762 sizeof(struct ieee80211_country_ie_triplet
))
763 + sizeof(domain
->country_code
));
766 memcpy(domain
->triplet
, adapter
->domain_reg
.triplet
,
767 no_of_triplet
* sizeof(struct
768 ieee80211_country_ie_triplet
));
770 cmd
->size
= cpu_to_le16(sizeof(domain_info
->action
) +
771 le16_to_cpu(domain
->header
.len
) +
772 sizeof(struct mwifiex_ie_types_header
)
775 cmd
->size
= cpu_to_le16(sizeof(domain_info
->action
) + S_DS_GEN
);
782 * This function prepares command to set/get IBSS coalescing status.
784 * Preparation includes -
785 * - Setting command ID, action and proper size
786 * - Setting status to enable or disable (for SET only)
787 * - Ensuring correct endian-ness
789 static int mwifiex_cmd_ibss_coalescing_status(struct host_cmd_ds_command
*cmd
,
790 u16 cmd_action
, u16
*enable
)
792 struct host_cmd_ds_802_11_ibss_status
*ibss_coal
=
793 &(cmd
->params
.ibss_coalescing
);
795 cmd
->command
= cpu_to_le16(HostCmd_CMD_802_11_IBSS_COALESCING_STATUS
);
796 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_802_11_ibss_status
) +
799 ibss_coal
->action
= cpu_to_le16(cmd_action
);
801 switch (cmd_action
) {
802 case HostCmd_ACT_GEN_SET
:
804 ibss_coal
->enable
= cpu_to_le16(*enable
);
806 ibss_coal
->enable
= 0;
809 /* In other case.. Nothing to do */
810 case HostCmd_ACT_GEN_GET
:
819 * This function prepares command to set/get register value.
821 * Preparation includes -
822 * - Setting command ID, action and proper size
823 * - Setting register offset (for both GET and SET) and
824 * register value (for SET only)
825 * - Ensuring correct endian-ness
827 * The following type of registers can be accessed with this function -
835 static int mwifiex_cmd_reg_access(struct host_cmd_ds_command
*cmd
,
836 u16 cmd_action
, void *data_buf
)
838 struct mwifiex_ds_reg_rw
*reg_rw
= data_buf
;
840 switch (le16_to_cpu(cmd
->command
)) {
841 case HostCmd_CMD_MAC_REG_ACCESS
:
843 struct host_cmd_ds_mac_reg_access
*mac_reg
;
845 cmd
->size
= cpu_to_le16(sizeof(*mac_reg
) + S_DS_GEN
);
846 mac_reg
= &cmd
->params
.mac_reg
;
847 mac_reg
->action
= cpu_to_le16(cmd_action
);
849 cpu_to_le16((u16
) le32_to_cpu(reg_rw
->offset
));
850 mac_reg
->value
= reg_rw
->value
;
853 case HostCmd_CMD_BBP_REG_ACCESS
:
855 struct host_cmd_ds_bbp_reg_access
*bbp_reg
;
857 cmd
->size
= cpu_to_le16(sizeof(*bbp_reg
) + S_DS_GEN
);
858 bbp_reg
= &cmd
->params
.bbp_reg
;
859 bbp_reg
->action
= cpu_to_le16(cmd_action
);
861 cpu_to_le16((u16
) le32_to_cpu(reg_rw
->offset
));
862 bbp_reg
->value
= (u8
) le32_to_cpu(reg_rw
->value
);
865 case HostCmd_CMD_RF_REG_ACCESS
:
867 struct host_cmd_ds_rf_reg_access
*rf_reg
;
869 cmd
->size
= cpu_to_le16(sizeof(*rf_reg
) + S_DS_GEN
);
870 rf_reg
= &cmd
->params
.rf_reg
;
871 rf_reg
->action
= cpu_to_le16(cmd_action
);
872 rf_reg
->offset
= cpu_to_le16((u16
) le32_to_cpu(reg_rw
->offset
));
873 rf_reg
->value
= (u8
) le32_to_cpu(reg_rw
->value
);
876 case HostCmd_CMD_PMIC_REG_ACCESS
:
878 struct host_cmd_ds_pmic_reg_access
*pmic_reg
;
880 cmd
->size
= cpu_to_le16(sizeof(*pmic_reg
) + S_DS_GEN
);
881 pmic_reg
= &cmd
->params
.pmic_reg
;
882 pmic_reg
->action
= cpu_to_le16(cmd_action
);
884 cpu_to_le16((u16
) le32_to_cpu(reg_rw
->offset
));
885 pmic_reg
->value
= (u8
) le32_to_cpu(reg_rw
->value
);
888 case HostCmd_CMD_CAU_REG_ACCESS
:
890 struct host_cmd_ds_rf_reg_access
*cau_reg
;
892 cmd
->size
= cpu_to_le16(sizeof(*cau_reg
) + S_DS_GEN
);
893 cau_reg
= &cmd
->params
.rf_reg
;
894 cau_reg
->action
= cpu_to_le16(cmd_action
);
896 cpu_to_le16((u16
) le32_to_cpu(reg_rw
->offset
));
897 cau_reg
->value
= (u8
) le32_to_cpu(reg_rw
->value
);
900 case HostCmd_CMD_802_11_EEPROM_ACCESS
:
902 struct mwifiex_ds_read_eeprom
*rd_eeprom
= data_buf
;
903 struct host_cmd_ds_802_11_eeprom_access
*cmd_eeprom
=
906 cmd
->size
= cpu_to_le16(sizeof(*cmd_eeprom
) + S_DS_GEN
);
907 cmd_eeprom
->action
= cpu_to_le16(cmd_action
);
908 cmd_eeprom
->offset
= rd_eeprom
->offset
;
909 cmd_eeprom
->byte_count
= rd_eeprom
->byte_count
;
910 cmd_eeprom
->value
= 0;
921 * This function prepares command to set PCI-Express
922 * host buffer configuration
924 * Preparation includes -
925 * - Setting command ID, action and proper size
926 * - Setting host buffer configuration
927 * - Ensuring correct endian-ness
930 mwifiex_cmd_pcie_host_spec(struct mwifiex_private
*priv
,
931 struct host_cmd_ds_command
*cmd
, u16 action
)
933 struct host_cmd_ds_pcie_details
*host_spec
=
934 &cmd
->params
.pcie_host_spec
;
935 struct pcie_service_card
*card
= priv
->adapter
->card
;
937 cmd
->command
= cpu_to_le16(HostCmd_CMD_PCIE_DESC_DETAILS
);
938 cmd
->size
= cpu_to_le16(sizeof(struct
939 host_cmd_ds_pcie_details
) + S_DS_GEN
);
942 memset(host_spec
, 0, sizeof(struct host_cmd_ds_pcie_details
));
944 if (action
!= HostCmd_ACT_GEN_SET
)
947 /* Send the ring base addresses and count to firmware */
948 host_spec
->txbd_addr_lo
= (u32
)(card
->txbd_ring_pbase
);
949 host_spec
->txbd_addr_hi
= (u32
)(((u64
)card
->txbd_ring_pbase
)>>32);
950 host_spec
->txbd_count
= MWIFIEX_MAX_TXRX_BD
;
951 host_spec
->rxbd_addr_lo
= (u32
)(card
->rxbd_ring_pbase
);
952 host_spec
->rxbd_addr_hi
= (u32
)(((u64
)card
->rxbd_ring_pbase
)>>32);
953 host_spec
->rxbd_count
= MWIFIEX_MAX_TXRX_BD
;
954 host_spec
->evtbd_addr_lo
= (u32
)(card
->evtbd_ring_pbase
);
955 host_spec
->evtbd_addr_hi
= (u32
)(((u64
)card
->evtbd_ring_pbase
)>>32);
956 host_spec
->evtbd_count
= MWIFIEX_MAX_EVT_BD
;
957 if (card
->sleep_cookie_vbase
) {
958 host_spec
->sleep_cookie_addr_lo
=
959 (u32
)(card
->sleep_cookie_pbase
);
960 host_spec
->sleep_cookie_addr_hi
=
961 (u32
)(((u64
)(card
->sleep_cookie_pbase
)) >> 32);
962 dev_dbg(priv
->adapter
->dev
, "sleep_cook_lo phy addr: 0x%x\n",
963 host_spec
->sleep_cookie_addr_lo
);
970 * This function prepares command for event subscription, configuration
971 * and query. Events can be subscribed or unsubscribed. Current subscribed
972 * events can be queried. Also, current subscribed events are reported in
976 mwifiex_cmd_802_11_subsc_evt(struct mwifiex_private
*priv
,
977 struct host_cmd_ds_command
*cmd
,
978 struct mwifiex_ds_misc_subsc_evt
*subsc_evt_cfg
)
980 struct host_cmd_ds_802_11_subsc_evt
*subsc_evt
= &cmd
->params
.subsc_evt
;
981 struct mwifiex_ie_types_rssi_threshold
*rssi_tlv
;
985 cmd
->command
= cpu_to_le16(HostCmd_CMD_802_11_SUBSCRIBE_EVENT
);
986 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_802_11_subsc_evt
) +
989 subsc_evt
->action
= cpu_to_le16(subsc_evt_cfg
->action
);
990 dev_dbg(priv
->adapter
->dev
, "cmd: action: %d\n", subsc_evt_cfg
->action
);
992 /*For query requests, no configuration TLV structures are to be added.*/
993 if (subsc_evt_cfg
->action
== HostCmd_ACT_GEN_GET
)
996 subsc_evt
->events
= cpu_to_le16(subsc_evt_cfg
->events
);
998 event_bitmap
= subsc_evt_cfg
->events
;
999 dev_dbg(priv
->adapter
->dev
, "cmd: event bitmap : %16x\n",
1002 if (((subsc_evt_cfg
->action
== HostCmd_ACT_BITWISE_CLR
) ||
1003 (subsc_evt_cfg
->action
== HostCmd_ACT_BITWISE_SET
)) &&
1004 (event_bitmap
== 0)) {
1005 dev_dbg(priv
->adapter
->dev
, "Error: No event specified "
1006 "for bitwise action type\n");
1011 * Append TLV structures for each of the specified events for
1012 * subscribing or re-configuring. This is not required for
1013 * bitwise unsubscribing request.
1015 if (subsc_evt_cfg
->action
== HostCmd_ACT_BITWISE_CLR
)
1018 pos
= ((u8
*)subsc_evt
) +
1019 sizeof(struct host_cmd_ds_802_11_subsc_evt
);
1021 if (event_bitmap
& BITMASK_BCN_RSSI_LOW
) {
1022 rssi_tlv
= (struct mwifiex_ie_types_rssi_threshold
*) pos
;
1024 rssi_tlv
->header
.type
= cpu_to_le16(TLV_TYPE_RSSI_LOW
);
1025 rssi_tlv
->header
.len
=
1026 cpu_to_le16(sizeof(struct mwifiex_ie_types_rssi_threshold
) -
1027 sizeof(struct mwifiex_ie_types_header
));
1028 rssi_tlv
->abs_value
= subsc_evt_cfg
->bcn_l_rssi_cfg
.abs_value
;
1029 rssi_tlv
->evt_freq
= subsc_evt_cfg
->bcn_l_rssi_cfg
.evt_freq
;
1031 dev_dbg(priv
->adapter
->dev
, "Cfg Beacon Low Rssi event, "
1032 "RSSI:-%d dBm, Freq:%d\n",
1033 subsc_evt_cfg
->bcn_l_rssi_cfg
.abs_value
,
1034 subsc_evt_cfg
->bcn_l_rssi_cfg
.evt_freq
);
1036 pos
+= sizeof(struct mwifiex_ie_types_rssi_threshold
);
1037 le16_add_cpu(&cmd
->size
,
1038 sizeof(struct mwifiex_ie_types_rssi_threshold
));
1041 if (event_bitmap
& BITMASK_BCN_RSSI_HIGH
) {
1042 rssi_tlv
= (struct mwifiex_ie_types_rssi_threshold
*) pos
;
1044 rssi_tlv
->header
.type
= cpu_to_le16(TLV_TYPE_RSSI_HIGH
);
1045 rssi_tlv
->header
.len
=
1046 cpu_to_le16(sizeof(struct mwifiex_ie_types_rssi_threshold
) -
1047 sizeof(struct mwifiex_ie_types_header
));
1048 rssi_tlv
->abs_value
= subsc_evt_cfg
->bcn_h_rssi_cfg
.abs_value
;
1049 rssi_tlv
->evt_freq
= subsc_evt_cfg
->bcn_h_rssi_cfg
.evt_freq
;
1051 dev_dbg(priv
->adapter
->dev
, "Cfg Beacon High Rssi event, "
1052 "RSSI:-%d dBm, Freq:%d\n",
1053 subsc_evt_cfg
->bcn_h_rssi_cfg
.abs_value
,
1054 subsc_evt_cfg
->bcn_h_rssi_cfg
.evt_freq
);
1056 pos
+= sizeof(struct mwifiex_ie_types_rssi_threshold
);
1057 le16_add_cpu(&cmd
->size
,
1058 sizeof(struct mwifiex_ie_types_rssi_threshold
));
1065 mwifiex_cmd_append_rpn_expression(struct mwifiex_private
*priv
,
1066 struct mwifiex_mef_entry
*mef_entry
,
1069 struct mwifiex_mef_filter
*filter
= mef_entry
->filter
;
1071 u8
*stack_ptr
= *buffer
;
1073 for (i
= 0; i
< MWIFIEX_MEF_MAX_FILTERS
; i
++) {
1074 filter
= &mef_entry
->filter
[i
];
1075 if (!filter
->filt_type
)
1077 *(__le32
*)stack_ptr
= cpu_to_le32((u32
)filter
->repeat
);
1079 *stack_ptr
= TYPE_DNUM
;
1082 byte_len
= filter
->byte_seq
[MWIFIEX_MEF_MAX_BYTESEQ
];
1083 memcpy(stack_ptr
, filter
->byte_seq
, byte_len
);
1084 stack_ptr
+= byte_len
;
1085 *stack_ptr
= byte_len
;
1087 *stack_ptr
= TYPE_BYTESEQ
;
1090 *(__le32
*)stack_ptr
= cpu_to_le32((u32
)filter
->offset
);
1092 *stack_ptr
= TYPE_DNUM
;
1095 *stack_ptr
= filter
->filt_type
;
1098 if (filter
->filt_action
) {
1099 *stack_ptr
= filter
->filt_action
;
1103 if (stack_ptr
- *buffer
> STACK_NBYTES
)
1107 *buffer
= stack_ptr
;
1112 mwifiex_cmd_mef_cfg(struct mwifiex_private
*priv
,
1113 struct host_cmd_ds_command
*cmd
,
1114 struct mwifiex_ds_mef_cfg
*mef
)
1116 struct host_cmd_ds_mef_cfg
*mef_cfg
= &cmd
->params
.mef_cfg
;
1117 u8
*pos
= (u8
*)mef_cfg
;
1119 cmd
->command
= cpu_to_le16(HostCmd_CMD_MEF_CFG
);
1121 mef_cfg
->criteria
= cpu_to_le32(mef
->criteria
);
1122 mef_cfg
->num_entries
= cpu_to_le16(mef
->num_entries
);
1123 pos
+= sizeof(*mef_cfg
);
1124 mef_cfg
->mef_entry
->mode
= mef
->mef_entry
->mode
;
1125 mef_cfg
->mef_entry
->action
= mef
->mef_entry
->action
;
1126 pos
+= sizeof(*(mef_cfg
->mef_entry
));
1128 if (mwifiex_cmd_append_rpn_expression(priv
, mef
->mef_entry
, &pos
))
1131 mef_cfg
->mef_entry
->exprsize
=
1132 cpu_to_le16(pos
- mef_cfg
->mef_entry
->expr
);
1133 cmd
->size
= cpu_to_le16((u16
) (pos
- (u8
*)mef_cfg
) + S_DS_GEN
);
1138 /* This function parse cal data from ASCII to hex */
1139 static u32
mwifiex_parse_cal_cfg(u8
*src
, size_t len
, u8
*dst
)
1141 u8
*s
= src
, *d
= dst
;
1143 while (s
- src
< len
) {
1144 if (*s
&& (isspace(*s
) || *s
== '\t')) {
1149 *d
++ = simple_strtol(s
, NULL
, 16);
1159 /* This function prepares command of set_cfg_data. */
1160 static int mwifiex_cmd_cfg_data(struct mwifiex_private
*priv
,
1161 struct host_cmd_ds_command
*cmd
,
1164 struct host_cmd_ds_802_11_cfg_data
*cfg_data
= &cmd
->params
.cfg_data
;
1165 struct mwifiex_adapter
*adapter
= priv
->adapter
;
1166 u32 len
, cal_data_offset
;
1167 u8
*tmp_cmd
= (u8
*)cmd
;
1169 cal_data_offset
= S_DS_GEN
+ sizeof(*cfg_data
);
1170 if ((adapter
->cal_data
->data
) && (adapter
->cal_data
->size
> 0))
1171 len
= mwifiex_parse_cal_cfg((u8
*)adapter
->cal_data
->data
,
1172 adapter
->cal_data
->size
,
1173 (u8
*)(tmp_cmd
+ cal_data_offset
));
1177 cfg_data
->action
= cpu_to_le16(cmd_action
);
1178 cfg_data
->type
= cpu_to_le16(CFG_DATA_TYPE_CAL
);
1179 cfg_data
->data_len
= cpu_to_le16(len
);
1181 cmd
->command
= cpu_to_le16(HostCmd_CMD_CFG_DATA
);
1182 cmd
->size
= cpu_to_le16(S_DS_GEN
+ sizeof(*cfg_data
) + len
);
1188 mwifiex_cmd_coalesce_cfg(struct mwifiex_private
*priv
,
1189 struct host_cmd_ds_command
*cmd
,
1190 u16 cmd_action
, void *data_buf
)
1192 struct host_cmd_ds_coalesce_cfg
*coalesce_cfg
=
1193 &cmd
->params
.coalesce_cfg
;
1194 struct mwifiex_ds_coalesce_cfg
*cfg
= data_buf
;
1195 struct coalesce_filt_field_param
*param
;
1196 u16 cnt
, idx
, length
;
1197 struct coalesce_receive_filt_rule
*rule
;
1199 cmd
->command
= cpu_to_le16(HostCmd_CMD_COALESCE_CFG
);
1200 cmd
->size
= cpu_to_le16(S_DS_GEN
);
1202 coalesce_cfg
->action
= cpu_to_le16(cmd_action
);
1203 coalesce_cfg
->num_of_rules
= cpu_to_le16(cfg
->num_of_rules
);
1204 rule
= coalesce_cfg
->rule
;
1206 for (cnt
= 0; cnt
< cfg
->num_of_rules
; cnt
++) {
1207 rule
->header
.type
= cpu_to_le16(TLV_TYPE_COALESCE_RULE
);
1208 rule
->max_coalescing_delay
=
1209 cpu_to_le16(cfg
->rule
[cnt
].max_coalescing_delay
);
1210 rule
->pkt_type
= cfg
->rule
[cnt
].pkt_type
;
1211 rule
->num_of_fields
= cfg
->rule
[cnt
].num_of_fields
;
1215 param
= rule
->params
;
1216 for (idx
= 0; idx
< cfg
->rule
[cnt
].num_of_fields
; idx
++) {
1217 param
->operation
= cfg
->rule
[cnt
].params
[idx
].operation
;
1218 param
->operand_len
=
1219 cfg
->rule
[cnt
].params
[idx
].operand_len
;
1221 cpu_to_le16(cfg
->rule
[cnt
].params
[idx
].offset
);
1222 memcpy(param
->operand_byte_stream
,
1223 cfg
->rule
[cnt
].params
[idx
].operand_byte_stream
,
1224 param
->operand_len
);
1226 length
+= sizeof(struct coalesce_filt_field_param
);
1231 /* Total rule length is sizeof max_coalescing_delay(u16),
1232 * num_of_fields(u8), pkt_type(u8) and total length of the all
1235 rule
->header
.len
= cpu_to_le16(length
+ sizeof(u16
) +
1236 sizeof(u8
) + sizeof(u8
));
1238 /* Add the rule length to the command size*/
1239 le16_add_cpu(&cmd
->size
, le16_to_cpu(rule
->header
.len
) +
1240 sizeof(struct mwifiex_ie_types_header
));
1242 rule
= (void *)((u8
*)rule
->params
+ length
);
1245 /* Add sizeof action, num_of_rules to total command length */
1246 le16_add_cpu(&cmd
->size
, sizeof(u16
) + sizeof(u16
));
1252 * This function prepares the commands before sending them to the firmware.
1254 * This is a generic function which calls specific command preparation
1255 * routines based upon the command number.
1257 int mwifiex_sta_prepare_cmd(struct mwifiex_private
*priv
, uint16_t cmd_no
,
1258 u16 cmd_action
, u32 cmd_oid
,
1259 void *data_buf
, void *cmd_buf
)
1261 struct host_cmd_ds_command
*cmd_ptr
= cmd_buf
;
1264 /* Prepare command */
1266 case HostCmd_CMD_GET_HW_SPEC
:
1267 ret
= mwifiex_cmd_get_hw_spec(priv
, cmd_ptr
);
1269 case HostCmd_CMD_CFG_DATA
:
1270 ret
= mwifiex_cmd_cfg_data(priv
, cmd_ptr
, cmd_action
);
1272 case HostCmd_CMD_MAC_CONTROL
:
1273 ret
= mwifiex_cmd_mac_control(priv
, cmd_ptr
, cmd_action
,
1276 case HostCmd_CMD_802_11_MAC_ADDRESS
:
1277 ret
= mwifiex_cmd_802_11_mac_address(priv
, cmd_ptr
,
1280 case HostCmd_CMD_MAC_MULTICAST_ADR
:
1281 ret
= mwifiex_cmd_mac_multicast_adr(cmd_ptr
, cmd_action
,
1284 case HostCmd_CMD_TX_RATE_CFG
:
1285 ret
= mwifiex_cmd_tx_rate_cfg(priv
, cmd_ptr
, cmd_action
,
1288 case HostCmd_CMD_TXPWR_CFG
:
1289 ret
= mwifiex_cmd_tx_power_cfg(cmd_ptr
, cmd_action
,
1292 case HostCmd_CMD_RF_TX_PWR
:
1293 ret
= mwifiex_cmd_rf_tx_power(priv
, cmd_ptr
, cmd_action
,
1296 case HostCmd_CMD_RF_ANTENNA
:
1297 ret
= mwifiex_cmd_rf_antenna(priv
, cmd_ptr
, cmd_action
,
1300 case HostCmd_CMD_802_11_PS_MODE_ENH
:
1301 ret
= mwifiex_cmd_enh_power_mode(priv
, cmd_ptr
, cmd_action
,
1302 (uint16_t)cmd_oid
, data_buf
);
1304 case HostCmd_CMD_802_11_HS_CFG_ENH
:
1305 ret
= mwifiex_cmd_802_11_hs_cfg(priv
, cmd_ptr
, cmd_action
,
1306 (struct mwifiex_hs_config_param
*) data_buf
);
1308 case HostCmd_CMD_802_11_SCAN
:
1309 ret
= mwifiex_cmd_802_11_scan(cmd_ptr
, data_buf
);
1311 case HostCmd_CMD_802_11_BG_SCAN_QUERY
:
1312 ret
= mwifiex_cmd_802_11_bg_scan_query(cmd_ptr
);
1314 case HostCmd_CMD_802_11_ASSOCIATE
:
1315 ret
= mwifiex_cmd_802_11_associate(priv
, cmd_ptr
, data_buf
);
1317 case HostCmd_CMD_802_11_DEAUTHENTICATE
:
1318 ret
= mwifiex_cmd_802_11_deauthenticate(priv
, cmd_ptr
,
1321 case HostCmd_CMD_802_11_AD_HOC_START
:
1322 ret
= mwifiex_cmd_802_11_ad_hoc_start(priv
, cmd_ptr
,
1325 case HostCmd_CMD_802_11_GET_LOG
:
1326 ret
= mwifiex_cmd_802_11_get_log(cmd_ptr
);
1328 case HostCmd_CMD_802_11_AD_HOC_JOIN
:
1329 ret
= mwifiex_cmd_802_11_ad_hoc_join(priv
, cmd_ptr
,
1332 case HostCmd_CMD_802_11_AD_HOC_STOP
:
1333 ret
= mwifiex_cmd_802_11_ad_hoc_stop(cmd_ptr
);
1335 case HostCmd_CMD_RSSI_INFO
:
1336 ret
= mwifiex_cmd_802_11_rssi_info(priv
, cmd_ptr
, cmd_action
);
1338 case HostCmd_CMD_802_11_SNMP_MIB
:
1339 ret
= mwifiex_cmd_802_11_snmp_mib(priv
, cmd_ptr
, cmd_action
,
1342 case HostCmd_CMD_802_11_TX_RATE_QUERY
:
1344 cpu_to_le16(HostCmd_CMD_802_11_TX_RATE_QUERY
);
1346 cpu_to_le16(sizeof(struct host_cmd_ds_tx_rate_query
) +
1351 case HostCmd_CMD_VERSION_EXT
:
1352 cmd_ptr
->command
= cpu_to_le16(cmd_no
);
1353 cmd_ptr
->params
.verext
.version_str_sel
=
1354 (u8
) (*((u32
*) data_buf
));
1355 memcpy(&cmd_ptr
->params
, data_buf
,
1356 sizeof(struct host_cmd_ds_version_ext
));
1358 cpu_to_le16(sizeof(struct host_cmd_ds_version_ext
) +
1362 case HostCmd_CMD_MGMT_FRAME_REG
:
1363 cmd_ptr
->command
= cpu_to_le16(cmd_no
);
1364 cmd_ptr
->params
.reg_mask
.action
= cpu_to_le16(cmd_action
);
1365 cmd_ptr
->params
.reg_mask
.mask
= cpu_to_le32(*(u32
*)data_buf
);
1367 cpu_to_le16(sizeof(struct host_cmd_ds_mgmt_frame_reg
) +
1371 case HostCmd_CMD_REMAIN_ON_CHAN
:
1372 cmd_ptr
->command
= cpu_to_le16(cmd_no
);
1373 memcpy(&cmd_ptr
->params
, data_buf
,
1374 sizeof(struct host_cmd_ds_remain_on_chan
));
1376 cpu_to_le16(sizeof(struct host_cmd_ds_remain_on_chan
) +
1379 case HostCmd_CMD_11AC_CFG
:
1380 ret
= mwifiex_cmd_11ac_cfg(priv
, cmd_ptr
, cmd_action
, data_buf
);
1382 case HostCmd_CMD_P2P_MODE_CFG
:
1383 cmd_ptr
->command
= cpu_to_le16(cmd_no
);
1384 cmd_ptr
->params
.mode_cfg
.action
= cpu_to_le16(cmd_action
);
1385 cmd_ptr
->params
.mode_cfg
.mode
= cpu_to_le16(*(u16
*)data_buf
);
1387 cpu_to_le16(sizeof(struct host_cmd_ds_p2p_mode_cfg
) +
1390 case HostCmd_CMD_FUNC_INIT
:
1391 if (priv
->adapter
->hw_status
== MWIFIEX_HW_STATUS_RESET
)
1392 priv
->adapter
->hw_status
= MWIFIEX_HW_STATUS_READY
;
1393 cmd_ptr
->command
= cpu_to_le16(cmd_no
);
1394 cmd_ptr
->size
= cpu_to_le16(S_DS_GEN
);
1396 case HostCmd_CMD_FUNC_SHUTDOWN
:
1397 priv
->adapter
->hw_status
= MWIFIEX_HW_STATUS_RESET
;
1398 cmd_ptr
->command
= cpu_to_le16(cmd_no
);
1399 cmd_ptr
->size
= cpu_to_le16(S_DS_GEN
);
1401 case HostCmd_CMD_11N_ADDBA_REQ
:
1402 ret
= mwifiex_cmd_11n_addba_req(cmd_ptr
, data_buf
);
1404 case HostCmd_CMD_11N_DELBA
:
1405 ret
= mwifiex_cmd_11n_delba(cmd_ptr
, data_buf
);
1407 case HostCmd_CMD_11N_ADDBA_RSP
:
1408 ret
= mwifiex_cmd_11n_addba_rsp_gen(priv
, cmd_ptr
, data_buf
);
1410 case HostCmd_CMD_802_11_KEY_MATERIAL
:
1411 ret
= mwifiex_cmd_802_11_key_material(priv
, cmd_ptr
,
1412 cmd_action
, cmd_oid
,
1415 case HostCmd_CMD_802_11D_DOMAIN_INFO
:
1416 ret
= mwifiex_cmd_802_11d_domain_info(priv
, cmd_ptr
,
1419 case HostCmd_CMD_RECONFIGURE_TX_BUFF
:
1420 ret
= mwifiex_cmd_recfg_tx_buf(priv
, cmd_ptr
, cmd_action
,
1423 case HostCmd_CMD_AMSDU_AGGR_CTRL
:
1424 ret
= mwifiex_cmd_amsdu_aggr_ctrl(cmd_ptr
, cmd_action
,
1427 case HostCmd_CMD_11N_CFG
:
1428 ret
= mwifiex_cmd_11n_cfg(priv
, cmd_ptr
, cmd_action
, data_buf
);
1430 case HostCmd_CMD_WMM_GET_STATUS
:
1431 dev_dbg(priv
->adapter
->dev
,
1432 "cmd: WMM: WMM_GET_STATUS cmd sent\n");
1433 cmd_ptr
->command
= cpu_to_le16(HostCmd_CMD_WMM_GET_STATUS
);
1435 cpu_to_le16(sizeof(struct host_cmd_ds_wmm_get_status
) +
1439 case HostCmd_CMD_802_11_IBSS_COALESCING_STATUS
:
1440 ret
= mwifiex_cmd_ibss_coalescing_status(cmd_ptr
, cmd_action
,
1443 case HostCmd_CMD_MAC_REG_ACCESS
:
1444 case HostCmd_CMD_BBP_REG_ACCESS
:
1445 case HostCmd_CMD_RF_REG_ACCESS
:
1446 case HostCmd_CMD_PMIC_REG_ACCESS
:
1447 case HostCmd_CMD_CAU_REG_ACCESS
:
1448 case HostCmd_CMD_802_11_EEPROM_ACCESS
:
1449 ret
= mwifiex_cmd_reg_access(cmd_ptr
, cmd_action
, data_buf
);
1451 case HostCmd_CMD_SET_BSS_MODE
:
1452 cmd_ptr
->command
= cpu_to_le16(cmd_no
);
1453 if (priv
->bss_mode
== NL80211_IFTYPE_ADHOC
)
1454 cmd_ptr
->params
.bss_mode
.con_type
=
1455 CONNECTION_TYPE_ADHOC
;
1456 else if (priv
->bss_mode
== NL80211_IFTYPE_STATION
)
1457 cmd_ptr
->params
.bss_mode
.con_type
=
1458 CONNECTION_TYPE_INFRA
;
1459 else if (priv
->bss_mode
== NL80211_IFTYPE_AP
)
1460 cmd_ptr
->params
.bss_mode
.con_type
= CONNECTION_TYPE_AP
;
1461 cmd_ptr
->size
= cpu_to_le16(sizeof(struct
1462 host_cmd_ds_set_bss_mode
) + S_DS_GEN
);
1465 case HostCmd_CMD_PCIE_DESC_DETAILS
:
1466 ret
= mwifiex_cmd_pcie_host_spec(priv
, cmd_ptr
, cmd_action
);
1468 case HostCmd_CMD_802_11_SUBSCRIBE_EVENT
:
1469 ret
= mwifiex_cmd_802_11_subsc_evt(priv
, cmd_ptr
, data_buf
);
1471 case HostCmd_CMD_MEF_CFG
:
1472 ret
= mwifiex_cmd_mef_cfg(priv
, cmd_ptr
, data_buf
);
1474 case HostCmd_CMD_COALESCE_CFG
:
1475 ret
= mwifiex_cmd_coalesce_cfg(priv
, cmd_ptr
, cmd_action
,
1479 dev_err(priv
->adapter
->dev
,
1480 "PREP_CMD: unknown cmd- %#x\n", cmd_no
);
1488 * This function issues commands to initialize firmware.
1490 * This is called after firmware download to bring the card to
1493 * The following commands are issued sequentially -
1494 * - Set PCI-Express host buffer configuration (PCIE only)
1495 * - Function init (for first interface only)
1496 * - Read MAC address (for first interface only)
1497 * - Reconfigure Tx buffer size (for first interface only)
1498 * - Enable auto deep sleep (for first interface only)
1501 * - Set IBSS coalescing status
1502 * - Set AMSDU aggregation control
1504 * - Set MAC control (this must be the last command to initialize firmware)
1506 int mwifiex_sta_init_cmd(struct mwifiex_private
*priv
, u8 first_sta
)
1508 struct mwifiex_adapter
*adapter
= priv
->adapter
;
1511 struct mwifiex_ds_11n_amsdu_aggr_ctrl amsdu_aggr_ctrl
;
1512 struct mwifiex_ds_auto_ds auto_ds
;
1513 enum state_11d_t state_11d
;
1514 struct mwifiex_ds_11n_tx_cfg tx_cfg
;
1517 if (priv
->adapter
->iface_type
== MWIFIEX_PCIE
) {
1518 ret
= mwifiex_send_cmd_sync(priv
,
1519 HostCmd_CMD_PCIE_DESC_DETAILS
,
1520 HostCmd_ACT_GEN_SET
, 0, NULL
);
1525 ret
= mwifiex_send_cmd_sync(priv
, HostCmd_CMD_FUNC_INIT
,
1526 HostCmd_ACT_GEN_SET
, 0, NULL
);
1530 /* Download calibration data to firmware */
1531 if (adapter
->cal_data
) {
1532 ret
= mwifiex_send_cmd_sync(priv
, HostCmd_CMD_CFG_DATA
,
1533 HostCmd_ACT_GEN_SET
, 0, NULL
);
1538 /* Read MAC address from HW */
1539 ret
= mwifiex_send_cmd_sync(priv
, HostCmd_CMD_GET_HW_SPEC
,
1540 HostCmd_ACT_GEN_GET
, 0, NULL
);
1544 /* Reconfigure tx buf size */
1545 ret
= mwifiex_send_cmd_sync(priv
,
1546 HostCmd_CMD_RECONFIGURE_TX_BUFF
,
1547 HostCmd_ACT_GEN_SET
, 0,
1548 &priv
->adapter
->tx_buf_size
);
1552 if (priv
->bss_type
!= MWIFIEX_BSS_TYPE_UAP
) {
1553 /* Enable IEEE PS by default */
1554 priv
->adapter
->ps_mode
= MWIFIEX_802_11_POWER_MODE_PSP
;
1555 ret
= mwifiex_send_cmd_sync(
1556 priv
, HostCmd_CMD_802_11_PS_MODE_ENH
,
1557 EN_AUTO_PS
, BITMAP_STA_PS
, NULL
);
1564 ret
= mwifiex_send_cmd_sync(priv
, HostCmd_CMD_TX_RATE_CFG
,
1565 HostCmd_ACT_GEN_GET
, 0, NULL
);
1568 priv
->data_rate
= 0;
1571 ret
= mwifiex_send_cmd_sync(priv
, HostCmd_CMD_RF_TX_PWR
,
1572 HostCmd_ACT_GEN_GET
, 0, NULL
);
1576 if (priv
->bss_type
== MWIFIEX_BSS_TYPE_STA
) {
1577 /* set ibss coalescing_status */
1578 ret
= mwifiex_send_cmd_sync(
1579 priv
, HostCmd_CMD_802_11_IBSS_COALESCING_STATUS
,
1580 HostCmd_ACT_GEN_SET
, 0, &enable
);
1585 memset(&amsdu_aggr_ctrl
, 0, sizeof(amsdu_aggr_ctrl
));
1586 amsdu_aggr_ctrl
.enable
= true;
1587 /* Send request to firmware */
1588 ret
= mwifiex_send_cmd_sync(priv
, HostCmd_CMD_AMSDU_AGGR_CTRL
,
1589 HostCmd_ACT_GEN_SET
, 0,
1593 /* MAC Control must be the last command in init_fw */
1594 /* set MAC Control */
1595 ret
= mwifiex_send_cmd_sync(priv
, HostCmd_CMD_MAC_CONTROL
,
1596 HostCmd_ACT_GEN_SET
, 0,
1597 &priv
->curr_pkt_filter
);
1601 if (first_sta
&& priv
->adapter
->iface_type
!= MWIFIEX_USB
&&
1602 priv
->bss_type
!= MWIFIEX_BSS_TYPE_UAP
) {
1603 /* Enable auto deep sleep */
1604 auto_ds
.auto_ds
= DEEP_SLEEP_ON
;
1605 auto_ds
.idle_time
= DEEP_SLEEP_IDLE_TIME
;
1606 ret
= mwifiex_send_cmd_sync(priv
,
1607 HostCmd_CMD_802_11_PS_MODE_ENH
,
1608 EN_AUTO_PS
, BITMAP_AUTO_DS
,
1614 if (priv
->bss_type
!= MWIFIEX_BSS_TYPE_UAP
) {
1615 /* Send cmd to FW to enable/disable 11D function */
1616 state_11d
= ENABLE_11D
;
1617 ret
= mwifiex_send_cmd_sync(priv
, HostCmd_CMD_802_11_SNMP_MIB
,
1618 HostCmd_ACT_GEN_SET
, DOT11D_I
,
1621 dev_err(priv
->adapter
->dev
,
1622 "11D: failed to enable 11D\n");
1625 /* set last_init_cmd before sending the command */
1626 priv
->adapter
->last_init_cmd
= HostCmd_CMD_11N_CFG
;
1628 /* Send cmd to FW to configure 11n specific configuration
1629 * (Short GI, Channel BW, Green field support etc.) for transmit
1631 tx_cfg
.tx_htcap
= MWIFIEX_FW_DEF_HTTXCFG
;
1632 ret
= mwifiex_send_cmd_sync(priv
, HostCmd_CMD_11N_CFG
,
1633 HostCmd_ACT_GEN_SET
, 0, &tx_cfg
);