2 * Copyright (c) 2010 Broadcom Corporation
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
11 * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
13 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
14 * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 /* Toplevel file. Relies on dhd_linux.c to send commands to the dongle. */
19 #include <linux/kernel.h>
20 #include <linux/etherdevice.h>
21 #include <linux/module.h>
22 #include <linux/vmalloc.h>
23 #include <net/cfg80211.h>
24 #include <net/netlink.h>
26 #include <brcmu_utils.h>
28 #include <brcmu_wifi.h>
31 #include "tracepoint.h"
32 #include "fwil_types.h"
43 #define BRCMF_SCAN_IE_LEN_MAX 2048
44 #define BRCMF_PNO_VERSION 2
45 #define BRCMF_PNO_TIME 30
46 #define BRCMF_PNO_REPEAT 4
47 #define BRCMF_PNO_FREQ_EXPO_MAX 3
48 #define BRCMF_PNO_MAX_PFN_COUNT 16
49 #define BRCMF_PNO_ENABLE_ADAPTSCAN_BIT 6
50 #define BRCMF_PNO_HIDDEN_BIT 2
51 #define BRCMF_PNO_WPA_AUTH_ANY 0xFFFFFFFF
52 #define BRCMF_PNO_SCAN_COMPLETE 1
53 #define BRCMF_PNO_SCAN_INCOMPLETE 0
55 #define WPA_OUI "\x00\x50\xF2" /* WPA OUI */
56 #define WPA_OUI_TYPE 1
57 #define RSN_OUI "\x00\x0F\xAC" /* RSN OUI */
58 #define WME_OUI_TYPE 2
59 #define WPS_OUI_TYPE 4
61 #define VS_IE_FIXED_HDR_LEN 6
62 #define WPA_IE_VERSION_LEN 2
63 #define WPA_IE_MIN_OUI_LEN 4
64 #define WPA_IE_SUITE_COUNT_LEN 2
66 #define WPA_CIPHER_NONE 0 /* None */
67 #define WPA_CIPHER_WEP_40 1 /* WEP (40-bit) */
68 #define WPA_CIPHER_TKIP 2 /* TKIP: default for WPA */
69 #define WPA_CIPHER_AES_CCM 4 /* AES (CCM) */
70 #define WPA_CIPHER_WEP_104 5 /* WEP (104-bit) */
72 #define RSN_AKM_NONE 0 /* None (IBSS) */
73 #define RSN_AKM_UNSPECIFIED 1 /* Over 802.1x */
74 #define RSN_AKM_PSK 2 /* Pre-shared Key */
75 #define RSN_AKM_SHA256_1X 5 /* SHA256, 802.1X */
76 #define RSN_AKM_SHA256_PSK 6 /* SHA256, Pre-shared Key */
77 #define RSN_CAP_LEN 2 /* Length of RSN capabilities */
78 #define RSN_CAP_PTK_REPLAY_CNTR_MASK (BIT(2) | BIT(3))
79 #define RSN_CAP_MFPR_MASK BIT(6)
80 #define RSN_CAP_MFPC_MASK BIT(7)
81 #define RSN_PMKID_COUNT_LEN 2
83 #define VNDR_IE_CMD_LEN 4 /* length of the set command
84 * string :"add", "del" (+ NUL)
86 #define VNDR_IE_COUNT_OFFSET 4
87 #define VNDR_IE_PKTFLAG_OFFSET 8
88 #define VNDR_IE_VSIE_OFFSET 12
89 #define VNDR_IE_HDR_SIZE 12
90 #define VNDR_IE_PARSE_LIMIT 5
92 #define DOT11_MGMT_HDR_LEN 24 /* d11 management header len */
93 #define DOT11_BCN_PRB_FIXED_LEN 12 /* beacon/probe fixed length */
95 #define BRCMF_SCAN_JOIN_ACTIVE_DWELL_TIME_MS 320
96 #define BRCMF_SCAN_JOIN_PASSIVE_DWELL_TIME_MS 400
97 #define BRCMF_SCAN_JOIN_PROBE_INTERVAL_MS 20
99 #define BRCMF_SCAN_CHANNEL_TIME 40
100 #define BRCMF_SCAN_UNASSOC_TIME 40
101 #define BRCMF_SCAN_PASSIVE_TIME 120
103 #define BRCMF_ND_INFO_TIMEOUT msecs_to_jiffies(2000)
105 #define BRCMF_ASSOC_PARAMS_FIXED_SIZE \
106 (sizeof(struct brcmf_assoc_params_le) - sizeof(u16))
108 static bool check_vif_up(struct brcmf_cfg80211_vif
*vif
)
110 if (!test_bit(BRCMF_VIF_STATUS_READY
, &vif
->sme_state
)) {
111 brcmf_dbg(INFO
, "device is not ready : status (%lu)\n",
118 #define RATE_TO_BASE100KBPS(rate) (((rate) * 10) / 2)
119 #define RATETAB_ENT(_rateid, _flags) \
121 .bitrate = RATE_TO_BASE100KBPS(_rateid), \
122 .hw_value = (_rateid), \
126 static struct ieee80211_rate __wl_rates
[] = {
127 RATETAB_ENT(BRCM_RATE_1M
, 0),
128 RATETAB_ENT(BRCM_RATE_2M
, IEEE80211_RATE_SHORT_PREAMBLE
),
129 RATETAB_ENT(BRCM_RATE_5M5
, IEEE80211_RATE_SHORT_PREAMBLE
),
130 RATETAB_ENT(BRCM_RATE_11M
, IEEE80211_RATE_SHORT_PREAMBLE
),
131 RATETAB_ENT(BRCM_RATE_6M
, 0),
132 RATETAB_ENT(BRCM_RATE_9M
, 0),
133 RATETAB_ENT(BRCM_RATE_12M
, 0),
134 RATETAB_ENT(BRCM_RATE_18M
, 0),
135 RATETAB_ENT(BRCM_RATE_24M
, 0),
136 RATETAB_ENT(BRCM_RATE_36M
, 0),
137 RATETAB_ENT(BRCM_RATE_48M
, 0),
138 RATETAB_ENT(BRCM_RATE_54M
, 0),
141 #define wl_g_rates (__wl_rates + 0)
142 #define wl_g_rates_size ARRAY_SIZE(__wl_rates)
143 #define wl_a_rates (__wl_rates + 4)
144 #define wl_a_rates_size (wl_g_rates_size - 4)
146 #define CHAN2G(_channel, _freq) { \
147 .band = NL80211_BAND_2GHZ, \
148 .center_freq = (_freq), \
149 .hw_value = (_channel), \
150 .flags = IEEE80211_CHAN_DISABLED, \
151 .max_antenna_gain = 0, \
155 #define CHAN5G(_channel) { \
156 .band = NL80211_BAND_5GHZ, \
157 .center_freq = 5000 + (5 * (_channel)), \
158 .hw_value = (_channel), \
159 .flags = IEEE80211_CHAN_DISABLED, \
160 .max_antenna_gain = 0, \
164 static struct ieee80211_channel __wl_2ghz_channels
[] = {
165 CHAN2G(1, 2412), CHAN2G(2, 2417), CHAN2G(3, 2422), CHAN2G(4, 2427),
166 CHAN2G(5, 2432), CHAN2G(6, 2437), CHAN2G(7, 2442), CHAN2G(8, 2447),
167 CHAN2G(9, 2452), CHAN2G(10, 2457), CHAN2G(11, 2462), CHAN2G(12, 2467),
168 CHAN2G(13, 2472), CHAN2G(14, 2484)
171 static struct ieee80211_channel __wl_5ghz_channels
[] = {
172 CHAN5G(34), CHAN5G(36), CHAN5G(38), CHAN5G(40), CHAN5G(42),
173 CHAN5G(44), CHAN5G(46), CHAN5G(48), CHAN5G(52), CHAN5G(56),
174 CHAN5G(60), CHAN5G(64), CHAN5G(100), CHAN5G(104), CHAN5G(108),
175 CHAN5G(112), CHAN5G(116), CHAN5G(120), CHAN5G(124), CHAN5G(128),
176 CHAN5G(132), CHAN5G(136), CHAN5G(140), CHAN5G(144), CHAN5G(149),
177 CHAN5G(153), CHAN5G(157), CHAN5G(161), CHAN5G(165)
180 /* Band templates duplicated per wiphy. The channel info
181 * above is added to the band during setup.
183 static const struct ieee80211_supported_band __wl_band_2ghz
= {
184 .band
= NL80211_BAND_2GHZ
,
185 .bitrates
= wl_g_rates
,
186 .n_bitrates
= wl_g_rates_size
,
189 static const struct ieee80211_supported_band __wl_band_5ghz
= {
190 .band
= NL80211_BAND_5GHZ
,
191 .bitrates
= wl_a_rates
,
192 .n_bitrates
= wl_a_rates_size
,
195 /* This is to override regulatory domains defined in cfg80211 module (reg.c)
196 * By default world regulatory domain defined in reg.c puts the flags
197 * NL80211_RRF_NO_IR for 5GHz channels (for * 36..48 and 149..165).
198 * With respect to these flags, wpa_supplicant doesn't * start p2p
199 * operations on 5GHz channels. All the changes in world regulatory
200 * domain are to be done here.
202 static const struct ieee80211_regdomain brcmf_regdom
= {
206 /* IEEE 802.11b/g, channels 1..11 */
207 REG_RULE(2412-10, 2472+10, 40, 6, 20, 0),
209 /* IEEE 802.11 channel 14 - Only JP enables
210 * this and for 802.11b only
212 REG_RULE(2484-10, 2484+10, 20, 6, 20, 0),
213 /* IEEE 802.11a, channel 36..64 */
214 REG_RULE(5150-10, 5350+10, 80, 6, 20, 0),
215 /* IEEE 802.11a, channel 100..165 */
216 REG_RULE(5470-10, 5850+10, 80, 6, 20, 0), }
219 /* Note: brcmf_cipher_suites is an array of int defining which cipher suites
220 * are supported. A pointer to this array and the number of entries is passed
221 * on to upper layers. AES_CMAC defines whether or not the driver supports MFP.
222 * So the cipher suite AES_CMAC has to be the last one in the array, and when
223 * device does not support MFP then the number of suites will be decreased by 1
225 static const u32 brcmf_cipher_suites
[] = {
226 WLAN_CIPHER_SUITE_WEP40
,
227 WLAN_CIPHER_SUITE_WEP104
,
228 WLAN_CIPHER_SUITE_TKIP
,
229 WLAN_CIPHER_SUITE_CCMP
,
230 /* Keep as last entry: */
231 WLAN_CIPHER_SUITE_AES_CMAC
234 /* Vendor specific ie. id = 221, oui and type defines exact ie */
235 struct brcmf_vs_tlv
{
242 struct parsed_vndr_ie_info
{
244 u32 ie_len
; /* total length including id & length field */
245 struct brcmf_vs_tlv vndrie
;
248 struct parsed_vndr_ies
{
250 struct parsed_vndr_ie_info ie_info
[VNDR_IE_PARSE_LIMIT
];
253 static u8
nl80211_band_to_fwil(enum nl80211_band band
)
256 case NL80211_BAND_2GHZ
:
258 case NL80211_BAND_5GHZ
:
267 static u16
chandef_to_chanspec(struct brcmu_d11inf
*d11inf
,
268 struct cfg80211_chan_def
*ch
)
270 struct brcmu_chan ch_inf
;
273 brcmf_dbg(TRACE
, "chandef: control %d center %d width %d\n",
274 ch
->chan
->center_freq
, ch
->center_freq1
, ch
->width
);
275 ch_inf
.chnum
= ieee80211_frequency_to_channel(ch
->center_freq1
);
276 primary_offset
= ch
->chan
->center_freq
- ch
->center_freq1
;
278 case NL80211_CHAN_WIDTH_20
:
279 case NL80211_CHAN_WIDTH_20_NOHT
:
280 ch_inf
.bw
= BRCMU_CHAN_BW_20
;
281 WARN_ON(primary_offset
!= 0);
283 case NL80211_CHAN_WIDTH_40
:
284 ch_inf
.bw
= BRCMU_CHAN_BW_40
;
285 if (primary_offset
> 0)
286 ch_inf
.sb
= BRCMU_CHAN_SB_U
;
288 ch_inf
.sb
= BRCMU_CHAN_SB_L
;
290 case NL80211_CHAN_WIDTH_80
:
291 ch_inf
.bw
= BRCMU_CHAN_BW_80
;
292 if (primary_offset
== -30)
293 ch_inf
.sb
= BRCMU_CHAN_SB_LL
;
294 else if (primary_offset
== -10)
295 ch_inf
.sb
= BRCMU_CHAN_SB_LU
;
296 else if (primary_offset
== 10)
297 ch_inf
.sb
= BRCMU_CHAN_SB_UL
;
299 ch_inf
.sb
= BRCMU_CHAN_SB_UU
;
301 case NL80211_CHAN_WIDTH_80P80
:
302 case NL80211_CHAN_WIDTH_160
:
303 case NL80211_CHAN_WIDTH_5
:
304 case NL80211_CHAN_WIDTH_10
:
308 switch (ch
->chan
->band
) {
309 case NL80211_BAND_2GHZ
:
310 ch_inf
.band
= BRCMU_CHAN_BAND_2G
;
312 case NL80211_BAND_5GHZ
:
313 ch_inf
.band
= BRCMU_CHAN_BAND_5G
;
315 case NL80211_BAND_60GHZ
:
319 d11inf
->encchspec(&ch_inf
);
321 return ch_inf
.chspec
;
324 u16
channel_to_chanspec(struct brcmu_d11inf
*d11inf
,
325 struct ieee80211_channel
*ch
)
327 struct brcmu_chan ch_inf
;
329 ch_inf
.chnum
= ieee80211_frequency_to_channel(ch
->center_freq
);
330 ch_inf
.bw
= BRCMU_CHAN_BW_20
;
331 d11inf
->encchspec(&ch_inf
);
333 return ch_inf
.chspec
;
336 /* Traverse a string of 1-byte tag/1-byte length/variable-length value
337 * triples, returning a pointer to the substring whose first element
340 const struct brcmf_tlv
*
341 brcmf_parse_tlvs(const void *buf
, int buflen
, uint key
)
343 const struct brcmf_tlv
*elt
= buf
;
346 /* find tagged parameter */
347 while (totlen
>= TLV_HDR_LEN
) {
350 /* validate remaining totlen */
351 if ((elt
->id
== key
) && (totlen
>= (len
+ TLV_HDR_LEN
)))
354 elt
= (struct brcmf_tlv
*)((u8
*)elt
+ (len
+ TLV_HDR_LEN
));
355 totlen
-= (len
+ TLV_HDR_LEN
);
361 /* Is any of the tlvs the expected entry? If
362 * not update the tlvs buffer pointer/length.
365 brcmf_tlv_has_ie(const u8
*ie
, const u8
**tlvs
, u32
*tlvs_len
,
366 const u8
*oui
, u32 oui_len
, u8 type
)
368 /* If the contents match the OUI and the type */
369 if (ie
[TLV_LEN_OFF
] >= oui_len
+ 1 &&
370 !memcmp(&ie
[TLV_BODY_OFF
], oui
, oui_len
) &&
371 type
== ie
[TLV_BODY_OFF
+ oui_len
]) {
377 /* point to the next ie */
378 ie
+= ie
[TLV_LEN_OFF
] + TLV_HDR_LEN
;
379 /* calculate the length of the rest of the buffer */
380 *tlvs_len
-= (int)(ie
- *tlvs
);
381 /* update the pointer to the start of the buffer */
387 static struct brcmf_vs_tlv
*
388 brcmf_find_wpaie(const u8
*parse
, u32 len
)
390 const struct brcmf_tlv
*ie
;
392 while ((ie
= brcmf_parse_tlvs(parse
, len
, WLAN_EID_VENDOR_SPECIFIC
))) {
393 if (brcmf_tlv_has_ie((const u8
*)ie
, &parse
, &len
,
394 WPA_OUI
, TLV_OUI_LEN
, WPA_OUI_TYPE
))
395 return (struct brcmf_vs_tlv
*)ie
;
400 static struct brcmf_vs_tlv
*
401 brcmf_find_wpsie(const u8
*parse
, u32 len
)
403 const struct brcmf_tlv
*ie
;
405 while ((ie
= brcmf_parse_tlvs(parse
, len
, WLAN_EID_VENDOR_SPECIFIC
))) {
406 if (brcmf_tlv_has_ie((u8
*)ie
, &parse
, &len
,
407 WPA_OUI
, TLV_OUI_LEN
, WPS_OUI_TYPE
))
408 return (struct brcmf_vs_tlv
*)ie
;
413 static int brcmf_vif_change_validate(struct brcmf_cfg80211_info
*cfg
,
414 struct brcmf_cfg80211_vif
*vif
,
415 enum nl80211_iftype new_type
)
417 int iftype_num
[NUM_NL80211_IFTYPES
];
418 struct brcmf_cfg80211_vif
*pos
;
419 bool check_combos
= false;
422 memset(&iftype_num
[0], 0, sizeof(iftype_num
));
423 list_for_each_entry(pos
, &cfg
->vif_list
, list
)
425 iftype_num
[new_type
]++;
427 /* concurrent interfaces so need check combinations */
429 iftype_num
[pos
->wdev
.iftype
]++;
433 ret
= cfg80211_check_combinations(cfg
->wiphy
, 1, 0, iftype_num
);
438 static int brcmf_vif_add_validate(struct brcmf_cfg80211_info
*cfg
,
439 enum nl80211_iftype new_type
)
441 int iftype_num
[NUM_NL80211_IFTYPES
];
442 struct brcmf_cfg80211_vif
*pos
;
444 memset(&iftype_num
[0], 0, sizeof(iftype_num
));
445 list_for_each_entry(pos
, &cfg
->vif_list
, list
)
446 iftype_num
[pos
->wdev
.iftype
]++;
448 iftype_num
[new_type
]++;
449 return cfg80211_check_combinations(cfg
->wiphy
, 1, 0, iftype_num
);
452 static void convert_key_from_CPU(struct brcmf_wsec_key
*key
,
453 struct brcmf_wsec_key_le
*key_le
)
455 key_le
->index
= cpu_to_le32(key
->index
);
456 key_le
->len
= cpu_to_le32(key
->len
);
457 key_le
->algo
= cpu_to_le32(key
->algo
);
458 key_le
->flags
= cpu_to_le32(key
->flags
);
459 key_le
->rxiv
.hi
= cpu_to_le32(key
->rxiv
.hi
);
460 key_le
->rxiv
.lo
= cpu_to_le16(key
->rxiv
.lo
);
461 key_le
->iv_initialized
= cpu_to_le32(key
->iv_initialized
);
462 memcpy(key_le
->data
, key
->data
, sizeof(key
->data
));
463 memcpy(key_le
->ea
, key
->ea
, sizeof(key
->ea
));
467 send_key_to_dongle(struct brcmf_if
*ifp
, struct brcmf_wsec_key
*key
)
470 struct brcmf_wsec_key_le key_le
;
472 convert_key_from_CPU(key
, &key_le
);
474 brcmf_netdev_wait_pend8021x(ifp
);
476 err
= brcmf_fil_bsscfg_data_set(ifp
, "wsec_key", &key_le
,
480 brcmf_err("wsec_key error (%d)\n", err
);
485 brcmf_configure_arp_nd_offload(struct brcmf_if
*ifp
, bool enable
)
491 mode
= BRCMF_ARP_OL_AGENT
| BRCMF_ARP_OL_PEER_AUTO_REPLY
;
495 /* Try to set and enable ARP offload feature, this may fail, then it */
496 /* is simply not supported and err 0 will be returned */
497 err
= brcmf_fil_iovar_int_set(ifp
, "arp_ol", mode
);
499 brcmf_dbg(TRACE
, "failed to set ARP offload mode to 0x%x, err = %d\n",
503 err
= brcmf_fil_iovar_int_set(ifp
, "arpoe", enable
);
505 brcmf_dbg(TRACE
, "failed to configure (%d) ARP offload err = %d\n",
509 brcmf_dbg(TRACE
, "successfully configured (%d) ARP offload to 0x%x\n",
513 err
= brcmf_fil_iovar_int_set(ifp
, "ndoe", enable
);
515 brcmf_dbg(TRACE
, "failed to configure (%d) ND offload err = %d\n",
519 brcmf_dbg(TRACE
, "successfully configured (%d) ND offload to 0x%x\n",
526 brcmf_cfg80211_update_proto_addr_mode(struct wireless_dev
*wdev
)
528 struct brcmf_cfg80211_vif
*vif
;
529 struct brcmf_if
*ifp
;
531 vif
= container_of(wdev
, struct brcmf_cfg80211_vif
, wdev
);
534 if ((wdev
->iftype
== NL80211_IFTYPE_ADHOC
) ||
535 (wdev
->iftype
== NL80211_IFTYPE_AP
) ||
536 (wdev
->iftype
== NL80211_IFTYPE_P2P_GO
))
537 brcmf_proto_configure_addr_mode(ifp
->drvr
, ifp
->ifidx
,
540 brcmf_proto_configure_addr_mode(ifp
->drvr
, ifp
->ifidx
,
544 static int brcmf_get_first_free_bsscfgidx(struct brcmf_pub
*drvr
)
548 for (bsscfgidx
= 0; bsscfgidx
< BRCMF_MAX_IFS
; bsscfgidx
++) {
549 /* bsscfgidx 1 is reserved for legacy P2P */
552 if (!drvr
->iflist
[bsscfgidx
])
559 static int brcmf_cfg80211_request_ap_if(struct brcmf_if
*ifp
)
561 struct brcmf_mbss_ssid_le mbss_ssid_le
;
565 memset(&mbss_ssid_le
, 0, sizeof(mbss_ssid_le
));
566 bsscfgidx
= brcmf_get_first_free_bsscfgidx(ifp
->drvr
);
570 mbss_ssid_le
.bsscfgidx
= cpu_to_le32(bsscfgidx
);
571 mbss_ssid_le
.SSID_len
= cpu_to_le32(5);
572 sprintf(mbss_ssid_le
.SSID
, "ssid%d" , bsscfgidx
);
574 err
= brcmf_fil_bsscfg_data_set(ifp
, "bsscfg:ssid", &mbss_ssid_le
,
575 sizeof(mbss_ssid_le
));
577 brcmf_err("setting ssid failed %d\n", err
);
583 * brcmf_ap_add_vif() - create a new AP virtual interface for multiple BSS
585 * @wiphy: wiphy device of new interface.
586 * @name: name of the new interface.
588 * @params: contains mac address for AP device.
591 struct wireless_dev
*brcmf_ap_add_vif(struct wiphy
*wiphy
, const char *name
,
592 u32
*flags
, struct vif_params
*params
)
594 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
595 struct brcmf_if
*ifp
= netdev_priv(cfg_to_ndev(cfg
));
596 struct brcmf_cfg80211_vif
*vif
;
599 if (brcmf_cfg80211_vif_event_armed(cfg
))
600 return ERR_PTR(-EBUSY
);
602 brcmf_dbg(INFO
, "Adding vif \"%s\"\n", name
);
604 vif
= brcmf_alloc_vif(cfg
, NL80211_IFTYPE_AP
);
606 return (struct wireless_dev
*)vif
;
608 brcmf_cfg80211_arm_vif_event(cfg
, vif
);
610 err
= brcmf_cfg80211_request_ap_if(ifp
);
612 brcmf_cfg80211_arm_vif_event(cfg
, NULL
);
616 /* wait for firmware event */
617 err
= brcmf_cfg80211_wait_vif_event(cfg
, BRCMF_E_IF_ADD
,
618 BRCMF_VIF_EVENT_TIMEOUT
);
619 brcmf_cfg80211_arm_vif_event(cfg
, NULL
);
621 brcmf_err("timeout occurred\n");
626 /* interface created in firmware */
629 brcmf_err("no if pointer provided\n");
634 strncpy(ifp
->ndev
->name
, name
, sizeof(ifp
->ndev
->name
) - 1);
635 err
= brcmf_net_attach(ifp
, true);
637 brcmf_err("Registering netdevice failed\n");
641 return &ifp
->vif
->wdev
;
648 static bool brcmf_is_apmode(struct brcmf_cfg80211_vif
*vif
)
650 enum nl80211_iftype iftype
;
652 iftype
= vif
->wdev
.iftype
;
653 return iftype
== NL80211_IFTYPE_AP
|| iftype
== NL80211_IFTYPE_P2P_GO
;
656 static bool brcmf_is_ibssmode(struct brcmf_cfg80211_vif
*vif
)
658 return vif
->wdev
.iftype
== NL80211_IFTYPE_ADHOC
;
661 static struct wireless_dev
*brcmf_cfg80211_add_iface(struct wiphy
*wiphy
,
663 unsigned char name_assign_type
,
664 enum nl80211_iftype type
,
666 struct vif_params
*params
)
668 struct wireless_dev
*wdev
;
671 brcmf_dbg(TRACE
, "enter: %s type %d\n", name
, type
);
672 err
= brcmf_vif_add_validate(wiphy_to_cfg(wiphy
), type
);
674 brcmf_err("iface validation failed: err=%d\n", err
);
678 case NL80211_IFTYPE_ADHOC
:
679 case NL80211_IFTYPE_STATION
:
680 case NL80211_IFTYPE_AP_VLAN
:
681 case NL80211_IFTYPE_WDS
:
682 case NL80211_IFTYPE_MONITOR
:
683 case NL80211_IFTYPE_MESH_POINT
:
684 return ERR_PTR(-EOPNOTSUPP
);
685 case NL80211_IFTYPE_AP
:
686 wdev
= brcmf_ap_add_vif(wiphy
, name
, flags
, params
);
688 case NL80211_IFTYPE_P2P_CLIENT
:
689 case NL80211_IFTYPE_P2P_GO
:
690 case NL80211_IFTYPE_P2P_DEVICE
:
691 wdev
= brcmf_p2p_add_vif(wiphy
, name
, name_assign_type
, type
, flags
, params
);
693 case NL80211_IFTYPE_UNSPECIFIED
:
695 return ERR_PTR(-EINVAL
);
699 brcmf_err("add iface %s type %d failed: err=%d\n",
700 name
, type
, (int)PTR_ERR(wdev
));
702 brcmf_cfg80211_update_proto_addr_mode(wdev
);
707 static void brcmf_scan_config_mpc(struct brcmf_if
*ifp
, int mpc
)
709 if (brcmf_feat_is_quirk_enabled(ifp
, BRCMF_FEAT_QUIRK_NEED_MPC
))
710 brcmf_set_mpc(ifp
, mpc
);
713 void brcmf_set_mpc(struct brcmf_if
*ifp
, int mpc
)
717 if (check_vif_up(ifp
->vif
)) {
718 err
= brcmf_fil_iovar_int_set(ifp
, "mpc", mpc
);
720 brcmf_err("fail to set mpc\n");
723 brcmf_dbg(INFO
, "MPC : %d\n", mpc
);
727 s32
brcmf_notify_escan_complete(struct brcmf_cfg80211_info
*cfg
,
728 struct brcmf_if
*ifp
, bool aborted
,
731 struct brcmf_scan_params_le params_le
;
732 struct cfg80211_scan_request
*scan_request
;
735 brcmf_dbg(SCAN
, "Enter\n");
737 /* clear scan request, because the FW abort can cause a second call */
738 /* to this functon and might cause a double cfg80211_scan_done */
739 scan_request
= cfg
->scan_request
;
740 cfg
->scan_request
= NULL
;
742 if (timer_pending(&cfg
->escan_timeout
))
743 del_timer_sync(&cfg
->escan_timeout
);
746 /* Do a scan abort to stop the driver's scan engine */
747 brcmf_dbg(SCAN
, "ABORT scan in firmware\n");
748 memset(¶ms_le
, 0, sizeof(params_le
));
749 eth_broadcast_addr(params_le
.bssid
);
750 params_le
.bss_type
= DOT11_BSSTYPE_ANY
;
751 params_le
.scan_type
= 0;
752 params_le
.channel_num
= cpu_to_le32(1);
753 params_le
.nprobes
= cpu_to_le32(1);
754 params_le
.active_time
= cpu_to_le32(-1);
755 params_le
.passive_time
= cpu_to_le32(-1);
756 params_le
.home_time
= cpu_to_le32(-1);
757 /* Scan is aborted by setting channel_list[0] to -1 */
758 params_le
.channel_list
[0] = cpu_to_le16(-1);
759 /* E-Scan (or anyother type) can be aborted by SCAN */
760 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_SCAN
,
761 ¶ms_le
, sizeof(params_le
));
763 brcmf_err("Scan abort failed\n");
766 brcmf_scan_config_mpc(ifp
, 1);
769 * e-scan can be initiated by scheduled scan
770 * which takes precedence.
772 if (cfg
->sched_escan
) {
773 brcmf_dbg(SCAN
, "scheduled scan completed\n");
774 cfg
->sched_escan
= false;
776 cfg80211_sched_scan_results(cfg_to_wiphy(cfg
));
777 } else if (scan_request
) {
778 struct cfg80211_scan_info info
= {
782 brcmf_dbg(SCAN
, "ESCAN Completed scan: %s\n",
783 aborted
? "Aborted" : "Done");
784 cfg80211_scan_done(scan_request
, &info
);
786 if (!test_and_clear_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
))
787 brcmf_dbg(SCAN
, "Scan complete, probably P2P scan\n");
792 static int brcmf_cfg80211_del_ap_iface(struct wiphy
*wiphy
,
793 struct wireless_dev
*wdev
)
795 struct brcmf_cfg80211_info
*cfg
= wiphy_priv(wiphy
);
796 struct net_device
*ndev
= wdev
->netdev
;
797 struct brcmf_if
*ifp
= netdev_priv(ndev
);
801 brcmf_cfg80211_arm_vif_event(cfg
, ifp
->vif
);
803 err
= brcmf_fil_bsscfg_data_set(ifp
, "interface_remove", NULL
, 0);
805 brcmf_err("interface_remove failed %d\n", err
);
809 /* wait for firmware event */
810 ret
= brcmf_cfg80211_wait_vif_event(cfg
, BRCMF_E_IF_DEL
,
811 BRCMF_VIF_EVENT_TIMEOUT
);
813 brcmf_err("timeout occurred\n");
818 brcmf_remove_interface(ifp
, true);
821 brcmf_cfg80211_arm_vif_event(cfg
, NULL
);
826 int brcmf_cfg80211_del_iface(struct wiphy
*wiphy
, struct wireless_dev
*wdev
)
828 struct brcmf_cfg80211_info
*cfg
= wiphy_priv(wiphy
);
829 struct net_device
*ndev
= wdev
->netdev
;
831 if (ndev
&& ndev
== cfg_to_ndev(cfg
))
834 /* vif event pending in firmware */
835 if (brcmf_cfg80211_vif_event_armed(cfg
))
839 if (test_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
) &&
840 cfg
->escan_info
.ifp
== netdev_priv(ndev
))
841 brcmf_notify_escan_complete(cfg
, netdev_priv(ndev
),
844 brcmf_fil_iovar_int_set(netdev_priv(ndev
), "mpc", 1);
847 switch (wdev
->iftype
) {
848 case NL80211_IFTYPE_ADHOC
:
849 case NL80211_IFTYPE_STATION
:
850 case NL80211_IFTYPE_AP_VLAN
:
851 case NL80211_IFTYPE_WDS
:
852 case NL80211_IFTYPE_MONITOR
:
853 case NL80211_IFTYPE_MESH_POINT
:
855 case NL80211_IFTYPE_AP
:
856 return brcmf_cfg80211_del_ap_iface(wiphy
, wdev
);
857 case NL80211_IFTYPE_P2P_CLIENT
:
858 case NL80211_IFTYPE_P2P_GO
:
859 case NL80211_IFTYPE_P2P_DEVICE
:
860 return brcmf_p2p_del_vif(wiphy
, wdev
);
861 case NL80211_IFTYPE_UNSPECIFIED
:
869 brcmf_cfg80211_change_iface(struct wiphy
*wiphy
, struct net_device
*ndev
,
870 enum nl80211_iftype type
, u32
*flags
,
871 struct vif_params
*params
)
873 struct brcmf_cfg80211_info
*cfg
= wiphy_priv(wiphy
);
874 struct brcmf_if
*ifp
= netdev_priv(ndev
);
875 struct brcmf_cfg80211_vif
*vif
= ifp
->vif
;
880 brcmf_dbg(TRACE
, "Enter, bsscfgidx=%d, type=%d\n", ifp
->bsscfgidx
,
883 /* WAR: There are a number of p2p interface related problems which
884 * need to be handled initially (before doing the validate).
885 * wpa_supplicant tends to do iface changes on p2p device/client/go
886 * which are not always possible/allowed. However we need to return
887 * OK otherwise the wpa_supplicant wont start. The situation differs
888 * on configuration and setup (p2pon=1 module param). The first check
889 * is to see if the request is a change to station for p2p iface.
891 if ((type
== NL80211_IFTYPE_STATION
) &&
892 ((vif
->wdev
.iftype
== NL80211_IFTYPE_P2P_CLIENT
) ||
893 (vif
->wdev
.iftype
== NL80211_IFTYPE_P2P_GO
) ||
894 (vif
->wdev
.iftype
== NL80211_IFTYPE_P2P_DEVICE
))) {
895 brcmf_dbg(TRACE
, "Ignoring cmd for p2p if\n");
896 /* Now depending on whether module param p2pon=1 was used the
897 * response needs to be either 0 or EOPNOTSUPP. The reason is
898 * that if p2pon=1 is used, but a newer supplicant is used then
899 * we should return an error, as this combination wont work.
900 * In other situations 0 is returned and supplicant will start
901 * normally. It will give a trace in cfg80211, but it is the
902 * only way to get it working. Unfortunately this will result
903 * in situation where we wont support new supplicant in
904 * combination with module param p2pon=1, but that is the way
905 * it is. If the user tries this then unloading of driver might
908 if (cfg
->p2p
.p2pdev_dynamically
)
913 err
= brcmf_vif_change_validate(wiphy_to_cfg(wiphy
), vif
, type
);
915 brcmf_err("iface validation failed: err=%d\n", err
);
919 case NL80211_IFTYPE_MONITOR
:
920 case NL80211_IFTYPE_WDS
:
921 brcmf_err("type (%d) : currently we do not support this type\n",
924 case NL80211_IFTYPE_ADHOC
:
927 case NL80211_IFTYPE_STATION
:
930 case NL80211_IFTYPE_AP
:
931 case NL80211_IFTYPE_P2P_GO
:
940 if (type
== NL80211_IFTYPE_P2P_GO
) {
941 brcmf_dbg(INFO
, "IF Type = P2P GO\n");
942 err
= brcmf_p2p_ifchange(cfg
, BRCMF_FIL_P2P_IF_GO
);
945 brcmf_dbg(INFO
, "IF Type = AP\n");
948 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_INFRA
, infra
);
950 brcmf_err("WLC_SET_INFRA error (%d)\n", err
);
954 brcmf_dbg(INFO
, "IF Type = %s\n", brcmf_is_ibssmode(vif
) ?
957 ndev
->ieee80211_ptr
->iftype
= type
;
959 brcmf_cfg80211_update_proto_addr_mode(&vif
->wdev
);
962 brcmf_dbg(TRACE
, "Exit\n");
967 static void brcmf_escan_prep(struct brcmf_cfg80211_info
*cfg
,
968 struct brcmf_scan_params_le
*params_le
,
969 struct cfg80211_scan_request
*request
)
977 struct brcmf_ssid_le ssid_le
;
979 eth_broadcast_addr(params_le
->bssid
);
980 params_le
->bss_type
= DOT11_BSSTYPE_ANY
;
981 params_le
->scan_type
= 0;
982 params_le
->channel_num
= 0;
983 params_le
->nprobes
= cpu_to_le32(-1);
984 params_le
->active_time
= cpu_to_le32(-1);
985 params_le
->passive_time
= cpu_to_le32(-1);
986 params_le
->home_time
= cpu_to_le32(-1);
987 memset(¶ms_le
->ssid_le
, 0, sizeof(params_le
->ssid_le
));
989 /* if request is null exit so it will be all channel broadcast scan */
993 n_ssids
= request
->n_ssids
;
994 n_channels
= request
->n_channels
;
995 /* Copy channel array if applicable */
996 brcmf_dbg(SCAN
, "### List of channelspecs to scan ### %d\n",
998 if (n_channels
> 0) {
999 for (i
= 0; i
< n_channels
; i
++) {
1000 chanspec
= channel_to_chanspec(&cfg
->d11inf
,
1001 request
->channels
[i
]);
1002 brcmf_dbg(SCAN
, "Chan : %d, Channel spec: %x\n",
1003 request
->channels
[i
]->hw_value
, chanspec
);
1004 params_le
->channel_list
[i
] = cpu_to_le16(chanspec
);
1007 brcmf_dbg(SCAN
, "Scanning all channels\n");
1009 /* Copy ssid array if applicable */
1010 brcmf_dbg(SCAN
, "### List of SSIDs to scan ### %d\n", n_ssids
);
1012 offset
= offsetof(struct brcmf_scan_params_le
, channel_list
) +
1013 n_channels
* sizeof(u16
);
1014 offset
= roundup(offset
, sizeof(u32
));
1015 ptr
= (char *)params_le
+ offset
;
1016 for (i
= 0; i
< n_ssids
; i
++) {
1017 memset(&ssid_le
, 0, sizeof(ssid_le
));
1019 cpu_to_le32(request
->ssids
[i
].ssid_len
);
1020 memcpy(ssid_le
.SSID
, request
->ssids
[i
].ssid
,
1021 request
->ssids
[i
].ssid_len
);
1022 if (!ssid_le
.SSID_len
)
1023 brcmf_dbg(SCAN
, "%d: Broadcast scan\n", i
);
1025 brcmf_dbg(SCAN
, "%d: scan for %s size =%d\n",
1026 i
, ssid_le
.SSID
, ssid_le
.SSID_len
);
1027 memcpy(ptr
, &ssid_le
, sizeof(ssid_le
));
1028 ptr
+= sizeof(ssid_le
);
1031 brcmf_dbg(SCAN
, "Broadcast scan %p\n", request
->ssids
);
1032 if ((request
->ssids
) && request
->ssids
->ssid_len
) {
1033 brcmf_dbg(SCAN
, "SSID %s len=%d\n",
1034 params_le
->ssid_le
.SSID
,
1035 request
->ssids
->ssid_len
);
1036 params_le
->ssid_le
.SSID_len
=
1037 cpu_to_le32(request
->ssids
->ssid_len
);
1038 memcpy(¶ms_le
->ssid_le
.SSID
, request
->ssids
->ssid
,
1039 request
->ssids
->ssid_len
);
1042 /* Adding mask to channel numbers */
1043 params_le
->channel_num
=
1044 cpu_to_le32((n_ssids
<< BRCMF_SCAN_PARAMS_NSSID_SHIFT
) |
1045 (n_channels
& BRCMF_SCAN_PARAMS_COUNT_MASK
));
1049 brcmf_run_escan(struct brcmf_cfg80211_info
*cfg
, struct brcmf_if
*ifp
,
1050 struct cfg80211_scan_request
*request
)
1052 s32 params_size
= BRCMF_SCAN_PARAMS_FIXED_SIZE
+
1053 offsetof(struct brcmf_escan_params_le
, params_le
);
1054 struct brcmf_escan_params_le
*params
;
1057 brcmf_dbg(SCAN
, "E-SCAN START\n");
1059 if (request
!= NULL
) {
1060 /* Allocate space for populating ssids in struct */
1061 params_size
+= sizeof(u32
) * ((request
->n_channels
+ 1) / 2);
1063 /* Allocate space for populating ssids in struct */
1064 params_size
+= sizeof(struct brcmf_ssid_le
) * request
->n_ssids
;
1067 params
= kzalloc(params_size
, GFP_KERNEL
);
1072 BUG_ON(params_size
+ sizeof("escan") >= BRCMF_DCMD_MEDLEN
);
1073 brcmf_escan_prep(cfg
, ¶ms
->params_le
, request
);
1074 params
->version
= cpu_to_le32(BRCMF_ESCAN_REQ_VERSION
);
1075 params
->action
= cpu_to_le16(WL_ESCAN_ACTION_START
);
1076 params
->sync_id
= cpu_to_le16(0x1234);
1078 err
= brcmf_fil_iovar_data_set(ifp
, "escan", params
, params_size
);
1081 brcmf_dbg(INFO
, "system busy : escan canceled\n");
1083 brcmf_err("error (%d)\n", err
);
1092 brcmf_do_escan(struct brcmf_cfg80211_info
*cfg
, struct wiphy
*wiphy
,
1093 struct brcmf_if
*ifp
, struct cfg80211_scan_request
*request
)
1097 struct brcmf_scan_results
*results
;
1098 struct escan_info
*escan
= &cfg
->escan_info
;
1100 brcmf_dbg(SCAN
, "Enter\n");
1102 escan
->wiphy
= wiphy
;
1103 escan
->escan_state
= WL_ESCAN_STATE_SCANNING
;
1104 passive_scan
= cfg
->active_scan
? 0 : 1;
1105 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_PASSIVE_SCAN
,
1108 brcmf_err("error (%d)\n", err
);
1111 brcmf_scan_config_mpc(ifp
, 0);
1112 results
= (struct brcmf_scan_results
*)cfg
->escan_info
.escan_buf
;
1113 results
->version
= 0;
1115 results
->buflen
= WL_ESCAN_RESULTS_FIXED_SIZE
;
1117 err
= escan
->run(cfg
, ifp
, request
);
1119 brcmf_scan_config_mpc(ifp
, 1);
1124 brcmf_cfg80211_escan(struct wiphy
*wiphy
, struct brcmf_cfg80211_vif
*vif
,
1125 struct cfg80211_scan_request
*request
,
1126 struct cfg80211_ssid
*this_ssid
)
1128 struct brcmf_if
*ifp
= vif
->ifp
;
1129 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
1130 struct cfg80211_ssid
*ssids
;
1135 struct brcmf_ssid_le ssid_le
;
1138 brcmf_dbg(SCAN
, "START ESCAN\n");
1140 if (test_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
)) {
1141 brcmf_err("Scanning already: status (%lu)\n", cfg
->scan_status
);
1144 if (test_bit(BRCMF_SCAN_STATUS_ABORT
, &cfg
->scan_status
)) {
1145 brcmf_err("Scanning being aborted: status (%lu)\n",
1149 if (test_bit(BRCMF_SCAN_STATUS_SUPPRESS
, &cfg
->scan_status
)) {
1150 brcmf_err("Scanning suppressed: status (%lu)\n",
1154 if (test_bit(BRCMF_VIF_STATUS_CONNECTING
, &ifp
->vif
->sme_state
)) {
1155 brcmf_err("Connecting: status (%lu)\n", ifp
->vif
->sme_state
);
1159 /* If scan req comes for p2p0, send it over primary I/F */
1160 if (vif
== cfg
->p2p
.bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
)
1161 vif
= cfg
->p2p
.bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
;
1166 ssids
= request
->ssids
;
1170 /* we don't do escan in ibss */
1174 cfg
->scan_request
= request
;
1175 set_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
);
1177 cfg
->escan_info
.run
= brcmf_run_escan
;
1178 err
= brcmf_p2p_scan_prep(wiphy
, request
, vif
);
1182 err
= brcmf_do_escan(cfg
, wiphy
, vif
->ifp
, request
);
1186 brcmf_dbg(SCAN
, "ssid \"%s\", ssid_len (%d)\n",
1187 ssids
->ssid
, ssids
->ssid_len
);
1188 memset(&ssid_le
, 0, sizeof(ssid_le
));
1189 SSID_len
= min_t(u8
, sizeof(ssid_le
.SSID
), ssids
->ssid_len
);
1190 ssid_le
.SSID_len
= cpu_to_le32(0);
1193 memcpy(ssid_le
.SSID
, ssids
->ssid
, SSID_len
);
1194 ssid_le
.SSID_len
= cpu_to_le32(SSID_len
);
1197 brcmf_dbg(SCAN
, "Broadcast scan\n");
1199 passive_scan
= cfg
->active_scan
? 0 : 1;
1200 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_PASSIVE_SCAN
,
1203 brcmf_err("WLC_SET_PASSIVE_SCAN error (%d)\n", err
);
1206 brcmf_scan_config_mpc(ifp
, 0);
1207 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_SCAN
, &ssid_le
,
1211 brcmf_dbg(INFO
, "BUSY: scan for \"%s\" canceled\n",
1214 brcmf_err("WLC_SCAN error (%d)\n", err
);
1216 brcmf_scan_config_mpc(ifp
, 1);
1221 /* Arm scan timeout timer */
1222 mod_timer(&cfg
->escan_timeout
, jiffies
+
1223 BRCMF_ESCAN_TIMER_INTERVAL_MS
* HZ
/ 1000);
1228 clear_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
);
1229 cfg
->scan_request
= NULL
;
1234 brcmf_cfg80211_scan(struct wiphy
*wiphy
, struct cfg80211_scan_request
*request
)
1236 struct brcmf_cfg80211_vif
*vif
;
1239 brcmf_dbg(TRACE
, "Enter\n");
1240 vif
= container_of(request
->wdev
, struct brcmf_cfg80211_vif
, wdev
);
1241 if (!check_vif_up(vif
))
1244 err
= brcmf_cfg80211_escan(wiphy
, vif
, request
, NULL
);
1247 brcmf_err("scan error (%d)\n", err
);
1249 brcmf_dbg(TRACE
, "Exit\n");
1253 static s32
brcmf_set_rts(struct net_device
*ndev
, u32 rts_threshold
)
1257 err
= brcmf_fil_iovar_int_set(netdev_priv(ndev
), "rtsthresh",
1260 brcmf_err("Error (%d)\n", err
);
1265 static s32
brcmf_set_frag(struct net_device
*ndev
, u32 frag_threshold
)
1269 err
= brcmf_fil_iovar_int_set(netdev_priv(ndev
), "fragthresh",
1272 brcmf_err("Error (%d)\n", err
);
1277 static s32
brcmf_set_retry(struct net_device
*ndev
, u32 retry
, bool l
)
1280 u32 cmd
= (l
? BRCMF_C_SET_LRL
: BRCMF_C_SET_SRL
);
1282 err
= brcmf_fil_cmd_int_set(netdev_priv(ndev
), cmd
, retry
);
1284 brcmf_err("cmd (%d) , error (%d)\n", cmd
, err
);
1290 static s32
brcmf_cfg80211_set_wiphy_params(struct wiphy
*wiphy
, u32 changed
)
1292 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
1293 struct net_device
*ndev
= cfg_to_ndev(cfg
);
1294 struct brcmf_if
*ifp
= netdev_priv(ndev
);
1297 brcmf_dbg(TRACE
, "Enter\n");
1298 if (!check_vif_up(ifp
->vif
))
1301 if (changed
& WIPHY_PARAM_RTS_THRESHOLD
&&
1302 (cfg
->conf
->rts_threshold
!= wiphy
->rts_threshold
)) {
1303 cfg
->conf
->rts_threshold
= wiphy
->rts_threshold
;
1304 err
= brcmf_set_rts(ndev
, cfg
->conf
->rts_threshold
);
1308 if (changed
& WIPHY_PARAM_FRAG_THRESHOLD
&&
1309 (cfg
->conf
->frag_threshold
!= wiphy
->frag_threshold
)) {
1310 cfg
->conf
->frag_threshold
= wiphy
->frag_threshold
;
1311 err
= brcmf_set_frag(ndev
, cfg
->conf
->frag_threshold
);
1315 if (changed
& WIPHY_PARAM_RETRY_LONG
1316 && (cfg
->conf
->retry_long
!= wiphy
->retry_long
)) {
1317 cfg
->conf
->retry_long
= wiphy
->retry_long
;
1318 err
= brcmf_set_retry(ndev
, cfg
->conf
->retry_long
, true);
1322 if (changed
& WIPHY_PARAM_RETRY_SHORT
1323 && (cfg
->conf
->retry_short
!= wiphy
->retry_short
)) {
1324 cfg
->conf
->retry_short
= wiphy
->retry_short
;
1325 err
= brcmf_set_retry(ndev
, cfg
->conf
->retry_short
, false);
1331 brcmf_dbg(TRACE
, "Exit\n");
1335 static void brcmf_init_prof(struct brcmf_cfg80211_profile
*prof
)
1337 memset(prof
, 0, sizeof(*prof
));
1340 static u16
brcmf_map_fw_linkdown_reason(const struct brcmf_event_msg
*e
)
1344 switch (e
->event_code
) {
1345 case BRCMF_E_DEAUTH
:
1346 case BRCMF_E_DEAUTH_IND
:
1347 case BRCMF_E_DISASSOC_IND
:
1358 static void brcmf_link_down(struct brcmf_cfg80211_vif
*vif
, u16 reason
)
1360 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(vif
->wdev
.wiphy
);
1363 brcmf_dbg(TRACE
, "Enter\n");
1365 if (test_and_clear_bit(BRCMF_VIF_STATUS_CONNECTED
, &vif
->sme_state
)) {
1366 brcmf_dbg(INFO
, "Call WLC_DISASSOC to stop excess roaming\n ");
1367 err
= brcmf_fil_cmd_data_set(vif
->ifp
,
1368 BRCMF_C_DISASSOC
, NULL
, 0);
1370 brcmf_err("WLC_DISASSOC failed (%d)\n", err
);
1372 if ((vif
->wdev
.iftype
== NL80211_IFTYPE_STATION
) ||
1373 (vif
->wdev
.iftype
== NL80211_IFTYPE_P2P_CLIENT
))
1374 cfg80211_disconnected(vif
->wdev
.netdev
, reason
, NULL
, 0,
1377 clear_bit(BRCMF_VIF_STATUS_CONNECTING
, &vif
->sme_state
);
1378 clear_bit(BRCMF_SCAN_STATUS_SUPPRESS
, &cfg
->scan_status
);
1379 brcmf_btcoex_set_mode(vif
, BRCMF_BTCOEX_ENABLED
, 0);
1380 brcmf_dbg(TRACE
, "Exit\n");
1384 brcmf_cfg80211_join_ibss(struct wiphy
*wiphy
, struct net_device
*ndev
,
1385 struct cfg80211_ibss_params
*params
)
1387 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
1388 struct brcmf_if
*ifp
= netdev_priv(ndev
);
1389 struct brcmf_cfg80211_profile
*profile
= &ifp
->vif
->profile
;
1390 struct brcmf_join_params join_params
;
1391 size_t join_params_size
= 0;
1398 brcmf_dbg(TRACE
, "Enter\n");
1399 if (!check_vif_up(ifp
->vif
))
1403 brcmf_dbg(CONN
, "SSID: %s\n", params
->ssid
);
1405 brcmf_dbg(CONN
, "SSID: NULL, Not supported\n");
1409 set_bit(BRCMF_VIF_STATUS_CONNECTING
, &ifp
->vif
->sme_state
);
1412 brcmf_dbg(CONN
, "BSSID: %pM\n", params
->bssid
);
1414 brcmf_dbg(CONN
, "No BSSID specified\n");
1416 if (params
->chandef
.chan
)
1417 brcmf_dbg(CONN
, "channel: %d\n",
1418 params
->chandef
.chan
->center_freq
);
1420 brcmf_dbg(CONN
, "no channel specified\n");
1422 if (params
->channel_fixed
)
1423 brcmf_dbg(CONN
, "fixed channel required\n");
1425 brcmf_dbg(CONN
, "no fixed channel required\n");
1427 if (params
->ie
&& params
->ie_len
)
1428 brcmf_dbg(CONN
, "ie len: %d\n", params
->ie_len
);
1430 brcmf_dbg(CONN
, "no ie specified\n");
1432 if (params
->beacon_interval
)
1433 brcmf_dbg(CONN
, "beacon interval: %d\n",
1434 params
->beacon_interval
);
1436 brcmf_dbg(CONN
, "no beacon interval specified\n");
1438 if (params
->basic_rates
)
1439 brcmf_dbg(CONN
, "basic rates: %08X\n", params
->basic_rates
);
1441 brcmf_dbg(CONN
, "no basic rates specified\n");
1443 if (params
->privacy
)
1444 brcmf_dbg(CONN
, "privacy required\n");
1446 brcmf_dbg(CONN
, "no privacy required\n");
1448 /* Configure Privacy for starter */
1449 if (params
->privacy
)
1450 wsec
|= WEP_ENABLED
;
1452 err
= brcmf_fil_iovar_int_set(ifp
, "wsec", wsec
);
1454 brcmf_err("wsec failed (%d)\n", err
);
1458 /* Configure Beacon Interval for starter */
1459 if (params
->beacon_interval
)
1460 bcnprd
= params
->beacon_interval
;
1464 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_BCNPRD
, bcnprd
);
1466 brcmf_err("WLC_SET_BCNPRD failed (%d)\n", err
);
1470 /* Configure required join parameter */
1471 memset(&join_params
, 0, sizeof(struct brcmf_join_params
));
1474 ssid_len
= min_t(u32
, params
->ssid_len
, IEEE80211_MAX_SSID_LEN
);
1475 memcpy(join_params
.ssid_le
.SSID
, params
->ssid
, ssid_len
);
1476 join_params
.ssid_le
.SSID_len
= cpu_to_le32(ssid_len
);
1477 join_params_size
= sizeof(join_params
.ssid_le
);
1480 if (params
->bssid
) {
1481 memcpy(join_params
.params_le
.bssid
, params
->bssid
, ETH_ALEN
);
1482 join_params_size
+= BRCMF_ASSOC_PARAMS_FIXED_SIZE
;
1483 memcpy(profile
->bssid
, params
->bssid
, ETH_ALEN
);
1485 eth_broadcast_addr(join_params
.params_le
.bssid
);
1486 eth_zero_addr(profile
->bssid
);
1490 if (params
->chandef
.chan
) {
1494 ieee80211_frequency_to_channel(
1495 params
->chandef
.chan
->center_freq
);
1496 if (params
->channel_fixed
) {
1497 /* adding chanspec */
1498 chanspec
= chandef_to_chanspec(&cfg
->d11inf
,
1500 join_params
.params_le
.chanspec_list
[0] =
1501 cpu_to_le16(chanspec
);
1502 join_params
.params_le
.chanspec_num
= cpu_to_le32(1);
1503 join_params_size
+= sizeof(join_params
.params_le
);
1506 /* set channel for starter */
1507 target_channel
= cfg
->channel
;
1508 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_CHANNEL
,
1511 brcmf_err("WLC_SET_CHANNEL failed (%d)\n", err
);
1517 cfg
->ibss_starter
= false;
1520 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_SET_SSID
,
1521 &join_params
, join_params_size
);
1523 brcmf_err("WLC_SET_SSID failed (%d)\n", err
);
1529 clear_bit(BRCMF_VIF_STATUS_CONNECTING
, &ifp
->vif
->sme_state
);
1530 brcmf_dbg(TRACE
, "Exit\n");
1535 brcmf_cfg80211_leave_ibss(struct wiphy
*wiphy
, struct net_device
*ndev
)
1537 struct brcmf_if
*ifp
= netdev_priv(ndev
);
1539 brcmf_dbg(TRACE
, "Enter\n");
1540 if (!check_vif_up(ifp
->vif
)) {
1541 /* When driver is being unloaded, it can end up here. If an
1542 * error is returned then later on a debug trace in the wireless
1543 * core module will be printed. To avoid this 0 is returned.
1548 brcmf_link_down(ifp
->vif
, WLAN_REASON_DEAUTH_LEAVING
);
1549 brcmf_net_setcarrier(ifp
, false);
1551 brcmf_dbg(TRACE
, "Exit\n");
1556 static s32
brcmf_set_wpa_version(struct net_device
*ndev
,
1557 struct cfg80211_connect_params
*sme
)
1559 struct brcmf_cfg80211_profile
*profile
= ndev_to_prof(ndev
);
1560 struct brcmf_cfg80211_security
*sec
;
1564 if (sme
->crypto
.wpa_versions
& NL80211_WPA_VERSION_1
)
1565 val
= WPA_AUTH_PSK
| WPA_AUTH_UNSPECIFIED
;
1566 else if (sme
->crypto
.wpa_versions
& NL80211_WPA_VERSION_2
)
1567 val
= WPA2_AUTH_PSK
| WPA2_AUTH_UNSPECIFIED
;
1569 val
= WPA_AUTH_DISABLED
;
1570 brcmf_dbg(CONN
, "setting wpa_auth to 0x%0x\n", val
);
1571 err
= brcmf_fil_bsscfg_int_set(netdev_priv(ndev
), "wpa_auth", val
);
1573 brcmf_err("set wpa_auth failed (%d)\n", err
);
1576 sec
= &profile
->sec
;
1577 sec
->wpa_versions
= sme
->crypto
.wpa_versions
;
1581 static s32
brcmf_set_auth_type(struct net_device
*ndev
,
1582 struct cfg80211_connect_params
*sme
)
1584 struct brcmf_cfg80211_profile
*profile
= ndev_to_prof(ndev
);
1585 struct brcmf_cfg80211_security
*sec
;
1589 switch (sme
->auth_type
) {
1590 case NL80211_AUTHTYPE_OPEN_SYSTEM
:
1592 brcmf_dbg(CONN
, "open system\n");
1594 case NL80211_AUTHTYPE_SHARED_KEY
:
1596 brcmf_dbg(CONN
, "shared key\n");
1598 case NL80211_AUTHTYPE_AUTOMATIC
:
1600 brcmf_dbg(CONN
, "automatic\n");
1602 case NL80211_AUTHTYPE_NETWORK_EAP
:
1603 brcmf_dbg(CONN
, "network eap\n");
1606 brcmf_err("invalid auth type (%d)\n", sme
->auth_type
);
1610 err
= brcmf_fil_bsscfg_int_set(netdev_priv(ndev
), "auth", val
);
1612 brcmf_err("set auth failed (%d)\n", err
);
1615 sec
= &profile
->sec
;
1616 sec
->auth_type
= sme
->auth_type
;
1621 brcmf_set_wsec_mode(struct net_device
*ndev
,
1622 struct cfg80211_connect_params
*sme
)
1624 struct brcmf_cfg80211_profile
*profile
= ndev_to_prof(ndev
);
1625 struct brcmf_cfg80211_security
*sec
;
1631 if (sme
->crypto
.n_ciphers_pairwise
) {
1632 switch (sme
->crypto
.ciphers_pairwise
[0]) {
1633 case WLAN_CIPHER_SUITE_WEP40
:
1634 case WLAN_CIPHER_SUITE_WEP104
:
1637 case WLAN_CIPHER_SUITE_TKIP
:
1638 pval
= TKIP_ENABLED
;
1640 case WLAN_CIPHER_SUITE_CCMP
:
1643 case WLAN_CIPHER_SUITE_AES_CMAC
:
1647 brcmf_err("invalid cipher pairwise (%d)\n",
1648 sme
->crypto
.ciphers_pairwise
[0]);
1652 if (sme
->crypto
.cipher_group
) {
1653 switch (sme
->crypto
.cipher_group
) {
1654 case WLAN_CIPHER_SUITE_WEP40
:
1655 case WLAN_CIPHER_SUITE_WEP104
:
1658 case WLAN_CIPHER_SUITE_TKIP
:
1659 gval
= TKIP_ENABLED
;
1661 case WLAN_CIPHER_SUITE_CCMP
:
1664 case WLAN_CIPHER_SUITE_AES_CMAC
:
1668 brcmf_err("invalid cipher group (%d)\n",
1669 sme
->crypto
.cipher_group
);
1674 brcmf_dbg(CONN
, "pval (%d) gval (%d)\n", pval
, gval
);
1675 /* In case of privacy, but no security and WPS then simulate */
1676 /* setting AES. WPS-2.0 allows no security */
1677 if (brcmf_find_wpsie(sme
->ie
, sme
->ie_len
) && !pval
&& !gval
&&
1682 err
= brcmf_fil_bsscfg_int_set(netdev_priv(ndev
), "wsec", wsec
);
1684 brcmf_err("error (%d)\n", err
);
1688 sec
= &profile
->sec
;
1689 sec
->cipher_pairwise
= sme
->crypto
.ciphers_pairwise
[0];
1690 sec
->cipher_group
= sme
->crypto
.cipher_group
;
1696 brcmf_set_key_mgmt(struct net_device
*ndev
, struct cfg80211_connect_params
*sme
)
1698 struct brcmf_if
*ifp
= netdev_priv(ndev
);
1701 const struct brcmf_tlv
*rsn_ie
;
1709 if (!sme
->crypto
.n_akm_suites
)
1712 err
= brcmf_fil_bsscfg_int_get(netdev_priv(ndev
), "wpa_auth", &val
);
1714 brcmf_err("could not get wpa_auth (%d)\n", err
);
1717 if (val
& (WPA_AUTH_PSK
| WPA_AUTH_UNSPECIFIED
)) {
1718 switch (sme
->crypto
.akm_suites
[0]) {
1719 case WLAN_AKM_SUITE_8021X
:
1720 val
= WPA_AUTH_UNSPECIFIED
;
1722 case WLAN_AKM_SUITE_PSK
:
1726 brcmf_err("invalid cipher group (%d)\n",
1727 sme
->crypto
.cipher_group
);
1730 } else if (val
& (WPA2_AUTH_PSK
| WPA2_AUTH_UNSPECIFIED
)) {
1731 switch (sme
->crypto
.akm_suites
[0]) {
1732 case WLAN_AKM_SUITE_8021X
:
1733 val
= WPA2_AUTH_UNSPECIFIED
;
1735 case WLAN_AKM_SUITE_8021X_SHA256
:
1736 val
= WPA2_AUTH_1X_SHA256
;
1738 case WLAN_AKM_SUITE_PSK_SHA256
:
1739 val
= WPA2_AUTH_PSK_SHA256
;
1741 case WLAN_AKM_SUITE_PSK
:
1742 val
= WPA2_AUTH_PSK
;
1745 brcmf_err("invalid cipher group (%d)\n",
1746 sme
->crypto
.cipher_group
);
1751 if (!brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_MFP
))
1752 goto skip_mfp_config
;
1753 /* The MFP mode (1 or 2) needs to be determined, parse IEs. The
1754 * IE will not be verified, just a quick search for MFP config
1756 rsn_ie
= brcmf_parse_tlvs((const u8
*)sme
->ie
, sme
->ie_len
,
1759 goto skip_mfp_config
;
1760 ie
= (const u8
*)rsn_ie
;
1761 ie_len
= rsn_ie
->len
+ TLV_HDR_LEN
;
1762 /* Skip unicast suite */
1763 offset
= TLV_HDR_LEN
+ WPA_IE_VERSION_LEN
+ WPA_IE_MIN_OUI_LEN
;
1764 if (offset
+ WPA_IE_SUITE_COUNT_LEN
>= ie_len
)
1765 goto skip_mfp_config
;
1766 /* Skip multicast suite */
1767 count
= ie
[offset
] + (ie
[offset
+ 1] << 8);
1768 offset
+= WPA_IE_SUITE_COUNT_LEN
+ (count
* WPA_IE_MIN_OUI_LEN
);
1769 if (offset
+ WPA_IE_SUITE_COUNT_LEN
>= ie_len
)
1770 goto skip_mfp_config
;
1771 /* Skip auth key management suite(s) */
1772 count
= ie
[offset
] + (ie
[offset
+ 1] << 8);
1773 offset
+= WPA_IE_SUITE_COUNT_LEN
+ (count
* WPA_IE_MIN_OUI_LEN
);
1774 if (offset
+ WPA_IE_SUITE_COUNT_LEN
> ie_len
)
1775 goto skip_mfp_config
;
1776 /* Ready to read capabilities */
1777 mfp
= BRCMF_MFP_NONE
;
1778 rsn_cap
= ie
[offset
] + (ie
[offset
+ 1] << 8);
1779 if (rsn_cap
& RSN_CAP_MFPR_MASK
)
1780 mfp
= BRCMF_MFP_REQUIRED
;
1781 else if (rsn_cap
& RSN_CAP_MFPC_MASK
)
1782 mfp
= BRCMF_MFP_CAPABLE
;
1783 brcmf_fil_bsscfg_int_set(netdev_priv(ndev
), "mfp", mfp
);
1786 brcmf_dbg(CONN
, "setting wpa_auth to %d\n", val
);
1787 err
= brcmf_fil_bsscfg_int_set(netdev_priv(ndev
), "wpa_auth", val
);
1789 brcmf_err("could not set wpa_auth (%d)\n", err
);
1797 brcmf_set_sharedkey(struct net_device
*ndev
,
1798 struct cfg80211_connect_params
*sme
)
1800 struct brcmf_cfg80211_profile
*profile
= ndev_to_prof(ndev
);
1801 struct brcmf_cfg80211_security
*sec
;
1802 struct brcmf_wsec_key key
;
1806 brcmf_dbg(CONN
, "key len (%d)\n", sme
->key_len
);
1808 if (sme
->key_len
== 0)
1811 sec
= &profile
->sec
;
1812 brcmf_dbg(CONN
, "wpa_versions 0x%x cipher_pairwise 0x%x\n",
1813 sec
->wpa_versions
, sec
->cipher_pairwise
);
1815 if (sec
->wpa_versions
& (NL80211_WPA_VERSION_1
| NL80211_WPA_VERSION_2
))
1818 if (!(sec
->cipher_pairwise
&
1819 (WLAN_CIPHER_SUITE_WEP40
| WLAN_CIPHER_SUITE_WEP104
)))
1822 memset(&key
, 0, sizeof(key
));
1823 key
.len
= (u32
) sme
->key_len
;
1824 key
.index
= (u32
) sme
->key_idx
;
1825 if (key
.len
> sizeof(key
.data
)) {
1826 brcmf_err("Too long key length (%u)\n", key
.len
);
1829 memcpy(key
.data
, sme
->key
, key
.len
);
1830 key
.flags
= BRCMF_PRIMARY_KEY
;
1831 switch (sec
->cipher_pairwise
) {
1832 case WLAN_CIPHER_SUITE_WEP40
:
1833 key
.algo
= CRYPTO_ALGO_WEP1
;
1835 case WLAN_CIPHER_SUITE_WEP104
:
1836 key
.algo
= CRYPTO_ALGO_WEP128
;
1839 brcmf_err("Invalid algorithm (%d)\n",
1840 sme
->crypto
.ciphers_pairwise
[0]);
1843 /* Set the new key/index */
1844 brcmf_dbg(CONN
, "key length (%d) key index (%d) algo (%d)\n",
1845 key
.len
, key
.index
, key
.algo
);
1846 brcmf_dbg(CONN
, "key \"%s\"\n", key
.data
);
1847 err
= send_key_to_dongle(netdev_priv(ndev
), &key
);
1851 if (sec
->auth_type
== NL80211_AUTHTYPE_SHARED_KEY
) {
1852 brcmf_dbg(CONN
, "set auth_type to shared key\n");
1853 val
= WL_AUTH_SHARED_KEY
; /* shared key */
1854 err
= brcmf_fil_bsscfg_int_set(netdev_priv(ndev
), "auth", val
);
1856 brcmf_err("set auth failed (%d)\n", err
);
1862 enum nl80211_auth_type
brcmf_war_auth_type(struct brcmf_if
*ifp
,
1863 enum nl80211_auth_type type
)
1865 if (type
== NL80211_AUTHTYPE_AUTOMATIC
&&
1866 brcmf_feat_is_quirk_enabled(ifp
, BRCMF_FEAT_QUIRK_AUTO_AUTH
)) {
1867 brcmf_dbg(CONN
, "WAR: use OPEN instead of AUTO\n");
1868 type
= NL80211_AUTHTYPE_OPEN_SYSTEM
;
1873 static void brcmf_set_join_pref(struct brcmf_if
*ifp
,
1874 struct cfg80211_bss_selection
*bss_select
)
1876 struct brcmf_join_pref_params join_pref_params
[2];
1877 enum nl80211_band band
;
1880 join_pref_params
[i
].len
= 2;
1881 join_pref_params
[i
].rssi_gain
= 0;
1883 if (bss_select
->behaviour
!= NL80211_BSS_SELECT_ATTR_BAND_PREF
)
1884 brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_ASSOC_PREFER
, WLC_BAND_AUTO
);
1886 switch (bss_select
->behaviour
) {
1887 case __NL80211_BSS_SELECT_ATTR_INVALID
:
1888 brcmf_c_set_joinpref_default(ifp
);
1890 case NL80211_BSS_SELECT_ATTR_BAND_PREF
:
1891 join_pref_params
[i
].type
= BRCMF_JOIN_PREF_BAND
;
1892 band
= bss_select
->param
.band_pref
;
1893 join_pref_params
[i
].band
= nl80211_band_to_fwil(band
);
1896 case NL80211_BSS_SELECT_ATTR_RSSI_ADJUST
:
1897 join_pref_params
[i
].type
= BRCMF_JOIN_PREF_RSSI_DELTA
;
1898 band
= bss_select
->param
.adjust
.band
;
1899 join_pref_params
[i
].band
= nl80211_band_to_fwil(band
);
1900 join_pref_params
[i
].rssi_gain
= bss_select
->param
.adjust
.delta
;
1903 case NL80211_BSS_SELECT_ATTR_RSSI
:
1907 join_pref_params
[i
].type
= BRCMF_JOIN_PREF_RSSI
;
1908 join_pref_params
[i
].len
= 2;
1909 join_pref_params
[i
].rssi_gain
= 0;
1910 join_pref_params
[i
].band
= 0;
1911 err
= brcmf_fil_iovar_data_set(ifp
, "join_pref", join_pref_params
,
1912 sizeof(join_pref_params
));
1914 brcmf_err("Set join_pref error (%d)\n", err
);
1918 brcmf_cfg80211_connect(struct wiphy
*wiphy
, struct net_device
*ndev
,
1919 struct cfg80211_connect_params
*sme
)
1921 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
1922 struct brcmf_if
*ifp
= netdev_priv(ndev
);
1923 struct ieee80211_channel
*chan
= sme
->channel
;
1924 struct brcmf_join_params join_params
;
1925 size_t join_params_size
;
1926 const struct brcmf_tlv
*rsn_ie
;
1927 const struct brcmf_vs_tlv
*wpa_ie
;
1930 struct brcmf_ext_join_params_le
*ext_join_params
;
1935 brcmf_dbg(TRACE
, "Enter\n");
1936 if (!check_vif_up(ifp
->vif
))
1940 brcmf_err("Invalid ssid\n");
1944 if (ifp
->vif
== cfg
->p2p
.bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
) {
1945 /* A normal (non P2P) connection request setup. */
1948 /* find the WPA_IE */
1949 wpa_ie
= brcmf_find_wpaie((u8
*)sme
->ie
, sme
->ie_len
);
1952 ie_len
= wpa_ie
->len
+ TLV_HDR_LEN
;
1954 /* find the RSN_IE */
1955 rsn_ie
= brcmf_parse_tlvs((const u8
*)sme
->ie
,
1960 ie_len
= rsn_ie
->len
+ TLV_HDR_LEN
;
1963 brcmf_fil_iovar_data_set(ifp
, "wpaie", ie
, ie_len
);
1966 err
= brcmf_vif_set_mgmt_ie(ifp
->vif
, BRCMF_VNDR_IE_ASSOCREQ_FLAG
,
1967 sme
->ie
, sme
->ie_len
);
1969 brcmf_err("Set Assoc REQ IE Failed\n");
1971 brcmf_dbg(TRACE
, "Applied Vndr IEs for Assoc request\n");
1973 set_bit(BRCMF_VIF_STATUS_CONNECTING
, &ifp
->vif
->sme_state
);
1977 ieee80211_frequency_to_channel(chan
->center_freq
);
1978 chanspec
= channel_to_chanspec(&cfg
->d11inf
, chan
);
1979 brcmf_dbg(CONN
, "channel=%d, center_req=%d, chanspec=0x%04x\n",
1980 cfg
->channel
, chan
->center_freq
, chanspec
);
1986 brcmf_dbg(INFO
, "ie (%p), ie_len (%zd)\n", sme
->ie
, sme
->ie_len
);
1988 err
= brcmf_set_wpa_version(ndev
, sme
);
1990 brcmf_err("wl_set_wpa_version failed (%d)\n", err
);
1994 sme
->auth_type
= brcmf_war_auth_type(ifp
, sme
->auth_type
);
1995 err
= brcmf_set_auth_type(ndev
, sme
);
1997 brcmf_err("wl_set_auth_type failed (%d)\n", err
);
2001 err
= brcmf_set_wsec_mode(ndev
, sme
);
2003 brcmf_err("wl_set_set_cipher failed (%d)\n", err
);
2007 err
= brcmf_set_key_mgmt(ndev
, sme
);
2009 brcmf_err("wl_set_key_mgmt failed (%d)\n", err
);
2013 err
= brcmf_set_sharedkey(ndev
, sme
);
2015 brcmf_err("brcmf_set_sharedkey failed (%d)\n", err
);
2019 /* Join with specific BSSID and cached SSID
2020 * If SSID is zero join based on BSSID only
2022 join_params_size
= offsetof(struct brcmf_ext_join_params_le
, assoc_le
) +
2023 offsetof(struct brcmf_assoc_params_le
, chanspec_list
);
2025 join_params_size
+= sizeof(u16
);
2026 ext_join_params
= kzalloc(join_params_size
, GFP_KERNEL
);
2027 if (ext_join_params
== NULL
) {
2031 ssid_len
= min_t(u32
, sme
->ssid_len
, IEEE80211_MAX_SSID_LEN
);
2032 ext_join_params
->ssid_le
.SSID_len
= cpu_to_le32(ssid_len
);
2033 memcpy(&ext_join_params
->ssid_le
.SSID
, sme
->ssid
, ssid_len
);
2034 if (ssid_len
< IEEE80211_MAX_SSID_LEN
)
2035 brcmf_dbg(CONN
, "SSID \"%s\", len (%d)\n",
2036 ext_join_params
->ssid_le
.SSID
, ssid_len
);
2038 /* Set up join scan parameters */
2039 ext_join_params
->scan_le
.scan_type
= -1;
2040 ext_join_params
->scan_le
.home_time
= cpu_to_le32(-1);
2043 memcpy(&ext_join_params
->assoc_le
.bssid
, sme
->bssid
, ETH_ALEN
);
2045 eth_broadcast_addr(ext_join_params
->assoc_le
.bssid
);
2048 ext_join_params
->assoc_le
.chanspec_num
= cpu_to_le32(1);
2050 ext_join_params
->assoc_le
.chanspec_list
[0] =
2051 cpu_to_le16(chanspec
);
2052 /* Increase dwell time to receive probe response or detect
2053 * beacon from target AP at a noisy air only during connect
2056 ext_join_params
->scan_le
.active_time
=
2057 cpu_to_le32(BRCMF_SCAN_JOIN_ACTIVE_DWELL_TIME_MS
);
2058 ext_join_params
->scan_le
.passive_time
=
2059 cpu_to_le32(BRCMF_SCAN_JOIN_PASSIVE_DWELL_TIME_MS
);
2060 /* To sync with presence period of VSDB GO send probe request
2061 * more frequently. Probe request will be stopped when it gets
2062 * probe response from target AP/GO.
2064 ext_join_params
->scan_le
.nprobes
=
2065 cpu_to_le32(BRCMF_SCAN_JOIN_ACTIVE_DWELL_TIME_MS
/
2066 BRCMF_SCAN_JOIN_PROBE_INTERVAL_MS
);
2068 ext_join_params
->scan_le
.active_time
= cpu_to_le32(-1);
2069 ext_join_params
->scan_le
.passive_time
= cpu_to_le32(-1);
2070 ext_join_params
->scan_le
.nprobes
= cpu_to_le32(-1);
2073 brcmf_set_join_pref(ifp
, &sme
->bss_select
);
2075 err
= brcmf_fil_bsscfg_data_set(ifp
, "join", ext_join_params
,
2077 kfree(ext_join_params
);
2079 /* This is it. join command worked, we are done */
2082 /* join command failed, fallback to set ssid */
2083 memset(&join_params
, 0, sizeof(join_params
));
2084 join_params_size
= sizeof(join_params
.ssid_le
);
2086 memcpy(&join_params
.ssid_le
.SSID
, sme
->ssid
, ssid_len
);
2087 join_params
.ssid_le
.SSID_len
= cpu_to_le32(ssid_len
);
2090 memcpy(join_params
.params_le
.bssid
, sme
->bssid
, ETH_ALEN
);
2092 eth_broadcast_addr(join_params
.params_le
.bssid
);
2095 join_params
.params_le
.chanspec_list
[0] = cpu_to_le16(chanspec
);
2096 join_params
.params_le
.chanspec_num
= cpu_to_le32(1);
2097 join_params_size
+= sizeof(join_params
.params_le
);
2099 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_SET_SSID
,
2100 &join_params
, join_params_size
);
2102 brcmf_err("BRCMF_C_SET_SSID failed (%d)\n", err
);
2106 clear_bit(BRCMF_VIF_STATUS_CONNECTING
, &ifp
->vif
->sme_state
);
2107 brcmf_dbg(TRACE
, "Exit\n");
2112 brcmf_cfg80211_disconnect(struct wiphy
*wiphy
, struct net_device
*ndev
,
2115 struct brcmf_if
*ifp
= netdev_priv(ndev
);
2116 struct brcmf_cfg80211_profile
*profile
= &ifp
->vif
->profile
;
2117 struct brcmf_scb_val_le scbval
;
2120 brcmf_dbg(TRACE
, "Enter. Reason code = %d\n", reason_code
);
2121 if (!check_vif_up(ifp
->vif
))
2124 clear_bit(BRCMF_VIF_STATUS_CONNECTED
, &ifp
->vif
->sme_state
);
2125 clear_bit(BRCMF_VIF_STATUS_CONNECTING
, &ifp
->vif
->sme_state
);
2126 cfg80211_disconnected(ndev
, reason_code
, NULL
, 0, true, GFP_KERNEL
);
2128 memcpy(&scbval
.ea
, &profile
->bssid
, ETH_ALEN
);
2129 scbval
.val
= cpu_to_le32(reason_code
);
2130 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_DISASSOC
,
2131 &scbval
, sizeof(scbval
));
2133 brcmf_err("error (%d)\n", err
);
2135 brcmf_dbg(TRACE
, "Exit\n");
2140 brcmf_cfg80211_set_tx_power(struct wiphy
*wiphy
, struct wireless_dev
*wdev
,
2141 enum nl80211_tx_power_setting type
, s32 mbm
)
2143 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
2144 struct net_device
*ndev
= cfg_to_ndev(cfg
);
2145 struct brcmf_if
*ifp
= netdev_priv(ndev
);
2150 brcmf_dbg(TRACE
, "Enter %d %d\n", type
, mbm
);
2151 if (!check_vif_up(ifp
->vif
))
2155 case NL80211_TX_POWER_AUTOMATIC
:
2157 case NL80211_TX_POWER_LIMITED
:
2158 case NL80211_TX_POWER_FIXED
:
2160 brcmf_err("TX_POWER_FIXED - dbm is negative\n");
2164 qdbm
= MBM_TO_DBM(4 * mbm
);
2167 qdbm
|= WL_TXPWR_OVERRIDE
;
2170 brcmf_err("Unsupported type %d\n", type
);
2174 /* Make sure radio is off or on as far as software is concerned */
2175 disable
= WL_RADIO_SW_DISABLE
<< 16;
2176 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_RADIO
, disable
);
2178 brcmf_err("WLC_SET_RADIO error (%d)\n", err
);
2180 err
= brcmf_fil_iovar_int_set(ifp
, "qtxpower", qdbm
);
2182 brcmf_err("qtxpower error (%d)\n", err
);
2185 brcmf_dbg(TRACE
, "Exit %d (qdbm)\n", qdbm
& ~WL_TXPWR_OVERRIDE
);
2190 brcmf_cfg80211_get_tx_power(struct wiphy
*wiphy
, struct wireless_dev
*wdev
,
2193 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
2194 struct net_device
*ndev
= cfg_to_ndev(cfg
);
2195 struct brcmf_if
*ifp
= netdev_priv(ndev
);
2199 brcmf_dbg(TRACE
, "Enter\n");
2200 if (!check_vif_up(ifp
->vif
))
2203 err
= brcmf_fil_iovar_int_get(ifp
, "qtxpower", &qdbm
);
2205 brcmf_err("error (%d)\n", err
);
2208 *dbm
= (qdbm
& ~WL_TXPWR_OVERRIDE
) / 4;
2211 brcmf_dbg(TRACE
, "Exit (0x%x %d)\n", qdbm
, *dbm
);
2216 brcmf_cfg80211_config_default_key(struct wiphy
*wiphy
, struct net_device
*ndev
,
2217 u8 key_idx
, bool unicast
, bool multicast
)
2219 struct brcmf_if
*ifp
= netdev_priv(ndev
);
2224 brcmf_dbg(TRACE
, "Enter\n");
2225 brcmf_dbg(CONN
, "key index (%d)\n", key_idx
);
2226 if (!check_vif_up(ifp
->vif
))
2229 err
= brcmf_fil_bsscfg_int_get(ifp
, "wsec", &wsec
);
2231 brcmf_err("WLC_GET_WSEC error (%d)\n", err
);
2235 if (wsec
& WEP_ENABLED
) {
2236 /* Just select a new current key */
2238 err
= brcmf_fil_cmd_int_set(ifp
,
2239 BRCMF_C_SET_KEY_PRIMARY
, index
);
2241 brcmf_err("error (%d)\n", err
);
2244 brcmf_dbg(TRACE
, "Exit\n");
2249 brcmf_cfg80211_del_key(struct wiphy
*wiphy
, struct net_device
*ndev
,
2250 u8 key_idx
, bool pairwise
, const u8
*mac_addr
)
2252 struct brcmf_if
*ifp
= netdev_priv(ndev
);
2253 struct brcmf_wsec_key
*key
;
2256 brcmf_dbg(TRACE
, "Enter\n");
2257 brcmf_dbg(CONN
, "key index (%d)\n", key_idx
);
2259 if (!check_vif_up(ifp
->vif
))
2262 if (key_idx
>= BRCMF_MAX_DEFAULT_KEYS
) {
2263 /* we ignore this key index in this case */
2267 key
= &ifp
->vif
->profile
.key
[key_idx
];
2269 if (key
->algo
== CRYPTO_ALGO_OFF
) {
2270 brcmf_dbg(CONN
, "Ignore clearing of (never configured) key\n");
2274 memset(key
, 0, sizeof(*key
));
2275 key
->index
= (u32
)key_idx
;
2276 key
->flags
= BRCMF_PRIMARY_KEY
;
2278 /* Clear the key/index */
2279 err
= send_key_to_dongle(ifp
, key
);
2281 brcmf_dbg(TRACE
, "Exit\n");
2286 brcmf_cfg80211_add_key(struct wiphy
*wiphy
, struct net_device
*ndev
,
2287 u8 key_idx
, bool pairwise
, const u8
*mac_addr
,
2288 struct key_params
*params
)
2290 struct brcmf_if
*ifp
= netdev_priv(ndev
);
2291 struct brcmf_wsec_key
*key
;
2298 brcmf_dbg(TRACE
, "Enter\n");
2299 brcmf_dbg(CONN
, "key index (%d)\n", key_idx
);
2300 if (!check_vif_up(ifp
->vif
))
2303 if (key_idx
>= BRCMF_MAX_DEFAULT_KEYS
) {
2304 /* we ignore this key index in this case */
2305 brcmf_err("invalid key index (%d)\n", key_idx
);
2309 if (params
->key_len
== 0)
2310 return brcmf_cfg80211_del_key(wiphy
, ndev
, key_idx
, pairwise
,
2313 if (params
->key_len
> sizeof(key
->data
)) {
2314 brcmf_err("Too long key length (%u)\n", params
->key_len
);
2319 if (mac_addr
&& (params
->cipher
!= WLAN_CIPHER_SUITE_WEP40
) &&
2320 (params
->cipher
!= WLAN_CIPHER_SUITE_WEP104
)) {
2321 brcmf_dbg(TRACE
, "Ext key, mac %pM", mac_addr
);
2325 key
= &ifp
->vif
->profile
.key
[key_idx
];
2326 memset(key
, 0, sizeof(*key
));
2327 if ((ext_key
) && (!is_multicast_ether_addr(mac_addr
)))
2328 memcpy((char *)&key
->ea
, (void *)mac_addr
, ETH_ALEN
);
2329 key
->len
= params
->key_len
;
2330 key
->index
= key_idx
;
2331 memcpy(key
->data
, params
->key
, key
->len
);
2333 key
->flags
= BRCMF_PRIMARY_KEY
;
2335 switch (params
->cipher
) {
2336 case WLAN_CIPHER_SUITE_WEP40
:
2337 key
->algo
= CRYPTO_ALGO_WEP1
;
2339 brcmf_dbg(CONN
, "WLAN_CIPHER_SUITE_WEP40\n");
2341 case WLAN_CIPHER_SUITE_WEP104
:
2342 key
->algo
= CRYPTO_ALGO_WEP128
;
2344 brcmf_dbg(CONN
, "WLAN_CIPHER_SUITE_WEP104\n");
2346 case WLAN_CIPHER_SUITE_TKIP
:
2347 if (!brcmf_is_apmode(ifp
->vif
)) {
2348 brcmf_dbg(CONN
, "Swapping RX/TX MIC key\n");
2349 memcpy(keybuf
, &key
->data
[24], sizeof(keybuf
));
2350 memcpy(&key
->data
[24], &key
->data
[16], sizeof(keybuf
));
2351 memcpy(&key
->data
[16], keybuf
, sizeof(keybuf
));
2353 key
->algo
= CRYPTO_ALGO_TKIP
;
2355 brcmf_dbg(CONN
, "WLAN_CIPHER_SUITE_TKIP\n");
2357 case WLAN_CIPHER_SUITE_AES_CMAC
:
2358 key
->algo
= CRYPTO_ALGO_AES_CCM
;
2360 brcmf_dbg(CONN
, "WLAN_CIPHER_SUITE_AES_CMAC\n");
2362 case WLAN_CIPHER_SUITE_CCMP
:
2363 key
->algo
= CRYPTO_ALGO_AES_CCM
;
2365 brcmf_dbg(CONN
, "WLAN_CIPHER_SUITE_CCMP\n");
2368 brcmf_err("Invalid cipher (0x%x)\n", params
->cipher
);
2373 err
= send_key_to_dongle(ifp
, key
);
2377 err
= brcmf_fil_bsscfg_int_get(ifp
, "wsec", &wsec
);
2379 brcmf_err("get wsec error (%d)\n", err
);
2383 err
= brcmf_fil_bsscfg_int_set(ifp
, "wsec", wsec
);
2385 brcmf_err("set wsec error (%d)\n", err
);
2390 brcmf_dbg(TRACE
, "Exit\n");
2395 brcmf_cfg80211_get_key(struct wiphy
*wiphy
, struct net_device
*ndev
, u8 key_idx
,
2396 bool pairwise
, const u8
*mac_addr
, void *cookie
,
2397 void (*callback
)(void *cookie
,
2398 struct key_params
*params
))
2400 struct key_params params
;
2401 struct brcmf_if
*ifp
= netdev_priv(ndev
);
2402 struct brcmf_cfg80211_profile
*profile
= &ifp
->vif
->profile
;
2403 struct brcmf_cfg80211_security
*sec
;
2407 brcmf_dbg(TRACE
, "Enter\n");
2408 brcmf_dbg(CONN
, "key index (%d)\n", key_idx
);
2409 if (!check_vif_up(ifp
->vif
))
2412 memset(¶ms
, 0, sizeof(params
));
2414 err
= brcmf_fil_bsscfg_int_get(ifp
, "wsec", &wsec
);
2416 brcmf_err("WLC_GET_WSEC error (%d)\n", err
);
2417 /* Ignore this error, may happen during DISASSOC */
2421 if (wsec
& WEP_ENABLED
) {
2422 sec
= &profile
->sec
;
2423 if (sec
->cipher_pairwise
& WLAN_CIPHER_SUITE_WEP40
) {
2424 params
.cipher
= WLAN_CIPHER_SUITE_WEP40
;
2425 brcmf_dbg(CONN
, "WLAN_CIPHER_SUITE_WEP40\n");
2426 } else if (sec
->cipher_pairwise
& WLAN_CIPHER_SUITE_WEP104
) {
2427 params
.cipher
= WLAN_CIPHER_SUITE_WEP104
;
2428 brcmf_dbg(CONN
, "WLAN_CIPHER_SUITE_WEP104\n");
2430 } else if (wsec
& TKIP_ENABLED
) {
2431 params
.cipher
= WLAN_CIPHER_SUITE_TKIP
;
2432 brcmf_dbg(CONN
, "WLAN_CIPHER_SUITE_TKIP\n");
2433 } else if (wsec
& AES_ENABLED
) {
2434 params
.cipher
= WLAN_CIPHER_SUITE_AES_CMAC
;
2435 brcmf_dbg(CONN
, "WLAN_CIPHER_SUITE_AES_CMAC\n");
2437 brcmf_err("Invalid algo (0x%x)\n", wsec
);
2441 callback(cookie
, ¶ms
);
2444 brcmf_dbg(TRACE
, "Exit\n");
2449 brcmf_cfg80211_config_default_mgmt_key(struct wiphy
*wiphy
,
2450 struct net_device
*ndev
, u8 key_idx
)
2452 struct brcmf_if
*ifp
= netdev_priv(ndev
);
2454 brcmf_dbg(TRACE
, "Enter key_idx %d\n", key_idx
);
2456 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_MFP
))
2459 brcmf_dbg(INFO
, "Not supported\n");
2465 brcmf_cfg80211_reconfigure_wep(struct brcmf_if
*ifp
)
2469 struct brcmf_wsec_key
*key
;
2472 for (key_idx
= 0; key_idx
< BRCMF_MAX_DEFAULT_KEYS
; key_idx
++) {
2473 key
= &ifp
->vif
->profile
.key
[key_idx
];
2474 if ((key
->algo
== CRYPTO_ALGO_WEP1
) ||
2475 (key
->algo
== CRYPTO_ALGO_WEP128
))
2478 if (key_idx
== BRCMF_MAX_DEFAULT_KEYS
)
2481 err
= send_key_to_dongle(ifp
, key
);
2483 brcmf_err("Setting WEP key failed (%d)\n", err
);
2486 err
= brcmf_fil_bsscfg_int_get(ifp
, "wsec", &wsec
);
2488 brcmf_err("get wsec error (%d)\n", err
);
2491 wsec
|= WEP_ENABLED
;
2492 err
= brcmf_fil_bsscfg_int_set(ifp
, "wsec", wsec
);
2494 brcmf_err("set wsec error (%d)\n", err
);
2497 static void brcmf_convert_sta_flags(u32 fw_sta_flags
, struct station_info
*si
)
2499 struct nl80211_sta_flag_update
*sfu
;
2501 brcmf_dbg(TRACE
, "flags %08x\n", fw_sta_flags
);
2502 si
->filled
|= BIT(NL80211_STA_INFO_STA_FLAGS
);
2503 sfu
= &si
->sta_flags
;
2504 sfu
->mask
= BIT(NL80211_STA_FLAG_WME
) |
2505 BIT(NL80211_STA_FLAG_AUTHENTICATED
) |
2506 BIT(NL80211_STA_FLAG_ASSOCIATED
) |
2507 BIT(NL80211_STA_FLAG_AUTHORIZED
);
2508 if (fw_sta_flags
& BRCMF_STA_WME
)
2509 sfu
->set
|= BIT(NL80211_STA_FLAG_WME
);
2510 if (fw_sta_flags
& BRCMF_STA_AUTHE
)
2511 sfu
->set
|= BIT(NL80211_STA_FLAG_AUTHENTICATED
);
2512 if (fw_sta_flags
& BRCMF_STA_ASSOC
)
2513 sfu
->set
|= BIT(NL80211_STA_FLAG_ASSOCIATED
);
2514 if (fw_sta_flags
& BRCMF_STA_AUTHO
)
2515 sfu
->set
|= BIT(NL80211_STA_FLAG_AUTHORIZED
);
2518 static void brcmf_fill_bss_param(struct brcmf_if
*ifp
, struct station_info
*si
)
2522 struct brcmf_bss_info_le bss_le
;
2527 buf
= kzalloc(WL_BSS_INFO_MAX
, GFP_KERNEL
);
2531 buf
->len
= cpu_to_le32(WL_BSS_INFO_MAX
);
2532 err
= brcmf_fil_cmd_data_get(ifp
, BRCMF_C_GET_BSS_INFO
, buf
,
2535 brcmf_err("Failed to get bss info (%d)\n", err
);
2538 si
->filled
|= BIT(NL80211_STA_INFO_BSS_PARAM
);
2539 si
->bss_param
.beacon_interval
= le16_to_cpu(buf
->bss_le
.beacon_period
);
2540 si
->bss_param
.dtim_period
= buf
->bss_le
.dtim_period
;
2541 capability
= le16_to_cpu(buf
->bss_le
.capability
);
2542 if (capability
& IEEE80211_HT_STBC_PARAM_DUAL_CTS_PROT
)
2543 si
->bss_param
.flags
|= BSS_PARAM_FLAGS_CTS_PROT
;
2544 if (capability
& WLAN_CAPABILITY_SHORT_PREAMBLE
)
2545 si
->bss_param
.flags
|= BSS_PARAM_FLAGS_SHORT_PREAMBLE
;
2546 if (capability
& WLAN_CAPABILITY_SHORT_SLOT_TIME
)
2547 si
->bss_param
.flags
|= BSS_PARAM_FLAGS_SHORT_SLOT_TIME
;
2551 brcmf_cfg80211_get_station_ibss(struct brcmf_if
*ifp
,
2552 struct station_info
*sinfo
)
2554 struct brcmf_scb_val_le scbval
;
2555 struct brcmf_pktcnt_le pktcnt
;
2560 /* Get the current tx rate */
2561 err
= brcmf_fil_cmd_int_get(ifp
, BRCMF_C_GET_RATE
, &rate
);
2563 brcmf_err("BRCMF_C_GET_RATE error (%d)\n", err
);
2566 sinfo
->filled
|= BIT(NL80211_STA_INFO_TX_BITRATE
);
2567 sinfo
->txrate
.legacy
= rate
* 5;
2569 memset(&scbval
, 0, sizeof(scbval
));
2570 err
= brcmf_fil_cmd_data_get(ifp
, BRCMF_C_GET_RSSI
, &scbval
,
2573 brcmf_err("BRCMF_C_GET_RSSI error (%d)\n", err
);
2576 rssi
= le32_to_cpu(scbval
.val
);
2577 sinfo
->filled
|= BIT(NL80211_STA_INFO_SIGNAL
);
2578 sinfo
->signal
= rssi
;
2580 err
= brcmf_fil_cmd_data_get(ifp
, BRCMF_C_GET_GET_PKTCNTS
, &pktcnt
,
2583 brcmf_err("BRCMF_C_GET_GET_PKTCNTS error (%d)\n", err
);
2586 sinfo
->filled
|= BIT(NL80211_STA_INFO_RX_PACKETS
) |
2587 BIT(NL80211_STA_INFO_RX_DROP_MISC
) |
2588 BIT(NL80211_STA_INFO_TX_PACKETS
) |
2589 BIT(NL80211_STA_INFO_TX_FAILED
);
2590 sinfo
->rx_packets
= le32_to_cpu(pktcnt
.rx_good_pkt
);
2591 sinfo
->rx_dropped_misc
= le32_to_cpu(pktcnt
.rx_bad_pkt
);
2592 sinfo
->tx_packets
= le32_to_cpu(pktcnt
.tx_good_pkt
);
2593 sinfo
->tx_failed
= le32_to_cpu(pktcnt
.tx_bad_pkt
);
2599 brcmf_cfg80211_get_station(struct wiphy
*wiphy
, struct net_device
*ndev
,
2600 const u8
*mac
, struct station_info
*sinfo
)
2602 struct brcmf_if
*ifp
= netdev_priv(ndev
);
2603 struct brcmf_scb_val_le scb_val
;
2605 struct brcmf_sta_info_le sta_info_le
;
2613 brcmf_dbg(TRACE
, "Enter, MAC %pM\n", mac
);
2614 if (!check_vif_up(ifp
->vif
))
2617 if (brcmf_is_ibssmode(ifp
->vif
))
2618 return brcmf_cfg80211_get_station_ibss(ifp
, sinfo
);
2620 memset(&sta_info_le
, 0, sizeof(sta_info_le
));
2621 memcpy(&sta_info_le
, mac
, ETH_ALEN
);
2622 err
= brcmf_fil_iovar_data_get(ifp
, "tdls_sta_info",
2624 sizeof(sta_info_le
));
2625 is_tdls_peer
= !err
;
2627 err
= brcmf_fil_iovar_data_get(ifp
, "sta_info",
2629 sizeof(sta_info_le
));
2631 brcmf_err("GET STA INFO failed, %d\n", err
);
2635 brcmf_dbg(TRACE
, "version %d\n", le16_to_cpu(sta_info_le
.ver
));
2636 sinfo
->filled
= BIT(NL80211_STA_INFO_INACTIVE_TIME
);
2637 sinfo
->inactive_time
= le32_to_cpu(sta_info_le
.idle
) * 1000;
2638 sta_flags
= le32_to_cpu(sta_info_le
.flags
);
2639 brcmf_convert_sta_flags(sta_flags
, sinfo
);
2640 sinfo
->sta_flags
.mask
|= BIT(NL80211_STA_FLAG_TDLS_PEER
);
2642 sinfo
->sta_flags
.set
|= BIT(NL80211_STA_FLAG_TDLS_PEER
);
2644 sinfo
->sta_flags
.set
&= ~BIT(NL80211_STA_FLAG_TDLS_PEER
);
2645 if (sta_flags
& BRCMF_STA_ASSOC
) {
2646 sinfo
->filled
|= BIT(NL80211_STA_INFO_CONNECTED_TIME
);
2647 sinfo
->connected_time
= le32_to_cpu(sta_info_le
.in
);
2648 brcmf_fill_bss_param(ifp
, sinfo
);
2650 if (sta_flags
& BRCMF_STA_SCBSTATS
) {
2651 sinfo
->filled
|= BIT(NL80211_STA_INFO_TX_FAILED
);
2652 sinfo
->tx_failed
= le32_to_cpu(sta_info_le
.tx_failures
);
2653 sinfo
->filled
|= BIT(NL80211_STA_INFO_TX_PACKETS
);
2654 sinfo
->tx_packets
= le32_to_cpu(sta_info_le
.tx_pkts
);
2655 sinfo
->tx_packets
+= le32_to_cpu(sta_info_le
.tx_mcast_pkts
);
2656 sinfo
->filled
|= BIT(NL80211_STA_INFO_RX_PACKETS
);
2657 sinfo
->rx_packets
= le32_to_cpu(sta_info_le
.rx_ucast_pkts
);
2658 sinfo
->rx_packets
+= le32_to_cpu(sta_info_le
.rx_mcast_pkts
);
2659 if (sinfo
->tx_packets
) {
2660 sinfo
->filled
|= BIT(NL80211_STA_INFO_TX_BITRATE
);
2661 sinfo
->txrate
.legacy
=
2662 le32_to_cpu(sta_info_le
.tx_rate
) / 100;
2664 if (sinfo
->rx_packets
) {
2665 sinfo
->filled
|= BIT(NL80211_STA_INFO_RX_BITRATE
);
2666 sinfo
->rxrate
.legacy
=
2667 le32_to_cpu(sta_info_le
.rx_rate
) / 100;
2669 if (le16_to_cpu(sta_info_le
.ver
) >= 4) {
2670 sinfo
->filled
|= BIT(NL80211_STA_INFO_TX_BYTES
);
2671 sinfo
->tx_bytes
= le64_to_cpu(sta_info_le
.tx_tot_bytes
);
2672 sinfo
->filled
|= BIT(NL80211_STA_INFO_RX_BYTES
);
2673 sinfo
->rx_bytes
= le64_to_cpu(sta_info_le
.rx_tot_bytes
);
2677 for (i
= 0; i
< BRCMF_ANT_MAX
; i
++) {
2678 if (sta_info_le
.rssi
[i
]) {
2679 sinfo
->chain_signal_avg
[count_rssi
] =
2680 sta_info_le
.rssi
[i
];
2681 sinfo
->chain_signal
[count_rssi
] =
2682 sta_info_le
.rssi
[i
];
2683 total_rssi
+= sta_info_le
.rssi
[i
];
2688 sinfo
->filled
|= BIT(NL80211_STA_INFO_CHAIN_SIGNAL
);
2689 sinfo
->chains
= count_rssi
;
2691 sinfo
->filled
|= BIT(NL80211_STA_INFO_SIGNAL
);
2692 total_rssi
/= count_rssi
;
2693 sinfo
->signal
= total_rssi
;
2694 } else if (test_bit(BRCMF_VIF_STATUS_CONNECTED
,
2695 &ifp
->vif
->sme_state
)) {
2696 memset(&scb_val
, 0, sizeof(scb_val
));
2697 err
= brcmf_fil_cmd_data_get(ifp
, BRCMF_C_GET_RSSI
,
2698 &scb_val
, sizeof(scb_val
));
2700 brcmf_err("Could not get rssi (%d)\n", err
);
2703 rssi
= le32_to_cpu(scb_val
.val
);
2704 sinfo
->filled
|= BIT(NL80211_STA_INFO_SIGNAL
);
2705 sinfo
->signal
= rssi
;
2706 brcmf_dbg(CONN
, "RSSI %d dBm\n", rssi
);
2711 brcmf_dbg(TRACE
, "Exit\n");
2716 brcmf_cfg80211_dump_station(struct wiphy
*wiphy
, struct net_device
*ndev
,
2717 int idx
, u8
*mac
, struct station_info
*sinfo
)
2719 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
2720 struct brcmf_if
*ifp
= netdev_priv(ndev
);
2723 brcmf_dbg(TRACE
, "Enter, idx %d\n", idx
);
2726 cfg
->assoclist
.count
= cpu_to_le32(BRCMF_MAX_ASSOCLIST
);
2727 err
= brcmf_fil_cmd_data_get(ifp
, BRCMF_C_GET_ASSOCLIST
,
2729 sizeof(cfg
->assoclist
));
2731 brcmf_err("BRCMF_C_GET_ASSOCLIST unsupported, err=%d\n",
2733 cfg
->assoclist
.count
= 0;
2737 if (idx
< le32_to_cpu(cfg
->assoclist
.count
)) {
2738 memcpy(mac
, cfg
->assoclist
.mac
[idx
], ETH_ALEN
);
2739 return brcmf_cfg80211_get_station(wiphy
, ndev
, mac
, sinfo
);
2745 brcmf_cfg80211_set_power_mgmt(struct wiphy
*wiphy
, struct net_device
*ndev
,
2746 bool enabled
, s32 timeout
)
2750 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
2751 struct brcmf_if
*ifp
= netdev_priv(ndev
);
2753 brcmf_dbg(TRACE
, "Enter\n");
2756 * Powersave enable/disable request is coming from the
2757 * cfg80211 even before the interface is up. In that
2758 * scenario, driver will be storing the power save
2759 * preference in cfg struct to apply this to
2760 * FW later while initializing the dongle
2762 cfg
->pwr_save
= enabled
;
2763 if (!check_vif_up(ifp
->vif
)) {
2765 brcmf_dbg(INFO
, "Device is not ready, storing the value in cfg_info struct\n");
2769 pm
= enabled
? PM_FAST
: PM_OFF
;
2770 /* Do not enable the power save after assoc if it is a p2p interface */
2771 if (ifp
->vif
->wdev
.iftype
== NL80211_IFTYPE_P2P_CLIENT
) {
2772 brcmf_dbg(INFO
, "Do not enable power save for P2P clients\n");
2775 brcmf_dbg(INFO
, "power save %s\n", (pm
? "enabled" : "disabled"));
2777 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_PM
, pm
);
2780 brcmf_err("net_device is not ready yet\n");
2782 brcmf_err("error (%d)\n", err
);
2785 brcmf_dbg(TRACE
, "Exit\n");
2789 static s32
brcmf_inform_single_bss(struct brcmf_cfg80211_info
*cfg
,
2790 struct brcmf_bss_info_le
*bi
)
2792 struct wiphy
*wiphy
= cfg_to_wiphy(cfg
);
2793 struct ieee80211_channel
*notify_channel
;
2794 struct cfg80211_bss
*bss
;
2795 struct ieee80211_supported_band
*band
;
2796 struct brcmu_chan ch
;
2799 u16 notify_capability
;
2800 u16 notify_interval
;
2802 size_t notify_ielen
;
2805 if (le32_to_cpu(bi
->length
) > WL_BSS_INFO_MAX
) {
2806 brcmf_err("Bss info is larger than buffer. Discarding\n");
2811 ch
.chspec
= le16_to_cpu(bi
->chanspec
);
2812 cfg
->d11inf
.decchspec(&ch
);
2813 bi
->ctl_ch
= ch
.control_ch_num
;
2815 channel
= bi
->ctl_ch
;
2817 if (channel
<= CH_MAX_2G_CHANNEL
)
2818 band
= wiphy
->bands
[NL80211_BAND_2GHZ
];
2820 band
= wiphy
->bands
[NL80211_BAND_5GHZ
];
2822 freq
= ieee80211_channel_to_frequency(channel
, band
->band
);
2823 notify_channel
= ieee80211_get_channel(wiphy
, freq
);
2825 notify_capability
= le16_to_cpu(bi
->capability
);
2826 notify_interval
= le16_to_cpu(bi
->beacon_period
);
2827 notify_ie
= (u8
*)bi
+ le16_to_cpu(bi
->ie_offset
);
2828 notify_ielen
= le32_to_cpu(bi
->ie_length
);
2829 notify_signal
= (s16
)le16_to_cpu(bi
->RSSI
) * 100;
2831 brcmf_dbg(CONN
, "bssid: %pM\n", bi
->BSSID
);
2832 brcmf_dbg(CONN
, "Channel: %d(%d)\n", channel
, freq
);
2833 brcmf_dbg(CONN
, "Capability: %X\n", notify_capability
);
2834 brcmf_dbg(CONN
, "Beacon interval: %d\n", notify_interval
);
2835 brcmf_dbg(CONN
, "Signal: %d\n", notify_signal
);
2837 bss
= cfg80211_inform_bss(wiphy
, notify_channel
,
2838 CFG80211_BSS_FTYPE_UNKNOWN
,
2839 (const u8
*)bi
->BSSID
,
2840 0, notify_capability
,
2841 notify_interval
, notify_ie
,
2842 notify_ielen
, notify_signal
,
2848 cfg80211_put_bss(wiphy
, bss
);
2853 static struct brcmf_bss_info_le
*
2854 next_bss_le(struct brcmf_scan_results
*list
, struct brcmf_bss_info_le
*bss
)
2857 return list
->bss_info_le
;
2858 return (struct brcmf_bss_info_le
*)((unsigned long)bss
+
2859 le32_to_cpu(bss
->length
));
2862 static s32
brcmf_inform_bss(struct brcmf_cfg80211_info
*cfg
)
2864 struct brcmf_scan_results
*bss_list
;
2865 struct brcmf_bss_info_le
*bi
= NULL
; /* must be initialized */
2869 bss_list
= (struct brcmf_scan_results
*)cfg
->escan_info
.escan_buf
;
2870 if (bss_list
->count
!= 0 &&
2871 bss_list
->version
!= BRCMF_BSS_INFO_VERSION
) {
2872 brcmf_err("Version %d != WL_BSS_INFO_VERSION\n",
2876 brcmf_dbg(SCAN
, "scanned AP count (%d)\n", bss_list
->count
);
2877 for (i
= 0; i
< bss_list
->count
; i
++) {
2878 bi
= next_bss_le(bss_list
, bi
);
2879 err
= brcmf_inform_single_bss(cfg
, bi
);
2886 static s32
brcmf_inform_ibss(struct brcmf_cfg80211_info
*cfg
,
2887 struct net_device
*ndev
, const u8
*bssid
)
2889 struct wiphy
*wiphy
= cfg_to_wiphy(cfg
);
2890 struct ieee80211_channel
*notify_channel
;
2891 struct brcmf_bss_info_le
*bi
= NULL
;
2892 struct ieee80211_supported_band
*band
;
2893 struct cfg80211_bss
*bss
;
2894 struct brcmu_chan ch
;
2898 u16 notify_capability
;
2899 u16 notify_interval
;
2901 size_t notify_ielen
;
2904 brcmf_dbg(TRACE
, "Enter\n");
2906 buf
= kzalloc(WL_BSS_INFO_MAX
, GFP_KERNEL
);
2912 *(__le32
*)buf
= cpu_to_le32(WL_BSS_INFO_MAX
);
2914 err
= brcmf_fil_cmd_data_get(netdev_priv(ndev
), BRCMF_C_GET_BSS_INFO
,
2915 buf
, WL_BSS_INFO_MAX
);
2917 brcmf_err("WLC_GET_BSS_INFO failed: %d\n", err
);
2921 bi
= (struct brcmf_bss_info_le
*)(buf
+ 4);
2923 ch
.chspec
= le16_to_cpu(bi
->chanspec
);
2924 cfg
->d11inf
.decchspec(&ch
);
2926 if (ch
.band
== BRCMU_CHAN_BAND_2G
)
2927 band
= wiphy
->bands
[NL80211_BAND_2GHZ
];
2929 band
= wiphy
->bands
[NL80211_BAND_5GHZ
];
2931 freq
= ieee80211_channel_to_frequency(ch
.control_ch_num
, band
->band
);
2932 cfg
->channel
= freq
;
2933 notify_channel
= ieee80211_get_channel(wiphy
, freq
);
2935 notify_capability
= le16_to_cpu(bi
->capability
);
2936 notify_interval
= le16_to_cpu(bi
->beacon_period
);
2937 notify_ie
= (u8
*)bi
+ le16_to_cpu(bi
->ie_offset
);
2938 notify_ielen
= le32_to_cpu(bi
->ie_length
);
2939 notify_signal
= (s16
)le16_to_cpu(bi
->RSSI
) * 100;
2941 brcmf_dbg(CONN
, "channel: %d(%d)\n", ch
.control_ch_num
, freq
);
2942 brcmf_dbg(CONN
, "capability: %X\n", notify_capability
);
2943 brcmf_dbg(CONN
, "beacon interval: %d\n", notify_interval
);
2944 brcmf_dbg(CONN
, "signal: %d\n", notify_signal
);
2946 bss
= cfg80211_inform_bss(wiphy
, notify_channel
,
2947 CFG80211_BSS_FTYPE_UNKNOWN
, bssid
, 0,
2948 notify_capability
, notify_interval
,
2949 notify_ie
, notify_ielen
, notify_signal
,
2957 cfg80211_put_bss(wiphy
, bss
);
2963 brcmf_dbg(TRACE
, "Exit\n");
2968 static s32
brcmf_update_bss_info(struct brcmf_cfg80211_info
*cfg
,
2969 struct brcmf_if
*ifp
)
2971 struct brcmf_bss_info_le
*bi
;
2972 const struct brcmf_tlv
*tim
;
2973 u16 beacon_interval
;
2979 brcmf_dbg(TRACE
, "Enter\n");
2980 if (brcmf_is_ibssmode(ifp
->vif
))
2983 *(__le32
*)cfg
->extra_buf
= cpu_to_le32(WL_EXTRA_BUF_MAX
);
2984 err
= brcmf_fil_cmd_data_get(ifp
, BRCMF_C_GET_BSS_INFO
,
2985 cfg
->extra_buf
, WL_EXTRA_BUF_MAX
);
2987 brcmf_err("Could not get bss info %d\n", err
);
2988 goto update_bss_info_out
;
2991 bi
= (struct brcmf_bss_info_le
*)(cfg
->extra_buf
+ 4);
2992 err
= brcmf_inform_single_bss(cfg
, bi
);
2994 goto update_bss_info_out
;
2996 ie
= ((u8
*)bi
) + le16_to_cpu(bi
->ie_offset
);
2997 ie_len
= le32_to_cpu(bi
->ie_length
);
2998 beacon_interval
= le16_to_cpu(bi
->beacon_period
);
3000 tim
= brcmf_parse_tlvs(ie
, ie_len
, WLAN_EID_TIM
);
3002 dtim_period
= tim
->data
[1];
3005 * active scan was done so we could not get dtim
3006 * information out of probe response.
3007 * so we speficially query dtim information to dongle.
3010 err
= brcmf_fil_iovar_int_get(ifp
, "dtim_assoc", &var
);
3012 brcmf_err("wl dtim_assoc failed (%d)\n", err
);
3013 goto update_bss_info_out
;
3015 dtim_period
= (u8
)var
;
3018 update_bss_info_out
:
3019 brcmf_dbg(TRACE
, "Exit");
3023 void brcmf_abort_scanning(struct brcmf_cfg80211_info
*cfg
)
3025 struct escan_info
*escan
= &cfg
->escan_info
;
3027 set_bit(BRCMF_SCAN_STATUS_ABORT
, &cfg
->scan_status
);
3028 if (cfg
->scan_request
) {
3029 escan
->escan_state
= WL_ESCAN_STATE_IDLE
;
3030 brcmf_notify_escan_complete(cfg
, escan
->ifp
, true, true);
3032 clear_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
);
3033 clear_bit(BRCMF_SCAN_STATUS_ABORT
, &cfg
->scan_status
);
3036 static void brcmf_cfg80211_escan_timeout_worker(struct work_struct
*work
)
3038 struct brcmf_cfg80211_info
*cfg
=
3039 container_of(work
, struct brcmf_cfg80211_info
,
3040 escan_timeout_work
);
3042 brcmf_inform_bss(cfg
);
3043 brcmf_notify_escan_complete(cfg
, cfg
->escan_info
.ifp
, true, true);
3046 static void brcmf_escan_timeout(unsigned long data
)
3048 struct brcmf_cfg80211_info
*cfg
=
3049 (struct brcmf_cfg80211_info
*)data
;
3051 if (cfg
->scan_request
) {
3052 brcmf_err("timer expired\n");
3053 schedule_work(&cfg
->escan_timeout_work
);
3058 brcmf_compare_update_same_bss(struct brcmf_cfg80211_info
*cfg
,
3059 struct brcmf_bss_info_le
*bss
,
3060 struct brcmf_bss_info_le
*bss_info_le
)
3062 struct brcmu_chan ch_bss
, ch_bss_info_le
;
3064 ch_bss
.chspec
= le16_to_cpu(bss
->chanspec
);
3065 cfg
->d11inf
.decchspec(&ch_bss
);
3066 ch_bss_info_le
.chspec
= le16_to_cpu(bss_info_le
->chanspec
);
3067 cfg
->d11inf
.decchspec(&ch_bss_info_le
);
3069 if (!memcmp(&bss_info_le
->BSSID
, &bss
->BSSID
, ETH_ALEN
) &&
3070 ch_bss
.band
== ch_bss_info_le
.band
&&
3071 bss_info_le
->SSID_len
== bss
->SSID_len
&&
3072 !memcmp(bss_info_le
->SSID
, bss
->SSID
, bss_info_le
->SSID_len
)) {
3073 if ((bss
->flags
& BRCMF_BSS_RSSI_ON_CHANNEL
) ==
3074 (bss_info_le
->flags
& BRCMF_BSS_RSSI_ON_CHANNEL
)) {
3075 s16 bss_rssi
= le16_to_cpu(bss
->RSSI
);
3076 s16 bss_info_rssi
= le16_to_cpu(bss_info_le
->RSSI
);
3078 /* preserve max RSSI if the measurements are
3079 * both on-channel or both off-channel
3081 if (bss_info_rssi
> bss_rssi
)
3082 bss
->RSSI
= bss_info_le
->RSSI
;
3083 } else if ((bss
->flags
& BRCMF_BSS_RSSI_ON_CHANNEL
) &&
3084 (bss_info_le
->flags
& BRCMF_BSS_RSSI_ON_CHANNEL
) == 0) {
3085 /* preserve the on-channel rssi measurement
3086 * if the new measurement is off channel
3088 bss
->RSSI
= bss_info_le
->RSSI
;
3089 bss
->flags
|= BRCMF_BSS_RSSI_ON_CHANNEL
;
3097 brcmf_cfg80211_escan_handler(struct brcmf_if
*ifp
,
3098 const struct brcmf_event_msg
*e
, void *data
)
3100 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
3102 struct brcmf_escan_result_le
*escan_result_le
;
3103 struct brcmf_bss_info_le
*bss_info_le
;
3104 struct brcmf_bss_info_le
*bss
= NULL
;
3106 struct brcmf_scan_results
*list
;
3112 if (!test_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
)) {
3113 brcmf_err("scan not ready, bsscfgidx=%d\n", ifp
->bsscfgidx
);
3117 if (status
== BRCMF_E_STATUS_PARTIAL
) {
3118 brcmf_dbg(SCAN
, "ESCAN Partial result\n");
3119 escan_result_le
= (struct brcmf_escan_result_le
*) data
;
3120 if (!escan_result_le
) {
3121 brcmf_err("Invalid escan result (NULL pointer)\n");
3124 if (le16_to_cpu(escan_result_le
->bss_count
) != 1) {
3125 brcmf_err("Invalid bss_count %d: ignoring\n",
3126 escan_result_le
->bss_count
);
3129 bss_info_le
= &escan_result_le
->bss_info_le
;
3131 if (brcmf_p2p_scan_finding_common_channel(cfg
, bss_info_le
))
3134 if (!cfg
->scan_request
) {
3135 brcmf_dbg(SCAN
, "result without cfg80211 request\n");
3139 bi_length
= le32_to_cpu(bss_info_le
->length
);
3140 if (bi_length
!= (le32_to_cpu(escan_result_le
->buflen
) -
3141 WL_ESCAN_RESULTS_FIXED_SIZE
)) {
3142 brcmf_err("Invalid bss_info length %d: ignoring\n",
3147 if (!(cfg_to_wiphy(cfg
)->interface_modes
&
3148 BIT(NL80211_IFTYPE_ADHOC
))) {
3149 if (le16_to_cpu(bss_info_le
->capability
) &
3150 WLAN_CAPABILITY_IBSS
) {
3151 brcmf_err("Ignoring IBSS result\n");
3156 list
= (struct brcmf_scan_results
*)
3157 cfg
->escan_info
.escan_buf
;
3158 if (bi_length
> BRCMF_ESCAN_BUF_SIZE
- list
->buflen
) {
3159 brcmf_err("Buffer is too small: ignoring\n");
3163 for (i
= 0; i
< list
->count
; i
++) {
3164 bss
= bss
? (struct brcmf_bss_info_le
*)
3165 ((unsigned char *)bss
+
3166 le32_to_cpu(bss
->length
)) : list
->bss_info_le
;
3167 if (brcmf_compare_update_same_bss(cfg
, bss
,
3171 memcpy(&cfg
->escan_info
.escan_buf
[list
->buflen
], bss_info_le
,
3173 list
->version
= le32_to_cpu(bss_info_le
->version
);
3174 list
->buflen
+= bi_length
;
3177 cfg
->escan_info
.escan_state
= WL_ESCAN_STATE_IDLE
;
3178 if (brcmf_p2p_scan_finding_common_channel(cfg
, NULL
))
3180 if (cfg
->scan_request
) {
3181 brcmf_inform_bss(cfg
);
3182 aborted
= status
!= BRCMF_E_STATUS_SUCCESS
;
3183 brcmf_notify_escan_complete(cfg
, ifp
, aborted
, false);
3185 brcmf_dbg(SCAN
, "Ignored scan complete result 0x%x\n",
3192 static void brcmf_init_escan(struct brcmf_cfg80211_info
*cfg
)
3194 brcmf_fweh_register(cfg
->pub
, BRCMF_E_ESCAN_RESULT
,
3195 brcmf_cfg80211_escan_handler
);
3196 cfg
->escan_info
.escan_state
= WL_ESCAN_STATE_IDLE
;
3197 /* Init scan_timeout timer */
3198 init_timer(&cfg
->escan_timeout
);
3199 cfg
->escan_timeout
.data
= (unsigned long) cfg
;
3200 cfg
->escan_timeout
.function
= brcmf_escan_timeout
;
3201 INIT_WORK(&cfg
->escan_timeout_work
,
3202 brcmf_cfg80211_escan_timeout_worker
);
3205 /* PFN result doesn't have all the info which are required by the supplicant
3206 * (For e.g IEs) Do a target Escan so that sched scan results are reported
3207 * via wl_inform_single_bss in the required format. Escan does require the
3208 * scan request in the form of cfg80211_scan_request. For timebeing, create
3209 * cfg80211_scan_request one out of the received PNO event.
3212 brcmf_notify_sched_scan_results(struct brcmf_if
*ifp
,
3213 const struct brcmf_event_msg
*e
, void *data
)
3215 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
3216 struct brcmf_pno_net_info_le
*netinfo
, *netinfo_start
;
3217 struct cfg80211_scan_request
*request
= NULL
;
3218 struct cfg80211_ssid
*ssid
= NULL
;
3219 struct ieee80211_channel
*channel
= NULL
;
3220 struct wiphy
*wiphy
= cfg_to_wiphy(cfg
);
3222 int channel_req
= 0;
3224 struct brcmf_pno_scanresults_le
*pfn_result
;
3228 brcmf_dbg(SCAN
, "Enter\n");
3230 if (e
->datalen
< (sizeof(*pfn_result
) + sizeof(*netinfo
))) {
3231 brcmf_dbg(SCAN
, "Event data to small. Ignore\n");
3235 if (e
->event_code
== BRCMF_E_PFN_NET_LOST
) {
3236 brcmf_dbg(SCAN
, "PFN NET LOST event. Do Nothing\n");
3240 pfn_result
= (struct brcmf_pno_scanresults_le
*)data
;
3241 result_count
= le32_to_cpu(pfn_result
->count
);
3242 status
= le32_to_cpu(pfn_result
->status
);
3244 /* PFN event is limited to fit 512 bytes so we may get
3245 * multiple NET_FOUND events. For now place a warning here.
3247 WARN_ON(status
!= BRCMF_PNO_SCAN_COMPLETE
);
3248 brcmf_dbg(SCAN
, "PFN NET FOUND event. count: %d\n", result_count
);
3249 if (result_count
> 0) {
3252 request
= kzalloc(sizeof(*request
), GFP_KERNEL
);
3253 ssid
= kcalloc(result_count
, sizeof(*ssid
), GFP_KERNEL
);
3254 channel
= kcalloc(result_count
, sizeof(*channel
), GFP_KERNEL
);
3255 if (!request
|| !ssid
|| !channel
) {
3260 request
->wiphy
= wiphy
;
3261 data
+= sizeof(struct brcmf_pno_scanresults_le
);
3262 netinfo_start
= (struct brcmf_pno_net_info_le
*)data
;
3264 for (i
= 0; i
< result_count
; i
++) {
3265 netinfo
= &netinfo_start
[i
];
3267 brcmf_err("Invalid netinfo ptr. index: %d\n",
3273 brcmf_dbg(SCAN
, "SSID:%s Channel:%d\n",
3274 netinfo
->SSID
, netinfo
->channel
);
3275 memcpy(ssid
[i
].ssid
, netinfo
->SSID
, netinfo
->SSID_len
);
3276 ssid
[i
].ssid_len
= netinfo
->SSID_len
;
3279 channel_req
= netinfo
->channel
;
3280 if (channel_req
<= CH_MAX_2G_CHANNEL
)
3281 band
= NL80211_BAND_2GHZ
;
3283 band
= NL80211_BAND_5GHZ
;
3284 channel
[i
].center_freq
=
3285 ieee80211_channel_to_frequency(channel_req
,
3287 channel
[i
].band
= band
;
3288 channel
[i
].flags
|= IEEE80211_CHAN_NO_HT40
;
3289 request
->channels
[i
] = &channel
[i
];
3290 request
->n_channels
++;
3293 /* assign parsed ssid array */
3294 if (request
->n_ssids
)
3295 request
->ssids
= &ssid
[0];
3297 if (test_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
)) {
3298 /* Abort any on-going scan */
3299 brcmf_abort_scanning(cfg
);
3302 set_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
);
3303 cfg
->escan_info
.run
= brcmf_run_escan
;
3304 err
= brcmf_do_escan(cfg
, wiphy
, ifp
, request
);
3306 clear_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
);
3309 cfg
->sched_escan
= true;
3310 cfg
->scan_request
= request
;
3312 brcmf_err("FALSE PNO Event. (pfn_count == 0)\n");
3325 cfg80211_sched_scan_stopped(wiphy
);
3329 static int brcmf_dev_pno_clean(struct net_device
*ndev
)
3334 ret
= brcmf_fil_iovar_int_set(netdev_priv(ndev
), "pfn", 0);
3337 ret
= brcmf_fil_iovar_data_set(netdev_priv(ndev
), "pfnclear",
3341 brcmf_err("failed code %d\n", ret
);
3346 static int brcmf_dev_pno_config(struct brcmf_if
*ifp
,
3347 struct cfg80211_sched_scan_request
*request
)
3349 struct brcmf_pno_param_le pfn_param
;
3350 struct brcmf_pno_macaddr_le pfn_mac
;
3355 memset(&pfn_param
, 0, sizeof(pfn_param
));
3356 pfn_param
.version
= cpu_to_le32(BRCMF_PNO_VERSION
);
3358 /* set extra pno params */
3359 pfn_param
.flags
= cpu_to_le16(1 << BRCMF_PNO_ENABLE_ADAPTSCAN_BIT
);
3360 pfn_param
.repeat
= BRCMF_PNO_REPEAT
;
3361 pfn_param
.exp
= BRCMF_PNO_FREQ_EXPO_MAX
;
3363 /* set up pno scan fr */
3364 pfn_param
.scan_freq
= cpu_to_le32(BRCMF_PNO_TIME
);
3366 err
= brcmf_fil_iovar_data_set(ifp
, "pfn_set", &pfn_param
,
3369 brcmf_err("pfn_set failed, err=%d\n", err
);
3373 /* Find out if mac randomization should be turned on */
3374 if (!(request
->flags
& NL80211_SCAN_FLAG_RANDOM_ADDR
))
3377 pfn_mac
.version
= BRCMF_PFN_MACADDR_CFG_VER
;
3378 pfn_mac
.flags
= BRCMF_PFN_MAC_OUI_ONLY
| BRCMF_PFN_SET_MAC_UNASSOC
;
3380 memcpy(pfn_mac
.mac
, request
->mac_addr
, ETH_ALEN
);
3381 mac_mask
= request
->mac_addr_mask
;
3382 for (i
= 0; i
< ETH_ALEN
; i
++) {
3383 pfn_mac
.mac
[i
] &= mac_mask
[i
];
3384 pfn_mac
.mac
[i
] |= get_random_int() & ~(mac_mask
[i
]);
3386 /* Clear multi bit */
3387 pfn_mac
.mac
[0] &= 0xFE;
3388 /* Set locally administered */
3389 pfn_mac
.mac
[0] |= 0x02;
3391 err
= brcmf_fil_iovar_data_set(ifp
, "pfn_macaddr", &pfn_mac
,
3394 brcmf_err("pfn_macaddr failed, err=%d\n", err
);
3400 brcmf_cfg80211_sched_scan_start(struct wiphy
*wiphy
,
3401 struct net_device
*ndev
,
3402 struct cfg80211_sched_scan_request
*request
)
3404 struct brcmf_if
*ifp
= netdev_priv(ndev
);
3405 struct brcmf_cfg80211_info
*cfg
= wiphy_priv(wiphy
);
3406 struct brcmf_pno_net_param_le pfn
;
3410 brcmf_dbg(SCAN
, "Enter n_match_sets:%d n_ssids:%d\n",
3411 request
->n_match_sets
, request
->n_ssids
);
3412 if (test_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
)) {
3413 brcmf_err("Scanning already: status (%lu)\n", cfg
->scan_status
);
3416 if (test_bit(BRCMF_SCAN_STATUS_SUPPRESS
, &cfg
->scan_status
)) {
3417 brcmf_err("Scanning suppressed: status (%lu)\n",
3422 if (!request
->n_ssids
|| !request
->n_match_sets
) {
3423 brcmf_dbg(SCAN
, "Invalid sched scan req!! n_ssids:%d\n",
3428 if (request
->n_ssids
> 0) {
3429 for (i
= 0; i
< request
->n_ssids
; i
++) {
3430 /* Active scan req for ssids */
3431 brcmf_dbg(SCAN
, ">>> Active scan req for ssid (%s)\n",
3432 request
->ssids
[i
].ssid
);
3434 /* match_set ssids is a supert set of n_ssid list,
3435 * so we need not add these set separately.
3440 if (request
->n_match_sets
> 0) {
3441 /* clean up everything */
3442 ret
= brcmf_dev_pno_clean(ndev
);
3444 brcmf_err("failed error=%d\n", ret
);
3449 if (brcmf_dev_pno_config(ifp
, request
))
3452 /* configure each match set */
3453 for (i
= 0; i
< request
->n_match_sets
; i
++) {
3454 struct cfg80211_ssid
*ssid
;
3457 ssid
= &request
->match_sets
[i
].ssid
;
3458 ssid_len
= ssid
->ssid_len
;
3461 brcmf_err("skip broadcast ssid\n");
3464 pfn
.auth
= cpu_to_le32(WLAN_AUTH_OPEN
);
3465 pfn
.wpa_auth
= cpu_to_le32(BRCMF_PNO_WPA_AUTH_ANY
);
3466 pfn
.wsec
= cpu_to_le32(0);
3467 pfn
.infra
= cpu_to_le32(1);
3468 pfn
.flags
= cpu_to_le32(1 << BRCMF_PNO_HIDDEN_BIT
);
3469 pfn
.ssid
.SSID_len
= cpu_to_le32(ssid_len
);
3470 memcpy(pfn
.ssid
.SSID
, ssid
->ssid
, ssid_len
);
3471 ret
= brcmf_fil_iovar_data_set(ifp
, "pfn_add", &pfn
,
3473 brcmf_dbg(SCAN
, ">>> PNO filter %s for ssid (%s)\n",
3474 ret
== 0 ? "set" : "failed", ssid
->ssid
);
3476 /* Enable the PNO */
3477 if (brcmf_fil_iovar_int_set(ifp
, "pfn", 1) < 0) {
3478 brcmf_err("PNO enable failed!! ret=%d\n", ret
);
3488 static int brcmf_cfg80211_sched_scan_stop(struct wiphy
*wiphy
,
3489 struct net_device
*ndev
)
3491 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
3493 brcmf_dbg(SCAN
, "enter\n");
3494 brcmf_dev_pno_clean(ndev
);
3495 if (cfg
->sched_escan
)
3496 brcmf_notify_escan_complete(cfg
, netdev_priv(ndev
), true, true);
3500 static __always_inline
void brcmf_delay(u32 ms
)
3502 if (ms
< 1000 / HZ
) {
3510 static s32
brcmf_config_wowl_pattern(struct brcmf_if
*ifp
, u8 cmd
[4],
3511 u8
*pattern
, u32 patternsize
, u8
*mask
,
3514 struct brcmf_fil_wowl_pattern_le
*filter
;
3521 masksize
= (patternsize
+ 7) / 8;
3522 patternoffset
= sizeof(*filter
) - sizeof(filter
->cmd
) + masksize
;
3524 bufsize
= sizeof(*filter
) + patternsize
+ masksize
;
3525 buf
= kzalloc(bufsize
, GFP_KERNEL
);
3528 filter
= (struct brcmf_fil_wowl_pattern_le
*)buf
;
3530 memcpy(filter
->cmd
, cmd
, 4);
3531 filter
->masksize
= cpu_to_le32(masksize
);
3532 filter
->offset
= cpu_to_le32(packet_offset
);
3533 filter
->patternoffset
= cpu_to_le32(patternoffset
);
3534 filter
->patternsize
= cpu_to_le32(patternsize
);
3535 filter
->type
= cpu_to_le32(BRCMF_WOWL_PATTERN_TYPE_BITMAP
);
3537 if ((mask
) && (masksize
))
3538 memcpy(buf
+ sizeof(*filter
), mask
, masksize
);
3539 if ((pattern
) && (patternsize
))
3540 memcpy(buf
+ sizeof(*filter
) + masksize
, pattern
, patternsize
);
3542 ret
= brcmf_fil_iovar_data_set(ifp
, "wowl_pattern", buf
, bufsize
);
3549 brcmf_wowl_nd_results(struct brcmf_if
*ifp
, const struct brcmf_event_msg
*e
,
3552 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
3553 struct brcmf_pno_scanresults_le
*pfn_result
;
3554 struct brcmf_pno_net_info_le
*netinfo
;
3556 brcmf_dbg(SCAN
, "Enter\n");
3558 if (e
->datalen
< (sizeof(*pfn_result
) + sizeof(*netinfo
))) {
3559 brcmf_dbg(SCAN
, "Event data to small. Ignore\n");
3563 pfn_result
= (struct brcmf_pno_scanresults_le
*)data
;
3565 if (e
->event_code
== BRCMF_E_PFN_NET_LOST
) {
3566 brcmf_dbg(SCAN
, "PFN NET LOST event. Ignore\n");
3570 if (le32_to_cpu(pfn_result
->count
) < 1) {
3571 brcmf_err("Invalid result count, expected 1 (%d)\n",
3572 le32_to_cpu(pfn_result
->count
));
3576 data
+= sizeof(struct brcmf_pno_scanresults_le
);
3577 netinfo
= (struct brcmf_pno_net_info_le
*)data
;
3578 memcpy(cfg
->wowl
.nd
->ssid
.ssid
, netinfo
->SSID
, netinfo
->SSID_len
);
3579 cfg
->wowl
.nd
->ssid
.ssid_len
= netinfo
->SSID_len
;
3580 cfg
->wowl
.nd
->n_channels
= 1;
3581 cfg
->wowl
.nd
->channels
[0] =
3582 ieee80211_channel_to_frequency(netinfo
->channel
,
3583 netinfo
->channel
<= CH_MAX_2G_CHANNEL
?
3584 NL80211_BAND_2GHZ
: NL80211_BAND_5GHZ
);
3585 cfg
->wowl
.nd_info
->n_matches
= 1;
3586 cfg
->wowl
.nd_info
->matches
[0] = cfg
->wowl
.nd
;
3588 /* Inform (the resume task) that the net detect information was recvd */
3589 cfg
->wowl
.nd_data_completed
= true;
3590 wake_up(&cfg
->wowl
.nd_data_wait
);
3597 static void brcmf_report_wowl_wakeind(struct wiphy
*wiphy
, struct brcmf_if
*ifp
)
3599 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
3600 struct brcmf_wowl_wakeind_le wake_ind_le
;
3601 struct cfg80211_wowlan_wakeup wakeup_data
;
3602 struct cfg80211_wowlan_wakeup
*wakeup
;
3607 err
= brcmf_fil_iovar_data_get(ifp
, "wowl_wakeind", &wake_ind_le
,
3608 sizeof(wake_ind_le
));
3610 brcmf_err("Get wowl_wakeind failed, err = %d\n", err
);
3614 wakeind
= le32_to_cpu(wake_ind_le
.ucode_wakeind
);
3615 if (wakeind
& (BRCMF_WOWL_MAGIC
| BRCMF_WOWL_DIS
| BRCMF_WOWL_BCN
|
3616 BRCMF_WOWL_RETR
| BRCMF_WOWL_NET
|
3617 BRCMF_WOWL_PFN_FOUND
)) {
3618 wakeup
= &wakeup_data
;
3619 memset(&wakeup_data
, 0, sizeof(wakeup_data
));
3620 wakeup_data
.pattern_idx
= -1;
3622 if (wakeind
& BRCMF_WOWL_MAGIC
) {
3623 brcmf_dbg(INFO
, "WOWL Wake indicator: BRCMF_WOWL_MAGIC\n");
3624 wakeup_data
.magic_pkt
= true;
3626 if (wakeind
& BRCMF_WOWL_DIS
) {
3627 brcmf_dbg(INFO
, "WOWL Wake indicator: BRCMF_WOWL_DIS\n");
3628 wakeup_data
.disconnect
= true;
3630 if (wakeind
& BRCMF_WOWL_BCN
) {
3631 brcmf_dbg(INFO
, "WOWL Wake indicator: BRCMF_WOWL_BCN\n");
3632 wakeup_data
.disconnect
= true;
3634 if (wakeind
& BRCMF_WOWL_RETR
) {
3635 brcmf_dbg(INFO
, "WOWL Wake indicator: BRCMF_WOWL_RETR\n");
3636 wakeup_data
.disconnect
= true;
3638 if (wakeind
& BRCMF_WOWL_NET
) {
3639 brcmf_dbg(INFO
, "WOWL Wake indicator: BRCMF_WOWL_NET\n");
3640 /* For now always map to pattern 0, no API to get
3641 * correct information available at the moment.
3643 wakeup_data
.pattern_idx
= 0;
3645 if (wakeind
& BRCMF_WOWL_PFN_FOUND
) {
3646 brcmf_dbg(INFO
, "WOWL Wake indicator: BRCMF_WOWL_PFN_FOUND\n");
3647 timeout
= wait_event_timeout(cfg
->wowl
.nd_data_wait
,
3648 cfg
->wowl
.nd_data_completed
,
3649 BRCMF_ND_INFO_TIMEOUT
);
3651 brcmf_err("No result for wowl net detect\n");
3653 wakeup_data
.net_detect
= cfg
->wowl
.nd_info
;
3655 if (wakeind
& BRCMF_WOWL_GTK_FAILURE
) {
3656 brcmf_dbg(INFO
, "WOWL Wake indicator: BRCMF_WOWL_GTK_FAILURE\n");
3657 wakeup_data
.gtk_rekey_failure
= true;
3662 cfg80211_report_wowlan_wakeup(&ifp
->vif
->wdev
, wakeup
, GFP_KERNEL
);
3667 static void brcmf_report_wowl_wakeind(struct wiphy
*wiphy
, struct brcmf_if
*ifp
)
3671 #endif /* CONFIG_PM */
3673 static s32
brcmf_cfg80211_resume(struct wiphy
*wiphy
)
3675 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
3676 struct net_device
*ndev
= cfg_to_ndev(cfg
);
3677 struct brcmf_if
*ifp
= netdev_priv(ndev
);
3679 brcmf_dbg(TRACE
, "Enter\n");
3681 if (cfg
->wowl
.active
) {
3682 brcmf_report_wowl_wakeind(wiphy
, ifp
);
3683 brcmf_fil_iovar_int_set(ifp
, "wowl_clear", 0);
3684 brcmf_config_wowl_pattern(ifp
, "clr", NULL
, 0, NULL
, 0);
3685 if (!brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_WOWL_ARP_ND
))
3686 brcmf_configure_arp_nd_offload(ifp
, true);
3687 brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_PM
,
3688 cfg
->wowl
.pre_pmmode
);
3689 cfg
->wowl
.active
= false;
3690 if (cfg
->wowl
.nd_enabled
) {
3691 brcmf_cfg80211_sched_scan_stop(cfg
->wiphy
, ifp
->ndev
);
3692 brcmf_fweh_unregister(cfg
->pub
, BRCMF_E_PFN_NET_FOUND
);
3693 brcmf_fweh_register(cfg
->pub
, BRCMF_E_PFN_NET_FOUND
,
3694 brcmf_notify_sched_scan_results
);
3695 cfg
->wowl
.nd_enabled
= false;
3701 static void brcmf_configure_wowl(struct brcmf_cfg80211_info
*cfg
,
3702 struct brcmf_if
*ifp
,
3703 struct cfg80211_wowlan
*wowl
)
3708 brcmf_dbg(TRACE
, "Suspend, wowl config.\n");
3710 if (!brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_WOWL_ARP_ND
))
3711 brcmf_configure_arp_nd_offload(ifp
, false);
3712 brcmf_fil_cmd_int_get(ifp
, BRCMF_C_GET_PM
, &cfg
->wowl
.pre_pmmode
);
3713 brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_PM
, PM_MAX
);
3716 if (wowl
->disconnect
)
3717 wowl_config
= BRCMF_WOWL_DIS
| BRCMF_WOWL_BCN
| BRCMF_WOWL_RETR
;
3718 if (wowl
->magic_pkt
)
3719 wowl_config
|= BRCMF_WOWL_MAGIC
;
3720 if ((wowl
->patterns
) && (wowl
->n_patterns
)) {
3721 wowl_config
|= BRCMF_WOWL_NET
;
3722 for (i
= 0; i
< wowl
->n_patterns
; i
++) {
3723 brcmf_config_wowl_pattern(ifp
, "add",
3724 (u8
*)wowl
->patterns
[i
].pattern
,
3725 wowl
->patterns
[i
].pattern_len
,
3726 (u8
*)wowl
->patterns
[i
].mask
,
3727 wowl
->patterns
[i
].pkt_offset
);
3730 if (wowl
->nd_config
) {
3731 brcmf_cfg80211_sched_scan_start(cfg
->wiphy
, ifp
->ndev
,
3733 wowl_config
|= BRCMF_WOWL_PFN_FOUND
;
3735 cfg
->wowl
.nd_data_completed
= false;
3736 cfg
->wowl
.nd_enabled
= true;
3737 /* Now reroute the event for PFN to the wowl function. */
3738 brcmf_fweh_unregister(cfg
->pub
, BRCMF_E_PFN_NET_FOUND
);
3739 brcmf_fweh_register(cfg
->pub
, BRCMF_E_PFN_NET_FOUND
,
3740 brcmf_wowl_nd_results
);
3742 if (wowl
->gtk_rekey_failure
)
3743 wowl_config
|= BRCMF_WOWL_GTK_FAILURE
;
3744 if (!test_bit(BRCMF_VIF_STATUS_CONNECTED
, &ifp
->vif
->sme_state
))
3745 wowl_config
|= BRCMF_WOWL_UNASSOC
;
3747 brcmf_fil_iovar_data_set(ifp
, "wowl_wakeind", "clear",
3748 sizeof(struct brcmf_wowl_wakeind_le
));
3749 brcmf_fil_iovar_int_set(ifp
, "wowl", wowl_config
);
3750 brcmf_fil_iovar_int_set(ifp
, "wowl_activate", 1);
3751 brcmf_bus_wowl_config(cfg
->pub
->bus_if
, true);
3752 cfg
->wowl
.active
= true;
3755 static s32
brcmf_cfg80211_suspend(struct wiphy
*wiphy
,
3756 struct cfg80211_wowlan
*wowl
)
3758 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
3759 struct net_device
*ndev
= cfg_to_ndev(cfg
);
3760 struct brcmf_if
*ifp
= netdev_priv(ndev
);
3761 struct brcmf_cfg80211_vif
*vif
;
3763 brcmf_dbg(TRACE
, "Enter\n");
3765 /* if the primary net_device is not READY there is nothing
3766 * we can do but pray resume goes smoothly.
3768 if (!check_vif_up(ifp
->vif
))
3771 /* Stop scheduled scan */
3772 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_PNO
))
3773 brcmf_cfg80211_sched_scan_stop(wiphy
, ndev
);
3775 /* end any scanning */
3776 if (test_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
))
3777 brcmf_abort_scanning(cfg
);
3780 brcmf_bus_wowl_config(cfg
->pub
->bus_if
, false);
3781 list_for_each_entry(vif
, &cfg
->vif_list
, list
) {
3782 if (!test_bit(BRCMF_VIF_STATUS_READY
, &vif
->sme_state
))
3784 /* While going to suspend if associated with AP
3785 * disassociate from AP to save power while system is
3786 * in suspended state
3788 brcmf_link_down(vif
, WLAN_REASON_UNSPECIFIED
);
3789 /* Make sure WPA_Supplicant receives all the event
3790 * generated due to DISASSOC call to the fw to keep
3791 * the state fw and WPA_Supplicant state consistent
3796 brcmf_set_mpc(ifp
, 1);
3799 /* Configure WOWL paramaters */
3800 brcmf_configure_wowl(cfg
, ifp
, wowl
);
3804 brcmf_dbg(TRACE
, "Exit\n");
3805 /* clear any scanning activity */
3806 cfg
->scan_status
= 0;
3811 brcmf_update_pmklist(struct brcmf_cfg80211_info
*cfg
, struct brcmf_if
*ifp
)
3813 struct brcmf_pmk_list_le
*pmk_list
;
3818 pmk_list
= &cfg
->pmk_list
;
3819 npmk
= le32_to_cpu(pmk_list
->npmk
);
3821 brcmf_dbg(CONN
, "No of elements %d\n", npmk
);
3822 for (i
= 0; i
< npmk
; i
++)
3823 brcmf_dbg(CONN
, "PMK[%d]: %pM\n", i
, &pmk_list
->pmk
[i
].bssid
);
3825 err
= brcmf_fil_iovar_data_set(ifp
, "pmkid_info", pmk_list
,
3832 brcmf_cfg80211_set_pmksa(struct wiphy
*wiphy
, struct net_device
*ndev
,
3833 struct cfg80211_pmksa
*pmksa
)
3835 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
3836 struct brcmf_if
*ifp
= netdev_priv(ndev
);
3837 struct brcmf_pmksa
*pmk
= &cfg
->pmk_list
.pmk
[0];
3841 brcmf_dbg(TRACE
, "Enter\n");
3842 if (!check_vif_up(ifp
->vif
))
3845 npmk
= le32_to_cpu(cfg
->pmk_list
.npmk
);
3846 for (i
= 0; i
< npmk
; i
++)
3847 if (!memcmp(pmksa
->bssid
, pmk
[i
].bssid
, ETH_ALEN
))
3849 if (i
< BRCMF_MAXPMKID
) {
3850 memcpy(pmk
[i
].bssid
, pmksa
->bssid
, ETH_ALEN
);
3851 memcpy(pmk
[i
].pmkid
, pmksa
->pmkid
, WLAN_PMKID_LEN
);
3854 cfg
->pmk_list
.npmk
= cpu_to_le32(npmk
);
3857 brcmf_err("Too many PMKSA entries cached %d\n", npmk
);
3861 brcmf_dbg(CONN
, "set_pmksa - PMK bssid: %pM =\n", pmk
[npmk
].bssid
);
3862 for (i
= 0; i
< WLAN_PMKID_LEN
; i
+= 4)
3863 brcmf_dbg(CONN
, "%02x %02x %02x %02x\n", pmk
[npmk
].pmkid
[i
],
3864 pmk
[npmk
].pmkid
[i
+ 1], pmk
[npmk
].pmkid
[i
+ 2],
3865 pmk
[npmk
].pmkid
[i
+ 3]);
3867 err
= brcmf_update_pmklist(cfg
, ifp
);
3869 brcmf_dbg(TRACE
, "Exit\n");
3874 brcmf_cfg80211_del_pmksa(struct wiphy
*wiphy
, struct net_device
*ndev
,
3875 struct cfg80211_pmksa
*pmksa
)
3877 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
3878 struct brcmf_if
*ifp
= netdev_priv(ndev
);
3879 struct brcmf_pmksa
*pmk
= &cfg
->pmk_list
.pmk
[0];
3883 brcmf_dbg(TRACE
, "Enter\n");
3884 if (!check_vif_up(ifp
->vif
))
3887 brcmf_dbg(CONN
, "del_pmksa - PMK bssid = %pM\n", &pmksa
->bssid
);
3889 npmk
= le32_to_cpu(cfg
->pmk_list
.npmk
);
3890 for (i
= 0; i
< npmk
; i
++)
3891 if (!memcmp(&pmksa
->bssid
, &pmk
[i
].bssid
, ETH_ALEN
))
3894 if ((npmk
> 0) && (i
< npmk
)) {
3895 for (; i
< (npmk
- 1); i
++) {
3896 memcpy(&pmk
[i
].bssid
, &pmk
[i
+ 1].bssid
, ETH_ALEN
);
3897 memcpy(&pmk
[i
].pmkid
, &pmk
[i
+ 1].pmkid
,
3900 memset(&pmk
[i
], 0, sizeof(*pmk
));
3901 cfg
->pmk_list
.npmk
= cpu_to_le32(npmk
- 1);
3903 brcmf_err("Cache entry not found\n");
3907 err
= brcmf_update_pmklist(cfg
, ifp
);
3909 brcmf_dbg(TRACE
, "Exit\n");
3915 brcmf_cfg80211_flush_pmksa(struct wiphy
*wiphy
, struct net_device
*ndev
)
3917 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
3918 struct brcmf_if
*ifp
= netdev_priv(ndev
);
3921 brcmf_dbg(TRACE
, "Enter\n");
3922 if (!check_vif_up(ifp
->vif
))
3925 memset(&cfg
->pmk_list
, 0, sizeof(cfg
->pmk_list
));
3926 err
= brcmf_update_pmklist(cfg
, ifp
);
3928 brcmf_dbg(TRACE
, "Exit\n");
3933 static s32
brcmf_configure_opensecurity(struct brcmf_if
*ifp
)
3938 err
= brcmf_fil_bsscfg_int_set(ifp
, "auth", 0);
3940 brcmf_err("auth error %d\n", err
);
3944 err
= brcmf_fil_bsscfg_int_set(ifp
, "wsec", 0);
3946 brcmf_err("wsec error %d\n", err
);
3949 /* set upper-layer auth */
3950 err
= brcmf_fil_bsscfg_int_set(ifp
, "wpa_auth", WPA_AUTH_NONE
);
3952 brcmf_err("wpa_auth error %d\n", err
);
3959 static bool brcmf_valid_wpa_oui(u8
*oui
, bool is_rsn_ie
)
3962 return (memcmp(oui
, RSN_OUI
, TLV_OUI_LEN
) == 0);
3964 return (memcmp(oui
, WPA_OUI
, TLV_OUI_LEN
) == 0);
3968 brcmf_configure_wpaie(struct brcmf_if
*ifp
,
3969 const struct brcmf_vs_tlv
*wpa_ie
,
3972 u32 auth
= 0; /* d11 open authentication */
3984 u32 wme_bss_disable
;
3987 brcmf_dbg(TRACE
, "Enter\n");
3991 len
= wpa_ie
->len
+ TLV_HDR_LEN
;
3992 data
= (u8
*)wpa_ie
;
3993 offset
= TLV_HDR_LEN
;
3995 offset
+= VS_IE_FIXED_HDR_LEN
;
3997 offset
+= WPA_IE_VERSION_LEN
;
3999 /* check for multicast cipher suite */
4000 if (offset
+ WPA_IE_MIN_OUI_LEN
> len
) {
4002 brcmf_err("no multicast cipher suite\n");
4006 if (!brcmf_valid_wpa_oui(&data
[offset
], is_rsn_ie
)) {
4008 brcmf_err("ivalid OUI\n");
4011 offset
+= TLV_OUI_LEN
;
4013 /* pick up multicast cipher */
4014 switch (data
[offset
]) {
4015 case WPA_CIPHER_NONE
:
4018 case WPA_CIPHER_WEP_40
:
4019 case WPA_CIPHER_WEP_104
:
4022 case WPA_CIPHER_TKIP
:
4023 gval
= TKIP_ENABLED
;
4025 case WPA_CIPHER_AES_CCM
:
4030 brcmf_err("Invalid multi cast cipher info\n");
4035 /* walk thru unicast cipher list and pick up what we recognize */
4036 count
= data
[offset
] + (data
[offset
+ 1] << 8);
4037 offset
+= WPA_IE_SUITE_COUNT_LEN
;
4038 /* Check for unicast suite(s) */
4039 if (offset
+ (WPA_IE_MIN_OUI_LEN
* count
) > len
) {
4041 brcmf_err("no unicast cipher suite\n");
4044 for (i
= 0; i
< count
; i
++) {
4045 if (!brcmf_valid_wpa_oui(&data
[offset
], is_rsn_ie
)) {
4047 brcmf_err("ivalid OUI\n");
4050 offset
+= TLV_OUI_LEN
;
4051 switch (data
[offset
]) {
4052 case WPA_CIPHER_NONE
:
4054 case WPA_CIPHER_WEP_40
:
4055 case WPA_CIPHER_WEP_104
:
4056 pval
|= WEP_ENABLED
;
4058 case WPA_CIPHER_TKIP
:
4059 pval
|= TKIP_ENABLED
;
4061 case WPA_CIPHER_AES_CCM
:
4062 pval
|= AES_ENABLED
;
4065 brcmf_err("Ivalid unicast security info\n");
4069 /* walk thru auth management suite list and pick up what we recognize */
4070 count
= data
[offset
] + (data
[offset
+ 1] << 8);
4071 offset
+= WPA_IE_SUITE_COUNT_LEN
;
4072 /* Check for auth key management suite(s) */
4073 if (offset
+ (WPA_IE_MIN_OUI_LEN
* count
) > len
) {
4075 brcmf_err("no auth key mgmt suite\n");
4078 for (i
= 0; i
< count
; i
++) {
4079 if (!brcmf_valid_wpa_oui(&data
[offset
], is_rsn_ie
)) {
4081 brcmf_err("ivalid OUI\n");
4084 offset
+= TLV_OUI_LEN
;
4085 switch (data
[offset
]) {
4087 brcmf_dbg(TRACE
, "RSN_AKM_NONE\n");
4088 wpa_auth
|= WPA_AUTH_NONE
;
4090 case RSN_AKM_UNSPECIFIED
:
4091 brcmf_dbg(TRACE
, "RSN_AKM_UNSPECIFIED\n");
4092 is_rsn_ie
? (wpa_auth
|= WPA2_AUTH_UNSPECIFIED
) :
4093 (wpa_auth
|= WPA_AUTH_UNSPECIFIED
);
4096 brcmf_dbg(TRACE
, "RSN_AKM_PSK\n");
4097 is_rsn_ie
? (wpa_auth
|= WPA2_AUTH_PSK
) :
4098 (wpa_auth
|= WPA_AUTH_PSK
);
4100 case RSN_AKM_SHA256_PSK
:
4101 brcmf_dbg(TRACE
, "RSN_AKM_MFP_PSK\n");
4102 wpa_auth
|= WPA2_AUTH_PSK_SHA256
;
4104 case RSN_AKM_SHA256_1X
:
4105 brcmf_dbg(TRACE
, "RSN_AKM_MFP_1X\n");
4106 wpa_auth
|= WPA2_AUTH_1X_SHA256
;
4109 brcmf_err("Ivalid key mgmt info\n");
4114 mfp
= BRCMF_MFP_NONE
;
4116 wme_bss_disable
= 1;
4117 if ((offset
+ RSN_CAP_LEN
) <= len
) {
4118 rsn_cap
= data
[offset
] + (data
[offset
+ 1] << 8);
4119 if (rsn_cap
& RSN_CAP_PTK_REPLAY_CNTR_MASK
)
4120 wme_bss_disable
= 0;
4121 if (rsn_cap
& RSN_CAP_MFPR_MASK
) {
4122 brcmf_dbg(TRACE
, "MFP Required\n");
4123 mfp
= BRCMF_MFP_REQUIRED
;
4124 /* Firmware only supports mfp required in
4125 * combination with WPA2_AUTH_PSK_SHA256 or
4126 * WPA2_AUTH_1X_SHA256.
4128 if (!(wpa_auth
& (WPA2_AUTH_PSK_SHA256
|
4129 WPA2_AUTH_1X_SHA256
))) {
4133 /* Firmware has requirement that WPA2_AUTH_PSK/
4134 * WPA2_AUTH_UNSPECIFIED be set, if SHA256 OUI
4135 * is to be included in the rsn ie.
4137 if (wpa_auth
& WPA2_AUTH_PSK_SHA256
)
4138 wpa_auth
|= WPA2_AUTH_PSK
;
4139 else if (wpa_auth
& WPA2_AUTH_1X_SHA256
)
4140 wpa_auth
|= WPA2_AUTH_UNSPECIFIED
;
4141 } else if (rsn_cap
& RSN_CAP_MFPC_MASK
) {
4142 brcmf_dbg(TRACE
, "MFP Capable\n");
4143 mfp
= BRCMF_MFP_CAPABLE
;
4146 offset
+= RSN_CAP_LEN
;
4147 /* set wme_bss_disable to sync RSN Capabilities */
4148 err
= brcmf_fil_bsscfg_int_set(ifp
, "wme_bss_disable",
4151 brcmf_err("wme_bss_disable error %d\n", err
);
4155 /* Skip PMKID cnt as it is know to be 0 for AP. */
4156 offset
+= RSN_PMKID_COUNT_LEN
;
4158 /* See if there is BIP wpa suite left for MFP */
4159 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_MFP
) &&
4160 ((offset
+ WPA_IE_MIN_OUI_LEN
) <= len
)) {
4161 err
= brcmf_fil_bsscfg_data_set(ifp
, "bip",
4163 WPA_IE_MIN_OUI_LEN
);
4165 brcmf_err("bip error %d\n", err
);
4170 /* FOR WPS , set SES_OW_ENABLED */
4171 wsec
= (pval
| gval
| SES_OW_ENABLED
);
4174 err
= brcmf_fil_bsscfg_int_set(ifp
, "auth", auth
);
4176 brcmf_err("auth error %d\n", err
);
4180 err
= brcmf_fil_bsscfg_int_set(ifp
, "wsec", wsec
);
4182 brcmf_err("wsec error %d\n", err
);
4185 /* Configure MFP, this needs to go after wsec otherwise the wsec command
4186 * will overwrite the values set by MFP
4188 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_MFP
)) {
4189 err
= brcmf_fil_bsscfg_int_set(ifp
, "mfp", mfp
);
4191 brcmf_err("mfp error %d\n", err
);
4195 /* set upper-layer auth */
4196 err
= brcmf_fil_bsscfg_int_set(ifp
, "wpa_auth", wpa_auth
);
4198 brcmf_err("wpa_auth error %d\n", err
);
4207 brcmf_parse_vndr_ies(const u8
*vndr_ie_buf
, u32 vndr_ie_len
,
4208 struct parsed_vndr_ies
*vndr_ies
)
4210 struct brcmf_vs_tlv
*vndrie
;
4211 struct brcmf_tlv
*ie
;
4212 struct parsed_vndr_ie_info
*parsed_info
;
4215 remaining_len
= (s32
)vndr_ie_len
;
4216 memset(vndr_ies
, 0, sizeof(*vndr_ies
));
4218 ie
= (struct brcmf_tlv
*)vndr_ie_buf
;
4220 if (ie
->id
!= WLAN_EID_VENDOR_SPECIFIC
)
4222 vndrie
= (struct brcmf_vs_tlv
*)ie
;
4223 /* len should be bigger than OUI length + one */
4224 if (vndrie
->len
< (VS_IE_FIXED_HDR_LEN
- TLV_HDR_LEN
+ 1)) {
4225 brcmf_err("invalid vndr ie. length is too small %d\n",
4229 /* if wpa or wme ie, do not add ie */
4230 if (!memcmp(vndrie
->oui
, (u8
*)WPA_OUI
, TLV_OUI_LEN
) &&
4231 ((vndrie
->oui_type
== WPA_OUI_TYPE
) ||
4232 (vndrie
->oui_type
== WME_OUI_TYPE
))) {
4233 brcmf_dbg(TRACE
, "Found WPA/WME oui. Do not add it\n");
4237 parsed_info
= &vndr_ies
->ie_info
[vndr_ies
->count
];
4239 /* save vndr ie information */
4240 parsed_info
->ie_ptr
= (char *)vndrie
;
4241 parsed_info
->ie_len
= vndrie
->len
+ TLV_HDR_LEN
;
4242 memcpy(&parsed_info
->vndrie
, vndrie
, sizeof(*vndrie
));
4246 brcmf_dbg(TRACE
, "** OUI %02x %02x %02x, type 0x%02x\n",
4247 parsed_info
->vndrie
.oui
[0],
4248 parsed_info
->vndrie
.oui
[1],
4249 parsed_info
->vndrie
.oui
[2],
4250 parsed_info
->vndrie
.oui_type
);
4252 if (vndr_ies
->count
>= VNDR_IE_PARSE_LIMIT
)
4255 remaining_len
-= (ie
->len
+ TLV_HDR_LEN
);
4256 if (remaining_len
<= TLV_HDR_LEN
)
4259 ie
= (struct brcmf_tlv
*)(((u8
*)ie
) + ie
->len
+
4266 brcmf_vndr_ie(u8
*iebuf
, s32 pktflag
, u8
*ie_ptr
, u32 ie_len
, s8
*add_del_cmd
)
4269 strncpy(iebuf
, add_del_cmd
, VNDR_IE_CMD_LEN
- 1);
4270 iebuf
[VNDR_IE_CMD_LEN
- 1] = '\0';
4272 put_unaligned_le32(1, &iebuf
[VNDR_IE_COUNT_OFFSET
]);
4274 put_unaligned_le32(pktflag
, &iebuf
[VNDR_IE_PKTFLAG_OFFSET
]);
4276 memcpy(&iebuf
[VNDR_IE_VSIE_OFFSET
], ie_ptr
, ie_len
);
4278 return ie_len
+ VNDR_IE_HDR_SIZE
;
4281 s32
brcmf_vif_set_mgmt_ie(struct brcmf_cfg80211_vif
*vif
, s32 pktflag
,
4282 const u8
*vndr_ie_buf
, u32 vndr_ie_len
)
4284 struct brcmf_if
*ifp
;
4285 struct vif_saved_ie
*saved_ie
;
4289 u8
*mgmt_ie_buf
= NULL
;
4290 int mgmt_ie_buf_len
;
4292 u32 del_add_ie_buf_len
= 0;
4293 u32 total_ie_buf_len
= 0;
4294 u32 parsed_ie_buf_len
= 0;
4295 struct parsed_vndr_ies old_vndr_ies
;
4296 struct parsed_vndr_ies new_vndr_ies
;
4297 struct parsed_vndr_ie_info
*vndrie_info
;
4300 int remained_buf_len
;
4305 saved_ie
= &vif
->saved_ie
;
4307 brcmf_dbg(TRACE
, "bsscfgidx %d, pktflag : 0x%02X\n", ifp
->bsscfgidx
,
4309 iovar_ie_buf
= kzalloc(WL_EXTRA_BUF_MAX
, GFP_KERNEL
);
4312 curr_ie_buf
= iovar_ie_buf
;
4314 case BRCMF_VNDR_IE_PRBREQ_FLAG
:
4315 mgmt_ie_buf
= saved_ie
->probe_req_ie
;
4316 mgmt_ie_len
= &saved_ie
->probe_req_ie_len
;
4317 mgmt_ie_buf_len
= sizeof(saved_ie
->probe_req_ie
);
4319 case BRCMF_VNDR_IE_PRBRSP_FLAG
:
4320 mgmt_ie_buf
= saved_ie
->probe_res_ie
;
4321 mgmt_ie_len
= &saved_ie
->probe_res_ie_len
;
4322 mgmt_ie_buf_len
= sizeof(saved_ie
->probe_res_ie
);
4324 case BRCMF_VNDR_IE_BEACON_FLAG
:
4325 mgmt_ie_buf
= saved_ie
->beacon_ie
;
4326 mgmt_ie_len
= &saved_ie
->beacon_ie_len
;
4327 mgmt_ie_buf_len
= sizeof(saved_ie
->beacon_ie
);
4329 case BRCMF_VNDR_IE_ASSOCREQ_FLAG
:
4330 mgmt_ie_buf
= saved_ie
->assoc_req_ie
;
4331 mgmt_ie_len
= &saved_ie
->assoc_req_ie_len
;
4332 mgmt_ie_buf_len
= sizeof(saved_ie
->assoc_req_ie
);
4336 brcmf_err("not suitable type\n");
4340 if (vndr_ie_len
> mgmt_ie_buf_len
) {
4342 brcmf_err("extra IE size too big\n");
4346 /* parse and save new vndr_ie in curr_ie_buff before comparing it */
4347 if (vndr_ie_buf
&& vndr_ie_len
&& curr_ie_buf
) {
4349 brcmf_parse_vndr_ies(vndr_ie_buf
, vndr_ie_len
, &new_vndr_ies
);
4350 for (i
= 0; i
< new_vndr_ies
.count
; i
++) {
4351 vndrie_info
= &new_vndr_ies
.ie_info
[i
];
4352 memcpy(ptr
+ parsed_ie_buf_len
, vndrie_info
->ie_ptr
,
4353 vndrie_info
->ie_len
);
4354 parsed_ie_buf_len
+= vndrie_info
->ie_len
;
4358 if (mgmt_ie_buf
&& *mgmt_ie_len
) {
4359 if (parsed_ie_buf_len
&& (parsed_ie_buf_len
== *mgmt_ie_len
) &&
4360 (memcmp(mgmt_ie_buf
, curr_ie_buf
,
4361 parsed_ie_buf_len
) == 0)) {
4362 brcmf_dbg(TRACE
, "Previous mgmt IE equals to current IE\n");
4366 /* parse old vndr_ie */
4367 brcmf_parse_vndr_ies(mgmt_ie_buf
, *mgmt_ie_len
, &old_vndr_ies
);
4369 /* make a command to delete old ie */
4370 for (i
= 0; i
< old_vndr_ies
.count
; i
++) {
4371 vndrie_info
= &old_vndr_ies
.ie_info
[i
];
4373 brcmf_dbg(TRACE
, "DEL ID : %d, Len: %d , OUI:%02x:%02x:%02x\n",
4374 vndrie_info
->vndrie
.id
,
4375 vndrie_info
->vndrie
.len
,
4376 vndrie_info
->vndrie
.oui
[0],
4377 vndrie_info
->vndrie
.oui
[1],
4378 vndrie_info
->vndrie
.oui
[2]);
4380 del_add_ie_buf_len
= brcmf_vndr_ie(curr_ie_buf
, pktflag
,
4381 vndrie_info
->ie_ptr
,
4382 vndrie_info
->ie_len
,
4384 curr_ie_buf
+= del_add_ie_buf_len
;
4385 total_ie_buf_len
+= del_add_ie_buf_len
;
4390 /* Add if there is any extra IE */
4391 if (mgmt_ie_buf
&& parsed_ie_buf_len
) {
4394 remained_buf_len
= mgmt_ie_buf_len
;
4396 /* make a command to add new ie */
4397 for (i
= 0; i
< new_vndr_ies
.count
; i
++) {
4398 vndrie_info
= &new_vndr_ies
.ie_info
[i
];
4400 /* verify remained buf size before copy data */
4401 if (remained_buf_len
< (vndrie_info
->vndrie
.len
+
4402 VNDR_IE_VSIE_OFFSET
)) {
4403 brcmf_err("no space in mgmt_ie_buf: len left %d",
4407 remained_buf_len
-= (vndrie_info
->ie_len
+
4408 VNDR_IE_VSIE_OFFSET
);
4410 brcmf_dbg(TRACE
, "ADDED ID : %d, Len: %d, OUI:%02x:%02x:%02x\n",
4411 vndrie_info
->vndrie
.id
,
4412 vndrie_info
->vndrie
.len
,
4413 vndrie_info
->vndrie
.oui
[0],
4414 vndrie_info
->vndrie
.oui
[1],
4415 vndrie_info
->vndrie
.oui
[2]);
4417 del_add_ie_buf_len
= brcmf_vndr_ie(curr_ie_buf
, pktflag
,
4418 vndrie_info
->ie_ptr
,
4419 vndrie_info
->ie_len
,
4422 /* save the parsed IE in wl struct */
4423 memcpy(ptr
+ (*mgmt_ie_len
), vndrie_info
->ie_ptr
,
4424 vndrie_info
->ie_len
);
4425 *mgmt_ie_len
+= vndrie_info
->ie_len
;
4427 curr_ie_buf
+= del_add_ie_buf_len
;
4428 total_ie_buf_len
+= del_add_ie_buf_len
;
4431 if (total_ie_buf_len
) {
4432 err
= brcmf_fil_bsscfg_data_set(ifp
, "vndr_ie", iovar_ie_buf
,
4435 brcmf_err("vndr ie set error : %d\n", err
);
4439 kfree(iovar_ie_buf
);
4443 s32
brcmf_vif_clear_mgmt_ies(struct brcmf_cfg80211_vif
*vif
)
4446 BRCMF_VNDR_IE_PRBREQ_FLAG
,
4447 BRCMF_VNDR_IE_PRBRSP_FLAG
,
4448 BRCMF_VNDR_IE_BEACON_FLAG
4452 for (i
= 0; i
< ARRAY_SIZE(pktflags
); i
++)
4453 brcmf_vif_set_mgmt_ie(vif
, pktflags
[i
], NULL
, 0);
4455 memset(&vif
->saved_ie
, 0, sizeof(vif
->saved_ie
));
4460 brcmf_config_ap_mgmt_ie(struct brcmf_cfg80211_vif
*vif
,
4461 struct cfg80211_beacon_data
*beacon
)
4465 /* Set Beacon IEs to FW */
4466 err
= brcmf_vif_set_mgmt_ie(vif
, BRCMF_VNDR_IE_BEACON_FLAG
,
4467 beacon
->tail
, beacon
->tail_len
);
4469 brcmf_err("Set Beacon IE Failed\n");
4472 brcmf_dbg(TRACE
, "Applied Vndr IEs for Beacon\n");
4474 /* Set Probe Response IEs to FW */
4475 err
= brcmf_vif_set_mgmt_ie(vif
, BRCMF_VNDR_IE_PRBRSP_FLAG
,
4476 beacon
->proberesp_ies
,
4477 beacon
->proberesp_ies_len
);
4479 brcmf_err("Set Probe Resp IE Failed\n");
4481 brcmf_dbg(TRACE
, "Applied Vndr IEs for Probe Resp\n");
4487 brcmf_cfg80211_start_ap(struct wiphy
*wiphy
, struct net_device
*ndev
,
4488 struct cfg80211_ap_settings
*settings
)
4491 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
4492 struct brcmf_if
*ifp
= netdev_priv(ndev
);
4493 const struct brcmf_tlv
*ssid_ie
;
4494 const struct brcmf_tlv
*country_ie
;
4495 struct brcmf_ssid_le ssid_le
;
4497 const struct brcmf_tlv
*rsn_ie
;
4498 const struct brcmf_vs_tlv
*wpa_ie
;
4499 struct brcmf_join_params join_params
;
4500 enum nl80211_iftype dev_role
;
4501 struct brcmf_fil_bss_enable_le bss_enable
;
4502 u16 chanspec
= chandef_to_chanspec(&cfg
->d11inf
, &settings
->chandef
);
4506 brcmf_dbg(TRACE
, "ctrlchn=%d, center=%d, bw=%d, beacon_interval=%d, dtim_period=%d,\n",
4507 settings
->chandef
.chan
->hw_value
,
4508 settings
->chandef
.center_freq1
, settings
->chandef
.width
,
4509 settings
->beacon_interval
, settings
->dtim_period
);
4510 brcmf_dbg(TRACE
, "ssid=%s(%zu), auth_type=%d, inactivity_timeout=%d\n",
4511 settings
->ssid
, settings
->ssid_len
, settings
->auth_type
,
4512 settings
->inactivity_timeout
);
4513 dev_role
= ifp
->vif
->wdev
.iftype
;
4514 mbss
= ifp
->vif
->mbss
;
4516 /* store current 11d setting */
4517 brcmf_fil_cmd_int_get(ifp
, BRCMF_C_GET_REGULATORY
, &ifp
->vif
->is_11d
);
4518 country_ie
= brcmf_parse_tlvs((u8
*)settings
->beacon
.tail
,
4519 settings
->beacon
.tail_len
,
4521 is_11d
= country_ie
? 1 : 0;
4523 memset(&ssid_le
, 0, sizeof(ssid_le
));
4524 if (settings
->ssid
== NULL
|| settings
->ssid_len
== 0) {
4525 ie_offset
= DOT11_MGMT_HDR_LEN
+ DOT11_BCN_PRB_FIXED_LEN
;
4526 ssid_ie
= brcmf_parse_tlvs(
4527 (u8
*)&settings
->beacon
.head
[ie_offset
],
4528 settings
->beacon
.head_len
- ie_offset
,
4533 memcpy(ssid_le
.SSID
, ssid_ie
->data
, ssid_ie
->len
);
4534 ssid_le
.SSID_len
= cpu_to_le32(ssid_ie
->len
);
4535 brcmf_dbg(TRACE
, "SSID is (%s) in Head\n", ssid_le
.SSID
);
4537 memcpy(ssid_le
.SSID
, settings
->ssid
, settings
->ssid_len
);
4538 ssid_le
.SSID_len
= cpu_to_le32((u32
)settings
->ssid_len
);
4542 brcmf_set_mpc(ifp
, 0);
4543 brcmf_configure_arp_nd_offload(ifp
, false);
4546 /* find the RSN_IE */
4547 rsn_ie
= brcmf_parse_tlvs((u8
*)settings
->beacon
.tail
,
4548 settings
->beacon
.tail_len
, WLAN_EID_RSN
);
4550 /* find the WPA_IE */
4551 wpa_ie
= brcmf_find_wpaie((u8
*)settings
->beacon
.tail
,
4552 settings
->beacon
.tail_len
);
4554 if ((wpa_ie
!= NULL
|| rsn_ie
!= NULL
)) {
4555 brcmf_dbg(TRACE
, "WPA(2) IE is found\n");
4556 if (wpa_ie
!= NULL
) {
4558 err
= brcmf_configure_wpaie(ifp
, wpa_ie
, false);
4562 struct brcmf_vs_tlv
*tmp_ie
;
4564 tmp_ie
= (struct brcmf_vs_tlv
*)rsn_ie
;
4567 err
= brcmf_configure_wpaie(ifp
, tmp_ie
, true);
4572 brcmf_dbg(TRACE
, "No WPA(2) IEs found\n");
4573 brcmf_configure_opensecurity(ifp
);
4576 brcmf_config_ap_mgmt_ie(ifp
->vif
, &settings
->beacon
);
4578 /* Parameters shared by all radio interfaces */
4580 if (is_11d
!= ifp
->vif
->is_11d
) {
4581 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_REGULATORY
,
4584 brcmf_err("Regulatory Set Error, %d\n", err
);
4588 if (settings
->beacon_interval
) {
4589 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_BCNPRD
,
4590 settings
->beacon_interval
);
4592 brcmf_err("Beacon Interval Set Error, %d\n",
4597 if (settings
->dtim_period
) {
4598 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_DTIMPRD
,
4599 settings
->dtim_period
);
4601 brcmf_err("DTIM Interval Set Error, %d\n", err
);
4606 if ((dev_role
== NL80211_IFTYPE_AP
) &&
4607 ((ifp
->ifidx
== 0) ||
4608 !brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_RSDB
))) {
4609 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_DOWN
, 1);
4611 brcmf_err("BRCMF_C_DOWN error %d\n", err
);
4614 brcmf_fil_iovar_int_set(ifp
, "apsta", 0);
4617 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_INFRA
, 1);
4619 brcmf_err("SET INFRA error %d\n", err
);
4622 } else if (WARN_ON(is_11d
!= ifp
->vif
->is_11d
)) {
4623 /* Multiple-BSS should use same 11d configuration */
4628 /* Interface specific setup */
4629 if (dev_role
== NL80211_IFTYPE_AP
) {
4630 if ((brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_MBSS
)) && (!mbss
))
4631 brcmf_fil_iovar_int_set(ifp
, "mbss", 1);
4633 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_AP
, 1);
4635 brcmf_err("setting AP mode failed %d\n", err
);
4639 /* Firmware 10.x requires setting channel after enabling
4640 * AP and before bringing interface up.
4642 err
= brcmf_fil_iovar_int_set(ifp
, "chanspec", chanspec
);
4644 brcmf_err("Set Channel failed: chspec=%d, %d\n",
4649 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_UP
, 1);
4651 brcmf_err("BRCMF_C_UP error (%d)\n", err
);
4654 /* On DOWN the firmware removes the WEP keys, reconfigure
4655 * them if they were set.
4657 brcmf_cfg80211_reconfigure_wep(ifp
);
4659 memset(&join_params
, 0, sizeof(join_params
));
4660 /* join parameters starts with ssid */
4661 memcpy(&join_params
.ssid_le
, &ssid_le
, sizeof(ssid_le
));
4663 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_SET_SSID
,
4664 &join_params
, sizeof(join_params
));
4666 brcmf_err("SET SSID error (%d)\n", err
);
4669 brcmf_dbg(TRACE
, "AP mode configuration complete\n");
4670 } else if (dev_role
== NL80211_IFTYPE_P2P_GO
) {
4671 err
= brcmf_fil_iovar_int_set(ifp
, "chanspec", chanspec
);
4673 brcmf_err("Set Channel failed: chspec=%d, %d\n",
4677 err
= brcmf_fil_bsscfg_data_set(ifp
, "ssid", &ssid_le
,
4680 brcmf_err("setting ssid failed %d\n", err
);
4683 bss_enable
.bsscfgidx
= cpu_to_le32(ifp
->bsscfgidx
);
4684 bss_enable
.enable
= cpu_to_le32(1);
4685 err
= brcmf_fil_iovar_data_set(ifp
, "bss", &bss_enable
,
4686 sizeof(bss_enable
));
4688 brcmf_err("bss_enable config failed %d\n", err
);
4692 brcmf_dbg(TRACE
, "GO mode configuration complete\n");
4697 set_bit(BRCMF_VIF_STATUS_AP_CREATED
, &ifp
->vif
->sme_state
);
4698 brcmf_net_setcarrier(ifp
, true);
4701 if ((err
) && (!mbss
)) {
4702 brcmf_set_mpc(ifp
, 1);
4703 brcmf_configure_arp_nd_offload(ifp
, true);
4708 static int brcmf_cfg80211_stop_ap(struct wiphy
*wiphy
, struct net_device
*ndev
)
4710 struct brcmf_if
*ifp
= netdev_priv(ndev
);
4712 struct brcmf_fil_bss_enable_le bss_enable
;
4713 struct brcmf_join_params join_params
;
4715 brcmf_dbg(TRACE
, "Enter\n");
4717 if (ifp
->vif
->wdev
.iftype
== NL80211_IFTYPE_AP
) {
4718 /* Due to most likely deauths outstanding we sleep */
4719 /* first to make sure they get processed by fw. */
4722 if (ifp
->vif
->mbss
) {
4723 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_DOWN
, 1);
4727 memset(&join_params
, 0, sizeof(join_params
));
4728 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_SET_SSID
,
4729 &join_params
, sizeof(join_params
));
4731 brcmf_err("SET SSID error (%d)\n", err
);
4732 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_DOWN
, 1);
4734 brcmf_err("BRCMF_C_DOWN error %d\n", err
);
4735 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_AP
, 0);
4737 brcmf_err("setting AP mode failed %d\n", err
);
4738 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_INFRA
, 0);
4740 brcmf_err("setting INFRA mode failed %d\n", err
);
4741 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_MBSS
))
4742 brcmf_fil_iovar_int_set(ifp
, "mbss", 0);
4743 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_REGULATORY
,
4746 brcmf_err("restoring REGULATORY setting failed %d\n",
4748 /* Bring device back up so it can be used again */
4749 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_UP
, 1);
4751 brcmf_err("BRCMF_C_UP error %d\n", err
);
4753 bss_enable
.bsscfgidx
= cpu_to_le32(ifp
->bsscfgidx
);
4754 bss_enable
.enable
= cpu_to_le32(0);
4755 err
= brcmf_fil_iovar_data_set(ifp
, "bss", &bss_enable
,
4756 sizeof(bss_enable
));
4758 brcmf_err("bss_enable config failed %d\n", err
);
4760 brcmf_set_mpc(ifp
, 1);
4761 brcmf_configure_arp_nd_offload(ifp
, true);
4762 clear_bit(BRCMF_VIF_STATUS_AP_CREATED
, &ifp
->vif
->sme_state
);
4763 brcmf_net_setcarrier(ifp
, false);
4769 brcmf_cfg80211_change_beacon(struct wiphy
*wiphy
, struct net_device
*ndev
,
4770 struct cfg80211_beacon_data
*info
)
4772 struct brcmf_if
*ifp
= netdev_priv(ndev
);
4775 brcmf_dbg(TRACE
, "Enter\n");
4777 err
= brcmf_config_ap_mgmt_ie(ifp
->vif
, info
);
4783 brcmf_cfg80211_del_station(struct wiphy
*wiphy
, struct net_device
*ndev
,
4784 struct station_del_parameters
*params
)
4786 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
4787 struct brcmf_scb_val_le scbval
;
4788 struct brcmf_if
*ifp
= netdev_priv(ndev
);
4794 brcmf_dbg(TRACE
, "Enter %pM\n", params
->mac
);
4796 if (ifp
->vif
== cfg
->p2p
.bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
)
4797 ifp
= cfg
->p2p
.bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
->ifp
;
4798 if (!check_vif_up(ifp
->vif
))
4801 memcpy(&scbval
.ea
, params
->mac
, ETH_ALEN
);
4802 scbval
.val
= cpu_to_le32(params
->reason_code
);
4803 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_SCB_DEAUTHENTICATE_FOR_REASON
,
4804 &scbval
, sizeof(scbval
));
4806 brcmf_err("SCB_DEAUTHENTICATE_FOR_REASON failed %d\n", err
);
4808 brcmf_dbg(TRACE
, "Exit\n");
4813 brcmf_cfg80211_change_station(struct wiphy
*wiphy
, struct net_device
*ndev
,
4814 const u8
*mac
, struct station_parameters
*params
)
4816 struct brcmf_if
*ifp
= netdev_priv(ndev
);
4819 brcmf_dbg(TRACE
, "Enter, MAC %pM, mask 0x%04x set 0x%04x\n", mac
,
4820 params
->sta_flags_mask
, params
->sta_flags_set
);
4822 /* Ignore all 00 MAC */
4823 if (is_zero_ether_addr(mac
))
4826 if (!(params
->sta_flags_mask
& BIT(NL80211_STA_FLAG_AUTHORIZED
)))
4829 if (params
->sta_flags_set
& BIT(NL80211_STA_FLAG_AUTHORIZED
))
4830 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_SET_SCB_AUTHORIZE
,
4831 (void *)mac
, ETH_ALEN
);
4833 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_SET_SCB_DEAUTHORIZE
,
4834 (void *)mac
, ETH_ALEN
);
4836 brcmf_err("Setting SCB (de-)authorize failed, %d\n", err
);
4842 brcmf_cfg80211_mgmt_frame_register(struct wiphy
*wiphy
,
4843 struct wireless_dev
*wdev
,
4844 u16 frame_type
, bool reg
)
4846 struct brcmf_cfg80211_vif
*vif
;
4849 brcmf_dbg(TRACE
, "Enter, frame_type %04x, reg=%d\n", frame_type
, reg
);
4851 mgmt_type
= (frame_type
& IEEE80211_FCTL_STYPE
) >> 4;
4852 vif
= container_of(wdev
, struct brcmf_cfg80211_vif
, wdev
);
4854 vif
->mgmt_rx_reg
|= BIT(mgmt_type
);
4856 vif
->mgmt_rx_reg
&= ~BIT(mgmt_type
);
4861 brcmf_cfg80211_mgmt_tx(struct wiphy
*wiphy
, struct wireless_dev
*wdev
,
4862 struct cfg80211_mgmt_tx_params
*params
, u64
*cookie
)
4864 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
4865 struct ieee80211_channel
*chan
= params
->chan
;
4866 const u8
*buf
= params
->buf
;
4867 size_t len
= params
->len
;
4868 const struct ieee80211_mgmt
*mgmt
;
4869 struct brcmf_cfg80211_vif
*vif
;
4873 struct brcmf_fil_action_frame_le
*action_frame
;
4874 struct brcmf_fil_af_params_le
*af_params
;
4879 brcmf_dbg(TRACE
, "Enter\n");
4883 mgmt
= (const struct ieee80211_mgmt
*)buf
;
4885 if (!ieee80211_is_mgmt(mgmt
->frame_control
)) {
4886 brcmf_err("Driver only allows MGMT packet type\n");
4890 vif
= container_of(wdev
, struct brcmf_cfg80211_vif
, wdev
);
4892 if (ieee80211_is_probe_resp(mgmt
->frame_control
)) {
4893 /* Right now the only reason to get a probe response */
4894 /* is for p2p listen response or for p2p GO from */
4895 /* wpa_supplicant. Unfortunately the probe is send */
4896 /* on primary ndev, while dongle wants it on the p2p */
4897 /* vif. Since this is only reason for a probe */
4898 /* response to be sent, the vif is taken from cfg. */
4899 /* If ever desired to send proberesp for non p2p */
4900 /* response then data should be checked for */
4901 /* "DIRECT-". Note in future supplicant will take */
4902 /* dedicated p2p wdev to do this and then this 'hack'*/
4903 /* is not needed anymore. */
4904 ie_offset
= DOT11_MGMT_HDR_LEN
+
4905 DOT11_BCN_PRB_FIXED_LEN
;
4906 ie_len
= len
- ie_offset
;
4907 if (vif
== cfg
->p2p
.bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
)
4908 vif
= cfg
->p2p
.bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
;
4909 err
= brcmf_vif_set_mgmt_ie(vif
,
4910 BRCMF_VNDR_IE_PRBRSP_FLAG
,
4913 cfg80211_mgmt_tx_status(wdev
, *cookie
, buf
, len
, true,
4915 } else if (ieee80211_is_action(mgmt
->frame_control
)) {
4916 af_params
= kzalloc(sizeof(*af_params
), GFP_KERNEL
);
4917 if (af_params
== NULL
) {
4918 brcmf_err("unable to allocate frame\n");
4922 action_frame
= &af_params
->action_frame
;
4923 /* Add the packet Id */
4924 action_frame
->packet_id
= cpu_to_le32(*cookie
);
4926 memcpy(&action_frame
->da
[0], &mgmt
->da
[0], ETH_ALEN
);
4927 memcpy(&af_params
->bssid
[0], &mgmt
->bssid
[0], ETH_ALEN
);
4928 /* Add the length exepted for 802.11 header */
4929 action_frame
->len
= cpu_to_le16(len
- DOT11_MGMT_HDR_LEN
);
4930 /* Add the channel. Use the one specified as parameter if any or
4931 * the current one (got from the firmware) otherwise
4934 freq
= chan
->center_freq
;
4936 brcmf_fil_cmd_int_get(vif
->ifp
, BRCMF_C_GET_CHANNEL
,
4938 chan_nr
= ieee80211_frequency_to_channel(freq
);
4939 af_params
->channel
= cpu_to_le32(chan_nr
);
4941 memcpy(action_frame
->data
, &buf
[DOT11_MGMT_HDR_LEN
],
4942 le16_to_cpu(action_frame
->len
));
4944 brcmf_dbg(TRACE
, "Action frame, cookie=%lld, len=%d, freq=%d\n",
4945 *cookie
, le16_to_cpu(action_frame
->len
), freq
);
4947 ack
= brcmf_p2p_send_action_frame(cfg
, cfg_to_ndev(cfg
),
4950 cfg80211_mgmt_tx_status(wdev
, *cookie
, buf
, len
, ack
,
4954 brcmf_dbg(TRACE
, "Unhandled, fc=%04x!!\n", mgmt
->frame_control
);
4955 brcmf_dbg_hex_dump(true, buf
, len
, "payload, len=%Zu\n", len
);
4964 brcmf_cfg80211_cancel_remain_on_channel(struct wiphy
*wiphy
,
4965 struct wireless_dev
*wdev
,
4968 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
4969 struct brcmf_cfg80211_vif
*vif
;
4972 brcmf_dbg(TRACE
, "Enter p2p listen cancel\n");
4974 vif
= cfg
->p2p
.bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
;
4976 brcmf_err("No p2p device available for probe response\n");
4980 brcmf_p2p_cancel_remain_on_channel(vif
->ifp
);
4985 static int brcmf_cfg80211_get_channel(struct wiphy
*wiphy
,
4986 struct wireless_dev
*wdev
,
4987 struct cfg80211_chan_def
*chandef
)
4989 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
4990 struct net_device
*ndev
= wdev
->netdev
;
4991 struct brcmf_if
*ifp
;
4992 struct brcmu_chan ch
;
4993 enum nl80211_band band
= 0;
4994 enum nl80211_chan_width width
= 0;
5000 ifp
= netdev_priv(ndev
);
5002 err
= brcmf_fil_iovar_int_get(ifp
, "chanspec", &chanspec
);
5004 brcmf_err("chanspec failed (%d)\n", err
);
5008 ch
.chspec
= chanspec
;
5009 cfg
->d11inf
.decchspec(&ch
);
5012 case BRCMU_CHAN_BAND_2G
:
5013 band
= NL80211_BAND_2GHZ
;
5015 case BRCMU_CHAN_BAND_5G
:
5016 band
= NL80211_BAND_5GHZ
;
5021 case BRCMU_CHAN_BW_80
:
5022 width
= NL80211_CHAN_WIDTH_80
;
5024 case BRCMU_CHAN_BW_40
:
5025 width
= NL80211_CHAN_WIDTH_40
;
5027 case BRCMU_CHAN_BW_20
:
5028 width
= NL80211_CHAN_WIDTH_20
;
5030 case BRCMU_CHAN_BW_80P80
:
5031 width
= NL80211_CHAN_WIDTH_80P80
;
5033 case BRCMU_CHAN_BW_160
:
5034 width
= NL80211_CHAN_WIDTH_160
;
5038 freq
= ieee80211_channel_to_frequency(ch
.control_ch_num
, band
);
5039 chandef
->chan
= ieee80211_get_channel(wiphy
, freq
);
5040 chandef
->width
= width
;
5041 chandef
->center_freq1
= ieee80211_channel_to_frequency(ch
.chnum
, band
);
5042 chandef
->center_freq2
= 0;
5047 static int brcmf_cfg80211_crit_proto_start(struct wiphy
*wiphy
,
5048 struct wireless_dev
*wdev
,
5049 enum nl80211_crit_proto_id proto
,
5052 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
5053 struct brcmf_cfg80211_vif
*vif
;
5055 vif
= container_of(wdev
, struct brcmf_cfg80211_vif
, wdev
);
5057 /* only DHCP support for now */
5058 if (proto
!= NL80211_CRIT_PROTO_DHCP
)
5061 /* suppress and abort scanning */
5062 set_bit(BRCMF_SCAN_STATUS_SUPPRESS
, &cfg
->scan_status
);
5063 brcmf_abort_scanning(cfg
);
5065 return brcmf_btcoex_set_mode(vif
, BRCMF_BTCOEX_DISABLED
, duration
);
5068 static void brcmf_cfg80211_crit_proto_stop(struct wiphy
*wiphy
,
5069 struct wireless_dev
*wdev
)
5071 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
5072 struct brcmf_cfg80211_vif
*vif
;
5074 vif
= container_of(wdev
, struct brcmf_cfg80211_vif
, wdev
);
5076 brcmf_btcoex_set_mode(vif
, BRCMF_BTCOEX_ENABLED
, 0);
5077 clear_bit(BRCMF_SCAN_STATUS_SUPPRESS
, &cfg
->scan_status
);
5081 brcmf_notify_tdls_peer_event(struct brcmf_if
*ifp
,
5082 const struct brcmf_event_msg
*e
, void *data
)
5084 switch (e
->reason
) {
5085 case BRCMF_E_REASON_TDLS_PEER_DISCOVERED
:
5086 brcmf_dbg(TRACE
, "TDLS Peer Discovered\n");
5088 case BRCMF_E_REASON_TDLS_PEER_CONNECTED
:
5089 brcmf_dbg(TRACE
, "TDLS Peer Connected\n");
5090 brcmf_proto_add_tdls_peer(ifp
->drvr
, ifp
->ifidx
, (u8
*)e
->addr
);
5092 case BRCMF_E_REASON_TDLS_PEER_DISCONNECTED
:
5093 brcmf_dbg(TRACE
, "TDLS Peer Disconnected\n");
5094 brcmf_proto_delete_peer(ifp
->drvr
, ifp
->ifidx
, (u8
*)e
->addr
);
5101 static int brcmf_convert_nl80211_tdls_oper(enum nl80211_tdls_operation oper
)
5106 case NL80211_TDLS_DISCOVERY_REQ
:
5107 ret
= BRCMF_TDLS_MANUAL_EP_DISCOVERY
;
5109 case NL80211_TDLS_SETUP
:
5110 ret
= BRCMF_TDLS_MANUAL_EP_CREATE
;
5112 case NL80211_TDLS_TEARDOWN
:
5113 ret
= BRCMF_TDLS_MANUAL_EP_DELETE
;
5116 brcmf_err("unsupported operation: %d\n", oper
);
5122 static int brcmf_cfg80211_tdls_oper(struct wiphy
*wiphy
,
5123 struct net_device
*ndev
, const u8
*peer
,
5124 enum nl80211_tdls_operation oper
)
5126 struct brcmf_if
*ifp
;
5127 struct brcmf_tdls_iovar_le info
;
5130 ret
= brcmf_convert_nl80211_tdls_oper(oper
);
5134 ifp
= netdev_priv(ndev
);
5135 memset(&info
, 0, sizeof(info
));
5136 info
.mode
= (u8
)ret
;
5138 memcpy(info
.ea
, peer
, ETH_ALEN
);
5140 ret
= brcmf_fil_iovar_data_set(ifp
, "tdls_endpoint",
5141 &info
, sizeof(info
));
5143 brcmf_err("tdls_endpoint iovar failed: ret=%d\n", ret
);
5150 brcmf_cfg80211_set_rekey_data(struct wiphy
*wiphy
, struct net_device
*ndev
,
5151 struct cfg80211_gtk_rekey_data
*gtk
)
5153 struct brcmf_if
*ifp
= netdev_priv(ndev
);
5154 struct brcmf_gtk_keyinfo_le gtk_le
;
5157 brcmf_dbg(TRACE
, "Enter, bssidx=%d\n", ifp
->bsscfgidx
);
5159 memcpy(gtk_le
.kck
, gtk
->kck
, sizeof(gtk_le
.kck
));
5160 memcpy(gtk_le
.kek
, gtk
->kek
, sizeof(gtk_le
.kek
));
5161 memcpy(gtk_le
.replay_counter
, gtk
->replay_ctr
,
5162 sizeof(gtk_le
.replay_counter
));
5164 ret
= brcmf_fil_iovar_data_set(ifp
, "gtk_key_info", >k_le
,
5167 brcmf_err("gtk_key_info iovar failed: ret=%d\n", ret
);
5173 static struct cfg80211_ops brcmf_cfg80211_ops
= {
5174 .add_virtual_intf
= brcmf_cfg80211_add_iface
,
5175 .del_virtual_intf
= brcmf_cfg80211_del_iface
,
5176 .change_virtual_intf
= brcmf_cfg80211_change_iface
,
5177 .scan
= brcmf_cfg80211_scan
,
5178 .set_wiphy_params
= brcmf_cfg80211_set_wiphy_params
,
5179 .join_ibss
= brcmf_cfg80211_join_ibss
,
5180 .leave_ibss
= brcmf_cfg80211_leave_ibss
,
5181 .get_station
= brcmf_cfg80211_get_station
,
5182 .dump_station
= brcmf_cfg80211_dump_station
,
5183 .set_tx_power
= brcmf_cfg80211_set_tx_power
,
5184 .get_tx_power
= brcmf_cfg80211_get_tx_power
,
5185 .add_key
= brcmf_cfg80211_add_key
,
5186 .del_key
= brcmf_cfg80211_del_key
,
5187 .get_key
= brcmf_cfg80211_get_key
,
5188 .set_default_key
= brcmf_cfg80211_config_default_key
,
5189 .set_default_mgmt_key
= brcmf_cfg80211_config_default_mgmt_key
,
5190 .set_power_mgmt
= brcmf_cfg80211_set_power_mgmt
,
5191 .connect
= brcmf_cfg80211_connect
,
5192 .disconnect
= brcmf_cfg80211_disconnect
,
5193 .suspend
= brcmf_cfg80211_suspend
,
5194 .resume
= brcmf_cfg80211_resume
,
5195 .set_pmksa
= brcmf_cfg80211_set_pmksa
,
5196 .del_pmksa
= brcmf_cfg80211_del_pmksa
,
5197 .flush_pmksa
= brcmf_cfg80211_flush_pmksa
,
5198 .start_ap
= brcmf_cfg80211_start_ap
,
5199 .stop_ap
= brcmf_cfg80211_stop_ap
,
5200 .change_beacon
= brcmf_cfg80211_change_beacon
,
5201 .del_station
= brcmf_cfg80211_del_station
,
5202 .change_station
= brcmf_cfg80211_change_station
,
5203 .sched_scan_start
= brcmf_cfg80211_sched_scan_start
,
5204 .sched_scan_stop
= brcmf_cfg80211_sched_scan_stop
,
5205 .mgmt_frame_register
= brcmf_cfg80211_mgmt_frame_register
,
5206 .mgmt_tx
= brcmf_cfg80211_mgmt_tx
,
5207 .remain_on_channel
= brcmf_p2p_remain_on_channel
,
5208 .cancel_remain_on_channel
= brcmf_cfg80211_cancel_remain_on_channel
,
5209 .get_channel
= brcmf_cfg80211_get_channel
,
5210 .start_p2p_device
= brcmf_p2p_start_device
,
5211 .stop_p2p_device
= brcmf_p2p_stop_device
,
5212 .crit_proto_start
= brcmf_cfg80211_crit_proto_start
,
5213 .crit_proto_stop
= brcmf_cfg80211_crit_proto_stop
,
5214 .tdls_oper
= brcmf_cfg80211_tdls_oper
,
5217 struct brcmf_cfg80211_vif
*brcmf_alloc_vif(struct brcmf_cfg80211_info
*cfg
,
5218 enum nl80211_iftype type
)
5220 struct brcmf_cfg80211_vif
*vif_walk
;
5221 struct brcmf_cfg80211_vif
*vif
;
5224 brcmf_dbg(TRACE
, "allocating virtual interface (size=%zu)\n",
5226 vif
= kzalloc(sizeof(*vif
), GFP_KERNEL
);
5228 return ERR_PTR(-ENOMEM
);
5230 vif
->wdev
.wiphy
= cfg
->wiphy
;
5231 vif
->wdev
.iftype
= type
;
5233 brcmf_init_prof(&vif
->profile
);
5235 if (type
== NL80211_IFTYPE_AP
) {
5237 list_for_each_entry(vif_walk
, &cfg
->vif_list
, list
) {
5238 if (vif_walk
->wdev
.iftype
== NL80211_IFTYPE_AP
) {
5246 list_add_tail(&vif
->list
, &cfg
->vif_list
);
5250 void brcmf_free_vif(struct brcmf_cfg80211_vif
*vif
)
5252 list_del(&vif
->list
);
5256 void brcmf_cfg80211_free_netdev(struct net_device
*ndev
)
5258 struct brcmf_cfg80211_vif
*vif
;
5259 struct brcmf_if
*ifp
;
5261 ifp
= netdev_priv(ndev
);
5265 brcmf_free_vif(vif
);
5269 static bool brcmf_is_linkup(const struct brcmf_event_msg
*e
)
5271 u32 event
= e
->event_code
;
5272 u32 status
= e
->status
;
5274 if (event
== BRCMF_E_SET_SSID
&& status
== BRCMF_E_STATUS_SUCCESS
) {
5275 brcmf_dbg(CONN
, "Processing set ssid\n");
5282 static bool brcmf_is_linkdown(const struct brcmf_event_msg
*e
)
5284 u32 event
= e
->event_code
;
5285 u16 flags
= e
->flags
;
5287 if ((event
== BRCMF_E_DEAUTH
) || (event
== BRCMF_E_DEAUTH_IND
) ||
5288 (event
== BRCMF_E_DISASSOC_IND
) ||
5289 ((event
== BRCMF_E_LINK
) && (!(flags
& BRCMF_EVENT_MSG_LINK
)))) {
5290 brcmf_dbg(CONN
, "Processing link down\n");
5296 static bool brcmf_is_nonetwork(struct brcmf_cfg80211_info
*cfg
,
5297 const struct brcmf_event_msg
*e
)
5299 u32 event
= e
->event_code
;
5300 u32 status
= e
->status
;
5302 if (event
== BRCMF_E_LINK
&& status
== BRCMF_E_STATUS_NO_NETWORKS
) {
5303 brcmf_dbg(CONN
, "Processing Link %s & no network found\n",
5304 e
->flags
& BRCMF_EVENT_MSG_LINK
? "up" : "down");
5308 if (event
== BRCMF_E_SET_SSID
&& status
!= BRCMF_E_STATUS_SUCCESS
) {
5309 brcmf_dbg(CONN
, "Processing connecting & no network found\n");
5316 static void brcmf_clear_assoc_ies(struct brcmf_cfg80211_info
*cfg
)
5318 struct brcmf_cfg80211_connect_info
*conn_info
= cfg_to_conn(cfg
);
5320 kfree(conn_info
->req_ie
);
5321 conn_info
->req_ie
= NULL
;
5322 conn_info
->req_ie_len
= 0;
5323 kfree(conn_info
->resp_ie
);
5324 conn_info
->resp_ie
= NULL
;
5325 conn_info
->resp_ie_len
= 0;
5328 static s32
brcmf_get_assoc_ies(struct brcmf_cfg80211_info
*cfg
,
5329 struct brcmf_if
*ifp
)
5331 struct brcmf_cfg80211_assoc_ielen_le
*assoc_info
;
5332 struct brcmf_cfg80211_connect_info
*conn_info
= cfg_to_conn(cfg
);
5337 brcmf_clear_assoc_ies(cfg
);
5339 err
= brcmf_fil_iovar_data_get(ifp
, "assoc_info",
5340 cfg
->extra_buf
, WL_ASSOC_INFO_MAX
);
5342 brcmf_err("could not get assoc info (%d)\n", err
);
5346 (struct brcmf_cfg80211_assoc_ielen_le
*)cfg
->extra_buf
;
5347 req_len
= le32_to_cpu(assoc_info
->req_len
);
5348 resp_len
= le32_to_cpu(assoc_info
->resp_len
);
5350 err
= brcmf_fil_iovar_data_get(ifp
, "assoc_req_ies",
5354 brcmf_err("could not get assoc req (%d)\n", err
);
5357 conn_info
->req_ie_len
= req_len
;
5359 kmemdup(cfg
->extra_buf
, conn_info
->req_ie_len
,
5362 conn_info
->req_ie_len
= 0;
5363 conn_info
->req_ie
= NULL
;
5366 err
= brcmf_fil_iovar_data_get(ifp
, "assoc_resp_ies",
5370 brcmf_err("could not get assoc resp (%d)\n", err
);
5373 conn_info
->resp_ie_len
= resp_len
;
5374 conn_info
->resp_ie
=
5375 kmemdup(cfg
->extra_buf
, conn_info
->resp_ie_len
,
5378 conn_info
->resp_ie_len
= 0;
5379 conn_info
->resp_ie
= NULL
;
5381 brcmf_dbg(CONN
, "req len (%d) resp len (%d)\n",
5382 conn_info
->req_ie_len
, conn_info
->resp_ie_len
);
5388 brcmf_bss_roaming_done(struct brcmf_cfg80211_info
*cfg
,
5389 struct net_device
*ndev
,
5390 const struct brcmf_event_msg
*e
)
5392 struct brcmf_if
*ifp
= netdev_priv(ndev
);
5393 struct brcmf_cfg80211_profile
*profile
= &ifp
->vif
->profile
;
5394 struct brcmf_cfg80211_connect_info
*conn_info
= cfg_to_conn(cfg
);
5395 struct wiphy
*wiphy
= cfg_to_wiphy(cfg
);
5396 struct ieee80211_channel
*notify_channel
= NULL
;
5397 struct ieee80211_supported_band
*band
;
5398 struct brcmf_bss_info_le
*bi
;
5399 struct brcmu_chan ch
;
5404 brcmf_dbg(TRACE
, "Enter\n");
5406 brcmf_get_assoc_ies(cfg
, ifp
);
5407 memcpy(profile
->bssid
, e
->addr
, ETH_ALEN
);
5408 brcmf_update_bss_info(cfg
, ifp
);
5410 buf
= kzalloc(WL_BSS_INFO_MAX
, GFP_KERNEL
);
5416 /* data sent to dongle has to be little endian */
5417 *(__le32
*)buf
= cpu_to_le32(WL_BSS_INFO_MAX
);
5418 err
= brcmf_fil_cmd_data_get(ifp
, BRCMF_C_GET_BSS_INFO
,
5419 buf
, WL_BSS_INFO_MAX
);
5424 bi
= (struct brcmf_bss_info_le
*)(buf
+ 4);
5425 ch
.chspec
= le16_to_cpu(bi
->chanspec
);
5426 cfg
->d11inf
.decchspec(&ch
);
5428 if (ch
.band
== BRCMU_CHAN_BAND_2G
)
5429 band
= wiphy
->bands
[NL80211_BAND_2GHZ
];
5431 band
= wiphy
->bands
[NL80211_BAND_5GHZ
];
5433 freq
= ieee80211_channel_to_frequency(ch
.control_ch_num
, band
->band
);
5434 notify_channel
= ieee80211_get_channel(wiphy
, freq
);
5438 cfg80211_roamed(ndev
, notify_channel
, (u8
*)profile
->bssid
,
5439 conn_info
->req_ie
, conn_info
->req_ie_len
,
5440 conn_info
->resp_ie
, conn_info
->resp_ie_len
, GFP_KERNEL
);
5441 brcmf_dbg(CONN
, "Report roaming result\n");
5443 set_bit(BRCMF_VIF_STATUS_CONNECTED
, &ifp
->vif
->sme_state
);
5444 brcmf_dbg(TRACE
, "Exit\n");
5449 brcmf_bss_connect_done(struct brcmf_cfg80211_info
*cfg
,
5450 struct net_device
*ndev
, const struct brcmf_event_msg
*e
,
5453 struct brcmf_if
*ifp
= netdev_priv(ndev
);
5454 struct brcmf_cfg80211_profile
*profile
= &ifp
->vif
->profile
;
5455 struct brcmf_cfg80211_connect_info
*conn_info
= cfg_to_conn(cfg
);
5457 brcmf_dbg(TRACE
, "Enter\n");
5459 if (test_and_clear_bit(BRCMF_VIF_STATUS_CONNECTING
,
5460 &ifp
->vif
->sme_state
)) {
5462 brcmf_get_assoc_ies(cfg
, ifp
);
5463 memcpy(profile
->bssid
, e
->addr
, ETH_ALEN
);
5464 brcmf_update_bss_info(cfg
, ifp
);
5465 set_bit(BRCMF_VIF_STATUS_CONNECTED
,
5466 &ifp
->vif
->sme_state
);
5468 cfg80211_connect_result(ndev
,
5469 (u8
*)profile
->bssid
,
5471 conn_info
->req_ie_len
,
5473 conn_info
->resp_ie_len
,
5474 completed
? WLAN_STATUS_SUCCESS
:
5475 WLAN_STATUS_AUTH_TIMEOUT
,
5477 brcmf_dbg(CONN
, "Report connect result - connection %s\n",
5478 completed
? "succeeded" : "failed");
5480 brcmf_dbg(TRACE
, "Exit\n");
5485 brcmf_notify_connect_status_ap(struct brcmf_cfg80211_info
*cfg
,
5486 struct net_device
*ndev
,
5487 const struct brcmf_event_msg
*e
, void *data
)
5489 static int generation
;
5490 u32 event
= e
->event_code
;
5491 u32 reason
= e
->reason
;
5492 struct station_info sinfo
;
5494 brcmf_dbg(CONN
, "event %d, reason %d\n", event
, reason
);
5495 if (event
== BRCMF_E_LINK
&& reason
== BRCMF_E_REASON_LINK_BSSCFG_DIS
&&
5496 ndev
!= cfg_to_ndev(cfg
)) {
5497 brcmf_dbg(CONN
, "AP mode link down\n");
5498 complete(&cfg
->vif_disabled
);
5502 if (((event
== BRCMF_E_ASSOC_IND
) || (event
== BRCMF_E_REASSOC_IND
)) &&
5503 (reason
== BRCMF_E_STATUS_SUCCESS
)) {
5504 memset(&sinfo
, 0, sizeof(sinfo
));
5506 brcmf_err("No IEs present in ASSOC/REASSOC_IND");
5509 sinfo
.assoc_req_ies
= data
;
5510 sinfo
.assoc_req_ies_len
= e
->datalen
;
5512 sinfo
.generation
= generation
;
5513 cfg80211_new_sta(ndev
, e
->addr
, &sinfo
, GFP_KERNEL
);
5514 } else if ((event
== BRCMF_E_DISASSOC_IND
) ||
5515 (event
== BRCMF_E_DEAUTH_IND
) ||
5516 (event
== BRCMF_E_DEAUTH
)) {
5517 cfg80211_del_sta(ndev
, e
->addr
, GFP_KERNEL
);
5523 brcmf_notify_connect_status(struct brcmf_if
*ifp
,
5524 const struct brcmf_event_msg
*e
, void *data
)
5526 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
5527 struct net_device
*ndev
= ifp
->ndev
;
5528 struct brcmf_cfg80211_profile
*profile
= &ifp
->vif
->profile
;
5529 struct ieee80211_channel
*chan
;
5532 if ((e
->event_code
== BRCMF_E_DEAUTH
) ||
5533 (e
->event_code
== BRCMF_E_DEAUTH_IND
) ||
5534 (e
->event_code
== BRCMF_E_DISASSOC_IND
) ||
5535 ((e
->event_code
== BRCMF_E_LINK
) && (!e
->flags
))) {
5536 brcmf_proto_delete_peer(ifp
->drvr
, ifp
->ifidx
, (u8
*)e
->addr
);
5539 if (brcmf_is_apmode(ifp
->vif
)) {
5540 err
= brcmf_notify_connect_status_ap(cfg
, ndev
, e
, data
);
5541 } else if (brcmf_is_linkup(e
)) {
5542 brcmf_dbg(CONN
, "Linkup\n");
5543 if (brcmf_is_ibssmode(ifp
->vif
)) {
5544 brcmf_inform_ibss(cfg
, ndev
, e
->addr
);
5545 chan
= ieee80211_get_channel(cfg
->wiphy
, cfg
->channel
);
5546 memcpy(profile
->bssid
, e
->addr
, ETH_ALEN
);
5547 cfg80211_ibss_joined(ndev
, e
->addr
, chan
, GFP_KERNEL
);
5548 clear_bit(BRCMF_VIF_STATUS_CONNECTING
,
5549 &ifp
->vif
->sme_state
);
5550 set_bit(BRCMF_VIF_STATUS_CONNECTED
,
5551 &ifp
->vif
->sme_state
);
5553 brcmf_bss_connect_done(cfg
, ndev
, e
, true);
5554 brcmf_net_setcarrier(ifp
, true);
5555 } else if (brcmf_is_linkdown(e
)) {
5556 brcmf_dbg(CONN
, "Linkdown\n");
5557 if (!brcmf_is_ibssmode(ifp
->vif
)) {
5558 brcmf_bss_connect_done(cfg
, ndev
, e
, false);
5559 brcmf_link_down(ifp
->vif
,
5560 brcmf_map_fw_linkdown_reason(e
));
5561 brcmf_init_prof(ndev_to_prof(ndev
));
5562 if (ndev
!= cfg_to_ndev(cfg
))
5563 complete(&cfg
->vif_disabled
);
5564 brcmf_net_setcarrier(ifp
, false);
5566 } else if (brcmf_is_nonetwork(cfg
, e
)) {
5567 if (brcmf_is_ibssmode(ifp
->vif
))
5568 clear_bit(BRCMF_VIF_STATUS_CONNECTING
,
5569 &ifp
->vif
->sme_state
);
5571 brcmf_bss_connect_done(cfg
, ndev
, e
, false);
5578 brcmf_notify_roaming_status(struct brcmf_if
*ifp
,
5579 const struct brcmf_event_msg
*e
, void *data
)
5581 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
5582 u32 event
= e
->event_code
;
5583 u32 status
= e
->status
;
5585 if (event
== BRCMF_E_ROAM
&& status
== BRCMF_E_STATUS_SUCCESS
) {
5586 if (test_bit(BRCMF_VIF_STATUS_CONNECTED
, &ifp
->vif
->sme_state
))
5587 brcmf_bss_roaming_done(cfg
, ifp
->ndev
, e
);
5589 brcmf_bss_connect_done(cfg
, ifp
->ndev
, e
, true);
5596 brcmf_notify_mic_status(struct brcmf_if
*ifp
,
5597 const struct brcmf_event_msg
*e
, void *data
)
5599 u16 flags
= e
->flags
;
5600 enum nl80211_key_type key_type
;
5602 if (flags
& BRCMF_EVENT_MSG_GROUP
)
5603 key_type
= NL80211_KEYTYPE_GROUP
;
5605 key_type
= NL80211_KEYTYPE_PAIRWISE
;
5607 cfg80211_michael_mic_failure(ifp
->ndev
, (u8
*)&e
->addr
, key_type
, -1,
5613 static s32
brcmf_notify_vif_event(struct brcmf_if
*ifp
,
5614 const struct brcmf_event_msg
*e
, void *data
)
5616 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
5617 struct brcmf_if_event
*ifevent
= (struct brcmf_if_event
*)data
;
5618 struct brcmf_cfg80211_vif_event
*event
= &cfg
->vif_event
;
5619 struct brcmf_cfg80211_vif
*vif
;
5621 brcmf_dbg(TRACE
, "Enter: action %u flags %u ifidx %u bsscfgidx %u\n",
5622 ifevent
->action
, ifevent
->flags
, ifevent
->ifidx
,
5623 ifevent
->bsscfgidx
);
5625 mutex_lock(&event
->vif_event_lock
);
5626 event
->action
= ifevent
->action
;
5629 switch (ifevent
->action
) {
5630 case BRCMF_E_IF_ADD
:
5631 /* waiting process may have timed out */
5632 if (!cfg
->vif_event
.vif
) {
5633 mutex_unlock(&event
->vif_event_lock
);
5640 vif
->wdev
.netdev
= ifp
->ndev
;
5641 ifp
->ndev
->ieee80211_ptr
= &vif
->wdev
;
5642 SET_NETDEV_DEV(ifp
->ndev
, wiphy_dev(cfg
->wiphy
));
5644 mutex_unlock(&event
->vif_event_lock
);
5645 wake_up(&event
->vif_wq
);
5648 case BRCMF_E_IF_DEL
:
5649 mutex_unlock(&event
->vif_event_lock
);
5650 /* event may not be upon user request */
5651 if (brcmf_cfg80211_vif_event_armed(cfg
))
5652 wake_up(&event
->vif_wq
);
5655 case BRCMF_E_IF_CHANGE
:
5656 mutex_unlock(&event
->vif_event_lock
);
5657 wake_up(&event
->vif_wq
);
5661 mutex_unlock(&event
->vif_event_lock
);
5667 static void brcmf_init_conf(struct brcmf_cfg80211_conf
*conf
)
5669 conf
->frag_threshold
= (u32
)-1;
5670 conf
->rts_threshold
= (u32
)-1;
5671 conf
->retry_short
= (u32
)-1;
5672 conf
->retry_long
= (u32
)-1;
5675 static void brcmf_register_event_handlers(struct brcmf_cfg80211_info
*cfg
)
5677 brcmf_fweh_register(cfg
->pub
, BRCMF_E_LINK
,
5678 brcmf_notify_connect_status
);
5679 brcmf_fweh_register(cfg
->pub
, BRCMF_E_DEAUTH_IND
,
5680 brcmf_notify_connect_status
);
5681 brcmf_fweh_register(cfg
->pub
, BRCMF_E_DEAUTH
,
5682 brcmf_notify_connect_status
);
5683 brcmf_fweh_register(cfg
->pub
, BRCMF_E_DISASSOC_IND
,
5684 brcmf_notify_connect_status
);
5685 brcmf_fweh_register(cfg
->pub
, BRCMF_E_ASSOC_IND
,
5686 brcmf_notify_connect_status
);
5687 brcmf_fweh_register(cfg
->pub
, BRCMF_E_REASSOC_IND
,
5688 brcmf_notify_connect_status
);
5689 brcmf_fweh_register(cfg
->pub
, BRCMF_E_ROAM
,
5690 brcmf_notify_roaming_status
);
5691 brcmf_fweh_register(cfg
->pub
, BRCMF_E_MIC_ERROR
,
5692 brcmf_notify_mic_status
);
5693 brcmf_fweh_register(cfg
->pub
, BRCMF_E_SET_SSID
,
5694 brcmf_notify_connect_status
);
5695 brcmf_fweh_register(cfg
->pub
, BRCMF_E_PFN_NET_FOUND
,
5696 brcmf_notify_sched_scan_results
);
5697 brcmf_fweh_register(cfg
->pub
, BRCMF_E_IF
,
5698 brcmf_notify_vif_event
);
5699 brcmf_fweh_register(cfg
->pub
, BRCMF_E_P2P_PROBEREQ_MSG
,
5700 brcmf_p2p_notify_rx_mgmt_p2p_probereq
);
5701 brcmf_fweh_register(cfg
->pub
, BRCMF_E_P2P_DISC_LISTEN_COMPLETE
,
5702 brcmf_p2p_notify_listen_complete
);
5703 brcmf_fweh_register(cfg
->pub
, BRCMF_E_ACTION_FRAME_RX
,
5704 brcmf_p2p_notify_action_frame_rx
);
5705 brcmf_fweh_register(cfg
->pub
, BRCMF_E_ACTION_FRAME_COMPLETE
,
5706 brcmf_p2p_notify_action_tx_complete
);
5707 brcmf_fweh_register(cfg
->pub
, BRCMF_E_ACTION_FRAME_OFF_CHAN_COMPLETE
,
5708 brcmf_p2p_notify_action_tx_complete
);
5711 static void brcmf_deinit_priv_mem(struct brcmf_cfg80211_info
*cfg
)
5715 kfree(cfg
->extra_buf
);
5716 cfg
->extra_buf
= NULL
;
5717 kfree(cfg
->wowl
.nd
);
5718 cfg
->wowl
.nd
= NULL
;
5719 kfree(cfg
->wowl
.nd_info
);
5720 cfg
->wowl
.nd_info
= NULL
;
5721 kfree(cfg
->escan_info
.escan_buf
);
5722 cfg
->escan_info
.escan_buf
= NULL
;
5725 static s32
brcmf_init_priv_mem(struct brcmf_cfg80211_info
*cfg
)
5727 cfg
->conf
= kzalloc(sizeof(*cfg
->conf
), GFP_KERNEL
);
5729 goto init_priv_mem_out
;
5730 cfg
->extra_buf
= kzalloc(WL_EXTRA_BUF_MAX
, GFP_KERNEL
);
5731 if (!cfg
->extra_buf
)
5732 goto init_priv_mem_out
;
5733 cfg
->wowl
.nd
= kzalloc(sizeof(*cfg
->wowl
.nd
) + sizeof(u32
), GFP_KERNEL
);
5735 goto init_priv_mem_out
;
5736 cfg
->wowl
.nd_info
= kzalloc(sizeof(*cfg
->wowl
.nd_info
) +
5737 sizeof(struct cfg80211_wowlan_nd_match
*),
5739 if (!cfg
->wowl
.nd_info
)
5740 goto init_priv_mem_out
;
5741 cfg
->escan_info
.escan_buf
= kzalloc(BRCMF_ESCAN_BUF_SIZE
, GFP_KERNEL
);
5742 if (!cfg
->escan_info
.escan_buf
)
5743 goto init_priv_mem_out
;
5748 brcmf_deinit_priv_mem(cfg
);
5753 static s32
wl_init_priv(struct brcmf_cfg80211_info
*cfg
)
5757 cfg
->scan_request
= NULL
;
5758 cfg
->pwr_save
= true;
5759 cfg
->active_scan
= true; /* we do active scan per default */
5760 cfg
->dongle_up
= false; /* dongle is not up yet */
5761 err
= brcmf_init_priv_mem(cfg
);
5764 brcmf_register_event_handlers(cfg
);
5765 mutex_init(&cfg
->usr_sync
);
5766 brcmf_init_escan(cfg
);
5767 brcmf_init_conf(cfg
->conf
);
5768 init_completion(&cfg
->vif_disabled
);
5772 static void wl_deinit_priv(struct brcmf_cfg80211_info
*cfg
)
5774 cfg
->dongle_up
= false; /* dongle down */
5775 brcmf_abort_scanning(cfg
);
5776 brcmf_deinit_priv_mem(cfg
);
5779 static void init_vif_event(struct brcmf_cfg80211_vif_event
*event
)
5781 init_waitqueue_head(&event
->vif_wq
);
5782 mutex_init(&event
->vif_event_lock
);
5785 static s32
brcmf_dongle_roam(struct brcmf_if
*ifp
)
5789 __le32 roamtrigger
[2];
5790 __le32 roam_delta
[2];
5792 /* Configure beacon timeout value based upon roaming setting */
5793 if (ifp
->drvr
->settings
->roamoff
)
5794 bcn_timeout
= BRCMF_DEFAULT_BCN_TIMEOUT_ROAM_OFF
;
5796 bcn_timeout
= BRCMF_DEFAULT_BCN_TIMEOUT_ROAM_ON
;
5797 err
= brcmf_fil_iovar_int_set(ifp
, "bcn_timeout", bcn_timeout
);
5799 brcmf_err("bcn_timeout error (%d)\n", err
);
5800 goto roam_setup_done
;
5803 /* Enable/Disable built-in roaming to allow supplicant to take care of
5806 brcmf_dbg(INFO
, "Internal Roaming = %s\n",
5807 ifp
->drvr
->settings
->roamoff
? "Off" : "On");
5808 err
= brcmf_fil_iovar_int_set(ifp
, "roam_off",
5809 ifp
->drvr
->settings
->roamoff
);
5811 brcmf_err("roam_off error (%d)\n", err
);
5812 goto roam_setup_done
;
5815 roamtrigger
[0] = cpu_to_le32(WL_ROAM_TRIGGER_LEVEL
);
5816 roamtrigger
[1] = cpu_to_le32(BRCM_BAND_ALL
);
5817 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_SET_ROAM_TRIGGER
,
5818 (void *)roamtrigger
, sizeof(roamtrigger
));
5820 brcmf_err("WLC_SET_ROAM_TRIGGER error (%d)\n", err
);
5821 goto roam_setup_done
;
5824 roam_delta
[0] = cpu_to_le32(WL_ROAM_DELTA
);
5825 roam_delta
[1] = cpu_to_le32(BRCM_BAND_ALL
);
5826 err
= brcmf_fil_cmd_data_set(ifp
, BRCMF_C_SET_ROAM_DELTA
,
5827 (void *)roam_delta
, sizeof(roam_delta
));
5829 brcmf_err("WLC_SET_ROAM_DELTA error (%d)\n", err
);
5830 goto roam_setup_done
;
5838 brcmf_dongle_scantime(struct brcmf_if
*ifp
)
5842 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_SCAN_CHANNEL_TIME
,
5843 BRCMF_SCAN_CHANNEL_TIME
);
5845 brcmf_err("Scan assoc time error (%d)\n", err
);
5846 goto dongle_scantime_out
;
5848 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_SCAN_UNASSOC_TIME
,
5849 BRCMF_SCAN_UNASSOC_TIME
);
5851 brcmf_err("Scan unassoc time error (%d)\n", err
);
5852 goto dongle_scantime_out
;
5855 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_SCAN_PASSIVE_TIME
,
5856 BRCMF_SCAN_PASSIVE_TIME
);
5858 brcmf_err("Scan passive time error (%d)\n", err
);
5859 goto dongle_scantime_out
;
5862 dongle_scantime_out
:
5866 static void brcmf_update_bw40_channel_flag(struct ieee80211_channel
*channel
,
5867 struct brcmu_chan
*ch
)
5871 ht40_flag
= channel
->flags
& IEEE80211_CHAN_NO_HT40
;
5872 if (ch
->sb
== BRCMU_CHAN_SB_U
) {
5873 if (ht40_flag
== IEEE80211_CHAN_NO_HT40
)
5874 channel
->flags
&= ~IEEE80211_CHAN_NO_HT40
;
5875 channel
->flags
|= IEEE80211_CHAN_NO_HT40PLUS
;
5877 /* It should be one of
5878 * IEEE80211_CHAN_NO_HT40 or
5879 * IEEE80211_CHAN_NO_HT40PLUS
5881 channel
->flags
&= ~IEEE80211_CHAN_NO_HT40
;
5882 if (ht40_flag
== IEEE80211_CHAN_NO_HT40
)
5883 channel
->flags
|= IEEE80211_CHAN_NO_HT40MINUS
;
5887 static int brcmf_construct_chaninfo(struct brcmf_cfg80211_info
*cfg
,
5890 struct brcmf_if
*ifp
= netdev_priv(cfg_to_ndev(cfg
));
5891 struct ieee80211_supported_band
*band
;
5892 struct ieee80211_channel
*channel
;
5893 struct wiphy
*wiphy
;
5894 struct brcmf_chanspec_list
*list
;
5895 struct brcmu_chan ch
;
5903 pbuf
= kzalloc(BRCMF_DCMD_MEDLEN
, GFP_KERNEL
);
5908 list
= (struct brcmf_chanspec_list
*)pbuf
;
5910 err
= brcmf_fil_iovar_data_get(ifp
, "chanspecs", pbuf
,
5913 brcmf_err("get chanspecs error (%d)\n", err
);
5917 wiphy
= cfg_to_wiphy(cfg
);
5918 band
= wiphy
->bands
[NL80211_BAND_2GHZ
];
5920 for (i
= 0; i
< band
->n_channels
; i
++)
5921 band
->channels
[i
].flags
= IEEE80211_CHAN_DISABLED
;
5922 band
= wiphy
->bands
[NL80211_BAND_5GHZ
];
5924 for (i
= 0; i
< band
->n_channels
; i
++)
5925 band
->channels
[i
].flags
= IEEE80211_CHAN_DISABLED
;
5927 total
= le32_to_cpu(list
->count
);
5928 for (i
= 0; i
< total
; i
++) {
5929 ch
.chspec
= (u16
)le32_to_cpu(list
->element
[i
]);
5930 cfg
->d11inf
.decchspec(&ch
);
5932 if (ch
.band
== BRCMU_CHAN_BAND_2G
) {
5933 band
= wiphy
->bands
[NL80211_BAND_2GHZ
];
5934 } else if (ch
.band
== BRCMU_CHAN_BAND_5G
) {
5935 band
= wiphy
->bands
[NL80211_BAND_5GHZ
];
5937 brcmf_err("Invalid channel Spec. 0x%x.\n", ch
.chspec
);
5942 if (!(bw_cap
[band
->band
] & WLC_BW_40MHZ_BIT
) &&
5943 ch
.bw
== BRCMU_CHAN_BW_40
)
5945 if (!(bw_cap
[band
->band
] & WLC_BW_80MHZ_BIT
) &&
5946 ch
.bw
== BRCMU_CHAN_BW_80
)
5949 channel
= band
->channels
;
5950 index
= band
->n_channels
;
5951 for (j
= 0; j
< band
->n_channels
; j
++) {
5952 if (channel
[j
].hw_value
== ch
.control_ch_num
) {
5957 channel
[index
].center_freq
=
5958 ieee80211_channel_to_frequency(ch
.control_ch_num
,
5960 channel
[index
].hw_value
= ch
.control_ch_num
;
5962 /* assuming the chanspecs order is HT20,
5963 * HT40 upper, HT40 lower, and VHT80.
5965 if (ch
.bw
== BRCMU_CHAN_BW_80
) {
5966 channel
[index
].flags
&= ~IEEE80211_CHAN_NO_80MHZ
;
5967 } else if (ch
.bw
== BRCMU_CHAN_BW_40
) {
5968 brcmf_update_bw40_channel_flag(&channel
[index
], &ch
);
5970 /* enable the channel and disable other bandwidths
5971 * for now as mentioned order assure they are enabled
5972 * for subsequent chanspecs.
5974 channel
[index
].flags
= IEEE80211_CHAN_NO_HT40
|
5975 IEEE80211_CHAN_NO_80MHZ
;
5976 ch
.bw
= BRCMU_CHAN_BW_20
;
5977 cfg
->d11inf
.encchspec(&ch
);
5978 chaninfo
= ch
.chspec
;
5979 err
= brcmf_fil_bsscfg_int_get(ifp
, "per_chan_info",
5982 if (chaninfo
& WL_CHAN_RADAR
)
5983 channel
[index
].flags
|=
5984 (IEEE80211_CHAN_RADAR
|
5985 IEEE80211_CHAN_NO_IR
);
5986 if (chaninfo
& WL_CHAN_PASSIVE
)
5987 channel
[index
].flags
|=
5988 IEEE80211_CHAN_NO_IR
;
5998 static int brcmf_enable_bw40_2g(struct brcmf_cfg80211_info
*cfg
)
6000 struct brcmf_if
*ifp
= netdev_priv(cfg_to_ndev(cfg
));
6001 struct ieee80211_supported_band
*band
;
6002 struct brcmf_fil_bwcap_le band_bwcap
;
6003 struct brcmf_chanspec_list
*list
;
6007 struct brcmu_chan ch
;
6011 /* verify support for bw_cap command */
6013 err
= brcmf_fil_iovar_int_get(ifp
, "bw_cap", &val
);
6016 /* only set 2G bandwidth using bw_cap command */
6017 band_bwcap
.band
= cpu_to_le32(WLC_BAND_2G
);
6018 band_bwcap
.bw_cap
= cpu_to_le32(WLC_BW_CAP_40MHZ
);
6019 err
= brcmf_fil_iovar_data_set(ifp
, "bw_cap", &band_bwcap
,
6020 sizeof(band_bwcap
));
6022 brcmf_dbg(INFO
, "fallback to mimo_bw_cap\n");
6023 val
= WLC_N_BW_40ALL
;
6024 err
= brcmf_fil_iovar_int_set(ifp
, "mimo_bw_cap", val
);
6028 /* update channel info in 2G band */
6029 pbuf
= kzalloc(BRCMF_DCMD_MEDLEN
, GFP_KERNEL
);
6034 ch
.band
= BRCMU_CHAN_BAND_2G
;
6035 ch
.bw
= BRCMU_CHAN_BW_40
;
6036 ch
.sb
= BRCMU_CHAN_SB_NONE
;
6038 cfg
->d11inf
.encchspec(&ch
);
6040 /* pass encoded chanspec in query */
6041 *(__le16
*)pbuf
= cpu_to_le16(ch
.chspec
);
6043 err
= brcmf_fil_iovar_data_get(ifp
, "chanspecs", pbuf
,
6046 brcmf_err("get chanspecs error (%d)\n", err
);
6051 band
= cfg_to_wiphy(cfg
)->bands
[NL80211_BAND_2GHZ
];
6052 list
= (struct brcmf_chanspec_list
*)pbuf
;
6053 num_chan
= le32_to_cpu(list
->count
);
6054 for (i
= 0; i
< num_chan
; i
++) {
6055 ch
.chspec
= (u16
)le32_to_cpu(list
->element
[i
]);
6056 cfg
->d11inf
.decchspec(&ch
);
6057 if (WARN_ON(ch
.band
!= BRCMU_CHAN_BAND_2G
))
6059 if (WARN_ON(ch
.bw
!= BRCMU_CHAN_BW_40
))
6061 for (j
= 0; j
< band
->n_channels
; j
++) {
6062 if (band
->channels
[j
].hw_value
== ch
.control_ch_num
)
6065 if (WARN_ON(j
== band
->n_channels
))
6068 brcmf_update_bw40_channel_flag(&band
->channels
[j
], &ch
);
6075 static void brcmf_get_bwcap(struct brcmf_if
*ifp
, u32 bw_cap
[])
6077 u32 band
, mimo_bwcap
;
6081 err
= brcmf_fil_iovar_int_get(ifp
, "bw_cap", &band
);
6083 bw_cap
[NL80211_BAND_2GHZ
] = band
;
6085 err
= brcmf_fil_iovar_int_get(ifp
, "bw_cap", &band
);
6087 bw_cap
[NL80211_BAND_5GHZ
] = band
;
6093 brcmf_dbg(INFO
, "fallback to mimo_bw_cap info\n");
6095 err
= brcmf_fil_iovar_int_get(ifp
, "mimo_bw_cap", &mimo_bwcap
);
6097 /* assume 20MHz if firmware does not give a clue */
6098 mimo_bwcap
= WLC_N_BW_20ALL
;
6100 switch (mimo_bwcap
) {
6101 case WLC_N_BW_40ALL
:
6102 bw_cap
[NL80211_BAND_2GHZ
] |= WLC_BW_40MHZ_BIT
;
6104 case WLC_N_BW_20IN2G_40IN5G
:
6105 bw_cap
[NL80211_BAND_5GHZ
] |= WLC_BW_40MHZ_BIT
;
6107 case WLC_N_BW_20ALL
:
6108 bw_cap
[NL80211_BAND_2GHZ
] |= WLC_BW_20MHZ_BIT
;
6109 bw_cap
[NL80211_BAND_5GHZ
] |= WLC_BW_20MHZ_BIT
;
6112 brcmf_err("invalid mimo_bw_cap value\n");
6116 static void brcmf_update_ht_cap(struct ieee80211_supported_band
*band
,
6117 u32 bw_cap
[2], u32 nchain
)
6119 band
->ht_cap
.ht_supported
= true;
6120 if (bw_cap
[band
->band
] & WLC_BW_40MHZ_BIT
) {
6121 band
->ht_cap
.cap
|= IEEE80211_HT_CAP_SGI_40
;
6122 band
->ht_cap
.cap
|= IEEE80211_HT_CAP_SUP_WIDTH_20_40
;
6124 band
->ht_cap
.cap
|= IEEE80211_HT_CAP_SGI_20
;
6125 band
->ht_cap
.cap
|= IEEE80211_HT_CAP_DSSSCCK40
;
6126 band
->ht_cap
.ampdu_factor
= IEEE80211_HT_MAX_AMPDU_64K
;
6127 band
->ht_cap
.ampdu_density
= IEEE80211_HT_MPDU_DENSITY_16
;
6128 memset(band
->ht_cap
.mcs
.rx_mask
, 0xff, nchain
);
6129 band
->ht_cap
.mcs
.tx_params
= IEEE80211_HT_MCS_TX_DEFINED
;
6132 static __le16
brcmf_get_mcs_map(u32 nchain
, enum ieee80211_vht_mcs_support supp
)
6137 for (i
= 0, mcs_map
= 0xFFFF; i
< nchain
; i
++)
6138 mcs_map
= (mcs_map
<< 2) | supp
;
6140 return cpu_to_le16(mcs_map
);
6143 static void brcmf_update_vht_cap(struct ieee80211_supported_band
*band
,
6144 u32 bw_cap
[2], u32 nchain
, u32 txstreams
,
6145 u32 txbf_bfe_cap
, u32 txbf_bfr_cap
)
6149 /* not allowed in 2.4G band */
6150 if (band
->band
== NL80211_BAND_2GHZ
)
6153 band
->vht_cap
.vht_supported
= true;
6154 /* 80MHz is mandatory */
6155 band
->vht_cap
.cap
|= IEEE80211_VHT_CAP_SHORT_GI_80
;
6156 if (bw_cap
[band
->band
] & WLC_BW_160MHZ_BIT
) {
6157 band
->vht_cap
.cap
|= IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ
;
6158 band
->vht_cap
.cap
|= IEEE80211_VHT_CAP_SHORT_GI_160
;
6160 /* all support 256-QAM */
6161 mcs_map
= brcmf_get_mcs_map(nchain
, IEEE80211_VHT_MCS_SUPPORT_0_9
);
6162 band
->vht_cap
.vht_mcs
.rx_mcs_map
= mcs_map
;
6163 band
->vht_cap
.vht_mcs
.tx_mcs_map
= mcs_map
;
6165 /* Beamforming support information */
6166 if (txbf_bfe_cap
& BRCMF_TXBF_SU_BFE_CAP
)
6167 band
->vht_cap
.cap
|= IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE
;
6168 if (txbf_bfe_cap
& BRCMF_TXBF_MU_BFE_CAP
)
6169 band
->vht_cap
.cap
|= IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE
;
6170 if (txbf_bfr_cap
& BRCMF_TXBF_SU_BFR_CAP
)
6171 band
->vht_cap
.cap
|= IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE
;
6172 if (txbf_bfr_cap
& BRCMF_TXBF_MU_BFR_CAP
)
6173 band
->vht_cap
.cap
|= IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE
;
6175 if ((txbf_bfe_cap
|| txbf_bfr_cap
) && (txstreams
> 1)) {
6176 band
->vht_cap
.cap
|=
6177 (2 << IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT
);
6178 band
->vht_cap
.cap
|= ((txstreams
- 1) <<
6179 IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_SHIFT
);
6180 band
->vht_cap
.cap
|=
6181 IEEE80211_VHT_CAP_VHT_LINK_ADAPTATION_VHT_MRQ_MFB
;
6185 static int brcmf_setup_wiphybands(struct wiphy
*wiphy
)
6187 struct brcmf_cfg80211_info
*cfg
= wiphy_priv(wiphy
);
6188 struct brcmf_if
*ifp
= netdev_priv(cfg_to_ndev(cfg
));
6191 u32 bw_cap
[2] = { WLC_BW_20MHZ_BIT
, WLC_BW_20MHZ_BIT
};
6196 struct ieee80211_supported_band
*band
;
6198 u32 txbf_bfe_cap
= 0;
6199 u32 txbf_bfr_cap
= 0;
6201 (void)brcmf_fil_iovar_int_get(ifp
, "vhtmode", &vhtmode
);
6202 err
= brcmf_fil_iovar_int_get(ifp
, "nmode", &nmode
);
6204 brcmf_err("nmode error (%d)\n", err
);
6206 brcmf_get_bwcap(ifp
, bw_cap
);
6208 brcmf_dbg(INFO
, "nmode=%d, vhtmode=%d, bw_cap=(%d, %d)\n",
6209 nmode
, vhtmode
, bw_cap
[NL80211_BAND_2GHZ
],
6210 bw_cap
[NL80211_BAND_5GHZ
]);
6212 err
= brcmf_fil_iovar_int_get(ifp
, "rxchain", &rxchain
);
6214 brcmf_err("rxchain error (%d)\n", err
);
6217 for (nchain
= 0; rxchain
; nchain
++)
6218 rxchain
= rxchain
& (rxchain
- 1);
6220 brcmf_dbg(INFO
, "nchain=%d\n", nchain
);
6222 err
= brcmf_construct_chaninfo(cfg
, bw_cap
);
6224 brcmf_err("brcmf_construct_chaninfo failed (%d)\n", err
);
6229 (void)brcmf_fil_iovar_int_get(ifp
, "txstreams", &txstreams
);
6230 (void)brcmf_fil_iovar_int_get(ifp
, "txbf_bfe_cap",
6232 (void)brcmf_fil_iovar_int_get(ifp
, "txbf_bfr_cap",
6236 wiphy
= cfg_to_wiphy(cfg
);
6237 for (i
= 0; i
< ARRAY_SIZE(wiphy
->bands
); i
++) {
6238 band
= wiphy
->bands
[i
];
6243 brcmf_update_ht_cap(band
, bw_cap
, nchain
);
6245 brcmf_update_vht_cap(band
, bw_cap
, nchain
, txstreams
,
6246 txbf_bfe_cap
, txbf_bfr_cap
);
6252 static const struct ieee80211_txrx_stypes
6253 brcmf_txrx_stypes
[NUM_NL80211_IFTYPES
] = {
6254 [NL80211_IFTYPE_STATION
] = {
6256 .rx
= BIT(IEEE80211_STYPE_ACTION
>> 4) |
6257 BIT(IEEE80211_STYPE_PROBE_REQ
>> 4)
6259 [NL80211_IFTYPE_P2P_CLIENT
] = {
6261 .rx
= BIT(IEEE80211_STYPE_ACTION
>> 4) |
6262 BIT(IEEE80211_STYPE_PROBE_REQ
>> 4)
6264 [NL80211_IFTYPE_P2P_GO
] = {
6266 .rx
= BIT(IEEE80211_STYPE_ASSOC_REQ
>> 4) |
6267 BIT(IEEE80211_STYPE_REASSOC_REQ
>> 4) |
6268 BIT(IEEE80211_STYPE_PROBE_REQ
>> 4) |
6269 BIT(IEEE80211_STYPE_DISASSOC
>> 4) |
6270 BIT(IEEE80211_STYPE_AUTH
>> 4) |
6271 BIT(IEEE80211_STYPE_DEAUTH
>> 4) |
6272 BIT(IEEE80211_STYPE_ACTION
>> 4)
6274 [NL80211_IFTYPE_P2P_DEVICE
] = {
6276 .rx
= BIT(IEEE80211_STYPE_ACTION
>> 4) |
6277 BIT(IEEE80211_STYPE_PROBE_REQ
>> 4)
6282 * brcmf_setup_ifmodes() - determine interface modes and combinations.
6284 * @wiphy: wiphy object.
6285 * @ifp: interface object needed for feat module api.
6287 * The interface modes and combinations are determined dynamically here
6288 * based on firmware functionality.
6290 * no p2p and no mbss:
6292 * #STA <= 1, #AP <= 1, channels = 1, 2 total
6296 * #STA <= 1, #AP <= 1, channels = 1, 2 total
6297 * #AP <= 4, matching BI, channels = 1, 4 total
6299 * p2p, no mchan, and mbss:
6301 * #STA <= 1, #P2P-DEV <= 1, #{P2P-CL, P2P-GO} <= 1, channels = 1, 3 total
6302 * #STA <= 1, #P2P-DEV <= 1, #AP <= 1, #P2P-CL <= 1, channels = 1, 4 total
6303 * #AP <= 4, matching BI, channels = 1, 4 total
6305 * p2p, mchan, and mbss:
6307 * #STA <= 1, #P2P-DEV <= 1, #{P2P-CL, P2P-GO} <= 1, channels = 2, 3 total
6308 * #STA <= 1, #P2P-DEV <= 1, #AP <= 1, #P2P-CL <= 1, channels = 1, 4 total
6309 * #AP <= 4, matching BI, channels = 1, 4 total
6311 static int brcmf_setup_ifmodes(struct wiphy
*wiphy
, struct brcmf_if
*ifp
)
6313 struct ieee80211_iface_combination
*combo
= NULL
;
6314 struct ieee80211_iface_limit
*c0_limits
= NULL
;
6315 struct ieee80211_iface_limit
*p2p_limits
= NULL
;
6316 struct ieee80211_iface_limit
*mbss_limits
= NULL
;
6320 mbss
= brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_MBSS
);
6321 p2p
= brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_P2P
);
6323 n_combos
= 1 + !!p2p
+ !!mbss
;
6324 combo
= kcalloc(n_combos
, sizeof(*combo
), GFP_KERNEL
);
6328 wiphy
->interface_modes
= BIT(NL80211_IFTYPE_STATION
) |
6329 BIT(NL80211_IFTYPE_ADHOC
) |
6330 BIT(NL80211_IFTYPE_AP
);
6334 c0_limits
= kcalloc(p2p
? 3 : 2, sizeof(*c0_limits
), GFP_KERNEL
);
6337 c0_limits
[i
].max
= 1;
6338 c0_limits
[i
++].types
= BIT(NL80211_IFTYPE_STATION
);
6340 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_MCHAN
))
6341 combo
[c
].num_different_channels
= 2;
6342 wiphy
->interface_modes
|= BIT(NL80211_IFTYPE_P2P_CLIENT
) |
6343 BIT(NL80211_IFTYPE_P2P_GO
) |
6344 BIT(NL80211_IFTYPE_P2P_DEVICE
);
6345 c0_limits
[i
].max
= 1;
6346 c0_limits
[i
++].types
= BIT(NL80211_IFTYPE_P2P_DEVICE
);
6347 c0_limits
[i
].max
= 1;
6348 c0_limits
[i
++].types
= BIT(NL80211_IFTYPE_P2P_CLIENT
) |
6349 BIT(NL80211_IFTYPE_P2P_GO
);
6351 c0_limits
[i
].max
= 1;
6352 c0_limits
[i
++].types
= BIT(NL80211_IFTYPE_AP
);
6354 combo
[c
].num_different_channels
= 1;
6355 combo
[c
].max_interfaces
= i
;
6356 combo
[c
].n_limits
= i
;
6357 combo
[c
].limits
= c0_limits
;
6362 p2p_limits
= kcalloc(4, sizeof(*p2p_limits
), GFP_KERNEL
);
6365 p2p_limits
[i
].max
= 1;
6366 p2p_limits
[i
++].types
= BIT(NL80211_IFTYPE_STATION
);
6367 p2p_limits
[i
].max
= 1;
6368 p2p_limits
[i
++].types
= BIT(NL80211_IFTYPE_AP
);
6369 p2p_limits
[i
].max
= 1;
6370 p2p_limits
[i
++].types
= BIT(NL80211_IFTYPE_P2P_CLIENT
);
6371 p2p_limits
[i
].max
= 1;
6372 p2p_limits
[i
++].types
= BIT(NL80211_IFTYPE_P2P_DEVICE
);
6373 combo
[c
].num_different_channels
= 1;
6374 combo
[c
].max_interfaces
= i
;
6375 combo
[c
].n_limits
= i
;
6376 combo
[c
].limits
= p2p_limits
;
6382 mbss_limits
= kcalloc(1, sizeof(*mbss_limits
), GFP_KERNEL
);
6385 mbss_limits
[i
].max
= 4;
6386 mbss_limits
[i
++].types
= BIT(NL80211_IFTYPE_AP
);
6387 combo
[c
].beacon_int_infra_match
= true;
6388 combo
[c
].num_different_channels
= 1;
6389 combo
[c
].max_interfaces
= 4;
6390 combo
[c
].n_limits
= i
;
6391 combo
[c
].limits
= mbss_limits
;
6394 wiphy
->n_iface_combinations
= n_combos
;
6395 wiphy
->iface_combinations
= combo
;
6406 static void brcmf_wiphy_pno_params(struct wiphy
*wiphy
)
6408 /* scheduled scan settings */
6409 wiphy
->max_sched_scan_ssids
= BRCMF_PNO_MAX_PFN_COUNT
;
6410 wiphy
->max_match_sets
= BRCMF_PNO_MAX_PFN_COUNT
;
6411 wiphy
->max_sched_scan_ie_len
= BRCMF_SCAN_IE_LEN_MAX
;
6412 wiphy
->flags
|= WIPHY_FLAG_SUPPORTS_SCHED_SCAN
;
6416 static struct wiphy_wowlan_support brcmf_wowlan_support
= {
6417 .flags
= WIPHY_WOWLAN_MAGIC_PKT
| WIPHY_WOWLAN_DISCONNECT
,
6418 .n_patterns
= BRCMF_WOWL_MAXPATTERNS
,
6419 .pattern_max_len
= BRCMF_WOWL_MAXPATTERNSIZE
,
6420 .pattern_min_len
= 1,
6421 .max_pkt_offset
= 1500,
6425 static void brcmf_wiphy_wowl_params(struct wiphy
*wiphy
, struct brcmf_if
*ifp
)
6428 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
6430 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_PNO
)) {
6431 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_WOWL_ND
)) {
6432 brcmf_wowlan_support
.flags
|= WIPHY_WOWLAN_NET_DETECT
;
6433 init_waitqueue_head(&cfg
->wowl
.nd_data_wait
);
6436 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_WOWL_GTK
)) {
6437 brcmf_wowlan_support
.flags
|= WIPHY_WOWLAN_SUPPORTS_GTK_REKEY
;
6438 brcmf_wowlan_support
.flags
|= WIPHY_WOWLAN_GTK_REKEY_FAILURE
;
6441 wiphy
->wowlan
= &brcmf_wowlan_support
;
6445 static int brcmf_setup_wiphy(struct wiphy
*wiphy
, struct brcmf_if
*ifp
)
6447 struct brcmf_pub
*drvr
= ifp
->drvr
;
6448 const struct ieee80211_iface_combination
*combo
;
6449 struct ieee80211_supported_band
*band
;
6450 u16 max_interfaces
= 0;
6455 wiphy
->max_scan_ssids
= WL_NUM_SCAN_MAX
;
6456 wiphy
->max_scan_ie_len
= BRCMF_SCAN_IE_LEN_MAX
;
6457 wiphy
->max_num_pmkids
= BRCMF_MAXPMKID
;
6459 err
= brcmf_setup_ifmodes(wiphy
, ifp
);
6463 for (i
= 0, combo
= wiphy
->iface_combinations
;
6464 i
< wiphy
->n_iface_combinations
; i
++, combo
++) {
6465 max_interfaces
= max(max_interfaces
, combo
->max_interfaces
);
6468 for (i
= 0; i
< max_interfaces
&& i
< ARRAY_SIZE(drvr
->addresses
);
6470 u8
*addr
= drvr
->addresses
[i
].addr
;
6472 memcpy(addr
, drvr
->mac
, ETH_ALEN
);
6475 addr
[ETH_ALEN
- 1] ^= i
;
6478 wiphy
->addresses
= drvr
->addresses
;
6479 wiphy
->n_addresses
= i
;
6481 wiphy
->signal_type
= CFG80211_SIGNAL_TYPE_MBM
;
6482 wiphy
->cipher_suites
= brcmf_cipher_suites
;
6483 wiphy
->n_cipher_suites
= ARRAY_SIZE(brcmf_cipher_suites
);
6484 if (!brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_MFP
))
6485 wiphy
->n_cipher_suites
--;
6486 wiphy
->bss_select_support
= BIT(NL80211_BSS_SELECT_ATTR_RSSI
) |
6487 BIT(NL80211_BSS_SELECT_ATTR_BAND_PREF
) |
6488 BIT(NL80211_BSS_SELECT_ATTR_RSSI_ADJUST
);
6490 wiphy
->flags
|= WIPHY_FLAG_PS_ON_BY_DEFAULT
|
6491 WIPHY_FLAG_OFFCHAN_TX
|
6492 WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL
;
6493 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_TDLS
))
6494 wiphy
->flags
|= WIPHY_FLAG_SUPPORTS_TDLS
;
6495 if (!ifp
->drvr
->settings
->roamoff
)
6496 wiphy
->flags
|= WIPHY_FLAG_SUPPORTS_FW_ROAM
;
6497 wiphy
->mgmt_stypes
= brcmf_txrx_stypes
;
6498 wiphy
->max_remain_on_channel_duration
= 5000;
6499 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_PNO
))
6500 brcmf_wiphy_pno_params(wiphy
);
6502 /* vendor commands/events support */
6503 wiphy
->vendor_commands
= brcmf_vendor_cmds
;
6504 wiphy
->n_vendor_commands
= BRCMF_VNDR_CMDS_LAST
- 1;
6506 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_WOWL
))
6507 brcmf_wiphy_wowl_params(wiphy
, ifp
);
6508 err
= brcmf_fil_cmd_data_get(ifp
, BRCMF_C_GET_BANDLIST
, &bandlist
,
6511 brcmf_err("could not obtain band info: err=%d\n", err
);
6514 /* first entry in bandlist is number of bands */
6515 n_bands
= le32_to_cpu(bandlist
[0]);
6516 for (i
= 1; i
<= n_bands
&& i
< ARRAY_SIZE(bandlist
); i
++) {
6517 if (bandlist
[i
] == cpu_to_le32(WLC_BAND_2G
)) {
6518 band
= kmemdup(&__wl_band_2ghz
, sizeof(__wl_band_2ghz
),
6523 band
->channels
= kmemdup(&__wl_2ghz_channels
,
6524 sizeof(__wl_2ghz_channels
),
6526 if (!band
->channels
) {
6531 band
->n_channels
= ARRAY_SIZE(__wl_2ghz_channels
);
6532 wiphy
->bands
[NL80211_BAND_2GHZ
] = band
;
6534 if (bandlist
[i
] == cpu_to_le32(WLC_BAND_5G
)) {
6535 band
= kmemdup(&__wl_band_5ghz
, sizeof(__wl_band_5ghz
),
6540 band
->channels
= kmemdup(&__wl_5ghz_channels
,
6541 sizeof(__wl_5ghz_channels
),
6543 if (!band
->channels
) {
6548 band
->n_channels
= ARRAY_SIZE(__wl_5ghz_channels
);
6549 wiphy
->bands
[NL80211_BAND_5GHZ
] = band
;
6552 err
= brcmf_setup_wiphybands(wiphy
);
6556 static s32
brcmf_config_dongle(struct brcmf_cfg80211_info
*cfg
)
6558 struct net_device
*ndev
;
6559 struct wireless_dev
*wdev
;
6560 struct brcmf_if
*ifp
;
6567 ndev
= cfg_to_ndev(cfg
);
6568 wdev
= ndev
->ieee80211_ptr
;
6569 ifp
= netdev_priv(ndev
);
6571 /* make sure RF is ready for work */
6572 brcmf_fil_cmd_int_set(ifp
, BRCMF_C_UP
, 0);
6574 brcmf_dongle_scantime(ifp
);
6576 power_mode
= cfg
->pwr_save
? PM_FAST
: PM_OFF
;
6577 err
= brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_PM
, power_mode
);
6579 goto default_conf_out
;
6580 brcmf_dbg(INFO
, "power save set to %s\n",
6581 (power_mode
? "enabled" : "disabled"));
6583 err
= brcmf_dongle_roam(ifp
);
6585 goto default_conf_out
;
6586 err
= brcmf_cfg80211_change_iface(wdev
->wiphy
, ndev
, wdev
->iftype
,
6589 goto default_conf_out
;
6591 brcmf_configure_arp_nd_offload(ifp
, true);
6593 cfg
->dongle_up
= true;
6600 static s32
__brcmf_cfg80211_up(struct brcmf_if
*ifp
)
6602 set_bit(BRCMF_VIF_STATUS_READY
, &ifp
->vif
->sme_state
);
6604 return brcmf_config_dongle(ifp
->drvr
->config
);
6607 static s32
__brcmf_cfg80211_down(struct brcmf_if
*ifp
)
6609 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
6612 * While going down, if associated with AP disassociate
6613 * from AP to save power
6615 if (check_vif_up(ifp
->vif
)) {
6616 brcmf_link_down(ifp
->vif
, WLAN_REASON_UNSPECIFIED
);
6618 /* Make sure WPA_Supplicant receives all the event
6619 generated due to DISASSOC call to the fw to keep
6620 the state fw and WPA_Supplicant state consistent
6625 brcmf_abort_scanning(cfg
);
6626 clear_bit(BRCMF_VIF_STATUS_READY
, &ifp
->vif
->sme_state
);
6631 s32
brcmf_cfg80211_up(struct net_device
*ndev
)
6633 struct brcmf_if
*ifp
= netdev_priv(ndev
);
6634 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
6637 mutex_lock(&cfg
->usr_sync
);
6638 err
= __brcmf_cfg80211_up(ifp
);
6639 mutex_unlock(&cfg
->usr_sync
);
6644 s32
brcmf_cfg80211_down(struct net_device
*ndev
)
6646 struct brcmf_if
*ifp
= netdev_priv(ndev
);
6647 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
6650 mutex_lock(&cfg
->usr_sync
);
6651 err
= __brcmf_cfg80211_down(ifp
);
6652 mutex_unlock(&cfg
->usr_sync
);
6657 enum nl80211_iftype
brcmf_cfg80211_get_iftype(struct brcmf_if
*ifp
)
6659 struct wireless_dev
*wdev
= &ifp
->vif
->wdev
;
6661 return wdev
->iftype
;
6664 bool brcmf_get_vif_state_any(struct brcmf_cfg80211_info
*cfg
,
6665 unsigned long state
)
6667 struct brcmf_cfg80211_vif
*vif
;
6669 list_for_each_entry(vif
, &cfg
->vif_list
, list
) {
6670 if (test_bit(state
, &vif
->sme_state
))
6676 static inline bool vif_event_equals(struct brcmf_cfg80211_vif_event
*event
,
6681 mutex_lock(&event
->vif_event_lock
);
6682 evt_action
= event
->action
;
6683 mutex_unlock(&event
->vif_event_lock
);
6684 return evt_action
== action
;
6687 void brcmf_cfg80211_arm_vif_event(struct brcmf_cfg80211_info
*cfg
,
6688 struct brcmf_cfg80211_vif
*vif
)
6690 struct brcmf_cfg80211_vif_event
*event
= &cfg
->vif_event
;
6692 mutex_lock(&event
->vif_event_lock
);
6695 mutex_unlock(&event
->vif_event_lock
);
6698 bool brcmf_cfg80211_vif_event_armed(struct brcmf_cfg80211_info
*cfg
)
6700 struct brcmf_cfg80211_vif_event
*event
= &cfg
->vif_event
;
6703 mutex_lock(&event
->vif_event_lock
);
6704 armed
= event
->vif
!= NULL
;
6705 mutex_unlock(&event
->vif_event_lock
);
6710 int brcmf_cfg80211_wait_vif_event(struct brcmf_cfg80211_info
*cfg
,
6711 u8 action
, ulong timeout
)
6713 struct brcmf_cfg80211_vif_event
*event
= &cfg
->vif_event
;
6715 return wait_event_timeout(event
->vif_wq
,
6716 vif_event_equals(event
, action
), timeout
);
6719 static s32
brcmf_translate_country_code(struct brcmf_pub
*drvr
, char alpha2
[2],
6720 struct brcmf_fil_country_le
*ccreq
)
6722 struct brcmfmac_pd_cc
*country_codes
;
6723 struct brcmfmac_pd_cc_entry
*cc
;
6727 country_codes
= drvr
->settings
->country_codes
;
6728 if (!country_codes
) {
6729 brcmf_dbg(TRACE
, "No country codes configured for device\n");
6733 if ((alpha2
[0] == ccreq
->country_abbrev
[0]) &&
6734 (alpha2
[1] == ccreq
->country_abbrev
[1])) {
6735 brcmf_dbg(TRACE
, "Country code already set\n");
6740 for (i
= 0; i
< country_codes
->table_size
; i
++) {
6741 cc
= &country_codes
->table
[i
];
6742 if ((cc
->iso3166
[0] == '\0') && (found_index
== -1))
6744 if ((cc
->iso3166
[0] == alpha2
[0]) &&
6745 (cc
->iso3166
[1] == alpha2
[1])) {
6750 if (found_index
== -1) {
6751 brcmf_dbg(TRACE
, "No country code match found\n");
6754 memset(ccreq
, 0, sizeof(*ccreq
));
6755 ccreq
->rev
= cpu_to_le32(country_codes
->table
[found_index
].rev
);
6756 memcpy(ccreq
->ccode
, country_codes
->table
[found_index
].cc
,
6757 BRCMF_COUNTRY_BUF_SZ
);
6758 ccreq
->country_abbrev
[0] = alpha2
[0];
6759 ccreq
->country_abbrev
[1] = alpha2
[1];
6760 ccreq
->country_abbrev
[2] = 0;
6765 static void brcmf_cfg80211_reg_notifier(struct wiphy
*wiphy
,
6766 struct regulatory_request
*req
)
6768 struct brcmf_cfg80211_info
*cfg
= wiphy_priv(wiphy
);
6769 struct brcmf_if
*ifp
= netdev_priv(cfg_to_ndev(cfg
));
6770 struct brcmf_fil_country_le ccreq
;
6774 /* ignore non-ISO3166 country codes */
6775 for (i
= 0; i
< sizeof(req
->alpha2
); i
++)
6776 if (req
->alpha2
[i
] < 'A' || req
->alpha2
[i
] > 'Z') {
6777 brcmf_err("not a ISO3166 code (0x%02x 0x%02x)\n",
6778 req
->alpha2
[0], req
->alpha2
[1]);
6782 brcmf_dbg(TRACE
, "Enter: initiator=%d, alpha=%c%c\n", req
->initiator
,
6783 req
->alpha2
[0], req
->alpha2
[1]);
6785 err
= brcmf_fil_iovar_data_get(ifp
, "country", &ccreq
, sizeof(ccreq
));
6787 brcmf_err("Country code iovar returned err = %d\n", err
);
6791 err
= brcmf_translate_country_code(ifp
->drvr
, req
->alpha2
, &ccreq
);
6795 err
= brcmf_fil_iovar_data_set(ifp
, "country", &ccreq
, sizeof(ccreq
));
6797 brcmf_err("Firmware rejected country setting\n");
6800 brcmf_setup_wiphybands(wiphy
);
6803 static void brcmf_free_wiphy(struct wiphy
*wiphy
)
6810 if (wiphy
->iface_combinations
) {
6811 for (i
= 0; i
< wiphy
->n_iface_combinations
; i
++)
6812 kfree(wiphy
->iface_combinations
[i
].limits
);
6814 kfree(wiphy
->iface_combinations
);
6815 if (wiphy
->bands
[NL80211_BAND_2GHZ
]) {
6816 kfree(wiphy
->bands
[NL80211_BAND_2GHZ
]->channels
);
6817 kfree(wiphy
->bands
[NL80211_BAND_2GHZ
]);
6819 if (wiphy
->bands
[NL80211_BAND_5GHZ
]) {
6820 kfree(wiphy
->bands
[NL80211_BAND_5GHZ
]->channels
);
6821 kfree(wiphy
->bands
[NL80211_BAND_5GHZ
]);
6826 struct brcmf_cfg80211_info
*brcmf_cfg80211_attach(struct brcmf_pub
*drvr
,
6827 struct device
*busdev
,
6830 struct net_device
*ndev
= brcmf_get_ifp(drvr
, 0)->ndev
;
6831 struct brcmf_cfg80211_info
*cfg
;
6832 struct wiphy
*wiphy
;
6833 struct cfg80211_ops
*ops
;
6834 struct brcmf_cfg80211_vif
*vif
;
6835 struct brcmf_if
*ifp
;
6841 brcmf_err("ndev is invalid\n");
6845 ops
= kmemdup(&brcmf_cfg80211_ops
, sizeof(*ops
), GFP_KERNEL
);
6849 ifp
= netdev_priv(ndev
);
6851 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_WOWL_GTK
))
6852 ops
->set_rekey_data
= brcmf_cfg80211_set_rekey_data
;
6854 wiphy
= wiphy_new(ops
, sizeof(struct brcmf_cfg80211_info
));
6856 brcmf_err("Could not allocate wiphy device\n");
6859 memcpy(wiphy
->perm_addr
, drvr
->mac
, ETH_ALEN
);
6860 set_wiphy_dev(wiphy
, busdev
);
6862 cfg
= wiphy_priv(wiphy
);
6866 init_vif_event(&cfg
->vif_event
);
6867 INIT_LIST_HEAD(&cfg
->vif_list
);
6869 vif
= brcmf_alloc_vif(cfg
, NL80211_IFTYPE_STATION
);
6874 vif
->wdev
.netdev
= ndev
;
6875 ndev
->ieee80211_ptr
= &vif
->wdev
;
6876 SET_NETDEV_DEV(ndev
, wiphy_dev(cfg
->wiphy
));
6878 err
= wl_init_priv(cfg
);
6880 brcmf_err("Failed to init iwm_priv (%d)\n", err
);
6881 brcmf_free_vif(vif
);
6886 /* determine d11 io type before wiphy setup */
6887 err
= brcmf_fil_cmd_int_get(ifp
, BRCMF_C_GET_VERSION
, &io_type
);
6889 brcmf_err("Failed to get D11 version (%d)\n", err
);
6892 cfg
->d11inf
.io_type
= (u8
)io_type
;
6893 brcmu_d11_attach(&cfg
->d11inf
);
6895 err
= brcmf_setup_wiphy(wiphy
, ifp
);
6899 brcmf_dbg(INFO
, "Registering custom regulatory\n");
6900 wiphy
->reg_notifier
= brcmf_cfg80211_reg_notifier
;
6901 wiphy
->regulatory_flags
|= REGULATORY_CUSTOM_REG
;
6902 wiphy_apply_custom_regulatory(wiphy
, &brcmf_regdom
);
6904 /* firmware defaults to 40MHz disabled in 2G band. We signal
6905 * cfg80211 here that we do and have it decide we can enable
6906 * it. But first check if device does support 2G operation.
6908 if (wiphy
->bands
[NL80211_BAND_2GHZ
]) {
6909 cap
= &wiphy
->bands
[NL80211_BAND_2GHZ
]->ht_cap
.cap
;
6910 *cap
|= IEEE80211_HT_CAP_SUP_WIDTH_20_40
;
6912 err
= wiphy_register(wiphy
);
6914 brcmf_err("Could not register wiphy device (%d)\n", err
);
6918 /* If cfg80211 didn't disable 40MHz HT CAP in wiphy_register(),
6919 * setup 40MHz in 2GHz band and enable OBSS scanning.
6921 if (cap
&& (*cap
& IEEE80211_HT_CAP_SUP_WIDTH_20_40
)) {
6922 err
= brcmf_enable_bw40_2g(cfg
);
6924 err
= brcmf_fil_iovar_int_set(ifp
, "obss_coex",
6925 BRCMF_OBSS_COEX_AUTO
);
6927 *cap
&= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40
;
6929 /* p2p might require that "if-events" get processed by fweh. So
6930 * activate the already registered event handlers now and activate
6931 * the rest when initialization has completed. drvr->config needs to
6932 * be assigned before activating events.
6935 err
= brcmf_fweh_activate_events(ifp
);
6937 brcmf_err("FWEH activation failed (%d)\n", err
);
6938 goto wiphy_unreg_out
;
6941 err
= brcmf_p2p_attach(cfg
, p2pdev_forced
);
6943 brcmf_err("P2P initilisation failed (%d)\n", err
);
6944 goto wiphy_unreg_out
;
6946 err
= brcmf_btcoex_attach(cfg
);
6948 brcmf_err("BT-coex initialisation failed (%d)\n", err
);
6949 brcmf_p2p_detach(&cfg
->p2p
);
6950 goto wiphy_unreg_out
;
6953 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_TDLS
)) {
6954 err
= brcmf_fil_iovar_int_set(ifp
, "tdls_enable", 1);
6956 brcmf_dbg(INFO
, "TDLS not enabled (%d)\n", err
);
6957 wiphy
->flags
&= ~WIPHY_FLAG_SUPPORTS_TDLS
;
6959 brcmf_fweh_register(cfg
->pub
, BRCMF_E_TDLS_PEER_EVENT
,
6960 brcmf_notify_tdls_peer_event
);
6964 /* (re-) activate FWEH event handling */
6965 err
= brcmf_fweh_activate_events(ifp
);
6967 brcmf_err("FWEH activation failed (%d)\n", err
);
6968 goto wiphy_unreg_out
;
6971 /* Fill in some of the advertised nl80211 supported features */
6972 if (brcmf_feat_is_enabled(ifp
, BRCMF_FEAT_SCAN_RANDOM_MAC
)) {
6973 wiphy
->features
|= NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR
;
6975 if (wiphy
->wowlan
&&
6976 wiphy
->wowlan
->flags
& WIPHY_WOWLAN_NET_DETECT
)
6977 wiphy
->features
|= NL80211_FEATURE_ND_RANDOM_MAC_ADDR
;
6984 wiphy_unregister(cfg
->wiphy
);
6986 wl_deinit_priv(cfg
);
6987 brcmf_free_vif(vif
);
6990 brcmf_free_wiphy(wiphy
);
6995 void brcmf_cfg80211_detach(struct brcmf_cfg80211_info
*cfg
)
7000 brcmf_btcoex_detach(cfg
);
7001 wiphy_unregister(cfg
->wiphy
);
7003 wl_deinit_priv(cfg
);
7004 brcmf_free_wiphy(cfg
->wiphy
);