2 * Copyright (c) 2012 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.
16 #include <linux/slab.h>
17 #include <linux/netdevice.h>
18 #include <linux/etherdevice.h>
19 #include <net/cfg80211.h>
21 #include <brcmu_wifi.h>
22 #include <brcmu_utils.h>
27 #include "fwil_types.h"
29 #include "wl_cfg80211.h"
31 /* parameters used for p2p escan */
32 #define P2PAPI_SCAN_NPROBES 1
33 #define P2PAPI_SCAN_DWELL_TIME_MS 80
34 #define P2PAPI_SCAN_SOCIAL_DWELL_TIME_MS 40
35 #define P2PAPI_SCAN_HOME_TIME_MS 60
36 #define P2PAPI_SCAN_NPROBS_TIME_MS 30
37 #define P2PAPI_SCAN_AF_SEARCH_DWELL_TIME_MS 100
38 #define WL_SCAN_CONNECT_DWELL_TIME_MS 200
39 #define WL_SCAN_JOIN_PROBE_INTERVAL_MS 20
41 #define BRCMF_P2P_WILDCARD_SSID "DIRECT-"
42 #define BRCMF_P2P_WILDCARD_SSID_LEN (sizeof(BRCMF_P2P_WILDCARD_SSID) - 1)
44 #define SOCIAL_CHAN_1 1
45 #define SOCIAL_CHAN_2 6
46 #define SOCIAL_CHAN_3 11
47 #define IS_P2P_SOCIAL_CHANNEL(channel) ((channel == SOCIAL_CHAN_1) || \
48 (channel == SOCIAL_CHAN_2) || \
49 (channel == SOCIAL_CHAN_3))
50 #define SOCIAL_CHAN_CNT 3
51 #define AF_PEER_SEARCH_CNT 2
53 #define BRCMF_SCB_TIMEOUT_VALUE 20
55 #define P2P_VER 9 /* P2P version: 9=WiFi P2P v1.0 */
56 #define P2P_PUB_AF_CATEGORY 0x04
57 #define P2P_PUB_AF_ACTION 0x09
58 #define P2P_AF_CATEGORY 0x7f
59 #define P2P_OUI "\x50\x6F\x9A" /* P2P OUI */
60 #define P2P_OUI_LEN 3 /* P2P OUI length */
62 /* Action Frame Constants */
63 #define DOT11_ACTION_HDR_LEN 2 /* action frame category + action */
64 #define DOT11_ACTION_CAT_OFF 0 /* category offset */
65 #define DOT11_ACTION_ACT_OFF 1 /* action offset */
67 #define P2P_AF_DWELL_TIME 200
68 #define P2P_AF_MIN_DWELL_TIME 100
69 #define P2P_AF_MED_DWELL_TIME 400
70 #define P2P_AF_LONG_DWELL_TIME 1000
71 #define P2P_AF_TX_MAX_RETRY 1
72 #define P2P_AF_MAX_WAIT_TIME 2000
73 #define P2P_INVALID_CHANNEL -1
74 #define P2P_CHANNEL_SYNC_RETRY 5
75 #define P2P_AF_FRM_SCAN_MAX_WAIT 1500
76 #define P2P_DEFAULT_SLEEP_TIME_VSDB 200
78 /* WiFi P2P Public Action Frame OUI Subtypes */
79 #define P2P_PAF_GON_REQ 0 /* Group Owner Negotiation Req */
80 #define P2P_PAF_GON_RSP 1 /* Group Owner Negotiation Rsp */
81 #define P2P_PAF_GON_CONF 2 /* Group Owner Negotiation Confirm */
82 #define P2P_PAF_INVITE_REQ 3 /* P2P Invitation Request */
83 #define P2P_PAF_INVITE_RSP 4 /* P2P Invitation Response */
84 #define P2P_PAF_DEVDIS_REQ 5 /* Device Discoverability Request */
85 #define P2P_PAF_DEVDIS_RSP 6 /* Device Discoverability Response */
86 #define P2P_PAF_PROVDIS_REQ 7 /* Provision Discovery Request */
87 #define P2P_PAF_PROVDIS_RSP 8 /* Provision Discovery Response */
88 #define P2P_PAF_SUBTYPE_INVALID 255 /* Invalid Subtype */
90 /* WiFi P2P Action Frame OUI Subtypes */
91 #define P2P_AF_NOTICE_OF_ABSENCE 0 /* Notice of Absence */
92 #define P2P_AF_PRESENCE_REQ 1 /* P2P Presence Request */
93 #define P2P_AF_PRESENCE_RSP 2 /* P2P Presence Response */
94 #define P2P_AF_GO_DISC_REQ 3 /* GO Discoverability Request */
96 /* P2P Service Discovery related */
97 #define P2PSD_ACTION_CATEGORY 0x04 /* Public action frame */
98 #define P2PSD_ACTION_ID_GAS_IREQ 0x0a /* GAS Initial Request AF */
99 #define P2PSD_ACTION_ID_GAS_IRESP 0x0b /* GAS Initial Response AF */
100 #define P2PSD_ACTION_ID_GAS_CREQ 0x0c /* GAS Comback Request AF */
101 #define P2PSD_ACTION_ID_GAS_CRESP 0x0d /* GAS Comback Response AF */
104 * struct brcmf_p2p_disc_st_le - set discovery state in firmware.
106 * @state: requested discovery state (see enum brcmf_p2p_disc_state).
107 * @chspec: channel parameter for %WL_P2P_DISC_ST_LISTEN state.
108 * @dwell: dwell time in ms for %WL_P2P_DISC_ST_LISTEN state.
110 struct brcmf_p2p_disc_st_le
{
117 * enum brcmf_p2p_disc_state - P2P discovery state values
119 * @WL_P2P_DISC_ST_SCAN: P2P discovery with wildcard SSID and P2P IE.
120 * @WL_P2P_DISC_ST_LISTEN: P2P discovery off-channel for specified time.
121 * @WL_P2P_DISC_ST_SEARCH: P2P discovery with P2P wildcard SSID and P2P IE.
123 enum brcmf_p2p_disc_state
{
125 WL_P2P_DISC_ST_LISTEN
,
126 WL_P2P_DISC_ST_SEARCH
130 * struct brcmf_p2p_scan_le - P2P specific scan request.
132 * @type: type of scan method requested (values: 'E' or 'S').
133 * @reserved: reserved (ignored).
134 * @eparams: parameters used for type 'E'.
135 * @sparams: parameters used for type 'S'.
137 struct brcmf_p2p_scan_le
{
141 struct brcmf_escan_params_le eparams
;
142 struct brcmf_scan_params_le sparams
;
147 * struct brcmf_p2p_pub_act_frame - WiFi P2P Public Action Frame
149 * @category: P2P_PUB_AF_CATEGORY
150 * @action: P2P_PUB_AF_ACTION
152 * @oui_type: OUI type - P2P_VER
153 * @subtype: OUI subtype - P2P_TYPE_*
154 * @dialog_token: nonzero, identifies req/rsp transaction
155 * @elts[1]: Variable length information elements.
157 struct brcmf_p2p_pub_act_frame
{
168 * struct brcmf_p2p_action_frame - WiFi P2P Action Frame
170 * @category: P2P_AF_CATEGORY
171 * @OUI[3]: OUI - P2P_OUI
172 * @type: OUI Type - P2P_VER
173 * @subtype: OUI Subtype - P2P_AF_*
174 * @dialog_token: nonzero, identifies req/resp tranaction
175 * @elts[1]: Variable length information elements.
177 struct brcmf_p2p_action_frame
{
187 * struct brcmf_p2psd_gas_pub_act_frame - Wi-Fi GAS Public Action Frame
189 * @category: 0x04 Public Action Frame
190 * @action: 0x6c Advertisement Protocol
191 * @dialog_token: nonzero, identifies req/rsp transaction
192 * @query_data[1]: Query Data. SD gas ireq SD gas iresp
194 struct brcmf_p2psd_gas_pub_act_frame
{
202 * struct brcmf_config_af_params - Action Frame Parameters for tx.
204 * @mpc_onoff: To make sure to send successfully action frame, we have to
205 * turn off mpc 0: off, 1: on, (-1): do nothing
206 * @search_channel: 1: search peer's channel to send af
207 * extra_listen: keep the dwell time to get af response frame.
209 struct brcmf_config_af_params
{
216 * brcmf_p2p_is_pub_action() - true if p2p public type frame.
218 * @frame: action frame data.
219 * @frame_len: length of action frame data.
221 * Determine if action frame is p2p public action type
223 static bool brcmf_p2p_is_pub_action(void *frame
, u32 frame_len
)
225 struct brcmf_p2p_pub_act_frame
*pact_frm
;
230 pact_frm
= (struct brcmf_p2p_pub_act_frame
*)frame
;
231 if (frame_len
< sizeof(struct brcmf_p2p_pub_act_frame
) - 1)
234 if (pact_frm
->category
== P2P_PUB_AF_CATEGORY
&&
235 pact_frm
->action
== P2P_PUB_AF_ACTION
&&
236 pact_frm
->oui_type
== P2P_VER
&&
237 memcmp(pact_frm
->oui
, P2P_OUI
, P2P_OUI_LEN
) == 0)
244 * brcmf_p2p_is_p2p_action() - true if p2p action type frame.
246 * @frame: action frame data.
247 * @frame_len: length of action frame data.
249 * Determine if action frame is p2p action type
251 static bool brcmf_p2p_is_p2p_action(void *frame
, u32 frame_len
)
253 struct brcmf_p2p_action_frame
*act_frm
;
258 act_frm
= (struct brcmf_p2p_action_frame
*)frame
;
259 if (frame_len
< sizeof(struct brcmf_p2p_action_frame
) - 1)
262 if (act_frm
->category
== P2P_AF_CATEGORY
&&
263 act_frm
->type
== P2P_VER
&&
264 memcmp(act_frm
->oui
, P2P_OUI
, P2P_OUI_LEN
) == 0)
271 * brcmf_p2p_is_gas_action() - true if p2p gas action type frame.
273 * @frame: action frame data.
274 * @frame_len: length of action frame data.
276 * Determine if action frame is p2p gas action type
278 static bool brcmf_p2p_is_gas_action(void *frame
, u32 frame_len
)
280 struct brcmf_p2psd_gas_pub_act_frame
*sd_act_frm
;
285 sd_act_frm
= (struct brcmf_p2psd_gas_pub_act_frame
*)frame
;
286 if (frame_len
< sizeof(struct brcmf_p2psd_gas_pub_act_frame
) - 1)
289 if (sd_act_frm
->category
!= P2PSD_ACTION_CATEGORY
)
292 if (sd_act_frm
->action
== P2PSD_ACTION_ID_GAS_IREQ
||
293 sd_act_frm
->action
== P2PSD_ACTION_ID_GAS_IRESP
||
294 sd_act_frm
->action
== P2PSD_ACTION_ID_GAS_CREQ
||
295 sd_act_frm
->action
== P2PSD_ACTION_ID_GAS_CRESP
)
302 * brcmf_p2p_print_actframe() - debug print routine.
304 * @tx: Received or to be transmitted
305 * @frame: action frame data.
306 * @frame_len: length of action frame data.
308 * Print information about the p2p action frame
313 static void brcmf_p2p_print_actframe(bool tx
, void *frame
, u32 frame_len
)
315 struct brcmf_p2p_pub_act_frame
*pact_frm
;
316 struct brcmf_p2p_action_frame
*act_frm
;
317 struct brcmf_p2psd_gas_pub_act_frame
*sd_act_frm
;
319 if (!frame
|| frame_len
<= 2)
322 if (brcmf_p2p_is_pub_action(frame
, frame_len
)) {
323 pact_frm
= (struct brcmf_p2p_pub_act_frame
*)frame
;
324 switch (pact_frm
->subtype
) {
325 case P2P_PAF_GON_REQ
:
326 brcmf_dbg(TRACE
, "%s P2P Group Owner Negotiation Req Frame\n",
329 case P2P_PAF_GON_RSP
:
330 brcmf_dbg(TRACE
, "%s P2P Group Owner Negotiation Rsp Frame\n",
333 case P2P_PAF_GON_CONF
:
334 brcmf_dbg(TRACE
, "%s P2P Group Owner Negotiation Confirm Frame\n",
337 case P2P_PAF_INVITE_REQ
:
338 brcmf_dbg(TRACE
, "%s P2P Invitation Request Frame\n",
341 case P2P_PAF_INVITE_RSP
:
342 brcmf_dbg(TRACE
, "%s P2P Invitation Response Frame\n",
345 case P2P_PAF_DEVDIS_REQ
:
346 brcmf_dbg(TRACE
, "%s P2P Device Discoverability Request Frame\n",
349 case P2P_PAF_DEVDIS_RSP
:
350 brcmf_dbg(TRACE
, "%s P2P Device Discoverability Response Frame\n",
353 case P2P_PAF_PROVDIS_REQ
:
354 brcmf_dbg(TRACE
, "%s P2P Provision Discovery Request Frame\n",
357 case P2P_PAF_PROVDIS_RSP
:
358 brcmf_dbg(TRACE
, "%s P2P Provision Discovery Response Frame\n",
362 brcmf_dbg(TRACE
, "%s Unknown P2P Public Action Frame\n",
366 } else if (brcmf_p2p_is_p2p_action(frame
, frame_len
)) {
367 act_frm
= (struct brcmf_p2p_action_frame
*)frame
;
368 switch (act_frm
->subtype
) {
369 case P2P_AF_NOTICE_OF_ABSENCE
:
370 brcmf_dbg(TRACE
, "%s P2P Notice of Absence Frame\n",
373 case P2P_AF_PRESENCE_REQ
:
374 brcmf_dbg(TRACE
, "%s P2P Presence Request Frame\n",
377 case P2P_AF_PRESENCE_RSP
:
378 brcmf_dbg(TRACE
, "%s P2P Presence Response Frame\n",
381 case P2P_AF_GO_DISC_REQ
:
382 brcmf_dbg(TRACE
, "%s P2P Discoverability Request Frame\n",
386 brcmf_dbg(TRACE
, "%s Unknown P2P Action Frame\n",
390 } else if (brcmf_p2p_is_gas_action(frame
, frame_len
)) {
391 sd_act_frm
= (struct brcmf_p2psd_gas_pub_act_frame
*)frame
;
392 switch (sd_act_frm
->action
) {
393 case P2PSD_ACTION_ID_GAS_IREQ
:
394 brcmf_dbg(TRACE
, "%s P2P GAS Initial Request\n",
397 case P2PSD_ACTION_ID_GAS_IRESP
:
398 brcmf_dbg(TRACE
, "%s P2P GAS Initial Response\n",
401 case P2PSD_ACTION_ID_GAS_CREQ
:
402 brcmf_dbg(TRACE
, "%s P2P GAS Comback Request\n",
405 case P2PSD_ACTION_ID_GAS_CRESP
:
406 brcmf_dbg(TRACE
, "%s P2P GAS Comback Response\n",
410 brcmf_dbg(TRACE
, "%s Unknown P2P GAS Frame\n",
419 static void brcmf_p2p_print_actframe(bool tx
, void *frame
, u32 frame_len
)
427 * brcmf_p2p_chnr_to_chspec() - convert channel number to chanspec.
429 * @channel: channel number
431 static u16
brcmf_p2p_chnr_to_chspec(u16 channel
)
435 chanspec
= channel
& WL_CHANSPEC_CHAN_MASK
;
437 if (channel
<= CH_MAX_2G_CHANNEL
)
438 chanspec
|= WL_CHANSPEC_BAND_2G
;
440 chanspec
|= WL_CHANSPEC_BAND_5G
;
442 chanspec
|= WL_CHANSPEC_BW_20
;
443 chanspec
|= WL_CHANSPEC_CTL_SB_NONE
;
450 * brcmf_p2p_set_firmware() - prepare firmware for peer-to-peer operation.
452 * @ifp: ifp to use for iovars (primary).
453 * @p2p_mac: mac address to configure for p2p_da_override
455 static int brcmf_p2p_set_firmware(struct brcmf_if
*ifp
, u8
*p2p_mac
)
459 brcmf_fil_cmd_int_set(ifp
, BRCMF_C_DOWN
, 1);
460 brcmf_fil_iovar_int_set(ifp
, "apsta", 1);
461 brcmf_fil_cmd_int_set(ifp
, BRCMF_C_UP
, 1);
463 /* In case of COB type, firmware has default mac address
464 * After Initializing firmware, we have to set current mac address to
465 * firmware for P2P device address
467 ret
= brcmf_fil_iovar_data_set(ifp
, "p2p_da_override", p2p_mac
,
470 brcmf_err("failed to update device address ret %d\n", ret
);
476 * brcmf_p2p_generate_bss_mac() - derive mac addresses for P2P.
478 * @p2p: P2P specific data.
479 * @dev_addr: optional device address.
481 * P2P needs mac addresses for P2P device and interface. If no device
482 * address it specified, these are derived from the primary net device, ie.
483 * the permanent ethernet address of the device.
485 static void brcmf_p2p_generate_bss_mac(struct brcmf_p2p_info
*p2p
, u8
*dev_addr
)
487 struct brcmf_if
*pri_ifp
= p2p
->bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
->ifp
;
488 bool local_admin
= false;
490 if (!dev_addr
|| is_zero_ether_addr(dev_addr
)) {
491 dev_addr
= pri_ifp
->mac_addr
;
495 /* Generate the P2P Device Address. This consists of the device's
496 * primary MAC address with the locally administered bit set.
498 memcpy(p2p
->dev_addr
, dev_addr
, ETH_ALEN
);
500 p2p
->dev_addr
[0] |= 0x02;
502 /* Generate the P2P Interface Address. If the discovery and connection
503 * BSSCFGs need to simultaneously co-exist, then this address must be
504 * different from the P2P Device Address, but also locally administered.
506 memcpy(p2p
->int_addr
, p2p
->dev_addr
, ETH_ALEN
);
507 p2p
->int_addr
[0] |= 0x02;
508 p2p
->int_addr
[4] ^= 0x80;
512 * brcmf_p2p_scan_is_p2p_request() - is cfg80211 scan request a P2P scan.
514 * @request: the scan request as received from cfg80211.
516 * returns true if one of the ssids in the request matches the
517 * P2P wildcard ssid; otherwise returns false.
519 static bool brcmf_p2p_scan_is_p2p_request(struct cfg80211_scan_request
*request
)
521 struct cfg80211_ssid
*ssids
= request
->ssids
;
524 for (i
= 0; i
< request
->n_ssids
; i
++) {
525 if (ssids
[i
].ssid_len
!= BRCMF_P2P_WILDCARD_SSID_LEN
)
528 brcmf_dbg(INFO
, "comparing ssid \"%s\"", ssids
[i
].ssid
);
529 if (!memcmp(BRCMF_P2P_WILDCARD_SSID
, ssids
[i
].ssid
,
530 BRCMF_P2P_WILDCARD_SSID_LEN
))
537 * brcmf_p2p_set_discover_state - set discover state in firmware.
539 * @ifp: low-level interface object.
540 * @state: discover state to set.
541 * @chanspec: channel parameters (for state @WL_P2P_DISC_ST_LISTEN only).
542 * @listen_ms: duration to listen (for state @WL_P2P_DISC_ST_LISTEN only).
544 static s32
brcmf_p2p_set_discover_state(struct brcmf_if
*ifp
, u8 state
,
545 u16 chanspec
, u16 listen_ms
)
547 struct brcmf_p2p_disc_st_le discover_state
;
549 brcmf_dbg(TRACE
, "enter\n");
551 discover_state
.state
= state
;
552 discover_state
.chspec
= cpu_to_le16(chanspec
);
553 discover_state
.dwell
= cpu_to_le16(listen_ms
);
554 ret
= brcmf_fil_bsscfg_data_set(ifp
, "p2p_state", &discover_state
,
555 sizeof(discover_state
));
560 * brcmf_p2p_deinit_discovery() - disable P2P device discovery.
562 * @p2p: P2P specific data.
564 * Resets the discovery state and disables it in firmware.
566 static s32
brcmf_p2p_deinit_discovery(struct brcmf_p2p_info
*p2p
)
568 struct brcmf_cfg80211_vif
*vif
;
570 brcmf_dbg(TRACE
, "enter\n");
572 /* Set the discovery state to SCAN */
573 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
;
574 (void)brcmf_p2p_set_discover_state(vif
->ifp
, WL_P2P_DISC_ST_SCAN
, 0, 0);
576 /* Disable P2P discovery in the firmware */
577 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
;
578 (void)brcmf_fil_iovar_int_set(vif
->ifp
, "p2p_disc", 0);
584 * brcmf_p2p_enable_discovery() - initialize and configure discovery.
586 * @p2p: P2P specific data.
588 * Initializes the discovery device and configure the virtual interface.
590 static int brcmf_p2p_enable_discovery(struct brcmf_p2p_info
*p2p
)
592 struct brcmf_cfg80211_vif
*vif
;
595 brcmf_dbg(TRACE
, "enter\n");
596 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
;
598 brcmf_err("P2P config device not available\n");
603 if (test_bit(BRCMF_P2P_STATUS_ENABLED
, &p2p
->status
)) {
604 brcmf_dbg(INFO
, "P2P config device already configured\n");
608 /* Re-initialize P2P Discovery in the firmware */
609 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
;
610 ret
= brcmf_fil_iovar_int_set(vif
->ifp
, "p2p_disc", 1);
612 brcmf_err("set p2p_disc error\n");
615 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
;
616 ret
= brcmf_p2p_set_discover_state(vif
->ifp
, WL_P2P_DISC_ST_SCAN
, 0, 0);
618 brcmf_err("unable to set WL_P2P_DISC_ST_SCAN\n");
623 * Set wsec to any non-zero value in the discovery bsscfg
624 * to ensure our P2P probe responses have the privacy bit
625 * set in the 802.11 WPA IE. Some peer devices may not
626 * initiate WPS with us if this bit is not set.
628 ret
= brcmf_fil_bsscfg_int_set(vif
->ifp
, "wsec", AES_ENABLED
);
630 brcmf_err("wsec error %d\n", ret
);
634 set_bit(BRCMF_P2P_STATUS_ENABLED
, &p2p
->status
);
640 * brcmf_p2p_escan() - initiate a P2P scan.
642 * @p2p: P2P specific data.
643 * @num_chans: number of channels to scan.
644 * @chanspecs: channel parameters for @num_chans channels.
645 * @search_state: P2P discover state to use.
646 * @action: scan action to pass to firmware.
647 * @bss_type: type of P2P bss.
649 static s32
brcmf_p2p_escan(struct brcmf_p2p_info
*p2p
, u32 num_chans
,
650 u16 chanspecs
[], s32 search_state
, u16 action
,
651 enum p2p_bss_type bss_type
)
654 s32 memsize
= offsetof(struct brcmf_p2p_scan_le
,
655 eparams
.params_le
.channel_list
);
660 struct brcmf_cfg80211_vif
*vif
;
661 struct brcmf_p2p_scan_le
*p2p_params
;
662 struct brcmf_scan_params_le
*sparams
;
663 struct brcmf_ssid ssid
;
665 memsize
+= num_chans
* sizeof(__le16
);
666 memblk
= kzalloc(memsize
, GFP_KERNEL
);
670 vif
= p2p
->bss_idx
[bss_type
].vif
;
672 brcmf_err("no vif for bss type %d\n", bss_type
);
677 switch (search_state
) {
678 case WL_P2P_DISC_ST_SEARCH
:
680 * If we in SEARCH STATE, we don't need to set SSID explictly
681 * because dongle use P2P WILDCARD internally by default
685 memset(ssid
.SSID
, 0, sizeof(ssid
.SSID
));
687 case WL_P2P_DISC_ST_SCAN
:
689 * wpa_supplicant has p2p_find command with type social or
690 * progressive. For progressive, we need to set the ssid to
691 * P2P WILDCARD because we just do broadcast scan unless
694 ssid
.SSID_len
= BRCMF_P2P_WILDCARD_SSID_LEN
;
695 memcpy(ssid
.SSID
, BRCMF_P2P_WILDCARD_SSID
, ssid
.SSID_len
);
698 brcmf_err(" invalid search state %d\n", search_state
);
703 brcmf_p2p_set_discover_state(vif
->ifp
, search_state
, 0, 0);
706 * set p2p scan parameters.
708 p2p_params
= (struct brcmf_p2p_scan_le
*)memblk
;
709 p2p_params
->type
= 'E';
711 /* determine the scan engine parameters */
712 sparams
= &p2p_params
->eparams
.params_le
;
713 sparams
->bss_type
= DOT11_BSSTYPE_ANY
;
714 if (p2p
->cfg
->active_scan
)
715 sparams
->scan_type
= 0;
717 sparams
->scan_type
= 1;
719 memset(&sparams
->bssid
, 0xFF, ETH_ALEN
);
721 memcpy(sparams
->ssid_le
.SSID
, ssid
.SSID
, ssid
.SSID_len
);
722 sparams
->ssid_le
.SSID_len
= cpu_to_le32(ssid
.SSID_len
);
723 sparams
->home_time
= cpu_to_le32(P2PAPI_SCAN_HOME_TIME_MS
);
726 * SOCIAL_CHAN_CNT + 1 takes care of the Progressive scan
727 * supported by the supplicant.
729 if (num_chans
== SOCIAL_CHAN_CNT
|| num_chans
== (SOCIAL_CHAN_CNT
+ 1))
730 active
= P2PAPI_SCAN_SOCIAL_DWELL_TIME_MS
;
731 else if (num_chans
== AF_PEER_SEARCH_CNT
)
732 active
= P2PAPI_SCAN_AF_SEARCH_DWELL_TIME_MS
;
733 else if (wl_get_vif_state_all(p2p
->cfg
, BRCMF_VIF_STATUS_CONNECTED
))
736 active
= P2PAPI_SCAN_DWELL_TIME_MS
;
738 /* Override scan params to find a peer for a connection */
739 if (num_chans
== 1) {
740 active
= WL_SCAN_CONNECT_DWELL_TIME_MS
;
741 /* WAR to sync with presence period of VSDB GO.
742 * send probe request more frequently
744 nprobes
= active
/ WL_SCAN_JOIN_PROBE_INTERVAL_MS
;
746 nprobes
= active
/ P2PAPI_SCAN_NPROBS_TIME_MS
;
752 brcmf_dbg(INFO
, "nprobes # %d, active_time %d\n", nprobes
, active
);
753 sparams
->active_time
= cpu_to_le32(active
);
754 sparams
->nprobes
= cpu_to_le32(nprobes
);
755 sparams
->passive_time
= cpu_to_le32(-1);
756 sparams
->channel_num
= cpu_to_le32(num_chans
&
757 BRCMF_SCAN_PARAMS_COUNT_MASK
);
758 for (i
= 0; i
< num_chans
; i
++)
759 sparams
->channel_list
[i
] = cpu_to_le16(chanspecs
[i
]);
761 /* set the escan specific parameters */
762 p2p_params
->eparams
.version
= cpu_to_le32(BRCMF_ESCAN_REQ_VERSION
);
763 p2p_params
->eparams
.action
= cpu_to_le16(action
);
764 p2p_params
->eparams
.sync_id
= cpu_to_le16(0x1234);
765 /* perform p2p scan on primary device */
766 ret
= brcmf_fil_bsscfg_data_set(vif
->ifp
, "p2p_scan", memblk
, memsize
);
768 set_bit(BRCMF_SCAN_STATUS_BUSY
, &p2p
->cfg
->scan_status
);
775 * brcmf_p2p_run_escan() - escan callback for peer-to-peer.
777 * @cfg: driver private data for cfg80211 interface.
778 * @ndev: net device for which scan is requested.
779 * @request: scan request from cfg80211.
780 * @action: scan action.
782 * Determines the P2P discovery state based to scan request parameters and
783 * validates the channels in the request.
785 static s32
brcmf_p2p_run_escan(struct brcmf_cfg80211_info
*cfg
,
786 struct brcmf_if
*ifp
,
787 struct cfg80211_scan_request
*request
,
790 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
792 s32 search_state
= WL_P2P_DISC_ST_SCAN
;
793 struct brcmf_cfg80211_vif
*vif
;
794 struct net_device
*dev
= NULL
;
795 int i
, num_nodfs
= 0;
798 brcmf_dbg(TRACE
, "enter\n");
805 if (request
->n_channels
) {
806 chanspecs
= kcalloc(request
->n_channels
, sizeof(*chanspecs
),
812 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_CONNECTION
].vif
;
814 dev
= vif
->wdev
.netdev
;
815 if (request
->n_channels
== 3 &&
816 request
->channels
[0]->hw_value
== SOCIAL_CHAN_1
&&
817 request
->channels
[1]->hw_value
== SOCIAL_CHAN_2
&&
818 request
->channels
[2]->hw_value
== SOCIAL_CHAN_3
) {
819 /* SOCIAL CHANNELS 1, 6, 11 */
820 search_state
= WL_P2P_DISC_ST_SEARCH
;
821 brcmf_dbg(INFO
, "P2P SEARCH PHASE START\n");
822 } else if (dev
!= NULL
&& vif
->mode
== WL_MODE_AP
) {
823 /* If you are already a GO, then do SEARCH only */
824 brcmf_dbg(INFO
, "Already a GO. Do SEARCH Only\n");
825 search_state
= WL_P2P_DISC_ST_SEARCH
;
827 brcmf_dbg(INFO
, "P2P SCAN STATE START\n");
831 * no P2P scanning on passive or DFS channels.
833 for (i
= 0; i
< request
->n_channels
; i
++) {
834 struct ieee80211_channel
*chan
= request
->channels
[i
];
836 if (chan
->flags
& (IEEE80211_CHAN_RADAR
|
837 IEEE80211_CHAN_PASSIVE_SCAN
))
840 chanspecs
[i
] = channel_to_chanspec(chan
);
841 brcmf_dbg(INFO
, "%d: chan=%d, channel spec=%x\n",
842 num_nodfs
, chan
->hw_value
, chanspecs
[i
]);
845 err
= brcmf_p2p_escan(p2p
, num_nodfs
, chanspecs
, search_state
,
846 action
, P2PAPI_BSSCFG_DEVICE
);
850 brcmf_err("error (%d)\n", err
);
856 * brcmf_p2p_find_listen_channel() - find listen channel in ie string.
858 * @ie: string of information elements.
859 * @ie_len: length of string.
861 * Scan ie for p2p ie and look for attribute 6 channel. If available determine
862 * channel and return it.
864 static s32
brcmf_p2p_find_listen_channel(const u8
*ie
, u32 ie_len
)
870 err
= cfg80211_get_p2p_attr(ie
, ie_len
,
871 IEEE80211_P2P_ATTR_LISTEN_CHANNEL
,
872 channel_ie
, sizeof(channel_ie
));
876 /* listen channel subel length format: */
877 /* 3(country) + 1(op. class) + 1(chan num) */
878 listen_channel
= (s32
)channel_ie
[3 + 1];
880 if (listen_channel
== SOCIAL_CHAN_1
||
881 listen_channel
== SOCIAL_CHAN_2
||
882 listen_channel
== SOCIAL_CHAN_3
) {
883 brcmf_dbg(INFO
, "Found my Listen Channel %d\n", listen_channel
);
884 return listen_channel
;
892 * brcmf_p2p_scan_prep() - prepare scan based on request.
894 * @wiphy: wiphy device.
895 * @request: scan request from cfg80211.
896 * @vif: vif on which scan request is to be executed.
898 * Prepare the scan appropriately for type of scan requested. Overrides the
899 * escan .run() callback for peer-to-peer scanning.
901 int brcmf_p2p_scan_prep(struct wiphy
*wiphy
,
902 struct cfg80211_scan_request
*request
,
903 struct brcmf_cfg80211_vif
*vif
)
905 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
906 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
909 if (brcmf_p2p_scan_is_p2p_request(request
)) {
910 /* find my listen channel */
911 err
= brcmf_p2p_find_listen_channel(request
->ie
,
916 p2p
->afx_hdl
.my_listen_chan
= err
;
918 clear_bit(BRCMF_P2P_STATUS_GO_NEG_PHASE
, &p2p
->status
);
919 brcmf_dbg(INFO
, "P2P: GO_NEG_PHASE status cleared\n");
921 err
= brcmf_p2p_enable_discovery(p2p
);
925 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
;
927 /* override .run_escan() callback. */
928 cfg
->escan_info
.run
= brcmf_p2p_run_escan
;
930 err
= brcmf_vif_set_mgmt_ie(vif
, BRCMF_VNDR_IE_PRBREQ_FLAG
,
931 request
->ie
, request
->ie_len
);
937 * brcmf_p2p_discover_listen() - set firmware to discover listen state.
940 * @channel: channel nr for discover listen.
941 * @duration: time in ms to stay on channel.
945 brcmf_p2p_discover_listen(struct brcmf_p2p_info
*p2p
, u16 channel
, u32 duration
)
947 struct brcmf_cfg80211_vif
*vif
;
951 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
;
953 brcmf_err("Discovery is not set, so we have nothing to do\n");
958 if (test_bit(BRCMF_P2P_STATUS_DISCOVER_LISTEN
, &p2p
->status
)) {
959 brcmf_err("Previous LISTEN is not completed yet\n");
960 /* WAR: prevent cookie mismatch in wpa_supplicant return OK */
964 chanspec
= brcmf_p2p_chnr_to_chspec(channel
);
965 err
= brcmf_p2p_set_discover_state(vif
->ifp
, WL_P2P_DISC_ST_LISTEN
,
966 chanspec
, (u16
)duration
);
968 set_bit(BRCMF_P2P_STATUS_DISCOVER_LISTEN
, &p2p
->status
);
969 p2p
->remain_on_channel_cookie
++;
977 * brcmf_p2p_remain_on_channel() - put device on channel and stay there.
979 * @wiphy: wiphy device.
980 * @channel: channel to stay on.
981 * @duration: time in ms to remain on channel.
984 int brcmf_p2p_remain_on_channel(struct wiphy
*wiphy
, struct wireless_dev
*wdev
,
985 struct ieee80211_channel
*channel
,
986 unsigned int duration
, u64
*cookie
)
988 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
989 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
993 channel_nr
= ieee80211_frequency_to_channel(channel
->center_freq
);
994 brcmf_dbg(TRACE
, "Enter, channel: %d, duration ms (%d)\n", channel_nr
,
997 err
= brcmf_p2p_enable_discovery(p2p
);
1000 err
= brcmf_p2p_discover_listen(p2p
, channel_nr
, duration
);
1004 memcpy(&p2p
->remain_on_channel
, channel
, sizeof(*channel
));
1005 *cookie
= p2p
->remain_on_channel_cookie
;
1006 cfg80211_ready_on_channel(wdev
, *cookie
, channel
, duration
, GFP_KERNEL
);
1014 * brcmf_p2p_notify_listen_complete() - p2p listen has completed.
1016 * @ifp: interfac control.
1017 * @e: event message. Not used, to make it usable for fweh event dispatcher.
1018 * @data: payload of message. Not used.
1021 int brcmf_p2p_notify_listen_complete(struct brcmf_if
*ifp
,
1022 const struct brcmf_event_msg
*e
,
1025 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
1026 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
1028 brcmf_dbg(TRACE
, "Enter\n");
1029 if (test_and_clear_bit(BRCMF_P2P_STATUS_DISCOVER_LISTEN
,
1031 if (test_and_clear_bit(BRCMF_P2P_STATUS_WAITING_NEXT_AF_LISTEN
,
1033 clear_bit(BRCMF_P2P_STATUS_WAITING_NEXT_ACT_FRAME
,
1035 brcmf_dbg(INFO
, "Listen DONE, wake up wait_next_af\n");
1036 complete(&p2p
->wait_next_af
);
1039 cfg80211_remain_on_channel_expired(&ifp
->vif
->wdev
,
1040 p2p
->remain_on_channel_cookie
,
1041 &p2p
->remain_on_channel
,
1049 * brcmf_p2p_cancel_remain_on_channel() - cancel p2p listen state.
1051 * @ifp: interfac control.
1054 void brcmf_p2p_cancel_remain_on_channel(struct brcmf_if
*ifp
)
1058 brcmf_p2p_set_discover_state(ifp
, WL_P2P_DISC_ST_SCAN
, 0, 0);
1059 brcmf_p2p_notify_listen_complete(ifp
, NULL
, NULL
);
1064 * brcmf_p2p_act_frm_search() - search function for action frame.
1067 * channel: channel on which action frame is to be trasmitted.
1069 * search function to reach at common channel to send action frame. When
1070 * channel is 0 then all social channels will be used to send af
1072 static s32
brcmf_p2p_act_frm_search(struct brcmf_p2p_info
*p2p
, u16 channel
)
1076 u16
*default_chan_list
;
1079 brcmf_dbg(TRACE
, "Enter\n");
1082 channel_cnt
= AF_PEER_SEARCH_CNT
;
1084 channel_cnt
= SOCIAL_CHAN_CNT
;
1085 default_chan_list
= kzalloc(channel_cnt
* sizeof(*default_chan_list
),
1087 if (default_chan_list
== NULL
) {
1088 brcmf_err("channel list allocation failed\n");
1093 /* insert same channel to the chan_list */
1094 for (i
= 0; i
< channel_cnt
; i
++)
1095 default_chan_list
[i
] =
1096 brcmf_p2p_chnr_to_chspec(channel
);
1098 default_chan_list
[0] = brcmf_p2p_chnr_to_chspec(SOCIAL_CHAN_1
);
1099 default_chan_list
[1] = brcmf_p2p_chnr_to_chspec(SOCIAL_CHAN_2
);
1100 default_chan_list
[2] = brcmf_p2p_chnr_to_chspec(SOCIAL_CHAN_3
);
1102 err
= brcmf_p2p_escan(p2p
, channel_cnt
, default_chan_list
,
1103 WL_P2P_DISC_ST_SEARCH
, WL_ESCAN_ACTION_START
,
1104 P2PAPI_BSSCFG_DEVICE
);
1105 kfree(default_chan_list
);
1112 * brcmf_p2p_afx_handler() - afx worker thread.
1117 static void brcmf_p2p_afx_handler(struct work_struct
*work
)
1119 struct afx_hdl
*afx_hdl
= container_of(work
, struct afx_hdl
, afx_work
);
1120 struct brcmf_p2p_info
*p2p
= container_of(afx_hdl
,
1121 struct brcmf_p2p_info
,
1125 if (!afx_hdl
->is_active
)
1128 if (afx_hdl
->is_listen
&& afx_hdl
->my_listen_chan
)
1130 err
= brcmf_p2p_discover_listen(p2p
, afx_hdl
->my_listen_chan
,
1131 100 * (1 + (random32() % 3)));
1133 err
= brcmf_p2p_act_frm_search(p2p
, afx_hdl
->peer_listen_chan
);
1136 brcmf_err("ERROR occurred! value is (%d)\n", err
);
1137 if (test_bit(BRCMF_P2P_STATUS_FINDING_COMMON_CHANNEL
,
1139 complete(&afx_hdl
->act_frm_scan
);
1145 * brcmf_p2p_af_searching_channel() - search channel.
1147 * @p2p: p2p device info struct.
1150 static s32
brcmf_p2p_af_searching_channel(struct brcmf_p2p_info
*p2p
)
1152 struct afx_hdl
*afx_hdl
= &p2p
->afx_hdl
;
1153 struct brcmf_cfg80211_vif
*pri_vif
;
1154 unsigned long duration
;
1157 brcmf_dbg(TRACE
, "Enter\n");
1159 pri_vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
;
1161 INIT_COMPLETION(afx_hdl
->act_frm_scan
);
1162 set_bit(BRCMF_P2P_STATUS_FINDING_COMMON_CHANNEL
, &p2p
->status
);
1163 afx_hdl
->is_active
= true;
1164 afx_hdl
->peer_chan
= P2P_INVALID_CHANNEL
;
1166 /* Loop to wait until we find a peer's channel or the
1167 * pending action frame tx is cancelled.
1170 duration
= msecs_to_jiffies(P2P_AF_FRM_SCAN_MAX_WAIT
);
1171 while ((retry
< P2P_CHANNEL_SYNC_RETRY
) &&
1172 (afx_hdl
->peer_chan
== P2P_INVALID_CHANNEL
)) {
1173 afx_hdl
->is_listen
= false;
1174 brcmf_dbg(TRACE
, "Scheduling action frame for sending.. (%d)\n",
1176 /* search peer on peer's listen channel */
1177 schedule_work(&afx_hdl
->afx_work
);
1178 wait_for_completion_timeout(&afx_hdl
->act_frm_scan
, duration
);
1179 if ((afx_hdl
->peer_chan
!= P2P_INVALID_CHANNEL
) ||
1180 (!test_bit(BRCMF_P2P_STATUS_FINDING_COMMON_CHANNEL
,
1184 if (afx_hdl
->my_listen_chan
) {
1185 brcmf_dbg(TRACE
, "Scheduling listen peer, channel=%d\n",
1186 afx_hdl
->my_listen_chan
);
1187 /* listen on my listen channel */
1188 afx_hdl
->is_listen
= true;
1189 schedule_work(&afx_hdl
->afx_work
);
1190 wait_for_completion_timeout(&afx_hdl
->act_frm_scan
,
1193 if ((afx_hdl
->peer_chan
!= P2P_INVALID_CHANNEL
) ||
1194 (!test_bit(BRCMF_P2P_STATUS_FINDING_COMMON_CHANNEL
,
1199 /* if sta is connected or connecting, sleep for a while before
1200 * retry af tx or finding a peer
1202 if (test_bit(BRCMF_VIF_STATUS_CONNECTED
, &pri_vif
->sme_state
) ||
1203 test_bit(BRCMF_VIF_STATUS_CONNECTING
, &pri_vif
->sme_state
))
1204 msleep(P2P_DEFAULT_SLEEP_TIME_VSDB
);
1207 brcmf_dbg(TRACE
, "Completed search/listen peer_chan=%d\n",
1208 afx_hdl
->peer_chan
);
1209 afx_hdl
->is_active
= false;
1211 clear_bit(BRCMF_P2P_STATUS_FINDING_COMMON_CHANNEL
, &p2p
->status
);
1213 return afx_hdl
->peer_chan
;
1218 * brcmf_p2p_scan_finding_common_channel() - was escan used for finding channel
1220 * @cfg: common configuration struct.
1221 * @bi: bss info struct, result from scan.
1224 bool brcmf_p2p_scan_finding_common_channel(struct brcmf_cfg80211_info
*cfg
,
1225 struct brcmf_bss_info_le
*bi
)
1228 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
1229 struct afx_hdl
*afx_hdl
= &p2p
->afx_hdl
;
1232 u8 p2p_dev_addr
[ETH_ALEN
];
1234 if (!test_bit(BRCMF_P2P_STATUS_FINDING_COMMON_CHANNEL
, &p2p
->status
))
1238 brcmf_dbg(TRACE
, "ACTION FRAME SCAN Done\n");
1239 if (afx_hdl
->peer_chan
== P2P_INVALID_CHANNEL
)
1240 complete(&afx_hdl
->act_frm_scan
);
1244 ie
= ((u8
*)bi
) + le16_to_cpu(bi
->ie_offset
);
1245 memset(p2p_dev_addr
, 0, sizeof(p2p_dev_addr
));
1246 err
= cfg80211_get_p2p_attr(ie
, le32_to_cpu(bi
->ie_length
),
1247 IEEE80211_P2P_ATTR_DEVICE_INFO
,
1248 p2p_dev_addr
, sizeof(p2p_dev_addr
));
1250 err
= cfg80211_get_p2p_attr(ie
, le32_to_cpu(bi
->ie_length
),
1251 IEEE80211_P2P_ATTR_DEVICE_ID
,
1252 p2p_dev_addr
, sizeof(p2p_dev_addr
));
1254 (!memcmp(p2p_dev_addr
, afx_hdl
->tx_dst_addr
, ETH_ALEN
))) {
1255 afx_hdl
->peer_chan
= bi
->ctl_ch
? bi
->ctl_ch
:
1256 CHSPEC_CHANNEL(le16_to_cpu(bi
->chanspec
));
1257 brcmf_dbg(TRACE
, "ACTION FRAME SCAN : Peer %pM found, channel : %d\n",
1258 afx_hdl
->tx_dst_addr
, afx_hdl
->peer_chan
);
1259 complete(&afx_hdl
->act_frm_scan
);
1265 * brcmf_p2p_stop_wait_next_action_frame() - finish scan if af tx complete.
1267 * @cfg: common configuration struct.
1271 brcmf_p2p_stop_wait_next_action_frame(struct brcmf_cfg80211_info
*cfg
)
1273 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
1274 struct brcmf_if
*ifp
= cfg
->escan_info
.ifp
;
1276 if (test_bit(BRCMF_P2P_STATUS_SENDING_ACT_FRAME
, &p2p
->status
) &&
1277 (test_bit(BRCMF_P2P_STATUS_ACTION_TX_COMPLETED
, &p2p
->status
) ||
1278 test_bit(BRCMF_P2P_STATUS_ACTION_TX_NOACK
, &p2p
->status
))) {
1279 brcmf_dbg(TRACE
, "*** Wake UP ** abort actframe iovar\n");
1280 /* if channel is not zero, "actfame" uses off channel scan.
1281 * So abort scan for off channel completion.
1283 if (p2p
->af_sent_channel
)
1284 brcmf_notify_escan_complete(cfg
, ifp
, true, true);
1285 } else if (test_bit(BRCMF_P2P_STATUS_WAITING_NEXT_AF_LISTEN
,
1287 brcmf_dbg(TRACE
, "*** Wake UP ** abort listen for next af frame\n");
1288 /* So abort scan to cancel listen */
1289 brcmf_notify_escan_complete(cfg
, ifp
, true, true);
1295 * brcmf_p2p_gon_req_collision() - Check if go negotiaton collission
1297 * @p2p: p2p device info struct.
1299 * return true if recevied action frame is to be dropped.
1302 brcmf_p2p_gon_req_collision(struct brcmf_p2p_info
*p2p
, u8
*mac
)
1304 struct brcmf_cfg80211_info
*cfg
= p2p
->cfg
;
1305 struct brcmf_if
*ifp
;
1307 brcmf_dbg(TRACE
, "Enter\n");
1309 if (!test_bit(BRCMF_P2P_STATUS_WAITING_NEXT_ACT_FRAME
, &p2p
->status
) ||
1310 !p2p
->gon_req_action
)
1313 brcmf_dbg(TRACE
, "GO Negotiation Request COLLISION !!!\n");
1314 /* if sa(peer) addr is less than da(my) addr, then this device
1315 * process peer's gon request and block to send gon req.
1316 * if not (sa addr > da addr),
1317 * this device will process gon request and drop gon req of peer.
1319 ifp
= p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
->ifp
;
1320 if (memcmp(mac
, ifp
->mac_addr
, ETH_ALEN
) < 0) {
1321 brcmf_dbg(INFO
, "Block transmit gon req !!!\n");
1322 p2p
->block_gon_req_tx
= true;
1323 /* if we are finding a common channel for sending af,
1324 * do not scan more to block to send current gon req
1326 if (test_and_clear_bit(BRCMF_P2P_STATUS_FINDING_COMMON_CHANNEL
,
1328 complete(&p2p
->afx_hdl
.act_frm_scan
);
1329 if (test_and_clear_bit(BRCMF_P2P_STATUS_WAITING_NEXT_ACT_FRAME
,
1331 brcmf_p2p_stop_wait_next_action_frame(cfg
);
1335 /* drop gon request of peer to process gon request by this device. */
1336 brcmf_dbg(INFO
, "Drop received gon req !!!\n");
1343 * brcmf_p2p_notify_action_frame_rx() - received action frame.
1345 * @ifp: interfac control.
1346 * @e: event message. Not used, to make it usable for fweh event dispatcher.
1347 * @data: payload of message, containing action frame data.
1350 int brcmf_p2p_notify_action_frame_rx(struct brcmf_if
*ifp
,
1351 const struct brcmf_event_msg
*e
,
1354 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
1355 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
1356 struct afx_hdl
*afx_hdl
= &p2p
->afx_hdl
;
1357 struct wireless_dev
*wdev
;
1358 u32 mgmt_frame_len
= e
->datalen
- sizeof(struct brcmf_rx_mgmt_data
);
1359 struct brcmf_rx_mgmt_data
*rxframe
= (struct brcmf_rx_mgmt_data
*)data
;
1360 u8
*frame
= (u8
*)(rxframe
+ 1);
1361 struct brcmf_p2p_pub_act_frame
*act_frm
;
1362 struct brcmf_p2psd_gas_pub_act_frame
*sd_act_frm
;
1363 u16 chanspec
= be16_to_cpu(rxframe
->chanspec
);
1364 struct ieee80211_mgmt
*mgmt_frame
;
1369 /* Check if wpa_supplicant has registered for this frame */
1370 brcmf_dbg(INFO
, "ifp->vif->mgmt_rx_reg %04x\n", ifp
->vif
->mgmt_rx_reg
);
1371 mgmt_type
= (IEEE80211_STYPE_ACTION
& IEEE80211_FCTL_STYPE
) >> 4;
1372 if ((ifp
->vif
->mgmt_rx_reg
& BIT(mgmt_type
)) == 0)
1375 brcmf_p2p_print_actframe(false, frame
, mgmt_frame_len
);
1377 action
= P2P_PAF_SUBTYPE_INVALID
;
1378 if (brcmf_p2p_is_pub_action(frame
, mgmt_frame_len
)) {
1379 act_frm
= (struct brcmf_p2p_pub_act_frame
*)frame
;
1380 action
= act_frm
->subtype
;
1381 if ((action
== P2P_PAF_GON_REQ
) &&
1382 (brcmf_p2p_gon_req_collision(p2p
, (u8
*)e
->addr
))) {
1383 if (test_bit(BRCMF_P2P_STATUS_FINDING_COMMON_CHANNEL
,
1385 (memcmp(afx_hdl
->tx_dst_addr
, e
->addr
,
1387 afx_hdl
->peer_chan
= CHSPEC_CHANNEL(chanspec
);
1388 brcmf_dbg(INFO
, "GON request: Peer found, channel=%d\n",
1389 afx_hdl
->peer_chan
);
1390 complete(&afx_hdl
->act_frm_scan
);
1394 /* After complete GO Negotiation, roll back to mpc mode */
1395 if ((action
== P2P_PAF_GON_CONF
) ||
1396 (action
== P2P_PAF_PROVDIS_RSP
))
1397 brcmf_set_mpc(ifp
, 1);
1398 if (action
== P2P_PAF_GON_CONF
) {
1399 brcmf_dbg(TRACE
, "P2P: GO_NEG_PHASE status cleared\n");
1400 clear_bit(BRCMF_P2P_STATUS_GO_NEG_PHASE
, &p2p
->status
);
1402 } else if (brcmf_p2p_is_gas_action(frame
, mgmt_frame_len
)) {
1403 sd_act_frm
= (struct brcmf_p2psd_gas_pub_act_frame
*)frame
;
1404 action
= sd_act_frm
->action
;
1407 if (test_bit(BRCMF_P2P_STATUS_WAITING_NEXT_ACT_FRAME
, &p2p
->status
) &&
1408 (p2p
->next_af_subtype
== action
)) {
1409 brcmf_dbg(TRACE
, "We got a right next frame! (%d)\n", action
);
1410 clear_bit(BRCMF_P2P_STATUS_WAITING_NEXT_ACT_FRAME
,
1412 /* Stop waiting for next AF. */
1413 brcmf_p2p_stop_wait_next_action_frame(cfg
);
1416 mgmt_frame
= kzalloc(offsetof(struct ieee80211_mgmt
, u
) +
1417 mgmt_frame_len
, GFP_KERNEL
);
1419 brcmf_err("No memory available for action frame\n");
1422 memcpy(mgmt_frame
->da
, ifp
->mac_addr
, ETH_ALEN
);
1423 brcmf_fil_cmd_data_get(ifp
, BRCMF_C_GET_BSSID
, mgmt_frame
->bssid
,
1425 memcpy(mgmt_frame
->sa
, e
->addr
, ETH_ALEN
);
1426 mgmt_frame
->frame_control
= cpu_to_le16(IEEE80211_STYPE_ACTION
);
1427 memcpy(&mgmt_frame
->u
, frame
, mgmt_frame_len
);
1428 mgmt_frame_len
+= offsetof(struct ieee80211_mgmt
, u
);
1430 freq
= ieee80211_channel_to_frequency(CHSPEC_CHANNEL(chanspec
),
1431 CHSPEC_IS2G(chanspec
) ?
1432 IEEE80211_BAND_2GHZ
:
1433 IEEE80211_BAND_5GHZ
);
1434 wdev
= ifp
->ndev
->ieee80211_ptr
;
1435 cfg80211_rx_mgmt(wdev
, freq
, 0, (u8
*)mgmt_frame
, mgmt_frame_len
,
1444 * brcmf_p2p_notify_action_tx_complete() - transmit action frame complete
1446 * @ifp: interfac control.
1447 * @e: event message. Not used, to make it usable for fweh event dispatcher.
1451 int brcmf_p2p_notify_action_tx_complete(struct brcmf_if
*ifp
,
1452 const struct brcmf_event_msg
*e
,
1455 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
1456 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
1458 brcmf_dbg(INFO
, "Enter: event %s, status=%d\n",
1459 e
->event_code
== BRCMF_E_ACTION_FRAME_OFF_CHAN_COMPLETE
?
1460 "ACTION_FRAME_OFF_CHAN_COMPLETE" : "ACTION_FRAME_COMPLETE",
1463 if (!test_bit(BRCMF_P2P_STATUS_SENDING_ACT_FRAME
, &p2p
->status
))
1466 if (e
->event_code
== BRCMF_E_ACTION_FRAME_COMPLETE
) {
1467 if (e
->status
== BRCMF_E_STATUS_SUCCESS
)
1468 set_bit(BRCMF_P2P_STATUS_ACTION_TX_COMPLETED
,
1471 set_bit(BRCMF_P2P_STATUS_ACTION_TX_NOACK
, &p2p
->status
);
1472 /* If there is no ack, we don't need to wait for
1473 * WLC_E_ACTION_FRAME_OFFCHAN_COMPLETE event
1475 brcmf_p2p_stop_wait_next_action_frame(cfg
);
1479 complete(&p2p
->send_af_done
);
1486 * brcmf_p2p_tx_action_frame() - send action frame over fil.
1488 * @p2p: p2p info struct for vif.
1489 * @af_params: action frame data/info.
1491 * Send an action frame immediately without doing channel synchronization.
1493 * This function waits for a completion event before returning.
1494 * The WLC_E_ACTION_FRAME_COMPLETE event will be received when the action
1495 * frame is transmitted.
1497 static s32
brcmf_p2p_tx_action_frame(struct brcmf_p2p_info
*p2p
,
1498 struct brcmf_fil_af_params_le
*af_params
)
1500 struct brcmf_cfg80211_vif
*vif
;
1504 brcmf_dbg(TRACE
, "Enter\n");
1506 INIT_COMPLETION(p2p
->send_af_done
);
1507 clear_bit(BRCMF_P2P_STATUS_ACTION_TX_COMPLETED
, &p2p
->status
);
1508 clear_bit(BRCMF_P2P_STATUS_ACTION_TX_NOACK
, &p2p
->status
);
1510 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
;
1511 err
= brcmf_fil_bsscfg_data_set(vif
->ifp
, "actframe", af_params
,
1512 sizeof(*af_params
));
1514 brcmf_err(" sending action frame has failed\n");
1518 p2p
->af_sent_channel
= le32_to_cpu(af_params
->channel
);
1519 p2p
->af_tx_sent_jiffies
= jiffies
;
1521 timeout
= wait_for_completion_timeout(&p2p
->send_af_done
,
1522 msecs_to_jiffies(P2P_AF_MAX_WAIT_TIME
));
1524 if (test_bit(BRCMF_P2P_STATUS_ACTION_TX_COMPLETED
, &p2p
->status
)) {
1525 brcmf_dbg(TRACE
, "TX action frame operation is success\n");
1528 brcmf_dbg(TRACE
, "TX action frame operation has failed\n");
1530 /* clear status bit for action tx */
1531 clear_bit(BRCMF_P2P_STATUS_ACTION_TX_COMPLETED
, &p2p
->status
);
1532 clear_bit(BRCMF_P2P_STATUS_ACTION_TX_NOACK
, &p2p
->status
);
1540 * brcmf_p2p_pub_af_tx() - public action frame tx routine.
1542 * @cfg: driver private data for cfg80211 interface.
1543 * @af_params: action frame data/info.
1544 * @config_af_params: configuration data for action frame.
1546 * routine which transmits ation frame public type.
1548 static s32
brcmf_p2p_pub_af_tx(struct brcmf_cfg80211_info
*cfg
,
1549 struct brcmf_fil_af_params_le
*af_params
,
1550 struct brcmf_config_af_params
*config_af_params
)
1552 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
1553 struct brcmf_fil_action_frame_le
*action_frame
;
1554 struct brcmf_p2p_pub_act_frame
*act_frm
;
1558 action_frame
= &af_params
->action_frame
;
1559 act_frm
= (struct brcmf_p2p_pub_act_frame
*)(action_frame
->data
);
1561 config_af_params
->extra_listen
= true;
1563 switch (act_frm
->subtype
) {
1564 case P2P_PAF_GON_REQ
:
1565 brcmf_dbg(TRACE
, "P2P: GO_NEG_PHASE status set\n");
1566 set_bit(BRCMF_P2P_STATUS_GO_NEG_PHASE
, &p2p
->status
);
1567 config_af_params
->mpc_onoff
= 0;
1568 config_af_params
->search_channel
= true;
1569 p2p
->next_af_subtype
= act_frm
->subtype
+ 1;
1570 p2p
->gon_req_action
= true;
1571 /* increase dwell time to wait for RESP frame */
1572 af_params
->dwell_time
= cpu_to_le32(P2P_AF_MED_DWELL_TIME
);
1574 case P2P_PAF_GON_RSP
:
1575 p2p
->next_af_subtype
= act_frm
->subtype
+ 1;
1576 /* increase dwell time to wait for CONF frame */
1577 af_params
->dwell_time
= cpu_to_le32(P2P_AF_MED_DWELL_TIME
);
1579 case P2P_PAF_GON_CONF
:
1580 /* If we reached till GO Neg confirmation reset the filter */
1581 brcmf_dbg(TRACE
, "P2P: GO_NEG_PHASE status cleared\n");
1582 clear_bit(BRCMF_P2P_STATUS_GO_NEG_PHASE
, &p2p
->status
);
1583 /* turn on mpc again if go nego is done */
1584 config_af_params
->mpc_onoff
= 1;
1585 /* minimize dwell time */
1586 af_params
->dwell_time
= cpu_to_le32(P2P_AF_MIN_DWELL_TIME
);
1587 config_af_params
->extra_listen
= false;
1589 case P2P_PAF_INVITE_REQ
:
1590 config_af_params
->search_channel
= true;
1591 p2p
->next_af_subtype
= act_frm
->subtype
+ 1;
1592 /* increase dwell time */
1593 af_params
->dwell_time
= cpu_to_le32(P2P_AF_MED_DWELL_TIME
);
1595 case P2P_PAF_INVITE_RSP
:
1596 /* minimize dwell time */
1597 af_params
->dwell_time
= cpu_to_le32(P2P_AF_MIN_DWELL_TIME
);
1598 config_af_params
->extra_listen
= false;
1600 case P2P_PAF_DEVDIS_REQ
:
1601 config_af_params
->search_channel
= true;
1602 p2p
->next_af_subtype
= act_frm
->subtype
+ 1;
1603 /* maximize dwell time to wait for RESP frame */
1604 af_params
->dwell_time
= cpu_to_le32(P2P_AF_LONG_DWELL_TIME
);
1606 case P2P_PAF_DEVDIS_RSP
:
1607 /* minimize dwell time */
1608 af_params
->dwell_time
= cpu_to_le32(P2P_AF_MIN_DWELL_TIME
);
1609 config_af_params
->extra_listen
= false;
1611 case P2P_PAF_PROVDIS_REQ
:
1612 ie_len
= le16_to_cpu(action_frame
->len
) -
1613 offsetof(struct brcmf_p2p_pub_act_frame
, elts
);
1614 if (cfg80211_get_p2p_attr(&act_frm
->elts
[0], ie_len
,
1615 IEEE80211_P2P_ATTR_GROUP_ID
,
1617 config_af_params
->search_channel
= true;
1618 config_af_params
->mpc_onoff
= 0;
1619 p2p
->next_af_subtype
= act_frm
->subtype
+ 1;
1620 /* increase dwell time to wait for RESP frame */
1621 af_params
->dwell_time
= cpu_to_le32(P2P_AF_MED_DWELL_TIME
);
1623 case P2P_PAF_PROVDIS_RSP
:
1624 /* wpa_supplicant send go nego req right after prov disc */
1625 p2p
->next_af_subtype
= P2P_PAF_GON_REQ
;
1626 /* increase dwell time to MED level */
1627 af_params
->dwell_time
= cpu_to_le32(P2P_AF_MED_DWELL_TIME
);
1628 config_af_params
->extra_listen
= false;
1631 brcmf_err("Unknown p2p pub act frame subtype: %d\n",
1639 * brcmf_p2p_send_action_frame() - send action frame .
1641 * @cfg: driver private data for cfg80211 interface.
1642 * @ndev: net device to transmit on.
1643 * @af_params: configuration data for action frame.
1645 bool brcmf_p2p_send_action_frame(struct brcmf_cfg80211_info
*cfg
,
1646 struct net_device
*ndev
,
1647 struct brcmf_fil_af_params_le
*af_params
)
1649 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
1650 struct brcmf_if
*ifp
= netdev_priv(ndev
);
1651 struct brcmf_fil_action_frame_le
*action_frame
;
1652 struct brcmf_config_af_params config_af_params
;
1653 struct afx_hdl
*afx_hdl
= &p2p
->afx_hdl
;
1654 u16 action_frame_len
;
1659 s32 extra_listen_time
;
1662 action_frame
= &af_params
->action_frame
;
1663 action_frame_len
= le16_to_cpu(action_frame
->len
);
1665 brcmf_p2p_print_actframe(true, action_frame
->data
, action_frame_len
);
1667 /* Add the default dwell time. Dwell time to stay off-channel */
1668 /* to wait for a response action frame after transmitting an */
1669 /* GO Negotiation action frame */
1670 af_params
->dwell_time
= cpu_to_le32(P2P_AF_DWELL_TIME
);
1672 category
= action_frame
->data
[DOT11_ACTION_CAT_OFF
];
1673 action
= action_frame
->data
[DOT11_ACTION_ACT_OFF
];
1675 /* initialize variables */
1676 p2p
->next_af_subtype
= P2P_PAF_SUBTYPE_INVALID
;
1677 p2p
->gon_req_action
= false;
1679 /* config parameters */
1680 config_af_params
.mpc_onoff
= -1;
1681 config_af_params
.search_channel
= false;
1682 config_af_params
.extra_listen
= false;
1684 if (brcmf_p2p_is_pub_action(action_frame
->data
, action_frame_len
)) {
1685 /* p2p public action frame process */
1686 if (brcmf_p2p_pub_af_tx(cfg
, af_params
, &config_af_params
)) {
1687 /* Just send unknown subtype frame with */
1688 /* default parameters. */
1689 brcmf_err("P2P Public action frame, unknown subtype.\n");
1691 } else if (brcmf_p2p_is_gas_action(action_frame
->data
,
1692 action_frame_len
)) {
1693 /* service discovery process */
1694 if (action
== P2PSD_ACTION_ID_GAS_IREQ
||
1695 action
== P2PSD_ACTION_ID_GAS_CREQ
) {
1696 /* configure service discovery query frame */
1697 config_af_params
.search_channel
= true;
1699 /* save next af suptype to cancel */
1700 /* remaining dwell time */
1701 p2p
->next_af_subtype
= action
+ 1;
1703 af_params
->dwell_time
=
1704 cpu_to_le32(P2P_AF_MED_DWELL_TIME
);
1705 } else if (action
== P2PSD_ACTION_ID_GAS_IRESP
||
1706 action
== P2PSD_ACTION_ID_GAS_CRESP
) {
1707 /* configure service discovery response frame */
1708 af_params
->dwell_time
=
1709 cpu_to_le32(P2P_AF_MIN_DWELL_TIME
);
1711 brcmf_err("Unknown action type: %d\n", action
);
1714 } else if (brcmf_p2p_is_p2p_action(action_frame
->data
,
1715 action_frame_len
)) {
1716 /* do not configure anything. it will be */
1717 /* sent with a default configuration */
1719 brcmf_err("Unknown Frame: category 0x%x, action 0x%x\n",
1724 /* if connecting on primary iface, sleep for a while before sending
1727 if (test_bit(BRCMF_VIF_STATUS_CONNECTING
,
1728 &p2p
->bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
->sme_state
))
1731 /* if scan is ongoing, abort current scan. */
1732 if (test_bit(BRCMF_SCAN_STATUS_BUSY
, &cfg
->scan_status
))
1733 brcmf_abort_scanning(cfg
);
1735 memcpy(afx_hdl
->tx_dst_addr
, action_frame
->da
, ETH_ALEN
);
1737 /* To make sure to send successfully action frame, turn off mpc */
1738 if (config_af_params
.mpc_onoff
== 0)
1739 brcmf_set_mpc(ifp
, 0);
1741 /* set status and destination address before sending af */
1742 if (p2p
->next_af_subtype
!= P2P_PAF_SUBTYPE_INVALID
) {
1743 /* set status to cancel the remained dwell time in rx process */
1744 set_bit(BRCMF_P2P_STATUS_WAITING_NEXT_ACT_FRAME
, &p2p
->status
);
1747 p2p
->af_sent_channel
= 0;
1748 set_bit(BRCMF_P2P_STATUS_SENDING_ACT_FRAME
, &p2p
->status
);
1749 /* validate channel and p2p ies */
1750 if (config_af_params
.search_channel
&&
1751 IS_P2P_SOCIAL_CHANNEL(le32_to_cpu(af_params
->channel
)) &&
1752 p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
->saved_ie
.probe_req_ie_len
) {
1753 afx_hdl
= &p2p
->afx_hdl
;
1754 afx_hdl
->peer_listen_chan
= le32_to_cpu(af_params
->channel
);
1756 if (brcmf_p2p_af_searching_channel(p2p
) ==
1757 P2P_INVALID_CHANNEL
) {
1758 brcmf_err("Couldn't find peer's channel.\n");
1762 /* Abort scan even for VSDB scenarios. Scan gets aborted in
1763 * firmware but after the check of piggyback algorithm. To take
1764 * care of current piggback algo, lets abort the scan here
1767 brcmf_notify_escan_complete(cfg
, ifp
, true, true);
1769 /* update channel */
1770 af_params
->channel
= cpu_to_le32(afx_hdl
->peer_chan
);
1774 while (!p2p
->block_gon_req_tx
&&
1775 (ack
== false) && (tx_retry
< P2P_AF_TX_MAX_RETRY
)) {
1776 ack
= !brcmf_p2p_tx_action_frame(p2p
, af_params
);
1780 brcmf_err("Failed to send Action Frame(retry %d)\n", tx_retry
);
1781 clear_bit(BRCMF_P2P_STATUS_GO_NEG_PHASE
, &p2p
->status
);
1785 clear_bit(BRCMF_P2P_STATUS_SENDING_ACT_FRAME
, &p2p
->status
);
1787 /* WAR: sometimes dongle does not keep the dwell time of 'actframe'.
1788 * if we coundn't get the next action response frame and dongle does
1789 * not keep the dwell time, go to listen state again to get next action
1792 if (ack
&& config_af_params
.extra_listen
&& !p2p
->block_gon_req_tx
&&
1793 test_bit(BRCMF_P2P_STATUS_WAITING_NEXT_ACT_FRAME
, &p2p
->status
) &&
1794 p2p
->af_sent_channel
== afx_hdl
->my_listen_chan
) {
1795 delta_ms
= jiffies_to_msecs(jiffies
- p2p
->af_tx_sent_jiffies
);
1796 if (le32_to_cpu(af_params
->dwell_time
) > delta_ms
)
1797 extra_listen_time
= le32_to_cpu(af_params
->dwell_time
) -
1800 extra_listen_time
= 0;
1801 if (extra_listen_time
> 50) {
1802 set_bit(BRCMF_P2P_STATUS_WAITING_NEXT_AF_LISTEN
,
1804 brcmf_dbg(INFO
, "Wait more time! actual af time:%d, calculated extra listen:%d\n",
1805 le32_to_cpu(af_params
->dwell_time
),
1807 extra_listen_time
+= 100;
1808 if (!brcmf_p2p_discover_listen(p2p
,
1809 p2p
->af_sent_channel
,
1810 extra_listen_time
)) {
1811 unsigned long duration
;
1813 extra_listen_time
+= 100;
1814 duration
= msecs_to_jiffies(extra_listen_time
);
1815 wait_for_completion_timeout(&p2p
->wait_next_af
,
1818 clear_bit(BRCMF_P2P_STATUS_WAITING_NEXT_AF_LISTEN
,
1823 if (p2p
->block_gon_req_tx
) {
1824 /* if ack is true, supplicant will wait more time(100ms).
1825 * so we will return it as a success to get more time .
1827 p2p
->block_gon_req_tx
= false;
1831 clear_bit(BRCMF_P2P_STATUS_WAITING_NEXT_ACT_FRAME
, &p2p
->status
);
1832 /* if all done, turn mpc on again */
1833 if (config_af_params
.mpc_onoff
== 1)
1834 brcmf_set_mpc(ifp
, 1);
1840 * brcmf_p2p_notify_rx_mgmt_p2p_probereq() - Event handler for p2p probe req.
1842 * @ifp: interface pointer for which event was received.
1844 * @data: payload of event message (probe request).
1846 s32
brcmf_p2p_notify_rx_mgmt_p2p_probereq(struct brcmf_if
*ifp
,
1847 const struct brcmf_event_msg
*e
,
1850 struct brcmf_cfg80211_info
*cfg
= ifp
->drvr
->config
;
1851 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
1852 struct afx_hdl
*afx_hdl
= &p2p
->afx_hdl
;
1853 struct brcmf_cfg80211_vif
*vif
= ifp
->vif
;
1854 struct brcmf_rx_mgmt_data
*rxframe
= (struct brcmf_rx_mgmt_data
*)data
;
1855 u16 chanspec
= be16_to_cpu(rxframe
->chanspec
);
1861 brcmf_dbg(INFO
, "Enter: event %d reason %d\n", e
->event_code
,
1864 if (test_bit(BRCMF_P2P_STATUS_FINDING_COMMON_CHANNEL
, &p2p
->status
) &&
1865 (memcmp(afx_hdl
->tx_dst_addr
, e
->addr
, ETH_ALEN
) == 0)) {
1866 afx_hdl
->peer_chan
= CHSPEC_CHANNEL(chanspec
);
1867 brcmf_dbg(INFO
, "PROBE REQUEST: Peer found, channel=%d\n",
1868 afx_hdl
->peer_chan
);
1869 complete(&afx_hdl
->act_frm_scan
);
1872 /* Firmware sends us two proberesponses for each idx one. At the */
1873 /* moment anything but bsscfgidx 0 is passed up to supplicant */
1874 if (e
->bsscfgidx
== 0)
1877 /* Filter any P2P probe reqs arriving during the GO-NEG Phase */
1878 if (test_bit(BRCMF_P2P_STATUS_GO_NEG_PHASE
, &p2p
->status
)) {
1879 brcmf_dbg(INFO
, "Filtering P2P probe_req in GO-NEG phase\n");
1883 /* Check if wpa_supplicant has registered for this frame */
1884 brcmf_dbg(INFO
, "vif->mgmt_rx_reg %04x\n", vif
->mgmt_rx_reg
);
1885 mgmt_type
= (IEEE80211_STYPE_PROBE_REQ
& IEEE80211_FCTL_STYPE
) >> 4;
1886 if ((vif
->mgmt_rx_reg
& BIT(mgmt_type
)) == 0)
1889 mgmt_frame
= (u8
*)(rxframe
+ 1);
1890 mgmt_frame_len
= e
->datalen
- sizeof(*rxframe
);
1891 freq
= ieee80211_channel_to_frequency(CHSPEC_CHANNEL(chanspec
),
1892 CHSPEC_IS2G(chanspec
) ?
1893 IEEE80211_BAND_2GHZ
:
1894 IEEE80211_BAND_5GHZ
);
1896 cfg80211_rx_mgmt(&vif
->wdev
, freq
, 0, mgmt_frame
, mgmt_frame_len
,
1899 brcmf_dbg(INFO
, "mgmt_frame_len (%d) , e->datalen (%d), chanspec (%04x), freq (%d)\n",
1900 mgmt_frame_len
, e
->datalen
, chanspec
, freq
);
1907 * brcmf_p2p_attach() - attach for P2P.
1909 * @cfg: driver private data for cfg80211 interface.
1911 s32
brcmf_p2p_attach(struct brcmf_cfg80211_info
*cfg
)
1913 struct brcmf_if
*pri_ifp
;
1914 struct brcmf_if
*p2p_ifp
;
1915 struct brcmf_cfg80211_vif
*p2p_vif
;
1916 struct brcmf_p2p_info
*p2p
;
1917 struct brcmf_pub
*drvr
;
1926 pri_ifp
= drvr
->iflist
[0];
1927 p2p_ifp
= drvr
->iflist
[1];
1929 p2p
->bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
= pri_ifp
->vif
;
1932 p2p_vif
= brcmf_alloc_vif(cfg
, NL80211_IFTYPE_P2P_DEVICE
,
1934 if (IS_ERR(p2p_vif
)) {
1935 brcmf_err("could not create discovery vif\n");
1940 p2p_vif
->ifp
= p2p_ifp
;
1941 p2p_ifp
->vif
= p2p_vif
;
1942 p2p_vif
->wdev
.netdev
= p2p_ifp
->ndev
;
1943 p2p_ifp
->ndev
->ieee80211_ptr
= &p2p_vif
->wdev
;
1944 SET_NETDEV_DEV(p2p_ifp
->ndev
, wiphy_dev(cfg
->wiphy
));
1946 p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
= p2p_vif
;
1948 brcmf_p2p_generate_bss_mac(p2p
, NULL
);
1949 memcpy(p2p_ifp
->mac_addr
, p2p
->dev_addr
, ETH_ALEN
);
1950 brcmf_p2p_set_firmware(pri_ifp
, p2p
->dev_addr
);
1952 /* Initialize P2P Discovery in the firmware */
1953 err
= brcmf_fil_iovar_int_set(pri_ifp
, "p2p_disc", 1);
1955 brcmf_err("set p2p_disc error\n");
1956 brcmf_free_vif(p2p_vif
);
1959 /* obtain bsscfg index for P2P discovery */
1960 err
= brcmf_fil_iovar_int_get(pri_ifp
, "p2p_dev", &bssidx
);
1962 brcmf_err("retrieving discover bsscfg index failed\n");
1963 brcmf_free_vif(p2p_vif
);
1966 /* Verify that firmware uses same bssidx as driver !! */
1967 if (p2p_ifp
->bssidx
!= bssidx
) {
1968 brcmf_err("Incorrect bssidx=%d, compared to p2p_ifp->bssidx=%d\n",
1969 bssidx
, p2p_ifp
->bssidx
);
1970 brcmf_free_vif(p2p_vif
);
1974 init_completion(&p2p
->send_af_done
);
1975 INIT_WORK(&p2p
->afx_hdl
.afx_work
, brcmf_p2p_afx_handler
);
1976 init_completion(&p2p
->afx_hdl
.act_frm_scan
);
1977 init_completion(&p2p
->wait_next_af
);
1985 * brcmf_p2p_detach() - detach P2P.
1987 * @p2p: P2P specific data.
1989 void brcmf_p2p_detach(struct brcmf_p2p_info
*p2p
)
1991 struct brcmf_cfg80211_vif
*vif
;
1993 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
;
1995 brcmf_p2p_cancel_remain_on_channel(vif
->ifp
);
1996 brcmf_p2p_deinit_discovery(p2p
);
1997 /* remove discovery interface */
1998 brcmf_free_vif(vif
);
1999 p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
= NULL
;
2001 /* just set it all to zero */
2002 memset(p2p
, 0, sizeof(*p2p
));
2006 * brcmf_p2p_get_current_chanspec() - Get current operation channel.
2008 * @p2p: P2P specific data.
2009 * @chanspec: chanspec to be returned.
2011 static void brcmf_p2p_get_current_chanspec(struct brcmf_p2p_info
*p2p
,
2014 struct brcmf_if
*ifp
;
2015 struct brcmf_fil_chan_info_le ci
;
2018 ifp
= p2p
->bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
->ifp
;
2020 *chanspec
= 11 & WL_CHANSPEC_CHAN_MASK
;
2022 err
= brcmf_fil_cmd_data_get(ifp
, BRCMF_C_GET_CHANNEL
, &ci
, sizeof(ci
));
2024 *chanspec
= le32_to_cpu(ci
.hw_channel
) & WL_CHANSPEC_CHAN_MASK
;
2025 if (*chanspec
< CH_MAX_2G_CHANNEL
)
2026 *chanspec
|= WL_CHANSPEC_BAND_2G
;
2028 *chanspec
|= WL_CHANSPEC_BAND_5G
;
2030 *chanspec
|= WL_CHANSPEC_BW_20
| WL_CHANSPEC_CTL_SB_NONE
;
2034 * Change a P2P Role.
2036 * @mac: MAC address of the BSS to change a role
2037 * Returns 0 if success.
2039 int brcmf_p2p_ifchange(struct brcmf_cfg80211_info
*cfg
,
2040 enum brcmf_fil_p2p_if_types if_type
)
2042 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
2043 struct brcmf_cfg80211_vif
*vif
;
2044 struct brcmf_fil_p2p_if_le if_request
;
2048 brcmf_dbg(TRACE
, "Enter\n");
2050 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
;
2052 brcmf_err("vif for P2PAPI_BSSCFG_PRIMARY does not exist\n");
2055 brcmf_notify_escan_complete(cfg
, vif
->ifp
, true, true);
2056 vif
= p2p
->bss_idx
[P2PAPI_BSSCFG_CONNECTION
].vif
;
2058 brcmf_err("vif for P2PAPI_BSSCFG_CONNECTION does not exist\n");
2061 brcmf_set_mpc(vif
->ifp
, 0);
2063 /* In concurrency case, STA may be already associated in a particular */
2064 /* channel. so retrieve the current channel of primary interface and */
2065 /* then start the virtual interface on that. */
2066 brcmf_p2p_get_current_chanspec(p2p
, &chanspec
);
2068 if_request
.type
= cpu_to_le16((u16
)if_type
);
2069 if_request
.chspec
= cpu_to_le16(chanspec
);
2070 memcpy(if_request
.addr
, p2p
->int_addr
, sizeof(if_request
.addr
));
2072 brcmf_cfg80211_arm_vif_event(cfg
, vif
);
2073 err
= brcmf_fil_iovar_data_set(vif
->ifp
, "p2p_ifupd", &if_request
,
2074 sizeof(if_request
));
2076 brcmf_err("p2p_ifupd FAILED, err=%d\n", err
);
2077 brcmf_cfg80211_arm_vif_event(cfg
, NULL
);
2080 err
= brcmf_cfg80211_wait_vif_event_timeout(cfg
, BRCMF_E_IF_CHANGE
,
2081 msecs_to_jiffies(1500));
2082 brcmf_cfg80211_arm_vif_event(cfg
, NULL
);
2084 brcmf_err("No BRCMF_E_IF_CHANGE event received\n");
2088 err
= brcmf_fil_cmd_int_set(vif
->ifp
, BRCMF_C_SET_SCB_TIMEOUT
,
2089 BRCMF_SCB_TIMEOUT_VALUE
);
2094 static int brcmf_p2p_request_p2p_if(struct brcmf_p2p_info
*p2p
,
2095 struct brcmf_if
*ifp
, u8 ea
[ETH_ALEN
],
2096 enum brcmf_fil_p2p_if_types iftype
)
2098 struct brcmf_fil_p2p_if_le if_request
;
2102 /* we need a default channel */
2103 brcmf_p2p_get_current_chanspec(p2p
, &chanspec
);
2105 /* fill the firmware request */
2106 memcpy(if_request
.addr
, ea
, ETH_ALEN
);
2107 if_request
.type
= cpu_to_le16((u16
)iftype
);
2108 if_request
.chspec
= cpu_to_le16(chanspec
);
2110 err
= brcmf_fil_iovar_data_set(ifp
, "p2p_ifadd", &if_request
,
2111 sizeof(if_request
));
2118 static int brcmf_p2p_disable_p2p_if(struct brcmf_cfg80211_vif
*vif
)
2120 struct brcmf_cfg80211_info
*cfg
= wdev_to_cfg(&vif
->wdev
);
2121 struct net_device
*pri_ndev
= cfg_to_ndev(cfg
);
2122 struct brcmf_if
*ifp
= netdev_priv(pri_ndev
);
2123 u8
*addr
= vif
->wdev
.netdev
->dev_addr
;
2125 return brcmf_fil_iovar_data_set(ifp
, "p2p_ifdis", addr
, ETH_ALEN
);
2128 static int brcmf_p2p_release_p2p_if(struct brcmf_cfg80211_vif
*vif
)
2130 struct brcmf_cfg80211_info
*cfg
= wdev_to_cfg(&vif
->wdev
);
2131 struct net_device
*pri_ndev
= cfg_to_ndev(cfg
);
2132 struct brcmf_if
*ifp
= netdev_priv(pri_ndev
);
2133 u8
*addr
= vif
->wdev
.netdev
->dev_addr
;
2135 return brcmf_fil_iovar_data_set(ifp
, "p2p_ifdel", addr
, ETH_ALEN
);
2139 * brcmf_p2p_create_p2pdev() - create a P2P_DEVICE virtual interface.
2141 * @p2p: P2P specific data.
2142 * @wiphy: wiphy device of new interface.
2143 * @addr: mac address for this new interface.
2145 static struct wireless_dev
*brcmf_p2p_create_p2pdev(struct brcmf_p2p_info
*p2p
,
2146 struct wiphy
*wiphy
,
2149 struct brcmf_cfg80211_vif
*p2p_vif
;
2150 struct brcmf_if
*p2p_ifp
;
2151 struct brcmf_if
*pri_ifp
;
2155 if (p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
)
2156 return ERR_PTR(-ENOSPC
);
2158 p2p_vif
= brcmf_alloc_vif(p2p
->cfg
, NL80211_IFTYPE_P2P_DEVICE
,
2160 if (IS_ERR(p2p_vif
)) {
2161 brcmf_err("could not create discovery vif\n");
2162 return (struct wireless_dev
*)p2p_vif
;
2165 pri_ifp
= p2p
->bss_idx
[P2PAPI_BSSCFG_PRIMARY
].vif
->ifp
;
2166 brcmf_p2p_generate_bss_mac(p2p
, addr
);
2167 brcmf_p2p_set_firmware(pri_ifp
, p2p
->dev_addr
);
2169 brcmf_cfg80211_arm_vif_event(p2p
->cfg
, p2p_vif
);
2171 /* Initialize P2P Discovery in the firmware */
2172 err
= brcmf_fil_iovar_int_set(pri_ifp
, "p2p_disc", 1);
2174 brcmf_err("set p2p_disc error\n");
2175 brcmf_cfg80211_arm_vif_event(p2p
->cfg
, NULL
);
2179 /* wait for firmware event */
2180 err
= brcmf_cfg80211_wait_vif_event_timeout(p2p
->cfg
, BRCMF_E_IF_ADD
,
2181 msecs_to_jiffies(1500));
2182 brcmf_cfg80211_arm_vif_event(p2p
->cfg
, NULL
);
2184 brcmf_err("timeout occurred\n");
2189 /* discovery interface created */
2190 p2p_ifp
= p2p_vif
->ifp
;
2191 p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
= p2p_vif
;
2192 memcpy(p2p_ifp
->mac_addr
, p2p
->dev_addr
, ETH_ALEN
);
2193 memcpy(&p2p_vif
->wdev
.address
, p2p
->dev_addr
, sizeof(p2p
->dev_addr
));
2195 /* verify bsscfg index for P2P discovery */
2196 err
= brcmf_fil_iovar_int_get(pri_ifp
, "p2p_dev", &bssidx
);
2198 brcmf_err("retrieving discover bsscfg index failed\n");
2202 WARN_ON(p2p_ifp
->bssidx
!= bssidx
);
2204 init_completion(&p2p
->send_af_done
);
2205 INIT_WORK(&p2p
->afx_hdl
.afx_work
, brcmf_p2p_afx_handler
);
2206 init_completion(&p2p
->afx_hdl
.act_frm_scan
);
2207 init_completion(&p2p
->wait_next_af
);
2209 return &p2p_vif
->wdev
;
2212 brcmf_free_vif(p2p_vif
);
2213 return ERR_PTR(err
);
2217 * brcmf_p2p_delete_p2pdev() - delete P2P_DEVICE virtual interface.
2219 * @vif: virtual interface object to delete.
2221 static void brcmf_p2p_delete_p2pdev(struct brcmf_cfg80211_vif
*vif
)
2223 struct brcmf_p2p_info
*p2p
= &vif
->ifp
->drvr
->config
->p2p
;
2225 cfg80211_unregister_wdev(&vif
->wdev
);
2226 p2p
->bss_idx
[P2PAPI_BSSCFG_DEVICE
].vif
= NULL
;
2227 brcmf_free_vif(vif
);
2231 * brcmf_p2p_add_vif() - create a new P2P virtual interface.
2233 * @wiphy: wiphy device of new interface.
2234 * @name: name of the new interface.
2235 * @type: nl80211 interface type.
2237 * @params: contains mac address for P2P device.
2239 struct wireless_dev
*brcmf_p2p_add_vif(struct wiphy
*wiphy
, const char *name
,
2240 enum nl80211_iftype type
, u32
*flags
,
2241 struct vif_params
*params
)
2243 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
2244 struct brcmf_if
*ifp
= netdev_priv(cfg_to_ndev(cfg
));
2245 struct brcmf_cfg80211_vif
*vif
;
2246 enum brcmf_fil_p2p_if_types iftype
;
2250 if (brcmf_cfg80211_vif_event_armed(cfg
))
2251 return ERR_PTR(-EBUSY
);
2253 brcmf_dbg(INFO
, "adding vif \"%s\" (type=%d)\n", name
, type
);
2256 case NL80211_IFTYPE_P2P_CLIENT
:
2257 iftype
= BRCMF_FIL_P2P_IF_CLIENT
;
2260 case NL80211_IFTYPE_P2P_GO
:
2261 iftype
= BRCMF_FIL_P2P_IF_GO
;
2264 case NL80211_IFTYPE_P2P_DEVICE
:
2265 return brcmf_p2p_create_p2pdev(&cfg
->p2p
, wiphy
,
2268 return ERR_PTR(-EOPNOTSUPP
);
2271 vif
= brcmf_alloc_vif(cfg
, type
, false);
2273 return (struct wireless_dev
*)vif
;
2274 brcmf_cfg80211_arm_vif_event(cfg
, vif
);
2276 err
= brcmf_p2p_request_p2p_if(&cfg
->p2p
, ifp
, cfg
->p2p
.int_addr
,
2279 brcmf_cfg80211_arm_vif_event(cfg
, NULL
);
2283 /* wait for firmware event */
2284 err
= brcmf_cfg80211_wait_vif_event_timeout(cfg
, BRCMF_E_IF_ADD
,
2285 msecs_to_jiffies(1500));
2286 brcmf_cfg80211_arm_vif_event(cfg
, NULL
);
2288 brcmf_err("timeout occurred\n");
2293 /* interface created in firmware */
2296 brcmf_err("no if pointer provided\n");
2301 strncpy(ifp
->ndev
->name
, name
, sizeof(ifp
->ndev
->name
) - 1);
2302 err
= brcmf_net_attach(ifp
, true);
2304 brcmf_err("Registering netdevice failed\n");
2307 cfg
->p2p
.bss_idx
[P2PAPI_BSSCFG_CONNECTION
].vif
= vif
;
2308 /* Disable firmware roaming for P2P interface */
2309 brcmf_fil_iovar_int_set(ifp
, "roam_off", 1);
2310 if (iftype
== BRCMF_FIL_P2P_IF_GO
) {
2311 /* set station timeout for p2p */
2312 brcmf_fil_cmd_int_set(ifp
, BRCMF_C_SET_SCB_TIMEOUT
,
2313 BRCMF_SCB_TIMEOUT_VALUE
);
2315 return &ifp
->vif
->wdev
;
2318 brcmf_free_vif(vif
);
2319 return ERR_PTR(err
);
2323 * brcmf_p2p_del_vif() - delete a P2P virtual interface.
2325 * @wiphy: wiphy device of interface.
2326 * @wdev: wireless device of interface.
2328 * TODO: not yet supported.
2330 int brcmf_p2p_del_vif(struct wiphy
*wiphy
, struct wireless_dev
*wdev
)
2332 struct brcmf_cfg80211_info
*cfg
= wiphy_priv(wiphy
);
2333 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
2334 struct brcmf_cfg80211_vif
*vif
;
2335 unsigned long jiffie_timeout
= msecs_to_jiffies(1500);
2336 bool wait_for_disable
= false;
2339 brcmf_dbg(TRACE
, "delete P2P vif\n");
2340 vif
= container_of(wdev
, struct brcmf_cfg80211_vif
, wdev
);
2342 switch (vif
->wdev
.iftype
) {
2343 case NL80211_IFTYPE_P2P_CLIENT
:
2344 if (test_bit(BRCMF_VIF_STATUS_DISCONNECTING
, &vif
->sme_state
))
2345 wait_for_disable
= true;
2348 case NL80211_IFTYPE_P2P_GO
:
2349 if (!brcmf_p2p_disable_p2p_if(vif
))
2350 wait_for_disable
= true;
2353 case NL80211_IFTYPE_P2P_DEVICE
:
2354 brcmf_p2p_delete_p2pdev(vif
);
2361 clear_bit(BRCMF_P2P_STATUS_GO_NEG_PHASE
, &p2p
->status
);
2362 brcmf_dbg(INFO
, "P2P: GO_NEG_PHASE status cleared\n");
2364 if (wait_for_disable
)
2365 wait_for_completion_timeout(&cfg
->vif_disabled
,
2366 msecs_to_jiffies(500));
2368 brcmf_vif_clear_mgmt_ies(vif
);
2370 brcmf_cfg80211_arm_vif_event(cfg
, vif
);
2371 err
= brcmf_p2p_release_p2p_if(vif
);
2373 /* wait for firmware event */
2374 err
= brcmf_cfg80211_wait_vif_event_timeout(cfg
, BRCMF_E_IF_DEL
,
2381 brcmf_cfg80211_arm_vif_event(cfg
, NULL
);
2382 brcmf_free_vif(vif
);
2383 p2p
->bss_idx
[P2PAPI_BSSCFG_CONNECTION
].vif
= NULL
;
2388 int brcmf_p2p_start_device(struct wiphy
*wiphy
, struct wireless_dev
*wdev
)
2390 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
2391 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
2392 struct brcmf_cfg80211_vif
*vif
;
2395 vif
= container_of(wdev
, struct brcmf_cfg80211_vif
, wdev
);
2396 mutex_lock(&cfg
->usr_sync
);
2397 err
= brcmf_p2p_enable_discovery(p2p
);
2399 set_bit(BRCMF_VIF_STATUS_READY
, &vif
->sme_state
);
2400 mutex_unlock(&cfg
->usr_sync
);
2404 void brcmf_p2p_stop_device(struct wiphy
*wiphy
, struct wireless_dev
*wdev
)
2406 struct brcmf_cfg80211_info
*cfg
= wiphy_to_cfg(wiphy
);
2407 struct brcmf_p2p_info
*p2p
= &cfg
->p2p
;
2408 struct brcmf_cfg80211_vif
*vif
;
2410 vif
= container_of(wdev
, struct brcmf_cfg80211_vif
, wdev
);
2411 mutex_lock(&cfg
->usr_sync
);
2412 (void)brcmf_p2p_deinit_discovery(p2p
);
2413 brcmf_abort_scanning(cfg
);
2414 clear_bit(BRCMF_VIF_STATUS_READY
, &vif
->sme_state
);
2415 mutex_unlock(&cfg
->usr_sync
);