mwifiex: return success in set_default_key for WPA/WPA2
[deliverable/linux.git] / drivers / net / wireless / mwifiex / cfg80211.c
CommitLineData
5e6e3a92
BZ
1/*
2 * Marvell Wireless LAN device driver: CFG80211
3 *
4 * Copyright (C) 2011, Marvell International Ltd.
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
23/*
24 * This function maps the nl802.11 channel type into driver channel type.
25 *
26 * The mapping is as follows -
27 * NL80211_CHAN_NO_HT -> NO_SEC_CHANNEL
28 * NL80211_CHAN_HT20 -> NO_SEC_CHANNEL
29 * NL80211_CHAN_HT40PLUS -> SEC_CHANNEL_ABOVE
30 * NL80211_CHAN_HT40MINUS -> SEC_CHANNEL_BELOW
31 * Others -> NO_SEC_CHANNEL
32 */
33static int
34mwifiex_cfg80211_channel_type_to_mwifiex_channels(enum nl80211_channel_type
35 channel_type)
36{
37 int channel;
38 switch (channel_type) {
39 case NL80211_CHAN_NO_HT:
40 case NL80211_CHAN_HT20:
41 channel = NO_SEC_CHANNEL;
42 break;
43 case NL80211_CHAN_HT40PLUS:
44 channel = SEC_CHANNEL_ABOVE;
45 break;
46 case NL80211_CHAN_HT40MINUS:
47 channel = SEC_CHANNEL_BELOW;
48 break;
49 default:
50 channel = NO_SEC_CHANNEL;
51 }
52 return channel;
53}
54
55/*
56 * This function maps the driver channel type into nl802.11 channel type.
57 *
58 * The mapping is as follows -
59 * NO_SEC_CHANNEL -> NL80211_CHAN_HT20
60 * SEC_CHANNEL_ABOVE -> NL80211_CHAN_HT40PLUS
61 * SEC_CHANNEL_BELOW -> NL80211_CHAN_HT40MINUS
62 * Others -> NL80211_CHAN_HT20
63 */
64static enum nl80211_channel_type
65mwifiex_channels_to_cfg80211_channel_type(int channel_type)
66{
67 int channel;
68 switch (channel_type) {
69 case NO_SEC_CHANNEL:
70 channel = NL80211_CHAN_HT20;
71 break;
72 case SEC_CHANNEL_ABOVE:
73 channel = NL80211_CHAN_HT40PLUS;
74 break;
75 case SEC_CHANNEL_BELOW:
76 channel = NL80211_CHAN_HT40MINUS;
77 break;
78 default:
79 channel = NL80211_CHAN_HT20;
80 }
81 return channel;
82}
83
84/*
85 * This function checks whether WEP is set.
86 */
87static int
88mwifiex_is_alg_wep(u32 cipher)
89{
90 int alg = 0;
91
92 switch (cipher) {
93 case MWIFIEX_ENCRYPTION_MODE_WEP40:
94 case MWIFIEX_ENCRYPTION_MODE_WEP104:
95 alg = 1;
96 break;
97 default:
98 alg = 0;
99 break;
100 }
101 return alg;
102}
103
104/*
105 * This function maps the given cipher type into driver specific type.
106 *
107 * It also sets a flag to indicate whether WPA is enabled or not.
108 *
109 * The mapping table is -
110 * Input cipher Driver cipher type WPA enabled?
111 * ------------ ------------------ ------------
112 * IW_AUTH_CIPHER_NONE MWIFIEX_ENCRYPTION_MODE_NONE No
113 * WLAN_CIPHER_SUITE_WEP40 MWIFIEX_ENCRYPTION_MODE_WEP40 No
114 * WLAN_CIPHER_SUITE_WEP104 MWIFIEX_ENCRYPTION_MODE_WEP104 No
115 * WLAN_CIPHER_SUITE_TKIP MWIFIEX_ENCRYPTION_MODE_TKIP Yes
116 * WLAN_CIPHER_SUITE_CCMP MWIFIEX_ENCRYPTION_MODE_CCMP Yes
117 * Others -1 No
118 */
119static int
120mwifiex_get_mwifiex_cipher(u32 cipher, int *wpa_enabled)
121{
122 int encrypt_mode;
123
124 if (wpa_enabled)
125 *wpa_enabled = 0;
126 switch (cipher) {
127 case IW_AUTH_CIPHER_NONE:
128 encrypt_mode = MWIFIEX_ENCRYPTION_MODE_NONE;
129 break;
130 case WLAN_CIPHER_SUITE_WEP40:
131 encrypt_mode = MWIFIEX_ENCRYPTION_MODE_WEP40;
132 break;
133 case WLAN_CIPHER_SUITE_WEP104:
134 encrypt_mode = MWIFIEX_ENCRYPTION_MODE_WEP104;
135 break;
136 case WLAN_CIPHER_SUITE_TKIP:
137 encrypt_mode = MWIFIEX_ENCRYPTION_MODE_TKIP;
138 if (wpa_enabled)
139 *wpa_enabled = 1;
140 break;
141 case WLAN_CIPHER_SUITE_CCMP:
142 encrypt_mode = MWIFIEX_ENCRYPTION_MODE_CCMP;
143 if (wpa_enabled)
144 *wpa_enabled = 1;
145 break;
146 default:
147 encrypt_mode = -1;
148 }
149
150 return encrypt_mode;
151}
152
153/*
154 * This function retrieves the private structure from kernel wiphy structure.
155 */
156static void *mwifiex_cfg80211_get_priv(struct wiphy *wiphy)
157{
158 return (void *) (*(unsigned long *) wiphy_priv(wiphy));
159}
160
161/*
162 * CFG802.11 operation handler to delete a network key.
163 */
164static int
165mwifiex_cfg80211_del_key(struct wiphy *wiphy, struct net_device *netdev,
166 u8 key_index, bool pairwise, const u8 *mac_addr)
167{
168 struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
169 int ret = 0;
170
171 ret = mwifiex_set_encode(priv, NULL, 0, key_index, 1);
172 if (ret) {
173 wiphy_err(wiphy, "deleting the crypto keys\n");
174 return -EFAULT;
175 }
176
177 wiphy_dbg(wiphy, "info: crypto keys deleted\n");
178 return 0;
179}
180
181/*
182 * CFG802.11 operation handler to set Tx power.
183 */
184static int
185mwifiex_cfg80211_set_tx_power(struct wiphy *wiphy,
186 enum nl80211_tx_power_setting type,
187 int dbm)
188{
189 int ret = 0;
190 struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
191
192 ret = mwifiex_set_tx_power(priv, type, dbm);
193
194 return ret;
195}
196
197/*
198 * CFG802.11 operation handler to set Power Save option.
199 *
200 * The timeout value, if provided, is currently ignored.
201 */
202static int
203mwifiex_cfg80211_set_power_mgmt(struct wiphy *wiphy,
204 struct net_device *dev,
205 bool enabled, int timeout)
206{
207 int ret = 0;
208 struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
209
210 if (timeout)
211 wiphy_dbg(wiphy,
212 "info: ignoring the timeout value"
213 " for IEEE power save\n");
214
215 ret = mwifiex_drv_set_power(priv, enabled);
216
217 return ret;
218}
219
220/*
221 * CFG802.11 operation handler to set the default network key.
222 */
223static int
224mwifiex_cfg80211_set_default_key(struct wiphy *wiphy, struct net_device *netdev,
225 u8 key_index, bool unicast,
226 bool multicast)
227{
228 struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
229 int ret;
230
2d3d0a88
AK
231 /* Return if WEP key not configured */
232 if (priv->sec_info.wep_status == MWIFIEX_802_11_WEP_DISABLED)
233 return 0;
234
5e6e3a92
BZ
235 ret = mwifiex_set_encode(priv, NULL, 0, key_index, 0);
236
237 wiphy_dbg(wiphy, "info: set default Tx key index\n");
238
239 if (ret)
240 return -EFAULT;
241
242 return 0;
243}
244
245/*
246 * CFG802.11 operation handler to add a network key.
247 */
248static int
249mwifiex_cfg80211_add_key(struct wiphy *wiphy, struct net_device *netdev,
250 u8 key_index, bool pairwise, const u8 *mac_addr,
251 struct key_params *params)
252{
253 struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
254 int ret = 0;
255 int encrypt_mode;
256
257 encrypt_mode = mwifiex_get_mwifiex_cipher(params->cipher, NULL);
258
259 if (encrypt_mode != -1)
260 ret = mwifiex_set_encode(priv, params->key, params->key_len,
261 key_index, 0);
262
263 wiphy_dbg(wiphy, "info: crypto keys added\n");
264
265 if (ret)
266 return -EFAULT;
267
268 return 0;
269}
270
271/*
272 * This function sends domain information to the firmware.
273 *
274 * The following information are passed to the firmware -
275 * - Country codes
276 * - Sub bands (first channel, number of channels, maximum Tx power)
277 */
278static int mwifiex_send_domain_info_cmd_fw(struct wiphy *wiphy)
279{
280 u8 no_of_triplet = 0;
281 struct ieee80211_country_ie_triplet *t;
282 u8 no_of_parsed_chan = 0;
283 u8 first_chan = 0, next_chan = 0, max_pwr = 0;
284 u8 i, flag = 0;
285 enum ieee80211_band band;
286 struct ieee80211_supported_band *sband;
287 struct ieee80211_channel *ch;
288 struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
289 struct mwifiex_adapter *adapter = priv->adapter;
290 struct mwifiex_802_11d_domain_reg *domain_info = &adapter->domain_reg;
291 int ret = 0;
292
293 /* Set country code */
294 domain_info->country_code[0] = priv->country_code[0];
295 domain_info->country_code[1] = priv->country_code[1];
296 domain_info->country_code[2] = ' ';
297
298 band = mwifiex_band_to_radio_type(adapter->config_bands);
299 if (!wiphy->bands[band]) {
300 wiphy_err(wiphy, "11D: setting domain info in FW\n");
301 return -1;
302 }
303
304 sband = wiphy->bands[band];
305
306 for (i = 0; i < sband->n_channels ; i++) {
307 ch = &sband->channels[i];
308 if (ch->flags & IEEE80211_CHAN_DISABLED)
309 continue;
310
311 if (!flag) {
312 flag = 1;
313 first_chan = (u32) ch->hw_value;
314 next_chan = first_chan;
315 max_pwr = ch->max_power;
316 no_of_parsed_chan = 1;
317 continue;
318 }
319
320 if (ch->hw_value == next_chan + 1 &&
321 ch->max_power == max_pwr) {
322 next_chan++;
323 no_of_parsed_chan++;
324 } else {
325 t = &domain_info->triplet[no_of_triplet];
326 t->chans.first_channel = first_chan;
327 t->chans.num_channels = no_of_parsed_chan;
328 t->chans.max_power = max_pwr;
329 no_of_triplet++;
330 first_chan = (u32) ch->hw_value;
331 next_chan = first_chan;
332 max_pwr = ch->max_power;
333 no_of_parsed_chan = 1;
334 }
335 }
336
337 if (flag) {
338 t = &domain_info->triplet[no_of_triplet];
339 t->chans.first_channel = first_chan;
340 t->chans.num_channels = no_of_parsed_chan;
341 t->chans.max_power = max_pwr;
342 no_of_triplet++;
343 }
344
345 domain_info->no_of_triplet = no_of_triplet;
346 /* Send cmd to FW to set domain info */
347 ret = mwifiex_prepare_cmd(priv, HostCmd_CMD_802_11D_DOMAIN_INFO,
348 HostCmd_ACT_GEN_SET, 0, NULL, NULL);
349 if (ret)
350 wiphy_err(wiphy, "11D: setting domain info in FW\n");
351
352 return ret;
353}
354
355/*
356 * CFG802.11 regulatory domain callback function.
357 *
358 * This function is called when the regulatory domain is changed due to the
359 * following reasons -
360 * - Set by driver
361 * - Set by system core
362 * - Set by user
363 * - Set bt Country IE
364 */
365static int mwifiex_reg_notifier(struct wiphy *wiphy,
366 struct regulatory_request *request)
367{
368 struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
369
370 wiphy_dbg(wiphy, "info: cfg80211 regulatory domain callback for domain"
371 " %c%c\n", request->alpha2[0], request->alpha2[1]);
372
373 memcpy(priv->country_code, request->alpha2, sizeof(request->alpha2));
374
375 switch (request->initiator) {
376 case NL80211_REGDOM_SET_BY_DRIVER:
377 case NL80211_REGDOM_SET_BY_CORE:
378 case NL80211_REGDOM_SET_BY_USER:
379 break;
380 /* Todo: apply driver specific changes in channel flags based
381 on the request initiator if necessary. */
382 case NL80211_REGDOM_SET_BY_COUNTRY_IE:
383 break;
384 }
385 mwifiex_send_domain_info_cmd_fw(wiphy);
386
387 return 0;
388}
389
390/*
391 * This function sets the RF channel.
392 *
393 * This function creates multiple IOCTL requests, populates them accordingly
394 * and issues them to set the band/channel and frequency.
395 */
396static int
397mwifiex_set_rf_channel(struct mwifiex_private *priv,
398 struct ieee80211_channel *chan,
399 enum nl80211_channel_type channel_type)
400{
401 struct mwifiex_chan_freq_power cfp;
402 int ret = 0;
403 int status = 0;
404 struct mwifiex_ds_band_cfg band_cfg;
5e6e3a92
BZ
405 u32 config_bands = 0;
406 struct wiphy *wiphy = priv->wdev->wiphy;
407
5e6e3a92
BZ
408 if (chan) {
409 memset(&band_cfg, 0, sizeof(band_cfg));
410 /* Set appropriate bands */
411 if (chan->band == IEEE80211_BAND_2GHZ)
412 config_bands = BAND_B | BAND_G | BAND_GN;
413 else
414 config_bands = BAND_AN | BAND_A;
eecd8250
BZ
415 if (priv->bss_mode == NL80211_IFTYPE_STATION
416 || priv->bss_mode == NL80211_IFTYPE_UNSPECIFIED) {
5e6e3a92 417 band_cfg.config_bands = config_bands;
eecd8250 418 } else if (priv->bss_mode == NL80211_IFTYPE_ADHOC) {
5e6e3a92
BZ
419 band_cfg.config_bands = config_bands;
420 band_cfg.adhoc_start_band = config_bands;
421 }
422 /* Set channel offset */
423 band_cfg.sec_chan_offset =
424 mwifiex_cfg80211_channel_type_to_mwifiex_channels
425 (channel_type);
426 status = mwifiex_radio_ioctl_band_cfg(priv, HostCmd_ACT_GEN_SET,
427 &band_cfg);
428
429 if (status)
430 return -EFAULT;
431 mwifiex_send_domain_info_cmd_fw(wiphy);
432 }
433
434 wiphy_dbg(wiphy, "info: setting band %d, channel offset %d and "
eecd8250
BZ
435 "mode %d\n", config_bands, band_cfg.sec_chan_offset,
436 priv->bss_mode);
5e6e3a92
BZ
437 if (!chan)
438 return ret;
439
440 memset(&cfp, 0, sizeof(cfp));
441 cfp.freq = chan->center_freq;
442 /* Convert frequency to channel */
443 cfp.channel = ieee80211_frequency_to_channel(chan->center_freq);
444
445 status = mwifiex_bss_ioctl_channel(priv, HostCmd_ACT_GEN_SET, &cfp);
446 if (status)
447 return -EFAULT;
448
449 ret = mwifiex_drv_change_adhoc_chan(priv, cfp.channel);
450
451 return ret;
452}
453
454/*
455 * CFG802.11 operation handler to set channel.
456 *
457 * This function can only be used when station is not connected.
458 */
459static int
460mwifiex_cfg80211_set_channel(struct wiphy *wiphy, struct net_device *dev,
461 struct ieee80211_channel *chan,
462 enum nl80211_channel_type channel_type)
463{
464 struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
465
466 if (priv->media_connected) {
467 wiphy_err(wiphy, "This setting is valid only when station "
468 "is not connected\n");
469 return -EINVAL;
470 }
471
472 return mwifiex_set_rf_channel(priv, chan, channel_type);
473}
474
475/*
476 * This function sets the fragmentation threshold.
477 *
478 * This function creates an IOCTL request, populates it accordingly
479 * and issues an IOCTL.
480 *
481 * The fragmentation threshold value must lies between MWIFIEX_FRAG_MIN_VALUE
482 * and MWIFIEX_FRAG_MAX_VALUE.
483 */
484static int
485mwifiex_set_frag(struct mwifiex_private *priv, u32 frag_thr)
486{
487 int ret = 0;
488 int status = 0;
489 struct mwifiex_wait_queue *wait = NULL;
490 u8 wait_option = MWIFIEX_IOCTL_WAIT;
491
492 if (frag_thr < MWIFIEX_FRAG_MIN_VALUE
493 || frag_thr > MWIFIEX_FRAG_MAX_VALUE)
494 return -EINVAL;
495
496 wait = mwifiex_alloc_fill_wait_queue(priv, wait_option);
497 if (!wait)
498 return -ENOMEM;
499
500 status = mwifiex_snmp_mib_ioctl(priv, wait, FRAG_THRESH_I,
501 HostCmd_ACT_GEN_SET, &frag_thr);
502
503 if (mwifiex_request_ioctl(priv, wait, status, wait_option))
504 ret = -EFAULT;
505
506 kfree(wait);
507 return ret;
508}
509
510/*
511 * This function sets the RTS threshold.
512 *
513 * This function creates an IOCTL request, populates it accordingly
514 * and issues an IOCTL.
515 */
516static int
517mwifiex_set_rts(struct mwifiex_private *priv, u32 rts_thr)
518{
519 int ret = 0;
520 struct mwifiex_wait_queue *wait = NULL;
521 int status = 0;
522 u8 wait_option = MWIFIEX_IOCTL_WAIT;
523
524 if (rts_thr < MWIFIEX_RTS_MIN_VALUE || rts_thr > MWIFIEX_RTS_MAX_VALUE)
525 rts_thr = MWIFIEX_RTS_MAX_VALUE;
526
527 wait = mwifiex_alloc_fill_wait_queue(priv, wait_option);
528 if (!wait)
529 return -ENOMEM;
530
531 status = mwifiex_snmp_mib_ioctl(priv, wait, RTS_THRESH_I,
532 HostCmd_ACT_GEN_SET, &rts_thr);
533
534 if (mwifiex_request_ioctl(priv, wait, status, wait_option))
535 ret = -EFAULT;
536
537 kfree(wait);
538 return ret;
539}
540
541/*
542 * CFG802.11 operation handler to set wiphy parameters.
543 *
544 * This function can be used to set the RTS threshold and the
545 * Fragmentation threshold of the driver.
546 */
547static int
548mwifiex_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
549{
550 struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
551
552 int ret = 0;
553
554 if (changed & WIPHY_PARAM_RTS_THRESHOLD)
555 ret = mwifiex_set_rts(priv, wiphy->rts_threshold);
556
557 if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
558 ret = mwifiex_set_frag(priv, wiphy->frag_threshold);
559
560 return ret;
561}
562
563/*
564 * CFG802.11 operation handler to change interface type.
5e6e3a92
BZ
565 */
566static int
567mwifiex_cfg80211_change_virtual_intf(struct wiphy *wiphy,
568 struct net_device *dev,
569 enum nl80211_iftype type, u32 *flags,
570 struct vif_params *params)
571{
572 int ret = 0;
573 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
5e6e3a92 574 struct mwifiex_wait_queue *wait = NULL;
5e6e3a92 575
eecd8250
BZ
576 if (priv->bss_mode == type) {
577 wiphy_warn(wiphy, "already set to required type\n");
578 return 0;
579 }
580
581 priv->bss_mode = type;
5e6e3a92
BZ
582
583 switch (type) {
584 case NL80211_IFTYPE_ADHOC:
5e6e3a92
BZ
585 dev->ieee80211_ptr->iftype = NL80211_IFTYPE_ADHOC;
586 wiphy_dbg(wiphy, "info: setting interface type to adhoc\n");
587 break;
588 case NL80211_IFTYPE_STATION:
5e6e3a92 589 dev->ieee80211_ptr->iftype = NL80211_IFTYPE_STATION;
eecd8250 590 wiphy_dbg(wiphy, "info: setting interface type to managed\n");
5e6e3a92
BZ
591 break;
592 case NL80211_IFTYPE_UNSPECIFIED:
5e6e3a92
BZ
593 dev->ieee80211_ptr->iftype = NL80211_IFTYPE_STATION;
594 wiphy_dbg(wiphy, "info: setting interface type to auto\n");
eecd8250 595 return 0;
5e6e3a92 596 default:
eecd8250
BZ
597 wiphy_err(wiphy, "unknown interface type: %d\n", type);
598 return -EINVAL;
5e6e3a92 599 }
5e6e3a92 600
eecd8250
BZ
601 wait = mwifiex_alloc_fill_wait_queue(priv, MWIFIEX_IOCTL_WAIT);
602 if (!wait)
603 return -ENOMEM;
604
605 mwifiex_deauthenticate(priv, wait, NULL);
606
f986b6d5 607 priv->sec_info.authentication_mode = NL80211_AUTHTYPE_OPEN_SYSTEM;
eecd8250
BZ
608
609 ret = mwifiex_prepare_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
610 HostCmd_ACT_GEN_SET, 0, wait, NULL);
611 if (!ret)
612 ret = -EINPROGRESS;
613
614 ret = mwifiex_request_ioctl(priv, wait, ret, MWIFIEX_IOCTL_WAIT);
615 if (ret)
5e6e3a92
BZ
616 ret = -EFAULT;
617
5e6e3a92
BZ
618 kfree(wait);
619 return ret;
620}
621
622/*
623 * This function dumps the station information on a buffer.
624 *
625 * The following information are shown -
626 * - Total bytes transmitted
627 * - Total bytes received
628 * - Total packets transmitted
629 * - Total packets received
630 * - Signal quality level
631 * - Transmission rate
632 */
633static int
634mwifiex_dump_station_info(struct mwifiex_private *priv,
635 struct station_info *sinfo)
636{
637 struct mwifiex_ds_get_signal signal;
638 struct mwifiex_rate_cfg rate;
639 int ret = 0;
640
641 sinfo->filled = STATION_INFO_RX_BYTES | STATION_INFO_TX_BYTES |
642 STATION_INFO_RX_PACKETS |
643 STATION_INFO_TX_PACKETS
644 | STATION_INFO_SIGNAL | STATION_INFO_TX_BITRATE;
645
646 /* Get signal information from the firmware */
647 memset(&signal, 0, sizeof(struct mwifiex_ds_get_signal));
648 if (mwifiex_get_signal_info(priv, MWIFIEX_IOCTL_WAIT, &signal)) {
649 dev_err(priv->adapter->dev, "getting signal information\n");
650 ret = -EFAULT;
651 }
652
653 if (mwifiex_drv_get_data_rate(priv, &rate)) {
654 dev_err(priv->adapter->dev, "getting data rate\n");
655 ret = -EFAULT;
656 }
657
658 sinfo->rx_bytes = priv->stats.rx_bytes;
659 sinfo->tx_bytes = priv->stats.tx_bytes;
660 sinfo->rx_packets = priv->stats.rx_packets;
661 sinfo->tx_packets = priv->stats.tx_packets;
662 sinfo->signal = priv->w_stats.qual.level;
663 sinfo->txrate.legacy = rate.rate;
664
665 return ret;
666}
667
668/*
669 * CFG802.11 operation handler to get station information.
670 *
671 * This function only works in connected mode, and dumps the
672 * requested station information, if available.
673 */
674static int
675mwifiex_cfg80211_get_station(struct wiphy *wiphy, struct net_device *dev,
676 u8 *mac, struct station_info *sinfo)
677{
678 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
679 int ret = 0;
680
681 mwifiex_dump_station_info(priv, sinfo);
682
683 if (!priv->media_connected)
684 return -ENOENT;
685 if (memcmp(mac, priv->cfg_bssid, ETH_ALEN))
686 return -ENOENT;
687
688
689 ret = mwifiex_dump_station_info(priv, sinfo);
690
691 return ret;
692}
693
694/* Supported rates to be advertised to the cfg80211 */
695
696static struct ieee80211_rate mwifiex_rates[] = {
697 {.bitrate = 10, .hw_value = 2, },
698 {.bitrate = 20, .hw_value = 4, },
699 {.bitrate = 55, .hw_value = 11, },
700 {.bitrate = 110, .hw_value = 22, },
701 {.bitrate = 220, .hw_value = 44, },
702 {.bitrate = 60, .hw_value = 12, },
703 {.bitrate = 90, .hw_value = 18, },
704 {.bitrate = 120, .hw_value = 24, },
705 {.bitrate = 180, .hw_value = 36, },
706 {.bitrate = 240, .hw_value = 48, },
707 {.bitrate = 360, .hw_value = 72, },
708 {.bitrate = 480, .hw_value = 96, },
709 {.bitrate = 540, .hw_value = 108, },
710 {.bitrate = 720, .hw_value = 144, },
711};
712
713/* Channel definitions to be advertised to cfg80211 */
714
715static struct ieee80211_channel mwifiex_channels_2ghz[] = {
716 {.center_freq = 2412, .hw_value = 1, },
717 {.center_freq = 2417, .hw_value = 2, },
718 {.center_freq = 2422, .hw_value = 3, },
719 {.center_freq = 2427, .hw_value = 4, },
720 {.center_freq = 2432, .hw_value = 5, },
721 {.center_freq = 2437, .hw_value = 6, },
722 {.center_freq = 2442, .hw_value = 7, },
723 {.center_freq = 2447, .hw_value = 8, },
724 {.center_freq = 2452, .hw_value = 9, },
725 {.center_freq = 2457, .hw_value = 10, },
726 {.center_freq = 2462, .hw_value = 11, },
727 {.center_freq = 2467, .hw_value = 12, },
728 {.center_freq = 2472, .hw_value = 13, },
729 {.center_freq = 2484, .hw_value = 14, },
730};
731
732static struct ieee80211_supported_band mwifiex_band_2ghz = {
733 .channels = mwifiex_channels_2ghz,
734 .n_channels = ARRAY_SIZE(mwifiex_channels_2ghz),
735 .bitrates = mwifiex_rates,
736 .n_bitrates = 14,
737};
738
739static struct ieee80211_channel mwifiex_channels_5ghz[] = {
740 {.center_freq = 5040, .hw_value = 8, },
741 {.center_freq = 5060, .hw_value = 12, },
742 {.center_freq = 5080, .hw_value = 16, },
743 {.center_freq = 5170, .hw_value = 34, },
744 {.center_freq = 5190, .hw_value = 38, },
745 {.center_freq = 5210, .hw_value = 42, },
746 {.center_freq = 5230, .hw_value = 46, },
747 {.center_freq = 5180, .hw_value = 36, },
748 {.center_freq = 5200, .hw_value = 40, },
749 {.center_freq = 5220, .hw_value = 44, },
750 {.center_freq = 5240, .hw_value = 48, },
751 {.center_freq = 5260, .hw_value = 52, },
752 {.center_freq = 5280, .hw_value = 56, },
753 {.center_freq = 5300, .hw_value = 60, },
754 {.center_freq = 5320, .hw_value = 64, },
755 {.center_freq = 5500, .hw_value = 100, },
756 {.center_freq = 5520, .hw_value = 104, },
757 {.center_freq = 5540, .hw_value = 108, },
758 {.center_freq = 5560, .hw_value = 112, },
759 {.center_freq = 5580, .hw_value = 116, },
760 {.center_freq = 5600, .hw_value = 120, },
761 {.center_freq = 5620, .hw_value = 124, },
762 {.center_freq = 5640, .hw_value = 128, },
763 {.center_freq = 5660, .hw_value = 132, },
764 {.center_freq = 5680, .hw_value = 136, },
765 {.center_freq = 5700, .hw_value = 140, },
766 {.center_freq = 5745, .hw_value = 149, },
767 {.center_freq = 5765, .hw_value = 153, },
768 {.center_freq = 5785, .hw_value = 157, },
769 {.center_freq = 5805, .hw_value = 161, },
770 {.center_freq = 5825, .hw_value = 165, },
771};
772
773static struct ieee80211_supported_band mwifiex_band_5ghz = {
774 .channels = mwifiex_channels_5ghz,
775 .n_channels = ARRAY_SIZE(mwifiex_channels_5ghz),
776 .bitrates = mwifiex_rates - 4,
777 .n_bitrates = ARRAY_SIZE(mwifiex_rates) + 4,
778};
779
780
781/* Supported crypto cipher suits to be advertised to cfg80211 */
782
783static const u32 mwifiex_cipher_suites[] = {
784 WLAN_CIPHER_SUITE_WEP40,
785 WLAN_CIPHER_SUITE_WEP104,
786 WLAN_CIPHER_SUITE_TKIP,
787 WLAN_CIPHER_SUITE_CCMP,
788};
789
790/*
791 * CFG802.11 operation handler for disconnection request.
792 *
793 * This function does not work when there is already a disconnection
794 * procedure going on.
795 */
796static int
797mwifiex_cfg80211_disconnect(struct wiphy *wiphy, struct net_device *dev,
798 u16 reason_code)
799{
800 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
801
802 if (priv->disconnect)
803 return -EBUSY;
804
805 priv->disconnect = 1;
806 if (mwifiex_disconnect(priv, MWIFIEX_IOCTL_WAIT, NULL))
807 return -EFAULT;
808
809 wiphy_dbg(wiphy, "info: successfully disconnected from %pM:"
810 " reason code %d\n", priv->cfg_bssid, reason_code);
811
812 queue_work(priv->workqueue, &priv->cfg_workqueue);
813
814 return 0;
815}
816
817/*
818 * This function informs the CFG802.11 subsystem of a new IBSS.
819 *
820 * The following information are sent to the CFG802.11 subsystem
821 * to register the new IBSS. If we do not register the new IBSS,
822 * a kernel panic will result.
823 * - SSID
824 * - SSID length
825 * - BSSID
826 * - Channel
827 */
828static int mwifiex_cfg80211_inform_ibss_bss(struct mwifiex_private *priv)
829{
830 int ret = 0;
831 struct ieee80211_channel *chan;
832 struct mwifiex_bss_info bss_info;
833 int ie_len = 0;
834 u8 ie_buf[IEEE80211_MAX_SSID_LEN + sizeof(struct ieee_types_header)];
835
836 ret = mwifiex_get_bss_info(priv, &bss_info);
837 if (ret)
838 return ret;
839
840 ie_buf[0] = WLAN_EID_SSID;
841 ie_buf[1] = bss_info.ssid.ssid_len;
842
843 memcpy(&ie_buf[sizeof(struct ieee_types_header)],
844 &bss_info.ssid.ssid,
845 bss_info.ssid.ssid_len);
846 ie_len = ie_buf[1] + sizeof(struct ieee_types_header);
847
848 chan = __ieee80211_get_channel(priv->wdev->wiphy,
849 ieee80211_channel_to_frequency(bss_info.bss_chan,
850 priv->curr_bss_params.band));
851
852 cfg80211_inform_bss(priv->wdev->wiphy, chan,
853 bss_info.bssid, 0, WLAN_CAPABILITY_IBSS,
854 0, ie_buf, ie_len, 0, GFP_KERNEL);
855 memcpy(priv->cfg_bssid, bss_info.bssid, ETH_ALEN);
856
857 return ret;
858}
859
860/*
861 * This function informs the CFG802.11 subsystem of a new BSS connection.
862 *
863 * The following information are sent to the CFG802.11 subsystem
864 * to register the new BSS connection. If we do not register the new BSS,
865 * a kernel panic will result.
866 * - MAC address
867 * - Capabilities
868 * - Beacon period
869 * - RSSI value
870 * - Channel
871 * - Supported rates IE
872 * - Extended capabilities IE
873 * - DS parameter set IE
874 * - HT Capability IE
875 * - Vendor Specific IE (221)
876 * - WPA IE
877 * - RSN IE
878 */
879static int mwifiex_inform_bss_from_scan_result(struct mwifiex_private *priv,
880 struct mwifiex_802_11_ssid *ssid)
881{
882 struct mwifiex_scan_resp scan_resp;
883 struct mwifiex_bssdescriptor *scan_table;
884 int i, j;
885 struct ieee80211_channel *chan;
886 u8 *ie, *tmp, *ie_buf;
887 u32 ie_len;
888 u64 ts = 0;
889 u8 *beacon;
890 int beacon_size;
891 u8 element_id, element_len;
892
893 memset(&scan_resp, 0, sizeof(scan_resp));
894 if (mwifiex_get_scan_table(priv, MWIFIEX_IOCTL_WAIT, &scan_resp))
895 return -EFAULT;
896
897#define MAX_IE_BUF 2048
898 ie_buf = kzalloc(MAX_IE_BUF, GFP_KERNEL);
899 if (!ie_buf) {
900 dev_err(priv->adapter->dev, "%s: failed to alloc ie_buf\n",
901 __func__);
902 return -ENOMEM;
903 }
904
905 scan_table = (struct mwifiex_bssdescriptor *) scan_resp.scan_table;
906 for (i = 0; i < scan_resp.num_in_scan_table; i++) {
907 if (ssid) {
908 /* Inform specific BSS only */
909 if (memcmp(ssid->ssid, scan_table[i].ssid.ssid,
910 ssid->ssid_len))
911 continue;
912 }
913 memset(ie_buf, 0, MAX_IE_BUF);
914 ie_buf[0] = WLAN_EID_SSID;
915 ie_buf[1] = scan_table[i].ssid.ssid_len;
916 memcpy(&ie_buf[sizeof(struct ieee_types_header)],
917 scan_table[i].ssid.ssid, ie_buf[1]);
918
919 ie = ie_buf + ie_buf[1] + sizeof(struct ieee_types_header);
920 ie_len = ie_buf[1] + sizeof(struct ieee_types_header);
921
922 ie[0] = WLAN_EID_SUPP_RATES;
923
924 for (j = 0; j < sizeof(scan_table[i].supported_rates); j++) {
925 if (!scan_table[i].supported_rates[j])
926 break;
927 else
928 ie[j + sizeof(struct ieee_types_header)] =
929 scan_table[i].supported_rates[j];
930 }
931
932 ie[1] = j;
933 ie_len += ie[1] + sizeof(struct ieee_types_header);
934
935 beacon = scan_table[i].beacon_buf;
936 beacon_size = scan_table[i].beacon_buf_size;
937
938 /* Skip time stamp, beacon interval and capability */
939
940 if (beacon) {
941 beacon += sizeof(scan_table[i].beacon_period)
942 + sizeof(scan_table[i].time_stamp) +
943 +sizeof(scan_table[i].cap_info_bitmap);
944
945 beacon_size -= sizeof(scan_table[i].beacon_period)
946 + sizeof(scan_table[i].time_stamp)
947 + sizeof(scan_table[i].cap_info_bitmap);
948 }
949
950 while (beacon_size >= sizeof(struct ieee_types_header)) {
951 ie = ie_buf + ie_len;
952 element_id = *beacon;
953 element_len = *(beacon + 1);
954 if (beacon_size < (int) element_len +
955 sizeof(struct ieee_types_header)) {
956 dev_err(priv->adapter->dev, "%s: in processing"
957 " IE, bytes left < IE length\n",
958 __func__);
959 break;
960 }
961 switch (element_id) {
962 case WLAN_EID_EXT_CAPABILITY:
963 case WLAN_EID_DS_PARAMS:
964 case WLAN_EID_HT_CAPABILITY:
965 case WLAN_EID_VENDOR_SPECIFIC:
966 case WLAN_EID_RSN:
967 case WLAN_EID_BSS_AC_ACCESS_DELAY:
968 ie[0] = element_id;
969 ie[1] = element_len;
970 tmp = (u8 *) beacon;
971 memcpy(&ie[sizeof(struct ieee_types_header)],
972 tmp + sizeof(struct ieee_types_header),
973 element_len);
974 ie_len += ie[1] +
975 sizeof(struct ieee_types_header);
976 break;
977 default:
978 break;
979 }
980 beacon += element_len +
981 sizeof(struct ieee_types_header);
982 beacon_size -= element_len +
983 sizeof(struct ieee_types_header);
984 }
985 chan = ieee80211_get_channel(priv->wdev->wiphy,
986 scan_table[i].freq);
987 cfg80211_inform_bss(priv->wdev->wiphy, chan,
988 scan_table[i].mac_address,
989 ts, scan_table[i].cap_info_bitmap,
990 scan_table[i].beacon_period,
991 ie_buf, ie_len,
992 scan_table[i].rssi, GFP_KERNEL);
993 }
994
995 kfree(ie_buf);
996 return 0;
997}
998
999/*
1000 * This function connects with a BSS.
1001 *
1002 * This function handles both Infra and Ad-Hoc modes. It also performs
1003 * validity checking on the provided parameters, disconnects from the
1004 * current BSS (if any), sets up the association/scan parameters,
1005 * including security settings, and performs specific SSID scan before
1006 * trying to connect.
1007 *
1008 * For Infra mode, the function returns failure if the specified SSID
1009 * is not found in scan table. However, for Ad-Hoc mode, it can create
1010 * the IBSS if it does not exist. On successful completion in either case,
1011 * the function notifies the CFG802.11 subsystem of the new BSS connection,
1012 * otherwise the kernel will panic.
1013 */
1014static int
1015mwifiex_cfg80211_assoc(struct mwifiex_private *priv, size_t ssid_len, u8 *ssid,
1016 u8 *bssid, int mode, struct ieee80211_channel *channel,
1017 struct cfg80211_connect_params *sme, bool privacy)
1018{
1019 struct mwifiex_802_11_ssid req_ssid;
1020 struct mwifiex_ssid_bssid ssid_bssid;
1021 int ret = 0;
1022 int auth_type = 0, pairwise_encrypt_mode = 0, wpa_enabled = 0;
1023 int group_encrypt_mode = 0;
1024 int alg_is_wep = 0;
1025
1026 memset(&req_ssid, 0, sizeof(struct mwifiex_802_11_ssid));
1027 memset(&ssid_bssid, 0, sizeof(struct mwifiex_ssid_bssid));
1028
1029 req_ssid.ssid_len = ssid_len;
1030 if (ssid_len > IEEE80211_MAX_SSID_LEN) {
1031 dev_err(priv->adapter->dev, "invalid SSID - aborting\n");
1032 return -EINVAL;
1033 }
1034
1035 memcpy(req_ssid.ssid, ssid, ssid_len);
1036 if (!req_ssid.ssid_len || req_ssid.ssid[0] < 0x20) {
1037 dev_err(priv->adapter->dev, "invalid SSID - aborting\n");
1038 return -EINVAL;
1039 }
1040
1041 /* disconnect before try to associate */
1042 mwifiex_disconnect(priv, MWIFIEX_IOCTL_WAIT, NULL);
1043
1044 if (channel)
1045 ret = mwifiex_set_rf_channel(priv, channel,
1046 mwifiex_channels_to_cfg80211_channel_type
1047 (priv->adapter->chan_offset));
1048
1049 ret = mwifiex_set_encode(priv, NULL, 0, 0, 1); /* Disable keys */
1050
eecd8250 1051 if (mode == NL80211_IFTYPE_ADHOC) {
5e6e3a92
BZ
1052 /* "privacy" is set only for ad-hoc mode */
1053 if (privacy) {
1054 /*
1055 * Keep MWIFIEX_ENCRYPTION_MODE_WEP104 for now so that
1056 * the firmware can find a matching network from the
1057 * scan. The cfg80211 does not give us the encryption
1058 * mode at this stage so just setting it to WEP here.
1059 */
203afeca
MY
1060 priv->sec_info.encryption_mode =
1061 MWIFIEX_ENCRYPTION_MODE_WEP104;
1062 priv->sec_info.authentication_mode =
f986b6d5 1063 NL80211_AUTHTYPE_OPEN_SYSTEM;
5e6e3a92
BZ
1064 }
1065
1066 goto done;
1067 }
1068
1069 /* Now handle infra mode. "sme" is valid for infra mode only */
1070 if (sme->auth_type == NL80211_AUTHTYPE_AUTOMATIC
1071 || sme->auth_type == NL80211_AUTHTYPE_OPEN_SYSTEM)
f986b6d5 1072 auth_type = NL80211_AUTHTYPE_OPEN_SYSTEM;
5e6e3a92 1073 else if (sme->auth_type == NL80211_AUTHTYPE_SHARED_KEY)
f986b6d5 1074 auth_type = NL80211_AUTHTYPE_SHARED_KEY;
5e6e3a92
BZ
1075
1076 if (sme->crypto.n_ciphers_pairwise) {
1077 pairwise_encrypt_mode = mwifiex_get_mwifiex_cipher(sme->crypto.
1078 ciphers_pairwise[0], &wpa_enabled);
203afeca
MY
1079 priv->sec_info.encryption_mode = pairwise_encrypt_mode;
1080 priv->sec_info.authentication_mode = auth_type;
5e6e3a92
BZ
1081 }
1082
1083 if (sme->crypto.cipher_group) {
1084 group_encrypt_mode = mwifiex_get_mwifiex_cipher(sme->crypto.
1085 cipher_group, &wpa_enabled);
203afeca
MY
1086 priv->sec_info.encryption_mode = group_encrypt_mode;
1087 priv->sec_info.authentication_mode = auth_type;
5e6e3a92
BZ
1088 }
1089 if (sme->ie)
1090 ret = mwifiex_set_gen_ie(priv, sme->ie, sme->ie_len);
1091
1092 if (sme->key) {
1093 alg_is_wep = mwifiex_is_alg_wep(pairwise_encrypt_mode)
1094 | mwifiex_is_alg_wep(group_encrypt_mode);
1095 if (alg_is_wep) {
1096 dev_dbg(priv->adapter->dev,
1097 "info: setting wep encryption"
1098 " with key len %d\n", sme->key_len);
1099 ret = mwifiex_set_encode(priv, sme->key, sme->key_len,
1100 sme->key_idx, 0);
1101 }
1102 }
1103done:
1104 /* Do specific SSID scanning */
1105 if (mwifiex_request_scan(priv, MWIFIEX_IOCTL_WAIT, &req_ssid)) {
1106 dev_err(priv->adapter->dev, "scan error\n");
1107 return -EFAULT;
1108 }
1109
1110
1111 memcpy(&ssid_bssid.ssid, &req_ssid, sizeof(struct mwifiex_802_11_ssid));
1112
eecd8250 1113 if (mode != NL80211_IFTYPE_ADHOC) {
5e6e3a92
BZ
1114 if (mwifiex_find_best_bss(priv, MWIFIEX_IOCTL_WAIT,
1115 &ssid_bssid))
1116 return -EFAULT;
1117 /* Inform the BSS information to kernel, otherwise
1118 * kernel will give a panic after successful assoc */
1119 if (mwifiex_inform_bss_from_scan_result(priv, &req_ssid))
1120 return -EFAULT;
1121 }
1122
1123 dev_dbg(priv->adapter->dev, "info: trying to associate to %s and bssid %pM\n",
1124 (char *) req_ssid.ssid, ssid_bssid.bssid);
1125
1126 memcpy(&priv->cfg_bssid, ssid_bssid.bssid, 6);
1127
1128 /* Connect to BSS by ESSID */
1129 memset(&ssid_bssid.bssid, 0, ETH_ALEN);
1130
1131 if (mwifiex_bss_start(priv, MWIFIEX_IOCTL_WAIT, &ssid_bssid))
1132 return -EFAULT;
1133
eecd8250 1134 if (mode == NL80211_IFTYPE_ADHOC) {
5e6e3a92
BZ
1135 /* Inform the BSS information to kernel, otherwise
1136 * kernel will give a panic after successful assoc */
1137 if (mwifiex_cfg80211_inform_ibss_bss(priv))
1138 return -EFAULT;
1139 }
1140
1141 return ret;
1142}
1143
1144/*
1145 * CFG802.11 operation handler for association request.
1146 *
1147 * This function does not work when the current mode is set to Ad-Hoc, or
1148 * when there is already an association procedure going on. The given BSS
1149 * information is used to associate.
1150 */
1151static int
1152mwifiex_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev,
1153 struct cfg80211_connect_params *sme)
1154{
1155 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1156 int ret = 0;
5e6e3a92
BZ
1157
1158 if (priv->assoc_request)
1159 return -EBUSY;
1160
eecd8250 1161 if (priv->bss_mode == NL80211_IFTYPE_ADHOC) {
5e6e3a92
BZ
1162 wiphy_err(wiphy, "received infra assoc request "
1163 "when station is in ibss mode\n");
1164 goto done;
1165 }
1166
1167 priv->assoc_request = 1;
1168
1169 wiphy_dbg(wiphy, "info: Trying to associate to %s and bssid %pM\n",
1170 (char *) sme->ssid, sme->bssid);
1171
1172 ret = mwifiex_cfg80211_assoc(priv, sme->ssid_len, sme->ssid, sme->bssid,
eecd8250 1173 priv->bss_mode, sme->channel, sme, 0);
5e6e3a92
BZ
1174
1175done:
1176 priv->assoc_result = ret;
1177 queue_work(priv->workqueue, &priv->cfg_workqueue);
1178 return ret;
1179}
1180
1181/*
1182 * CFG802.11 operation handler to join an IBSS.
1183 *
1184 * This function does not work in any mode other than Ad-Hoc, or if
1185 * a join operation is already in progress.
1186 */
1187static int
1188mwifiex_cfg80211_join_ibss(struct wiphy *wiphy, struct net_device *dev,
1189 struct cfg80211_ibss_params *params)
1190{
1191 struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
1192 int ret = 0;
5e6e3a92
BZ
1193
1194 if (priv->ibss_join_request)
1195 return -EBUSY;
1196
eecd8250 1197 if (priv->bss_mode != NL80211_IFTYPE_ADHOC) {
5e6e3a92
BZ
1198 wiphy_err(wiphy, "request to join ibss received "
1199 "when station is not in ibss mode\n");
1200 goto done;
1201 }
1202
1203 priv->ibss_join_request = 1;
1204
1205 wiphy_dbg(wiphy, "info: trying to join to %s and bssid %pM\n",
1206 (char *) params->ssid, params->bssid);
1207
1208 ret = mwifiex_cfg80211_assoc(priv, params->ssid_len, params->ssid,
eecd8250
BZ
1209 params->bssid, priv->bss_mode,
1210 params->channel, NULL, params->privacy);
5e6e3a92
BZ
1211done:
1212 priv->ibss_join_result = ret;
1213 queue_work(priv->workqueue, &priv->cfg_workqueue);
1214 return ret;
1215}
1216
1217/*
1218 * CFG802.11 operation handler to leave an IBSS.
1219 *
1220 * This function does not work if a leave operation is
1221 * already in progress.
1222 */
1223static int
1224mwifiex_cfg80211_leave_ibss(struct wiphy *wiphy, struct net_device *dev)
1225{
1226 struct mwifiex_private *priv = mwifiex_cfg80211_get_priv(wiphy);
1227
1228 if (priv->disconnect)
1229 return -EBUSY;
1230
1231 priv->disconnect = 1;
1232
1233 wiphy_dbg(wiphy, "info: disconnecting from essid %pM\n",
1234 priv->cfg_bssid);
1235 if (mwifiex_disconnect(priv, MWIFIEX_IOCTL_WAIT, NULL))
1236 return -EFAULT;
1237
1238 queue_work(priv->workqueue, &priv->cfg_workqueue);
1239
1240 return 0;
1241}
1242
1243/*
1244 * CFG802.11 operation handler for scan request.
1245 *
1246 * This function issues a scan request to the firmware based upon
1247 * the user specified scan configuration. On successfull completion,
1248 * it also informs the results.
1249 */
1250static int
1251mwifiex_cfg80211_scan(struct wiphy *wiphy, struct net_device *dev,
1252 struct cfg80211_scan_request *request)
1253{
1254 struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
1255
1256 wiphy_dbg(wiphy, "info: received scan request on %s\n", dev->name);
1257
1258 if (priv->scan_request && priv->scan_request != request)
1259 return -EBUSY;
1260
1261 priv->scan_request = request;
1262
1263 queue_work(priv->workqueue, &priv->cfg_workqueue);
1264 return 0;
1265}
1266
1267/*
1268 * This function sets up the CFG802.11 specific HT capability fields
1269 * with default values.
1270 *
1271 * The following default values are set -
1272 * - HT Supported = True
1273 * - Maximum AMPDU length factor = 0x3
1274 * - Minimum AMPDU spacing = 0x6
1275 * - HT Capabilities map = IEEE80211_HT_CAP_SUP_WIDTH_20_40 (0x0002)
1276 * - MCS information, Rx mask = 0xff
1277 * - MCD information, Tx parameters = IEEE80211_HT_MCS_TX_DEFINED (0x01)
1278 */
1279static void
1280mwifiex_setup_ht_caps(struct ieee80211_sta_ht_cap *ht_info,
1281 struct mwifiex_private *priv)
1282{
1283 int rx_mcs_supp;
1284 struct ieee80211_mcs_info mcs_set;
1285 u8 *mcs = (u8 *)&mcs_set;
1286 struct mwifiex_adapter *adapter = priv->adapter;
1287
1288 ht_info->ht_supported = true;
1289 ht_info->ampdu_factor = 0x3;
1290 ht_info->ampdu_density = 0x6;
1291
1292 memset(&ht_info->mcs, 0, sizeof(ht_info->mcs));
1293 ht_info->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40;
1294
1295 rx_mcs_supp = GET_RXMCSSUPP(priv->adapter->hw_dev_mcs_support);
1296 /* Set MCS for 1x1 */
1297 memset(mcs, 0xff, rx_mcs_supp);
1298 /* Clear all the other values */
1299 memset(&mcs[rx_mcs_supp], 0,
1300 sizeof(struct ieee80211_mcs_info) - rx_mcs_supp);
eecd8250 1301 if (priv->bss_mode == NL80211_IFTYPE_STATION ||
6d2bd916 1302 ISSUPP_CHANWIDTH40(adapter->hw_dot_11n_dev_cap))
5e6e3a92
BZ
1303 /* Set MCS32 for infra mode or ad-hoc mode with 40MHz support */
1304 SETHT_MCS32(mcs_set.rx_mask);
1305
1306 memcpy((u8 *) &ht_info->mcs, mcs, sizeof(struct ieee80211_mcs_info));
1307
1308 ht_info->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED;
1309}
1310
1311/* station cfg80211 operations */
1312static struct cfg80211_ops mwifiex_cfg80211_ops = {
1313 .change_virtual_intf = mwifiex_cfg80211_change_virtual_intf,
1314 .scan = mwifiex_cfg80211_scan,
1315 .connect = mwifiex_cfg80211_connect,
1316 .disconnect = mwifiex_cfg80211_disconnect,
1317 .get_station = mwifiex_cfg80211_get_station,
1318 .set_wiphy_params = mwifiex_cfg80211_set_wiphy_params,
1319 .set_channel = mwifiex_cfg80211_set_channel,
1320 .join_ibss = mwifiex_cfg80211_join_ibss,
1321 .leave_ibss = mwifiex_cfg80211_leave_ibss,
1322 .add_key = mwifiex_cfg80211_add_key,
1323 .del_key = mwifiex_cfg80211_del_key,
1324 .set_default_key = mwifiex_cfg80211_set_default_key,
1325 .set_power_mgmt = mwifiex_cfg80211_set_power_mgmt,
1326 .set_tx_power = mwifiex_cfg80211_set_tx_power,
1327};
1328
1329/*
1330 * This function registers the device with CFG802.11 subsystem.
1331 *
1332 * The function creates the wireless device/wiphy, populates it with
1333 * default parameters and handler function pointers, and finally
1334 * registers the device.
1335 */
1336int mwifiex_register_cfg80211(struct net_device *dev, u8 *mac,
1337 struct mwifiex_private *priv)
1338{
1339 int ret = 0;
1340 void *wdev_priv = NULL;
1341 struct wireless_dev *wdev;
1342
1343 wdev = kzalloc(sizeof(struct wireless_dev), GFP_KERNEL);
1344 if (!wdev) {
1345 dev_err(priv->adapter->dev, "%s: allocating wireless device\n",
1346 __func__);
1347 return -ENOMEM;
1348 }
1349 wdev->wiphy =
1350 wiphy_new(&mwifiex_cfg80211_ops,
1351 sizeof(struct mwifiex_private *));
1352 if (!wdev->wiphy)
1353 return -ENOMEM;
1354 wdev->iftype = NL80211_IFTYPE_STATION;
1355 wdev->wiphy->max_scan_ssids = 10;
1356 wdev->wiphy->interface_modes =
1357 BIT(NL80211_IFTYPE_STATION) | BIT(NL80211_IFTYPE_ADHOC);
1358 wdev->wiphy->bands[IEEE80211_BAND_2GHZ] = &mwifiex_band_2ghz;
1359 wdev->wiphy->bands[IEEE80211_BAND_5GHZ] = &mwifiex_band_5ghz;
1360
1361 /* Initialize cipher suits */
1362 wdev->wiphy->cipher_suites = mwifiex_cipher_suites;
1363 wdev->wiphy->n_cipher_suites = ARRAY_SIZE(mwifiex_cipher_suites);
1364
1365 /* Initialize parameters for 2GHz band */
1366
1367 mwifiex_setup_ht_caps(&wdev->wiphy->bands[IEEE80211_BAND_2GHZ]->ht_cap,
1368 priv);
1369 mwifiex_setup_ht_caps(&wdev->wiphy->bands[IEEE80211_BAND_5GHZ]->ht_cap,
1370 priv);
1371
1372 memcpy(wdev->wiphy->perm_addr, mac, 6);
1373 wdev->wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
1374
1375 /* We are using custom domains */
1376 wdev->wiphy->flags |= WIPHY_FLAG_CUSTOM_REGULATORY;
1377
1378 wdev->wiphy->reg_notifier = mwifiex_reg_notifier;
1379
1380 /* Set struct mwifiex_private pointer in wiphy_priv */
1381 wdev_priv = wiphy_priv(wdev->wiphy);
1382
1383 *(unsigned long *) wdev_priv = (unsigned long) priv;
1384
1385 ret = wiphy_register(wdev->wiphy);
1386 if (ret < 0) {
1387 dev_err(priv->adapter->dev, "%s: registering cfg80211 device\n",
1388 __func__);
1389 wiphy_free(wdev->wiphy);
1390 return ret;
1391 } else {
1392 dev_dbg(priv->adapter->dev,
1393 "info: successfully registered wiphy device\n");
1394 }
1395
1396 dev_net_set(dev, wiphy_net(wdev->wiphy));
1397 dev->ieee80211_ptr = wdev;
1398 memcpy(dev->dev_addr, wdev->wiphy->perm_addr, 6);
1399 memcpy(dev->perm_addr, wdev->wiphy->perm_addr, 6);
1400 SET_NETDEV_DEV(dev, wiphy_dev(wdev->wiphy));
1401 priv->wdev = wdev;
1402
1403 dev->flags |= IFF_BROADCAST | IFF_MULTICAST;
1404 dev->watchdog_timeo = MWIFIEX_DEFAULT_WATCHDOG_TIMEOUT;
1405 dev->hard_header_len += MWIFIEX_MIN_DATA_HEADER_LEN;
1406
1407 return ret;
1408}
1409
1410/*
1411 * This function handles the result of different pending network operations.
1412 *
1413 * The following operations are handled and CFG802.11 subsystem is
1414 * notified accordingly -
1415 * - Scan request completion
1416 * - Association request completion
1417 * - IBSS join request completion
1418 * - Disconnect request completion
1419 */
1420void
1421mwifiex_cfg80211_results(struct work_struct *work)
1422{
1423 struct mwifiex_private *priv =
1424 container_of(work, struct mwifiex_private, cfg_workqueue);
1425 struct mwifiex_user_scan_cfg *scan_req;
1426 int ret = 0, i;
1427 struct ieee80211_channel *chan;
1428
1429 if (priv->scan_request) {
1430 scan_req = kzalloc(sizeof(struct mwifiex_user_scan_cfg),
1431 GFP_KERNEL);
1432 if (!scan_req) {
1433 dev_err(priv->adapter->dev, "failed to alloc "
1434 "scan_req\n");
1435 return;
1436 }
1437 for (i = 0; i < priv->scan_request->n_ssids; i++) {
1438 memcpy(scan_req->ssid_list[i].ssid,
1439 priv->scan_request->ssids[i].ssid,
1440 priv->scan_request->ssids[i].ssid_len);
1441 scan_req->ssid_list[i].max_len =
1442 priv->scan_request->ssids[i].ssid_len;
1443 }
1444 for (i = 0; i < priv->scan_request->n_channels; i++) {
1445 chan = priv->scan_request->channels[i];
1446 scan_req->chan_list[i].chan_number = chan->hw_value;
1447 scan_req->chan_list[i].radio_type = chan->band;
1448 if (chan->flags & IEEE80211_CHAN_DISABLED)
1449 scan_req->chan_list[i].scan_type =
1450 MWIFIEX_SCAN_TYPE_PASSIVE;
1451 else
1452 scan_req->chan_list[i].scan_type =
1453 MWIFIEX_SCAN_TYPE_ACTIVE;
1454 scan_req->chan_list[i].scan_time = 0;
1455 }
1456 if (mwifiex_set_user_scan_ioctl(priv, scan_req)) {
1457 ret = -EFAULT;
1458 goto done;
1459 }
1460 if (mwifiex_inform_bss_from_scan_result(priv, NULL))
1461 ret = -EFAULT;
1462done:
1463 priv->scan_result_status = ret;
1464 dev_dbg(priv->adapter->dev, "info: %s: sending scan results\n",
1465 __func__);
1466 cfg80211_scan_done(priv->scan_request,
1467 (priv->scan_result_status < 0));
1468 priv->scan_request = NULL;
1469 kfree(scan_req);
1470 }
1471
1472 if (priv->assoc_request) {
1473 if (!priv->assoc_result) {
1474 cfg80211_connect_result(priv->netdev, priv->cfg_bssid,
1475 NULL, 0, NULL, 0,
1476 WLAN_STATUS_SUCCESS,
1477 GFP_KERNEL);
1478 dev_dbg(priv->adapter->dev,
1479 "info: associated to bssid %pM successfully\n",
1480 priv->cfg_bssid);
1481 } else {
1482 dev_dbg(priv->adapter->dev,
1483 "info: association to bssid %pM failed\n",
1484 priv->cfg_bssid);
1485 memset(priv->cfg_bssid, 0, ETH_ALEN);
1486 }
1487 priv->assoc_request = 0;
1488 priv->assoc_result = 0;
1489 }
1490
1491 if (priv->ibss_join_request) {
1492 if (!priv->ibss_join_result) {
1493 cfg80211_ibss_joined(priv->netdev, priv->cfg_bssid,
1494 GFP_KERNEL);
1495 dev_dbg(priv->adapter->dev,
1496 "info: joined/created adhoc network with bssid"
1497 " %pM successfully\n", priv->cfg_bssid);
1498 } else {
1499 dev_dbg(priv->adapter->dev,
1500 "info: failed creating/joining adhoc network\n");
1501 }
1502 priv->ibss_join_request = 0;
1503 priv->ibss_join_result = 0;
1504 }
1505
1506 if (priv->disconnect) {
1507 memset(priv->cfg_bssid, 0, ETH_ALEN);
1508 priv->disconnect = 0;
1509 }
1510
1511 return;
1512}
This page took 0.086905 seconds and 5 git commands to generate.