2 * Marvell Wireless LAN device driver: CFG80211
4 * Copyright (C) 2011-2014, 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.
23 static char *reg_alpha2
;
24 module_param(reg_alpha2
, charp
, 0);
26 static const struct ieee80211_iface_limit mwifiex_ap_sta_limits
[] = {
28 .max
= 2, .types
= BIT(NL80211_IFTYPE_STATION
) |
29 BIT(NL80211_IFTYPE_P2P_GO
) |
30 BIT(NL80211_IFTYPE_P2P_CLIENT
),
33 .max
= 1, .types
= BIT(NL80211_IFTYPE_AP
),
37 static const struct ieee80211_iface_combination mwifiex_iface_comb_ap_sta
= {
38 .limits
= mwifiex_ap_sta_limits
,
39 .num_different_channels
= 1,
40 .n_limits
= ARRAY_SIZE(mwifiex_ap_sta_limits
),
41 .max_interfaces
= MWIFIEX_MAX_BSS_NUM
,
42 .beacon_int_infra_match
= true,
46 * This function maps the nl802.11 channel type into driver channel type.
48 * The mapping is as follows -
49 * NL80211_CHAN_NO_HT -> IEEE80211_HT_PARAM_CHA_SEC_NONE
50 * NL80211_CHAN_HT20 -> IEEE80211_HT_PARAM_CHA_SEC_NONE
51 * NL80211_CHAN_HT40PLUS -> IEEE80211_HT_PARAM_CHA_SEC_ABOVE
52 * NL80211_CHAN_HT40MINUS -> IEEE80211_HT_PARAM_CHA_SEC_BELOW
53 * Others -> IEEE80211_HT_PARAM_CHA_SEC_NONE
55 u8
mwifiex_chan_type_to_sec_chan_offset(enum nl80211_channel_type chan_type
)
58 case NL80211_CHAN_NO_HT
:
59 case NL80211_CHAN_HT20
:
60 return IEEE80211_HT_PARAM_CHA_SEC_NONE
;
61 case NL80211_CHAN_HT40PLUS
:
62 return IEEE80211_HT_PARAM_CHA_SEC_ABOVE
;
63 case NL80211_CHAN_HT40MINUS
:
64 return IEEE80211_HT_PARAM_CHA_SEC_BELOW
;
66 return IEEE80211_HT_PARAM_CHA_SEC_NONE
;
71 * This function checks whether WEP is set.
74 mwifiex_is_alg_wep(u32 cipher
)
77 case WLAN_CIPHER_SUITE_WEP40
:
78 case WLAN_CIPHER_SUITE_WEP104
:
88 * This function retrieves the private structure from kernel wiphy structure.
90 static void *mwifiex_cfg80211_get_adapter(struct wiphy
*wiphy
)
92 return (void *) (*(unsigned long *) wiphy_priv(wiphy
));
96 * CFG802.11 operation handler to delete a network key.
99 mwifiex_cfg80211_del_key(struct wiphy
*wiphy
, struct net_device
*netdev
,
100 u8 key_index
, bool pairwise
, const u8
*mac_addr
)
102 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(netdev
);
103 const u8 bc_mac
[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
104 const u8
*peer_mac
= pairwise
? mac_addr
: bc_mac
;
106 if (mwifiex_set_encode(priv
, NULL
, NULL
, 0, key_index
, peer_mac
, 1)) {
107 wiphy_err(wiphy
, "deleting the crypto keys\n");
111 wiphy_dbg(wiphy
, "info: crypto keys deleted\n");
116 * This function forms an skb for management frame.
119 mwifiex_form_mgmt_frame(struct sk_buff
*skb
, const u8
*buf
, size_t len
)
121 u8 addr
[ETH_ALEN
] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
123 u32 tx_control
= 0, pkt_type
= PKT_TYPE_MGMT
;
125 pkt_len
= len
+ ETH_ALEN
;
127 skb_reserve(skb
, MWIFIEX_MIN_DATA_HEADER_LEN
+
128 MWIFIEX_MGMT_FRAME_HEADER_SIZE
+ sizeof(pkt_len
));
129 memcpy(skb_push(skb
, sizeof(pkt_len
)), &pkt_len
, sizeof(pkt_len
));
131 memcpy(skb_push(skb
, sizeof(tx_control
)),
132 &tx_control
, sizeof(tx_control
));
134 memcpy(skb_push(skb
, sizeof(pkt_type
)), &pkt_type
, sizeof(pkt_type
));
136 /* Add packet data and address4 */
137 memcpy(skb_put(skb
, sizeof(struct ieee80211_hdr_3addr
)), buf
,
138 sizeof(struct ieee80211_hdr_3addr
));
139 memcpy(skb_put(skb
, ETH_ALEN
), addr
, ETH_ALEN
);
140 memcpy(skb_put(skb
, len
- sizeof(struct ieee80211_hdr_3addr
)),
141 buf
+ sizeof(struct ieee80211_hdr_3addr
),
142 len
- sizeof(struct ieee80211_hdr_3addr
));
144 skb
->priority
= LOW_PRIO_TID
;
145 __net_timestamp(skb
);
151 * CFG802.11 operation handler to transmit a management frame.
154 mwifiex_cfg80211_mgmt_tx(struct wiphy
*wiphy
, struct wireless_dev
*wdev
,
155 struct cfg80211_mgmt_tx_params
*params
, u64
*cookie
)
157 const u8
*buf
= params
->buf
;
158 size_t len
= params
->len
;
161 const struct ieee80211_mgmt
*mgmt
;
162 struct mwifiex_txinfo
*tx_info
;
163 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(wdev
->netdev
);
166 wiphy_err(wiphy
, "invalid buffer and length\n");
170 mgmt
= (const struct ieee80211_mgmt
*)buf
;
171 if (GET_BSS_ROLE(priv
) != MWIFIEX_BSS_ROLE_STA
&&
172 ieee80211_is_probe_resp(mgmt
->frame_control
)) {
173 /* Since we support offload probe resp, we need to skip probe
174 * resp in AP or GO mode */
176 "info: skip to send probe resp in AP or GO mode\n");
180 pkt_len
= len
+ ETH_ALEN
;
181 skb
= dev_alloc_skb(MWIFIEX_MIN_DATA_HEADER_LEN
+
182 MWIFIEX_MGMT_FRAME_HEADER_SIZE
+
183 pkt_len
+ sizeof(pkt_len
));
186 wiphy_err(wiphy
, "allocate skb failed for management frame\n");
190 tx_info
= MWIFIEX_SKB_TXCB(skb
);
191 memset(tx_info
, 0, sizeof(*tx_info
));
192 tx_info
->bss_num
= priv
->bss_num
;
193 tx_info
->bss_type
= priv
->bss_type
;
194 tx_info
->pkt_len
= pkt_len
;
196 mwifiex_form_mgmt_frame(skb
, buf
, len
);
197 *cookie
= prandom_u32() | 1;
199 if (ieee80211_is_action(mgmt
->frame_control
))
200 skb
= mwifiex_clone_skb_for_tx_status(priv
,
202 MWIFIEX_BUF_FLAG_ACTION_TX_STATUS
, cookie
);
204 cfg80211_mgmt_tx_status(wdev
, *cookie
, buf
, len
, true,
207 mwifiex_queue_tx_pkt(priv
, skb
);
209 wiphy_dbg(wiphy
, "info: management frame transmitted\n");
214 * CFG802.11 operation handler to register a mgmt frame.
217 mwifiex_cfg80211_mgmt_frame_register(struct wiphy
*wiphy
,
218 struct wireless_dev
*wdev
,
219 u16 frame_type
, bool reg
)
221 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(wdev
->netdev
);
225 mask
= priv
->mgmt_frame_mask
| BIT(frame_type
>> 4);
227 mask
= priv
->mgmt_frame_mask
& ~BIT(frame_type
>> 4);
229 if (mask
!= priv
->mgmt_frame_mask
) {
230 priv
->mgmt_frame_mask
= mask
;
231 mwifiex_send_cmd(priv
, HostCmd_CMD_MGMT_FRAME_REG
,
232 HostCmd_ACT_GEN_SET
, 0,
233 &priv
->mgmt_frame_mask
, false);
234 wiphy_dbg(wiphy
, "info: mgmt frame registered\n");
239 * CFG802.11 operation handler to remain on channel.
242 mwifiex_cfg80211_remain_on_channel(struct wiphy
*wiphy
,
243 struct wireless_dev
*wdev
,
244 struct ieee80211_channel
*chan
,
245 unsigned int duration
, u64
*cookie
)
247 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(wdev
->netdev
);
250 if (!chan
|| !cookie
) {
251 wiphy_err(wiphy
, "Invalid parameter for ROC\n");
255 if (priv
->roc_cfg
.cookie
) {
256 wiphy_dbg(wiphy
, "info: ongoing ROC, cookie = 0x%llx\n",
257 priv
->roc_cfg
.cookie
);
261 ret
= mwifiex_remain_on_chan_cfg(priv
, HostCmd_ACT_GEN_SET
, chan
,
265 *cookie
= prandom_u32() | 1;
266 priv
->roc_cfg
.cookie
= *cookie
;
267 priv
->roc_cfg
.chan
= *chan
;
269 cfg80211_ready_on_channel(wdev
, *cookie
, chan
,
270 duration
, GFP_ATOMIC
);
272 wiphy_dbg(wiphy
, "info: ROC, cookie = 0x%llx\n", *cookie
);
279 * CFG802.11 operation handler to cancel remain on channel.
282 mwifiex_cfg80211_cancel_remain_on_channel(struct wiphy
*wiphy
,
283 struct wireless_dev
*wdev
, u64 cookie
)
285 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(wdev
->netdev
);
288 if (cookie
!= priv
->roc_cfg
.cookie
)
291 ret
= mwifiex_remain_on_chan_cfg(priv
, HostCmd_ACT_GEN_REMOVE
,
292 &priv
->roc_cfg
.chan
, 0);
295 cfg80211_remain_on_channel_expired(wdev
, cookie
,
299 memset(&priv
->roc_cfg
, 0, sizeof(struct mwifiex_roc_cfg
));
301 wiphy_dbg(wiphy
, "info: cancel ROC, cookie = 0x%llx\n", cookie
);
308 * CFG802.11 operation handler to set Tx power.
311 mwifiex_cfg80211_set_tx_power(struct wiphy
*wiphy
,
312 struct wireless_dev
*wdev
,
313 enum nl80211_tx_power_setting type
,
316 struct mwifiex_adapter
*adapter
= mwifiex_cfg80211_get_adapter(wiphy
);
317 struct mwifiex_private
*priv
;
318 struct mwifiex_power_cfg power_cfg
;
319 int dbm
= MBM_TO_DBM(mbm
);
321 if (type
== NL80211_TX_POWER_FIXED
) {
322 power_cfg
.is_power_auto
= 0;
323 power_cfg
.power_level
= dbm
;
325 power_cfg
.is_power_auto
= 1;
328 priv
= mwifiex_get_priv(adapter
, MWIFIEX_BSS_ROLE_ANY
);
330 return mwifiex_set_tx_power(priv
, &power_cfg
);
334 * CFG802.11 operation handler to set Power Save option.
336 * The timeout value, if provided, is currently ignored.
339 mwifiex_cfg80211_set_power_mgmt(struct wiphy
*wiphy
,
340 struct net_device
*dev
,
341 bool enabled
, int timeout
)
343 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
348 "info: ignore timeout value for IEEE Power Save\n");
352 return mwifiex_drv_set_power(priv
, &ps_mode
);
356 * CFG802.11 operation handler to set the default network key.
359 mwifiex_cfg80211_set_default_key(struct wiphy
*wiphy
, struct net_device
*netdev
,
360 u8 key_index
, bool unicast
,
363 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(netdev
);
365 /* Return if WEP key not configured */
366 if (!priv
->sec_info
.wep_enabled
)
369 if (priv
->bss_type
== MWIFIEX_BSS_TYPE_UAP
) {
370 priv
->wep_key_curr_index
= key_index
;
371 } else if (mwifiex_set_encode(priv
, NULL
, NULL
, 0, key_index
,
373 wiphy_err(wiphy
, "set default Tx key index\n");
381 * CFG802.11 operation handler to add a network key.
384 mwifiex_cfg80211_add_key(struct wiphy
*wiphy
, struct net_device
*netdev
,
385 u8 key_index
, bool pairwise
, const u8
*mac_addr
,
386 struct key_params
*params
)
388 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(netdev
);
389 struct mwifiex_wep_key
*wep_key
;
390 const u8 bc_mac
[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
391 const u8
*peer_mac
= pairwise
? mac_addr
: bc_mac
;
393 if (GET_BSS_ROLE(priv
) == MWIFIEX_BSS_ROLE_UAP
&&
394 (params
->cipher
== WLAN_CIPHER_SUITE_WEP40
||
395 params
->cipher
== WLAN_CIPHER_SUITE_WEP104
)) {
396 if (params
->key
&& params
->key_len
) {
397 wep_key
= &priv
->wep_key
[key_index
];
398 memset(wep_key
, 0, sizeof(struct mwifiex_wep_key
));
399 memcpy(wep_key
->key_material
, params
->key
,
401 wep_key
->key_index
= key_index
;
402 wep_key
->key_length
= params
->key_len
;
403 priv
->sec_info
.wep_enabled
= 1;
408 if (mwifiex_set_encode(priv
, params
, params
->key
, params
->key_len
,
409 key_index
, peer_mac
, 0)) {
410 wiphy_err(wiphy
, "crypto keys added\n");
418 * This function sends domain information to the firmware.
420 * The following information are passed to the firmware -
422 * - Sub bands (first channel, number of channels, maximum Tx power)
424 static int mwifiex_send_domain_info_cmd_fw(struct wiphy
*wiphy
)
426 u8 no_of_triplet
= 0;
427 struct ieee80211_country_ie_triplet
*t
;
428 u8 no_of_parsed_chan
= 0;
429 u8 first_chan
= 0, next_chan
= 0, max_pwr
= 0;
431 enum ieee80211_band band
;
432 struct ieee80211_supported_band
*sband
;
433 struct ieee80211_channel
*ch
;
434 struct mwifiex_adapter
*adapter
= mwifiex_cfg80211_get_adapter(wiphy
);
435 struct mwifiex_private
*priv
;
436 struct mwifiex_802_11d_domain_reg
*domain_info
= &adapter
->domain_reg
;
438 /* Set country code */
439 domain_info
->country_code
[0] = adapter
->country_code
[0];
440 domain_info
->country_code
[1] = adapter
->country_code
[1];
441 domain_info
->country_code
[2] = ' ';
443 band
= mwifiex_band_to_radio_type(adapter
->config_bands
);
444 if (!wiphy
->bands
[band
]) {
445 wiphy_err(wiphy
, "11D: setting domain info in FW\n");
449 sband
= wiphy
->bands
[band
];
451 for (i
= 0; i
< sband
->n_channels
; i
++) {
452 ch
= &sband
->channels
[i
];
453 if (ch
->flags
& IEEE80211_CHAN_DISABLED
)
458 first_chan
= (u32
) ch
->hw_value
;
459 next_chan
= first_chan
;
460 max_pwr
= ch
->max_power
;
461 no_of_parsed_chan
= 1;
465 if (ch
->hw_value
== next_chan
+ 1 &&
466 ch
->max_power
== max_pwr
) {
470 t
= &domain_info
->triplet
[no_of_triplet
];
471 t
->chans
.first_channel
= first_chan
;
472 t
->chans
.num_channels
= no_of_parsed_chan
;
473 t
->chans
.max_power
= max_pwr
;
475 first_chan
= (u32
) ch
->hw_value
;
476 next_chan
= first_chan
;
477 max_pwr
= ch
->max_power
;
478 no_of_parsed_chan
= 1;
483 t
= &domain_info
->triplet
[no_of_triplet
];
484 t
->chans
.first_channel
= first_chan
;
485 t
->chans
.num_channels
= no_of_parsed_chan
;
486 t
->chans
.max_power
= max_pwr
;
490 domain_info
->no_of_triplet
= no_of_triplet
;
492 priv
= mwifiex_get_priv(adapter
, MWIFIEX_BSS_ROLE_ANY
);
494 if (mwifiex_send_cmd(priv
, HostCmd_CMD_802_11D_DOMAIN_INFO
,
495 HostCmd_ACT_GEN_SET
, 0, NULL
, false)) {
496 wiphy_err(wiphy
, "11D: setting domain info in FW\n");
504 * CFG802.11 regulatory domain callback function.
506 * This function is called when the regulatory domain is changed due to the
507 * following reasons -
509 * - Set by system core
511 * - Set bt Country IE
513 static void mwifiex_reg_notifier(struct wiphy
*wiphy
,
514 struct regulatory_request
*request
)
516 struct mwifiex_adapter
*adapter
= mwifiex_cfg80211_get_adapter(wiphy
);
517 struct mwifiex_private
*priv
= mwifiex_get_priv(adapter
,
518 MWIFIEX_BSS_ROLE_ANY
);
520 wiphy_dbg(wiphy
, "info: cfg80211 regulatory domain callback for %c%c\n",
521 request
->alpha2
[0], request
->alpha2
[1]);
523 switch (request
->initiator
) {
524 case NL80211_REGDOM_SET_BY_DRIVER
:
525 case NL80211_REGDOM_SET_BY_CORE
:
526 case NL80211_REGDOM_SET_BY_USER
:
527 case NL80211_REGDOM_SET_BY_COUNTRY_IE
:
530 wiphy_err(wiphy
, "unknown regdom initiator: %d\n",
535 /* Don't send world or same regdom info to firmware */
536 if (strncmp(request
->alpha2
, "00", 2) &&
537 strncmp(request
->alpha2
, adapter
->country_code
,
538 sizeof(request
->alpha2
))) {
539 memcpy(adapter
->country_code
, request
->alpha2
,
540 sizeof(request
->alpha2
));
541 mwifiex_send_domain_info_cmd_fw(wiphy
);
542 mwifiex_dnld_txpwr_table(priv
);
547 * This function sets the fragmentation threshold.
549 * The fragmentation threshold value must lie between MWIFIEX_FRAG_MIN_VALUE
550 * and MWIFIEX_FRAG_MAX_VALUE.
553 mwifiex_set_frag(struct mwifiex_private
*priv
, u32 frag_thr
)
555 if (frag_thr
< MWIFIEX_FRAG_MIN_VALUE
||
556 frag_thr
> MWIFIEX_FRAG_MAX_VALUE
)
557 frag_thr
= MWIFIEX_FRAG_MAX_VALUE
;
559 return mwifiex_send_cmd(priv
, HostCmd_CMD_802_11_SNMP_MIB
,
560 HostCmd_ACT_GEN_SET
, FRAG_THRESH_I
,
565 * This function sets the RTS threshold.
567 * The rts value must lie between MWIFIEX_RTS_MIN_VALUE
568 * and MWIFIEX_RTS_MAX_VALUE.
571 mwifiex_set_rts(struct mwifiex_private
*priv
, u32 rts_thr
)
573 if (rts_thr
< MWIFIEX_RTS_MIN_VALUE
|| rts_thr
> MWIFIEX_RTS_MAX_VALUE
)
574 rts_thr
= MWIFIEX_RTS_MAX_VALUE
;
576 return mwifiex_send_cmd(priv
, HostCmd_CMD_802_11_SNMP_MIB
,
577 HostCmd_ACT_GEN_SET
, RTS_THRESH_I
,
582 * CFG802.11 operation handler to set wiphy parameters.
584 * This function can be used to set the RTS threshold and the
585 * Fragmentation threshold of the driver.
588 mwifiex_cfg80211_set_wiphy_params(struct wiphy
*wiphy
, u32 changed
)
590 struct mwifiex_adapter
*adapter
= mwifiex_cfg80211_get_adapter(wiphy
);
591 struct mwifiex_private
*priv
;
592 struct mwifiex_uap_bss_param
*bss_cfg
;
593 int ret
, bss_started
, i
;
595 for (i
= 0; i
< adapter
->priv_num
; i
++) {
596 priv
= adapter
->priv
[i
];
598 switch (priv
->bss_role
) {
599 case MWIFIEX_BSS_ROLE_UAP
:
600 bss_cfg
= kzalloc(sizeof(struct mwifiex_uap_bss_param
),
605 mwifiex_set_sys_config_invalid_data(bss_cfg
);
607 if (changed
& WIPHY_PARAM_RTS_THRESHOLD
)
608 bss_cfg
->rts_threshold
= wiphy
->rts_threshold
;
609 if (changed
& WIPHY_PARAM_FRAG_THRESHOLD
)
610 bss_cfg
->frag_threshold
= wiphy
->frag_threshold
;
611 if (changed
& WIPHY_PARAM_RETRY_LONG
)
612 bss_cfg
->retry_limit
= wiphy
->retry_long
;
614 bss_started
= priv
->bss_started
;
616 ret
= mwifiex_send_cmd(priv
, HostCmd_CMD_UAP_BSS_STOP
,
617 HostCmd_ACT_GEN_SET
, 0,
620 wiphy_err(wiphy
, "Failed to stop the BSS\n");
625 ret
= mwifiex_send_cmd(priv
, HostCmd_CMD_UAP_SYS_CONFIG
,
627 UAP_BSS_PARAMS_I
, bss_cfg
,
633 wiphy_err(wiphy
, "Failed to set bss config\n");
640 ret
= mwifiex_send_cmd(priv
, HostCmd_CMD_UAP_BSS_START
,
641 HostCmd_ACT_GEN_SET
, 0,
644 wiphy_err(wiphy
, "Failed to start BSS\n");
649 case MWIFIEX_BSS_ROLE_STA
:
650 if (changed
& WIPHY_PARAM_RTS_THRESHOLD
) {
651 ret
= mwifiex_set_rts(priv
,
652 wiphy
->rts_threshold
);
656 if (changed
& WIPHY_PARAM_FRAG_THRESHOLD
) {
657 ret
= mwifiex_set_frag(priv
,
658 wiphy
->frag_threshold
);
670 mwifiex_cfg80211_deinit_p2p(struct mwifiex_private
*priv
)
672 u16 mode
= P2P_MODE_DISABLE
;
674 if (GET_BSS_ROLE(priv
) != MWIFIEX_BSS_ROLE_STA
)
675 mwifiex_set_bss_role(priv
, MWIFIEX_BSS_ROLE_STA
);
677 if (mwifiex_send_cmd(priv
, HostCmd_CMD_P2P_MODE_CFG
,
678 HostCmd_ACT_GEN_SET
, 0, &mode
, true))
685 * This function initializes the functionalities for P2P client.
686 * The P2P client initialization sequence is:
687 * disable -> device -> client
690 mwifiex_cfg80211_init_p2p_client(struct mwifiex_private
*priv
)
694 if (mwifiex_cfg80211_deinit_p2p(priv
))
697 mode
= P2P_MODE_DEVICE
;
698 if (mwifiex_send_cmd(priv
, HostCmd_CMD_P2P_MODE_CFG
,
699 HostCmd_ACT_GEN_SET
, 0, &mode
, true))
702 mode
= P2P_MODE_CLIENT
;
703 if (mwifiex_send_cmd(priv
, HostCmd_CMD_P2P_MODE_CFG
,
704 HostCmd_ACT_GEN_SET
, 0, &mode
, true))
711 * This function initializes the functionalities for P2P GO.
712 * The P2P GO initialization sequence is:
713 * disable -> device -> GO
716 mwifiex_cfg80211_init_p2p_go(struct mwifiex_private
*priv
)
720 if (mwifiex_cfg80211_deinit_p2p(priv
))
723 mode
= P2P_MODE_DEVICE
;
724 if (mwifiex_send_cmd(priv
, HostCmd_CMD_P2P_MODE_CFG
,
725 HostCmd_ACT_GEN_SET
, 0, &mode
, true))
729 if (mwifiex_send_cmd(priv
, HostCmd_CMD_P2P_MODE_CFG
,
730 HostCmd_ACT_GEN_SET
, 0, &mode
, true))
733 if (GET_BSS_ROLE(priv
) != MWIFIEX_BSS_ROLE_UAP
)
734 mwifiex_set_bss_role(priv
, MWIFIEX_BSS_ROLE_UAP
);
740 * CFG802.11 operation handler to change interface type.
743 mwifiex_cfg80211_change_virtual_intf(struct wiphy
*wiphy
,
744 struct net_device
*dev
,
745 enum nl80211_iftype type
, u32
*flags
,
746 struct vif_params
*params
)
749 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
751 switch (dev
->ieee80211_ptr
->iftype
) {
752 case NL80211_IFTYPE_ADHOC
:
754 case NL80211_IFTYPE_STATION
:
756 case NL80211_IFTYPE_UNSPECIFIED
:
757 wiphy_warn(wiphy
, "%s: kept type as IBSS\n", dev
->name
);
758 case NL80211_IFTYPE_ADHOC
: /* This shouldn't happen */
760 case NL80211_IFTYPE_AP
:
762 wiphy_err(wiphy
, "%s: changing to %d not supported\n",
767 case NL80211_IFTYPE_STATION
:
769 case NL80211_IFTYPE_ADHOC
:
771 case NL80211_IFTYPE_P2P_CLIENT
:
772 if (mwifiex_cfg80211_init_p2p_client(priv
))
774 dev
->ieee80211_ptr
->iftype
= type
;
776 case NL80211_IFTYPE_P2P_GO
:
777 if (mwifiex_cfg80211_init_p2p_go(priv
))
779 dev
->ieee80211_ptr
->iftype
= type
;
781 case NL80211_IFTYPE_UNSPECIFIED
:
782 wiphy_warn(wiphy
, "%s: kept type as STA\n", dev
->name
);
783 case NL80211_IFTYPE_STATION
: /* This shouldn't happen */
785 case NL80211_IFTYPE_AP
:
787 wiphy_err(wiphy
, "%s: changing to %d not supported\n",
792 case NL80211_IFTYPE_AP
:
794 case NL80211_IFTYPE_UNSPECIFIED
:
795 wiphy_warn(wiphy
, "%s: kept type as AP\n", dev
->name
);
796 case NL80211_IFTYPE_AP
: /* This shouldn't happen */
798 case NL80211_IFTYPE_ADHOC
:
799 case NL80211_IFTYPE_STATION
:
801 wiphy_err(wiphy
, "%s: changing to %d not supported\n",
806 case NL80211_IFTYPE_P2P_CLIENT
:
807 case NL80211_IFTYPE_P2P_GO
:
809 case NL80211_IFTYPE_STATION
:
810 if (mwifiex_cfg80211_deinit_p2p(priv
))
812 dev
->ieee80211_ptr
->iftype
= type
;
819 wiphy_err(wiphy
, "%s: unknown iftype: %d\n",
820 dev
->name
, dev
->ieee80211_ptr
->iftype
);
824 dev
->ieee80211_ptr
->iftype
= type
;
825 priv
->bss_mode
= type
;
826 mwifiex_deauthenticate(priv
, NULL
);
828 priv
->sec_info
.authentication_mode
= NL80211_AUTHTYPE_OPEN_SYSTEM
;
830 ret
= mwifiex_send_cmd(priv
, HostCmd_CMD_SET_BSS_MODE
,
831 HostCmd_ACT_GEN_SET
, 0, NULL
, true);
837 mwifiex_parse_htinfo(struct mwifiex_private
*priv
, u8 tx_htinfo
,
838 struct rate_info
*rate
)
840 struct mwifiex_adapter
*adapter
= priv
->adapter
;
842 if (adapter
->is_hw_11ac_capable
) {
843 /* bit[1-0]: 00=LG 01=HT 10=VHT */
844 if (tx_htinfo
& BIT(0)) {
846 rate
->mcs
= priv
->tx_rate
;
847 rate
->flags
|= RATE_INFO_FLAGS_MCS
;
849 if (tx_htinfo
& BIT(1)) {
851 rate
->mcs
= priv
->tx_rate
& 0x0F;
852 rate
->flags
|= RATE_INFO_FLAGS_VHT_MCS
;
855 if (tx_htinfo
& (BIT(1) | BIT(0))) {
857 switch (tx_htinfo
& (BIT(3) | BIT(2))) {
859 /* This will be 20MHz */
862 rate
->flags
|= RATE_INFO_FLAGS_40_MHZ_WIDTH
;
865 rate
->flags
|= RATE_INFO_FLAGS_80_MHZ_WIDTH
;
867 case (BIT(3) | BIT(2)):
868 rate
->flags
|= RATE_INFO_FLAGS_160_MHZ_WIDTH
;
872 if (tx_htinfo
& BIT(4))
873 rate
->flags
|= RATE_INFO_FLAGS_SHORT_GI
;
875 if ((priv
->tx_rate
>> 4) == 1)
882 * Bit 0 in tx_htinfo indicates that current Tx rate
883 * is 11n rate. Valid MCS index values for us are 0 to 15.
885 if ((tx_htinfo
& BIT(0)) && (priv
->tx_rate
< 16)) {
886 rate
->mcs
= priv
->tx_rate
;
887 rate
->flags
|= RATE_INFO_FLAGS_MCS
;
888 if (tx_htinfo
& BIT(1))
889 rate
->flags
|= RATE_INFO_FLAGS_40_MHZ_WIDTH
;
890 if (tx_htinfo
& BIT(2))
891 rate
->flags
|= RATE_INFO_FLAGS_SHORT_GI
;
897 * This function dumps the station information on a buffer.
899 * The following information are shown -
900 * - Total bytes transmitted
901 * - Total bytes received
902 * - Total packets transmitted
903 * - Total packets received
904 * - Signal quality level
905 * - Transmission rate
908 mwifiex_dump_station_info(struct mwifiex_private
*priv
,
909 struct station_info
*sinfo
)
913 sinfo
->filled
= STATION_INFO_RX_BYTES
| STATION_INFO_TX_BYTES
|
914 STATION_INFO_RX_PACKETS
| STATION_INFO_TX_PACKETS
|
915 STATION_INFO_TX_BITRATE
|
916 STATION_INFO_SIGNAL
| STATION_INFO_SIGNAL_AVG
;
918 /* Get signal information from the firmware */
919 if (mwifiex_send_cmd(priv
, HostCmd_CMD_RSSI_INFO
,
920 HostCmd_ACT_GEN_GET
, 0, NULL
, true)) {
921 dev_err(priv
->adapter
->dev
, "failed to get signal information\n");
925 if (mwifiex_drv_get_data_rate(priv
, &rate
)) {
926 dev_err(priv
->adapter
->dev
, "getting data rate\n");
930 /* Get DTIM period information from firmware */
931 mwifiex_send_cmd(priv
, HostCmd_CMD_802_11_SNMP_MIB
,
932 HostCmd_ACT_GEN_GET
, DTIM_PERIOD_I
,
933 &priv
->dtim_period
, true);
935 mwifiex_parse_htinfo(priv
, priv
->tx_htinfo
, &sinfo
->txrate
);
937 sinfo
->signal_avg
= priv
->bcn_rssi_avg
;
938 sinfo
->rx_bytes
= priv
->stats
.rx_bytes
;
939 sinfo
->tx_bytes
= priv
->stats
.tx_bytes
;
940 sinfo
->rx_packets
= priv
->stats
.rx_packets
;
941 sinfo
->tx_packets
= priv
->stats
.tx_packets
;
942 sinfo
->signal
= priv
->bcn_rssi_avg
;
943 /* bit rate is in 500 kb/s units. Convert it to 100kb/s units */
944 sinfo
->txrate
.legacy
= rate
* 5;
946 if (priv
->bss_mode
== NL80211_IFTYPE_STATION
) {
947 sinfo
->filled
|= STATION_INFO_BSS_PARAM
;
948 sinfo
->bss_param
.flags
= 0;
949 if (priv
->curr_bss_params
.bss_descriptor
.cap_info_bitmap
&
950 WLAN_CAPABILITY_SHORT_PREAMBLE
)
951 sinfo
->bss_param
.flags
|=
952 BSS_PARAM_FLAGS_SHORT_PREAMBLE
;
953 if (priv
->curr_bss_params
.bss_descriptor
.cap_info_bitmap
&
954 WLAN_CAPABILITY_SHORT_SLOT_TIME
)
955 sinfo
->bss_param
.flags
|=
956 BSS_PARAM_FLAGS_SHORT_SLOT_TIME
;
957 sinfo
->bss_param
.dtim_period
= priv
->dtim_period
;
958 sinfo
->bss_param
.beacon_interval
=
959 priv
->curr_bss_params
.bss_descriptor
.beacon_period
;
966 * CFG802.11 operation handler to get station information.
968 * This function only works in connected mode, and dumps the
969 * requested station information, if available.
972 mwifiex_cfg80211_get_station(struct wiphy
*wiphy
, struct net_device
*dev
,
973 const u8
*mac
, struct station_info
*sinfo
)
975 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
977 if (!priv
->media_connected
)
979 if (memcmp(mac
, priv
->cfg_bssid
, ETH_ALEN
))
982 return mwifiex_dump_station_info(priv
, sinfo
);
986 * CFG802.11 operation handler to dump station information.
989 mwifiex_cfg80211_dump_station(struct wiphy
*wiphy
, struct net_device
*dev
,
990 int idx
, u8
*mac
, struct station_info
*sinfo
)
992 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
994 if (!priv
->media_connected
|| idx
)
997 memcpy(mac
, priv
->cfg_bssid
, ETH_ALEN
);
999 return mwifiex_dump_station_info(priv
, sinfo
);
1003 mwifiex_cfg80211_dump_survey(struct wiphy
*wiphy
, struct net_device
*dev
,
1004 int idx
, struct survey_info
*survey
)
1006 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1007 struct mwifiex_chan_stats
*pchan_stats
= priv
->adapter
->chan_stats
;
1008 enum ieee80211_band band
;
1010 dev_dbg(priv
->adapter
->dev
, "dump_survey idx=%d\n", idx
);
1012 memset(survey
, 0, sizeof(struct survey_info
));
1014 if ((GET_BSS_ROLE(priv
) == MWIFIEX_BSS_ROLE_STA
) &&
1015 priv
->media_connected
&& idx
== 0) {
1016 u8 curr_bss_band
= priv
->curr_bss_params
.band
;
1017 u32 chan
= priv
->curr_bss_params
.bss_descriptor
.channel
;
1019 band
= mwifiex_band_to_radio_type(curr_bss_band
);
1020 survey
->channel
= ieee80211_get_channel(wiphy
,
1021 ieee80211_channel_to_frequency(chan
, band
));
1023 if (priv
->bcn_nf_last
) {
1024 survey
->filled
= SURVEY_INFO_NOISE_DBM
;
1025 survey
->noise
= priv
->bcn_nf_last
;
1030 if (idx
>= priv
->adapter
->num_in_chan_stats
)
1033 if (!pchan_stats
[idx
].cca_scan_dur
)
1036 band
= pchan_stats
[idx
].bandcfg
;
1037 survey
->channel
= ieee80211_get_channel(wiphy
,
1038 ieee80211_channel_to_frequency(pchan_stats
[idx
].chan_num
, band
));
1039 survey
->filled
= SURVEY_INFO_NOISE_DBM
|
1040 SURVEY_INFO_CHANNEL_TIME
| SURVEY_INFO_CHANNEL_TIME_BUSY
;
1041 survey
->noise
= pchan_stats
[idx
].noise
;
1042 survey
->channel_time
= pchan_stats
[idx
].cca_scan_dur
;
1043 survey
->channel_time_busy
= pchan_stats
[idx
].cca_busy_dur
;
1048 /* Supported rates to be advertised to the cfg80211 */
1049 static struct ieee80211_rate mwifiex_rates
[] = {
1050 {.bitrate
= 10, .hw_value
= 2, },
1051 {.bitrate
= 20, .hw_value
= 4, },
1052 {.bitrate
= 55, .hw_value
= 11, },
1053 {.bitrate
= 110, .hw_value
= 22, },
1054 {.bitrate
= 60, .hw_value
= 12, },
1055 {.bitrate
= 90, .hw_value
= 18, },
1056 {.bitrate
= 120, .hw_value
= 24, },
1057 {.bitrate
= 180, .hw_value
= 36, },
1058 {.bitrate
= 240, .hw_value
= 48, },
1059 {.bitrate
= 360, .hw_value
= 72, },
1060 {.bitrate
= 480, .hw_value
= 96, },
1061 {.bitrate
= 540, .hw_value
= 108, },
1064 /* Channel definitions to be advertised to cfg80211 */
1065 static struct ieee80211_channel mwifiex_channels_2ghz
[] = {
1066 {.center_freq
= 2412, .hw_value
= 1, },
1067 {.center_freq
= 2417, .hw_value
= 2, },
1068 {.center_freq
= 2422, .hw_value
= 3, },
1069 {.center_freq
= 2427, .hw_value
= 4, },
1070 {.center_freq
= 2432, .hw_value
= 5, },
1071 {.center_freq
= 2437, .hw_value
= 6, },
1072 {.center_freq
= 2442, .hw_value
= 7, },
1073 {.center_freq
= 2447, .hw_value
= 8, },
1074 {.center_freq
= 2452, .hw_value
= 9, },
1075 {.center_freq
= 2457, .hw_value
= 10, },
1076 {.center_freq
= 2462, .hw_value
= 11, },
1077 {.center_freq
= 2467, .hw_value
= 12, },
1078 {.center_freq
= 2472, .hw_value
= 13, },
1079 {.center_freq
= 2484, .hw_value
= 14, },
1082 static struct ieee80211_supported_band mwifiex_band_2ghz
= {
1083 .channels
= mwifiex_channels_2ghz
,
1084 .n_channels
= ARRAY_SIZE(mwifiex_channels_2ghz
),
1085 .bitrates
= mwifiex_rates
,
1086 .n_bitrates
= ARRAY_SIZE(mwifiex_rates
),
1089 static struct ieee80211_channel mwifiex_channels_5ghz
[] = {
1090 {.center_freq
= 5040, .hw_value
= 8, },
1091 {.center_freq
= 5060, .hw_value
= 12, },
1092 {.center_freq
= 5080, .hw_value
= 16, },
1093 {.center_freq
= 5170, .hw_value
= 34, },
1094 {.center_freq
= 5190, .hw_value
= 38, },
1095 {.center_freq
= 5210, .hw_value
= 42, },
1096 {.center_freq
= 5230, .hw_value
= 46, },
1097 {.center_freq
= 5180, .hw_value
= 36, },
1098 {.center_freq
= 5200, .hw_value
= 40, },
1099 {.center_freq
= 5220, .hw_value
= 44, },
1100 {.center_freq
= 5240, .hw_value
= 48, },
1101 {.center_freq
= 5260, .hw_value
= 52, },
1102 {.center_freq
= 5280, .hw_value
= 56, },
1103 {.center_freq
= 5300, .hw_value
= 60, },
1104 {.center_freq
= 5320, .hw_value
= 64, },
1105 {.center_freq
= 5500, .hw_value
= 100, },
1106 {.center_freq
= 5520, .hw_value
= 104, },
1107 {.center_freq
= 5540, .hw_value
= 108, },
1108 {.center_freq
= 5560, .hw_value
= 112, },
1109 {.center_freq
= 5580, .hw_value
= 116, },
1110 {.center_freq
= 5600, .hw_value
= 120, },
1111 {.center_freq
= 5620, .hw_value
= 124, },
1112 {.center_freq
= 5640, .hw_value
= 128, },
1113 {.center_freq
= 5660, .hw_value
= 132, },
1114 {.center_freq
= 5680, .hw_value
= 136, },
1115 {.center_freq
= 5700, .hw_value
= 140, },
1116 {.center_freq
= 5745, .hw_value
= 149, },
1117 {.center_freq
= 5765, .hw_value
= 153, },
1118 {.center_freq
= 5785, .hw_value
= 157, },
1119 {.center_freq
= 5805, .hw_value
= 161, },
1120 {.center_freq
= 5825, .hw_value
= 165, },
1123 static struct ieee80211_supported_band mwifiex_band_5ghz
= {
1124 .channels
= mwifiex_channels_5ghz
,
1125 .n_channels
= ARRAY_SIZE(mwifiex_channels_5ghz
),
1126 .bitrates
= mwifiex_rates
+ 4,
1127 .n_bitrates
= ARRAY_SIZE(mwifiex_rates
) - 4,
1131 /* Supported crypto cipher suits to be advertised to cfg80211 */
1132 static const u32 mwifiex_cipher_suites
[] = {
1133 WLAN_CIPHER_SUITE_WEP40
,
1134 WLAN_CIPHER_SUITE_WEP104
,
1135 WLAN_CIPHER_SUITE_TKIP
,
1136 WLAN_CIPHER_SUITE_CCMP
,
1137 WLAN_CIPHER_SUITE_AES_CMAC
,
1140 /* Supported mgmt frame types to be advertised to cfg80211 */
1141 static const struct ieee80211_txrx_stypes
1142 mwifiex_mgmt_stypes
[NUM_NL80211_IFTYPES
] = {
1143 [NL80211_IFTYPE_STATION
] = {
1144 .tx
= BIT(IEEE80211_STYPE_ACTION
>> 4) |
1145 BIT(IEEE80211_STYPE_PROBE_RESP
>> 4),
1146 .rx
= BIT(IEEE80211_STYPE_ACTION
>> 4) |
1147 BIT(IEEE80211_STYPE_PROBE_REQ
>> 4),
1149 [NL80211_IFTYPE_AP
] = {
1150 .tx
= BIT(IEEE80211_STYPE_ACTION
>> 4) |
1151 BIT(IEEE80211_STYPE_PROBE_RESP
>> 4),
1152 .rx
= BIT(IEEE80211_STYPE_ACTION
>> 4) |
1153 BIT(IEEE80211_STYPE_PROBE_REQ
>> 4),
1155 [NL80211_IFTYPE_P2P_CLIENT
] = {
1156 .tx
= BIT(IEEE80211_STYPE_ACTION
>> 4) |
1157 BIT(IEEE80211_STYPE_PROBE_RESP
>> 4),
1158 .rx
= BIT(IEEE80211_STYPE_ACTION
>> 4) |
1159 BIT(IEEE80211_STYPE_PROBE_REQ
>> 4),
1161 [NL80211_IFTYPE_P2P_GO
] = {
1162 .tx
= BIT(IEEE80211_STYPE_ACTION
>> 4) |
1163 BIT(IEEE80211_STYPE_PROBE_RESP
>> 4),
1164 .rx
= BIT(IEEE80211_STYPE_ACTION
>> 4) |
1165 BIT(IEEE80211_STYPE_PROBE_REQ
>> 4),
1170 * CFG802.11 operation handler for setting bit rates.
1172 * Function configures data rates to firmware using bitrate mask
1173 * provided by cfg80211.
1175 static int mwifiex_cfg80211_set_bitrate_mask(struct wiphy
*wiphy
,
1176 struct net_device
*dev
,
1178 const struct cfg80211_bitrate_mask
*mask
)
1180 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1181 u16 bitmap_rates
[MAX_BITMAP_RATES_SIZE
];
1182 enum ieee80211_band band
;
1183 struct mwifiex_adapter
*adapter
= priv
->adapter
;
1185 if (!priv
->media_connected
) {
1186 dev_err(adapter
->dev
,
1187 "Can not set Tx data rate in disconnected state\n");
1191 band
= mwifiex_band_to_radio_type(priv
->curr_bss_params
.band
);
1193 memset(bitmap_rates
, 0, sizeof(bitmap_rates
));
1195 /* Fill HR/DSSS rates. */
1196 if (band
== IEEE80211_BAND_2GHZ
)
1197 bitmap_rates
[0] = mask
->control
[band
].legacy
& 0x000f;
1199 /* Fill OFDM rates */
1200 if (band
== IEEE80211_BAND_2GHZ
)
1201 bitmap_rates
[1] = (mask
->control
[band
].legacy
& 0x0ff0) >> 4;
1203 bitmap_rates
[1] = mask
->control
[band
].legacy
;
1205 /* Fill HT MCS rates */
1206 bitmap_rates
[2] = mask
->control
[band
].ht_mcs
[0];
1207 if (adapter
->hw_dev_mcs_support
== HT_STREAM_2X2
)
1208 bitmap_rates
[2] |= mask
->control
[band
].ht_mcs
[1] << 8;
1210 /* Fill VHT MCS rates */
1211 if (adapter
->fw_api_ver
== MWIFIEX_FW_V15
) {
1212 bitmap_rates
[10] = mask
->control
[band
].vht_mcs
[0];
1213 if (adapter
->hw_dev_mcs_support
== HT_STREAM_2X2
)
1214 bitmap_rates
[11] = mask
->control
[band
].vht_mcs
[1];
1217 return mwifiex_send_cmd(priv
, HostCmd_CMD_TX_RATE_CFG
,
1218 HostCmd_ACT_GEN_SET
, 0, bitmap_rates
, true);
1222 * CFG802.11 operation handler for connection quality monitoring.
1224 * This function subscribes/unsubscribes HIGH_RSSI and LOW_RSSI
1227 static int mwifiex_cfg80211_set_cqm_rssi_config(struct wiphy
*wiphy
,
1228 struct net_device
*dev
,
1229 s32 rssi_thold
, u32 rssi_hyst
)
1231 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1232 struct mwifiex_ds_misc_subsc_evt subsc_evt
;
1234 priv
->cqm_rssi_thold
= rssi_thold
;
1235 priv
->cqm_rssi_hyst
= rssi_hyst
;
1237 memset(&subsc_evt
, 0x00, sizeof(struct mwifiex_ds_misc_subsc_evt
));
1238 subsc_evt
.events
= BITMASK_BCN_RSSI_LOW
| BITMASK_BCN_RSSI_HIGH
;
1240 /* Subscribe/unsubscribe low and high rssi events */
1241 if (rssi_thold
&& rssi_hyst
) {
1242 subsc_evt
.action
= HostCmd_ACT_BITWISE_SET
;
1243 subsc_evt
.bcn_l_rssi_cfg
.abs_value
= abs(rssi_thold
);
1244 subsc_evt
.bcn_h_rssi_cfg
.abs_value
= abs(rssi_thold
);
1245 subsc_evt
.bcn_l_rssi_cfg
.evt_freq
= 1;
1246 subsc_evt
.bcn_h_rssi_cfg
.evt_freq
= 1;
1247 return mwifiex_send_cmd(priv
,
1248 HostCmd_CMD_802_11_SUBSCRIBE_EVENT
,
1249 0, 0, &subsc_evt
, true);
1251 subsc_evt
.action
= HostCmd_ACT_BITWISE_CLR
;
1252 return mwifiex_send_cmd(priv
,
1253 HostCmd_CMD_802_11_SUBSCRIBE_EVENT
,
1254 0, 0, &subsc_evt
, true);
1260 /* cfg80211 operation handler for change_beacon.
1261 * Function retrieves and sets modified management IEs to FW.
1263 static int mwifiex_cfg80211_change_beacon(struct wiphy
*wiphy
,
1264 struct net_device
*dev
,
1265 struct cfg80211_beacon_data
*data
)
1267 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1269 if (GET_BSS_ROLE(priv
) != MWIFIEX_BSS_ROLE_UAP
) {
1270 wiphy_err(wiphy
, "%s: bss_type mismatched\n", __func__
);
1274 if (!priv
->bss_started
) {
1275 wiphy_err(wiphy
, "%s: bss not started\n", __func__
);
1279 if (mwifiex_set_mgmt_ies(priv
, data
)) {
1280 wiphy_err(wiphy
, "%s: setting mgmt ies failed\n", __func__
);
1287 /* cfg80211 operation handler for del_station.
1288 * Function deauthenticates station which value is provided in mac parameter.
1289 * If mac is NULL/broadcast, all stations in associated station list are
1290 * deauthenticated. If bss is not started or there are no stations in
1291 * associated stations list, no action is taken.
1294 mwifiex_cfg80211_del_station(struct wiphy
*wiphy
, struct net_device
*dev
,
1295 struct station_del_parameters
*params
)
1297 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1298 struct mwifiex_sta_node
*sta_node
;
1299 unsigned long flags
;
1301 if (list_empty(&priv
->sta_list
) || !priv
->bss_started
)
1304 if (!params
->mac
|| is_broadcast_ether_addr(params
->mac
)) {
1305 wiphy_dbg(wiphy
, "%s: NULL/broadcast mac address\n", __func__
);
1306 list_for_each_entry(sta_node
, &priv
->sta_list
, list
) {
1307 if (mwifiex_send_cmd(priv
, HostCmd_CMD_UAP_STA_DEAUTH
,
1308 HostCmd_ACT_GEN_SET
, 0,
1309 sta_node
->mac_addr
, true))
1313 wiphy_dbg(wiphy
, "%s: mac address %pM\n", __func__
,
1315 spin_lock_irqsave(&priv
->sta_list_spinlock
, flags
);
1316 sta_node
= mwifiex_get_sta_entry(priv
, params
->mac
);
1317 spin_unlock_irqrestore(&priv
->sta_list_spinlock
, flags
);
1319 if (mwifiex_send_cmd(priv
, HostCmd_CMD_UAP_STA_DEAUTH
,
1320 HostCmd_ACT_GEN_SET
, 0,
1321 sta_node
->mac_addr
, true))
1330 mwifiex_cfg80211_set_antenna(struct wiphy
*wiphy
, u32 tx_ant
, u32 rx_ant
)
1332 struct mwifiex_adapter
*adapter
= mwifiex_cfg80211_get_adapter(wiphy
);
1333 struct mwifiex_private
*priv
= mwifiex_get_priv(adapter
,
1334 MWIFIEX_BSS_ROLE_ANY
);
1335 struct mwifiex_ds_ant_cfg ant_cfg
;
1337 if (!tx_ant
|| !rx_ant
)
1340 if (adapter
->hw_dev_mcs_support
!= HT_STREAM_2X2
) {
1341 /* Not a MIMO chip. User should provide specific antenna number
1342 * for Tx/Rx path or enable all antennas for diversity
1344 if (tx_ant
!= rx_ant
)
1347 if ((tx_ant
& (tx_ant
- 1)) &&
1348 (tx_ant
!= BIT(adapter
->number_of_antenna
) - 1))
1351 if ((tx_ant
== BIT(adapter
->number_of_antenna
) - 1) &&
1352 (priv
->adapter
->number_of_antenna
> 1)) {
1353 tx_ant
= RF_ANTENNA_AUTO
;
1354 rx_ant
= RF_ANTENNA_AUTO
;
1357 struct ieee80211_sta_ht_cap
*ht_info
;
1359 enum ieee80211_band band
;
1361 if ((tx_ant
== 0x1 && rx_ant
== 0x1)) {
1362 adapter
->user_dev_mcs_support
= HT_STREAM_1X1
;
1363 if (adapter
->is_hw_11ac_capable
)
1364 adapter
->usr_dot_11ac_mcs_support
=
1365 MWIFIEX_11AC_MCS_MAP_1X1
;
1367 adapter
->user_dev_mcs_support
= HT_STREAM_2X2
;
1368 if (adapter
->is_hw_11ac_capable
)
1369 adapter
->usr_dot_11ac_mcs_support
=
1370 MWIFIEX_11AC_MCS_MAP_2X2
;
1373 for (band
= 0; band
< IEEE80211_NUM_BANDS
; band
++) {
1374 if (!adapter
->wiphy
->bands
[band
])
1377 ht_info
= &adapter
->wiphy
->bands
[band
]->ht_cap
;
1379 GET_RXMCSSUPP(adapter
->user_dev_mcs_support
);
1380 memset(&ht_info
->mcs
, 0, adapter
->number_of_antenna
);
1381 memset(&ht_info
->mcs
, 0xff, rx_mcs_supp
);
1385 ant_cfg
.tx_ant
= tx_ant
;
1386 ant_cfg
.rx_ant
= rx_ant
;
1388 return mwifiex_send_cmd(priv
, HostCmd_CMD_RF_ANTENNA
,
1389 HostCmd_ACT_GEN_SET
, 0, &ant_cfg
, true);
1392 /* cfg80211 operation handler for stop ap.
1393 * Function stops BSS running at uAP interface.
1395 static int mwifiex_cfg80211_stop_ap(struct wiphy
*wiphy
, struct net_device
*dev
)
1397 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1399 if (mwifiex_del_mgmt_ies(priv
))
1400 wiphy_err(wiphy
, "Failed to delete mgmt IEs!\n");
1402 priv
->ap_11n_enabled
= 0;
1404 if (mwifiex_send_cmd(priv
, HostCmd_CMD_UAP_BSS_STOP
,
1405 HostCmd_ACT_GEN_SET
, 0, NULL
, true)) {
1406 wiphy_err(wiphy
, "Failed to stop the BSS\n");
1413 /* cfg80211 operation handler for start_ap.
1414 * Function sets beacon period, DTIM period, SSID and security into
1415 * AP config structure.
1416 * AP is configured with these settings and BSS is started.
1418 static int mwifiex_cfg80211_start_ap(struct wiphy
*wiphy
,
1419 struct net_device
*dev
,
1420 struct cfg80211_ap_settings
*params
)
1422 struct mwifiex_uap_bss_param
*bss_cfg
;
1423 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1424 u8 config_bands
= 0;
1426 if (GET_BSS_ROLE(priv
) != MWIFIEX_BSS_ROLE_UAP
)
1428 if (mwifiex_set_mgmt_ies(priv
, ¶ms
->beacon
))
1431 bss_cfg
= kzalloc(sizeof(struct mwifiex_uap_bss_param
), GFP_KERNEL
);
1435 mwifiex_set_sys_config_invalid_data(bss_cfg
);
1437 if (params
->beacon_interval
)
1438 bss_cfg
->beacon_period
= params
->beacon_interval
;
1439 if (params
->dtim_period
)
1440 bss_cfg
->dtim_period
= params
->dtim_period
;
1442 if (params
->ssid
&& params
->ssid_len
) {
1443 memcpy(bss_cfg
->ssid
.ssid
, params
->ssid
, params
->ssid_len
);
1444 bss_cfg
->ssid
.ssid_len
= params
->ssid_len
;
1447 switch (params
->hidden_ssid
) {
1448 case NL80211_HIDDEN_SSID_NOT_IN_USE
:
1449 bss_cfg
->bcast_ssid_ctl
= 1;
1451 case NL80211_HIDDEN_SSID_ZERO_LEN
:
1452 bss_cfg
->bcast_ssid_ctl
= 0;
1454 case NL80211_HIDDEN_SSID_ZERO_CONTENTS
:
1455 /* firmware doesn't support this type of hidden SSID */
1461 bss_cfg
->channel
= ieee80211_frequency_to_channel(
1462 params
->chandef
.chan
->center_freq
);
1464 /* Set appropriate bands */
1465 if (params
->chandef
.chan
->band
== IEEE80211_BAND_2GHZ
) {
1466 bss_cfg
->band_cfg
= BAND_CONFIG_BG
;
1467 config_bands
= BAND_B
| BAND_G
;
1469 if (params
->chandef
.width
> NL80211_CHAN_WIDTH_20_NOHT
)
1470 config_bands
|= BAND_GN
;
1472 bss_cfg
->band_cfg
= BAND_CONFIG_A
;
1473 config_bands
= BAND_A
;
1475 if (params
->chandef
.width
> NL80211_CHAN_WIDTH_20_NOHT
)
1476 config_bands
|= BAND_AN
;
1478 if (params
->chandef
.width
> NL80211_CHAN_WIDTH_40
)
1479 config_bands
|= BAND_AAC
;
1482 if (!((config_bands
| priv
->adapter
->fw_bands
) &
1483 ~priv
->adapter
->fw_bands
))
1484 priv
->adapter
->config_bands
= config_bands
;
1486 mwifiex_set_uap_rates(bss_cfg
, params
);
1487 mwifiex_send_domain_info_cmd_fw(wiphy
);
1489 if (mwifiex_set_secure_params(priv
, bss_cfg
, params
)) {
1491 wiphy_err(wiphy
, "Failed to parse secuirty parameters!\n");
1495 mwifiex_set_ht_params(priv
, bss_cfg
, params
);
1497 if (priv
->adapter
->is_hw_11ac_capable
) {
1498 mwifiex_set_vht_params(priv
, bss_cfg
, params
);
1499 mwifiex_set_vht_width(priv
, params
->chandef
.width
,
1500 priv
->ap_11ac_enabled
);
1503 if (priv
->ap_11ac_enabled
)
1504 mwifiex_set_11ac_ba_params(priv
);
1506 mwifiex_set_ba_params(priv
);
1508 mwifiex_set_wmm_params(priv
, bss_cfg
, params
);
1510 if (params
->inactivity_timeout
> 0) {
1511 /* sta_ao_timer/ps_sta_ao_timer is in unit of 100ms */
1512 bss_cfg
->sta_ao_timer
= 10 * params
->inactivity_timeout
;
1513 bss_cfg
->ps_sta_ao_timer
= 10 * params
->inactivity_timeout
;
1516 if (mwifiex_send_cmd(priv
, HostCmd_CMD_UAP_BSS_STOP
,
1517 HostCmd_ACT_GEN_SET
, 0, NULL
, true)) {
1518 wiphy_err(wiphy
, "Failed to stop the BSS\n");
1523 if (mwifiex_send_cmd(priv
, HostCmd_CMD_UAP_SYS_CONFIG
,
1524 HostCmd_ACT_GEN_SET
,
1525 UAP_BSS_PARAMS_I
, bss_cfg
, false)) {
1526 wiphy_err(wiphy
, "Failed to set the SSID\n");
1533 if (mwifiex_send_cmd(priv
, HostCmd_CMD_UAP_BSS_START
,
1534 HostCmd_ACT_GEN_SET
, 0, NULL
, false)) {
1535 wiphy_err(wiphy
, "Failed to start the BSS\n");
1539 if (priv
->sec_info
.wep_enabled
)
1540 priv
->curr_pkt_filter
|= HostCmd_ACT_MAC_WEP_ENABLE
;
1542 priv
->curr_pkt_filter
&= ~HostCmd_ACT_MAC_WEP_ENABLE
;
1544 if (mwifiex_send_cmd(priv
, HostCmd_CMD_MAC_CONTROL
,
1545 HostCmd_ACT_GEN_SET
, 0,
1546 &priv
->curr_pkt_filter
, true))
1553 * CFG802.11 operation handler for disconnection request.
1555 * This function does not work when there is already a disconnection
1556 * procedure going on.
1559 mwifiex_cfg80211_disconnect(struct wiphy
*wiphy
, struct net_device
*dev
,
1562 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1564 if (mwifiex_deauthenticate(priv
, NULL
))
1567 wiphy_dbg(wiphy
, "info: successfully disconnected from %pM:"
1568 " reason code %d\n", priv
->cfg_bssid
, reason_code
);
1570 memset(priv
->cfg_bssid
, 0, ETH_ALEN
);
1571 priv
->hs2_enabled
= false;
1577 * This function informs the CFG802.11 subsystem of a new IBSS.
1579 * The following information are sent to the CFG802.11 subsystem
1580 * to register the new IBSS. If we do not register the new IBSS,
1581 * a kernel panic will result.
1587 static int mwifiex_cfg80211_inform_ibss_bss(struct mwifiex_private
*priv
)
1589 struct ieee80211_channel
*chan
;
1590 struct mwifiex_bss_info bss_info
;
1591 struct cfg80211_bss
*bss
;
1593 u8 ie_buf
[IEEE80211_MAX_SSID_LEN
+ sizeof(struct ieee_types_header
)];
1594 enum ieee80211_band band
;
1596 if (mwifiex_get_bss_info(priv
, &bss_info
))
1599 ie_buf
[0] = WLAN_EID_SSID
;
1600 ie_buf
[1] = bss_info
.ssid
.ssid_len
;
1602 memcpy(&ie_buf
[sizeof(struct ieee_types_header
)],
1603 &bss_info
.ssid
.ssid
, bss_info
.ssid
.ssid_len
);
1604 ie_len
= ie_buf
[1] + sizeof(struct ieee_types_header
);
1606 band
= mwifiex_band_to_radio_type(priv
->curr_bss_params
.band
);
1607 chan
= __ieee80211_get_channel(priv
->wdev
->wiphy
,
1608 ieee80211_channel_to_frequency(bss_info
.bss_chan
,
1611 bss
= cfg80211_inform_bss(priv
->wdev
->wiphy
, chan
,
1612 CFG80211_BSS_FTYPE_UNKNOWN
,
1613 bss_info
.bssid
, 0, WLAN_CAPABILITY_IBSS
,
1614 0, ie_buf
, ie_len
, 0, GFP_KERNEL
);
1615 cfg80211_put_bss(priv
->wdev
->wiphy
, bss
);
1616 memcpy(priv
->cfg_bssid
, bss_info
.bssid
, ETH_ALEN
);
1622 * This function connects with a BSS.
1624 * This function handles both Infra and Ad-Hoc modes. It also performs
1625 * validity checking on the provided parameters, disconnects from the
1626 * current BSS (if any), sets up the association/scan parameters,
1627 * including security settings, and performs specific SSID scan before
1628 * trying to connect.
1630 * For Infra mode, the function returns failure if the specified SSID
1631 * is not found in scan table. However, for Ad-Hoc mode, it can create
1632 * the IBSS if it does not exist. On successful completion in either case,
1633 * the function notifies the CFG802.11 subsystem of the new BSS connection.
1636 mwifiex_cfg80211_assoc(struct mwifiex_private
*priv
, size_t ssid_len
,
1637 const u8
*ssid
, const u8
*bssid
, int mode
,
1638 struct ieee80211_channel
*channel
,
1639 struct cfg80211_connect_params
*sme
, bool privacy
)
1641 struct cfg80211_ssid req_ssid
;
1642 int ret
, auth_type
= 0;
1643 struct cfg80211_bss
*bss
= NULL
;
1644 u8 is_scanning_required
= 0;
1646 memset(&req_ssid
, 0, sizeof(struct cfg80211_ssid
));
1648 req_ssid
.ssid_len
= ssid_len
;
1649 if (ssid_len
> IEEE80211_MAX_SSID_LEN
) {
1650 dev_err(priv
->adapter
->dev
, "invalid SSID - aborting\n");
1654 memcpy(req_ssid
.ssid
, ssid
, ssid_len
);
1655 if (!req_ssid
.ssid_len
|| req_ssid
.ssid
[0] < 0x20) {
1656 dev_err(priv
->adapter
->dev
, "invalid SSID - aborting\n");
1660 /* As this is new association, clear locally stored
1661 * keys and security related flags */
1662 priv
->sec_info
.wpa_enabled
= false;
1663 priv
->sec_info
.wpa2_enabled
= false;
1664 priv
->wep_key_curr_index
= 0;
1665 priv
->sec_info
.encryption_mode
= 0;
1666 priv
->sec_info
.is_authtype_auto
= 0;
1667 ret
= mwifiex_set_encode(priv
, NULL
, NULL
, 0, 0, NULL
, 1);
1669 if (mode
== NL80211_IFTYPE_ADHOC
) {
1670 /* "privacy" is set only for ad-hoc mode */
1673 * Keep WLAN_CIPHER_SUITE_WEP104 for now so that
1674 * the firmware can find a matching network from the
1675 * scan. The cfg80211 does not give us the encryption
1676 * mode at this stage so just setting it to WEP here.
1678 priv
->sec_info
.encryption_mode
=
1679 WLAN_CIPHER_SUITE_WEP104
;
1680 priv
->sec_info
.authentication_mode
=
1681 NL80211_AUTHTYPE_OPEN_SYSTEM
;
1687 /* Now handle infra mode. "sme" is valid for infra mode only */
1688 if (sme
->auth_type
== NL80211_AUTHTYPE_AUTOMATIC
) {
1689 auth_type
= NL80211_AUTHTYPE_OPEN_SYSTEM
;
1690 priv
->sec_info
.is_authtype_auto
= 1;
1692 auth_type
= sme
->auth_type
;
1695 if (sme
->crypto
.n_ciphers_pairwise
) {
1696 priv
->sec_info
.encryption_mode
=
1697 sme
->crypto
.ciphers_pairwise
[0];
1698 priv
->sec_info
.authentication_mode
= auth_type
;
1701 if (sme
->crypto
.cipher_group
) {
1702 priv
->sec_info
.encryption_mode
= sme
->crypto
.cipher_group
;
1703 priv
->sec_info
.authentication_mode
= auth_type
;
1706 ret
= mwifiex_set_gen_ie(priv
, sme
->ie
, sme
->ie_len
);
1709 if (mwifiex_is_alg_wep(priv
->sec_info
.encryption_mode
)) {
1710 dev_dbg(priv
->adapter
->dev
,
1711 "info: setting wep encryption"
1712 " with key len %d\n", sme
->key_len
);
1713 priv
->wep_key_curr_index
= sme
->key_idx
;
1714 ret
= mwifiex_set_encode(priv
, NULL
, sme
->key
,
1715 sme
->key_len
, sme
->key_idx
,
1721 * Scan entries are valid for some time (15 sec). So we can save one
1722 * active scan time if we just try cfg80211_get_bss first. If it fails
1723 * then request scan and cfg80211_get_bss() again for final output.
1726 if (is_scanning_required
) {
1727 /* Do specific SSID scanning */
1728 if (mwifiex_request_scan(priv
, &req_ssid
)) {
1729 dev_err(priv
->adapter
->dev
, "scan error\n");
1734 /* Find the BSS we want using available scan results */
1735 if (mode
== NL80211_IFTYPE_ADHOC
)
1736 bss
= cfg80211_get_bss(priv
->wdev
->wiphy
, channel
,
1737 bssid
, ssid
, ssid_len
,
1738 WLAN_CAPABILITY_IBSS
,
1739 WLAN_CAPABILITY_IBSS
);
1741 bss
= cfg80211_get_bss(priv
->wdev
->wiphy
, channel
,
1742 bssid
, ssid
, ssid_len
,
1743 WLAN_CAPABILITY_ESS
,
1744 WLAN_CAPABILITY_ESS
);
1747 if (is_scanning_required
) {
1748 dev_warn(priv
->adapter
->dev
,
1749 "assoc: requested bss not found in scan results\n");
1752 is_scanning_required
= 1;
1754 dev_dbg(priv
->adapter
->dev
,
1755 "info: trying to associate to '%s' bssid %pM\n",
1756 (char *) req_ssid
.ssid
, bss
->bssid
);
1757 memcpy(&priv
->cfg_bssid
, bss
->bssid
, ETH_ALEN
);
1762 ret
= mwifiex_bss_start(priv
, bss
, &req_ssid
);
1766 if (mode
== NL80211_IFTYPE_ADHOC
) {
1767 /* Inform the BSS information to kernel, otherwise
1768 * kernel will give a panic after successful assoc */
1769 if (mwifiex_cfg80211_inform_ibss_bss(priv
))
1777 * CFG802.11 operation handler for association request.
1779 * This function does not work when the current mode is set to Ad-Hoc, or
1780 * when there is already an association procedure going on. The given BSS
1781 * information is used to associate.
1784 mwifiex_cfg80211_connect(struct wiphy
*wiphy
, struct net_device
*dev
,
1785 struct cfg80211_connect_params
*sme
)
1787 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1790 if (GET_BSS_ROLE(priv
) != MWIFIEX_BSS_ROLE_STA
) {
1792 "%s: reject infra assoc request in non-STA role\n",
1797 if (priv
->wdev
&& priv
->wdev
->current_bss
) {
1798 wiphy_warn(wiphy
, "%s: already connected\n", dev
->name
);
1802 wiphy_dbg(wiphy
, "info: Trying to associate to %s and bssid %pM\n",
1803 (char *) sme
->ssid
, sme
->bssid
);
1805 ret
= mwifiex_cfg80211_assoc(priv
, sme
->ssid_len
, sme
->ssid
, sme
->bssid
,
1806 priv
->bss_mode
, sme
->channel
, sme
, 0);
1808 cfg80211_connect_result(priv
->netdev
, priv
->cfg_bssid
, NULL
, 0,
1809 NULL
, 0, WLAN_STATUS_SUCCESS
,
1811 dev_dbg(priv
->adapter
->dev
,
1812 "info: associated to bssid %pM successfully\n",
1814 if (ISSUPP_TDLS_ENABLED(priv
->adapter
->fw_cap_info
) &&
1815 priv
->adapter
->auto_tdls
&&
1816 priv
->bss_type
== MWIFIEX_BSS_TYPE_STA
)
1817 mwifiex_setup_auto_tdls_timer(priv
);
1819 dev_dbg(priv
->adapter
->dev
,
1820 "info: association to bssid %pM failed\n",
1822 memset(priv
->cfg_bssid
, 0, ETH_ALEN
);
1825 cfg80211_connect_result(priv
->netdev
, priv
->cfg_bssid
,
1826 NULL
, 0, NULL
, 0, ret
,
1829 cfg80211_connect_result(priv
->netdev
, priv
->cfg_bssid
,
1831 WLAN_STATUS_UNSPECIFIED_FAILURE
,
1839 * This function sets following parameters for ibss network.
1843 * - secondary channel offset
1845 static int mwifiex_set_ibss_params(struct mwifiex_private
*priv
,
1846 struct cfg80211_ibss_params
*params
)
1848 struct wiphy
*wiphy
= priv
->wdev
->wiphy
;
1849 struct mwifiex_adapter
*adapter
= priv
->adapter
;
1851 u8 config_bands
= 0;
1853 if (params
->chandef
.chan
->band
== IEEE80211_BAND_2GHZ
) {
1854 if (!params
->basic_rates
) {
1855 config_bands
= BAND_B
| BAND_G
;
1857 for (i
= 0; i
< mwifiex_band_2ghz
.n_bitrates
; i
++) {
1859 * Rates below 6 Mbps in the table are CCK
1860 * rates; 802.11b and from 6 they are OFDM;
1863 if (mwifiex_rates
[i
].bitrate
== 60) {
1869 if (params
->basic_rates
< index
) {
1870 config_bands
= BAND_B
;
1872 config_bands
= BAND_G
;
1873 if (params
->basic_rates
% index
)
1874 config_bands
|= BAND_B
;
1878 if (cfg80211_get_chandef_type(¶ms
->chandef
) !=
1880 config_bands
|= BAND_G
| BAND_GN
;
1882 if (cfg80211_get_chandef_type(¶ms
->chandef
) ==
1884 config_bands
= BAND_A
;
1886 config_bands
= BAND_AN
| BAND_A
;
1889 if (!((config_bands
| adapter
->fw_bands
) & ~adapter
->fw_bands
)) {
1890 adapter
->config_bands
= config_bands
;
1891 adapter
->adhoc_start_band
= config_bands
;
1893 if ((config_bands
& BAND_GN
) || (config_bands
& BAND_AN
))
1894 adapter
->adhoc_11n_enabled
= true;
1896 adapter
->adhoc_11n_enabled
= false;
1899 adapter
->sec_chan_offset
=
1900 mwifiex_chan_type_to_sec_chan_offset(
1901 cfg80211_get_chandef_type(¶ms
->chandef
));
1902 priv
->adhoc_channel
= ieee80211_frequency_to_channel(
1903 params
->chandef
.chan
->center_freq
);
1905 wiphy_dbg(wiphy
, "info: set ibss band %d, chan %d, chan offset %d\n",
1906 config_bands
, priv
->adhoc_channel
, adapter
->sec_chan_offset
);
1912 * CFG802.11 operation handler to join an IBSS.
1914 * This function does not work in any mode other than Ad-Hoc, or if
1915 * a join operation is already in progress.
1918 mwifiex_cfg80211_join_ibss(struct wiphy
*wiphy
, struct net_device
*dev
,
1919 struct cfg80211_ibss_params
*params
)
1921 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1924 if (priv
->bss_mode
!= NL80211_IFTYPE_ADHOC
) {
1925 wiphy_err(wiphy
, "request to join ibss received "
1926 "when station is not in ibss mode\n");
1930 wiphy_dbg(wiphy
, "info: trying to join to %s and bssid %pM\n",
1931 (char *) params
->ssid
, params
->bssid
);
1933 mwifiex_set_ibss_params(priv
, params
);
1935 ret
= mwifiex_cfg80211_assoc(priv
, params
->ssid_len
, params
->ssid
,
1936 params
->bssid
, priv
->bss_mode
,
1937 params
->chandef
.chan
, NULL
,
1941 cfg80211_ibss_joined(priv
->netdev
, priv
->cfg_bssid
,
1942 params
->chandef
.chan
, GFP_KERNEL
);
1943 dev_dbg(priv
->adapter
->dev
,
1944 "info: joined/created adhoc network with bssid"
1945 " %pM successfully\n", priv
->cfg_bssid
);
1947 dev_dbg(priv
->adapter
->dev
,
1948 "info: failed creating/joining adhoc network\n");
1955 * CFG802.11 operation handler to leave an IBSS.
1957 * This function does not work if a leave operation is
1958 * already in progress.
1961 mwifiex_cfg80211_leave_ibss(struct wiphy
*wiphy
, struct net_device
*dev
)
1963 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1965 wiphy_dbg(wiphy
, "info: disconnecting from essid %pM\n",
1967 if (mwifiex_deauthenticate(priv
, NULL
))
1970 memset(priv
->cfg_bssid
, 0, ETH_ALEN
);
1976 * CFG802.11 operation handler for scan request.
1978 * This function issues a scan request to the firmware based upon
1979 * the user specified scan configuration. On successfull completion,
1980 * it also informs the results.
1983 mwifiex_cfg80211_scan(struct wiphy
*wiphy
,
1984 struct cfg80211_scan_request
*request
)
1986 struct net_device
*dev
= request
->wdev
->netdev
;
1987 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
1989 struct ieee80211_channel
*chan
;
1990 struct ieee_types_header
*ie
;
1991 struct mwifiex_user_scan_cfg
*user_scan_cfg
;
1993 wiphy_dbg(wiphy
, "info: received scan request on %s\n", dev
->name
);
1995 /* Block scan request if scan operation or scan cleanup when interface
1996 * is disabled is in process
1998 if (priv
->scan_request
|| priv
->scan_aborting
) {
1999 dev_err(priv
->adapter
->dev
, "cmd: Scan already in process..\n");
2003 user_scan_cfg
= kzalloc(sizeof(*user_scan_cfg
), GFP_KERNEL
);
2007 priv
->scan_request
= request
;
2009 user_scan_cfg
->num_ssids
= request
->n_ssids
;
2010 user_scan_cfg
->ssid_list
= request
->ssids
;
2012 if (request
->ie
&& request
->ie_len
) {
2014 for (i
= 0; i
< MWIFIEX_MAX_VSIE_NUM
; i
++) {
2015 if (priv
->vs_ie
[i
].mask
!= MWIFIEX_VSIE_MASK_CLEAR
)
2017 priv
->vs_ie
[i
].mask
= MWIFIEX_VSIE_MASK_SCAN
;
2018 ie
= (struct ieee_types_header
*)(request
->ie
+ offset
);
2019 memcpy(&priv
->vs_ie
[i
].ie
, ie
, sizeof(*ie
) + ie
->len
);
2020 offset
+= sizeof(*ie
) + ie
->len
;
2022 if (offset
>= request
->ie_len
)
2027 for (i
= 0; i
< min_t(u32
, request
->n_channels
,
2028 MWIFIEX_USER_SCAN_CHAN_MAX
); i
++) {
2029 chan
= request
->channels
[i
];
2030 user_scan_cfg
->chan_list
[i
].chan_number
= chan
->hw_value
;
2031 user_scan_cfg
->chan_list
[i
].radio_type
= chan
->band
;
2033 if ((chan
->flags
& IEEE80211_CHAN_NO_IR
) || !request
->n_ssids
)
2034 user_scan_cfg
->chan_list
[i
].scan_type
=
2035 MWIFIEX_SCAN_TYPE_PASSIVE
;
2037 user_scan_cfg
->chan_list
[i
].scan_type
=
2038 MWIFIEX_SCAN_TYPE_ACTIVE
;
2040 user_scan_cfg
->chan_list
[i
].scan_time
= 0;
2043 if (priv
->adapter
->scan_chan_gap_enabled
&&
2044 mwifiex_is_any_intf_active(priv
))
2045 user_scan_cfg
->scan_chan_gap
=
2046 priv
->adapter
->scan_chan_gap_time
;
2048 ret
= mwifiex_scan_networks(priv
, user_scan_cfg
);
2049 kfree(user_scan_cfg
);
2051 dev_err(priv
->adapter
->dev
, "scan failed: %d\n", ret
);
2052 priv
->scan_aborting
= false;
2053 priv
->scan_request
= NULL
;
2057 if (request
->ie
&& request
->ie_len
) {
2058 for (i
= 0; i
< MWIFIEX_MAX_VSIE_NUM
; i
++) {
2059 if (priv
->vs_ie
[i
].mask
== MWIFIEX_VSIE_MASK_SCAN
) {
2060 priv
->vs_ie
[i
].mask
= MWIFIEX_VSIE_MASK_CLEAR
;
2061 memset(&priv
->vs_ie
[i
].ie
, 0,
2062 MWIFIEX_MAX_VSIE_LEN
);
2069 static void mwifiex_setup_vht_caps(struct ieee80211_sta_vht_cap
*vht_info
,
2070 struct mwifiex_private
*priv
)
2072 struct mwifiex_adapter
*adapter
= priv
->adapter
;
2074 vht_info
->vht_supported
= true;
2076 vht_info
->cap
= adapter
->hw_dot_11ac_dev_cap
;
2077 /* Update MCS support for VHT */
2078 vht_info
->vht_mcs
.rx_mcs_map
= cpu_to_le16(
2079 adapter
->hw_dot_11ac_mcs_support
& 0xFFFF);
2080 vht_info
->vht_mcs
.rx_highest
= 0;
2081 vht_info
->vht_mcs
.tx_mcs_map
= cpu_to_le16(
2082 adapter
->hw_dot_11ac_mcs_support
>> 16);
2083 vht_info
->vht_mcs
.tx_highest
= 0;
2087 * This function sets up the CFG802.11 specific HT capability fields
2088 * with default values.
2090 * The following default values are set -
2091 * - HT Supported = True
2092 * - Maximum AMPDU length factor = IEEE80211_HT_MAX_AMPDU_64K
2093 * - Minimum AMPDU spacing = IEEE80211_HT_MPDU_DENSITY_NONE
2094 * - HT Capabilities supported by firmware
2095 * - MCS information, Rx mask = 0xff
2096 * - MCD information, Tx parameters = IEEE80211_HT_MCS_TX_DEFINED (0x01)
2099 mwifiex_setup_ht_caps(struct ieee80211_sta_ht_cap
*ht_info
,
2100 struct mwifiex_private
*priv
)
2103 struct ieee80211_mcs_info mcs_set
;
2104 u8
*mcs
= (u8
*)&mcs_set
;
2105 struct mwifiex_adapter
*adapter
= priv
->adapter
;
2107 ht_info
->ht_supported
= true;
2108 ht_info
->ampdu_factor
= IEEE80211_HT_MAX_AMPDU_64K
;
2109 ht_info
->ampdu_density
= IEEE80211_HT_MPDU_DENSITY_NONE
;
2111 memset(&ht_info
->mcs
, 0, sizeof(ht_info
->mcs
));
2113 /* Fill HT capability information */
2114 if (ISSUPP_CHANWIDTH40(adapter
->hw_dot_11n_dev_cap
))
2115 ht_info
->cap
|= IEEE80211_HT_CAP_SUP_WIDTH_20_40
;
2117 ht_info
->cap
&= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40
;
2119 if (ISSUPP_SHORTGI20(adapter
->hw_dot_11n_dev_cap
))
2120 ht_info
->cap
|= IEEE80211_HT_CAP_SGI_20
;
2122 ht_info
->cap
&= ~IEEE80211_HT_CAP_SGI_20
;
2124 if (ISSUPP_SHORTGI40(adapter
->hw_dot_11n_dev_cap
))
2125 ht_info
->cap
|= IEEE80211_HT_CAP_SGI_40
;
2127 ht_info
->cap
&= ~IEEE80211_HT_CAP_SGI_40
;
2129 if (adapter
->user_dev_mcs_support
== HT_STREAM_2X2
)
2130 ht_info
->cap
|= 3 << IEEE80211_HT_CAP_RX_STBC_SHIFT
;
2132 ht_info
->cap
|= 1 << IEEE80211_HT_CAP_RX_STBC_SHIFT
;
2134 if (ISSUPP_TXSTBC(adapter
->hw_dot_11n_dev_cap
))
2135 ht_info
->cap
|= IEEE80211_HT_CAP_TX_STBC
;
2137 ht_info
->cap
&= ~IEEE80211_HT_CAP_TX_STBC
;
2139 if (ISSUPP_GREENFIELD(adapter
->hw_dot_11n_dev_cap
))
2140 ht_info
->cap
|= IEEE80211_HT_CAP_GRN_FLD
;
2142 ht_info
->cap
&= ~IEEE80211_HT_CAP_GRN_FLD
;
2144 if (ISENABLED_40MHZ_INTOLERANT(adapter
->hw_dot_11n_dev_cap
))
2145 ht_info
->cap
|= IEEE80211_HT_CAP_40MHZ_INTOLERANT
;
2147 ht_info
->cap
&= ~IEEE80211_HT_CAP_40MHZ_INTOLERANT
;
2149 if (ISSUPP_RXLDPC(adapter
->hw_dot_11n_dev_cap
))
2150 ht_info
->cap
|= IEEE80211_HT_CAP_LDPC_CODING
;
2152 ht_info
->cap
&= ~IEEE80211_HT_CAP_LDPC_CODING
;
2154 ht_info
->cap
&= ~IEEE80211_HT_CAP_MAX_AMSDU
;
2155 ht_info
->cap
|= IEEE80211_HT_CAP_SM_PS
;
2157 rx_mcs_supp
= GET_RXMCSSUPP(adapter
->user_dev_mcs_support
);
2158 /* Set MCS for 1x1/2x2 */
2159 memset(mcs
, 0xff, rx_mcs_supp
);
2160 /* Clear all the other values */
2161 memset(&mcs
[rx_mcs_supp
], 0,
2162 sizeof(struct ieee80211_mcs_info
) - rx_mcs_supp
);
2163 if (priv
->bss_mode
== NL80211_IFTYPE_STATION
||
2164 ISSUPP_CHANWIDTH40(adapter
->hw_dot_11n_dev_cap
))
2165 /* Set MCS32 for infra mode or ad-hoc mode with 40MHz support */
2166 SETHT_MCS32(mcs_set
.rx_mask
);
2168 memcpy((u8
*) &ht_info
->mcs
, mcs
, sizeof(struct ieee80211_mcs_info
));
2170 ht_info
->mcs
.tx_params
= IEEE80211_HT_MCS_TX_DEFINED
;
2174 * create a new virtual interface with the given name
2176 struct wireless_dev
*mwifiex_add_virtual_intf(struct wiphy
*wiphy
,
2178 enum nl80211_iftype type
,
2180 struct vif_params
*params
)
2182 struct mwifiex_adapter
*adapter
= mwifiex_cfg80211_get_adapter(wiphy
);
2183 struct mwifiex_private
*priv
;
2184 struct net_device
*dev
;
2186 struct wireless_dev
*wdev
;
2189 return ERR_PTR(-EFAULT
);
2192 case NL80211_IFTYPE_UNSPECIFIED
:
2193 case NL80211_IFTYPE_STATION
:
2194 case NL80211_IFTYPE_ADHOC
:
2195 priv
= adapter
->priv
[MWIFIEX_BSS_TYPE_STA
];
2196 if (priv
->bss_mode
) {
2198 "cannot create multiple sta/adhoc ifaces\n");
2199 return ERR_PTR(-EINVAL
);
2202 wdev
= kzalloc(sizeof(struct wireless_dev
), GFP_KERNEL
);
2204 return ERR_PTR(-ENOMEM
);
2206 wdev
->wiphy
= wiphy
;
2208 wdev
->iftype
= NL80211_IFTYPE_STATION
;
2210 if (type
== NL80211_IFTYPE_UNSPECIFIED
)
2211 priv
->bss_mode
= NL80211_IFTYPE_STATION
;
2213 priv
->bss_mode
= type
;
2215 priv
->bss_type
= MWIFIEX_BSS_TYPE_STA
;
2216 priv
->frame_type
= MWIFIEX_DATA_FRAME_TYPE_ETH_II
;
2217 priv
->bss_priority
= 0;
2218 priv
->bss_role
= MWIFIEX_BSS_ROLE_STA
;
2222 case NL80211_IFTYPE_AP
:
2223 priv
= adapter
->priv
[MWIFIEX_BSS_TYPE_UAP
];
2225 if (priv
->bss_mode
) {
2226 wiphy_err(wiphy
, "Can't create multiple AP interfaces");
2227 return ERR_PTR(-EINVAL
);
2230 wdev
= kzalloc(sizeof(struct wireless_dev
), GFP_KERNEL
);
2232 return ERR_PTR(-ENOMEM
);
2235 wdev
->wiphy
= wiphy
;
2236 wdev
->iftype
= NL80211_IFTYPE_AP
;
2238 priv
->bss_type
= MWIFIEX_BSS_TYPE_UAP
;
2239 priv
->frame_type
= MWIFIEX_DATA_FRAME_TYPE_ETH_II
;
2240 priv
->bss_priority
= 0;
2241 priv
->bss_role
= MWIFIEX_BSS_ROLE_UAP
;
2242 priv
->bss_started
= 0;
2244 priv
->bss_mode
= type
;
2247 case NL80211_IFTYPE_P2P_CLIENT
:
2248 priv
= adapter
->priv
[MWIFIEX_BSS_TYPE_P2P
];
2250 if (priv
->bss_mode
) {
2251 wiphy_err(wiphy
, "Can't create multiple P2P ifaces");
2252 return ERR_PTR(-EINVAL
);
2255 wdev
= kzalloc(sizeof(struct wireless_dev
), GFP_KERNEL
);
2257 return ERR_PTR(-ENOMEM
);
2260 wdev
->wiphy
= wiphy
;
2262 /* At start-up, wpa_supplicant tries to change the interface
2263 * to NL80211_IFTYPE_STATION if it is not managed mode.
2265 wdev
->iftype
= NL80211_IFTYPE_P2P_CLIENT
;
2266 priv
->bss_mode
= NL80211_IFTYPE_P2P_CLIENT
;
2268 /* Setting bss_type to P2P tells firmware that this interface
2269 * is receiving P2P peers found during find phase and doing
2270 * action frame handshake.
2272 priv
->bss_type
= MWIFIEX_BSS_TYPE_P2P
;
2274 priv
->frame_type
= MWIFIEX_DATA_FRAME_TYPE_ETH_II
;
2275 priv
->bss_priority
= MWIFIEX_BSS_ROLE_STA
;
2276 priv
->bss_role
= MWIFIEX_BSS_ROLE_STA
;
2277 priv
->bss_started
= 0;
2280 if (mwifiex_cfg80211_init_p2p_client(priv
)) {
2281 wdev
= ERR_PTR(-EFAULT
);
2287 wiphy_err(wiphy
, "type not supported\n");
2288 return ERR_PTR(-EINVAL
);
2291 dev
= alloc_netdev_mqs(sizeof(struct mwifiex_private
*), name
,
2292 NET_NAME_UNKNOWN
, ether_setup
,
2293 IEEE80211_NUM_ACS
, 1);
2295 wiphy_err(wiphy
, "no memory available for netdevice\n");
2296 priv
->bss_mode
= NL80211_IFTYPE_UNSPECIFIED
;
2297 wdev
= ERR_PTR(-ENOMEM
);
2301 mwifiex_init_priv_params(priv
, dev
);
2304 mwifiex_setup_ht_caps(&wiphy
->bands
[IEEE80211_BAND_2GHZ
]->ht_cap
, priv
);
2305 if (adapter
->is_hw_11ac_capable
)
2306 mwifiex_setup_vht_caps(
2307 &wiphy
->bands
[IEEE80211_BAND_2GHZ
]->vht_cap
, priv
);
2309 if (adapter
->config_bands
& BAND_A
)
2310 mwifiex_setup_ht_caps(
2311 &wiphy
->bands
[IEEE80211_BAND_5GHZ
]->ht_cap
, priv
);
2313 if ((adapter
->config_bands
& BAND_A
) && adapter
->is_hw_11ac_capable
)
2314 mwifiex_setup_vht_caps(
2315 &wiphy
->bands
[IEEE80211_BAND_5GHZ
]->vht_cap
, priv
);
2317 dev_net_set(dev
, wiphy_net(wiphy
));
2318 dev
->ieee80211_ptr
= priv
->wdev
;
2319 dev
->ieee80211_ptr
->iftype
= priv
->bss_mode
;
2320 memcpy(dev
->dev_addr
, wiphy
->perm_addr
, ETH_ALEN
);
2321 SET_NETDEV_DEV(dev
, wiphy_dev(wiphy
));
2323 dev
->flags
|= IFF_BROADCAST
| IFF_MULTICAST
;
2324 dev
->watchdog_timeo
= MWIFIEX_DEFAULT_WATCHDOG_TIMEOUT
;
2325 dev
->hard_header_len
+= MWIFIEX_MIN_DATA_HEADER_LEN
;
2326 dev
->ethtool_ops
= &mwifiex_ethtool_ops
;
2328 mdev_priv
= netdev_priv(dev
);
2329 *((unsigned long *) mdev_priv
) = (unsigned long) priv
;
2331 SET_NETDEV_DEV(dev
, adapter
->dev
);
2333 /* Register network device */
2334 if (register_netdevice(dev
)) {
2335 wiphy_err(wiphy
, "cannot register virtual network device\n");
2337 priv
->bss_mode
= NL80211_IFTYPE_UNSPECIFIED
;
2338 priv
->netdev
= NULL
;
2339 wdev
= ERR_PTR(-EFAULT
);
2343 sema_init(&priv
->async_sem
, 1);
2345 dev_dbg(adapter
->dev
, "info: %s: Marvell 802.11 Adapter\n", dev
->name
);
2347 #ifdef CONFIG_DEBUG_FS
2348 mwifiex_dev_debugfs_init(priv
);
2359 EXPORT_SYMBOL_GPL(mwifiex_add_virtual_intf
);
2362 * del_virtual_intf: remove the virtual interface determined by dev
2364 int mwifiex_del_virtual_intf(struct wiphy
*wiphy
, struct wireless_dev
*wdev
)
2366 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(wdev
->netdev
);
2368 #ifdef CONFIG_DEBUG_FS
2369 mwifiex_dev_debugfs_remove(priv
);
2372 mwifiex_stop_net_dev_queue(priv
->netdev
, priv
->adapter
);
2374 if (netif_carrier_ok(priv
->netdev
))
2375 netif_carrier_off(priv
->netdev
);
2377 if (wdev
->netdev
->reg_state
== NETREG_REGISTERED
)
2378 unregister_netdevice(wdev
->netdev
);
2380 /* Clear the priv in adapter */
2381 priv
->netdev
->ieee80211_ptr
= NULL
;
2382 priv
->netdev
= NULL
;
2386 priv
->media_connected
= false;
2388 priv
->bss_mode
= NL80211_IFTYPE_UNSPECIFIED
;
2392 EXPORT_SYMBOL_GPL(mwifiex_del_virtual_intf
);
2395 mwifiex_is_pattern_supported(struct cfg80211_pkt_pattern
*pat
, s8
*byte_seq
,
2398 int j
, k
, valid_byte_cnt
= 0;
2399 bool dont_care_byte
= false;
2401 for (j
= 0; j
< DIV_ROUND_UP(pat
->pattern_len
, 8); j
++) {
2402 for (k
= 0; k
< 8; k
++) {
2403 if (pat
->mask
[j
] & 1 << k
) {
2404 memcpy(byte_seq
+ valid_byte_cnt
,
2405 &pat
->pattern
[j
* 8 + k
], 1);
2411 dont_care_byte
= true;
2414 if (valid_byte_cnt
> max_byte_seq
)
2419 byte_seq
[max_byte_seq
] = valid_byte_cnt
;
2425 static int mwifiex_cfg80211_suspend(struct wiphy
*wiphy
,
2426 struct cfg80211_wowlan
*wowlan
)
2428 struct mwifiex_adapter
*adapter
= mwifiex_cfg80211_get_adapter(wiphy
);
2429 struct mwifiex_ds_mef_cfg mef_cfg
;
2430 struct mwifiex_mef_entry
*mef_entry
;
2431 int i
, filt_num
= 0, ret
;
2432 bool first_pat
= true;
2433 u8 byte_seq
[MWIFIEX_MEF_MAX_BYTESEQ
+ 1];
2434 const u8 ipv4_mc_mac
[] = {0x33, 0x33};
2435 const u8 ipv6_mc_mac
[] = {0x01, 0x00, 0x5e};
2436 struct mwifiex_private
*priv
=
2437 mwifiex_get_priv(adapter
, MWIFIEX_BSS_ROLE_STA
);
2440 dev_warn(adapter
->dev
, "None of the WOWLAN triggers enabled\n");
2444 if (!priv
->media_connected
) {
2445 dev_warn(adapter
->dev
,
2446 "Can not configure WOWLAN in disconnected state\n");
2450 mef_entry
= kzalloc(sizeof(*mef_entry
), GFP_KERNEL
);
2454 memset(&mef_cfg
, 0, sizeof(mef_cfg
));
2455 mef_cfg
.num_entries
= 1;
2456 mef_cfg
.mef_entry
= mef_entry
;
2457 mef_entry
->mode
= MEF_MODE_HOST_SLEEP
;
2458 mef_entry
->action
= MEF_ACTION_ALLOW_AND_WAKEUP_HOST
;
2460 for (i
= 0; i
< wowlan
->n_patterns
; i
++) {
2461 memset(byte_seq
, 0, sizeof(byte_seq
));
2462 if (!mwifiex_is_pattern_supported(&wowlan
->patterns
[i
],
2464 MWIFIEX_MEF_MAX_BYTESEQ
)) {
2465 wiphy_err(wiphy
, "Pattern not supported\n");
2470 if (!wowlan
->patterns
[i
].pkt_offset
) {
2471 if (!(byte_seq
[0] & 0x01) &&
2472 (byte_seq
[MWIFIEX_MEF_MAX_BYTESEQ
] == 1)) {
2473 mef_cfg
.criteria
|= MWIFIEX_CRITERIA_UNICAST
;
2475 } else if (is_broadcast_ether_addr(byte_seq
)) {
2476 mef_cfg
.criteria
|= MWIFIEX_CRITERIA_BROADCAST
;
2478 } else if ((!memcmp(byte_seq
, ipv4_mc_mac
, 2) &&
2479 (byte_seq
[MWIFIEX_MEF_MAX_BYTESEQ
] == 2)) ||
2480 (!memcmp(byte_seq
, ipv6_mc_mac
, 3) &&
2481 (byte_seq
[MWIFIEX_MEF_MAX_BYTESEQ
] == 3))) {
2482 mef_cfg
.criteria
|= MWIFIEX_CRITERIA_MULTICAST
;
2487 mef_entry
->filter
[filt_num
].repeat
= 1;
2488 mef_entry
->filter
[filt_num
].offset
=
2489 wowlan
->patterns
[i
].pkt_offset
;
2490 memcpy(mef_entry
->filter
[filt_num
].byte_seq
, byte_seq
,
2492 mef_entry
->filter
[filt_num
].filt_type
= TYPE_EQ
;
2497 mef_entry
->filter
[filt_num
].filt_action
= TYPE_AND
;
2502 if (wowlan
->magic_pkt
) {
2503 mef_cfg
.criteria
|= MWIFIEX_CRITERIA_UNICAST
;
2504 mef_entry
->filter
[filt_num
].repeat
= 16;
2505 memcpy(mef_entry
->filter
[filt_num
].byte_seq
, priv
->curr_addr
,
2507 mef_entry
->filter
[filt_num
].byte_seq
[MWIFIEX_MEF_MAX_BYTESEQ
] =
2509 mef_entry
->filter
[filt_num
].offset
= 28;
2510 mef_entry
->filter
[filt_num
].filt_type
= TYPE_EQ
;
2512 mef_entry
->filter
[filt_num
].filt_action
= TYPE_OR
;
2515 mef_entry
->filter
[filt_num
].repeat
= 16;
2516 memcpy(mef_entry
->filter
[filt_num
].byte_seq
, priv
->curr_addr
,
2518 mef_entry
->filter
[filt_num
].byte_seq
[MWIFIEX_MEF_MAX_BYTESEQ
] =
2520 mef_entry
->filter
[filt_num
].offset
= 56;
2521 mef_entry
->filter
[filt_num
].filt_type
= TYPE_EQ
;
2522 mef_entry
->filter
[filt_num
].filt_action
= TYPE_OR
;
2525 if (!mef_cfg
.criteria
)
2526 mef_cfg
.criteria
= MWIFIEX_CRITERIA_BROADCAST
|
2527 MWIFIEX_CRITERIA_UNICAST
|
2528 MWIFIEX_CRITERIA_MULTICAST
;
2530 ret
= mwifiex_send_cmd(priv
, HostCmd_CMD_MEF_CFG
,
2531 HostCmd_ACT_GEN_SET
, 0, &mef_cfg
, true);
2537 static int mwifiex_cfg80211_resume(struct wiphy
*wiphy
)
2542 static void mwifiex_cfg80211_set_wakeup(struct wiphy
*wiphy
,
2545 struct mwifiex_adapter
*adapter
= mwifiex_cfg80211_get_adapter(wiphy
);
2547 device_set_wakeup_enable(adapter
->dev
, enabled
);
2551 static int mwifiex_get_coalesce_pkt_type(u8
*byte_seq
)
2553 const u8 ipv4_mc_mac
[] = {0x33, 0x33};
2554 const u8 ipv6_mc_mac
[] = {0x01, 0x00, 0x5e};
2555 const u8 bc_mac
[] = {0xff, 0xff, 0xff, 0xff};
2557 if ((byte_seq
[0] & 0x01) &&
2558 (byte_seq
[MWIFIEX_COALESCE_MAX_BYTESEQ
] == 1))
2559 return PACKET_TYPE_UNICAST
;
2560 else if (!memcmp(byte_seq
, bc_mac
, 4))
2561 return PACKET_TYPE_BROADCAST
;
2562 else if ((!memcmp(byte_seq
, ipv4_mc_mac
, 2) &&
2563 byte_seq
[MWIFIEX_COALESCE_MAX_BYTESEQ
] == 2) ||
2564 (!memcmp(byte_seq
, ipv6_mc_mac
, 3) &&
2565 byte_seq
[MWIFIEX_COALESCE_MAX_BYTESEQ
] == 3))
2566 return PACKET_TYPE_MULTICAST
;
2572 mwifiex_fill_coalesce_rule_info(struct mwifiex_private
*priv
,
2573 struct cfg80211_coalesce_rules
*crule
,
2574 struct mwifiex_coalesce_rule
*mrule
)
2576 u8 byte_seq
[MWIFIEX_COALESCE_MAX_BYTESEQ
+ 1];
2577 struct filt_field_param
*param
;
2580 mrule
->max_coalescing_delay
= crule
->delay
;
2582 param
= mrule
->params
;
2584 for (i
= 0; i
< crule
->n_patterns
; i
++) {
2585 memset(byte_seq
, 0, sizeof(byte_seq
));
2586 if (!mwifiex_is_pattern_supported(&crule
->patterns
[i
],
2588 MWIFIEX_COALESCE_MAX_BYTESEQ
)) {
2589 dev_err(priv
->adapter
->dev
, "Pattern not supported\n");
2593 if (!crule
->patterns
[i
].pkt_offset
) {
2596 pkt_type
= mwifiex_get_coalesce_pkt_type(byte_seq
);
2597 if (pkt_type
&& mrule
->pkt_type
) {
2598 dev_err(priv
->adapter
->dev
,
2599 "Multiple packet types not allowed\n");
2601 } else if (pkt_type
) {
2602 mrule
->pkt_type
= pkt_type
;
2607 if (crule
->condition
== NL80211_COALESCE_CONDITION_MATCH
)
2608 param
->operation
= RECV_FILTER_MATCH_TYPE_EQ
;
2610 param
->operation
= RECV_FILTER_MATCH_TYPE_NE
;
2612 param
->operand_len
= byte_seq
[MWIFIEX_COALESCE_MAX_BYTESEQ
];
2613 memcpy(param
->operand_byte_stream
, byte_seq
,
2614 param
->operand_len
);
2615 param
->offset
= crule
->patterns
[i
].pkt_offset
;
2618 mrule
->num_of_fields
++;
2621 if (!mrule
->pkt_type
) {
2622 dev_err(priv
->adapter
->dev
,
2623 "Packet type can not be determined\n");
2630 static int mwifiex_cfg80211_set_coalesce(struct wiphy
*wiphy
,
2631 struct cfg80211_coalesce
*coalesce
)
2633 struct mwifiex_adapter
*adapter
= mwifiex_cfg80211_get_adapter(wiphy
);
2635 struct mwifiex_ds_coalesce_cfg coalesce_cfg
;
2636 struct mwifiex_private
*priv
=
2637 mwifiex_get_priv(adapter
, MWIFIEX_BSS_ROLE_STA
);
2639 memset(&coalesce_cfg
, 0, sizeof(coalesce_cfg
));
2641 dev_dbg(adapter
->dev
,
2642 "Disable coalesce and reset all previous rules\n");
2643 return mwifiex_send_cmd(priv
, HostCmd_CMD_COALESCE_CFG
,
2644 HostCmd_ACT_GEN_SET
, 0,
2645 &coalesce_cfg
, true);
2648 coalesce_cfg
.num_of_rules
= coalesce
->n_rules
;
2649 for (i
= 0; i
< coalesce
->n_rules
; i
++) {
2650 ret
= mwifiex_fill_coalesce_rule_info(priv
, &coalesce
->rules
[i
],
2651 &coalesce_cfg
.rule
[i
]);
2653 dev_err(priv
->adapter
->dev
,
2654 "Recheck the patterns provided for rule %d\n",
2660 return mwifiex_send_cmd(priv
, HostCmd_CMD_COALESCE_CFG
,
2661 HostCmd_ACT_GEN_SET
, 0, &coalesce_cfg
, true);
2664 /* cfg80211 ops handler for tdls_mgmt.
2665 * Function prepares TDLS action frame packets and forwards them to FW
2668 mwifiex_cfg80211_tdls_mgmt(struct wiphy
*wiphy
, struct net_device
*dev
,
2669 const u8
*peer
, u8 action_code
, u8 dialog_token
,
2670 u16 status_code
, u32 peer_capability
,
2671 bool initiator
, const u8
*extra_ies
,
2672 size_t extra_ies_len
)
2674 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
2677 if (!(wiphy
->flags
& WIPHY_FLAG_SUPPORTS_TDLS
))
2680 /* make sure we are in station mode and connected */
2681 if (!(priv
->bss_type
== MWIFIEX_BSS_TYPE_STA
&& priv
->media_connected
))
2684 switch (action_code
) {
2685 case WLAN_TDLS_SETUP_REQUEST
:
2686 dev_dbg(priv
->adapter
->dev
,
2687 "Send TDLS Setup Request to %pM status_code=%d\n", peer
,
2689 mwifiex_add_auto_tdls_peer(priv
, peer
);
2690 ret
= mwifiex_send_tdls_data_frame(priv
, peer
, action_code
,
2691 dialog_token
, status_code
,
2692 extra_ies
, extra_ies_len
);
2694 case WLAN_TDLS_SETUP_RESPONSE
:
2695 mwifiex_add_auto_tdls_peer(priv
, peer
);
2696 dev_dbg(priv
->adapter
->dev
,
2697 "Send TDLS Setup Response to %pM status_code=%d\n",
2699 ret
= mwifiex_send_tdls_data_frame(priv
, peer
, action_code
,
2700 dialog_token
, status_code
,
2701 extra_ies
, extra_ies_len
);
2703 case WLAN_TDLS_SETUP_CONFIRM
:
2704 dev_dbg(priv
->adapter
->dev
,
2705 "Send TDLS Confirm to %pM status_code=%d\n", peer
,
2707 ret
= mwifiex_send_tdls_data_frame(priv
, peer
, action_code
,
2708 dialog_token
, status_code
,
2709 extra_ies
, extra_ies_len
);
2711 case WLAN_TDLS_TEARDOWN
:
2712 dev_dbg(priv
->adapter
->dev
, "Send TDLS Tear down to %pM\n",
2714 ret
= mwifiex_send_tdls_data_frame(priv
, peer
, action_code
,
2715 dialog_token
, status_code
,
2716 extra_ies
, extra_ies_len
);
2718 case WLAN_TDLS_DISCOVERY_REQUEST
:
2719 dev_dbg(priv
->adapter
->dev
,
2720 "Send TDLS Discovery Request to %pM\n", peer
);
2721 ret
= mwifiex_send_tdls_data_frame(priv
, peer
, action_code
,
2722 dialog_token
, status_code
,
2723 extra_ies
, extra_ies_len
);
2725 case WLAN_PUB_ACTION_TDLS_DISCOVER_RES
:
2726 dev_dbg(priv
->adapter
->dev
,
2727 "Send TDLS Discovery Response to %pM\n", peer
);
2728 ret
= mwifiex_send_tdls_action_frame(priv
, peer
, action_code
,
2729 dialog_token
, status_code
,
2730 extra_ies
, extra_ies_len
);
2733 dev_warn(priv
->adapter
->dev
,
2734 "Unknown TDLS mgmt/action frame %pM\n", peer
);
2743 mwifiex_cfg80211_tdls_oper(struct wiphy
*wiphy
, struct net_device
*dev
,
2744 const u8
*peer
, enum nl80211_tdls_operation action
)
2746 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
2748 if (!(wiphy
->flags
& WIPHY_FLAG_SUPPORTS_TDLS
) ||
2749 !(wiphy
->flags
& WIPHY_FLAG_TDLS_EXTERNAL_SETUP
))
2752 /* make sure we are in station mode and connected */
2753 if (!(priv
->bss_type
== MWIFIEX_BSS_TYPE_STA
&& priv
->media_connected
))
2756 dev_dbg(priv
->adapter
->dev
,
2757 "TDLS peer=%pM, oper=%d\n", peer
, action
);
2760 case NL80211_TDLS_ENABLE_LINK
:
2761 action
= MWIFIEX_TDLS_ENABLE_LINK
;
2763 case NL80211_TDLS_DISABLE_LINK
:
2764 action
= MWIFIEX_TDLS_DISABLE_LINK
;
2766 case NL80211_TDLS_TEARDOWN
:
2767 /* shouldn't happen!*/
2768 dev_warn(priv
->adapter
->dev
,
2769 "tdls_oper: teardown from driver not supported\n");
2771 case NL80211_TDLS_SETUP
:
2772 /* shouldn't happen!*/
2773 dev_warn(priv
->adapter
->dev
,
2774 "tdls_oper: setup from driver not supported\n");
2776 case NL80211_TDLS_DISCOVERY_REQ
:
2777 /* shouldn't happen!*/
2778 dev_warn(priv
->adapter
->dev
,
2779 "tdls_oper: discovery from driver not supported\n");
2782 dev_err(priv
->adapter
->dev
,
2783 "tdls_oper: operation not supported\n");
2787 return mwifiex_tdls_oper(priv
, peer
, action
);
2791 mwifiex_cfg80211_add_station(struct wiphy
*wiphy
, struct net_device
*dev
,
2792 const u8
*mac
, struct station_parameters
*params
)
2794 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
2796 if (!(params
->sta_flags_set
& BIT(NL80211_STA_FLAG_TDLS_PEER
)))
2799 /* make sure we are in station mode and connected */
2800 if ((priv
->bss_type
!= MWIFIEX_BSS_TYPE_STA
) || !priv
->media_connected
)
2803 return mwifiex_tdls_oper(priv
, mac
, MWIFIEX_TDLS_CREATE_LINK
);
2807 mwifiex_cfg80211_change_station(struct wiphy
*wiphy
, struct net_device
*dev
,
2809 struct station_parameters
*params
)
2812 struct mwifiex_private
*priv
= mwifiex_netdev_get_priv(dev
);
2814 /* we support change_station handler only for TDLS peers*/
2815 if (!(params
->sta_flags_set
& BIT(NL80211_STA_FLAG_TDLS_PEER
)))
2818 /* make sure we are in station mode and connected */
2819 if ((priv
->bss_type
!= MWIFIEX_BSS_TYPE_STA
) || !priv
->media_connected
)
2822 priv
->sta_params
= params
;
2824 ret
= mwifiex_tdls_oper(priv
, mac
, MWIFIEX_TDLS_CONFIG_LINK
);
2825 priv
->sta_params
= NULL
;
2830 /* station cfg80211 operations */
2831 static struct cfg80211_ops mwifiex_cfg80211_ops
= {
2832 .add_virtual_intf
= mwifiex_add_virtual_intf
,
2833 .del_virtual_intf
= mwifiex_del_virtual_intf
,
2834 .change_virtual_intf
= mwifiex_cfg80211_change_virtual_intf
,
2835 .scan
= mwifiex_cfg80211_scan
,
2836 .connect
= mwifiex_cfg80211_connect
,
2837 .disconnect
= mwifiex_cfg80211_disconnect
,
2838 .get_station
= mwifiex_cfg80211_get_station
,
2839 .dump_station
= mwifiex_cfg80211_dump_station
,
2840 .dump_survey
= mwifiex_cfg80211_dump_survey
,
2841 .set_wiphy_params
= mwifiex_cfg80211_set_wiphy_params
,
2842 .join_ibss
= mwifiex_cfg80211_join_ibss
,
2843 .leave_ibss
= mwifiex_cfg80211_leave_ibss
,
2844 .add_key
= mwifiex_cfg80211_add_key
,
2845 .del_key
= mwifiex_cfg80211_del_key
,
2846 .mgmt_tx
= mwifiex_cfg80211_mgmt_tx
,
2847 .mgmt_frame_register
= mwifiex_cfg80211_mgmt_frame_register
,
2848 .remain_on_channel
= mwifiex_cfg80211_remain_on_channel
,
2849 .cancel_remain_on_channel
= mwifiex_cfg80211_cancel_remain_on_channel
,
2850 .set_default_key
= mwifiex_cfg80211_set_default_key
,
2851 .set_power_mgmt
= mwifiex_cfg80211_set_power_mgmt
,
2852 .set_tx_power
= mwifiex_cfg80211_set_tx_power
,
2853 .set_bitrate_mask
= mwifiex_cfg80211_set_bitrate_mask
,
2854 .start_ap
= mwifiex_cfg80211_start_ap
,
2855 .stop_ap
= mwifiex_cfg80211_stop_ap
,
2856 .change_beacon
= mwifiex_cfg80211_change_beacon
,
2857 .set_cqm_rssi_config
= mwifiex_cfg80211_set_cqm_rssi_config
,
2858 .set_antenna
= mwifiex_cfg80211_set_antenna
,
2859 .del_station
= mwifiex_cfg80211_del_station
,
2861 .suspend
= mwifiex_cfg80211_suspend
,
2862 .resume
= mwifiex_cfg80211_resume
,
2863 .set_wakeup
= mwifiex_cfg80211_set_wakeup
,
2865 .set_coalesce
= mwifiex_cfg80211_set_coalesce
,
2866 .tdls_mgmt
= mwifiex_cfg80211_tdls_mgmt
,
2867 .tdls_oper
= mwifiex_cfg80211_tdls_oper
,
2868 .add_station
= mwifiex_cfg80211_add_station
,
2869 .change_station
= mwifiex_cfg80211_change_station
,
2873 static const struct wiphy_wowlan_support mwifiex_wowlan_support
= {
2874 .flags
= WIPHY_WOWLAN_MAGIC_PKT
,
2875 .n_patterns
= MWIFIEX_MEF_MAX_FILTERS
,
2876 .pattern_min_len
= 1,
2877 .pattern_max_len
= MWIFIEX_MAX_PATTERN_LEN
,
2878 .max_pkt_offset
= MWIFIEX_MAX_OFFSET_LEN
,
2882 static bool mwifiex_is_valid_alpha2(const char *alpha2
)
2884 if (!alpha2
|| strlen(alpha2
) != 2)
2887 if (isalpha(alpha2
[0]) && isalpha(alpha2
[1]))
2893 static const struct wiphy_coalesce_support mwifiex_coalesce_support
= {
2894 .n_rules
= MWIFIEX_COALESCE_MAX_RULES
,
2895 .max_delay
= MWIFIEX_MAX_COALESCING_DELAY
,
2896 .n_patterns
= MWIFIEX_COALESCE_MAX_FILTERS
,
2897 .pattern_min_len
= 1,
2898 .pattern_max_len
= MWIFIEX_MAX_PATTERN_LEN
,
2899 .max_pkt_offset
= MWIFIEX_MAX_OFFSET_LEN
,
2902 int mwifiex_init_channel_scan_gap(struct mwifiex_adapter
*adapter
)
2904 u32 n_channels_bg
, n_channels_a
= 0;
2906 n_channels_bg
= mwifiex_band_2ghz
.n_channels
;
2908 if (adapter
->config_bands
& BAND_A
)
2909 n_channels_a
= mwifiex_band_5ghz
.n_channels
;
2911 adapter
->num_in_chan_stats
= max_t(u32
, n_channels_bg
, n_channels_a
);
2912 adapter
->chan_stats
= vmalloc(sizeof(*adapter
->chan_stats
) *
2913 adapter
->num_in_chan_stats
);
2915 if (!adapter
->chan_stats
)
2922 * This function registers the device with CFG802.11 subsystem.
2924 * The function creates the wireless device/wiphy, populates it with
2925 * default parameters and handler function pointers, and finally
2926 * registers the device.
2929 int mwifiex_register_cfg80211(struct mwifiex_adapter
*adapter
)
2933 struct wiphy
*wiphy
;
2934 struct mwifiex_private
*priv
= adapter
->priv
[MWIFIEX_BSS_TYPE_STA
];
2938 /* create a new wiphy for use with cfg80211 */
2939 wiphy
= wiphy_new(&mwifiex_cfg80211_ops
,
2940 sizeof(struct mwifiex_adapter
*));
2942 dev_err(adapter
->dev
, "%s: creating new wiphy\n", __func__
);
2945 wiphy
->max_scan_ssids
= MWIFIEX_MAX_SSID_LIST_LENGTH
;
2946 wiphy
->max_scan_ie_len
= MWIFIEX_MAX_VSIE_LEN
;
2947 wiphy
->mgmt_stypes
= mwifiex_mgmt_stypes
;
2948 wiphy
->max_remain_on_channel_duration
= 5000;
2949 wiphy
->interface_modes
= BIT(NL80211_IFTYPE_STATION
) |
2950 BIT(NL80211_IFTYPE_ADHOC
) |
2951 BIT(NL80211_IFTYPE_P2P_CLIENT
) |
2952 BIT(NL80211_IFTYPE_P2P_GO
) |
2953 BIT(NL80211_IFTYPE_AP
);
2955 wiphy
->bands
[IEEE80211_BAND_2GHZ
] = &mwifiex_band_2ghz
;
2956 if (adapter
->config_bands
& BAND_A
)
2957 wiphy
->bands
[IEEE80211_BAND_5GHZ
] = &mwifiex_band_5ghz
;
2959 wiphy
->bands
[IEEE80211_BAND_5GHZ
] = NULL
;
2961 wiphy
->iface_combinations
= &mwifiex_iface_comb_ap_sta
;
2962 wiphy
->n_iface_combinations
= 1;
2964 /* Initialize cipher suits */
2965 wiphy
->cipher_suites
= mwifiex_cipher_suites
;
2966 wiphy
->n_cipher_suites
= ARRAY_SIZE(mwifiex_cipher_suites
);
2968 memcpy(wiphy
->perm_addr
, priv
->curr_addr
, ETH_ALEN
);
2969 wiphy
->signal_type
= CFG80211_SIGNAL_TYPE_MBM
;
2970 wiphy
->flags
|= WIPHY_FLAG_HAVE_AP_SME
|
2971 WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD
|
2972 WIPHY_FLAG_AP_UAPSD
|
2973 WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL
;
2975 if (ISSUPP_TDLS_ENABLED(adapter
->fw_cap_info
))
2976 wiphy
->flags
|= WIPHY_FLAG_SUPPORTS_TDLS
|
2977 WIPHY_FLAG_TDLS_EXTERNAL_SETUP
;
2980 wiphy
->wowlan
= &mwifiex_wowlan_support
;
2983 wiphy
->coalesce
= &mwifiex_coalesce_support
;
2985 wiphy
->probe_resp_offload
= NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS
|
2986 NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2
|
2987 NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P
;
2989 wiphy
->available_antennas_tx
= BIT(adapter
->number_of_antenna
) - 1;
2990 wiphy
->available_antennas_rx
= BIT(adapter
->number_of_antenna
) - 1;
2992 wiphy
->features
|= NL80211_FEATURE_HT_IBSS
|
2993 NL80211_FEATURE_INACTIVITY_TIMER
|
2994 NL80211_FEATURE_NEED_OBSS_SCAN
;
2996 if (adapter
->fw_api_ver
== MWIFIEX_FW_V15
)
2997 wiphy
->features
|= NL80211_FEATURE_SK_TX_STATUS
;
2999 /* Reserve space for mwifiex specific private data for BSS */
3000 wiphy
->bss_priv_size
= sizeof(struct mwifiex_bss_priv
);
3002 wiphy
->reg_notifier
= mwifiex_reg_notifier
;
3004 /* Set struct mwifiex_adapter pointer in wiphy_priv */
3005 wdev_priv
= wiphy_priv(wiphy
);
3006 *(unsigned long *)wdev_priv
= (unsigned long)adapter
;
3008 set_wiphy_dev(wiphy
, priv
->adapter
->dev
);
3010 ret
= wiphy_register(wiphy
);
3012 dev_err(adapter
->dev
,
3013 "%s: wiphy_register failed: %d\n", __func__
, ret
);
3018 if (reg_alpha2
&& mwifiex_is_valid_alpha2(reg_alpha2
)) {
3019 wiphy_info(wiphy
, "driver hint alpha2: %2.2s\n", reg_alpha2
);
3020 regulatory_hint(wiphy
, reg_alpha2
);
3022 country_code
= mwifiex_11d_code_2_region(adapter
->region_code
);
3024 wiphy_info(wiphy
, "ignoring F/W country code %2.2s\n",
3028 mwifiex_send_cmd(priv
, HostCmd_CMD_802_11_SNMP_MIB
,
3029 HostCmd_ACT_GEN_GET
, FRAG_THRESH_I
, &thr
, true);
3030 wiphy
->frag_threshold
= thr
;
3031 mwifiex_send_cmd(priv
, HostCmd_CMD_802_11_SNMP_MIB
,
3032 HostCmd_ACT_GEN_GET
, RTS_THRESH_I
, &thr
, true);
3033 wiphy
->rts_threshold
= thr
;
3034 mwifiex_send_cmd(priv
, HostCmd_CMD_802_11_SNMP_MIB
,
3035 HostCmd_ACT_GEN_GET
, SHORT_RETRY_LIM_I
, &retry
, true);
3036 wiphy
->retry_short
= (u8
) retry
;
3037 mwifiex_send_cmd(priv
, HostCmd_CMD_802_11_SNMP_MIB
,
3038 HostCmd_ACT_GEN_GET
, LONG_RETRY_LIM_I
, &retry
, true);
3039 wiphy
->retry_long
= (u8
) retry
;
3041 adapter
->wiphy
= wiphy
;