projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
mwifiex: refactor start_ap handler
[deliverable/linux.git] / drivers / net / wireless / mwifiex / cfg80211.c
CommitLineData
5e6e3a92
BZ		 1/*
2 * Marvell Wireless LAN device driver: CFG80211
3 *
65da33f5 4 * Copyright (C) 2011-2014, Marvell International Ltd.
5e6e3a92
BZ		 5 *
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.
13 *
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.
18 */
19
20#include "cfg80211.h"
21#include "main.h"
22
3c68ef5b
AP		 23static char *reg_alpha2;
24module_param(reg_alpha2, charp, 0);
25
cd8440da
AP		 26static const struct ieee80211_iface_limit mwifiex_ap_sta_limits[] = {
27 {
a4df8f56
AP		 28 .max = 2, .types = BIT(NL80211_IFTYPE_STATION) |
29 BIT(NL80211_IFTYPE_P2P_GO) |
30 BIT(NL80211_IFTYPE_P2P_CLIENT),
cd8440da
AP		 31 },
32 {
33 .max = 1, .types = BIT(NL80211_IFTYPE_AP),
34 },
35};
36
37static 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,
43};
44
5e6e3a92
BZ		 45/*
46 * This function maps the nl802.11 channel type into driver channel type.
47 *
48 * The mapping is as follows -
21c3ba34
AK		 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
5e6e3a92 54 */
7feb4c48 55u8 mwifiex_chan_type_to_sec_chan_offset(enum nl80211_channel_type chan_type)
5e6e3a92 56{
05910f4a 57 switch (chan_type) {
5e6e3a92
BZ		 58 case NL80211_CHAN_NO_HT:
59 case NL80211_CHAN_HT20:
21c3ba34 60 return IEEE80211_HT_PARAM_CHA_SEC_NONE;
5e6e3a92 61 case NL80211_CHAN_HT40PLUS:
21c3ba34 62 return IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
5e6e3a92 63 case NL80211_CHAN_HT40MINUS:
21c3ba34 64 return IEEE80211_HT_PARAM_CHA_SEC_BELOW;
5e6e3a92 65 default:
21c3ba34 66 return IEEE80211_HT_PARAM_CHA_SEC_NONE;
5e6e3a92 67 }
5e6e3a92
BZ		 68}
69
5e6e3a92
BZ		 70/*
71 * This function checks whether WEP is set.
72 */
73static int
74mwifiex_is_alg_wep(u32 cipher)
75{
5e6e3a92 76 switch (cipher) {
2be50b8d
YAP		 77 case WLAN_CIPHER_SUITE_WEP40:
78 case WLAN_CIPHER_SUITE_WEP104:
270e58e8 79 return 1;
5e6e3a92 80 default:
5e6e3a92
BZ		 81 break;
82 }
270e58e8
YAP		 83
84 return 0;
5e6e3a92
BZ		 85}
86
5e6e3a92
BZ		 87/*
88 * This function retrieves the private structure from kernel wiphy structure.
89 */
67fdf39e 90static void *mwifiex_cfg80211_get_adapter(struct wiphy *wiphy)
5e6e3a92
BZ		 91{
92 return (void *) (*(unsigned long *) wiphy_priv(wiphy));
93}
94
95/*
96 * CFG802.11 operation handler to delete a network key.
97 */
98static int
99mwifiex_cfg80211_del_key(struct wiphy *wiphy, struct net_device *netdev,
100 u8 key_index, bool pairwise, const u8 *mac_addr)
101{
f540f9f3 102 struct mwifiex_private *priv = mwifiex_netdev_get_priv(netdev);
75edd2c6
AP		 103 const u8 bc_mac[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
104 const u8 *peer_mac = pairwise ? mac_addr : bc_mac;
5e6e3a92 105
53b11231 106 if (mwifiex_set_encode(priv, NULL, NULL, 0, key_index, peer_mac, 1)) {
5e6e3a92
BZ		 107 wiphy_err(wiphy, "deleting the crypto keys\n");
108 return -EFAULT;
109 }
110
111 wiphy_dbg(wiphy, "info: crypto keys deleted\n");
112 return 0;
113}
114
e39faa73
SP		 115/*
116 * This function forms an skb for management frame.
117 */
118static int
119mwifiex_form_mgmt_frame(struct sk_buff *skb, const u8 *buf, size_t len)
120{
121 u8 addr[ETH_ALEN] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
122 u16 pkt_len;
123 u32 tx_control = 0, pkt_type = PKT_TYPE_MGMT;
e39faa73
SP		 124
125 pkt_len = len + ETH_ALEN;
126
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));
130
131 memcpy(skb_push(skb, sizeof(tx_control)),
132 &tx_control, sizeof(tx_control));
133
134 memcpy(skb_push(skb, sizeof(pkt_type)), &pkt_type, sizeof(pkt_type));
135
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));
143
144 skb->priority = LOW_PRIO_TID;
c64800e7 145 __net_timestamp(skb);
e39faa73
SP		 146
147 return 0;
148}
149
150/*
151 * CFG802.11 operation handler to transmit a management frame.
152 */
153static int
154mwifiex_cfg80211_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev,
b176e629 155 struct cfg80211_mgmt_tx_params *params, u64 *cookie)
e39faa73 156{
b176e629
AO		 157 const u8 *buf = params->buf;
158 size_t len = params->len;
e39faa73
SP		 159 struct sk_buff *skb;
160 u16 pkt_len;
161 const struct ieee80211_mgmt *mgmt;
231d83e2 162 struct mwifiex_txinfo *tx_info;
e39faa73
SP		 163 struct mwifiex_private *priv = mwifiex_netdev_get_priv(wdev->netdev);
164
165 if (!buf || !len) {
166 wiphy_err(wiphy, "invalid buffer and length\n");
167 return -EFAULT;
168 }
169
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 */
175 wiphy_dbg(wiphy,
176 "info: skip to send probe resp in AP or GO mode\n");
177 return 0;
178 }
179
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));
184
185 if (!skb) {
186 wiphy_err(wiphy, "allocate skb failed for management frame\n");
187 return -ENOMEM;
188 }
189
231d83e2 190 tx_info = MWIFIEX_SKB_TXCB(skb);
701a9e61 191 memset(tx_info, 0, sizeof(*tx_info));
231d83e2
HY		 192 tx_info->bss_num = priv->bss_num;
193 tx_info->bss_type = priv->bss_type;
a1ed4849 194 tx_info->pkt_len = pkt_len;
231d83e2 195
e39faa73 196 mwifiex_form_mgmt_frame(skb, buf, len);
e00adf39 197 *cookie = prandom_u32() | 1;
18ca4382
AK		 198
199 if (ieee80211_is_action(mgmt->frame_control))
200 skb = mwifiex_clone_skb_for_tx_status(priv,
201 skb,
202 MWIFIEX_BUF_FLAG_ACTION_TX_STATUS, cookie);
203 else
204 cfg80211_mgmt_tx_status(wdev, *cookie, buf, len, true,
205 GFP_ATOMIC);
206
207 mwifiex_queue_tx_pkt(priv, skb);
e39faa73
SP		 208
209 wiphy_dbg(wiphy, "info: management frame transmitted\n");
210 return 0;
211}
212
3cec6870
SP		 213/*
214 * CFG802.11 operation handler to register a mgmt frame.
215 */
216static void
217mwifiex_cfg80211_mgmt_frame_register(struct wiphy *wiphy,
218 struct wireless_dev *wdev,
219 u16 frame_type, bool reg)
220{
221 struct mwifiex_private *priv = mwifiex_netdev_get_priv(wdev->netdev);
4481b2db 222 u32 mask;
3cec6870
SP		 223
224 if (reg)
4481b2db 225 mask = priv->mgmt_frame_mask | BIT(frame_type >> 4);
3cec6870 226 else
4481b2db
SP		 227 mask = priv->mgmt_frame_mask & ~BIT(frame_type >> 4);
228
229 if (mask != priv->mgmt_frame_mask) {
230 priv->mgmt_frame_mask = mask;
fa0ecbb9
BZ		 231 mwifiex_send_cmd(priv, HostCmd_CMD_MGMT_FRAME_REG,
232 HostCmd_ACT_GEN_SET, 0,
233 &priv->mgmt_frame_mask, false);
4481b2db
SP		 234 wiphy_dbg(wiphy, "info: mgmt frame registered\n");
235 }
3cec6870
SP		 236}
237
7feb4c48
SP		 238/*
239 * CFG802.11 operation handler to remain on channel.
240 */
241static int
242mwifiex_cfg80211_remain_on_channel(struct wiphy *wiphy,
243 struct wireless_dev *wdev,
244 struct ieee80211_channel *chan,
7feb4c48
SP		 245 unsigned int duration, u64 *cookie)
246{
247 struct mwifiex_private *priv = mwifiex_netdev_get_priv(wdev->netdev);
248 int ret;
249
250 if (!chan || !cookie) {
251 wiphy_err(wiphy, "Invalid parameter for ROC\n");
252 return -EINVAL;
253 }
254
255 if (priv->roc_cfg.cookie) {
e2261afd 256 wiphy_dbg(wiphy, "info: ongoing ROC, cookie = 0x%llx\n",
7feb4c48
SP		 257 priv->roc_cfg.cookie);
258 return -EBUSY;
259 }
260
261 ret = mwifiex_remain_on_chan_cfg(priv, HostCmd_ACT_GEN_SET, chan,
42d97a59 262 duration);
7feb4c48
SP		 263
264 if (!ret) {
e00adf39 265 *cookie = prandom_u32() | 1;
7feb4c48
SP		 266 priv->roc_cfg.cookie = *cookie;
267 priv->roc_cfg.chan = *chan;
7feb4c48 268
42d97a59 269 cfg80211_ready_on_channel(wdev, *cookie, chan,
7feb4c48
SP		 270 duration, GFP_ATOMIC);
271
272 wiphy_dbg(wiphy, "info: ROC, cookie = 0x%llx\n", *cookie);
273 }
274
275 return ret;
276}
277
278/*
279 * CFG802.11 operation handler to cancel remain on channel.
280 */
281static int
282mwifiex_cfg80211_cancel_remain_on_channel(struct wiphy *wiphy,
283 struct wireless_dev *wdev, u64 cookie)
284{
285 struct mwifiex_private *priv = mwifiex_netdev_get_priv(wdev->netdev);
286 int ret;
287
288 if (cookie != priv->roc_cfg.cookie)
289 return -ENOENT;
290
291 ret = mwifiex_remain_on_chan_cfg(priv, HostCmd_ACT_GEN_REMOVE,
42d97a59 292 &priv->roc_cfg.chan, 0);
7feb4c48
SP		 293
294 if (!ret) {
295 cfg80211_remain_on_channel_expired(wdev, cookie,
296 &priv->roc_cfg.chan,
7feb4c48
SP		 297 GFP_ATOMIC);
298
299 memset(&priv->roc_cfg, 0, sizeof(struct mwifiex_roc_cfg));
300
301 wiphy_dbg(wiphy, "info: cancel ROC, cookie = 0x%llx\n", cookie);
302 }
303
304 return ret;
305}
306
5e6e3a92
BZ		 307/*
308 * CFG802.11 operation handler to set Tx power.
309 */
310static int
311mwifiex_cfg80211_set_tx_power(struct wiphy *wiphy,
c8442118 312 struct wireless_dev *wdev,
5e6e3a92 313 enum nl80211_tx_power_setting type,
742c29fd 314 int mbm)
5e6e3a92 315{
67fdf39e
AP		 316 struct mwifiex_adapter *adapter = mwifiex_cfg80211_get_adapter(wiphy);
317 struct mwifiex_private *priv;
600f5d90 318 struct mwifiex_power_cfg power_cfg;
742c29fd 319 int dbm = MBM_TO_DBM(mbm);
5e6e3a92 320
600f5d90
AK		 321 if (type == NL80211_TX_POWER_FIXED) {
322 power_cfg.is_power_auto = 0;
323 power_cfg.power_level = dbm;
324 } else {
325 power_cfg.is_power_auto = 1;
326 }
327
67fdf39e
AP		 328 priv = mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);
329
636c4598 330 return mwifiex_set_tx_power(priv, &power_cfg);
5e6e3a92
BZ		 331}
332
333/*
334 * CFG802.11 operation handler to set Power Save option.
335 *
336 * The timeout value, if provided, is currently ignored.
337 */
338static int
339mwifiex_cfg80211_set_power_mgmt(struct wiphy *wiphy,
340 struct net_device *dev,
341 bool enabled, int timeout)
342{
f540f9f3 343 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
600f5d90 344 u32 ps_mode;
5e6e3a92
BZ		 345
346 if (timeout)
347 wiphy_dbg(wiphy,
aea0701e 348 "info: ignore timeout value for IEEE Power Save\n");
5e6e3a92 349
600f5d90 350 ps_mode = enabled;
5e6e3a92 351
636c4598 352 return mwifiex_drv_set_power(priv, &ps_mode);
5e6e3a92
BZ		 353}
354
355/*
356 * CFG802.11 operation handler to set the default network key.
357 */
358static int
359mwifiex_cfg80211_set_default_key(struct wiphy *wiphy, struct net_device *netdev,
360 u8 key_index, bool unicast,
361 bool multicast)
362{
f540f9f3 363 struct mwifiex_private *priv = mwifiex_netdev_get_priv(netdev);
5e6e3a92 364
2d3d0a88 365 /* Return if WEP key not configured */
5eb02e44 366 if (!priv->sec_info.wep_enabled)
2d3d0a88
AK		 367 return 0;
368
96893538
AP		 369 if (priv->bss_type == MWIFIEX_BSS_TYPE_UAP) {
370 priv->wep_key_curr_index = key_index;
53b11231
YL		 371 } else if (mwifiex_set_encode(priv, NULL, NULL, 0, key_index,
372 NULL, 0)) {
636c4598 373 wiphy_err(wiphy, "set default Tx key index\n");
5e6e3a92 374 return -EFAULT;
636c4598 375 }
5e6e3a92
BZ		 376
377 return 0;
378}
379
380/*
381 * CFG802.11 operation handler to add a network key.
382 */
383static int
384mwifiex_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)
387{
f540f9f3 388 struct mwifiex_private *priv = mwifiex_netdev_get_priv(netdev);
96893538 389 struct mwifiex_wep_key *wep_key;
75edd2c6
AP		 390 const u8 bc_mac[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
391 const u8 *peer_mac = pairwise ? mac_addr : bc_mac;
5e6e3a92 392
96893538
AP		 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,
400 params->key_len);
401 wep_key->key_index = key_index;
402 wep_key->key_length = params->key_len;
403 priv->sec_info.wep_enabled = 1;
404 }
405 return 0;
406 }
407
53b11231 408 if (mwifiex_set_encode(priv, params, params->key, params->key_len,
75edd2c6 409 key_index, peer_mac, 0)) {
636c4598 410 wiphy_err(wiphy, "crypto keys added\n");
5e6e3a92 411 return -EFAULT;
636c4598 412 }
5e6e3a92
BZ		 413
414 return 0;
415}
416
417/*
418 * This function sends domain information to the firmware.
419 *
420 * The following information are passed to the firmware -
421 * - Country codes
422 * - Sub bands (first channel, number of channels, maximum Tx power)
423 */
424static int mwifiex_send_domain_info_cmd_fw(struct wiphy *wiphy)
425{
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;
430 u8 i, flag = 0;
431 enum ieee80211_band band;
432 struct ieee80211_supported_band *sband;
433 struct ieee80211_channel *ch;
67fdf39e
AP		 434 struct mwifiex_adapter *adapter = mwifiex_cfg80211_get_adapter(wiphy);
435 struct mwifiex_private *priv;
5e6e3a92 436 struct mwifiex_802_11d_domain_reg *domain_info = &adapter->domain_reg;
5e6e3a92
BZ		 437
438 /* Set country code */
67fdf39e
AP		 439 domain_info->country_code[0] = adapter->country_code[0];
440 domain_info->country_code[1] = adapter->country_code[1];
5e6e3a92
BZ		 441 domain_info->country_code[2] = ' ';
442
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");
446 return -1;
447 }
448
449 sband = wiphy->bands[band];
450
451 for (i = 0; i < sband->n_channels ; i++) {
452 ch = &sband->channels[i];
453 if (ch->flags & IEEE80211_CHAN_DISABLED)
454 continue;
455
456 if (!flag) {
457 flag = 1;
458 first_chan = (u32) ch->hw_value;
459 next_chan = first_chan;
22db2497 460 max_pwr = ch->max_power;
5e6e3a92
BZ		 461 no_of_parsed_chan = 1;
462 continue;
463 }
464
465 if (ch->hw_value == next_chan + 1 &&
22db2497 466 ch->max_power == max_pwr) {
5e6e3a92
BZ		 467 next_chan++;
468 no_of_parsed_chan++;
469 } else {
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;
474 no_of_triplet++;
475 first_chan = (u32) ch->hw_value;
476 next_chan = first_chan;
22db2497 477 max_pwr = ch->max_power;
5e6e3a92
BZ		 478 no_of_parsed_chan = 1;
479 }
480 }
481
482 if (flag) {
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;
487 no_of_triplet++;
488 }
489
490 domain_info->no_of_triplet = no_of_triplet;
636c4598 491
67fdf39e
AP		 492 priv = mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);
493
fa0ecbb9
BZ		 494 if (mwifiex_send_cmd(priv, HostCmd_CMD_802_11D_DOMAIN_INFO,
495 HostCmd_ACT_GEN_SET, 0, NULL, false)) {
5e6e3a92 496 wiphy_err(wiphy, "11D: setting domain info in FW\n");
636c4598
YAP		 497 return -1;
498 }
5e6e3a92 499
636c4598 500 return 0;
5e6e3a92
BZ		 501}
502
503/*
504 * CFG802.11 regulatory domain callback function.
505 *
506 * This function is called when the regulatory domain is changed due to the
507 * following reasons -
508 * - Set by driver
509 * - Set by system core
510 * - Set by user
511 * - Set bt Country IE
512 */
0c0280bd
LR		 513static void mwifiex_reg_notifier(struct wiphy *wiphy,
514 struct regulatory_request *request)
5e6e3a92 515{
67fdf39e 516 struct mwifiex_adapter *adapter = mwifiex_cfg80211_get_adapter(wiphy);
82efa16a
BZ		 517 struct mwifiex_private *priv = mwifiex_get_priv(adapter,
518 MWIFIEX_BSS_ROLE_ANY);
5e6e3a92 519
67fdf39e
AP		 520 wiphy_dbg(wiphy, "info: cfg80211 regulatory domain callback for %c%c\n",
521 request->alpha2[0], request->alpha2[1]);
5e6e3a92 522
5e6e3a92
BZ		 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:
5e6e3a92
BZ		 527 case NL80211_REGDOM_SET_BY_COUNTRY_IE:
528 break;
dd4a9ac0
BZ		 529 default:
530 wiphy_err(wiphy, "unknown regdom initiator: %d\n",
531 request->initiator);
532 return;
533 }
534
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);
b58df446 542 mwifiex_dnld_txpwr_table(priv);
5e6e3a92 543 }
5e6e3a92
BZ		 544}
545
5e6e3a92
BZ		 546/*
547 * This function sets the fragmentation threshold.
548 *
600f5d90 549 * The fragmentation threshold value must lie between MWIFIEX_FRAG_MIN_VALUE
5e6e3a92
BZ		 550 * and MWIFIEX_FRAG_MAX_VALUE.
551 */
552static int
553mwifiex_set_frag(struct mwifiex_private *priv, u32 frag_thr)
554{
aea0701e
YAP		 555 if (frag_thr < MWIFIEX_FRAG_MIN_VALUE ||
556 frag_thr > MWIFIEX_FRAG_MAX_VALUE)
9b930eae 557 frag_thr = MWIFIEX_FRAG_MAX_VALUE;
5e6e3a92 558
fa0ecbb9
BZ		 559 return mwifiex_send_cmd(priv, HostCmd_CMD_802_11_SNMP_MIB,
560 HostCmd_ACT_GEN_SET, FRAG_THRESH_I,
561 &frag_thr, true);
5e6e3a92
BZ		 562}
563
564/*
565 * This function sets the RTS threshold.
600f5d90
AK		 566
567 * The rts value must lie between MWIFIEX_RTS_MIN_VALUE
568 * and MWIFIEX_RTS_MAX_VALUE.
5e6e3a92
BZ		 569 */
570static int
571mwifiex_set_rts(struct mwifiex_private *priv, u32 rts_thr)
572{
5e6e3a92
BZ		 573 if (rts_thr < MWIFIEX_RTS_MIN_VALUE || rts_thr > MWIFIEX_RTS_MAX_VALUE)
574 rts_thr = MWIFIEX_RTS_MAX_VALUE;
575
fa0ecbb9
BZ		 576 return mwifiex_send_cmd(priv, HostCmd_CMD_802_11_SNMP_MIB,
577 HostCmd_ACT_GEN_SET, RTS_THRESH_I,
578 &rts_thr, true);
5e6e3a92
BZ		 579}
580
581/*
582 * CFG802.11 operation handler to set wiphy parameters.
583 *
584 * This function can be used to set the RTS threshold and the
585 * Fragmentation threshold of the driver.
586 */
587static int
588mwifiex_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
589{
67fdf39e 590 struct mwifiex_adapter *adapter = mwifiex_cfg80211_get_adapter(wiphy);
9b930eae
AP		 591 struct mwifiex_private *priv;
592 struct mwifiex_uap_bss_param *bss_cfg;
09f63ae6
AP		 593 int ret;
594
595 priv = mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);
9b930eae 596
09f63ae6
AP		 597 switch (priv->bss_role) {
598 case MWIFIEX_BSS_ROLE_UAP:
599 if (priv->bss_started) {
600 dev_err(adapter->dev,
601 "cannot change wiphy params when bss started");
602 return -EINVAL;
603 }
5e6e3a92 604
09f63ae6
AP		 605 bss_cfg = kzalloc(sizeof(*bss_cfg), GFP_KERNEL);
606 if (!bss_cfg)
607 return -ENOMEM;
9b930eae 608
09f63ae6 609 mwifiex_set_sys_config_invalid_data(bss_cfg);
5e6e3a92 610
09f63ae6
AP		 611 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
612 bss_cfg->rts_threshold = wiphy->rts_threshold;
613 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
614 bss_cfg->frag_threshold = wiphy->frag_threshold;
615 if (changed & WIPHY_PARAM_RETRY_LONG)
616 bss_cfg->retry_limit = wiphy->retry_long;
9b930eae 617
09f63ae6
AP		 618 ret = mwifiex_send_cmd(priv, HostCmd_CMD_UAP_SYS_CONFIG,
619 HostCmd_ACT_GEN_SET,
620 UAP_BSS_PARAMS_I, bss_cfg,
621 false);
622
623 kfree(bss_cfg);
624 if (ret) {
625 wiphy_err(wiphy, "Failed to set wiphy phy params\n");
626 return ret;
627 }
628 break;
9b930eae 629
9b930eae 630 case MWIFIEX_BSS_ROLE_STA:
09f63ae6
AP		 631 if (priv->media_connected) {
632 dev_err(adapter->dev,
633 "cannot change wiphy params when connected");
634 return -EINVAL;
635 }
636 if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
637 ret = mwifiex_set_rts(priv,
638 wiphy->rts_threshold);
639 if (ret)
640 return ret;
9b930eae 641 }
09f63ae6
AP		 642 if (changed & WIPHY_PARAM_FRAG_THRESHOLD) {
643 ret = mwifiex_set_frag(priv,
644 wiphy->frag_threshold);
645 if (ret)
646 return ret;
647 }
648 break;
9b930eae
AP		 649 }
650
651 return 0;
5e6e3a92
BZ		 652}
653
e1a2b7a3
SP		 654static int
655mwifiex_cfg80211_deinit_p2p(struct mwifiex_private *priv)
656{
657 u16 mode = P2P_MODE_DISABLE;
658
fa0ecbb9
BZ		 659 if (mwifiex_send_cmd(priv, HostCmd_CMD_P2P_MODE_CFG,
660 HostCmd_ACT_GEN_SET, 0, &mode, true))
e1a2b7a3
SP		 661 return -1;
662
663 return 0;
664}
665
666/*
667 * This function initializes the functionalities for P2P client.
668 * The P2P client initialization sequence is:
669 * disable -> device -> client
670 */
671static int
672mwifiex_cfg80211_init_p2p_client(struct mwifiex_private *priv)
673{
674 u16 mode;
675
676 if (mwifiex_cfg80211_deinit_p2p(priv))
677 return -1;
678
679 mode = P2P_MODE_DEVICE;
fa0ecbb9
BZ		 680 if (mwifiex_send_cmd(priv, HostCmd_CMD_P2P_MODE_CFG,
681 HostCmd_ACT_GEN_SET, 0, &mode, true))
e1a2b7a3
SP		 682 return -1;
683
684 mode = P2P_MODE_CLIENT;
fa0ecbb9
BZ		 685 if (mwifiex_send_cmd(priv, HostCmd_CMD_P2P_MODE_CFG,
686 HostCmd_ACT_GEN_SET, 0, &mode, true))
e1a2b7a3
SP		 687 return -1;
688
689 return 0;
690}
691
9197ab9e
SP		 692/*
693 * This function initializes the functionalities for P2P GO.
694 * The P2P GO initialization sequence is:
695 * disable -> device -> GO
696 */
697static int
698mwifiex_cfg80211_init_p2p_go(struct mwifiex_private *priv)
699{
700 u16 mode;
701
702 if (mwifiex_cfg80211_deinit_p2p(priv))
703 return -1;
704
705 mode = P2P_MODE_DEVICE;
fa0ecbb9
BZ		 706 if (mwifiex_send_cmd(priv, HostCmd_CMD_P2P_MODE_CFG,
707 HostCmd_ACT_GEN_SET, 0, &mode, true))
9197ab9e
SP		 708 return -1;
709
710 mode = P2P_MODE_GO;
fa0ecbb9
BZ		 711 if (mwifiex_send_cmd(priv, HostCmd_CMD_P2P_MODE_CFG,
712 HostCmd_ACT_GEN_SET, 0, &mode, true))
9197ab9e
SP		 713 return -1;
714
047eaaf6
AP		 715 return 0;
716}
717
718static int mwifiex_deinit_priv_params(struct mwifiex_private *priv)
719{
720 priv->mgmt_frame_mask = 0;
721 if (mwifiex_send_cmd(priv, HostCmd_CMD_MGMT_FRAME_REG,
722 HostCmd_ACT_GEN_SET, 0,
723 &priv->mgmt_frame_mask, false)) {
724 dev_warn(priv->adapter->dev,
725 "could not unregister mgmt frame rx\n");
726 return -1;
727 }
728
729 mwifiex_deauthenticate(priv, NULL);
730 mwifiex_free_priv(priv);
731 priv->wdev.iftype = NL80211_IFTYPE_UNSPECIFIED;
732 priv->bss_mode = NL80211_IFTYPE_UNSPECIFIED;
733 priv->sec_info.authentication_mode = NL80211_AUTHTYPE_OPEN_SYSTEM;
734
735 return 0;
736}
737
738static int
739mwifiex_init_new_priv_params(struct mwifiex_private *priv,
740 struct net_device *dev,
741 enum nl80211_iftype type)
742{
743 mwifiex_init_priv(priv);
744
745 priv->bss_mode = type;
746 priv->wdev.iftype = type;
747
748 mwifiex_init_priv_params(priv, priv->netdev);
749 priv->bss_started = 0;
750
751 switch (type) {
752 case NL80211_IFTYPE_STATION:
753 case NL80211_IFTYPE_ADHOC:
754 priv->bss_role = MWIFIEX_BSS_ROLE_STA;
755 priv->bss_type = MWIFIEX_BSS_TYPE_STA;
756 break;
757 case NL80211_IFTYPE_P2P_CLIENT:
758 case NL80211_IFTYPE_P2P_GO:
759 priv->bss_role = MWIFIEX_BSS_ROLE_STA;
760 priv->bss_type = MWIFIEX_BSS_TYPE_P2P;
761 break;
762 case NL80211_IFTYPE_AP:
763 priv->bss_type = MWIFIEX_BSS_TYPE_UAP;
764 priv->bss_role = MWIFIEX_BSS_ROLE_UAP;
765 break;
766 default:
767 dev_err(priv->adapter->dev,
768 "%s: changing to %d not supported\n",
769 dev->name, type);
770 return -EOPNOTSUPP;
771 }
9197ab9e
SP		 772
773 return 0;
774}
775
047eaaf6
AP		 776static int
777mwifiex_change_vif_to_p2p(struct net_device *dev,
778 enum nl80211_iftype curr_iftype,
779 enum nl80211_iftype type, u32 *flags,
780 struct vif_params *params)
781{
782 struct mwifiex_private *priv;
783 struct mwifiex_adapter *adapter;
784
785 priv = mwifiex_netdev_get_priv(dev);
786
787 if (!priv)
788 return -1;
789
790 adapter = priv->adapter;
791
792 if (adapter->curr_iface_comb.p2p_intf ==
793 adapter->iface_limit.p2p_intf) {
794 dev_err(adapter->dev,
795 "cannot create multiple P2P ifaces\n");
796 return -1;
797 }
798
799 dev_dbg(priv->adapter->dev, "%s: changing role to p2p\n", dev->name);
800
801 if (mwifiex_deinit_priv_params(priv))
802 return -1;
803 if (mwifiex_init_new_priv_params(priv, dev, type))
804 return -1;
805
806 switch (type) {
807 case NL80211_IFTYPE_P2P_CLIENT:
808 if (mwifiex_cfg80211_init_p2p_client(priv))
809 return -EFAULT;
810 break;
811 case NL80211_IFTYPE_P2P_GO:
812 if (mwifiex_cfg80211_init_p2p_go(priv))
813 return -EFAULT;
814 break;
815 default:
816 dev_err(priv->adapter->dev,
817 "%s: changing to %d not supported\n",
818 dev->name, type);
819 return -EOPNOTSUPP;
820 }
821
822 if (mwifiex_send_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
823 HostCmd_ACT_GEN_SET, 0, NULL, true))
824 return -1;
825
826 if (mwifiex_sta_init_cmd(priv, false, false))
827 return -1;
828
829 switch (curr_iftype) {
830 case NL80211_IFTYPE_STATION:
831 case NL80211_IFTYPE_ADHOC:
832 adapter->curr_iface_comb.sta_intf--;
833 break;
834 case NL80211_IFTYPE_AP:
835 adapter->curr_iface_comb.uap_intf--;
836 break;
837 default:
838 break;
839 }
840
841 adapter->curr_iface_comb.p2p_intf++;
842 dev->ieee80211_ptr->iftype = type;
843
844 return 0;
845}
846
847static int
848mwifiex_change_vif_to_sta_adhoc(struct net_device *dev,
849 enum nl80211_iftype curr_iftype,
850 enum nl80211_iftype type, u32 *flags,
851 struct vif_params *params)
852{
853 struct mwifiex_private *priv;
854 struct mwifiex_adapter *adapter;
855
856 priv = mwifiex_netdev_get_priv(dev);
857
858 if (!priv)
859 return -1;
860
861 adapter = priv->adapter;
862
863 if ((curr_iftype != NL80211_IFTYPE_P2P_CLIENT &&
864 curr_iftype != NL80211_IFTYPE_P2P_GO) &&
865 (adapter->curr_iface_comb.sta_intf ==
866 adapter->iface_limit.sta_intf)) {
867 dev_err(adapter->dev,
868 "cannot create multiple station/adhoc ifaces\n");
869 return -1;
870 }
871
872 if (type == NL80211_IFTYPE_STATION)
873 dev_notice(adapter->dev,
874 "%s: changing role to station\n", dev->name);
875 else
876 dev_notice(adapter->dev,
877 "%s: changing role to adhoc\n", dev->name);
878
879 if (mwifiex_deinit_priv_params(priv))
880 return -1;
881 if (mwifiex_init_new_priv_params(priv, dev, type))
882 return -1;
883 if (mwifiex_send_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
884 HostCmd_ACT_GEN_SET, 0, NULL, true))
885 return -1;
886 if (mwifiex_sta_init_cmd(priv, false, false))
887 return -1;
888
889 switch (curr_iftype) {
890 case NL80211_IFTYPE_P2P_CLIENT:
891 case NL80211_IFTYPE_P2P_GO:
892 adapter->curr_iface_comb.p2p_intf--;
893 break;
894 case NL80211_IFTYPE_AP:
895 adapter->curr_iface_comb.uap_intf--;
896 break;
897 default:
898 break;
899 }
900
901 adapter->curr_iface_comb.sta_intf++;
902 dev->ieee80211_ptr->iftype = type;
903 return 0;
904}
905
906static int
907mwifiex_change_vif_to_ap(struct net_device *dev,
908 enum nl80211_iftype curr_iftype,
909 enum nl80211_iftype type, u32 *flags,
910 struct vif_params *params)
911{
912 struct mwifiex_private *priv;
913 struct mwifiex_adapter *adapter;
914
915 priv = mwifiex_netdev_get_priv(dev);
916
917 if (!priv)
918 return -1;
919
920 adapter = priv->adapter;
921
922 if (adapter->curr_iface_comb.uap_intf ==
923 adapter->iface_limit.uap_intf) {
924 dev_err(adapter->dev,
925 "cannot create multiple AP ifaces\n");
926 return -1;
927 }
928
929 dev_notice(adapter->dev, "%s: changing role to AP\n", dev->name);
930
931 if (mwifiex_deinit_priv_params(priv))
932 return -1;
933 if (mwifiex_init_new_priv_params(priv, dev, type))
934 return -1;
935 if (mwifiex_send_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
936 HostCmd_ACT_GEN_SET, 0, NULL, true))
937 return -1;
938 if (mwifiex_sta_init_cmd(priv, false, false))
939 return -1;
940
941 switch (curr_iftype) {
942 case NL80211_IFTYPE_P2P_CLIENT:
943 case NL80211_IFTYPE_P2P_GO:
944 adapter->curr_iface_comb.p2p_intf--;
945 break;
946 case NL80211_IFTYPE_STATION:
947 case NL80211_IFTYPE_ADHOC:
948 adapter->curr_iface_comb.sta_intf--;
949 break;
950 default:
951 break;
952 }
953
954 adapter->curr_iface_comb.uap_intf++;
955 dev->ieee80211_ptr->iftype = type;
956 return 0;
957}
5e6e3a92
BZ		 958/*
959 * CFG802.11 operation handler to change interface type.
5e6e3a92
BZ		 960 */
961static int
962mwifiex_cfg80211_change_virtual_intf(struct wiphy *wiphy,
963 struct net_device *dev,
964 enum nl80211_iftype type, u32 *flags,
965 struct vif_params *params)
966{
5e6e3a92 967 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
047eaaf6 968 enum nl80211_iftype curr_iftype = dev->ieee80211_ptr->iftype;
5e6e3a92 969
047eaaf6 970 switch (curr_iftype) {
5e6e3a92 971 case NL80211_IFTYPE_ADHOC:
4f02341a
AP		 972 switch (type) {
973 case NL80211_IFTYPE_STATION:
047eaaf6
AP		 974 priv->bss_mode = type;
975 priv->sec_info.authentication_mode =
976 NL80211_AUTHTYPE_OPEN_SYSTEM;
977 dev->ieee80211_ptr->iftype = type;
978 mwifiex_deauthenticate(priv, NULL);
979 return mwifiex_send_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
980 HostCmd_ACT_GEN_SET, 0, NULL,
981 true);
982 case NL80211_IFTYPE_P2P_CLIENT:
983 case NL80211_IFTYPE_P2P_GO:
984 return mwifiex_change_vif_to_p2p(dev, curr_iftype,
985 type, flags, params);
986 case NL80211_IFTYPE_AP:
987 return mwifiex_change_vif_to_ap(dev, curr_iftype, type,
988 flags, params);
4f02341a
AP		 989 case NL80211_IFTYPE_UNSPECIFIED:
990 wiphy_warn(wiphy, "%s: kept type as IBSS\n", dev->name);
991 case NL80211_IFTYPE_ADHOC: /* This shouldn't happen */
992 return 0;
4f02341a
AP		 993 default:
994 wiphy_err(wiphy, "%s: changing to %d not supported\n",
995 dev->name, type);
996 return -EOPNOTSUPP;
997 }
5e6e3a92
BZ		 998 break;
999 case NL80211_IFTYPE_STATION:
4f02341a
AP		 1000 switch (type) {
1001 case NL80211_IFTYPE_ADHOC:
047eaaf6
AP		 1002 priv->bss_mode = type;
1003 priv->sec_info.authentication_mode =
1004 NL80211_AUTHTYPE_OPEN_SYSTEM;
e1a2b7a3 1005 dev->ieee80211_ptr->iftype = type;
047eaaf6
AP		 1006 mwifiex_deauthenticate(priv, NULL);
1007 return mwifiex_send_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
1008 HostCmd_ACT_GEN_SET, 0, NULL,
1009 true);
1010 case NL80211_IFTYPE_P2P_CLIENT:
9197ab9e 1011 case NL80211_IFTYPE_P2P_GO:
047eaaf6
AP		 1012 return mwifiex_change_vif_to_p2p(dev, curr_iftype,
1013 type, flags, params);
1014 case NL80211_IFTYPE_AP:
1015 return mwifiex_change_vif_to_ap(dev, curr_iftype, type,
1016 flags, params);
4f02341a
AP		 1017 case NL80211_IFTYPE_UNSPECIFIED:
1018 wiphy_warn(wiphy, "%s: kept type as STA\n", dev->name);
1019 case NL80211_IFTYPE_STATION: /* This shouldn't happen */
1020 return 0;
4f02341a
AP		 1021 default:
1022 wiphy_err(wiphy, "%s: changing to %d not supported\n",
1023 dev->name, type);
1024 return -EOPNOTSUPP;
1025 }
1026 break;
1027 case NL80211_IFTYPE_AP:
1028 switch (type) {
047eaaf6
AP		 1029 case NL80211_IFTYPE_ADHOC:
1030 case NL80211_IFTYPE_STATION:
1031 return mwifiex_change_vif_to_sta_adhoc(dev, curr_iftype,
1032 type, flags,
1033 params);
1034 break;
1035 case NL80211_IFTYPE_P2P_CLIENT:
1036 case NL80211_IFTYPE_P2P_GO:
1037 return mwifiex_change_vif_to_p2p(dev, curr_iftype,
1038 type, flags, params);
4f02341a
AP		 1039 case NL80211_IFTYPE_UNSPECIFIED:
1040 wiphy_warn(wiphy, "%s: kept type as AP\n", dev->name);
1041 case NL80211_IFTYPE_AP: /* This shouldn't happen */
1042 return 0;
4f02341a
AP		 1043 default:
1044 wiphy_err(wiphy, "%s: changing to %d not supported\n",
1045 dev->name, type);
1046 return -EOPNOTSUPP;
1047 }
5e6e3a92 1048 break;
e1a2b7a3 1049 case NL80211_IFTYPE_P2P_CLIENT:
9197ab9e 1050 case NL80211_IFTYPE_P2P_GO:
e1a2b7a3
SP		 1051 switch (type) {
1052 case NL80211_IFTYPE_STATION:
047eaaf6 1053 if (mwifiex_cfg80211_init_p2p_client(priv))
e1a2b7a3
SP		 1054 return -EFAULT;
1055 dev->ieee80211_ptr->iftype = type;
047eaaf6
AP		 1056 break;
1057 case NL80211_IFTYPE_ADHOC:
1058 if (mwifiex_cfg80211_deinit_p2p(priv))
1059 return -EFAULT;
1060 return mwifiex_change_vif_to_sta_adhoc(dev, curr_iftype,
1061 type, flags,
1062 params);
1063 break;
1064 case NL80211_IFTYPE_AP:
1065 if (mwifiex_cfg80211_deinit_p2p(priv))
1066 return -EFAULT;
1067 return mwifiex_change_vif_to_ap(dev, curr_iftype, type,
1068 flags, params);
1069 case NL80211_IFTYPE_UNSPECIFIED:
1070 wiphy_warn(wiphy, "%s: kept type as P2P\n", dev->name);
1071 case NL80211_IFTYPE_P2P_CLIENT:
1072 case NL80211_IFTYPE_P2P_GO:
e1a2b7a3
SP		 1073 return 0;
1074 default:
047eaaf6
AP		 1075 wiphy_err(wiphy, "%s: changing to %d not supported\n",
1076 dev->name, type);
e1a2b7a3
SP		 1077 return -EOPNOTSUPP;
1078 }
1079 break;
5e6e3a92 1080 default:
4f02341a
AP		 1081 wiphy_err(wiphy, "%s: unknown iftype: %d\n",
1082 dev->name, dev->ieee80211_ptr->iftype);
1083 return -EOPNOTSUPP;
5e6e3a92 1084 }
5e6e3a92 1085
eecd8250 1086
047eaaf6 1087 return 0;
5e6e3a92
BZ		 1088}
1089
a5f39056
YAP		 1090static void
1091mwifiex_parse_htinfo(struct mwifiex_private *priv, u8 tx_htinfo,
1092 struct rate_info *rate)
1093{
1094 struct mwifiex_adapter *adapter = priv->adapter;
1095
1096 if (adapter->is_hw_11ac_capable) {
1097 /* bit[1-0]: 00=LG 01=HT 10=VHT */
1098 if (tx_htinfo & BIT(0)) {
1099 /* HT */
1100 rate->mcs = priv->tx_rate;
1101 rate->flags |= RATE_INFO_FLAGS_MCS;
1102 }
1103 if (tx_htinfo & BIT(1)) {
1104 /* VHT */
1105 rate->mcs = priv->tx_rate & 0x0F;
1106 rate->flags |= RATE_INFO_FLAGS_VHT_MCS;
1107 }
1108
1109 if (tx_htinfo & (BIT(1) | BIT(0))) {
1110 /* HT or VHT */
1111 switch (tx_htinfo & (BIT(3) | BIT(2))) {
1112 case 0:
b51f3bee 1113 rate->bw = RATE_INFO_BW_20;
a5f39056
YAP		 1114 break;
1115 case (BIT(2)):
b51f3bee 1116 rate->bw = RATE_INFO_BW_40;
a5f39056
YAP		 1117 break;
1118 case (BIT(3)):
b51f3bee 1119 rate->bw = RATE_INFO_BW_80;
a5f39056
YAP		 1120 break;
1121 case (BIT(3) | BIT(2)):
b51f3bee 1122 rate->bw = RATE_INFO_BW_160;
a5f39056
YAP		 1123 break;
1124 }
1125
1126 if (tx_htinfo & BIT(4))
1127 rate->flags |= RATE_INFO_FLAGS_SHORT_GI;
1128
1129 if ((priv->tx_rate >> 4) == 1)
1130 rate->nss = 2;
1131 else
1132 rate->nss = 1;
1133 }
1134 } else {
1135 /*
1136 * Bit 0 in tx_htinfo indicates that current Tx rate
1137 * is 11n rate. Valid MCS index values for us are 0 to 15.
1138 */
1139 if ((tx_htinfo & BIT(0)) && (priv->tx_rate < 16)) {
1140 rate->mcs = priv->tx_rate;
1141 rate->flags |= RATE_INFO_FLAGS_MCS;
b51f3bee 1142 rate->bw = RATE_INFO_BW_20;
a5f39056 1143 if (tx_htinfo & BIT(1))
b51f3bee 1144 rate->bw = RATE_INFO_BW_40;
a5f39056
YAP		 1145 if (tx_htinfo & BIT(2))
1146 rate->flags |= RATE_INFO_FLAGS_SHORT_GI;
1147 }
1148 }
1149}
1150
5e6e3a92
BZ		 1151/*
1152 * This function dumps the station information on a buffer.
1153 *
1154 * The following information are shown -
1155 * - Total bytes transmitted
1156 * - Total bytes received
1157 * - Total packets transmitted
1158 * - Total packets received
1159 * - Signal quality level
1160 * - Transmission rate
1161 */
1162static int
1163mwifiex_dump_station_info(struct mwifiex_private *priv,
1164 struct station_info *sinfo)
1165{
006606c0 1166 u32 rate;
5e6e3a92 1167
319090bf
JB		 1168 sinfo->filled = BIT(NL80211_STA_INFO_RX_BYTES) | BIT(NL80211_STA_INFO_TX_BYTES) |
1169 BIT(NL80211_STA_INFO_RX_PACKETS) | BIT(NL80211_STA_INFO_TX_PACKETS) |
1170 BIT(NL80211_STA_INFO_TX_BITRATE) |
1171 BIT(NL80211_STA_INFO_SIGNAL) | BIT(NL80211_STA_INFO_SIGNAL_AVG);
5e6e3a92
BZ		 1172
1173 /* Get signal information from the firmware */
fa0ecbb9
BZ		 1174 if (mwifiex_send_cmd(priv, HostCmd_CMD_RSSI_INFO,
1175 HostCmd_ACT_GEN_GET, 0, NULL, true)) {
958a4a86
AK		 1176 dev_err(priv->adapter->dev, "failed to get signal information\n");
1177 return -EFAULT;
5e6e3a92
BZ		 1178 }
1179
1180 if (mwifiex_drv_get_data_rate(priv, &rate)) {
1181 dev_err(priv->adapter->dev, "getting data rate\n");
958a4a86 1182 return -EFAULT;
5e6e3a92
BZ		 1183 }
1184
caf60a6c 1185 /* Get DTIM period information from firmware */
fa0ecbb9
BZ		 1186 mwifiex_send_cmd(priv, HostCmd_CMD_802_11_SNMP_MIB,
1187 HostCmd_ACT_GEN_GET, DTIM_PERIOD_I,
1188 &priv->dtim_period, true);
caf60a6c 1189
a5f39056 1190 mwifiex_parse_htinfo(priv, priv->tx_htinfo, &sinfo->txrate);
4ec6f9c0 1191
7013d3e2 1192 sinfo->signal_avg = priv->bcn_rssi_avg;
5e6e3a92
BZ		 1193 sinfo->rx_bytes = priv->stats.rx_bytes;
1194 sinfo->tx_bytes = priv->stats.tx_bytes;
1195 sinfo->rx_packets = priv->stats.rx_packets;
1196 sinfo->tx_packets = priv->stats.tx_packets;
958a4a86 1197 sinfo->signal = priv->bcn_rssi_avg;
4ec6f9c0 1198 /* bit rate is in 500 kb/s units. Convert it to 100kb/s units */
006606c0 1199 sinfo->txrate.legacy = rate * 5;
5e6e3a92 1200
c4f3b972 1201 if (priv->bss_mode == NL80211_IFTYPE_STATION) {
319090bf 1202 sinfo->filled |= BIT(NL80211_STA_INFO_BSS_PARAM);
c4f3b972
AK		 1203 sinfo->bss_param.flags = 0;
1204 if (priv->curr_bss_params.bss_descriptor.cap_info_bitmap &
1205 WLAN_CAPABILITY_SHORT_PREAMBLE)
1206 sinfo->bss_param.flags |=
1207 BSS_PARAM_FLAGS_SHORT_PREAMBLE;
1208 if (priv->curr_bss_params.bss_descriptor.cap_info_bitmap &
1209 WLAN_CAPABILITY_SHORT_SLOT_TIME)
1210 sinfo->bss_param.flags |=
1211 BSS_PARAM_FLAGS_SHORT_SLOT_TIME;
caf60a6c 1212 sinfo->bss_param.dtim_period = priv->dtim_period;
c4f3b972
AK		 1213 sinfo->bss_param.beacon_interval =
1214 priv->curr_bss_params.bss_descriptor.beacon_period;
1215 }
1216
958a4a86 1217 return 0;
5e6e3a92
BZ		 1218}
1219
1220/*
1221 * CFG802.11 operation handler to get station information.
1222 *
1223 * This function only works in connected mode, and dumps the
1224 * requested station information, if available.
1225 */
1226static int
1227mwifiex_cfg80211_get_station(struct wiphy *wiphy, struct net_device *dev,
3b3a0162 1228 const u8 *mac, struct station_info *sinfo)
5e6e3a92
BZ		 1229{
1230 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
5e6e3a92 1231
5e6e3a92
BZ		 1232 if (!priv->media_connected)
1233 return -ENOENT;
1234 if (memcmp(mac, priv->cfg_bssid, ETH_ALEN))
1235 return -ENOENT;
1236
636c4598 1237 return mwifiex_dump_station_info(priv, sinfo);
5e6e3a92
BZ		 1238}
1239
f85aae6b
AK		 1240/*
1241 * CFG802.11 operation handler to dump station information.
1242 */
1243static int
1244mwifiex_cfg80211_dump_station(struct wiphy *wiphy, struct net_device *dev,
1245 int idx, u8 *mac, struct station_info *sinfo)
1246{
1247 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1248
1249 if (!priv->media_connected || idx)
1250 return -ENOENT;
1251
1252 memcpy(mac, priv->cfg_bssid, ETH_ALEN);
1253
1254 return mwifiex_dump_station_info(priv, sinfo);
1255}
1256
6bc6c49f
XH		 1257static int
1258mwifiex_cfg80211_dump_survey(struct wiphy *wiphy, struct net_device *dev,
1259 int idx, struct survey_info *survey)
1260{
1261 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1262 struct mwifiex_chan_stats *pchan_stats = priv->adapter->chan_stats;
1263 enum ieee80211_band band;
1264
1265 dev_dbg(priv->adapter->dev, "dump_survey idx=%d\n", idx);
1266
1267 memset(survey, 0, sizeof(struct survey_info));
1268
1269 if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
1270 priv->media_connected && idx == 0) {
1271 u8 curr_bss_band = priv->curr_bss_params.band;
1272 u32 chan = priv->curr_bss_params.bss_descriptor.channel;
1273
1274 band = mwifiex_band_to_radio_type(curr_bss_band);
1275 survey->channel = ieee80211_get_channel(wiphy,
1276 ieee80211_channel_to_frequency(chan, band));
1277
1278 if (priv->bcn_nf_last) {
1279 survey->filled = SURVEY_INFO_NOISE_DBM;
1280 survey->noise = priv->bcn_nf_last;
1281 }
1282 return 0;
1283 }
1284
1285 if (idx >= priv->adapter->num_in_chan_stats)
1286 return -ENOENT;
1287
1288 if (!pchan_stats[idx].cca_scan_dur)
1289 return 0;
1290
1291 band = pchan_stats[idx].bandcfg;
1292 survey->channel = ieee80211_get_channel(wiphy,
1293 ieee80211_channel_to_frequency(pchan_stats[idx].chan_num, band));
1294 survey->filled = SURVEY_INFO_NOISE_DBM |
4ed20beb
JB		 1295 SURVEY_INFO_TIME |
1296 SURVEY_INFO_TIME_BUSY;
6bc6c49f 1297 survey->noise = pchan_stats[idx].noise;
4ed20beb
JB		 1298 survey->time = pchan_stats[idx].cca_scan_dur;
1299 survey->time_busy = pchan_stats[idx].cca_busy_dur;
6bc6c49f
XH		 1300
1301 return 0;
1302}
1303
5e6e3a92 1304/* Supported rates to be advertised to the cfg80211 */
5e6e3a92
BZ		 1305static struct ieee80211_rate mwifiex_rates[] = {
1306 {.bitrate = 10, .hw_value = 2, },
1307 {.bitrate = 20, .hw_value = 4, },
1308 {.bitrate = 55, .hw_value = 11, },
1309 {.bitrate = 110, .hw_value = 22, },
5e6e3a92
BZ		 1310 {.bitrate = 60, .hw_value = 12, },
1311 {.bitrate = 90, .hw_value = 18, },
1312 {.bitrate = 120, .hw_value = 24, },
1313 {.bitrate = 180, .hw_value = 36, },
1314 {.bitrate = 240, .hw_value = 48, },
1315 {.bitrate = 360, .hw_value = 72, },
1316 {.bitrate = 480, .hw_value = 96, },
1317 {.bitrate = 540, .hw_value = 108, },
5e6e3a92
BZ		 1318};
1319
1320/* Channel definitions to be advertised to cfg80211 */
5e6e3a92
BZ		 1321static struct ieee80211_channel mwifiex_channels_2ghz[] = {
1322 {.center_freq = 2412, .hw_value = 1, },
1323 {.center_freq = 2417, .hw_value = 2, },
1324 {.center_freq = 2422, .hw_value = 3, },
1325 {.center_freq = 2427, .hw_value = 4, },
1326 {.center_freq = 2432, .hw_value = 5, },
1327 {.center_freq = 2437, .hw_value = 6, },
1328 {.center_freq = 2442, .hw_value = 7, },
1329 {.center_freq = 2447, .hw_value = 8, },
1330 {.center_freq = 2452, .hw_value = 9, },
1331 {.center_freq = 2457, .hw_value = 10, },
1332 {.center_freq = 2462, .hw_value = 11, },
1333 {.center_freq = 2467, .hw_value = 12, },
1334 {.center_freq = 2472, .hw_value = 13, },
1335 {.center_freq = 2484, .hw_value = 14, },
1336};
1337
1338static struct ieee80211_supported_band mwifiex_band_2ghz = {
1339 .channels = mwifiex_channels_2ghz,
1340 .n_channels = ARRAY_SIZE(mwifiex_channels_2ghz),
1341 .bitrates = mwifiex_rates,
8763848e 1342 .n_bitrates = ARRAY_SIZE(mwifiex_rates),
5e6e3a92
BZ		 1343};
1344
1345static struct ieee80211_channel mwifiex_channels_5ghz[] = {
1346 {.center_freq = 5040, .hw_value = 8, },
1347 {.center_freq = 5060, .hw_value = 12, },
1348 {.center_freq = 5080, .hw_value = 16, },
1349 {.center_freq = 5170, .hw_value = 34, },
1350 {.center_freq = 5190, .hw_value = 38, },
1351 {.center_freq = 5210, .hw_value = 42, },
1352 {.center_freq = 5230, .hw_value = 46, },
1353 {.center_freq = 5180, .hw_value = 36, },
1354 {.center_freq = 5200, .hw_value = 40, },
1355 {.center_freq = 5220, .hw_value = 44, },
1356 {.center_freq = 5240, .hw_value = 48, },
1357 {.center_freq = 5260, .hw_value = 52, },
1358 {.center_freq = 5280, .hw_value = 56, },
1359 {.center_freq = 5300, .hw_value = 60, },
1360 {.center_freq = 5320, .hw_value = 64, },
1361 {.center_freq = 5500, .hw_value = 100, },
1362 {.center_freq = 5520, .hw_value = 104, },
1363 {.center_freq = 5540, .hw_value = 108, },
1364 {.center_freq = 5560, .hw_value = 112, },
1365 {.center_freq = 5580, .hw_value = 116, },
1366 {.center_freq = 5600, .hw_value = 120, },
1367 {.center_freq = 5620, .hw_value = 124, },
1368 {.center_freq = 5640, .hw_value = 128, },
1369 {.center_freq = 5660, .hw_value = 132, },
1370 {.center_freq = 5680, .hw_value = 136, },
1371 {.center_freq = 5700, .hw_value = 140, },
1372 {.center_freq = 5745, .hw_value = 149, },
1373 {.center_freq = 5765, .hw_value = 153, },
1374 {.center_freq = 5785, .hw_value = 157, },
1375 {.center_freq = 5805, .hw_value = 161, },
1376 {.center_freq = 5825, .hw_value = 165, },
1377};
1378
1379static struct ieee80211_supported_band mwifiex_band_5ghz = {
1380 .channels = mwifiex_channels_5ghz,
1381 .n_channels = ARRAY_SIZE(mwifiex_channels_5ghz),
eb416ad3
AP		 1382 .bitrates = mwifiex_rates + 4,
1383 .n_bitrates = ARRAY_SIZE(mwifiex_rates) - 4,
5e6e3a92
BZ		 1384};
1385
1386
1387/* Supported crypto cipher suits to be advertised to cfg80211 */
5e6e3a92
BZ		 1388static const u32 mwifiex_cipher_suites[] = {
1389 WLAN_CIPHER_SUITE_WEP40,
1390 WLAN_CIPHER_SUITE_WEP104,
1391 WLAN_CIPHER_SUITE_TKIP,
1392 WLAN_CIPHER_SUITE_CCMP,
53b11231 1393 WLAN_CIPHER_SUITE_AES_CMAC,
5e6e3a92
BZ		 1394};
1395
83719be8
SP		 1396/* Supported mgmt frame types to be advertised to cfg80211 */
1397static const struct ieee80211_txrx_stypes
1398mwifiex_mgmt_stypes[NUM_NL80211_IFTYPES] = {
1399 [NL80211_IFTYPE_STATION] = {
1400 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
1401 BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
1402 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
1403 BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
1404 },
1405 [NL80211_IFTYPE_AP] = {
1406 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
1407 BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
1408 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
1409 BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
1410 },
1411 [NL80211_IFTYPE_P2P_CLIENT] = {
1412 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
1413 BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
1414 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
1415 BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
1416 },
1417 [NL80211_IFTYPE_P2P_GO] = {
1418 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) |
1419 BIT(IEEE80211_STYPE_PROBE_RESP >> 4),
1420 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
1421 BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
1422 },
1423};
1424
5d82c53a
YAP		 1425/*
1426 * CFG802.11 operation handler for setting bit rates.
1427 *
433c3990
AK		 1428 * Function configures data rates to firmware using bitrate mask
1429 * provided by cfg80211.
5d82c53a
YAP		 1430 */
1431static int mwifiex_cfg80211_set_bitrate_mask(struct wiphy *wiphy,
1432 struct net_device *dev,
1433 const u8 *peer,
1434 const struct cfg80211_bitrate_mask *mask)
1435{
5d82c53a 1436 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
433c3990
AK		 1437 u16 bitmap_rates[MAX_BITMAP_RATES_SIZE];
1438 enum ieee80211_band band;
c44379e2 1439 struct mwifiex_adapter *adapter = priv->adapter;
5d82c53a 1440
433c3990 1441 if (!priv->media_connected) {
c44379e2 1442 dev_err(adapter->dev,
433c3990
AK		 1443 "Can not set Tx data rate in disconnected state\n");
1444 return -EINVAL;
5d82c53a
YAP		 1445 }
1446
433c3990 1447 band = mwifiex_band_to_radio_type(priv->curr_bss_params.band);
5d82c53a 1448
433c3990 1449 memset(bitmap_rates, 0, sizeof(bitmap_rates));
5d82c53a 1450
433c3990
AK		 1451 /* Fill HR/DSSS rates. */
1452 if (band == IEEE80211_BAND_2GHZ)
1453 bitmap_rates[0] = mask->control[band].legacy & 0x000f;
5d82c53a 1454
433c3990
AK		 1455 /* Fill OFDM rates */
1456 if (band == IEEE80211_BAND_2GHZ)
1457 bitmap_rates[1] = (mask->control[band].legacy & 0x0ff0) >> 4;
1458 else
1459 bitmap_rates[1] = mask->control[band].legacy;
1460
d1e33e65
JD		 1461 /* Fill HT MCS rates */
1462 bitmap_rates[2] = mask->control[band].ht_mcs[0];
c44379e2 1463 if (adapter->hw_dev_mcs_support == HT_STREAM_2X2)
d1e33e65 1464 bitmap_rates[2] |= mask->control[band].ht_mcs[1] << 8;
433c3990 1465
c44379e2
AK		 1466 /* Fill VHT MCS rates */
1467 if (adapter->fw_api_ver == MWIFIEX_FW_V15) {
1468 bitmap_rates[10] = mask->control[band].vht_mcs[0];
1469 if (adapter->hw_dev_mcs_support == HT_STREAM_2X2)
1470 bitmap_rates[11] = mask->control[band].vht_mcs[1];
1471 }
1472
fa0ecbb9
BZ		 1473 return mwifiex_send_cmd(priv, HostCmd_CMD_TX_RATE_CFG,
1474 HostCmd_ACT_GEN_SET, 0, bitmap_rates, true);
5d82c53a
YAP		 1475}
1476
fa444bf8
AK		 1477/*
1478 * CFG802.11 operation handler for connection quality monitoring.
1479 *
1480 * This function subscribes/unsubscribes HIGH_RSSI and LOW_RSSI
1481 * events to FW.
1482 */
1483static int mwifiex_cfg80211_set_cqm_rssi_config(struct wiphy *wiphy,
1484 struct net_device *dev,
1485 s32 rssi_thold, u32 rssi_hyst)
1486{
1487 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1488 struct mwifiex_ds_misc_subsc_evt subsc_evt;
1489
1490 priv->cqm_rssi_thold = rssi_thold;
1491 priv->cqm_rssi_hyst = rssi_hyst;
1492
1493 memset(&subsc_evt, 0x00, sizeof(struct mwifiex_ds_misc_subsc_evt));
1494 subsc_evt.events = BITMASK_BCN_RSSI_LOW | BITMASK_BCN_RSSI_HIGH;
1495
1496 /* Subscribe/unsubscribe low and high rssi events */
1497 if (rssi_thold && rssi_hyst) {
1498 subsc_evt.action = HostCmd_ACT_BITWISE_SET;
1499 subsc_evt.bcn_l_rssi_cfg.abs_value = abs(rssi_thold);
1500 subsc_evt.bcn_h_rssi_cfg.abs_value = abs(rssi_thold);
1501 subsc_evt.bcn_l_rssi_cfg.evt_freq = 1;
1502 subsc_evt.bcn_h_rssi_cfg.evt_freq = 1;
fa0ecbb9
BZ		 1503 return mwifiex_send_cmd(priv,
1504 HostCmd_CMD_802_11_SUBSCRIBE_EVENT,
1505 0, 0, &subsc_evt, true);
fa444bf8
AK		 1506 } else {
1507 subsc_evt.action = HostCmd_ACT_BITWISE_CLR;
fa0ecbb9
BZ		 1508 return mwifiex_send_cmd(priv,
1509 HostCmd_CMD_802_11_SUBSCRIBE_EVENT,
1510 0, 0, &subsc_evt, true);
fa444bf8
AK		 1511 }
1512
1513 return 0;
1514}
1515
5370c836
AP		 1516/* cfg80211 operation handler for change_beacon.
1517 * Function retrieves and sets modified management IEs to FW.
1518 */
1519static int mwifiex_cfg80211_change_beacon(struct wiphy *wiphy,
1520 struct net_device *dev,
1521 struct cfg80211_beacon_data *data)
1522{
1523 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1524
9197ab9e 1525 if (GET_BSS_ROLE(priv) != MWIFIEX_BSS_ROLE_UAP) {
5370c836
AP		 1526 wiphy_err(wiphy, "%s: bss_type mismatched\n", __func__);
1527 return -EINVAL;
1528 }
1529
1530 if (!priv->bss_started) {
1531 wiphy_err(wiphy, "%s: bss not started\n", __func__);
1532 return -EINVAL;
1533 }
1534
1535 if (mwifiex_set_mgmt_ies(priv, data)) {
1536 wiphy_err(wiphy, "%s: setting mgmt ies failed\n", __func__);
1537 return -EFAULT;
1538 }
1539
1540 return 0;
1541}
1542
0f9e9b8b
AP		 1543/* cfg80211 operation handler for del_station.
1544 * Function deauthenticates station which value is provided in mac parameter.
1545 * If mac is NULL/broadcast, all stations in associated station list are
1546 * deauthenticated. If bss is not started or there are no stations in
1547 * associated stations list, no action is taken.
1548 */
1549static int
1550mwifiex_cfg80211_del_station(struct wiphy *wiphy, struct net_device *dev,
89c771e5 1551 struct station_del_parameters *params)
0f9e9b8b
AP		 1552{
1553 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1554 struct mwifiex_sta_node *sta_node;
fc99dd08 1555 u8 deauth_mac[ETH_ALEN];
0f9e9b8b
AP		 1556 unsigned long flags;
1557
1558 if (list_empty(&priv->sta_list) || !priv->bss_started)
1559 return 0;
1560
fc99dd08
AP		 1561 if (!params->mac || is_broadcast_ether_addr(params->mac))
1562 return 0;
1563
1564 wiphy_dbg(wiphy, "%s: mac address %pM\n", __func__, params->mac);
1565
1566 memset(deauth_mac, 0, ETH_ALEN);
1567
1568 spin_lock_irqsave(&priv->sta_list_spinlock, flags);
1569 sta_node = mwifiex_get_sta_entry(priv, params->mac);
1570 if (sta_node)
1571 ether_addr_copy(deauth_mac, params->mac);
1572 spin_unlock_irqrestore(&priv->sta_list_spinlock, flags);
1573
1574 if (is_valid_ether_addr(deauth_mac)) {
1575 if (mwifiex_send_cmd(priv, HostCmd_CMD_UAP_STA_DEAUTH,
1576 HostCmd_ACT_GEN_SET, 0,
1577 deauth_mac, true))
1578 return -1;
0f9e9b8b
AP		 1579 }
1580
1581 return 0;
1582}
1583
8a279d5b
AK		 1584static int
1585mwifiex_cfg80211_set_antenna(struct wiphy *wiphy, u32 tx_ant, u32 rx_ant)
1586{
1587 struct mwifiex_adapter *adapter = mwifiex_cfg80211_get_adapter(wiphy);
1588 struct mwifiex_private *priv = mwifiex_get_priv(adapter,
1589 MWIFIEX_BSS_ROLE_ANY);
1590 struct mwifiex_ds_ant_cfg ant_cfg;
1591
1592 if (!tx_ant || !rx_ant)
1593 return -EOPNOTSUPP;
1594
1595 if (adapter->hw_dev_mcs_support != HT_STREAM_2X2) {
1596 /* Not a MIMO chip. User should provide specific antenna number
1597 * for Tx/Rx path or enable all antennas for diversity
1598 */
1599 if (tx_ant != rx_ant)
1600 return -EOPNOTSUPP;
1601
1602 if ((tx_ant & (tx_ant - 1)) &&
1603 (tx_ant != BIT(adapter->number_of_antenna) - 1))
1604 return -EOPNOTSUPP;
1605
1606 if ((tx_ant == BIT(adapter->number_of_antenna) - 1) &&
1607 (priv->adapter->number_of_antenna > 1)) {
1608 tx_ant = RF_ANTENNA_AUTO;
1609 rx_ant = RF_ANTENNA_AUTO;
1610 }
a5333914
AK		 1611 } else {
1612 struct ieee80211_sta_ht_cap *ht_info;
1613 int rx_mcs_supp;
1614 enum ieee80211_band band;
1615
1616 if ((tx_ant == 0x1 && rx_ant == 0x1)) {
1617 adapter->user_dev_mcs_support = HT_STREAM_1X1;
1618 if (adapter->is_hw_11ac_capable)
1619 adapter->usr_dot_11ac_mcs_support =
1620 MWIFIEX_11AC_MCS_MAP_1X1;
1621 } else {
1622 adapter->user_dev_mcs_support = HT_STREAM_2X2;
1623 if (adapter->is_hw_11ac_capable)
1624 adapter->usr_dot_11ac_mcs_support =
1625 MWIFIEX_11AC_MCS_MAP_2X2;
1626 }
1627
1628 for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
1629 if (!adapter->wiphy->bands[band])
1630 continue;
1631
1632 ht_info = &adapter->wiphy->bands[band]->ht_cap;
1633 rx_mcs_supp =
1634 GET_RXMCSSUPP(adapter->user_dev_mcs_support);
1635 memset(&ht_info->mcs, 0, adapter->number_of_antenna);
1636 memset(&ht_info->mcs, 0xff, rx_mcs_supp);
1637 }
8a279d5b
AK		 1638 }
1639
1640 ant_cfg.tx_ant = tx_ant;
1641 ant_cfg.rx_ant = rx_ant;
1642
fa0ecbb9
BZ		 1643 return mwifiex_send_cmd(priv, HostCmd_CMD_RF_ANTENNA,
1644 HostCmd_ACT_GEN_SET, 0, &ant_cfg, true);
8a279d5b
AK		 1645}
1646
12190c5d
AP		 1647/* cfg80211 operation handler for stop ap.
1648 * Function stops BSS running at uAP interface.
1649 */
1650static int mwifiex_cfg80211_stop_ap(struct wiphy *wiphy, struct net_device *dev)
1651{
1652 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1653
40bbc21a
AP		 1654 if (mwifiex_del_mgmt_ies(priv))
1655 wiphy_err(wiphy, "Failed to delete mgmt IEs!\n");
1656
c8258913 1657 priv->ap_11n_enabled = 0;
35c739b5 1658 memset(&priv->bss_cfg, 0, sizeof(priv->bss_cfg));
c8258913 1659
fa0ecbb9
BZ		 1660 if (mwifiex_send_cmd(priv, HostCmd_CMD_UAP_BSS_STOP,
1661 HostCmd_ACT_GEN_SET, 0, NULL, true)) {
12190c5d
AP		 1662 wiphy_err(wiphy, "Failed to stop the BSS\n");
1663 return -1;
1664 }
1665
1666 return 0;
1667}
1668
1669/* cfg80211 operation handler for start_ap.
1670 * Function sets beacon period, DTIM period, SSID and security into
1671 * AP config structure.
1672 * AP is configured with these settings and BSS is started.
1673 */
1674static int mwifiex_cfg80211_start_ap(struct wiphy *wiphy,
1675 struct net_device *dev,
1676 struct cfg80211_ap_settings *params)
1677{
1678 struct mwifiex_uap_bss_param *bss_cfg;
1679 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1680
9197ab9e 1681 if (GET_BSS_ROLE(priv) != MWIFIEX_BSS_ROLE_UAP)
f752dcd5
AP		 1682 return -1;
1683
12190c5d
AP		 1684 bss_cfg = kzalloc(sizeof(struct mwifiex_uap_bss_param), GFP_KERNEL);
1685 if (!bss_cfg)
1686 return -ENOMEM;
1687
1688 mwifiex_set_sys_config_invalid_data(bss_cfg);
1689
1690 if (params->beacon_interval)
1691 bss_cfg->beacon_period = params->beacon_interval;
1692 if (params->dtim_period)
1693 bss_cfg->dtim_period = params->dtim_period;
1694
1695 if (params->ssid && params->ssid_len) {
1696 memcpy(bss_cfg->ssid.ssid, params->ssid, params->ssid_len);
1697 bss_cfg->ssid.ssid_len = params->ssid_len;
1698 }
b654ca18
AP		 1699 if (params->inactivity_timeout > 0) {
1700 /* sta_ao_timer/ps_sta_ao_timer is in unit of 100ms */
1701 bss_cfg->sta_ao_timer = 10 * params->inactivity_timeout;
1702 bss_cfg->ps_sta_ao_timer = 10 * params->inactivity_timeout;
1703 }
12190c5d 1704
7a1c9934
AP		 1705 switch (params->hidden_ssid) {
1706 case NL80211_HIDDEN_SSID_NOT_IN_USE:
1707 bss_cfg->bcast_ssid_ctl = 1;
1708 break;
1709 case NL80211_HIDDEN_SSID_ZERO_LEN:
1710 bss_cfg->bcast_ssid_ctl = 0;
1711 break;
1712 case NL80211_HIDDEN_SSID_ZERO_CONTENTS:
1713 /* firmware doesn't support this type of hidden SSID */
1714 default:
b3190466 1715 kfree(bss_cfg);
7a1c9934
AP		 1716 return -EINVAL;
1717 }
1718
b654ca18 1719 mwifiex_uap_set_channel(bss_cfg, params->chandef);
a3c2c4f6 1720 mwifiex_set_uap_rates(bss_cfg, params);
05910f4a 1721
f752dcd5
AP		 1722 if (mwifiex_set_secure_params(priv, bss_cfg, params)) {
1723 kfree(bss_cfg);
1724 wiphy_err(wiphy, "Failed to parse secuirty parameters!\n");
1725 return -1;
1726 }
1727
22281256 1728 mwifiex_set_ht_params(priv, bss_cfg, params);
83c78da9
YAP		 1729
1730 if (priv->adapter->is_hw_11ac_capable) {
1731 mwifiex_set_vht_params(priv, bss_cfg, params);
1732 mwifiex_set_vht_width(priv, params->chandef.width,
1733 priv->ap_11ac_enabled);
1734 }
1735
2b6254da
AP		 1736 if (priv->ap_11ac_enabled)
1737 mwifiex_set_11ac_ba_params(priv);
1738 else
1739 mwifiex_set_ba_params(priv);
1740
54428c57 1741 mwifiex_set_wmm_params(priv, bss_cfg, params);
22281256 1742
b654ca18
AP		 1743 if (mwifiex_config_start_uap(priv, bss_cfg)) {
1744 wiphy_err(wiphy, "Failed to start AP\n");
12190c5d
AP		 1745 kfree(bss_cfg);
1746 return -1;
1747 }
1748
b0d4c5ec
AP		 1749 if (mwifiex_set_mgmt_ies(priv, &params->beacon))
1750 return -1;
1751
35c739b5 1752 memcpy(&priv->bss_cfg, bss_cfg, sizeof(priv->bss_cfg));
12190c5d 1753 kfree(bss_cfg);
12190c5d
AP		 1754 return 0;
1755}
1756
5e6e3a92
BZ		 1757/*
1758 * CFG802.11 operation handler for disconnection request.
1759 *
1760 * This function does not work when there is already a disconnection
1761 * procedure going on.
1762 */
1763static int
1764mwifiex_cfg80211_disconnect(struct wiphy *wiphy, struct net_device *dev,
1765 u16 reason_code)
1766{
1767 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1768
600f5d90 1769 if (mwifiex_deauthenticate(priv, NULL))
5e6e3a92
BZ		 1770 return -EFAULT;
1771
1772 wiphy_dbg(wiphy, "info: successfully disconnected from %pM:"
1773 " reason code %d\n", priv->cfg_bssid, reason_code);
1774
38c9d664 1775 memset(priv->cfg_bssid, 0, ETH_ALEN);
587b36d3 1776 priv->hs2_enabled = false;
5e6e3a92
BZ		 1777
1778 return 0;
1779}
1780
1781/*
1782 * This function informs the CFG802.11 subsystem of a new IBSS.
1783 *
1784 * The following information are sent to the CFG802.11 subsystem
1785 * to register the new IBSS. If we do not register the new IBSS,
1786 * a kernel panic will result.
1787 * - SSID
1788 * - SSID length
1789 * - BSSID
1790 * - Channel
1791 */
1792static int mwifiex_cfg80211_inform_ibss_bss(struct mwifiex_private *priv)
1793{
5e6e3a92
BZ		 1794 struct ieee80211_channel *chan;
1795 struct mwifiex_bss_info bss_info;
aa95a48d 1796 struct cfg80211_bss *bss;
270e58e8 1797 int ie_len;
5e6e3a92 1798 u8 ie_buf[IEEE80211_MAX_SSID_LEN + sizeof(struct ieee_types_header)];
4ed5d521 1799 enum ieee80211_band band;
5e6e3a92 1800
636c4598
YAP		 1801 if (mwifiex_get_bss_info(priv, &bss_info))
1802 return -1;
5e6e3a92
BZ		 1803
1804 ie_buf[0] = WLAN_EID_SSID;
1805 ie_buf[1] = bss_info.ssid.ssid_len;
1806
1807 memcpy(&ie_buf[sizeof(struct ieee_types_header)],
aea0701e 1808 &bss_info.ssid.ssid, bss_info.ssid.ssid_len);
5e6e3a92
BZ		 1809 ie_len = ie_buf[1] + sizeof(struct ieee_types_header);
1810
4ed5d521 1811 band = mwifiex_band_to_radio_type(priv->curr_bss_params.band);
4facc34a 1812 chan = __ieee80211_get_channel(priv->wdev.wiphy,
5e6e3a92 1813 ieee80211_channel_to_frequency(bss_info.bss_chan,
4ed5d521 1814 band));
5e6e3a92 1815
4facc34a 1816 bss = cfg80211_inform_bss(priv->wdev.wiphy, chan,
5bc8c1f2 1817 CFG80211_BSS_FTYPE_UNKNOWN,
aea0701e
YAP		 1818 bss_info.bssid, 0, WLAN_CAPABILITY_IBSS,
1819 0, ie_buf, ie_len, 0, GFP_KERNEL);
4facc34a 1820 cfg80211_put_bss(priv->wdev.wiphy, bss);
5e6e3a92
BZ		 1821 memcpy(priv->cfg_bssid, bss_info.bssid, ETH_ALEN);
1822
636c4598 1823 return 0;
5e6e3a92
BZ		 1824}
1825
5e6e3a92
BZ		 1826/*
1827 * This function connects with a BSS.
1828 *
1829 * This function handles both Infra and Ad-Hoc modes. It also performs
1830 * validity checking on the provided parameters, disconnects from the
1831 * current BSS (if any), sets up the association/scan parameters,
1832 * including security settings, and performs specific SSID scan before
1833 * trying to connect.
1834 *
1835 * For Infra mode, the function returns failure if the specified SSID
1836 * is not found in scan table. However, for Ad-Hoc mode, it can create
1837 * the IBSS if it does not exist. On successful completion in either case,
7c6fa2a8 1838 * the function notifies the CFG802.11 subsystem of the new BSS connection.
5e6e3a92
BZ		 1839 */
1840static int
664834de
JM		 1841mwifiex_cfg80211_assoc(struct mwifiex_private *priv, size_t ssid_len,
1842 const u8 *ssid, const u8 *bssid, int mode,
1843 struct ieee80211_channel *channel,
5e6e3a92
BZ		 1844 struct cfg80211_connect_params *sme, bool privacy)
1845{
b9be5f39 1846 struct cfg80211_ssid req_ssid;
270e58e8 1847 int ret, auth_type = 0;
7c6fa2a8 1848 struct cfg80211_bss *bss = NULL;
d7b9c520 1849 u8 is_scanning_required = 0;
5e6e3a92 1850
b9be5f39 1851 memset(&req_ssid, 0, sizeof(struct cfg80211_ssid));
5e6e3a92
BZ		 1852
1853 req_ssid.ssid_len = ssid_len;
1854 if (ssid_len > IEEE80211_MAX_SSID_LEN) {
1855 dev_err(priv->adapter->dev, "invalid SSID - aborting\n");
1856 return -EINVAL;
1857 }
1858
1859 memcpy(req_ssid.ssid, ssid, ssid_len);
1860 if (!req_ssid.ssid_len || req_ssid.ssid[0] < 0x20) {
1861 dev_err(priv->adapter->dev, "invalid SSID - aborting\n");
1862 return -EINVAL;
1863 }
1864
6670f15b
AK		 1865 /* As this is new association, clear locally stored
1866 * keys and security related flags */
1867 priv->sec_info.wpa_enabled = false;
1868 priv->sec_info.wpa2_enabled = false;
1869 priv->wep_key_curr_index = 0;
00f157b4 1870 priv->sec_info.encryption_mode = 0;
a0f6d6ca 1871 priv->sec_info.is_authtype_auto = 0;
53b11231 1872 ret = mwifiex_set_encode(priv, NULL, NULL, 0, 0, NULL, 1);
5e6e3a92 1873
eecd8250 1874 if (mode == NL80211_IFTYPE_ADHOC) {
5e6e3a92
BZ		 1875 /* "privacy" is set only for ad-hoc mode */
1876 if (privacy) {
1877 /*
2be50b8d 1878 * Keep WLAN_CIPHER_SUITE_WEP104 for now so that
5e6e3a92
BZ		 1879 * the firmware can find a matching network from the
1880 * scan. The cfg80211 does not give us the encryption
1881 * mode at this stage so just setting it to WEP here.
1882 */
203afeca 1883 priv->sec_info.encryption_mode =
2be50b8d 1884 WLAN_CIPHER_SUITE_WEP104;
203afeca 1885 priv->sec_info.authentication_mode =
f986b6d5 1886 NL80211_AUTHTYPE_OPEN_SYSTEM;
5e6e3a92
BZ		 1887 }
1888
1889 goto done;
1890 }
1891
1892 /* Now handle infra mode. "sme" is valid for infra mode only */
a0f6d6ca 1893 if (sme->auth_type == NL80211_AUTHTYPE_AUTOMATIC) {
f986b6d5 1894 auth_type = NL80211_AUTHTYPE_OPEN_SYSTEM;
a0f6d6ca
AK		 1895 priv->sec_info.is_authtype_auto = 1;
1896 } else {
1897 auth_type = sme->auth_type;
1898 }
5e6e3a92
BZ		 1899
1900 if (sme->crypto.n_ciphers_pairwise) {
2be50b8d
YAP		 1901 priv->sec_info.encryption_mode =
1902 sme->crypto.ciphers_pairwise[0];
203afeca 1903 priv->sec_info.authentication_mode = auth_type;
5e6e3a92
BZ		 1904 }
1905
1906 if (sme->crypto.cipher_group) {
2be50b8d 1907 priv->sec_info.encryption_mode = sme->crypto.cipher_group;
203afeca 1908 priv->sec_info.authentication_mode = auth_type;
5e6e3a92
BZ		 1909 }
1910 if (sme->ie)
1911 ret = mwifiex_set_gen_ie(priv, sme->ie, sme->ie_len);
1912
1913 if (sme->key) {
e6faada5 1914 if (mwifiex_is_alg_wep(priv->sec_info.encryption_mode)) {
5e6e3a92
BZ		 1915 dev_dbg(priv->adapter->dev,
1916 "info: setting wep encryption"
1917 " with key len %d\n", sme->key_len);
6670f15b 1918 priv->wep_key_curr_index = sme->key_idx;
53b11231
YL		 1919 ret = mwifiex_set_encode(priv, NULL, sme->key,
1920 sme->key_len, sme->key_idx,
1921 NULL, 0);
5e6e3a92
BZ		 1922 }
1923 }
1924done:
7c6fa2a8
AK		 1925 /*
1926 * Scan entries are valid for some time (15 sec). So we can save one
1927 * active scan time if we just try cfg80211_get_bss first. If it fails
1928 * then request scan and cfg80211_get_bss() again for final output.
1929 */
1930 while (1) {
1931 if (is_scanning_required) {
1932 /* Do specific SSID scanning */
1933 if (mwifiex_request_scan(priv, &req_ssid)) {
1934 dev_err(priv->adapter->dev, "scan error\n");
1935 return -EFAULT;
1936 }
1937 }
5e6e3a92 1938
7c6fa2a8
AK		 1939 /* Find the BSS we want using available scan results */
1940 if (mode == NL80211_IFTYPE_ADHOC)
4facc34a 1941 bss = cfg80211_get_bss(priv->wdev.wiphy, channel,
7c6fa2a8
AK		 1942 bssid, ssid, ssid_len,
1943 WLAN_CAPABILITY_IBSS,
1944 WLAN_CAPABILITY_IBSS);
1945 else
4facc34a 1946 bss = cfg80211_get_bss(priv->wdev.wiphy, channel,
7c6fa2a8
AK		 1947 bssid, ssid, ssid_len,
1948 WLAN_CAPABILITY_ESS,
1949 WLAN_CAPABILITY_ESS);
1950
1951 if (!bss) {
1952 if (is_scanning_required) {
aea0701e
YAP		 1953 dev_warn(priv->adapter->dev,
1954 "assoc: requested bss not found in scan results\n");
7c6fa2a8
AK		 1955 break;
1956 }
1957 is_scanning_required = 1;
1958 } else {
aea0701e
YAP		 1959 dev_dbg(priv->adapter->dev,
1960 "info: trying to associate to '%s' bssid %pM\n",
1961 (char *) req_ssid.ssid, bss->bssid);
7c6fa2a8
AK		 1962 memcpy(&priv->cfg_bssid, bss->bssid, ETH_ALEN);
1963 break;
1964 }
5e6e3a92
BZ		 1965 }
1966
06975884
AK		 1967 ret = mwifiex_bss_start(priv, bss, &req_ssid);
1968 if (ret)
1969 return ret;
5e6e3a92 1970
eecd8250 1971 if (mode == NL80211_IFTYPE_ADHOC) {
5e6e3a92
BZ		 1972 /* Inform the BSS information to kernel, otherwise
1973 * kernel will give a panic after successful assoc */
1974 if (mwifiex_cfg80211_inform_ibss_bss(priv))
1975 return -EFAULT;
1976 }
1977
1978 return ret;
1979}
1980
1981/*
1982 * CFG802.11 operation handler for association request.
1983 *
1984 * This function does not work when the current mode is set to Ad-Hoc, or
1985 * when there is already an association procedure going on. The given BSS
1986 * information is used to associate.
1987 */
1988static int
1989mwifiex_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev,
1990 struct cfg80211_connect_params *sme)
1991{
1992 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
e00483f7 1993 struct mwifiex_adapter *adapter = priv->adapter;
8bc77a4d 1994 int ret;
5e6e3a92 1995
953b3539 1996 if (GET_BSS_ROLE(priv) != MWIFIEX_BSS_ROLE_STA) {
8bc77a4d 1997 wiphy_err(wiphy,
953b3539 1998 "%s: reject infra assoc request in non-STA role\n",
8bc77a4d
BZ		 1999 dev->name);
2000 return -EINVAL;
e568634a
AP		 2001 }
2002
4facc34a 2003 if (priv->wdev.current_bss) {
71954f24
UR		 2004 wiphy_warn(wiphy, "%s: already connected\n", dev->name);
2005 return -EALREADY;
2006 }
2007
e00483f7
AK		 2008 if (adapter->surprise_removed || adapter->is_cmd_timedout) {
2009 wiphy_err(wiphy,
2010 "%s: Ignore connection. Card removed or FW in bad state\n",
2011 dev->name);
2012 return -EFAULT;
2013 }
2014
5e6e3a92 2015 wiphy_dbg(wiphy, "info: Trying to associate to %s and bssid %pM\n",
aea0701e 2016 (char *) sme->ssid, sme->bssid);
5e6e3a92
BZ		 2017
2018 ret = mwifiex_cfg80211_assoc(priv, sme->ssid_len, sme->ssid, sme->bssid,
eecd8250 2019 priv->bss_mode, sme->channel, sme, 0);
38c9d664
AK		 2020 if (!ret) {
2021 cfg80211_connect_result(priv->netdev, priv->cfg_bssid, NULL, 0,
2022 NULL, 0, WLAN_STATUS_SUCCESS,
2023 GFP_KERNEL);
2024 dev_dbg(priv->adapter->dev,
2025 "info: associated to bssid %pM successfully\n",
2026 priv->cfg_bssid);
9927baa3
AP		 2027 if (ISSUPP_TDLS_ENABLED(priv->adapter->fw_cap_info) &&
2028 priv->adapter->auto_tdls &&
2029 priv->bss_type == MWIFIEX_BSS_TYPE_STA)
2030 mwifiex_setup_auto_tdls_timer(priv);
38c9d664
AK		 2031 } else {
2032 dev_dbg(priv->adapter->dev,
2033 "info: association to bssid %pM failed\n",
2034 priv->cfg_bssid);
2035 memset(priv->cfg_bssid, 0, ETH_ALEN);
06975884
AK		 2036
2037 if (ret > 0)
2038 cfg80211_connect_result(priv->netdev, priv->cfg_bssid,
2039 NULL, 0, NULL, 0, ret,
2040 GFP_KERNEL);
2041 else
2042 cfg80211_connect_result(priv->netdev, priv->cfg_bssid,
2043 NULL, 0, NULL, 0,
2044 WLAN_STATUS_UNSPECIFIED_FAILURE,
2045 GFP_KERNEL);
38c9d664
AK		 2046 }
2047
06975884 2048 return 0;
5e6e3a92
BZ		 2049}
2050
05910f4a
AK		 2051/*
2052 * This function sets following parameters for ibss network.
2053 * - channel
2054 * - start band
2055 * - 11n flag
2056 * - secondary channel offset
2057 */
2058static int mwifiex_set_ibss_params(struct mwifiex_private *priv,
2059 struct cfg80211_ibss_params *params)
2060{
4facc34a 2061 struct wiphy *wiphy = priv->wdev.wiphy;
05910f4a
AK		 2062 struct mwifiex_adapter *adapter = priv->adapter;
2063 int index = 0, i;
2064 u8 config_bands = 0;
2065
683b6d3b 2066 if (params->chandef.chan->band == IEEE80211_BAND_2GHZ) {
05910f4a
AK		 2067 if (!params->basic_rates) {
2068 config_bands = BAND_B | BAND_G;
2069 } else {
2070 for (i = 0; i < mwifiex_band_2ghz.n_bitrates; i++) {
2071 /*
2072 * Rates below 6 Mbps in the table are CCK
2073 * rates; 802.11b and from 6 they are OFDM;
2074 * 802.11G
2075 */
2076 if (mwifiex_rates[i].bitrate == 60) {
2077 index = 1 << i;
2078 break;
2079 }
2080 }
2081
2082 if (params->basic_rates < index) {
2083 config_bands = BAND_B;
2084 } else {
2085 config_bands = BAND_G;
2086 if (params->basic_rates % index)
2087 config_bands |= BAND_B;
2088 }
2089 }
2090
683b6d3b
JB		 2091 if (cfg80211_get_chandef_type(&params->chandef) !=
2092 NL80211_CHAN_NO_HT)
3b86acb8 2093 config_bands |= BAND_G | BAND_GN;
05910f4a 2094 } else {
c3ff0b2d 2095 if (cfg80211_get_chandef_type(&params->chandef) ==
683b6d3b 2096 NL80211_CHAN_NO_HT)
05910f4a
AK		 2097 config_bands = BAND_A;
2098 else
2099 config_bands = BAND_AN | BAND_A;
2100 }
2101
2102 if (!((config_bands | adapter->fw_bands) & ~adapter->fw_bands)) {
2103 adapter->config_bands = config_bands;
2104 adapter->adhoc_start_band = config_bands;
2105
2106 if ((config_bands & BAND_GN) || (config_bands & BAND_AN))
2107 adapter->adhoc_11n_enabled = true;
2108 else
2109 adapter->adhoc_11n_enabled = false;
2110 }
2111
2112 adapter->sec_chan_offset =
683b6d3b
JB		 2113 mwifiex_chan_type_to_sec_chan_offset(
2114 cfg80211_get_chandef_type(&params->chandef));
2115 priv->adhoc_channel = ieee80211_frequency_to_channel(
2116 params->chandef.chan->center_freq);
05910f4a
AK		 2117
2118 wiphy_dbg(wiphy, "info: set ibss band %d, chan %d, chan offset %d\n",
2119 config_bands, priv->adhoc_channel, adapter->sec_chan_offset);
2120
2121 return 0;
2122}
2123
5e6e3a92
BZ		 2124/*
2125 * CFG802.11 operation handler to join an IBSS.
2126 *
2127 * This function does not work in any mode other than Ad-Hoc, or if
2128 * a join operation is already in progress.
2129 */
2130static int
2131mwifiex_cfg80211_join_ibss(struct wiphy *wiphy, struct net_device *dev,
2132 struct cfg80211_ibss_params *params)
2133{
f540f9f3 2134 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
5e6e3a92 2135 int ret = 0;
5e6e3a92 2136
eecd8250 2137 if (priv->bss_mode != NL80211_IFTYPE_ADHOC) {
5e6e3a92
BZ		 2138 wiphy_err(wiphy, "request to join ibss received "
2139 "when station is not in ibss mode\n");
2140 goto done;
2141 }
2142
5e6e3a92 2143 wiphy_dbg(wiphy, "info: trying to join to %s and bssid %pM\n",
aea0701e 2144 (char *) params->ssid, params->bssid);
5e6e3a92 2145
05910f4a
AK		 2146 mwifiex_set_ibss_params(priv, params);
2147
5e6e3a92 2148 ret = mwifiex_cfg80211_assoc(priv, params->ssid_len, params->ssid,
aea0701e 2149 params->bssid, priv->bss_mode,
683b6d3b
JB		 2150 params->chandef.chan, NULL,
2151 params->privacy);
5e6e3a92 2152done:
38c9d664 2153 if (!ret) {
fe94f3a4
AQ		 2154 cfg80211_ibss_joined(priv->netdev, priv->cfg_bssid,
2155 params->chandef.chan, GFP_KERNEL);
38c9d664
AK		 2156 dev_dbg(priv->adapter->dev,
2157 "info: joined/created adhoc network with bssid"
2158 " %pM successfully\n", priv->cfg_bssid);
2159 } else {
2160 dev_dbg(priv->adapter->dev,
2161 "info: failed creating/joining adhoc network\n");
2162 }
2163
5e6e3a92
BZ		 2164 return ret;
2165}
2166
2167/*
2168 * CFG802.11 operation handler to leave an IBSS.
2169 *
2170 * This function does not work if a leave operation is
2171 * already in progress.
2172 */
2173static int
2174mwifiex_cfg80211_leave_ibss(struct wiphy *wiphy, struct net_device *dev)
2175{
f540f9f3 2176 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
5e6e3a92 2177
5e6e3a92 2178 wiphy_dbg(wiphy, "info: disconnecting from essid %pM\n",
aea0701e 2179 priv->cfg_bssid);
600f5d90 2180 if (mwifiex_deauthenticate(priv, NULL))
5e6e3a92
BZ		 2181 return -EFAULT;
2182
38c9d664 2183 memset(priv->cfg_bssid, 0, ETH_ALEN);
5e6e3a92
BZ		 2184
2185 return 0;
2186}
2187
2188/*
2189 * CFG802.11 operation handler for scan request.
2190 *
2191 * This function issues a scan request to the firmware based upon
2192 * the user specified scan configuration. On successfull completion,
2193 * it also informs the results.
2194 */
2195static int
fd014284 2196mwifiex_cfg80211_scan(struct wiphy *wiphy,
5e6e3a92
BZ		 2197 struct cfg80211_scan_request *request)
2198{
fd014284 2199 struct net_device *dev = request->wdev->netdev;
5e6e3a92 2200 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
c2476335 2201 int i, offset, ret;
38c9d664 2202 struct ieee80211_channel *chan;
ea021f56 2203 struct ieee_types_header *ie;
75ab753d 2204 struct mwifiex_user_scan_cfg *user_scan_cfg;
5e6e3a92
BZ		 2205
2206 wiphy_dbg(wiphy, "info: received scan request on %s\n", dev->name);
2207
75ab753d
AK		 2208 /* Block scan request if scan operation or scan cleanup when interface
2209 * is disabled is in process
2210 */
2211 if (priv->scan_request || priv->scan_aborting) {
f162cac8
AK		 2212 dev_err(priv->adapter->dev, "cmd: Scan already in process..\n");
2213 return -EBUSY;
2214 }
2215
75ab753d
AK		 2216 user_scan_cfg = kzalloc(sizeof(*user_scan_cfg), GFP_KERNEL);
2217 if (!user_scan_cfg)
38c9d664 2218 return -ENOMEM;
be0b281e 2219
6fcf2b10
BZ		 2220 priv->scan_request = request;
2221
75ab753d
AK		 2222 user_scan_cfg->num_ssids = request->n_ssids;
2223 user_scan_cfg->ssid_list = request->ssids;
be0b281e 2224
13d7ba78 2225 if (request->ie && request->ie_len) {
ea021f56 2226 offset = 0;
13d7ba78
AP		 2227 for (i = 0; i < MWIFIEX_MAX_VSIE_NUM; i++) {
2228 if (priv->vs_ie[i].mask != MWIFIEX_VSIE_MASK_CLEAR)
2229 continue;
2230 priv->vs_ie[i].mask = MWIFIEX_VSIE_MASK_SCAN;
ea021f56
SP		 2231 ie = (struct ieee_types_header *)(request->ie + offset);
2232 memcpy(&priv->vs_ie[i].ie, ie, sizeof(*ie) + ie->len);
2233 offset += sizeof(*ie) + ie->len;
2234
2235 if (offset >= request->ie_len)
2236 break;
13d7ba78
AP		 2237 }
2238 }
2239
901ceba4
SP		 2240 for (i = 0; i < min_t(u32, request->n_channels,
2241 MWIFIEX_USER_SCAN_CHAN_MAX); i++) {
38c9d664 2242 chan = request->channels[i];
75ab753d
AK		 2243 user_scan_cfg->chan_list[i].chan_number = chan->hw_value;
2244 user_scan_cfg->chan_list[i].radio_type = chan->band;
38c9d664 2245
a9c1c89e 2246 if ((chan->flags & IEEE80211_CHAN_NO_IR) || !request->n_ssids)
75ab753d 2247 user_scan_cfg->chan_list[i].scan_type =
aea0701e 2248 MWIFIEX_SCAN_TYPE_PASSIVE;
38c9d664 2249 else
75ab753d 2250 user_scan_cfg->chan_list[i].scan_type =
aea0701e 2251 MWIFIEX_SCAN_TYPE_ACTIVE;
38c9d664 2252
75ab753d 2253 user_scan_cfg->chan_list[i].scan_time = 0;
38c9d664 2254 }
c2476335 2255
cb91be87
AP		 2256 if (priv->adapter->scan_chan_gap_enabled &&
2257 mwifiex_is_any_intf_active(priv))
2258 user_scan_cfg->scan_chan_gap =
2259 priv->adapter->scan_chan_gap_time;
2260
75ab753d
AK		 2261 ret = mwifiex_scan_networks(priv, user_scan_cfg);
2262 kfree(user_scan_cfg);
c2476335
BZ		 2263 if (ret) {
2264 dev_err(priv->adapter->dev, "scan failed: %d\n", ret);
75ab753d 2265 priv->scan_aborting = false;
6fcf2b10 2266 priv->scan_request = NULL;
c2476335
BZ		 2267 return ret;
2268 }
38c9d664 2269
13d7ba78
AP		 2270 if (request->ie && request->ie_len) {
2271 for (i = 0; i < MWIFIEX_MAX_VSIE_NUM; i++) {
2272 if (priv->vs_ie[i].mask == MWIFIEX_VSIE_MASK_SCAN) {
2273 priv->vs_ie[i].mask = MWIFIEX_VSIE_MASK_CLEAR;
2274 memset(&priv->vs_ie[i].ie, 0,
2275 MWIFIEX_MAX_VSIE_LEN);
2276 }
2277 }
2278 }
5e6e3a92
BZ		 2279 return 0;
2280}
2281
a5f39056
YAP		 2282static void mwifiex_setup_vht_caps(struct ieee80211_sta_vht_cap *vht_info,
2283 struct mwifiex_private *priv)
2284{
2285 struct mwifiex_adapter *adapter = priv->adapter;
a5f39056
YAP		 2286
2287 vht_info->vht_supported = true;
2288
43283feb 2289 vht_info->cap = adapter->hw_dot_11ac_dev_cap;
a5f39056
YAP		 2290 /* Update MCS support for VHT */
2291 vht_info->vht_mcs.rx_mcs_map = cpu_to_le16(
2292 adapter->hw_dot_11ac_mcs_support & 0xFFFF);
2293 vht_info->vht_mcs.rx_highest = 0;
2294 vht_info->vht_mcs.tx_mcs_map = cpu_to_le16(
2295 adapter->hw_dot_11ac_mcs_support >> 16);
2296 vht_info->vht_mcs.tx_highest = 0;
2297}
2298
5e6e3a92
BZ		 2299/*
2300 * This function sets up the CFG802.11 specific HT capability fields
2301 * with default values.
2302 *
2303 * The following default values are set -
2304 * - HT Supported = True
a46b7b5c
AK		 2305 * - Maximum AMPDU length factor = IEEE80211_HT_MAX_AMPDU_64K
2306 * - Minimum AMPDU spacing = IEEE80211_HT_MPDU_DENSITY_NONE
2307 * - HT Capabilities supported by firmware
5e6e3a92
BZ		 2308 * - MCS information, Rx mask = 0xff
2309 * - MCD information, Tx parameters = IEEE80211_HT_MCS_TX_DEFINED (0x01)
2310 */
2311static void
2312mwifiex_setup_ht_caps(struct ieee80211_sta_ht_cap *ht_info,
2313 struct mwifiex_private *priv)
2314{
2315 int rx_mcs_supp;
2316 struct ieee80211_mcs_info mcs_set;
2317 u8 *mcs = (u8 *)&mcs_set;
2318 struct mwifiex_adapter *adapter = priv->adapter;
2319
2320 ht_info->ht_supported = true;
a46b7b5c
AK		 2321 ht_info->ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K;
2322 ht_info->ampdu_density = IEEE80211_HT_MPDU_DENSITY_NONE;
5e6e3a92
BZ		 2323
2324 memset(&ht_info->mcs, 0, sizeof(ht_info->mcs));
5e6e3a92 2325
a46b7b5c
AK		 2326 /* Fill HT capability information */
2327 if (ISSUPP_CHANWIDTH40(adapter->hw_dot_11n_dev_cap))
2328 ht_info->cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40;
2329 else
2330 ht_info->cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
2331
2332 if (ISSUPP_SHORTGI20(adapter->hw_dot_11n_dev_cap))
2333 ht_info->cap |= IEEE80211_HT_CAP_SGI_20;
2334 else
2335 ht_info->cap &= ~IEEE80211_HT_CAP_SGI_20;
2336
2337 if (ISSUPP_SHORTGI40(adapter->hw_dot_11n_dev_cap))
2338 ht_info->cap |= IEEE80211_HT_CAP_SGI_40;
2339 else
2340 ht_info->cap &= ~IEEE80211_HT_CAP_SGI_40;
2341
474a41e9
MH		 2342 if (adapter->user_dev_mcs_support == HT_STREAM_2X2)
2343 ht_info->cap |= 3 << IEEE80211_HT_CAP_RX_STBC_SHIFT;
a46b7b5c 2344 else
474a41e9 2345 ht_info->cap |= 1 << IEEE80211_HT_CAP_RX_STBC_SHIFT;
a46b7b5c
AK		 2346
2347 if (ISSUPP_TXSTBC(adapter->hw_dot_11n_dev_cap))
2348 ht_info->cap |= IEEE80211_HT_CAP_TX_STBC;
2349 else
2350 ht_info->cap &= ~IEEE80211_HT_CAP_TX_STBC;
2351
dd0d83c2
AP		 2352 if (ISSUPP_GREENFIELD(adapter->hw_dot_11n_dev_cap))
2353 ht_info->cap |= IEEE80211_HT_CAP_GRN_FLD;
2354 else
2355 ht_info->cap &= ~IEEE80211_HT_CAP_GRN_FLD;
2356
2357 if (ISENABLED_40MHZ_INTOLERANT(adapter->hw_dot_11n_dev_cap))
2358 ht_info->cap |= IEEE80211_HT_CAP_40MHZ_INTOLERANT;
2359 else
2360 ht_info->cap &= ~IEEE80211_HT_CAP_40MHZ_INTOLERANT;
2361
2362 if (ISSUPP_RXLDPC(adapter->hw_dot_11n_dev_cap))
2363 ht_info->cap |= IEEE80211_HT_CAP_LDPC_CODING;
2364 else
2365 ht_info->cap &= ~IEEE80211_HT_CAP_LDPC_CODING;
2366
a46b7b5c
AK		 2367 ht_info->cap &= ~IEEE80211_HT_CAP_MAX_AMSDU;
2368 ht_info->cap |= IEEE80211_HT_CAP_SM_PS;
2369
a5333914
AK		 2370 rx_mcs_supp = GET_RXMCSSUPP(adapter->user_dev_mcs_support);
2371 /* Set MCS for 1x1/2x2 */
5e6e3a92
BZ		 2372 memset(mcs, 0xff, rx_mcs_supp);
2373 /* Clear all the other values */
2374 memset(&mcs[rx_mcs_supp], 0,
aea0701e 2375 sizeof(struct ieee80211_mcs_info) - rx_mcs_supp);
eecd8250 2376 if (priv->bss_mode == NL80211_IFTYPE_STATION ||
aea0701e 2377 ISSUPP_CHANWIDTH40(adapter->hw_dot_11n_dev_cap))
5e6e3a92
BZ		 2378 /* Set MCS32 for infra mode or ad-hoc mode with 40MHz support */
2379 SETHT_MCS32(mcs_set.rx_mask);
2380
2381 memcpy((u8 *) &ht_info->mcs, mcs, sizeof(struct ieee80211_mcs_info));
2382
2383 ht_info->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED;
2384}
2385
93a1df48
YAP		 2386/*
2387 * create a new virtual interface with the given name
2388 */
84efbb84 2389struct wireless_dev *mwifiex_add_virtual_intf(struct wiphy *wiphy,
552bff0c 2390 const char *name,
84efbb84
JB		 2391 enum nl80211_iftype type,
2392 u32 *flags,
2393 struct vif_params *params)
93a1df48 2394{
67fdf39e
AP		 2395 struct mwifiex_adapter *adapter = mwifiex_cfg80211_get_adapter(wiphy);
2396 struct mwifiex_private *priv;
93a1df48
YAP		 2397 struct net_device *dev;
2398 void *mdev_priv;
2399
93a1df48 2400 if (!adapter)
858faa57 2401 return ERR_PTR(-EFAULT);
93a1df48
YAP		 2402
2403 switch (type) {
2404 case NL80211_IFTYPE_UNSPECIFIED:
2405 case NL80211_IFTYPE_STATION:
2406 case NL80211_IFTYPE_ADHOC:
cf052335
AP		 2407 if (adapter->curr_iface_comb.sta_intf ==
2408 adapter->iface_limit.sta_intf) {
d6bffe8b
AP		 2409 wiphy_err(wiphy,
2410 "cannot create multiple sta/adhoc ifaces\n");
858faa57 2411 return ERR_PTR(-EINVAL);
93a1df48
YAP		 2412 }
2413
cf052335
AP		 2414 priv = mwifiex_get_unused_priv(adapter);
2415 if (!priv) {
2416 wiphy_err(wiphy,
2417 "could not get free private struct\n");
2418 return ERR_PTR(-EFAULT);
2419 }
2420
4facc34a
AP		 2421 priv->wdev.wiphy = wiphy;
2422 priv->wdev.iftype = NL80211_IFTYPE_STATION;
d6bffe8b 2423
93a1df48
YAP		 2424 if (type == NL80211_IFTYPE_UNSPECIFIED)
2425 priv->bss_mode = NL80211_IFTYPE_STATION;
2426 else
2427 priv->bss_mode = type;
2428
2429 priv->bss_type = MWIFIEX_BSS_TYPE_STA;
2430 priv->frame_type = MWIFIEX_DATA_FRAME_TYPE_ETH_II;
a458c0ae 2431 priv->bss_priority = 0;
93a1df48 2432 priv->bss_role = MWIFIEX_BSS_ROLE_STA;
93a1df48
YAP		 2433 priv->bss_num = 0;
2434
d6bffe8b
AP		 2435 break;
2436 case NL80211_IFTYPE_AP:
cf052335
AP		 2437 if (adapter->curr_iface_comb.uap_intf ==
2438 adapter->iface_limit.uap_intf) {
2439 wiphy_err(wiphy,
2440 "cannot create multiple AP ifaces\n");
858faa57 2441 return ERR_PTR(-EINVAL);
d6bffe8b
AP		 2442 }
2443
cf052335
AP		 2444 priv = mwifiex_get_unused_priv(adapter);
2445 if (!priv) {
2446 wiphy_err(wiphy,
2447 "could not get free private struct\n");
2448 return ERR_PTR(-EFAULT);
2449 }
2450
4facc34a
AP		 2451 priv->wdev.wiphy = wiphy;
2452 priv->wdev.iftype = NL80211_IFTYPE_AP;
d6bffe8b
AP		 2453
2454 priv->bss_type = MWIFIEX_BSS_TYPE_UAP;
2455 priv->frame_type = MWIFIEX_DATA_FRAME_TYPE_ETH_II;
a458c0ae 2456 priv->bss_priority = 0;
d6bffe8b
AP		 2457 priv->bss_role = MWIFIEX_BSS_ROLE_UAP;
2458 priv->bss_started = 0;
2459 priv->bss_num = 0;
2460 priv->bss_mode = type;
2461
197f4a2e
SP		 2462 break;
2463 case NL80211_IFTYPE_P2P_CLIENT:
cf052335
AP		 2464 if (adapter->curr_iface_comb.p2p_intf ==
2465 adapter->iface_limit.p2p_intf) {
2466 wiphy_err(wiphy,
2467 "cannot create multiple P2P ifaces\n");
197f4a2e
SP		 2468 return ERR_PTR(-EINVAL);
2469 }
2470
cf052335
AP		 2471 priv = mwifiex_get_unused_priv(adapter);
2472 if (!priv) {
2473 wiphy_err(wiphy,
2474 "could not get free private struct\n");
2475 return ERR_PTR(-EFAULT);
2476 }
197f4a2e 2477
cf052335 2478 priv->wdev.wiphy = wiphy;
197f4a2e
SP		 2479 /* At start-up, wpa_supplicant tries to change the interface
2480 * to NL80211_IFTYPE_STATION if it is not managed mode.
197f4a2e 2481 */
4facc34a 2482 priv->wdev.iftype = NL80211_IFTYPE_P2P_CLIENT;
5586d3e2 2483 priv->bss_mode = NL80211_IFTYPE_P2P_CLIENT;
197f4a2e
SP		 2484
2485 /* Setting bss_type to P2P tells firmware that this interface
2486 * is receiving P2P peers found during find phase and doing
2487 * action frame handshake.
2488 */
2489 priv->bss_type = MWIFIEX_BSS_TYPE_P2P;
2490
2491 priv->frame_type = MWIFIEX_DATA_FRAME_TYPE_ETH_II;
2492 priv->bss_priority = MWIFIEX_BSS_ROLE_STA;
2493 priv->bss_role = MWIFIEX_BSS_ROLE_STA;
2494 priv->bss_started = 0;
2495 priv->bss_num = 0;
2496
bec568ff 2497 if (mwifiex_cfg80211_init_p2p_client(priv)) {
4facc34a
AP		 2498 memset(&priv->wdev, 0, sizeof(priv->wdev));
2499 priv->wdev.iftype = NL80211_IFTYPE_UNSPECIFIED;
2500 return ERR_PTR(-EFAULT);
bec568ff 2501 }
66aa1ae2 2502
93a1df48
YAP		 2503 break;
2504 default:
2505 wiphy_err(wiphy, "type not supported\n");
858faa57 2506 return ERR_PTR(-EINVAL);
93a1df48
YAP		 2507 }
2508
47411a06 2509 dev = alloc_netdev_mqs(sizeof(struct mwifiex_private *), name,
c835a677
TG		 2510 NET_NAME_UNKNOWN, ether_setup,
2511 IEEE80211_NUM_ACS, 1);
93a1df48
YAP		 2512 if (!dev) {
2513 wiphy_err(wiphy, "no memory available for netdevice\n");
4facc34a
AP		 2514 memset(&priv->wdev, 0, sizeof(priv->wdev));
2515 priv->wdev.iftype = NL80211_IFTYPE_UNSPECIFIED;
858faa57 2516 priv->bss_mode = NL80211_IFTYPE_UNSPECIFIED;
4facc34a 2517 return ERR_PTR(-ENOMEM);
93a1df48
YAP		 2518 }
2519
d6bffe8b
AP		 2520 mwifiex_init_priv_params(priv, dev);
2521 priv->netdev = dev;
2522
2523 mwifiex_setup_ht_caps(&wiphy->bands[IEEE80211_BAND_2GHZ]->ht_cap, priv);
a5f39056
YAP		 2524 if (adapter->is_hw_11ac_capable)
2525 mwifiex_setup_vht_caps(
2526 &wiphy->bands[IEEE80211_BAND_2GHZ]->vht_cap, priv);
d6bffe8b
AP		 2527
2528 if (adapter->config_bands & BAND_A)
2529 mwifiex_setup_ht_caps(
2530 &wiphy->bands[IEEE80211_BAND_5GHZ]->ht_cap, priv);
2531
a5f39056
YAP		 2532 if ((adapter->config_bands & BAND_A) && adapter->is_hw_11ac_capable)
2533 mwifiex_setup_vht_caps(
2534 &wiphy->bands[IEEE80211_BAND_5GHZ]->vht_cap, priv);
2535
93a1df48 2536 dev_net_set(dev, wiphy_net(wiphy));
4facc34a 2537 dev->ieee80211_ptr = &priv->wdev;
93a1df48
YAP		 2538 dev->ieee80211_ptr->iftype = priv->bss_mode;
2539 memcpy(dev->dev_addr, wiphy->perm_addr, ETH_ALEN);
93a1df48
YAP		 2540 SET_NETDEV_DEV(dev, wiphy_dev(wiphy));
2541
2542 dev->flags |= IFF_BROADCAST | IFF_MULTICAST;
2543 dev->watchdog_timeo = MWIFIEX_DEFAULT_WATCHDOG_TIMEOUT;
2544 dev->hard_header_len += MWIFIEX_MIN_DATA_HEADER_LEN;
0d7f53e3 2545 dev->ethtool_ops = &mwifiex_ethtool_ops;
93a1df48
YAP		 2546
2547 mdev_priv = netdev_priv(dev);
2548 *((unsigned long *) mdev_priv) = (unsigned long) priv;
2549
93a1df48
YAP		 2550 SET_NETDEV_DEV(dev, adapter->dev);
2551
2552 /* Register network device */
2553 if (register_netdevice(dev)) {
2554 wiphy_err(wiphy, "cannot register virtual network device\n");
858faa57
BZ		 2555 free_netdev(dev);
2556 priv->bss_mode = NL80211_IFTYPE_UNSPECIFIED;
bec568ff 2557 priv->netdev = NULL;
4facc34a
AP		 2558 memset(&priv->wdev, 0, sizeof(priv->wdev));
2559 priv->wdev.iftype = NL80211_IFTYPE_UNSPECIFIED;
2560 return ERR_PTR(-EFAULT);
93a1df48
YAP		 2561 }
2562
2563 sema_init(&priv->async_sem, 1);
93a1df48
YAP		 2564
2565 dev_dbg(adapter->dev, "info: %s: Marvell 802.11 Adapter\n", dev->name);
2566
2567#ifdef CONFIG_DEBUG_FS
2568 mwifiex_dev_debugfs_init(priv);
2569#endif
bec568ff 2570
cf052335
AP		 2571 switch (type) {
2572 case NL80211_IFTYPE_UNSPECIFIED:
2573 case NL80211_IFTYPE_STATION:
2574 case NL80211_IFTYPE_ADHOC:
2575 adapter->curr_iface_comb.sta_intf++;
2576 break;
2577 case NL80211_IFTYPE_AP:
2578 adapter->curr_iface_comb.uap_intf++;
2579 break;
2580 case NL80211_IFTYPE_P2P_CLIENT:
2581 adapter->curr_iface_comb.p2p_intf++;
2582 break;
2583 default:
2584 wiphy_err(wiphy, "type not supported\n");
2585 return ERR_PTR(-EINVAL);
2586 }
2587
4facc34a 2588 return &priv->wdev;
93a1df48
YAP		 2589}
2590EXPORT_SYMBOL_GPL(mwifiex_add_virtual_intf);
2591
2592/*
2593 * del_virtual_intf: remove the virtual interface determined by dev
2594 */
84efbb84 2595int mwifiex_del_virtual_intf(struct wiphy *wiphy, struct wireless_dev *wdev)
93a1df48 2596{
84efbb84 2597 struct mwifiex_private *priv = mwifiex_netdev_get_priv(wdev->netdev);
cf052335 2598 struct mwifiex_adapter *adapter = priv->adapter;
93a1df48
YAP		 2599
2600#ifdef CONFIG_DEBUG_FS
2601 mwifiex_dev_debugfs_remove(priv);
2602#endif
2603
cf052335 2604 mwifiex_stop_net_dev_queue(priv->netdev, adapter);
93a1df48
YAP		 2605
2606 if (netif_carrier_ok(priv->netdev))
2607 netif_carrier_off(priv->netdev);
2608
84efbb84
JB		 2609 if (wdev->netdev->reg_state == NETREG_REGISTERED)
2610 unregister_netdevice(wdev->netdev);
93a1df48 2611
93a1df48 2612 /* Clear the priv in adapter */
98a4635b 2613 priv->netdev->ieee80211_ptr = NULL;
93a1df48 2614 priv->netdev = NULL;
4facc34a 2615 priv->wdev.iftype = NL80211_IFTYPE_UNSPECIFIED;
93a1df48
YAP		 2616
2617 priv->media_connected = false;
2618
cf052335
AP		 2619 switch (priv->bss_mode) {
2620 case NL80211_IFTYPE_UNSPECIFIED:
2621 case NL80211_IFTYPE_STATION:
2622 case NL80211_IFTYPE_ADHOC:
2623 adapter->curr_iface_comb.sta_intf++;
2624 break;
2625 case NL80211_IFTYPE_AP:
2626 adapter->curr_iface_comb.uap_intf++;
2627 break;
2628 case NL80211_IFTYPE_P2P_CLIENT:
2629 case NL80211_IFTYPE_P2P_GO:
2630 adapter->curr_iface_comb.p2p_intf++;
2631 break;
2632 default:
2633 dev_err(adapter->dev, "del_virtual_intf: type not supported\n");
2634 break;
2635 }
2636
93a1df48
YAP		 2637 priv->bss_mode = NL80211_IFTYPE_UNSPECIFIED;
2638
cbf6e055
XH		 2639 if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA ||
2640 GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_UAP)
2641 kfree(priv->hist_data);
2642
93a1df48
YAP		 2643 return 0;
2644}
2645EXPORT_SYMBOL_GPL(mwifiex_del_virtual_intf);
2646
7da060c1 2647static bool
0434c464
AK		 2648mwifiex_is_pattern_supported(struct cfg80211_pkt_pattern *pat, s8 *byte_seq,
2649 u8 max_byte_seq)
7da060c1
AK		 2650{
2651 int j, k, valid_byte_cnt = 0;
2652 bool dont_care_byte = false;
2653
2654 for (j = 0; j < DIV_ROUND_UP(pat->pattern_len, 8); j++) {
2655 for (k = 0; k < 8; k++) {
2656 if (pat->mask[j] & 1 << k) {
2657 memcpy(byte_seq + valid_byte_cnt,
2658 &pat->pattern[j * 8 + k], 1);
2659 valid_byte_cnt++;
2660 if (dont_care_byte)
2661 return false;
2662 } else {
2663 if (valid_byte_cnt)
2664 dont_care_byte = true;
2665 }
2666
0434c464 2667 if (valid_byte_cnt > max_byte_seq)
7da060c1
AK		 2668 return false;
2669 }
2670 }
2671
0434c464 2672 byte_seq[max_byte_seq] = valid_byte_cnt;
7da060c1
AK		 2673
2674 return true;
2675}
2676
d1e2586f 2677#ifdef CONFIG_PM
468133c5
MH		 2678static int mwifiex_set_mef_filter(struct mwifiex_private *priv,
2679 struct cfg80211_wowlan *wowlan)
7da060c1 2680{
468133c5 2681 int i, filt_num = 0, ret = 0;
7da060c1 2682 bool first_pat = true;
3f4e854a 2683 u8 byte_seq[MWIFIEX_MEF_MAX_BYTESEQ + 1];
7da060c1
AK		 2684 const u8 ipv4_mc_mac[] = {0x33, 0x33};
2685 const u8 ipv6_mc_mac[] = {0x01, 0x00, 0x5e};
468133c5
MH		 2686 struct mwifiex_ds_mef_cfg mef_cfg;
2687 struct mwifiex_mef_entry *mef_entry;
7da060c1 2688
c678fb2a
BZ		 2689 mef_entry = kzalloc(sizeof(*mef_entry), GFP_KERNEL);
2690 if (!mef_entry)
2691 return -ENOMEM;
2692
7da060c1
AK		 2693 memset(&mef_cfg, 0, sizeof(mef_cfg));
2694 mef_cfg.num_entries = 1;
7da060c1
AK		 2695 mef_cfg.mef_entry = mef_entry;
2696 mef_entry->mode = MEF_MODE_HOST_SLEEP;
2697 mef_entry->action = MEF_ACTION_ALLOW_AND_WAKEUP_HOST;
2698
2699 for (i = 0; i < wowlan->n_patterns; i++) {
2700 memset(byte_seq, 0, sizeof(byte_seq));
2701 if (!mwifiex_is_pattern_supported(&wowlan->patterns[i],
468133c5
MH		 2702 byte_seq,
2703 MWIFIEX_MEF_MAX_BYTESEQ)) {
2704 dev_err(priv->adapter->dev, "Pattern not supported\n");
7da060c1
AK		 2705 kfree(mef_entry);
2706 return -EOPNOTSUPP;
2707 }
2708
2709 if (!wowlan->patterns[i].pkt_offset) {
2710 if (!(byte_seq[0] & 0x01) &&
3f4e854a 2711 (byte_seq[MWIFIEX_MEF_MAX_BYTESEQ] == 1)) {
7da060c1
AK		 2712 mef_cfg.criteria |= MWIFIEX_CRITERIA_UNICAST;
2713 continue;
2714 } else if (is_broadcast_ether_addr(byte_seq)) {
2715 mef_cfg.criteria |= MWIFIEX_CRITERIA_BROADCAST;
2716 continue;
2717 } else if ((!memcmp(byte_seq, ipv4_mc_mac, 2) &&
3f4e854a 2718 (byte_seq[MWIFIEX_MEF_MAX_BYTESEQ] == 2)) ||
7da060c1 2719 (!memcmp(byte_seq, ipv6_mc_mac, 3) &&
3f4e854a 2720 (byte_seq[MWIFIEX_MEF_MAX_BYTESEQ] == 3))) {
7da060c1
AK		 2721 mef_cfg.criteria |= MWIFIEX_CRITERIA_MULTICAST;
2722 continue;
2723 }
2724 }
2725
2726 mef_entry->filter[filt_num].repeat = 1;
2727 mef_entry->filter[filt_num].offset =
468133c5 2728 wowlan->patterns[i].pkt_offset;
7da060c1 2729 memcpy(mef_entry->filter[filt_num].byte_seq, byte_seq,
468133c5 2730 sizeof(byte_seq));
7da060c1
AK		 2731 mef_entry->filter[filt_num].filt_type = TYPE_EQ;
2732
2733 if (first_pat)
2734 first_pat = false;
2735 else
2736 mef_entry->filter[filt_num].filt_action = TYPE_AND;
2737
2738 filt_num++;
2739 }
2740
2741 if (wowlan->magic_pkt) {
2742 mef_cfg.criteria |= MWIFIEX_CRITERIA_UNICAST;
2743 mef_entry->filter[filt_num].repeat = 16;
2744 memcpy(mef_entry->filter[filt_num].byte_seq, priv->curr_addr,
468133c5 2745 ETH_ALEN);
3f4e854a 2746 mef_entry->filter[filt_num].byte_seq[MWIFIEX_MEF_MAX_BYTESEQ] =
468133c5 2747 ETH_ALEN;
09e65f5b 2748 mef_entry->filter[filt_num].offset = 28;
7da060c1
AK		 2749 mef_entry->filter[filt_num].filt_type = TYPE_EQ;
2750 if (filt_num)
2751 mef_entry->filter[filt_num].filt_action = TYPE_OR;
4dbc13fa
ZY		 2752
2753 filt_num++;
2754 mef_entry->filter[filt_num].repeat = 16;
2755 memcpy(mef_entry->filter[filt_num].byte_seq, priv->curr_addr,
468133c5 2756 ETH_ALEN);
4dbc13fa 2757 mef_entry->filter[filt_num].byte_seq[MWIFIEX_MEF_MAX_BYTESEQ] =
468133c5 2758 ETH_ALEN;
4dbc13fa
ZY		 2759 mef_entry->filter[filt_num].offset = 56;
2760 mef_entry->filter[filt_num].filt_type = TYPE_EQ;
2761 mef_entry->filter[filt_num].filt_action = TYPE_OR;
7da060c1
AK		 2762 }
2763
2764 if (!mef_cfg.criteria)
2765 mef_cfg.criteria = MWIFIEX_CRITERIA_BROADCAST |
468133c5
MH		 2766 MWIFIEX_CRITERIA_UNICAST |
2767 MWIFIEX_CRITERIA_MULTICAST;
7da060c1 2768
fa0ecbb9 2769 ret = mwifiex_send_cmd(priv, HostCmd_CMD_MEF_CFG,
468133c5 2770 HostCmd_ACT_GEN_SET, 0, &mef_cfg, true);
7da060c1
AK		 2771
2772 kfree(mef_entry);
2773 return ret;
2774}
2775
468133c5
MH		 2776static int mwifiex_cfg80211_suspend(struct wiphy *wiphy,
2777 struct cfg80211_wowlan *wowlan)
2778{
2779 struct mwifiex_adapter *adapter = mwifiex_cfg80211_get_adapter(wiphy);
8a40084e 2780 struct mwifiex_ds_hs_cfg hs_cfg;
468133c5
MH		 2781 int ret = 0;
2782 struct mwifiex_private *priv =
2783 mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_STA);
2784
2785 if (!wowlan) {
2786 dev_warn(adapter->dev, "None of the WOWLAN triggers enabled\n");
2787 return 0;
2788 }
2789
2790 if (!priv->media_connected) {
2791 dev_warn(adapter->dev,
2792 "Can not configure WOWLAN in disconnected state\n");
2793 return 0;
2794 }
2795
2796 if (wowlan->n_patterns || wowlan->magic_pkt) {
2797 ret = mwifiex_set_mef_filter(priv, wowlan);
2798 if (ret) {
2799 dev_err(adapter->dev, "Failed to set MEF filter\n");
2800 return ret;
2801 }
2802 }
2803
8a40084e
MH		 2804 if (wowlan->disconnect) {
2805 memset(&hs_cfg, 0, sizeof(hs_cfg));
2806 hs_cfg.is_invoke_hostcmd = false;
2807 hs_cfg.conditions = HS_CFG_COND_MAC_EVENT;
2808 hs_cfg.gpio = HS_CFG_GPIO_DEF;
2809 hs_cfg.gap = HS_CFG_GAP_DEF;
2810 ret = mwifiex_set_hs_params(priv, HostCmd_ACT_GEN_SET,
2811 MWIFIEX_SYNC_CMD, &hs_cfg);
2812 if (ret) {
2813 dev_err(adapter->dev, "Failed to set HS params\n");
2814 return ret;
2815 }
2816 }
2817
468133c5
MH		 2818 return ret;
2819}
2820
7da060c1
AK		 2821static int mwifiex_cfg80211_resume(struct wiphy *wiphy)
2822{
2823 return 0;
2824}
2825
2826static void mwifiex_cfg80211_set_wakeup(struct wiphy *wiphy,
2827 bool enabled)
2828{
2829 struct mwifiex_adapter *adapter = mwifiex_cfg80211_get_adapter(wiphy);
2830
2831 device_set_wakeup_enable(adapter->dev, enabled);
2832}
2833#endif
2834
562fc5b3
AK		 2835static int mwifiex_get_coalesce_pkt_type(u8 *byte_seq)
2836{
2837 const u8 ipv4_mc_mac[] = {0x33, 0x33};
2838 const u8 ipv6_mc_mac[] = {0x01, 0x00, 0x5e};
2839 const u8 bc_mac[] = {0xff, 0xff, 0xff, 0xff};
2840
2841 if ((byte_seq[0] & 0x01) &&
2842 (byte_seq[MWIFIEX_COALESCE_MAX_BYTESEQ] == 1))
2843 return PACKET_TYPE_UNICAST;
2844 else if (!memcmp(byte_seq, bc_mac, 4))
2845 return PACKET_TYPE_BROADCAST;
2846 else if ((!memcmp(byte_seq, ipv4_mc_mac, 2) &&
2847 byte_seq[MWIFIEX_COALESCE_MAX_BYTESEQ] == 2) ||
2848 (!memcmp(byte_seq, ipv6_mc_mac, 3) &&
2849 byte_seq[MWIFIEX_COALESCE_MAX_BYTESEQ] == 3))
2850 return PACKET_TYPE_MULTICAST;
2851
2852 return 0;
2853}
2854
2855static int
2856mwifiex_fill_coalesce_rule_info(struct mwifiex_private *priv,
2857 struct cfg80211_coalesce_rules *crule,
2858 struct mwifiex_coalesce_rule *mrule)
2859{
2860 u8 byte_seq[MWIFIEX_COALESCE_MAX_BYTESEQ + 1];
2861 struct filt_field_param *param;
2862 int i;
2863
2864 mrule->max_coalescing_delay = crule->delay;
2865
2866 param = mrule->params;
2867
2868 for (i = 0; i < crule->n_patterns; i++) {
2869 memset(byte_seq, 0, sizeof(byte_seq));
2870 if (!mwifiex_is_pattern_supported(&crule->patterns[i],
2871 byte_seq,
2872 MWIFIEX_COALESCE_MAX_BYTESEQ)) {
2873 dev_err(priv->adapter->dev, "Pattern not supported\n");
2874 return -EOPNOTSUPP;
2875 }
2876
2877 if (!crule->patterns[i].pkt_offset) {
2878 u8 pkt_type;
2879
2880 pkt_type = mwifiex_get_coalesce_pkt_type(byte_seq);
2881 if (pkt_type && mrule->pkt_type) {
2882 dev_err(priv->adapter->dev,
2883 "Multiple packet types not allowed\n");
2884 return -EOPNOTSUPP;
2885 } else if (pkt_type) {
2886 mrule->pkt_type = pkt_type;
2887 continue;
2888 }
2889 }
2890
2891 if (crule->condition == NL80211_COALESCE_CONDITION_MATCH)
2892 param->operation = RECV_FILTER_MATCH_TYPE_EQ;
2893 else
2894 param->operation = RECV_FILTER_MATCH_TYPE_NE;
2895
2896 param->operand_len = byte_seq[MWIFIEX_COALESCE_MAX_BYTESEQ];
2897 memcpy(param->operand_byte_stream, byte_seq,
2898 param->operand_len);
2899 param->offset = crule->patterns[i].pkt_offset;
2900 param++;
2901
2902 mrule->num_of_fields++;
2903 }
2904
2905 if (!mrule->pkt_type) {
2906 dev_err(priv->adapter->dev,
2907 "Packet type can not be determined\n");
2908 return -EOPNOTSUPP;
2909 }
2910
2911 return 0;
2912}
2913
2914static int mwifiex_cfg80211_set_coalesce(struct wiphy *wiphy,
2915 struct cfg80211_coalesce *coalesce)
2916{
2917 struct mwifiex_adapter *adapter = mwifiex_cfg80211_get_adapter(wiphy);
2918 int i, ret;
2919 struct mwifiex_ds_coalesce_cfg coalesce_cfg;
2920 struct mwifiex_private *priv =
2921 mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_STA);
2922
2923 memset(&coalesce_cfg, 0, sizeof(coalesce_cfg));
2924 if (!coalesce) {
2925 dev_dbg(adapter->dev,
2926 "Disable coalesce and reset all previous rules\n");
fa0ecbb9
BZ		 2927 return mwifiex_send_cmd(priv, HostCmd_CMD_COALESCE_CFG,
2928 HostCmd_ACT_GEN_SET, 0,
2929 &coalesce_cfg, true);
562fc5b3
AK		 2930 }
2931
2932 coalesce_cfg.num_of_rules = coalesce->n_rules;
2933 for (i = 0; i < coalesce->n_rules; i++) {
2934 ret = mwifiex_fill_coalesce_rule_info(priv, &coalesce->rules[i],
2935 &coalesce_cfg.rule[i]);
2936 if (ret) {
2937 dev_err(priv->adapter->dev,
2938 "Recheck the patterns provided for rule %d\n",
2939 i + 1);
2940 return ret;
2941 }
2942 }
2943
fa0ecbb9
BZ		 2944 return mwifiex_send_cmd(priv, HostCmd_CMD_COALESCE_CFG,
2945 HostCmd_ACT_GEN_SET, 0, &coalesce_cfg, true);
562fc5b3
AK		 2946}
2947
b23bce29
AP		 2948/* cfg80211 ops handler for tdls_mgmt.
2949 * Function prepares TDLS action frame packets and forwards them to FW
2950 */
2951static int
2952mwifiex_cfg80211_tdls_mgmt(struct wiphy *wiphy, struct net_device *dev,
3b3a0162 2953 const u8 *peer, u8 action_code, u8 dialog_token,
df942e7b 2954 u16 status_code, u32 peer_capability,
31fa97c5
AN		 2955 bool initiator, const u8 *extra_ies,
2956 size_t extra_ies_len)
b23bce29
AP		 2957{
2958 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
2959 int ret;
2960
2961 if (!(wiphy->flags & WIPHY_FLAG_SUPPORTS_TDLS))
2962 return -ENOTSUPP;
2963
2964 /* make sure we are in station mode and connected */
2965 if (!(priv->bss_type == MWIFIEX_BSS_TYPE_STA && priv->media_connected))
2966 return -ENOTSUPP;
2967
2968 switch (action_code) {
2969 case WLAN_TDLS_SETUP_REQUEST:
2970 dev_dbg(priv->adapter->dev,
2971 "Send TDLS Setup Request to %pM status_code=%d\n", peer,
2972 status_code);
9927baa3 2973 mwifiex_add_auto_tdls_peer(priv, peer);
b23bce29
AP		 2974 ret = mwifiex_send_tdls_data_frame(priv, peer, action_code,
2975 dialog_token, status_code,
2976 extra_ies, extra_ies_len);
2977 break;
2978 case WLAN_TDLS_SETUP_RESPONSE:
9927baa3 2979 mwifiex_add_auto_tdls_peer(priv, peer);
b23bce29
AP		 2980 dev_dbg(priv->adapter->dev,
2981 "Send TDLS Setup Response to %pM status_code=%d\n",
2982 peer, status_code);
2983 ret = mwifiex_send_tdls_data_frame(priv, peer, action_code,
2984 dialog_token, status_code,
2985 extra_ies, extra_ies_len);
2986 break;
2987 case WLAN_TDLS_SETUP_CONFIRM:
2988 dev_dbg(priv->adapter->dev,
2989 "Send TDLS Confirm to %pM status_code=%d\n", peer,
2990 status_code);
2991 ret = mwifiex_send_tdls_data_frame(priv, peer, action_code,
2992 dialog_token, status_code,
2993 extra_ies, extra_ies_len);
2994 break;
2995 case WLAN_TDLS_TEARDOWN:
2996 dev_dbg(priv->adapter->dev, "Send TDLS Tear down to %pM\n",
2997 peer);
2998 ret = mwifiex_send_tdls_data_frame(priv, peer, action_code,
2999 dialog_token, status_code,
3000 extra_ies, extra_ies_len);
3001 break;
3002 case WLAN_TDLS_DISCOVERY_REQUEST:
3003 dev_dbg(priv->adapter->dev,
3004 "Send TDLS Discovery Request to %pM\n", peer);
3005 ret = mwifiex_send_tdls_data_frame(priv, peer, action_code,
3006 dialog_token, status_code,
3007 extra_ies, extra_ies_len);
3008 break;
3009 case WLAN_PUB_ACTION_TDLS_DISCOVER_RES:
3010 dev_dbg(priv->adapter->dev,
3011 "Send TDLS Discovery Response to %pM\n", peer);
3012 ret = mwifiex_send_tdls_action_frame(priv, peer, action_code,
3013 dialog_token, status_code,
3014 extra_ies, extra_ies_len);
3015 break;
3016 default:
3017 dev_warn(priv->adapter->dev,
3018 "Unknown TDLS mgmt/action frame %pM\n", peer);
3019 ret = -EINVAL;
3020 break;
3021 }
3022
3023 return ret;
3024}
3025
429d90d2
AP		 3026static int
3027mwifiex_cfg80211_tdls_oper(struct wiphy *wiphy, struct net_device *dev,
3b3a0162 3028 const u8 *peer, enum nl80211_tdls_operation action)
429d90d2
AP		 3029{
3030 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
3031
3032 if (!(wiphy->flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
3033 !(wiphy->flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
3034 return -ENOTSUPP;
3035
3036 /* make sure we are in station mode and connected */
3037 if (!(priv->bss_type == MWIFIEX_BSS_TYPE_STA && priv->media_connected))
3038 return -ENOTSUPP;
3039
3040 dev_dbg(priv->adapter->dev,
3041 "TDLS peer=%pM, oper=%d\n", peer, action);
3042
3043 switch (action) {
3044 case NL80211_TDLS_ENABLE_LINK:
3045 action = MWIFIEX_TDLS_ENABLE_LINK;
3046 break;
3047 case NL80211_TDLS_DISABLE_LINK:
3048 action = MWIFIEX_TDLS_DISABLE_LINK;
3049 break;
3050 case NL80211_TDLS_TEARDOWN:
3051 /* shouldn't happen!*/
3052 dev_warn(priv->adapter->dev,
3053 "tdls_oper: teardown from driver not supported\n");
3054 return -EINVAL;
3055 case NL80211_TDLS_SETUP:
3056 /* shouldn't happen!*/
3057 dev_warn(priv->adapter->dev,
3058 "tdls_oper: setup from driver not supported\n");
3059 return -EINVAL;
3060 case NL80211_TDLS_DISCOVERY_REQ:
3061 /* shouldn't happen!*/
3062 dev_warn(priv->adapter->dev,
3063 "tdls_oper: discovery from driver not supported\n");
3064 return -EINVAL;
3065 default:
3066 dev_err(priv->adapter->dev,
3067 "tdls_oper: operation not supported\n");
3068 return -ENOTSUPP;
3069 }
3070
3071 return mwifiex_tdls_oper(priv, peer, action);
3072}
3073
e48e0de0 3074static int
3b3a0162
JB		 3075mwifiex_cfg80211_add_station(struct wiphy *wiphy, struct net_device *dev,
3076 const u8 *mac, struct station_parameters *params)
e48e0de0
AP		 3077{
3078 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
3079
3080 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
3081 return -ENOTSUPP;
3082
3083 /* make sure we are in station mode and connected */
3084 if ((priv->bss_type != MWIFIEX_BSS_TYPE_STA) || !priv->media_connected)
3085 return -ENOTSUPP;
3086
3087 return mwifiex_tdls_oper(priv, mac, MWIFIEX_TDLS_CREATE_LINK);
3088}
3089
1f4dfd8a 3090static int
3b3a0162
JB		 3091mwifiex_cfg80211_change_station(struct wiphy *wiphy, struct net_device *dev,
3092 const u8 *mac,
3093 struct station_parameters *params)
1f4dfd8a
AP		 3094{
3095 int ret;
3096 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
3097
3098 /* we support change_station handler only for TDLS peers*/
3099 if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
3100 return -ENOTSUPP;
3101
3102 /* make sure we are in station mode and connected */
3103 if ((priv->bss_type != MWIFIEX_BSS_TYPE_STA) || !priv->media_connected)
3104 return -ENOTSUPP;
3105
3106 priv->sta_params = params;
3107
3108 ret = mwifiex_tdls_oper(priv, mac, MWIFIEX_TDLS_CONFIG_LINK);
3109 priv->sta_params = NULL;
3110
3111 return ret;
3112}
3113
5e6e3a92
BZ		 3114/* station cfg80211 operations */
3115static struct cfg80211_ops mwifiex_cfg80211_ops = {
93a1df48
YAP		 3116 .add_virtual_intf = mwifiex_add_virtual_intf,
3117 .del_virtual_intf = mwifiex_del_virtual_intf,
5e6e3a92
BZ		 3118 .change_virtual_intf = mwifiex_cfg80211_change_virtual_intf,
3119 .scan = mwifiex_cfg80211_scan,
3120 .connect = mwifiex_cfg80211_connect,
3121 .disconnect = mwifiex_cfg80211_disconnect,
3122 .get_station = mwifiex_cfg80211_get_station,
f85aae6b 3123 .dump_station = mwifiex_cfg80211_dump_station,
6bc6c49f 3124 .dump_survey = mwifiex_cfg80211_dump_survey,
5e6e3a92 3125 .set_wiphy_params = mwifiex_cfg80211_set_wiphy_params,
5e6e3a92
BZ		 3126 .join_ibss = mwifiex_cfg80211_join_ibss,
3127 .leave_ibss = mwifiex_cfg80211_leave_ibss,
3128 .add_key = mwifiex_cfg80211_add_key,
3129 .del_key = mwifiex_cfg80211_del_key,
e39faa73 3130 .mgmt_tx = mwifiex_cfg80211_mgmt_tx,
3cec6870 3131 .mgmt_frame_register = mwifiex_cfg80211_mgmt_frame_register,
7feb4c48
SP		 3132 .remain_on_channel = mwifiex_cfg80211_remain_on_channel,
3133 .cancel_remain_on_channel = mwifiex_cfg80211_cancel_remain_on_channel,
5e6e3a92
BZ		 3134 .set_default_key = mwifiex_cfg80211_set_default_key,
3135 .set_power_mgmt = mwifiex_cfg80211_set_power_mgmt,
3136 .set_tx_power = mwifiex_cfg80211_set_tx_power,
5d82c53a 3137 .set_bitrate_mask = mwifiex_cfg80211_set_bitrate_mask,
12190c5d
AP		 3138 .start_ap = mwifiex_cfg80211_start_ap,
3139 .stop_ap = mwifiex_cfg80211_stop_ap,
5370c836 3140 .change_beacon = mwifiex_cfg80211_change_beacon,
fa444bf8 3141 .set_cqm_rssi_config = mwifiex_cfg80211_set_cqm_rssi_config,
8a279d5b 3142 .set_antenna = mwifiex_cfg80211_set_antenna,
0f9e9b8b 3143 .del_station = mwifiex_cfg80211_del_station,
7da060c1
AK		 3144#ifdef CONFIG_PM
3145 .suspend = mwifiex_cfg80211_suspend,
3146 .resume = mwifiex_cfg80211_resume,
3147 .set_wakeup = mwifiex_cfg80211_set_wakeup,
3148#endif
d1e2586f 3149 .set_coalesce = mwifiex_cfg80211_set_coalesce,
b23bce29 3150 .tdls_mgmt = mwifiex_cfg80211_tdls_mgmt,
429d90d2 3151 .tdls_oper = mwifiex_cfg80211_tdls_oper,
e48e0de0 3152 .add_station = mwifiex_cfg80211_add_station,
1f4dfd8a 3153 .change_station = mwifiex_cfg80211_change_station,
5e6e3a92
BZ		 3154};
3155
964dc9e2
JB		 3156#ifdef CONFIG_PM
3157static const struct wiphy_wowlan_support mwifiex_wowlan_support = {
8a40084e 3158 .flags = WIPHY_WOWLAN_MAGIC_PKT | WIPHY_WOWLAN_DISCONNECT,
3f4e854a 3159 .n_patterns = MWIFIEX_MEF_MAX_FILTERS,
964dc9e2
JB		 3160 .pattern_min_len = 1,
3161 .pattern_max_len = MWIFIEX_MAX_PATTERN_LEN,
3162 .max_pkt_offset = MWIFIEX_MAX_OFFSET_LEN,
3163};
3164#endif
3165
3c68ef5b
AP		 3166static bool mwifiex_is_valid_alpha2(const char *alpha2)
3167{
3168 if (!alpha2 || strlen(alpha2) != 2)
3169 return false;
3170
3171 if (isalpha(alpha2[0]) && isalpha(alpha2[1]))
3172 return true;
3173
3174 return false;
3175}
3176
562fc5b3
AK		 3177static const struct wiphy_coalesce_support mwifiex_coalesce_support = {
3178 .n_rules = MWIFIEX_COALESCE_MAX_RULES,
3179 .max_delay = MWIFIEX_MAX_COALESCING_DELAY,
3180 .n_patterns = MWIFIEX_COALESCE_MAX_FILTERS,
3181 .pattern_min_len = 1,
3182 .pattern_max_len = MWIFIEX_MAX_PATTERN_LEN,
3183 .max_pkt_offset = MWIFIEX_MAX_OFFSET_LEN,
3184};
3185
bf354433
AP		 3186int mwifiex_init_channel_scan_gap(struct mwifiex_adapter *adapter)
3187{
3188 u32 n_channels_bg, n_channels_a = 0;
3189
3190 n_channels_bg = mwifiex_band_2ghz.n_channels;
3191
3192 if (adapter->config_bands & BAND_A)
3193 n_channels_a = mwifiex_band_5ghz.n_channels;
3194
3195 adapter->num_in_chan_stats = max_t(u32, n_channels_bg, n_channels_a);
3196 adapter->chan_stats = vmalloc(sizeof(*adapter->chan_stats) *
3197 adapter->num_in_chan_stats);
3198
3199 if (!adapter->chan_stats)
3200 return -ENOMEM;
3201
3202 return 0;
3203}
3204
5e6e3a92
BZ		 3205/*
3206 * This function registers the device with CFG802.11 subsystem.
3207 *
3208 * The function creates the wireless device/wiphy, populates it with
3209 * default parameters and handler function pointers, and finally
3210 * registers the device.
3211 */
d6bffe8b
AP		 3212
3213int mwifiex_register_cfg80211(struct mwifiex_adapter *adapter)
5e6e3a92 3214{
270e58e8
YAP		 3215 int ret;
3216 void *wdev_priv;
d6bffe8b
AP		 3217 struct wiphy *wiphy;
3218 struct mwifiex_private *priv = adapter->priv[MWIFIEX_BSS_TYPE_STA];
9e04a7c6 3219 u8 *country_code;
f862bfd1 3220 u32 thr, retry;
5e6e3a92 3221
d6bffe8b
AP		 3222 /* create a new wiphy for use with cfg80211 */
3223 wiphy = wiphy_new(&mwifiex_cfg80211_ops,
3224 sizeof(struct mwifiex_adapter *));
3225 if (!wiphy) {
3226 dev_err(adapter->dev, "%s: creating new wiphy\n", __func__);
5e6e3a92
BZ		 3227 return -ENOMEM;
3228 }
d6bffe8b
AP		 3229 wiphy->max_scan_ssids = MWIFIEX_MAX_SSID_LIST_LENGTH;
3230 wiphy->max_scan_ie_len = MWIFIEX_MAX_VSIE_LEN;
83719be8 3231 wiphy->mgmt_stypes = mwifiex_mgmt_stypes;
7feb4c48 3232 wiphy->max_remain_on_channel_duration = 5000;
d6bffe8b
AP		 3233 wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
3234 BIT(NL80211_IFTYPE_ADHOC) |
197f4a2e
SP		 3235 BIT(NL80211_IFTYPE_P2P_CLIENT) |
3236 BIT(NL80211_IFTYPE_P2P_GO) |
d6bffe8b
AP		 3237 BIT(NL80211_IFTYPE_AP);
3238
3239 wiphy->bands[IEEE80211_BAND_2GHZ] = &mwifiex_band_2ghz;
3240 if (adapter->config_bands & BAND_A)
3241 wiphy->bands[IEEE80211_BAND_5GHZ] = &mwifiex_band_5ghz;
3242 else
3243 wiphy->bands[IEEE80211_BAND_5GHZ] = NULL;
5e6e3a92 3244
cd8440da
AP		 3245 wiphy->iface_combinations = &mwifiex_iface_comb_ap_sta;
3246 wiphy->n_iface_combinations = 1;
3247
5e6e3a92 3248 /* Initialize cipher suits */
d6bffe8b
AP		 3249 wiphy->cipher_suites = mwifiex_cipher_suites;
3250 wiphy->n_cipher_suites = ARRAY_SIZE(mwifiex_cipher_suites);
5e6e3a92 3251
8d05eb22 3252 ether_addr_copy(wiphy->perm_addr, adapter->perm_addr);
d6bffe8b 3253 wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
2dd2bd6b 3254 wiphy->flags |= WIPHY_FLAG_HAVE_AP_SME |
cc0ba0d5 3255 WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD |
54428c57 3256 WIPHY_FLAG_AP_UAPSD |
7feb4c48 3257 WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL;
b23bce29
AP		 3258
3259 if (ISSUPP_TDLS_ENABLED(adapter->fw_cap_info))
3260 wiphy->flags |= WIPHY_FLAG_SUPPORTS_TDLS |
3261 WIPHY_FLAG_TDLS_EXTERNAL_SETUP;
3262
7da060c1 3263#ifdef CONFIG_PM
964dc9e2 3264 wiphy->wowlan = &mwifiex_wowlan_support;
7da060c1
AK		 3265#endif
3266
562fc5b3
AK		 3267 wiphy->coalesce = &mwifiex_coalesce_support;
3268
2dd2bd6b 3269 wiphy->probe_resp_offload = NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS |
e39faa73
SP		 3270 NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 |
3271 NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P;
5e6e3a92 3272
8a279d5b
AK		 3273 wiphy->available_antennas_tx = BIT(adapter->number_of_antenna) - 1;
3274 wiphy->available_antennas_rx = BIT(adapter->number_of_antenna) - 1;
5e6e3a92 3275
b292219f 3276 wiphy->features |= NL80211_FEATURE_HT_IBSS |
e45a8419 3277 NL80211_FEATURE_INACTIVITY_TIMER |
e3c91683 3278 NL80211_FEATURE_NEED_OBSS_SCAN;
05910f4a 3279
808bbebc
AK		 3280 if (adapter->fw_api_ver == MWIFIEX_FW_V15)
3281 wiphy->features |= NL80211_FEATURE_SK_TX_STATUS;
3282
b5abcf02 3283 /* Reserve space for mwifiex specific private data for BSS */
d6bffe8b 3284 wiphy->bss_priv_size = sizeof(struct mwifiex_bss_priv);
5116f3ce 3285
d6bffe8b 3286 wiphy->reg_notifier = mwifiex_reg_notifier;
5e6e3a92 3287
67fdf39e 3288 /* Set struct mwifiex_adapter pointer in wiphy_priv */
d6bffe8b 3289 wdev_priv = wiphy_priv(wiphy);
67fdf39e 3290 *(unsigned long *)wdev_priv = (unsigned long)adapter;
5e6e3a92 3291
2c208890 3292 set_wiphy_dev(wiphy, priv->adapter->dev);
a7b21165 3293
d6bffe8b 3294 ret = wiphy_register(wiphy);
5e6e3a92 3295 if (ret < 0) {
d6bffe8b
AP		 3296 dev_err(adapter->dev,
3297 "%s: wiphy_register failed: %d\n", __func__, ret);
3298 wiphy_free(wiphy);
5e6e3a92 3299 return ret;
5e6e3a92 3300 }
3c68ef5b
AP		 3301
3302 if (reg_alpha2 && mwifiex_is_valid_alpha2(reg_alpha2)) {
3303 wiphy_info(wiphy, "driver hint alpha2: %2.2s\n", reg_alpha2);
3304 regulatory_hint(wiphy, reg_alpha2);
3305 } else {
3306 country_code = mwifiex_11d_code_2_region(adapter->region_code);
3307 if (country_code)
3308 wiphy_info(wiphy, "ignoring F/W country code %2.2s\n",
3309 country_code);
3310 }
5e6e3a92 3311
fa0ecbb9
BZ		 3312 mwifiex_send_cmd(priv, HostCmd_CMD_802_11_SNMP_MIB,
3313 HostCmd_ACT_GEN_GET, FRAG_THRESH_I, &thr, true);
f862bfd1 3314 wiphy->frag_threshold = thr;
fa0ecbb9
BZ		 3315 mwifiex_send_cmd(priv, HostCmd_CMD_802_11_SNMP_MIB,
3316 HostCmd_ACT_GEN_GET, RTS_THRESH_I, &thr, true);
f862bfd1 3317 wiphy->rts_threshold = thr;
fa0ecbb9
BZ		 3318 mwifiex_send_cmd(priv, HostCmd_CMD_802_11_SNMP_MIB,
3319 HostCmd_ACT_GEN_GET, SHORT_RETRY_LIM_I, &retry, true);
f862bfd1 3320 wiphy->retry_short = (u8) retry;
fa0ecbb9
BZ		 3321 mwifiex_send_cmd(priv, HostCmd_CMD_802_11_SNMP_MIB,
3322 HostCmd_ACT_GEN_GET, LONG_RETRY_LIM_I, &retry, true);
f862bfd1
UR		 3323 wiphy->retry_long = (u8) retry;
3324
d6bffe8b 3325 adapter->wiphy = wiphy;
5e6e3a92
BZ		 3326 return ret;
3327}
Linux kernel - Deliverables
This page took 0.624844 seconds and 5 git commands to generate.