1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Broadcom Dongle Host Driver (DHD)
3*4882a593Smuzhiyun * Prefered Network Offload and Wi-Fi Location Service(WLS) code.
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (C) 2020, Broadcom.
6*4882a593Smuzhiyun *
7*4882a593Smuzhiyun * Unless you and Broadcom execute a separate written software license
8*4882a593Smuzhiyun * agreement governing use of this software, this software is licensed to you
9*4882a593Smuzhiyun * under the terms of the GNU General Public License version 2 (the "GPL"),
10*4882a593Smuzhiyun * available at http://www.broadcom.com/licenses/GPLv2.php, with the
11*4882a593Smuzhiyun * following added to such license:
12*4882a593Smuzhiyun *
13*4882a593Smuzhiyun * As a special exception, the copyright holders of this software give you
14*4882a593Smuzhiyun * permission to link this software with independent modules, and to copy and
15*4882a593Smuzhiyun * distribute the resulting executable under terms of your choice, provided that
16*4882a593Smuzhiyun * you also meet, for each linked independent module, the terms and conditions of
17*4882a593Smuzhiyun * the license of that module. An independent module is a module which is not
18*4882a593Smuzhiyun * derived from this software. The special exception does not apply to any
19*4882a593Smuzhiyun * modifications of the software.
20*4882a593Smuzhiyun *
21*4882a593Smuzhiyun *
22*4882a593Smuzhiyun * <<Broadcom-WL-IPTag/Dual:>>
23*4882a593Smuzhiyun */
24*4882a593Smuzhiyun
25*4882a593Smuzhiyun #if defined (GSCAN_SUPPORT) && !defined(PNO_SUPPORT)
26*4882a593Smuzhiyun #error "GSCAN needs PNO to be enabled!"
27*4882a593Smuzhiyun #endif
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun #ifdef PNO_SUPPORT
30*4882a593Smuzhiyun #include <typedefs.h>
31*4882a593Smuzhiyun #include <osl.h>
32*4882a593Smuzhiyun
33*4882a593Smuzhiyun #include <epivers.h>
34*4882a593Smuzhiyun #include <bcmutils.h>
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun #include <bcmendian.h>
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun #ifdef OEM_ANDROID
39*4882a593Smuzhiyun #include <linuxver.h>
40*4882a593Smuzhiyun #include <linux/init.h>
41*4882a593Smuzhiyun #include <linux/kernel.h>
42*4882a593Smuzhiyun #include <linux/list.h>
43*4882a593Smuzhiyun #include <linux/sort.h>
44*4882a593Smuzhiyun #endif
45*4882a593Smuzhiyun
46*4882a593Smuzhiyun #include <dngl_stats.h>
47*4882a593Smuzhiyun #include <wlioctl.h>
48*4882a593Smuzhiyun
49*4882a593Smuzhiyun #include <bcmevent.h>
50*4882a593Smuzhiyun #include <dhd.h>
51*4882a593Smuzhiyun #include <dhd_pno.h>
52*4882a593Smuzhiyun #include <dhd_dbg.h>
53*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
54*4882a593Smuzhiyun #include <linux/gcd.h>
55*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
56*4882a593Smuzhiyun #ifdef WL_CFG80211
57*4882a593Smuzhiyun #include <wl_cfg80211.h>
58*4882a593Smuzhiyun #endif /* WL_CFG80211 */
59*4882a593Smuzhiyun
60*4882a593Smuzhiyun #ifdef __BIG_ENDIAN
61*4882a593Smuzhiyun #include <bcmendian.h>
62*4882a593Smuzhiyun #define htod32(i) (bcmswap32(i))
63*4882a593Smuzhiyun #define htod16(i) (bcmswap16(i))
64*4882a593Smuzhiyun #define dtoh32(i) (bcmswap32(i))
65*4882a593Smuzhiyun #define dtoh16(i) (bcmswap16(i))
66*4882a593Smuzhiyun #define htodchanspec(i) htod16(i)
67*4882a593Smuzhiyun #define dtohchanspec(i) dtoh16(i)
68*4882a593Smuzhiyun #else
69*4882a593Smuzhiyun #define htod32(i) (i)
70*4882a593Smuzhiyun #define htod16(i) (i)
71*4882a593Smuzhiyun #define dtoh32(i) (i)
72*4882a593Smuzhiyun #define dtoh16(i) (i)
73*4882a593Smuzhiyun #define htodchanspec(i) (i)
74*4882a593Smuzhiyun #define dtohchanspec(i) (i)
75*4882a593Smuzhiyun #endif /* IL_BIGENDINA */
76*4882a593Smuzhiyun
77*4882a593Smuzhiyun #ifdef OEM_ANDROID
78*4882a593Smuzhiyun #define NULL_CHECK(p, s, err) \
79*4882a593Smuzhiyun do { \
80*4882a593Smuzhiyun if (!(p)) { \
81*4882a593Smuzhiyun printf("NULL POINTER (%s) : %s\n", __FUNCTION__, (s)); \
82*4882a593Smuzhiyun err = BCME_ERROR; \
83*4882a593Smuzhiyun return err; \
84*4882a593Smuzhiyun } \
85*4882a593Smuzhiyun } while (0)
86*4882a593Smuzhiyun #define PNO_GET_PNOSTATE(dhd) ((dhd_pno_status_info_t *)dhd->pno_state)
87*4882a593Smuzhiyun
88*4882a593Smuzhiyun #define PNO_BESTNET_LEN WLC_IOCTL_MEDLEN
89*4882a593Smuzhiyun
90*4882a593Smuzhiyun #define PNO_ON 1
91*4882a593Smuzhiyun #define PNO_OFF 0
92*4882a593Smuzhiyun #define CHANNEL_2G_MIN 1
93*4882a593Smuzhiyun #define CHANNEL_2G_MAX 14
94*4882a593Smuzhiyun #define CHANNEL_5G_MIN 34
95*4882a593Smuzhiyun #define CHANNEL_5G_MAX 165
96*4882a593Smuzhiyun #define IS_2G_CHANNEL(ch) ((ch >= CHANNEL_2G_MIN) && \
97*4882a593Smuzhiyun (ch <= CHANNEL_2G_MAX))
98*4882a593Smuzhiyun #define IS_5G_CHANNEL(ch) ((ch >= CHANNEL_5G_MIN) && \
99*4882a593Smuzhiyun (ch <= CHANNEL_5G_MAX))
100*4882a593Smuzhiyun #define MAX_NODE_CNT 5
101*4882a593Smuzhiyun #define WLS_SUPPORTED(pno_state) (pno_state->wls_supported == TRUE)
102*4882a593Smuzhiyun #define TIME_DIFF(timestamp1, timestamp2) (abs((uint32)(timestamp1/1000) \
103*4882a593Smuzhiyun - (uint32)(timestamp2/1000)))
104*4882a593Smuzhiyun #define TIME_DIFF_MS(timestamp1, timestamp2) (abs((uint32)(timestamp1) \
105*4882a593Smuzhiyun - (uint32)(timestamp2)))
106*4882a593Smuzhiyun #define TIMESPEC_TO_US(ts) (((uint64)(ts).tv_sec * USEC_PER_SEC) + \
107*4882a593Smuzhiyun (ts).tv_nsec / NSEC_PER_USEC)
108*4882a593Smuzhiyun
109*4882a593Smuzhiyun #define ENTRY_OVERHEAD strlen("bssid=\nssid=\nfreq=\nlevel=\nage=\ndist=\ndistSd=\n====")
110*4882a593Smuzhiyun #define TIME_MIN_DIFF 5
111*4882a593Smuzhiyun
112*4882a593Smuzhiyun #define EVENT_DATABUF_MAXLEN (512 - sizeof(bcm_event_t))
113*4882a593Smuzhiyun #define EVENT_MAX_NETCNT_V1 \
114*4882a593Smuzhiyun ((EVENT_DATABUF_MAXLEN - sizeof(wl_pfn_scanresults_v1_t)) \
115*4882a593Smuzhiyun / sizeof(wl_pfn_net_info_v1_t) + 1)
116*4882a593Smuzhiyun #define EVENT_MAX_NETCNT_V2 \
117*4882a593Smuzhiyun ((EVENT_DATABUF_MAXLEN - sizeof(wl_pfn_scanresults_v2_t)) \
118*4882a593Smuzhiyun / sizeof(wl_pfn_net_info_v2_t) + 1)
119*4882a593Smuzhiyun #define EVENT_MAX_NETCNT_V3 \
120*4882a593Smuzhiyun ((EVENT_DATABUF_MAXLEN - sizeof(wl_pfn_scanresults_v3_t)) \
121*4882a593Smuzhiyun / sizeof(wl_pfn_net_info_v3_t) + 1)
122*4882a593Smuzhiyun
123*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
124*4882a593Smuzhiyun static int _dhd_pno_flush_ssid(dhd_pub_t *dhd);
125*4882a593Smuzhiyun static wl_pfn_gscan_ch_bucket_cfg_t *
126*4882a593Smuzhiyun dhd_pno_gscan_create_channel_list(dhd_pub_t *dhd, dhd_pno_status_info_t *pno_state,
127*4882a593Smuzhiyun uint16 *chan_list, uint32 *num_buckets, uint32 *num_buckets_to_fw);
128*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
129*4882a593Smuzhiyun
130*4882a593Smuzhiyun static int dhd_pno_set_legacy_pno(dhd_pub_t *dhd, uint16 scan_fr, int pno_repeat,
131*4882a593Smuzhiyun int pno_freq_expo_max, uint16 *channel_list, int nchan);
132*4882a593Smuzhiyun
133*4882a593Smuzhiyun static inline bool
is_dfs(dhd_pub_t * dhd,uint16 channel)134*4882a593Smuzhiyun is_dfs(dhd_pub_t *dhd, uint16 channel)
135*4882a593Smuzhiyun {
136*4882a593Smuzhiyun u32 ch;
137*4882a593Smuzhiyun s32 err;
138*4882a593Smuzhiyun u8 buf[32];
139*4882a593Smuzhiyun
140*4882a593Smuzhiyun ch = wl_ch_host_to_driver(channel);
141*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "per_chan_info", (char *)&ch,
142*4882a593Smuzhiyun sizeof(u32), buf, sizeof(buf), FALSE);
143*4882a593Smuzhiyun if (unlikely(err)) {
144*4882a593Smuzhiyun DHD_ERROR(("get per chan info failed:%d\n", err));
145*4882a593Smuzhiyun return FALSE;
146*4882a593Smuzhiyun }
147*4882a593Smuzhiyun /* Check the channel flags returned by fw */
148*4882a593Smuzhiyun if (*((u32 *)buf) & WL_CHAN_PASSIVE) {
149*4882a593Smuzhiyun return TRUE;
150*4882a593Smuzhiyun }
151*4882a593Smuzhiyun return FALSE;
152*4882a593Smuzhiyun }
153*4882a593Smuzhiyun
154*4882a593Smuzhiyun int
dhd_pno_clean(dhd_pub_t * dhd)155*4882a593Smuzhiyun dhd_pno_clean(dhd_pub_t *dhd)
156*4882a593Smuzhiyun {
157*4882a593Smuzhiyun int pfn = 0;
158*4882a593Smuzhiyun int err;
159*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
160*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
161*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
162*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
163*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
164*4882a593Smuzhiyun /* Disable PNO */
165*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfn", (char *)&pfn, sizeof(pfn), NULL, 0, TRUE);
166*4882a593Smuzhiyun if (err < 0) {
167*4882a593Smuzhiyun DHD_ERROR(("%s : failed to execute pfn(error : %d)\n",
168*4882a593Smuzhiyun __FUNCTION__, err));
169*4882a593Smuzhiyun goto exit;
170*4882a593Smuzhiyun }
171*4882a593Smuzhiyun _pno_state->pno_status = DHD_PNO_DISABLED;
172*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfnclear", NULL, 0, NULL, 0, TRUE);
173*4882a593Smuzhiyun if (err < 0) {
174*4882a593Smuzhiyun DHD_ERROR(("%s : failed to execute pfnclear(error : %d)\n",
175*4882a593Smuzhiyun __FUNCTION__, err));
176*4882a593Smuzhiyun }
177*4882a593Smuzhiyun exit:
178*4882a593Smuzhiyun return err;
179*4882a593Smuzhiyun }
180*4882a593Smuzhiyun
181*4882a593Smuzhiyun bool
dhd_is_pno_supported(dhd_pub_t * dhd)182*4882a593Smuzhiyun dhd_is_pno_supported(dhd_pub_t *dhd)
183*4882a593Smuzhiyun {
184*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
185*4882a593Smuzhiyun
186*4882a593Smuzhiyun if (!dhd || !dhd->pno_state) {
187*4882a593Smuzhiyun DHD_ERROR(("NULL POINTER : %s\n",
188*4882a593Smuzhiyun __FUNCTION__));
189*4882a593Smuzhiyun return FALSE;
190*4882a593Smuzhiyun }
191*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
192*4882a593Smuzhiyun return WLS_SUPPORTED(_pno_state);
193*4882a593Smuzhiyun }
194*4882a593Smuzhiyun
195*4882a593Smuzhiyun bool
dhd_is_legacy_pno_enabled(dhd_pub_t * dhd)196*4882a593Smuzhiyun dhd_is_legacy_pno_enabled(dhd_pub_t *dhd)
197*4882a593Smuzhiyun {
198*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
199*4882a593Smuzhiyun
200*4882a593Smuzhiyun if (!dhd || !dhd->pno_state) {
201*4882a593Smuzhiyun DHD_ERROR(("NULL POINTER : %s\n",
202*4882a593Smuzhiyun __FUNCTION__));
203*4882a593Smuzhiyun return FALSE;
204*4882a593Smuzhiyun }
205*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
206*4882a593Smuzhiyun return ((_pno_state->pno_mode & DHD_PNO_LEGACY_MODE) != 0);
207*4882a593Smuzhiyun }
208*4882a593Smuzhiyun
209*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
210*4882a593Smuzhiyun static uint64
convert_fw_rel_time_to_systime(struct osl_timespec * ts,uint32 fw_ts_ms)211*4882a593Smuzhiyun convert_fw_rel_time_to_systime(struct osl_timespec *ts, uint32 fw_ts_ms)
212*4882a593Smuzhiyun {
213*4882a593Smuzhiyun return ((uint64)(TIMESPEC_TO_US(*ts)) - (uint64)(fw_ts_ms * 1000));
214*4882a593Smuzhiyun }
215*4882a593Smuzhiyun
216*4882a593Smuzhiyun static void
dhd_pno_idx_to_ssid(struct dhd_pno_gscan_params * gscan_params,dhd_epno_results_t * res,uint32 idx)217*4882a593Smuzhiyun dhd_pno_idx_to_ssid(struct dhd_pno_gscan_params *gscan_params,
218*4882a593Smuzhiyun dhd_epno_results_t *res, uint32 idx)
219*4882a593Smuzhiyun {
220*4882a593Smuzhiyun dhd_pno_ssid_t *iter, *next;
221*4882a593Smuzhiyun int i;
222*4882a593Smuzhiyun
223*4882a593Smuzhiyun /* If idx doesn't make sense */
224*4882a593Smuzhiyun if (idx >= gscan_params->epno_cfg.num_epno_ssid) {
225*4882a593Smuzhiyun DHD_ERROR(("No match, idx %d num_ssid %d\n", idx,
226*4882a593Smuzhiyun gscan_params->epno_cfg.num_epno_ssid));
227*4882a593Smuzhiyun goto exit;
228*4882a593Smuzhiyun }
229*4882a593Smuzhiyun
230*4882a593Smuzhiyun if (gscan_params->epno_cfg.num_epno_ssid > 0) {
231*4882a593Smuzhiyun i = 0;
232*4882a593Smuzhiyun
233*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
234*4882a593Smuzhiyun list_for_each_entry_safe(iter, next,
235*4882a593Smuzhiyun &gscan_params->epno_cfg.epno_ssid_list, list) {
236*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
237*4882a593Smuzhiyun if (i++ == idx) {
238*4882a593Smuzhiyun memcpy(res->ssid, iter->SSID, iter->SSID_len);
239*4882a593Smuzhiyun res->ssid_len = iter->SSID_len;
240*4882a593Smuzhiyun return;
241*4882a593Smuzhiyun }
242*4882a593Smuzhiyun }
243*4882a593Smuzhiyun }
244*4882a593Smuzhiyun exit:
245*4882a593Smuzhiyun /* If we are here then there was no match */
246*4882a593Smuzhiyun res->ssid[0] = '\0';
247*4882a593Smuzhiyun res->ssid_len = 0;
248*4882a593Smuzhiyun return;
249*4882a593Smuzhiyun }
250*4882a593Smuzhiyun
251*4882a593Smuzhiyun /* Translate HAL flag bitmask to BRCM FW flag bitmask */
252*4882a593Smuzhiyun void
dhd_pno_translate_epno_fw_flags(uint32 * flags)253*4882a593Smuzhiyun dhd_pno_translate_epno_fw_flags(uint32 *flags)
254*4882a593Smuzhiyun {
255*4882a593Smuzhiyun uint32 in_flags, fw_flags = 0;
256*4882a593Smuzhiyun in_flags = *flags;
257*4882a593Smuzhiyun
258*4882a593Smuzhiyun if (in_flags & DHD_EPNO_A_BAND_TRIG) {
259*4882a593Smuzhiyun fw_flags |= WL_PFN_SSID_A_BAND_TRIG;
260*4882a593Smuzhiyun }
261*4882a593Smuzhiyun
262*4882a593Smuzhiyun if (in_flags & DHD_EPNO_BG_BAND_TRIG) {
263*4882a593Smuzhiyun fw_flags |= WL_PFN_SSID_BG_BAND_TRIG;
264*4882a593Smuzhiyun }
265*4882a593Smuzhiyun
266*4882a593Smuzhiyun if (!(in_flags & DHD_EPNO_STRICT_MATCH) &&
267*4882a593Smuzhiyun !(in_flags & DHD_EPNO_HIDDEN_SSID)) {
268*4882a593Smuzhiyun fw_flags |= WL_PFN_SSID_IMPRECISE_MATCH;
269*4882a593Smuzhiyun }
270*4882a593Smuzhiyun
271*4882a593Smuzhiyun if (in_flags & DHD_EPNO_SAME_NETWORK) {
272*4882a593Smuzhiyun fw_flags |= WL_PFN_SSID_SAME_NETWORK;
273*4882a593Smuzhiyun }
274*4882a593Smuzhiyun
275*4882a593Smuzhiyun /* Add any hard coded flags needed */
276*4882a593Smuzhiyun fw_flags |= WL_PFN_SUPPRESS_AGING_MASK;
277*4882a593Smuzhiyun *flags = fw_flags;
278*4882a593Smuzhiyun
279*4882a593Smuzhiyun return;
280*4882a593Smuzhiyun }
281*4882a593Smuzhiyun
282*4882a593Smuzhiyun /* Translate HAL auth bitmask to BRCM FW bitmask */
283*4882a593Smuzhiyun void
dhd_pno_set_epno_auth_flag(uint32 * wpa_auth)284*4882a593Smuzhiyun dhd_pno_set_epno_auth_flag(uint32 *wpa_auth)
285*4882a593Smuzhiyun {
286*4882a593Smuzhiyun switch (*wpa_auth) {
287*4882a593Smuzhiyun case DHD_PNO_AUTH_CODE_OPEN:
288*4882a593Smuzhiyun *wpa_auth = WPA_AUTH_DISABLED;
289*4882a593Smuzhiyun break;
290*4882a593Smuzhiyun case DHD_PNO_AUTH_CODE_PSK:
291*4882a593Smuzhiyun *wpa_auth = (WPA_AUTH_PSK | WPA2_AUTH_PSK);
292*4882a593Smuzhiyun break;
293*4882a593Smuzhiyun case DHD_PNO_AUTH_CODE_EAPOL:
294*4882a593Smuzhiyun *wpa_auth = ~WPA_AUTH_NONE;
295*4882a593Smuzhiyun break;
296*4882a593Smuzhiyun default:
297*4882a593Smuzhiyun DHD_ERROR(("%s: Unknown auth %d", __FUNCTION__, *wpa_auth));
298*4882a593Smuzhiyun *wpa_auth = WPA_AUTH_PFN_ANY;
299*4882a593Smuzhiyun break;
300*4882a593Smuzhiyun }
301*4882a593Smuzhiyun return;
302*4882a593Smuzhiyun }
303*4882a593Smuzhiyun
304*4882a593Smuzhiyun /* Cleanup all results */
305*4882a593Smuzhiyun static void
dhd_gscan_clear_all_batch_results(dhd_pub_t * dhd)306*4882a593Smuzhiyun dhd_gscan_clear_all_batch_results(dhd_pub_t *dhd)
307*4882a593Smuzhiyun {
308*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
309*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
310*4882a593Smuzhiyun gscan_results_cache_t *iter;
311*4882a593Smuzhiyun
312*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
313*4882a593Smuzhiyun gscan_params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS].params_gscan;
314*4882a593Smuzhiyun iter = gscan_params->gscan_batch_cache;
315*4882a593Smuzhiyun /* Mark everything as consumed */
316*4882a593Smuzhiyun while (iter) {
317*4882a593Smuzhiyun iter->tot_consumed = iter->tot_count;
318*4882a593Smuzhiyun iter = iter->next;
319*4882a593Smuzhiyun }
320*4882a593Smuzhiyun dhd_gscan_batch_cache_cleanup(dhd);
321*4882a593Smuzhiyun return;
322*4882a593Smuzhiyun }
323*4882a593Smuzhiyun
324*4882a593Smuzhiyun static int
_dhd_pno_gscan_cfg(dhd_pub_t * dhd,wl_pfn_gscan_cfg_t * pfncfg_gscan_param,int size)325*4882a593Smuzhiyun _dhd_pno_gscan_cfg(dhd_pub_t *dhd, wl_pfn_gscan_cfg_t *pfncfg_gscan_param, int size)
326*4882a593Smuzhiyun {
327*4882a593Smuzhiyun int err = BCME_OK;
328*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
329*4882a593Smuzhiyun
330*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
331*4882a593Smuzhiyun
332*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfn_gscan_cfg", (char *)pfncfg_gscan_param, size, NULL, 0, TRUE);
333*4882a593Smuzhiyun if (err < 0) {
334*4882a593Smuzhiyun DHD_ERROR(("%s : failed to execute pfncfg_gscan_param\n", __FUNCTION__));
335*4882a593Smuzhiyun goto exit;
336*4882a593Smuzhiyun }
337*4882a593Smuzhiyun exit:
338*4882a593Smuzhiyun return err;
339*4882a593Smuzhiyun }
340*4882a593Smuzhiyun
341*4882a593Smuzhiyun static int
_dhd_pno_flush_ssid(dhd_pub_t * dhd)342*4882a593Smuzhiyun _dhd_pno_flush_ssid(dhd_pub_t *dhd)
343*4882a593Smuzhiyun {
344*4882a593Smuzhiyun int err;
345*4882a593Smuzhiyun wl_pfn_t pfn_elem;
346*4882a593Smuzhiyun memset(&pfn_elem, 0, sizeof(wl_pfn_t));
347*4882a593Smuzhiyun pfn_elem.flags = htod32(WL_PFN_FLUSH_ALL_SSIDS);
348*4882a593Smuzhiyun
349*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfn_add", (char *)&pfn_elem, sizeof(wl_pfn_t), NULL, 0, TRUE);
350*4882a593Smuzhiyun if (err < 0) {
351*4882a593Smuzhiyun DHD_ERROR(("%s : failed to execute pfn_add\n", __FUNCTION__));
352*4882a593Smuzhiyun }
353*4882a593Smuzhiyun return err;
354*4882a593Smuzhiyun }
355*4882a593Smuzhiyun
356*4882a593Smuzhiyun static bool
is_batch_retrieval_complete(struct dhd_pno_gscan_params * gscan_params)357*4882a593Smuzhiyun is_batch_retrieval_complete(struct dhd_pno_gscan_params *gscan_params)
358*4882a593Smuzhiyun {
359*4882a593Smuzhiyun smp_rmb();
360*4882a593Smuzhiyun return (gscan_params->get_batch_flag == GSCAN_BATCH_RETRIEVAL_COMPLETE);
361*4882a593Smuzhiyun }
362*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
363*4882a593Smuzhiyun
364*4882a593Smuzhiyun static int
_dhd_pno_suspend(dhd_pub_t * dhd)365*4882a593Smuzhiyun _dhd_pno_suspend(dhd_pub_t *dhd)
366*4882a593Smuzhiyun {
367*4882a593Smuzhiyun int err;
368*4882a593Smuzhiyun int suspend = 1;
369*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
370*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
371*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
372*4882a593Smuzhiyun
373*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
374*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
375*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfn_suspend", (char *)&suspend, sizeof(suspend), NULL, 0, TRUE);
376*4882a593Smuzhiyun if (err < 0) {
377*4882a593Smuzhiyun DHD_ERROR(("%s : failed to suspend pfn(error :%d)\n", __FUNCTION__, err));
378*4882a593Smuzhiyun goto exit;
379*4882a593Smuzhiyun
380*4882a593Smuzhiyun }
381*4882a593Smuzhiyun _pno_state->pno_status = DHD_PNO_SUSPEND;
382*4882a593Smuzhiyun exit:
383*4882a593Smuzhiyun return err;
384*4882a593Smuzhiyun }
385*4882a593Smuzhiyun static int
_dhd_pno_enable(dhd_pub_t * dhd,int enable)386*4882a593Smuzhiyun _dhd_pno_enable(dhd_pub_t *dhd, int enable)
387*4882a593Smuzhiyun {
388*4882a593Smuzhiyun int err = BCME_OK;
389*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
390*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
391*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
392*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
393*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
394*4882a593Smuzhiyun
395*4882a593Smuzhiyun if (enable & 0xfffe) {
396*4882a593Smuzhiyun DHD_ERROR(("%s invalid value\n", __FUNCTION__));
397*4882a593Smuzhiyun err = BCME_BADARG;
398*4882a593Smuzhiyun goto exit;
399*4882a593Smuzhiyun }
400*4882a593Smuzhiyun if (!dhd_support_sta_mode(dhd)) {
401*4882a593Smuzhiyun DHD_ERROR(("PNO is not allowed for non-STA mode"));
402*4882a593Smuzhiyun err = BCME_BADOPTION;
403*4882a593Smuzhiyun goto exit;
404*4882a593Smuzhiyun }
405*4882a593Smuzhiyun if (enable) {
406*4882a593Smuzhiyun if ((_pno_state->pno_mode & DHD_PNO_LEGACY_MODE) &&
407*4882a593Smuzhiyun dhd_is_associated(dhd, 0, NULL)) {
408*4882a593Smuzhiyun DHD_ERROR(("%s Legacy PNO mode cannot be enabled "
409*4882a593Smuzhiyun "in assoc mode , ignore it\n", __FUNCTION__));
410*4882a593Smuzhiyun err = BCME_BADOPTION;
411*4882a593Smuzhiyun goto exit;
412*4882a593Smuzhiyun }
413*4882a593Smuzhiyun }
414*4882a593Smuzhiyun /* Enable/Disable PNO */
415*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfn", (char *)&enable, sizeof(enable), NULL, 0, TRUE);
416*4882a593Smuzhiyun if (err < 0) {
417*4882a593Smuzhiyun DHD_ERROR(("%s : failed to execute pfn_set - %d\n", __FUNCTION__, err));
418*4882a593Smuzhiyun goto exit;
419*4882a593Smuzhiyun }
420*4882a593Smuzhiyun _pno_state->pno_status = (enable)?
421*4882a593Smuzhiyun DHD_PNO_ENABLED : DHD_PNO_DISABLED;
422*4882a593Smuzhiyun if (!enable)
423*4882a593Smuzhiyun _pno_state->pno_mode = DHD_PNO_NONE_MODE;
424*4882a593Smuzhiyun
425*4882a593Smuzhiyun DHD_PNO(("%s set pno as %s\n",
426*4882a593Smuzhiyun __FUNCTION__, enable ? "Enable" : "Disable"));
427*4882a593Smuzhiyun exit:
428*4882a593Smuzhiyun return err;
429*4882a593Smuzhiyun }
430*4882a593Smuzhiyun
431*4882a593Smuzhiyun static int
_dhd_pno_set(dhd_pub_t * dhd,const dhd_pno_params_t * pno_params,dhd_pno_mode_t mode)432*4882a593Smuzhiyun _dhd_pno_set(dhd_pub_t *dhd, const dhd_pno_params_t *pno_params, dhd_pno_mode_t mode)
433*4882a593Smuzhiyun {
434*4882a593Smuzhiyun int err = BCME_OK;
435*4882a593Smuzhiyun wl_pfn_param_t pfn_param;
436*4882a593Smuzhiyun dhd_pno_params_t *_params;
437*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
438*4882a593Smuzhiyun bool combined_scan = FALSE;
439*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
440*4882a593Smuzhiyun
441*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
442*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
443*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
444*4882a593Smuzhiyun
445*4882a593Smuzhiyun memset(&pfn_param, 0, sizeof(pfn_param));
446*4882a593Smuzhiyun
447*4882a593Smuzhiyun /* set pfn parameters */
448*4882a593Smuzhiyun pfn_param.version = htod32(PFN_VERSION);
449*4882a593Smuzhiyun pfn_param.flags = ((PFN_LIST_ORDER << SORT_CRITERIA_BIT) |
450*4882a593Smuzhiyun (ENABLE << IMMEDIATE_SCAN_BIT) | (ENABLE << REPORT_SEPERATELY_BIT));
451*4882a593Smuzhiyun if (mode == DHD_PNO_LEGACY_MODE) {
452*4882a593Smuzhiyun /* check and set extra pno params */
453*4882a593Smuzhiyun if ((pno_params->params_legacy.pno_repeat != 0) ||
454*4882a593Smuzhiyun (pno_params->params_legacy.pno_freq_expo_max != 0)) {
455*4882a593Smuzhiyun pfn_param.flags |= htod16(ENABLE << ENABLE_ADAPTSCAN_BIT);
456*4882a593Smuzhiyun pfn_param.repeat = (uchar) (pno_params->params_legacy.pno_repeat);
457*4882a593Smuzhiyun pfn_param.exp = (uchar) (pno_params->params_legacy.pno_freq_expo_max);
458*4882a593Smuzhiyun }
459*4882a593Smuzhiyun /* set up pno scan fr */
460*4882a593Smuzhiyun if (pno_params->params_legacy.scan_fr != 0)
461*4882a593Smuzhiyun pfn_param.scan_freq = htod32(pno_params->params_legacy.scan_fr);
462*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_BATCH_MODE) {
463*4882a593Smuzhiyun DHD_PNO(("will enable combined scan with BATCHIG SCAN MODE\n"));
464*4882a593Smuzhiyun mode |= DHD_PNO_BATCH_MODE;
465*4882a593Smuzhiyun combined_scan = TRUE;
466*4882a593Smuzhiyun } else if (_pno_state->pno_mode & DHD_PNO_HOTLIST_MODE) {
467*4882a593Smuzhiyun DHD_PNO(("will enable combined scan with HOTLIST SCAN MODE\n"));
468*4882a593Smuzhiyun mode |= DHD_PNO_HOTLIST_MODE;
469*4882a593Smuzhiyun combined_scan = TRUE;
470*4882a593Smuzhiyun }
471*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
472*4882a593Smuzhiyun else if (_pno_state->pno_mode & DHD_PNO_GSCAN_MODE) {
473*4882a593Smuzhiyun DHD_PNO(("will enable combined scan with GSCAN SCAN MODE\n"));
474*4882a593Smuzhiyun mode |= DHD_PNO_GSCAN_MODE;
475*4882a593Smuzhiyun }
476*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
477*4882a593Smuzhiyun }
478*4882a593Smuzhiyun if (mode & (DHD_PNO_BATCH_MODE | DHD_PNO_HOTLIST_MODE)) {
479*4882a593Smuzhiyun /* Scan frequency of 30 sec */
480*4882a593Smuzhiyun pfn_param.scan_freq = htod32(30);
481*4882a593Smuzhiyun /* slow adapt scan is off by default */
482*4882a593Smuzhiyun pfn_param.slow_freq = htod32(0);
483*4882a593Smuzhiyun /* RSSI margin of 30 dBm */
484*4882a593Smuzhiyun pfn_param.rssi_margin = htod16(PNO_RSSI_MARGIN_DBM);
485*4882a593Smuzhiyun /* Network timeout 60 sec */
486*4882a593Smuzhiyun pfn_param.lost_network_timeout = htod32(60);
487*4882a593Smuzhiyun /* best n = 2 by default */
488*4882a593Smuzhiyun pfn_param.bestn = DEFAULT_BESTN;
489*4882a593Smuzhiyun /* mscan m=0 by default, so not record best networks by default */
490*4882a593Smuzhiyun pfn_param.mscan = DEFAULT_MSCAN;
491*4882a593Smuzhiyun /* default repeat = 10 */
492*4882a593Smuzhiyun pfn_param.repeat = DEFAULT_REPEAT;
493*4882a593Smuzhiyun /* by default, maximum scan interval = 2^2
494*4882a593Smuzhiyun * scan_freq when adaptive scan is turned on
495*4882a593Smuzhiyun */
496*4882a593Smuzhiyun pfn_param.exp = DEFAULT_EXP;
497*4882a593Smuzhiyun if (mode == DHD_PNO_BATCH_MODE) {
498*4882a593Smuzhiyun /* In case of BATCH SCAN */
499*4882a593Smuzhiyun if (pno_params->params_batch.bestn)
500*4882a593Smuzhiyun pfn_param.bestn = pno_params->params_batch.bestn;
501*4882a593Smuzhiyun if (pno_params->params_batch.scan_fr)
502*4882a593Smuzhiyun pfn_param.scan_freq = htod32(pno_params->params_batch.scan_fr);
503*4882a593Smuzhiyun if (pno_params->params_batch.mscan)
504*4882a593Smuzhiyun pfn_param.mscan = pno_params->params_batch.mscan;
505*4882a593Smuzhiyun /* enable broadcast scan */
506*4882a593Smuzhiyun pfn_param.flags |= (ENABLE << ENABLE_BD_SCAN_BIT);
507*4882a593Smuzhiyun } else if (mode == DHD_PNO_HOTLIST_MODE) {
508*4882a593Smuzhiyun /* In case of HOTLIST SCAN */
509*4882a593Smuzhiyun if (pno_params->params_hotlist.scan_fr)
510*4882a593Smuzhiyun pfn_param.scan_freq = htod32(pno_params->params_hotlist.scan_fr);
511*4882a593Smuzhiyun pfn_param.bestn = 0;
512*4882a593Smuzhiyun pfn_param.repeat = 0;
513*4882a593Smuzhiyun /* enable broadcast scan */
514*4882a593Smuzhiyun pfn_param.flags |= (ENABLE << ENABLE_BD_SCAN_BIT);
515*4882a593Smuzhiyun }
516*4882a593Smuzhiyun if (combined_scan) {
517*4882a593Smuzhiyun /* Disable Adaptive Scan */
518*4882a593Smuzhiyun pfn_param.flags &= ~(htod16(ENABLE << ENABLE_ADAPTSCAN_BIT));
519*4882a593Smuzhiyun pfn_param.flags |= (ENABLE << ENABLE_BD_SCAN_BIT);
520*4882a593Smuzhiyun pfn_param.repeat = 0;
521*4882a593Smuzhiyun pfn_param.exp = 0;
522*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_BATCH_MODE) {
523*4882a593Smuzhiyun /* In case of Legacy PNO + BATCH SCAN */
524*4882a593Smuzhiyun _params = &(_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS]);
525*4882a593Smuzhiyun if (_params->params_batch.bestn)
526*4882a593Smuzhiyun pfn_param.bestn = _params->params_batch.bestn;
527*4882a593Smuzhiyun if (_params->params_batch.scan_fr)
528*4882a593Smuzhiyun pfn_param.scan_freq = htod32(_params->params_batch.scan_fr);
529*4882a593Smuzhiyun if (_params->params_batch.mscan)
530*4882a593Smuzhiyun pfn_param.mscan = _params->params_batch.mscan;
531*4882a593Smuzhiyun } else if (_pno_state->pno_mode & DHD_PNO_HOTLIST_MODE) {
532*4882a593Smuzhiyun /* In case of Legacy PNO + HOTLIST SCAN */
533*4882a593Smuzhiyun _params = &(_pno_state->pno_params_arr[INDEX_OF_HOTLIST_PARAMS]);
534*4882a593Smuzhiyun if (_params->params_hotlist.scan_fr)
535*4882a593Smuzhiyun pfn_param.scan_freq = htod32(_params->params_hotlist.scan_fr);
536*4882a593Smuzhiyun pfn_param.bestn = 0;
537*4882a593Smuzhiyun pfn_param.repeat = 0;
538*4882a593Smuzhiyun }
539*4882a593Smuzhiyun }
540*4882a593Smuzhiyun }
541*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
542*4882a593Smuzhiyun if (mode & DHD_PNO_GSCAN_MODE) {
543*4882a593Smuzhiyun uint32 lost_network_timeout;
544*4882a593Smuzhiyun
545*4882a593Smuzhiyun pfn_param.scan_freq = htod32(pno_params->params_gscan.scan_fr);
546*4882a593Smuzhiyun if (pno_params->params_gscan.mscan) {
547*4882a593Smuzhiyun pfn_param.bestn = pno_params->params_gscan.bestn;
548*4882a593Smuzhiyun pfn_param.mscan = pno_params->params_gscan.mscan;
549*4882a593Smuzhiyun pfn_param.flags |= (ENABLE << ENABLE_BD_SCAN_BIT);
550*4882a593Smuzhiyun }
551*4882a593Smuzhiyun /* RSSI margin of 30 dBm */
552*4882a593Smuzhiyun pfn_param.rssi_margin = htod16(PNO_RSSI_MARGIN_DBM);
553*4882a593Smuzhiyun pfn_param.repeat = 0;
554*4882a593Smuzhiyun pfn_param.exp = 0;
555*4882a593Smuzhiyun pfn_param.slow_freq = 0;
556*4882a593Smuzhiyun pfn_param.flags |= htod16(ENABLE << ENABLE_ADAPTSCAN_BIT);
557*4882a593Smuzhiyun
558*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_LEGACY_MODE) {
559*4882a593Smuzhiyun dhd_pno_params_t *params;
560*4882a593Smuzhiyun
561*4882a593Smuzhiyun params = &(_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS]);
562*4882a593Smuzhiyun
563*4882a593Smuzhiyun pfn_param.scan_freq = gcd(pno_params->params_gscan.scan_fr,
564*4882a593Smuzhiyun params->params_legacy.scan_fr);
565*4882a593Smuzhiyun
566*4882a593Smuzhiyun if ((params->params_legacy.pno_repeat != 0) ||
567*4882a593Smuzhiyun (params->params_legacy.pno_freq_expo_max != 0)) {
568*4882a593Smuzhiyun pfn_param.repeat = (uchar) (params->params_legacy.pno_repeat);
569*4882a593Smuzhiyun pfn_param.exp = (uchar) (params->params_legacy.pno_freq_expo_max);
570*4882a593Smuzhiyun }
571*4882a593Smuzhiyun }
572*4882a593Smuzhiyun
573*4882a593Smuzhiyun lost_network_timeout = (pno_params->params_gscan.max_ch_bucket_freq *
574*4882a593Smuzhiyun pfn_param.scan_freq *
575*4882a593Smuzhiyun pno_params->params_gscan.lost_ap_window);
576*4882a593Smuzhiyun if (lost_network_timeout) {
577*4882a593Smuzhiyun pfn_param.lost_network_timeout = htod32(MIN(lost_network_timeout,
578*4882a593Smuzhiyun GSCAN_MIN_BSSID_TIMEOUT));
579*4882a593Smuzhiyun } else {
580*4882a593Smuzhiyun pfn_param.lost_network_timeout = htod32(GSCAN_MIN_BSSID_TIMEOUT);
581*4882a593Smuzhiyun }
582*4882a593Smuzhiyun } else
583*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
584*4882a593Smuzhiyun {
585*4882a593Smuzhiyun if (pfn_param.scan_freq < htod32(PNO_SCAN_MIN_FW_SEC) ||
586*4882a593Smuzhiyun pfn_param.scan_freq > htod32(PNO_SCAN_MAX_FW_SEC)) {
587*4882a593Smuzhiyun DHD_ERROR(("%s pno freq(%d sec) is not valid \n",
588*4882a593Smuzhiyun __FUNCTION__, PNO_SCAN_MIN_FW_SEC));
589*4882a593Smuzhiyun err = BCME_BADARG;
590*4882a593Smuzhiyun goto exit;
591*4882a593Smuzhiyun }
592*4882a593Smuzhiyun }
593*4882a593Smuzhiyun #if (!defined(WL_USE_RANDOMIZED_SCAN))
594*4882a593Smuzhiyun err = dhd_set_rand_mac_oui(dhd);
595*4882a593Smuzhiyun /* Ignore if chip doesnt support the feature */
596*4882a593Smuzhiyun if (err < 0 && err != BCME_UNSUPPORTED) {
597*4882a593Smuzhiyun DHD_ERROR(("%s : failed to set random mac for PNO scan, %d\n", __FUNCTION__, err));
598*4882a593Smuzhiyun goto exit;
599*4882a593Smuzhiyun }
600*4882a593Smuzhiyun #endif /* !defined(WL_USE_RANDOMIZED_SCAN */
601*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
602*4882a593Smuzhiyun if (mode == DHD_PNO_BATCH_MODE ||
603*4882a593Smuzhiyun ((mode & DHD_PNO_GSCAN_MODE) && pno_params->params_gscan.mscan))
604*4882a593Smuzhiyun #else
605*4882a593Smuzhiyun if (mode == DHD_PNO_BATCH_MODE)
606*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
607*4882a593Smuzhiyun {
608*4882a593Smuzhiyun int _tmp = pfn_param.bestn;
609*4882a593Smuzhiyun /* set bestn to calculate the max mscan which firmware supports */
610*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfnmem", (char *)&_tmp, sizeof(_tmp), NULL, 0, TRUE);
611*4882a593Smuzhiyun if (err < 0) {
612*4882a593Smuzhiyun DHD_ERROR(("%s : failed to set pfnmem\n", __FUNCTION__));
613*4882a593Smuzhiyun goto exit;
614*4882a593Smuzhiyun }
615*4882a593Smuzhiyun /* get max mscan which the firmware supports */
616*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfnmem", NULL, 0, (char *)&_tmp, sizeof(_tmp), FALSE);
617*4882a593Smuzhiyun if (err < 0) {
618*4882a593Smuzhiyun DHD_ERROR(("%s : failed to get pfnmem\n", __FUNCTION__));
619*4882a593Smuzhiyun goto exit;
620*4882a593Smuzhiyun }
621*4882a593Smuzhiyun pfn_param.mscan = MIN(pfn_param.mscan, _tmp);
622*4882a593Smuzhiyun DHD_PNO((" returned mscan : %d, set bestn : %d mscan %d\n", _tmp, pfn_param.bestn,
623*4882a593Smuzhiyun pfn_param.mscan));
624*4882a593Smuzhiyun }
625*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfn_set", (char *)&pfn_param, sizeof(pfn_param), NULL, 0, TRUE);
626*4882a593Smuzhiyun if (err < 0) {
627*4882a593Smuzhiyun DHD_ERROR(("%s : failed to execute pfn_set %d\n", __FUNCTION__, err));
628*4882a593Smuzhiyun goto exit;
629*4882a593Smuzhiyun }
630*4882a593Smuzhiyun /* need to return mscan if this is for batch scan instead of err */
631*4882a593Smuzhiyun err = (mode == DHD_PNO_BATCH_MODE)? pfn_param.mscan : err;
632*4882a593Smuzhiyun exit:
633*4882a593Smuzhiyun return err;
634*4882a593Smuzhiyun }
635*4882a593Smuzhiyun
636*4882a593Smuzhiyun static int
_dhd_pno_add_ssid(dhd_pub_t * dhd,struct list_head * ssid_list,int nssid)637*4882a593Smuzhiyun _dhd_pno_add_ssid(dhd_pub_t *dhd, struct list_head* ssid_list, int nssid)
638*4882a593Smuzhiyun {
639*4882a593Smuzhiyun int err = BCME_OK;
640*4882a593Smuzhiyun int i = 0, mem_needed;
641*4882a593Smuzhiyun wl_pfn_t *pfn_elem_buf;
642*4882a593Smuzhiyun struct dhd_pno_ssid *iter, *next;
643*4882a593Smuzhiyun
644*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
645*4882a593Smuzhiyun if (!nssid) {
646*4882a593Smuzhiyun NULL_CHECK(ssid_list, "ssid list is NULL", err);
647*4882a593Smuzhiyun return BCME_ERROR;
648*4882a593Smuzhiyun }
649*4882a593Smuzhiyun mem_needed = (sizeof(wl_pfn_t) * nssid);
650*4882a593Smuzhiyun pfn_elem_buf = (wl_pfn_t *) MALLOCZ(dhd->osh, mem_needed);
651*4882a593Smuzhiyun if (!pfn_elem_buf) {
652*4882a593Smuzhiyun DHD_ERROR(("%s: Can't malloc %d bytes!\n", __FUNCTION__, mem_needed));
653*4882a593Smuzhiyun return BCME_NOMEM;
654*4882a593Smuzhiyun }
655*4882a593Smuzhiyun
656*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
657*4882a593Smuzhiyun list_for_each_entry_safe(iter, next, ssid_list, list) {
658*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
659*4882a593Smuzhiyun pfn_elem_buf[i].infra = htod32(1);
660*4882a593Smuzhiyun pfn_elem_buf[i].auth = htod32(DOT11_OPEN_SYSTEM);
661*4882a593Smuzhiyun pfn_elem_buf[i].wpa_auth = htod32(iter->wpa_auth);
662*4882a593Smuzhiyun pfn_elem_buf[i].flags = htod32(iter->flags);
663*4882a593Smuzhiyun if (iter->hidden)
664*4882a593Smuzhiyun pfn_elem_buf[i].flags |= htod32(ENABLE << WL_PFN_HIDDEN_BIT);
665*4882a593Smuzhiyun /* If a single RSSI threshold is defined, use that */
666*4882a593Smuzhiyun #ifdef PNO_MIN_RSSI_TRIGGER
667*4882a593Smuzhiyun pfn_elem_buf[i].flags |= ((PNO_MIN_RSSI_TRIGGER & 0xFF) << WL_PFN_RSSI_SHIFT);
668*4882a593Smuzhiyun #else
669*4882a593Smuzhiyun pfn_elem_buf[i].flags |= ((iter->rssi_thresh & 0xFF) << WL_PFN_RSSI_SHIFT);
670*4882a593Smuzhiyun #endif /* PNO_MIN_RSSI_TRIGGER */
671*4882a593Smuzhiyun memcpy((char *)pfn_elem_buf[i].ssid.SSID, iter->SSID,
672*4882a593Smuzhiyun iter->SSID_len);
673*4882a593Smuzhiyun pfn_elem_buf[i].ssid.SSID_len = iter->SSID_len;
674*4882a593Smuzhiyun DHD_PNO(("%s size = %d hidden = %d flags = %x rssi_thresh %d\n",
675*4882a593Smuzhiyun iter->SSID, iter->SSID_len, iter->hidden,
676*4882a593Smuzhiyun iter->flags, iter->rssi_thresh));
677*4882a593Smuzhiyun if (++i >= nssid) {
678*4882a593Smuzhiyun /* shouldn't happen */
679*4882a593Smuzhiyun break;
680*4882a593Smuzhiyun }
681*4882a593Smuzhiyun }
682*4882a593Smuzhiyun
683*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfn_add", (char *)pfn_elem_buf, mem_needed, NULL, 0, TRUE);
684*4882a593Smuzhiyun if (err < 0) {
685*4882a593Smuzhiyun DHD_ERROR(("%s : failed to execute pfn_add\n", __FUNCTION__));
686*4882a593Smuzhiyun }
687*4882a593Smuzhiyun MFREE(dhd->osh, pfn_elem_buf, mem_needed);
688*4882a593Smuzhiyun return err;
689*4882a593Smuzhiyun }
690*4882a593Smuzhiyun
691*4882a593Smuzhiyun /* qsort compare function */
692*4882a593Smuzhiyun static int
_dhd_pno_cmpfunc(const void * a,const void * b)693*4882a593Smuzhiyun _dhd_pno_cmpfunc(const void *a, const void *b)
694*4882a593Smuzhiyun {
695*4882a593Smuzhiyun return (*(const uint16*)a - *(const uint16*)b);
696*4882a593Smuzhiyun }
697*4882a593Smuzhiyun
698*4882a593Smuzhiyun static int
_dhd_pno_chan_merge(uint16 * d_chan_list,int * nchan,uint16 * chan_list1,int nchan1,uint16 * chan_list2,int nchan2)699*4882a593Smuzhiyun _dhd_pno_chan_merge(uint16 *d_chan_list, int *nchan,
700*4882a593Smuzhiyun uint16 *chan_list1, int nchan1, uint16 *chan_list2, int nchan2)
701*4882a593Smuzhiyun {
702*4882a593Smuzhiyun int err = BCME_OK;
703*4882a593Smuzhiyun int i = 0, j = 0, k = 0;
704*4882a593Smuzhiyun uint16 tmp;
705*4882a593Smuzhiyun NULL_CHECK(d_chan_list, "d_chan_list is NULL", err);
706*4882a593Smuzhiyun NULL_CHECK(nchan, "nchan is NULL", err);
707*4882a593Smuzhiyun NULL_CHECK(chan_list1, "chan_list1 is NULL", err);
708*4882a593Smuzhiyun NULL_CHECK(chan_list2, "chan_list2 is NULL", err);
709*4882a593Smuzhiyun /* chan_list1 and chan_list2 should be sorted at first */
710*4882a593Smuzhiyun while (i < nchan1 && j < nchan2) {
711*4882a593Smuzhiyun tmp = chan_list1[i] < chan_list2[j]?
712*4882a593Smuzhiyun chan_list1[i++] : chan_list2[j++];
713*4882a593Smuzhiyun for (; i < nchan1 && chan_list1[i] == tmp; i++);
714*4882a593Smuzhiyun for (; j < nchan2 && chan_list2[j] == tmp; j++);
715*4882a593Smuzhiyun d_chan_list[k++] = tmp;
716*4882a593Smuzhiyun }
717*4882a593Smuzhiyun
718*4882a593Smuzhiyun while (i < nchan1) {
719*4882a593Smuzhiyun tmp = chan_list1[i++];
720*4882a593Smuzhiyun for (; i < nchan1 && chan_list1[i] == tmp; i++);
721*4882a593Smuzhiyun d_chan_list[k++] = tmp;
722*4882a593Smuzhiyun }
723*4882a593Smuzhiyun
724*4882a593Smuzhiyun while (j < nchan2) {
725*4882a593Smuzhiyun tmp = chan_list2[j++];
726*4882a593Smuzhiyun for (; j < nchan2 && chan_list2[j] == tmp; j++);
727*4882a593Smuzhiyun d_chan_list[k++] = tmp;
728*4882a593Smuzhiyun
729*4882a593Smuzhiyun }
730*4882a593Smuzhiyun *nchan = k;
731*4882a593Smuzhiyun return err;
732*4882a593Smuzhiyun }
733*4882a593Smuzhiyun
734*4882a593Smuzhiyun static int
_dhd_pno_get_channels(dhd_pub_t * dhd,uint16 * d_chan_list,int * nchan,uint8 band,bool skip_dfs)735*4882a593Smuzhiyun _dhd_pno_get_channels(dhd_pub_t *dhd, uint16 *d_chan_list,
736*4882a593Smuzhiyun int *nchan, uint8 band, bool skip_dfs)
737*4882a593Smuzhiyun {
738*4882a593Smuzhiyun int err = BCME_OK;
739*4882a593Smuzhiyun int i, j;
740*4882a593Smuzhiyun uint32 chan_buf[WL_NUMCHANNELS + 1];
741*4882a593Smuzhiyun wl_uint32_list_t *list;
742*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
743*4882a593Smuzhiyun if (*nchan) {
744*4882a593Smuzhiyun NULL_CHECK(d_chan_list, "d_chan_list is NULL", err);
745*4882a593Smuzhiyun }
746*4882a593Smuzhiyun memset(&chan_buf, 0, sizeof(chan_buf));
747*4882a593Smuzhiyun list = (wl_uint32_list_t *) (void *)chan_buf;
748*4882a593Smuzhiyun list->count = htod32(WL_NUMCHANNELS);
749*4882a593Smuzhiyun err = dhd_wl_ioctl_cmd(dhd, WLC_GET_VALID_CHANNELS, chan_buf, sizeof(chan_buf), FALSE, 0);
750*4882a593Smuzhiyun if (err < 0) {
751*4882a593Smuzhiyun DHD_ERROR(("failed to get channel list (err: %d)\n", err));
752*4882a593Smuzhiyun return err;
753*4882a593Smuzhiyun }
754*4882a593Smuzhiyun for (i = 0, j = 0; i < dtoh32(list->count) && i < *nchan; i++) {
755*4882a593Smuzhiyun if (IS_2G_CHANNEL(dtoh32(list->element[i]))) {
756*4882a593Smuzhiyun if (!(band & WLC_BAND_2G)) {
757*4882a593Smuzhiyun /* Skip, if not 2g */
758*4882a593Smuzhiyun continue;
759*4882a593Smuzhiyun }
760*4882a593Smuzhiyun /* fall through to include the channel */
761*4882a593Smuzhiyun } else if (IS_5G_CHANNEL(dtoh32(list->element[i]))) {
762*4882a593Smuzhiyun bool dfs_channel = is_dfs(dhd, dtoh32(list->element[i]));
763*4882a593Smuzhiyun if ((skip_dfs && dfs_channel) ||
764*4882a593Smuzhiyun (!(band & WLC_BAND_5G) && !dfs_channel)) {
765*4882a593Smuzhiyun /* Skip the channel if:
766*4882a593Smuzhiyun * the DFS bit is NOT set & the channel is a dfs channel
767*4882a593Smuzhiyun * the band 5G is not set & the channel is a non DFS 5G channel
768*4882a593Smuzhiyun */
769*4882a593Smuzhiyun continue;
770*4882a593Smuzhiyun }
771*4882a593Smuzhiyun /* fall through to include the channel */
772*4882a593Smuzhiyun } else {
773*4882a593Smuzhiyun /* Not in range. Bad channel */
774*4882a593Smuzhiyun DHD_ERROR(("Not in range. bad channel\n"));
775*4882a593Smuzhiyun *nchan = 0;
776*4882a593Smuzhiyun return BCME_BADCHAN;
777*4882a593Smuzhiyun }
778*4882a593Smuzhiyun
779*4882a593Smuzhiyun /* Include the channel */
780*4882a593Smuzhiyun d_chan_list[j++] = (uint16) dtoh32(list->element[i]);
781*4882a593Smuzhiyun }
782*4882a593Smuzhiyun *nchan = j;
783*4882a593Smuzhiyun return err;
784*4882a593Smuzhiyun }
785*4882a593Smuzhiyun
786*4882a593Smuzhiyun static int
_dhd_pno_convert_format(dhd_pub_t * dhd,struct dhd_pno_batch_params * params_batch,char * buf,int nbufsize)787*4882a593Smuzhiyun _dhd_pno_convert_format(dhd_pub_t *dhd, struct dhd_pno_batch_params *params_batch,
788*4882a593Smuzhiyun char *buf, int nbufsize)
789*4882a593Smuzhiyun {
790*4882a593Smuzhiyun int err = BCME_OK;
791*4882a593Smuzhiyun int bytes_written = 0, nreadsize = 0;
792*4882a593Smuzhiyun int t_delta = 0;
793*4882a593Smuzhiyun int nleftsize = nbufsize;
794*4882a593Smuzhiyun uint8 cnt = 0;
795*4882a593Smuzhiyun char *bp = buf;
796*4882a593Smuzhiyun char eabuf[ETHER_ADDR_STR_LEN];
797*4882a593Smuzhiyun #ifdef PNO_DEBUG
798*4882a593Smuzhiyun char *_base_bp;
799*4882a593Smuzhiyun char msg[150];
800*4882a593Smuzhiyun #endif
801*4882a593Smuzhiyun dhd_pno_bestnet_entry_t *iter, *next;
802*4882a593Smuzhiyun dhd_pno_scan_results_t *siter, *snext;
803*4882a593Smuzhiyun dhd_pno_best_header_t *phead, *pprev;
804*4882a593Smuzhiyun NULL_CHECK(params_batch, "params_batch is NULL", err);
805*4882a593Smuzhiyun if (nbufsize > 0)
806*4882a593Smuzhiyun NULL_CHECK(buf, "buf is NULL", err);
807*4882a593Smuzhiyun /* initialize the buffer */
808*4882a593Smuzhiyun memset(buf, 0, nbufsize);
809*4882a593Smuzhiyun DHD_PNO(("%s enter \n", __FUNCTION__));
810*4882a593Smuzhiyun /* # of scans */
811*4882a593Smuzhiyun if (!params_batch->get_batch.batch_started) {
812*4882a593Smuzhiyun bp += nreadsize = snprintf(bp, nleftsize, "scancount=%d\n",
813*4882a593Smuzhiyun params_batch->get_batch.expired_tot_scan_cnt);
814*4882a593Smuzhiyun nleftsize -= nreadsize;
815*4882a593Smuzhiyun params_batch->get_batch.batch_started = TRUE;
816*4882a593Smuzhiyun }
817*4882a593Smuzhiyun DHD_PNO(("%s scancount %d\n", __FUNCTION__, params_batch->get_batch.expired_tot_scan_cnt));
818*4882a593Smuzhiyun /* preestimate scan count until which scan result this report is going to end */
819*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
820*4882a593Smuzhiyun list_for_each_entry_safe(siter, snext,
821*4882a593Smuzhiyun ¶ms_batch->get_batch.expired_scan_results_list, list) {
822*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
823*4882a593Smuzhiyun phead = siter->bestnetheader;
824*4882a593Smuzhiyun while (phead != NULL) {
825*4882a593Smuzhiyun /* if left_size is less than bestheader total size , stop this */
826*4882a593Smuzhiyun if (nleftsize <=
827*4882a593Smuzhiyun (phead->tot_size + phead->tot_cnt * ENTRY_OVERHEAD))
828*4882a593Smuzhiyun goto exit;
829*4882a593Smuzhiyun /* increase scan count */
830*4882a593Smuzhiyun cnt++;
831*4882a593Smuzhiyun /* # best of each scan */
832*4882a593Smuzhiyun DHD_PNO(("\n<loop : %d, apcount %d>\n", cnt - 1, phead->tot_cnt));
833*4882a593Smuzhiyun /* attribute of the scan */
834*4882a593Smuzhiyun if (phead->reason & PNO_STATUS_ABORT_MASK) {
835*4882a593Smuzhiyun bp += nreadsize = snprintf(bp, nleftsize, "trunc\n");
836*4882a593Smuzhiyun nleftsize -= nreadsize;
837*4882a593Smuzhiyun }
838*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
839*4882a593Smuzhiyun list_for_each_entry_safe(iter, next,
840*4882a593Smuzhiyun &phead->entry_list, list) {
841*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
842*4882a593Smuzhiyun t_delta = jiffies_to_msecs(jiffies - iter->recorded_time);
843*4882a593Smuzhiyun #ifdef PNO_DEBUG
844*4882a593Smuzhiyun _base_bp = bp;
845*4882a593Smuzhiyun memset(msg, 0, sizeof(msg));
846*4882a593Smuzhiyun #endif
847*4882a593Smuzhiyun /* BSSID info */
848*4882a593Smuzhiyun bp += nreadsize = snprintf(bp, nleftsize, "bssid=%s\n",
849*4882a593Smuzhiyun bcm_ether_ntoa((const struct ether_addr *)&iter->BSSID, eabuf));
850*4882a593Smuzhiyun nleftsize -= nreadsize;
851*4882a593Smuzhiyun /* SSID */
852*4882a593Smuzhiyun bp += nreadsize = snprintf(bp, nleftsize, "ssid=%s\n", iter->SSID);
853*4882a593Smuzhiyun nleftsize -= nreadsize;
854*4882a593Smuzhiyun /* channel */
855*4882a593Smuzhiyun bp += nreadsize = snprintf(bp, nleftsize, "freq=%d\n",
856*4882a593Smuzhiyun wl_channel_to_frequency(wf_chspec_ctlchan(iter->channel),
857*4882a593Smuzhiyun CHSPEC_BAND(iter->channel)));
858*4882a593Smuzhiyun nleftsize -= nreadsize;
859*4882a593Smuzhiyun /* RSSI */
860*4882a593Smuzhiyun bp += nreadsize = snprintf(bp, nleftsize, "level=%d\n", iter->RSSI);
861*4882a593Smuzhiyun nleftsize -= nreadsize;
862*4882a593Smuzhiyun /* add the time consumed in Driver to the timestamp of firmware */
863*4882a593Smuzhiyun iter->timestamp += t_delta;
864*4882a593Smuzhiyun bp += nreadsize = snprintf(bp, nleftsize,
865*4882a593Smuzhiyun "age=%d\n", iter->timestamp);
866*4882a593Smuzhiyun nleftsize -= nreadsize;
867*4882a593Smuzhiyun /* RTT0 */
868*4882a593Smuzhiyun bp += nreadsize = snprintf(bp, nleftsize, "dist=%d\n",
869*4882a593Smuzhiyun (iter->rtt0 == 0)? -1 : iter->rtt0);
870*4882a593Smuzhiyun nleftsize -= nreadsize;
871*4882a593Smuzhiyun /* RTT1 */
872*4882a593Smuzhiyun bp += nreadsize = snprintf(bp, nleftsize, "distSd=%d\n",
873*4882a593Smuzhiyun (iter->rtt0 == 0)? -1 : iter->rtt1);
874*4882a593Smuzhiyun nleftsize -= nreadsize;
875*4882a593Smuzhiyun bp += nreadsize = snprintf(bp, nleftsize, "%s", AP_END_MARKER);
876*4882a593Smuzhiyun nleftsize -= nreadsize;
877*4882a593Smuzhiyun list_del(&iter->list);
878*4882a593Smuzhiyun MFREE(dhd->osh, iter, BESTNET_ENTRY_SIZE);
879*4882a593Smuzhiyun #ifdef PNO_DEBUG
880*4882a593Smuzhiyun memcpy(msg, _base_bp, bp - _base_bp);
881*4882a593Smuzhiyun DHD_PNO(("Entry : \n%s", msg));
882*4882a593Smuzhiyun #endif
883*4882a593Smuzhiyun }
884*4882a593Smuzhiyun bp += nreadsize = snprintf(bp, nleftsize, "%s", SCAN_END_MARKER);
885*4882a593Smuzhiyun DHD_PNO(("%s", SCAN_END_MARKER));
886*4882a593Smuzhiyun nleftsize -= nreadsize;
887*4882a593Smuzhiyun pprev = phead;
888*4882a593Smuzhiyun /* reset the header */
889*4882a593Smuzhiyun siter->bestnetheader = phead = phead->next;
890*4882a593Smuzhiyun MFREE(dhd->osh, pprev, BEST_HEADER_SIZE);
891*4882a593Smuzhiyun
892*4882a593Smuzhiyun siter->cnt_header--;
893*4882a593Smuzhiyun }
894*4882a593Smuzhiyun if (phead == NULL) {
895*4882a593Smuzhiyun /* we store all entry in this scan , so it is ok to delete */
896*4882a593Smuzhiyun list_del(&siter->list);
897*4882a593Smuzhiyun MFREE(dhd->osh, siter, SCAN_RESULTS_SIZE);
898*4882a593Smuzhiyun }
899*4882a593Smuzhiyun }
900*4882a593Smuzhiyun exit:
901*4882a593Smuzhiyun if (cnt < params_batch->get_batch.expired_tot_scan_cnt) {
902*4882a593Smuzhiyun DHD_ERROR(("Buffer size is small to save all batch entry,"
903*4882a593Smuzhiyun " cnt : %d (remained_scan_cnt): %d\n",
904*4882a593Smuzhiyun cnt, params_batch->get_batch.expired_tot_scan_cnt - cnt));
905*4882a593Smuzhiyun }
906*4882a593Smuzhiyun params_batch->get_batch.expired_tot_scan_cnt -= cnt;
907*4882a593Smuzhiyun /* set FALSE only if the link list is empty after returning the data */
908*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
909*4882a593Smuzhiyun if (list_empty(¶ms_batch->get_batch.expired_scan_results_list)) {
910*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
911*4882a593Smuzhiyun params_batch->get_batch.batch_started = FALSE;
912*4882a593Smuzhiyun bp += snprintf(bp, nleftsize, "%s", RESULTS_END_MARKER);
913*4882a593Smuzhiyun DHD_PNO(("%s", RESULTS_END_MARKER));
914*4882a593Smuzhiyun DHD_PNO(("%s : Getting the batching data is complete\n", __FUNCTION__));
915*4882a593Smuzhiyun }
916*4882a593Smuzhiyun /* return used memory in buffer */
917*4882a593Smuzhiyun bytes_written = (int32)(bp - buf);
918*4882a593Smuzhiyun return bytes_written;
919*4882a593Smuzhiyun }
920*4882a593Smuzhiyun
921*4882a593Smuzhiyun static int
_dhd_pno_clear_all_batch_results(dhd_pub_t * dhd,struct list_head * head,bool only_last)922*4882a593Smuzhiyun _dhd_pno_clear_all_batch_results(dhd_pub_t *dhd, struct list_head *head, bool only_last)
923*4882a593Smuzhiyun {
924*4882a593Smuzhiyun int err = BCME_OK;
925*4882a593Smuzhiyun int removed_scan_cnt = 0;
926*4882a593Smuzhiyun dhd_pno_scan_results_t *siter, *snext;
927*4882a593Smuzhiyun dhd_pno_best_header_t *phead, *pprev;
928*4882a593Smuzhiyun dhd_pno_bestnet_entry_t *iter, *next;
929*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
930*4882a593Smuzhiyun NULL_CHECK(head, "head is NULL", err);
931*4882a593Smuzhiyun NULL_CHECK(head->next, "head->next is NULL", err);
932*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
933*4882a593Smuzhiyun
934*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
935*4882a593Smuzhiyun list_for_each_entry_safe(siter, snext,
936*4882a593Smuzhiyun head, list) {
937*4882a593Smuzhiyun if (only_last) {
938*4882a593Smuzhiyun /* in case that we need to delete only last one */
939*4882a593Smuzhiyun if (!list_is_last(&siter->list, head)) {
940*4882a593Smuzhiyun /* skip if the one is not last */
941*4882a593Smuzhiyun continue;
942*4882a593Smuzhiyun }
943*4882a593Smuzhiyun }
944*4882a593Smuzhiyun /* delete all data belong if the one is last */
945*4882a593Smuzhiyun phead = siter->bestnetheader;
946*4882a593Smuzhiyun while (phead != NULL) {
947*4882a593Smuzhiyun removed_scan_cnt++;
948*4882a593Smuzhiyun list_for_each_entry_safe(iter, next,
949*4882a593Smuzhiyun &phead->entry_list, list) {
950*4882a593Smuzhiyun list_del(&iter->list);
951*4882a593Smuzhiyun MFREE(dhd->osh, iter, BESTNET_ENTRY_SIZE);
952*4882a593Smuzhiyun }
953*4882a593Smuzhiyun pprev = phead;
954*4882a593Smuzhiyun phead = phead->next;
955*4882a593Smuzhiyun MFREE(dhd->osh, pprev, BEST_HEADER_SIZE);
956*4882a593Smuzhiyun }
957*4882a593Smuzhiyun if (phead == NULL) {
958*4882a593Smuzhiyun /* it is ok to delete top node */
959*4882a593Smuzhiyun list_del(&siter->list);
960*4882a593Smuzhiyun MFREE(dhd->osh, siter, SCAN_RESULTS_SIZE);
961*4882a593Smuzhiyun }
962*4882a593Smuzhiyun }
963*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
964*4882a593Smuzhiyun return removed_scan_cnt;
965*4882a593Smuzhiyun }
966*4882a593Smuzhiyun
967*4882a593Smuzhiyun static int
_dhd_pno_cfg(dhd_pub_t * dhd,uint16 * channel_list,int nchan)968*4882a593Smuzhiyun _dhd_pno_cfg(dhd_pub_t *dhd, uint16 *channel_list, int nchan)
969*4882a593Smuzhiyun {
970*4882a593Smuzhiyun int err = BCME_OK;
971*4882a593Smuzhiyun int i = 0;
972*4882a593Smuzhiyun wl_pfn_cfg_t pfncfg_param;
973*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
974*4882a593Smuzhiyun if (nchan) {
975*4882a593Smuzhiyun if (nchan > WL_NUMCHANNELS) {
976*4882a593Smuzhiyun return BCME_RANGE;
977*4882a593Smuzhiyun }
978*4882a593Smuzhiyun DHD_PNO(("%s enter : nchan : %d\n", __FUNCTION__, nchan));
979*4882a593Smuzhiyun (void)memset_s(&pfncfg_param, sizeof(wl_pfn_cfg_t), 0, sizeof(wl_pfn_cfg_t));
980*4882a593Smuzhiyun pfncfg_param.channel_num = htod32(0);
981*4882a593Smuzhiyun
982*4882a593Smuzhiyun for (i = 0; i < nchan; i++) {
983*4882a593Smuzhiyun if (dhd->wlc_ver_major >= DHD_PNO_CHSPEC_SUPPORT_VER) {
984*4882a593Smuzhiyun pfncfg_param.channel_list[i] = CH20MHZ_CHSPEC(channel_list[i]);
985*4882a593Smuzhiyun } else {
986*4882a593Smuzhiyun pfncfg_param.channel_list[i] = channel_list[i];
987*4882a593Smuzhiyun }
988*4882a593Smuzhiyun }
989*4882a593Smuzhiyun }
990*4882a593Smuzhiyun
991*4882a593Smuzhiyun /* Setup default values */
992*4882a593Smuzhiyun pfncfg_param.reporttype = htod32(WL_PFN_REPORT_ALLNET);
993*4882a593Smuzhiyun pfncfg_param.channel_num = htod32(nchan);
994*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfn_cfg", (char *)&pfncfg_param, sizeof(pfncfg_param), NULL, 0,
995*4882a593Smuzhiyun TRUE);
996*4882a593Smuzhiyun if (err < 0) {
997*4882a593Smuzhiyun DHD_ERROR(("%s : failed to execute pfn_cfg\n", __FUNCTION__));
998*4882a593Smuzhiyun goto exit;
999*4882a593Smuzhiyun }
1000*4882a593Smuzhiyun exit:
1001*4882a593Smuzhiyun return err;
1002*4882a593Smuzhiyun }
1003*4882a593Smuzhiyun
1004*4882a593Smuzhiyun static int
_dhd_pno_reinitialize_prof(dhd_pub_t * dhd,dhd_pno_params_t * params,dhd_pno_mode_t mode)1005*4882a593Smuzhiyun _dhd_pno_reinitialize_prof(dhd_pub_t *dhd, dhd_pno_params_t *params, dhd_pno_mode_t mode)
1006*4882a593Smuzhiyun {
1007*4882a593Smuzhiyun int err = BCME_OK;
1008*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
1009*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL\n", err);
1010*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL\n", err);
1011*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
1012*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
1013*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
1014*4882a593Smuzhiyun switch (mode) {
1015*4882a593Smuzhiyun case DHD_PNO_LEGACY_MODE: {
1016*4882a593Smuzhiyun struct dhd_pno_ssid *iter, *next;
1017*4882a593Smuzhiyun if (params->params_legacy.nssid > 0) {
1018*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
1019*4882a593Smuzhiyun list_for_each_entry_safe(iter, next,
1020*4882a593Smuzhiyun ¶ms->params_legacy.ssid_list, list) {
1021*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
1022*4882a593Smuzhiyun list_del(&iter->list);
1023*4882a593Smuzhiyun MFREE(dhd->osh, iter, sizeof(struct dhd_pno_ssid));
1024*4882a593Smuzhiyun }
1025*4882a593Smuzhiyun }
1026*4882a593Smuzhiyun
1027*4882a593Smuzhiyun params->params_legacy.nssid = 0;
1028*4882a593Smuzhiyun params->params_legacy.scan_fr = 0;
1029*4882a593Smuzhiyun params->params_legacy.pno_freq_expo_max = 0;
1030*4882a593Smuzhiyun params->params_legacy.pno_repeat = 0;
1031*4882a593Smuzhiyun params->params_legacy.nchan = 0;
1032*4882a593Smuzhiyun memset(params->params_legacy.chan_list, 0,
1033*4882a593Smuzhiyun sizeof(params->params_legacy.chan_list));
1034*4882a593Smuzhiyun break;
1035*4882a593Smuzhiyun }
1036*4882a593Smuzhiyun case DHD_PNO_BATCH_MODE: {
1037*4882a593Smuzhiyun params->params_batch.scan_fr = 0;
1038*4882a593Smuzhiyun params->params_batch.mscan = 0;
1039*4882a593Smuzhiyun params->params_batch.nchan = 0;
1040*4882a593Smuzhiyun params->params_batch.rtt = 0;
1041*4882a593Smuzhiyun params->params_batch.bestn = 0;
1042*4882a593Smuzhiyun params->params_batch.nchan = 0;
1043*4882a593Smuzhiyun params->params_batch.band = WLC_BAND_AUTO;
1044*4882a593Smuzhiyun memset(params->params_batch.chan_list, 0,
1045*4882a593Smuzhiyun sizeof(params->params_batch.chan_list));
1046*4882a593Smuzhiyun params->params_batch.get_batch.batch_started = FALSE;
1047*4882a593Smuzhiyun params->params_batch.get_batch.buf = NULL;
1048*4882a593Smuzhiyun params->params_batch.get_batch.bufsize = 0;
1049*4882a593Smuzhiyun params->params_batch.get_batch.reason = 0;
1050*4882a593Smuzhiyun _dhd_pno_clear_all_batch_results(dhd,
1051*4882a593Smuzhiyun ¶ms->params_batch.get_batch.scan_results_list, FALSE);
1052*4882a593Smuzhiyun _dhd_pno_clear_all_batch_results(dhd,
1053*4882a593Smuzhiyun ¶ms->params_batch.get_batch.expired_scan_results_list, FALSE);
1054*4882a593Smuzhiyun params->params_batch.get_batch.tot_scan_cnt = 0;
1055*4882a593Smuzhiyun params->params_batch.get_batch.expired_tot_scan_cnt = 0;
1056*4882a593Smuzhiyun params->params_batch.get_batch.top_node_cnt = 0;
1057*4882a593Smuzhiyun INIT_LIST_HEAD(¶ms->params_batch.get_batch.scan_results_list);
1058*4882a593Smuzhiyun INIT_LIST_HEAD(¶ms->params_batch.get_batch.expired_scan_results_list);
1059*4882a593Smuzhiyun break;
1060*4882a593Smuzhiyun }
1061*4882a593Smuzhiyun case DHD_PNO_HOTLIST_MODE: {
1062*4882a593Smuzhiyun struct dhd_pno_bssid *iter, *next;
1063*4882a593Smuzhiyun if (params->params_hotlist.nbssid > 0) {
1064*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
1065*4882a593Smuzhiyun list_for_each_entry_safe(iter, next,
1066*4882a593Smuzhiyun ¶ms->params_hotlist.bssid_list, list) {
1067*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
1068*4882a593Smuzhiyun list_del(&iter->list);
1069*4882a593Smuzhiyun MFREE(dhd->osh, iter, sizeof(struct dhd_pno_ssid));
1070*4882a593Smuzhiyun }
1071*4882a593Smuzhiyun }
1072*4882a593Smuzhiyun params->params_hotlist.scan_fr = 0;
1073*4882a593Smuzhiyun params->params_hotlist.nbssid = 0;
1074*4882a593Smuzhiyun params->params_hotlist.nchan = 0;
1075*4882a593Smuzhiyun params->params_batch.band = WLC_BAND_AUTO;
1076*4882a593Smuzhiyun memset(params->params_hotlist.chan_list, 0,
1077*4882a593Smuzhiyun sizeof(params->params_hotlist.chan_list));
1078*4882a593Smuzhiyun break;
1079*4882a593Smuzhiyun }
1080*4882a593Smuzhiyun default:
1081*4882a593Smuzhiyun DHD_ERROR(("%s : unknown mode : %d\n", __FUNCTION__, mode));
1082*4882a593Smuzhiyun break;
1083*4882a593Smuzhiyun }
1084*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
1085*4882a593Smuzhiyun return err;
1086*4882a593Smuzhiyun }
1087*4882a593Smuzhiyun
1088*4882a593Smuzhiyun static int
_dhd_pno_add_bssid(dhd_pub_t * dhd,wl_pfn_bssid_t * p_pfn_bssid,int nbssid)1089*4882a593Smuzhiyun _dhd_pno_add_bssid(dhd_pub_t *dhd, wl_pfn_bssid_t *p_pfn_bssid, int nbssid)
1090*4882a593Smuzhiyun {
1091*4882a593Smuzhiyun int err = BCME_OK;
1092*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
1093*4882a593Smuzhiyun if (nbssid) {
1094*4882a593Smuzhiyun NULL_CHECK(p_pfn_bssid, "bssid list is NULL", err);
1095*4882a593Smuzhiyun }
1096*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfn_add_bssid", (char *)p_pfn_bssid,
1097*4882a593Smuzhiyun sizeof(wl_pfn_bssid_t) * nbssid, NULL, 0, TRUE);
1098*4882a593Smuzhiyun if (err < 0) {
1099*4882a593Smuzhiyun DHD_ERROR(("%s : failed to execute pfn_cfg\n", __FUNCTION__));
1100*4882a593Smuzhiyun goto exit;
1101*4882a593Smuzhiyun }
1102*4882a593Smuzhiyun exit:
1103*4882a593Smuzhiyun return err;
1104*4882a593Smuzhiyun }
1105*4882a593Smuzhiyun
1106*4882a593Smuzhiyun int
dhd_pno_stop_for_ssid(dhd_pub_t * dhd)1107*4882a593Smuzhiyun dhd_pno_stop_for_ssid(dhd_pub_t *dhd)
1108*4882a593Smuzhiyun {
1109*4882a593Smuzhiyun int err = BCME_OK;
1110*4882a593Smuzhiyun uint32 mode = 0, cnt = 0;
1111*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
1112*4882a593Smuzhiyun dhd_pno_params_t *_params = NULL;
1113*4882a593Smuzhiyun wl_pfn_bssid_t *p_pfn_bssid = NULL, *tmp_bssid;
1114*4882a593Smuzhiyun
1115*4882a593Smuzhiyun NULL_CHECK(dhd, "dev is NULL", err);
1116*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
1117*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
1118*4882a593Smuzhiyun if (!(_pno_state->pno_mode & DHD_PNO_LEGACY_MODE)) {
1119*4882a593Smuzhiyun DHD_ERROR(("%s : LEGACY PNO MODE is not enabled\n", __FUNCTION__));
1120*4882a593Smuzhiyun goto exit;
1121*4882a593Smuzhiyun }
1122*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
1123*4882a593Smuzhiyun /* If pno mode is PNO_LEGACY_MODE clear the pno values and unset the DHD_PNO_LEGACY_MODE */
1124*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS];
1125*4882a593Smuzhiyun _dhd_pno_reinitialize_prof(dhd, _params, DHD_PNO_LEGACY_MODE);
1126*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_LEGACY_MODE;
1127*4882a593Smuzhiyun
1128*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
1129*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_GSCAN_MODE) {
1130*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
1131*4882a593Smuzhiyun
1132*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
1133*4882a593Smuzhiyun gscan_params = &_params->params_gscan;
1134*4882a593Smuzhiyun if (gscan_params->mscan) {
1135*4882a593Smuzhiyun /* retrieve the batching data from firmware into host */
1136*4882a593Smuzhiyun err = dhd_wait_batch_results_complete(dhd);
1137*4882a593Smuzhiyun if (err != BCME_OK)
1138*4882a593Smuzhiyun goto exit;
1139*4882a593Smuzhiyun }
1140*4882a593Smuzhiyun /* save current pno_mode before calling dhd_pno_clean */
1141*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
1142*4882a593Smuzhiyun mode = _pno_state->pno_mode;
1143*4882a593Smuzhiyun err = dhd_pno_clean(dhd);
1144*4882a593Smuzhiyun if (err < 0) {
1145*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call dhd_pno_clean (err: %d)\n",
1146*4882a593Smuzhiyun __FUNCTION__, err));
1147*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
1148*4882a593Smuzhiyun goto exit;
1149*4882a593Smuzhiyun }
1150*4882a593Smuzhiyun /* restore previous pno_mode */
1151*4882a593Smuzhiyun _pno_state->pno_mode = mode;
1152*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
1153*4882a593Smuzhiyun /* Restart gscan */
1154*4882a593Smuzhiyun err = dhd_pno_initiate_gscan_request(dhd, 1, 0);
1155*4882a593Smuzhiyun goto exit;
1156*4882a593Smuzhiyun }
1157*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
1158*4882a593Smuzhiyun /* restart Batch mode if the batch mode is on */
1159*4882a593Smuzhiyun if (_pno_state->pno_mode & (DHD_PNO_BATCH_MODE | DHD_PNO_HOTLIST_MODE)) {
1160*4882a593Smuzhiyun /* retrieve the batching data from firmware into host */
1161*4882a593Smuzhiyun dhd_pno_get_for_batch(dhd, NULL, 0, PNO_STATUS_DISABLE);
1162*4882a593Smuzhiyun /* save current pno_mode before calling dhd_pno_clean */
1163*4882a593Smuzhiyun mode = _pno_state->pno_mode;
1164*4882a593Smuzhiyun err = dhd_pno_clean(dhd);
1165*4882a593Smuzhiyun if (err < 0) {
1166*4882a593Smuzhiyun err = BCME_ERROR;
1167*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call dhd_pno_clean (err: %d)\n",
1168*4882a593Smuzhiyun __FUNCTION__, err));
1169*4882a593Smuzhiyun goto exit;
1170*4882a593Smuzhiyun }
1171*4882a593Smuzhiyun
1172*4882a593Smuzhiyun /* restore previous pno_mode */
1173*4882a593Smuzhiyun _pno_state->pno_mode = mode;
1174*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_BATCH_MODE) {
1175*4882a593Smuzhiyun _params = &(_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS]);
1176*4882a593Smuzhiyun /* restart BATCH SCAN */
1177*4882a593Smuzhiyun err = dhd_pno_set_for_batch(dhd, &_params->params_batch);
1178*4882a593Smuzhiyun if (err < 0) {
1179*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_BATCH_MODE;
1180*4882a593Smuzhiyun DHD_ERROR(("%s : failed to restart batch scan(err: %d)\n",
1181*4882a593Smuzhiyun __FUNCTION__, err));
1182*4882a593Smuzhiyun goto exit;
1183*4882a593Smuzhiyun }
1184*4882a593Smuzhiyun } else if (_pno_state->pno_mode & DHD_PNO_HOTLIST_MODE) {
1185*4882a593Smuzhiyun /* restart HOTLIST SCAN */
1186*4882a593Smuzhiyun struct dhd_pno_bssid *iter, *next;
1187*4882a593Smuzhiyun _params = &(_pno_state->pno_params_arr[INDEX_OF_HOTLIST_PARAMS]);
1188*4882a593Smuzhiyun p_pfn_bssid = MALLOCZ(dhd->osh, sizeof(wl_pfn_bssid_t) *
1189*4882a593Smuzhiyun _params->params_hotlist.nbssid);
1190*4882a593Smuzhiyun if (p_pfn_bssid == NULL) {
1191*4882a593Smuzhiyun DHD_ERROR(("%s : failed to allocate wl_pfn_bssid_t array"
1192*4882a593Smuzhiyun " (count: %d)",
1193*4882a593Smuzhiyun __FUNCTION__, _params->params_hotlist.nbssid));
1194*4882a593Smuzhiyun err = BCME_ERROR;
1195*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_HOTLIST_MODE;
1196*4882a593Smuzhiyun goto exit;
1197*4882a593Smuzhiyun }
1198*4882a593Smuzhiyun /* convert dhd_pno_bssid to wl_pfn_bssid */
1199*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
1200*4882a593Smuzhiyun cnt = 0;
1201*4882a593Smuzhiyun tmp_bssid = p_pfn_bssid;
1202*4882a593Smuzhiyun list_for_each_entry_safe(iter, next,
1203*4882a593Smuzhiyun &_params->params_hotlist.bssid_list, list) {
1204*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
1205*4882a593Smuzhiyun memcpy(&tmp_bssid->macaddr,
1206*4882a593Smuzhiyun &iter->macaddr, ETHER_ADDR_LEN);
1207*4882a593Smuzhiyun tmp_bssid->flags = iter->flags;
1208*4882a593Smuzhiyun if (cnt < _params->params_hotlist.nbssid) {
1209*4882a593Smuzhiyun tmp_bssid++;
1210*4882a593Smuzhiyun cnt++;
1211*4882a593Smuzhiyun } else {
1212*4882a593Smuzhiyun DHD_ERROR(("%s: Allocated insufficient memory\n",
1213*4882a593Smuzhiyun __FUNCTION__));
1214*4882a593Smuzhiyun break;
1215*4882a593Smuzhiyun }
1216*4882a593Smuzhiyun }
1217*4882a593Smuzhiyun err = dhd_pno_set_for_hotlist(dhd, p_pfn_bssid, &_params->params_hotlist);
1218*4882a593Smuzhiyun if (err < 0) {
1219*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_HOTLIST_MODE;
1220*4882a593Smuzhiyun DHD_ERROR(("%s : failed to restart hotlist scan(err: %d)\n",
1221*4882a593Smuzhiyun __FUNCTION__, err));
1222*4882a593Smuzhiyun goto exit;
1223*4882a593Smuzhiyun }
1224*4882a593Smuzhiyun }
1225*4882a593Smuzhiyun } else {
1226*4882a593Smuzhiyun err = dhd_pno_clean(dhd);
1227*4882a593Smuzhiyun if (err < 0) {
1228*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call dhd_pno_clean (err: %d)\n",
1229*4882a593Smuzhiyun __FUNCTION__, err));
1230*4882a593Smuzhiyun goto exit;
1231*4882a593Smuzhiyun }
1232*4882a593Smuzhiyun }
1233*4882a593Smuzhiyun exit:
1234*4882a593Smuzhiyun if (p_pfn_bssid) {
1235*4882a593Smuzhiyun MFREE(dhd->osh, p_pfn_bssid, sizeof(wl_pfn_bssid_t) *
1236*4882a593Smuzhiyun _params->params_hotlist.nbssid);
1237*4882a593Smuzhiyun }
1238*4882a593Smuzhiyun return err;
1239*4882a593Smuzhiyun }
1240*4882a593Smuzhiyun
1241*4882a593Smuzhiyun int
dhd_pno_enable(dhd_pub_t * dhd,int enable)1242*4882a593Smuzhiyun dhd_pno_enable(dhd_pub_t *dhd, int enable)
1243*4882a593Smuzhiyun {
1244*4882a593Smuzhiyun int err = BCME_OK;
1245*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
1246*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
1247*4882a593Smuzhiyun return (_dhd_pno_enable(dhd, enable));
1248*4882a593Smuzhiyun }
1249*4882a593Smuzhiyun
1250*4882a593Smuzhiyun static int
dhd_pno_add_to_ssid_list(dhd_pub_t * dhd,struct list_head * ptr,wlc_ssid_ext_t * ssid_list,int nssid,int * num_ssid_added)1251*4882a593Smuzhiyun dhd_pno_add_to_ssid_list(dhd_pub_t *dhd, struct list_head *ptr, wlc_ssid_ext_t *ssid_list,
1252*4882a593Smuzhiyun int nssid, int *num_ssid_added)
1253*4882a593Smuzhiyun {
1254*4882a593Smuzhiyun int ret = BCME_OK;
1255*4882a593Smuzhiyun int i;
1256*4882a593Smuzhiyun struct dhd_pno_ssid *_pno_ssid;
1257*4882a593Smuzhiyun
1258*4882a593Smuzhiyun for (i = 0; i < nssid; i++) {
1259*4882a593Smuzhiyun if (ssid_list[i].SSID_len > DOT11_MAX_SSID_LEN) {
1260*4882a593Smuzhiyun DHD_ERROR(("%s : Invalid SSID length %d\n",
1261*4882a593Smuzhiyun __FUNCTION__, ssid_list[i].SSID_len));
1262*4882a593Smuzhiyun ret = BCME_ERROR;
1263*4882a593Smuzhiyun goto exit;
1264*4882a593Smuzhiyun }
1265*4882a593Smuzhiyun /* Check for broadcast ssid */
1266*4882a593Smuzhiyun if (!ssid_list[i].SSID_len) {
1267*4882a593Smuzhiyun DHD_ERROR(("%d: Broadcast SSID is illegal for PNO setting\n", i));
1268*4882a593Smuzhiyun ret = BCME_ERROR;
1269*4882a593Smuzhiyun goto exit;
1270*4882a593Smuzhiyun }
1271*4882a593Smuzhiyun _pno_ssid = (struct dhd_pno_ssid *)MALLOCZ(dhd->osh,
1272*4882a593Smuzhiyun sizeof(struct dhd_pno_ssid));
1273*4882a593Smuzhiyun if (_pno_ssid == NULL) {
1274*4882a593Smuzhiyun DHD_ERROR(("%s : failed to allocate struct dhd_pno_ssid\n",
1275*4882a593Smuzhiyun __FUNCTION__));
1276*4882a593Smuzhiyun ret = BCME_ERROR;
1277*4882a593Smuzhiyun goto exit;
1278*4882a593Smuzhiyun }
1279*4882a593Smuzhiyun _pno_ssid->SSID_len = ssid_list[i].SSID_len;
1280*4882a593Smuzhiyun _pno_ssid->hidden = ssid_list[i].hidden;
1281*4882a593Smuzhiyun _pno_ssid->rssi_thresh = ssid_list[i].rssi_thresh;
1282*4882a593Smuzhiyun _pno_ssid->flags = ssid_list[i].flags;
1283*4882a593Smuzhiyun _pno_ssid->wpa_auth = WPA_AUTH_PFN_ANY;
1284*4882a593Smuzhiyun
1285*4882a593Smuzhiyun memcpy(_pno_ssid->SSID, ssid_list[i].SSID, _pno_ssid->SSID_len);
1286*4882a593Smuzhiyun list_add_tail(&_pno_ssid->list, ptr);
1287*4882a593Smuzhiyun }
1288*4882a593Smuzhiyun
1289*4882a593Smuzhiyun exit:
1290*4882a593Smuzhiyun *num_ssid_added = i;
1291*4882a593Smuzhiyun return ret;
1292*4882a593Smuzhiyun }
1293*4882a593Smuzhiyun
1294*4882a593Smuzhiyun int
dhd_pno_set_for_ssid(dhd_pub_t * dhd,wlc_ssid_ext_t * ssid_list,int nssid,uint16 scan_fr,int pno_repeat,int pno_freq_expo_max,uint16 * channel_list,int nchan)1295*4882a593Smuzhiyun dhd_pno_set_for_ssid(dhd_pub_t *dhd, wlc_ssid_ext_t* ssid_list, int nssid,
1296*4882a593Smuzhiyun uint16 scan_fr, int pno_repeat, int pno_freq_expo_max, uint16 *channel_list, int nchan)
1297*4882a593Smuzhiyun {
1298*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
1299*4882a593Smuzhiyun dhd_pno_params_t *_params;
1300*4882a593Smuzhiyun struct dhd_pno_legacy_params *params_legacy;
1301*4882a593Smuzhiyun int err = BCME_OK;
1302*4882a593Smuzhiyun
1303*4882a593Smuzhiyun if (!dhd || !dhd->pno_state) {
1304*4882a593Smuzhiyun DHD_ERROR(("%s: PNO Not enabled/Not ready\n", __FUNCTION__));
1305*4882a593Smuzhiyun return BCME_NOTREADY;
1306*4882a593Smuzhiyun }
1307*4882a593Smuzhiyun
1308*4882a593Smuzhiyun if (!dhd_support_sta_mode(dhd)) {
1309*4882a593Smuzhiyun return BCME_BADOPTION;
1310*4882a593Smuzhiyun }
1311*4882a593Smuzhiyun
1312*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
1313*4882a593Smuzhiyun _params = &(_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS]);
1314*4882a593Smuzhiyun params_legacy = &(_params->params_legacy);
1315*4882a593Smuzhiyun err = _dhd_pno_reinitialize_prof(dhd, _params, DHD_PNO_LEGACY_MODE);
1316*4882a593Smuzhiyun
1317*4882a593Smuzhiyun if (err < 0) {
1318*4882a593Smuzhiyun DHD_ERROR(("%s : failed to reinitialize profile (err %d)\n",
1319*4882a593Smuzhiyun __FUNCTION__, err));
1320*4882a593Smuzhiyun return err;
1321*4882a593Smuzhiyun }
1322*4882a593Smuzhiyun
1323*4882a593Smuzhiyun INIT_LIST_HEAD(¶ms_legacy->ssid_list);
1324*4882a593Smuzhiyun
1325*4882a593Smuzhiyun if (dhd_pno_add_to_ssid_list(dhd, ¶ms_legacy->ssid_list, ssid_list,
1326*4882a593Smuzhiyun nssid, ¶ms_legacy->nssid) < 0) {
1327*4882a593Smuzhiyun _dhd_pno_reinitialize_prof(dhd, _params, DHD_PNO_LEGACY_MODE);
1328*4882a593Smuzhiyun return BCME_ERROR;
1329*4882a593Smuzhiyun }
1330*4882a593Smuzhiyun
1331*4882a593Smuzhiyun DHD_PNO(("%s enter : nssid %d, scan_fr :%d, pno_repeat :%d,"
1332*4882a593Smuzhiyun "pno_freq_expo_max: %d, nchan :%d\n", __FUNCTION__,
1333*4882a593Smuzhiyun params_legacy->nssid, scan_fr, pno_repeat, pno_freq_expo_max, nchan));
1334*4882a593Smuzhiyun
1335*4882a593Smuzhiyun return dhd_pno_set_legacy_pno(dhd, scan_fr, pno_repeat,
1336*4882a593Smuzhiyun pno_freq_expo_max, channel_list, nchan);
1337*4882a593Smuzhiyun
1338*4882a593Smuzhiyun }
1339*4882a593Smuzhiyun
1340*4882a593Smuzhiyun static int
dhd_pno_set_legacy_pno(dhd_pub_t * dhd,uint16 scan_fr,int pno_repeat,int pno_freq_expo_max,uint16 * channel_list,int nchan)1341*4882a593Smuzhiyun dhd_pno_set_legacy_pno(dhd_pub_t *dhd, uint16 scan_fr, int pno_repeat,
1342*4882a593Smuzhiyun int pno_freq_expo_max, uint16 *channel_list, int nchan)
1343*4882a593Smuzhiyun {
1344*4882a593Smuzhiyun dhd_pno_params_t *_params;
1345*4882a593Smuzhiyun dhd_pno_params_t *_params2;
1346*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
1347*4882a593Smuzhiyun uint16 _chan_list[WL_NUMCHANNELS];
1348*4882a593Smuzhiyun int32 tot_nchan = 0;
1349*4882a593Smuzhiyun int err = BCME_OK;
1350*4882a593Smuzhiyun int i, nssid;
1351*4882a593Smuzhiyun int mode = 0;
1352*4882a593Smuzhiyun struct list_head *ssid_list;
1353*4882a593Smuzhiyun
1354*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
1355*4882a593Smuzhiyun
1356*4882a593Smuzhiyun _params = &(_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS]);
1357*4882a593Smuzhiyun /* If GSCAN is also ON will handle this down below */
1358*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
1359*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_LEGACY_MODE &&
1360*4882a593Smuzhiyun !(_pno_state->pno_mode & DHD_PNO_GSCAN_MODE))
1361*4882a593Smuzhiyun #else
1362*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_LEGACY_MODE)
1363*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
1364*4882a593Smuzhiyun {
1365*4882a593Smuzhiyun DHD_ERROR(("%s : Legacy PNO mode was already started, "
1366*4882a593Smuzhiyun "will disable previous one to start new one\n", __FUNCTION__));
1367*4882a593Smuzhiyun err = dhd_pno_stop_for_ssid(dhd);
1368*4882a593Smuzhiyun if (err < 0) {
1369*4882a593Smuzhiyun DHD_ERROR(("%s : failed to stop legacy PNO (err %d)\n",
1370*4882a593Smuzhiyun __FUNCTION__, err));
1371*4882a593Smuzhiyun return err;
1372*4882a593Smuzhiyun }
1373*4882a593Smuzhiyun }
1374*4882a593Smuzhiyun _pno_state->pno_mode |= DHD_PNO_LEGACY_MODE;
1375*4882a593Smuzhiyun (void)memset_s(_chan_list, sizeof(_chan_list),
1376*4882a593Smuzhiyun 0, sizeof(_chan_list));
1377*4882a593Smuzhiyun tot_nchan = MIN(nchan, WL_NUMCHANNELS);
1378*4882a593Smuzhiyun if (tot_nchan > 0 && channel_list) {
1379*4882a593Smuzhiyun for (i = 0; i < tot_nchan; i++)
1380*4882a593Smuzhiyun _params->params_legacy.chan_list[i] = _chan_list[i] = channel_list[i];
1381*4882a593Smuzhiyun }
1382*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
1383*4882a593Smuzhiyun else {
1384*4882a593Smuzhiyun /* FW scan module will include all valid channels when chan count
1385*4882a593Smuzhiyun * is set to 0
1386*4882a593Smuzhiyun */
1387*4882a593Smuzhiyun tot_nchan = 0;
1388*4882a593Smuzhiyun }
1389*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
1390*4882a593Smuzhiyun
1391*4882a593Smuzhiyun if (_pno_state->pno_mode & (DHD_PNO_BATCH_MODE | DHD_PNO_HOTLIST_MODE)) {
1392*4882a593Smuzhiyun DHD_PNO(("BATCH SCAN is on progress in firmware\n"));
1393*4882a593Smuzhiyun /* retrieve the batching data from firmware into host */
1394*4882a593Smuzhiyun dhd_pno_get_for_batch(dhd, NULL, 0, PNO_STATUS_DISABLE);
1395*4882a593Smuzhiyun /* store current pno_mode before disabling pno */
1396*4882a593Smuzhiyun mode = _pno_state->pno_mode;
1397*4882a593Smuzhiyun err = _dhd_pno_enable(dhd, PNO_OFF);
1398*4882a593Smuzhiyun if (err < 0) {
1399*4882a593Smuzhiyun DHD_ERROR(("%s : failed to disable PNO\n", __FUNCTION__));
1400*4882a593Smuzhiyun goto exit;
1401*4882a593Smuzhiyun }
1402*4882a593Smuzhiyun /* restore the previous mode */
1403*4882a593Smuzhiyun _pno_state->pno_mode = mode;
1404*4882a593Smuzhiyun /* use superset of channel list between two mode */
1405*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_BATCH_MODE) {
1406*4882a593Smuzhiyun _params2 = &(_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS]);
1407*4882a593Smuzhiyun if (_params2->params_batch.nchan > 0 && tot_nchan > 0) {
1408*4882a593Smuzhiyun err = _dhd_pno_chan_merge(_chan_list, &tot_nchan,
1409*4882a593Smuzhiyun &_params2->params_batch.chan_list[0],
1410*4882a593Smuzhiyun _params2->params_batch.nchan,
1411*4882a593Smuzhiyun &channel_list[0], tot_nchan);
1412*4882a593Smuzhiyun if (err < 0) {
1413*4882a593Smuzhiyun DHD_ERROR(("%s : failed to merge channel list"
1414*4882a593Smuzhiyun " between legacy and batch\n",
1415*4882a593Smuzhiyun __FUNCTION__));
1416*4882a593Smuzhiyun goto exit;
1417*4882a593Smuzhiyun }
1418*4882a593Smuzhiyun } else {
1419*4882a593Smuzhiyun DHD_PNO(("superset channel will use"
1420*4882a593Smuzhiyun " all channels in firmware\n"));
1421*4882a593Smuzhiyun }
1422*4882a593Smuzhiyun } else if (_pno_state->pno_mode & DHD_PNO_HOTLIST_MODE) {
1423*4882a593Smuzhiyun _params2 = &(_pno_state->pno_params_arr[INDEX_OF_HOTLIST_PARAMS]);
1424*4882a593Smuzhiyun if (_params2->params_hotlist.nchan > 0 && tot_nchan > 0) {
1425*4882a593Smuzhiyun err = _dhd_pno_chan_merge(_chan_list, &tot_nchan,
1426*4882a593Smuzhiyun &_params2->params_hotlist.chan_list[0],
1427*4882a593Smuzhiyun _params2->params_hotlist.nchan,
1428*4882a593Smuzhiyun &channel_list[0], tot_nchan);
1429*4882a593Smuzhiyun if (err < 0) {
1430*4882a593Smuzhiyun DHD_ERROR(("%s : failed to merge channel list"
1431*4882a593Smuzhiyun " between legacy and hotlist\n",
1432*4882a593Smuzhiyun __FUNCTION__));
1433*4882a593Smuzhiyun goto exit;
1434*4882a593Smuzhiyun }
1435*4882a593Smuzhiyun }
1436*4882a593Smuzhiyun }
1437*4882a593Smuzhiyun }
1438*4882a593Smuzhiyun _params->params_legacy.scan_fr = scan_fr;
1439*4882a593Smuzhiyun _params->params_legacy.pno_repeat = pno_repeat;
1440*4882a593Smuzhiyun _params->params_legacy.pno_freq_expo_max = pno_freq_expo_max;
1441*4882a593Smuzhiyun _params->params_legacy.nchan = tot_nchan;
1442*4882a593Smuzhiyun ssid_list = &_params->params_legacy.ssid_list;
1443*4882a593Smuzhiyun nssid = _params->params_legacy.nssid;
1444*4882a593Smuzhiyun
1445*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
1446*4882a593Smuzhiyun /* dhd_pno_initiate_gscan_request will handle simultaneous Legacy PNO and GSCAN */
1447*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_GSCAN_MODE) {
1448*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
1449*4882a593Smuzhiyun gscan_params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS].params_gscan;
1450*4882a593Smuzhiyun /* ePNO and Legacy PNO do not co-exist */
1451*4882a593Smuzhiyun if (gscan_params->epno_cfg.num_epno_ssid) {
1452*4882a593Smuzhiyun DHD_PNO(("ePNO and Legacy PNO do not co-exist\n"));
1453*4882a593Smuzhiyun err = BCME_EPERM;
1454*4882a593Smuzhiyun goto exit;
1455*4882a593Smuzhiyun }
1456*4882a593Smuzhiyun DHD_PNO(("GSCAN mode is ON! Will restart GSCAN+Legacy PNO\n"));
1457*4882a593Smuzhiyun err = dhd_pno_initiate_gscan_request(dhd, 1, 0);
1458*4882a593Smuzhiyun goto exit;
1459*4882a593Smuzhiyun }
1460*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
1461*4882a593Smuzhiyun if ((err = _dhd_pno_set(dhd, _params, DHD_PNO_LEGACY_MODE)) < 0) {
1462*4882a593Smuzhiyun DHD_ERROR(("failed to set call pno_set (err %d) in firmware\n", err));
1463*4882a593Smuzhiyun goto exit;
1464*4882a593Smuzhiyun }
1465*4882a593Smuzhiyun if ((err = _dhd_pno_add_ssid(dhd, ssid_list, nssid)) < 0) {
1466*4882a593Smuzhiyun DHD_ERROR(("failed to add ssid list(err %d), %d in firmware\n", err, nssid));
1467*4882a593Smuzhiyun goto exit;
1468*4882a593Smuzhiyun }
1469*4882a593Smuzhiyun
1470*4882a593Smuzhiyun if ((err = _dhd_pno_cfg(dhd, _chan_list, tot_nchan)) < 0) {
1471*4882a593Smuzhiyun DHD_ERROR(("%s : failed to set call pno_cfg (err %d) in firmware\n",
1472*4882a593Smuzhiyun __FUNCTION__, err));
1473*4882a593Smuzhiyun goto exit;
1474*4882a593Smuzhiyun }
1475*4882a593Smuzhiyun
1476*4882a593Smuzhiyun if (_pno_state->pno_status == DHD_PNO_DISABLED) {
1477*4882a593Smuzhiyun if ((err = _dhd_pno_enable(dhd, PNO_ON)) < 0)
1478*4882a593Smuzhiyun DHD_ERROR(("%s : failed to enable PNO\n", __FUNCTION__));
1479*4882a593Smuzhiyun }
1480*4882a593Smuzhiyun exit:
1481*4882a593Smuzhiyun if (err < 0) {
1482*4882a593Smuzhiyun _dhd_pno_reinitialize_prof(dhd, _params, DHD_PNO_LEGACY_MODE);
1483*4882a593Smuzhiyun }
1484*4882a593Smuzhiyun /* clear mode in case of error */
1485*4882a593Smuzhiyun if (err < 0) {
1486*4882a593Smuzhiyun int ret = dhd_pno_clean(dhd);
1487*4882a593Smuzhiyun
1488*4882a593Smuzhiyun if (ret < 0) {
1489*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call dhd_pno_clean (err: %d)\n",
1490*4882a593Smuzhiyun __FUNCTION__, ret));
1491*4882a593Smuzhiyun } else {
1492*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_LEGACY_MODE;
1493*4882a593Smuzhiyun }
1494*4882a593Smuzhiyun }
1495*4882a593Smuzhiyun return err;
1496*4882a593Smuzhiyun }
1497*4882a593Smuzhiyun
1498*4882a593Smuzhiyun int
dhd_pno_set_for_batch(dhd_pub_t * dhd,struct dhd_pno_batch_params * batch_params)1499*4882a593Smuzhiyun dhd_pno_set_for_batch(dhd_pub_t *dhd, struct dhd_pno_batch_params *batch_params)
1500*4882a593Smuzhiyun {
1501*4882a593Smuzhiyun int err = BCME_OK;
1502*4882a593Smuzhiyun uint16 _chan_list[WL_NUMCHANNELS];
1503*4882a593Smuzhiyun int rem_nchan = 0, tot_nchan = 0;
1504*4882a593Smuzhiyun int mode = 0, mscan = 0;
1505*4882a593Smuzhiyun dhd_pno_params_t *_params;
1506*4882a593Smuzhiyun dhd_pno_params_t *_params2;
1507*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
1508*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
1509*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
1510*4882a593Smuzhiyun NULL_CHECK(batch_params, "batch_params is NULL", err);
1511*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
1512*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
1513*4882a593Smuzhiyun if (!dhd_support_sta_mode(dhd)) {
1514*4882a593Smuzhiyun err = BCME_BADOPTION;
1515*4882a593Smuzhiyun goto exit;
1516*4882a593Smuzhiyun }
1517*4882a593Smuzhiyun if (!WLS_SUPPORTED(_pno_state)) {
1518*4882a593Smuzhiyun DHD_ERROR(("%s : wifi location service is not supported\n", __FUNCTION__));
1519*4882a593Smuzhiyun err = BCME_UNSUPPORTED;
1520*4882a593Smuzhiyun goto exit;
1521*4882a593Smuzhiyun }
1522*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS];
1523*4882a593Smuzhiyun if (!(_pno_state->pno_mode & DHD_PNO_BATCH_MODE)) {
1524*4882a593Smuzhiyun _pno_state->pno_mode |= DHD_PNO_BATCH_MODE;
1525*4882a593Smuzhiyun err = _dhd_pno_reinitialize_prof(dhd, _params, DHD_PNO_BATCH_MODE);
1526*4882a593Smuzhiyun if (err < 0) {
1527*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call _dhd_pno_reinitialize_prof\n",
1528*4882a593Smuzhiyun __FUNCTION__));
1529*4882a593Smuzhiyun goto exit;
1530*4882a593Smuzhiyun }
1531*4882a593Smuzhiyun } else {
1532*4882a593Smuzhiyun /* batch mode is already started */
1533*4882a593Smuzhiyun return -EBUSY;
1534*4882a593Smuzhiyun }
1535*4882a593Smuzhiyun _params->params_batch.scan_fr = batch_params->scan_fr;
1536*4882a593Smuzhiyun _params->params_batch.bestn = batch_params->bestn;
1537*4882a593Smuzhiyun _params->params_batch.mscan = (batch_params->mscan)?
1538*4882a593Smuzhiyun batch_params->mscan : DEFAULT_BATCH_MSCAN;
1539*4882a593Smuzhiyun _params->params_batch.nchan = batch_params->nchan;
1540*4882a593Smuzhiyun memcpy(_params->params_batch.chan_list, batch_params->chan_list,
1541*4882a593Smuzhiyun sizeof(_params->params_batch.chan_list));
1542*4882a593Smuzhiyun
1543*4882a593Smuzhiyun memset(_chan_list, 0, sizeof(_chan_list));
1544*4882a593Smuzhiyun
1545*4882a593Smuzhiyun rem_nchan = ARRAYSIZE(batch_params->chan_list) - batch_params->nchan;
1546*4882a593Smuzhiyun if (batch_params->band == WLC_BAND_2G ||
1547*4882a593Smuzhiyun #ifdef WL_6G_BAND
1548*4882a593Smuzhiyun batch_params->band == WLC_BAND_6G ||
1549*4882a593Smuzhiyun #endif /* WL_6G_BAND */
1550*4882a593Smuzhiyun batch_params->band == WLC_BAND_5G) {
1551*4882a593Smuzhiyun /* get a valid channel list based on band B or A */
1552*4882a593Smuzhiyun err = _dhd_pno_get_channels(dhd,
1553*4882a593Smuzhiyun &_params->params_batch.chan_list[batch_params->nchan],
1554*4882a593Smuzhiyun &rem_nchan, batch_params->band, FALSE);
1555*4882a593Smuzhiyun if (err < 0) {
1556*4882a593Smuzhiyun DHD_ERROR(("%s: failed to get valid channel list(band : %d)\n",
1557*4882a593Smuzhiyun __FUNCTION__, batch_params->band));
1558*4882a593Smuzhiyun goto exit;
1559*4882a593Smuzhiyun }
1560*4882a593Smuzhiyun /* now we need to update nchan because rem_chan has valid channel count */
1561*4882a593Smuzhiyun _params->params_batch.nchan += rem_nchan;
1562*4882a593Smuzhiyun /* need to sort channel list */
1563*4882a593Smuzhiyun sort(_params->params_batch.chan_list, _params->params_batch.nchan,
1564*4882a593Smuzhiyun sizeof(_params->params_batch.chan_list[0]), _dhd_pno_cmpfunc, NULL);
1565*4882a593Smuzhiyun }
1566*4882a593Smuzhiyun #ifdef PNO_DEBUG
1567*4882a593Smuzhiyun {
1568*4882a593Smuzhiyun DHD_PNO(("Channel list : "));
1569*4882a593Smuzhiyun for (i = 0; i < _params->params_batch.nchan; i++) {
1570*4882a593Smuzhiyun DHD_PNO(("%d ", _params->params_batch.chan_list[i]));
1571*4882a593Smuzhiyun }
1572*4882a593Smuzhiyun DHD_PNO(("\n"));
1573*4882a593Smuzhiyun }
1574*4882a593Smuzhiyun #endif
1575*4882a593Smuzhiyun if (_params->params_batch.nchan) {
1576*4882a593Smuzhiyun /* copy the channel list into local array */
1577*4882a593Smuzhiyun memcpy(_chan_list, _params->params_batch.chan_list, sizeof(_chan_list));
1578*4882a593Smuzhiyun tot_nchan = _params->params_batch.nchan;
1579*4882a593Smuzhiyun }
1580*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_LEGACY_MODE) {
1581*4882a593Smuzhiyun DHD_PNO(("PNO SSID is on progress in firmware\n"));
1582*4882a593Smuzhiyun /* store current pno_mode before disabling pno */
1583*4882a593Smuzhiyun mode = _pno_state->pno_mode;
1584*4882a593Smuzhiyun err = _dhd_pno_enable(dhd, PNO_OFF);
1585*4882a593Smuzhiyun if (err < 0) {
1586*4882a593Smuzhiyun DHD_ERROR(("%s : failed to disable PNO\n", __FUNCTION__));
1587*4882a593Smuzhiyun goto exit;
1588*4882a593Smuzhiyun }
1589*4882a593Smuzhiyun /* restore the previous mode */
1590*4882a593Smuzhiyun _pno_state->pno_mode = mode;
1591*4882a593Smuzhiyun /* Use the superset for channelist between two mode */
1592*4882a593Smuzhiyun _params2 = &(_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS]);
1593*4882a593Smuzhiyun if (_params2->params_legacy.nchan > 0 && _params->params_batch.nchan > 0) {
1594*4882a593Smuzhiyun err = _dhd_pno_chan_merge(_chan_list, &tot_nchan,
1595*4882a593Smuzhiyun &_params2->params_legacy.chan_list[0],
1596*4882a593Smuzhiyun _params2->params_legacy.nchan,
1597*4882a593Smuzhiyun &_params->params_batch.chan_list[0], _params->params_batch.nchan);
1598*4882a593Smuzhiyun if (err < 0) {
1599*4882a593Smuzhiyun DHD_ERROR(("%s : failed to merge channel list"
1600*4882a593Smuzhiyun " between legacy and batch\n",
1601*4882a593Smuzhiyun __FUNCTION__));
1602*4882a593Smuzhiyun goto exit;
1603*4882a593Smuzhiyun }
1604*4882a593Smuzhiyun } else {
1605*4882a593Smuzhiyun DHD_PNO(("superset channel will use all channels in firmware\n"));
1606*4882a593Smuzhiyun }
1607*4882a593Smuzhiyun if ((err = _dhd_pno_add_ssid(dhd, &_params2->params_legacy.ssid_list,
1608*4882a593Smuzhiyun _params2->params_legacy.nssid)) < 0) {
1609*4882a593Smuzhiyun DHD_ERROR(("failed to add ssid list (err %d) in firmware\n", err));
1610*4882a593Smuzhiyun goto exit;
1611*4882a593Smuzhiyun }
1612*4882a593Smuzhiyun }
1613*4882a593Smuzhiyun if ((err = _dhd_pno_set(dhd, _params, DHD_PNO_BATCH_MODE)) < 0) {
1614*4882a593Smuzhiyun DHD_ERROR(("%s : failed to set call pno_set (err %d) in firmware\n",
1615*4882a593Smuzhiyun __FUNCTION__, err));
1616*4882a593Smuzhiyun goto exit;
1617*4882a593Smuzhiyun } else {
1618*4882a593Smuzhiyun /* we need to return mscan */
1619*4882a593Smuzhiyun mscan = err;
1620*4882a593Smuzhiyun }
1621*4882a593Smuzhiyun if (tot_nchan > 0) {
1622*4882a593Smuzhiyun if ((err = _dhd_pno_cfg(dhd, _chan_list, tot_nchan)) < 0) {
1623*4882a593Smuzhiyun DHD_ERROR(("%s : failed to set call pno_cfg (err %d) in firmware\n",
1624*4882a593Smuzhiyun __FUNCTION__, err));
1625*4882a593Smuzhiyun goto exit;
1626*4882a593Smuzhiyun }
1627*4882a593Smuzhiyun }
1628*4882a593Smuzhiyun if (_pno_state->pno_status == DHD_PNO_DISABLED) {
1629*4882a593Smuzhiyun if ((err = _dhd_pno_enable(dhd, PNO_ON)) < 0)
1630*4882a593Smuzhiyun DHD_ERROR(("%s : failed to enable PNO\n", __FUNCTION__));
1631*4882a593Smuzhiyun }
1632*4882a593Smuzhiyun exit:
1633*4882a593Smuzhiyun /* clear mode in case of error */
1634*4882a593Smuzhiyun if (err < 0)
1635*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_BATCH_MODE;
1636*4882a593Smuzhiyun else {
1637*4882a593Smuzhiyun /* return #max scan firmware can do */
1638*4882a593Smuzhiyun err = mscan;
1639*4882a593Smuzhiyun }
1640*4882a593Smuzhiyun return err;
1641*4882a593Smuzhiyun }
1642*4882a593Smuzhiyun
1643*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
1644*4882a593Smuzhiyun
1645*4882a593Smuzhiyun static int
dhd_set_epno_params(dhd_pub_t * dhd,wl_ssid_ext_params_t * params,bool set)1646*4882a593Smuzhiyun dhd_set_epno_params(dhd_pub_t *dhd, wl_ssid_ext_params_t *params, bool set)
1647*4882a593Smuzhiyun {
1648*4882a593Smuzhiyun wl_pfn_ssid_cfg_t cfg;
1649*4882a593Smuzhiyun int err;
1650*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL\n", err);
1651*4882a593Smuzhiyun memset(&cfg, 0, sizeof(wl_pfn_ssid_cfg_t));
1652*4882a593Smuzhiyun cfg.version = WL_PFN_SSID_CFG_VERSION;
1653*4882a593Smuzhiyun
1654*4882a593Smuzhiyun /* If asked to clear params (set == FALSE) just set the CLEAR bit */
1655*4882a593Smuzhiyun if (!set)
1656*4882a593Smuzhiyun cfg.flags |= WL_PFN_SSID_CFG_CLEAR;
1657*4882a593Smuzhiyun else if (params)
1658*4882a593Smuzhiyun memcpy(&cfg.params, params, sizeof(wl_ssid_ext_params_t));
1659*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfn_ssid_cfg", (char *)&cfg,
1660*4882a593Smuzhiyun sizeof(wl_pfn_ssid_cfg_t), NULL, 0, TRUE);
1661*4882a593Smuzhiyun if (err != BCME_OK) {
1662*4882a593Smuzhiyun DHD_ERROR(("%s : Failed to execute pfn_ssid_cfg %d\n", __FUNCTION__, err));
1663*4882a593Smuzhiyun }
1664*4882a593Smuzhiyun return err;
1665*4882a593Smuzhiyun }
1666*4882a593Smuzhiyun
1667*4882a593Smuzhiyun int
dhd_pno_flush_fw_epno(dhd_pub_t * dhd)1668*4882a593Smuzhiyun dhd_pno_flush_fw_epno(dhd_pub_t *dhd)
1669*4882a593Smuzhiyun {
1670*4882a593Smuzhiyun int err;
1671*4882a593Smuzhiyun
1672*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL\n", err);
1673*4882a593Smuzhiyun
1674*4882a593Smuzhiyun err = dhd_set_epno_params(dhd, NULL, FALSE);
1675*4882a593Smuzhiyun if (err < 0) {
1676*4882a593Smuzhiyun DHD_ERROR(("failed to set ePNO params %d\n", err));
1677*4882a593Smuzhiyun return err;
1678*4882a593Smuzhiyun }
1679*4882a593Smuzhiyun err = _dhd_pno_flush_ssid(dhd);
1680*4882a593Smuzhiyun return err;
1681*4882a593Smuzhiyun }
1682*4882a593Smuzhiyun
1683*4882a593Smuzhiyun int
dhd_pno_set_epno(dhd_pub_t * dhd)1684*4882a593Smuzhiyun dhd_pno_set_epno(dhd_pub_t *dhd)
1685*4882a593Smuzhiyun {
1686*4882a593Smuzhiyun int err = BCME_OK;
1687*4882a593Smuzhiyun dhd_pno_params_t *params;
1688*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
1689*4882a593Smuzhiyun
1690*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
1691*4882a593Smuzhiyun
1692*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL\n", err);
1693*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
1694*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
1695*4882a593Smuzhiyun params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
1696*4882a593Smuzhiyun gscan_params = ¶ms->params_gscan;
1697*4882a593Smuzhiyun
1698*4882a593Smuzhiyun if (gscan_params->epno_cfg.num_epno_ssid) {
1699*4882a593Smuzhiyun DHD_PNO(("num_epno_ssid %d\n", gscan_params->epno_cfg.num_epno_ssid));
1700*4882a593Smuzhiyun if ((err = _dhd_pno_add_ssid(dhd, &gscan_params->epno_cfg.epno_ssid_list,
1701*4882a593Smuzhiyun gscan_params->epno_cfg.num_epno_ssid)) < 0) {
1702*4882a593Smuzhiyun DHD_ERROR(("failed to add ssid list (err %d) to firmware\n", err));
1703*4882a593Smuzhiyun return err;
1704*4882a593Smuzhiyun }
1705*4882a593Smuzhiyun err = dhd_set_epno_params(dhd, &gscan_params->epno_cfg.params, TRUE);
1706*4882a593Smuzhiyun if (err < 0) {
1707*4882a593Smuzhiyun DHD_ERROR(("failed to set ePNO params %d\n", err));
1708*4882a593Smuzhiyun }
1709*4882a593Smuzhiyun }
1710*4882a593Smuzhiyun return err;
1711*4882a593Smuzhiyun }
1712*4882a593Smuzhiyun
1713*4882a593Smuzhiyun static void
dhd_pno_reset_cfg_gscan(dhd_pub_t * dhd,dhd_pno_params_t * _params,dhd_pno_status_info_t * _pno_state,uint8 flags)1714*4882a593Smuzhiyun dhd_pno_reset_cfg_gscan(dhd_pub_t *dhd, dhd_pno_params_t *_params,
1715*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state, uint8 flags)
1716*4882a593Smuzhiyun {
1717*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
1718*4882a593Smuzhiyun
1719*4882a593Smuzhiyun if (flags & GSCAN_FLUSH_SCAN_CFG) {
1720*4882a593Smuzhiyun _params->params_gscan.bestn = 0;
1721*4882a593Smuzhiyun _params->params_gscan.mscan = 0;
1722*4882a593Smuzhiyun _params->params_gscan.buffer_threshold = GSCAN_BATCH_NO_THR_SET;
1723*4882a593Smuzhiyun _params->params_gscan.scan_fr = 0;
1724*4882a593Smuzhiyun _params->params_gscan.send_all_results_flag = 0;
1725*4882a593Smuzhiyun memset(_params->params_gscan.channel_bucket, 0,
1726*4882a593Smuzhiyun _params->params_gscan.nchannel_buckets *
1727*4882a593Smuzhiyun sizeof(struct dhd_pno_gscan_channel_bucket));
1728*4882a593Smuzhiyun _params->params_gscan.nchannel_buckets = 0;
1729*4882a593Smuzhiyun DHD_PNO(("Flush Scan config\n"));
1730*4882a593Smuzhiyun }
1731*4882a593Smuzhiyun if (flags & GSCAN_FLUSH_HOTLIST_CFG) {
1732*4882a593Smuzhiyun struct dhd_pno_bssid *iter, *next;
1733*4882a593Smuzhiyun if (_params->params_gscan.nbssid_hotlist > 0) {
1734*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
1735*4882a593Smuzhiyun list_for_each_entry_safe(iter, next,
1736*4882a593Smuzhiyun &_params->params_gscan.hotlist_bssid_list, list) {
1737*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
1738*4882a593Smuzhiyun list_del(&iter->list);
1739*4882a593Smuzhiyun MFREE(dhd->osh, iter, sizeof(struct dhd_pno_bssid));
1740*4882a593Smuzhiyun }
1741*4882a593Smuzhiyun }
1742*4882a593Smuzhiyun _params->params_gscan.nbssid_hotlist = 0;
1743*4882a593Smuzhiyun DHD_PNO(("Flush Hotlist Config\n"));
1744*4882a593Smuzhiyun }
1745*4882a593Smuzhiyun if (flags & GSCAN_FLUSH_EPNO_CFG) {
1746*4882a593Smuzhiyun dhd_pno_ssid_t *iter, *next;
1747*4882a593Smuzhiyun dhd_epno_ssid_cfg_t *epno_cfg = &_params->params_gscan.epno_cfg;
1748*4882a593Smuzhiyun
1749*4882a593Smuzhiyun if (epno_cfg->num_epno_ssid > 0) {
1750*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
1751*4882a593Smuzhiyun list_for_each_entry_safe(iter, next,
1752*4882a593Smuzhiyun &epno_cfg->epno_ssid_list, list) {
1753*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
1754*4882a593Smuzhiyun list_del(&iter->list);
1755*4882a593Smuzhiyun MFREE(dhd->osh, iter, sizeof(struct dhd_pno_bssid));
1756*4882a593Smuzhiyun }
1757*4882a593Smuzhiyun epno_cfg->num_epno_ssid = 0;
1758*4882a593Smuzhiyun }
1759*4882a593Smuzhiyun memset(&epno_cfg->params, 0, sizeof(wl_ssid_ext_params_t));
1760*4882a593Smuzhiyun DHD_PNO(("Flushed ePNO Config\n"));
1761*4882a593Smuzhiyun }
1762*4882a593Smuzhiyun
1763*4882a593Smuzhiyun return;
1764*4882a593Smuzhiyun }
1765*4882a593Smuzhiyun
1766*4882a593Smuzhiyun int
dhd_pno_lock_batch_results(dhd_pub_t * dhd)1767*4882a593Smuzhiyun dhd_pno_lock_batch_results(dhd_pub_t *dhd)
1768*4882a593Smuzhiyun {
1769*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
1770*4882a593Smuzhiyun int err = BCME_OK;
1771*4882a593Smuzhiyun
1772*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
1773*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
1774*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
1775*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
1776*4882a593Smuzhiyun return err;
1777*4882a593Smuzhiyun }
1778*4882a593Smuzhiyun
1779*4882a593Smuzhiyun void
dhd_pno_unlock_batch_results(dhd_pub_t * dhd)1780*4882a593Smuzhiyun dhd_pno_unlock_batch_results(dhd_pub_t *dhd)
1781*4882a593Smuzhiyun {
1782*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
1783*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
1784*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
1785*4882a593Smuzhiyun return;
1786*4882a593Smuzhiyun }
1787*4882a593Smuzhiyun
1788*4882a593Smuzhiyun int
dhd_wait_batch_results_complete(dhd_pub_t * dhd)1789*4882a593Smuzhiyun dhd_wait_batch_results_complete(dhd_pub_t *dhd)
1790*4882a593Smuzhiyun {
1791*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
1792*4882a593Smuzhiyun dhd_pno_params_t *_params;
1793*4882a593Smuzhiyun int err = BCME_OK;
1794*4882a593Smuzhiyun
1795*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
1796*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
1797*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
1798*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
1799*4882a593Smuzhiyun
1800*4882a593Smuzhiyun /* Has the workqueue finished its job already?? */
1801*4882a593Smuzhiyun if (_params->params_gscan.get_batch_flag == GSCAN_BATCH_RETRIEVAL_IN_PROGRESS) {
1802*4882a593Smuzhiyun DHD_PNO(("%s: Waiting to complete retrieval..\n", __FUNCTION__));
1803*4882a593Smuzhiyun wait_event_interruptible_timeout(_pno_state->batch_get_wait,
1804*4882a593Smuzhiyun is_batch_retrieval_complete(&_params->params_gscan),
1805*4882a593Smuzhiyun msecs_to_jiffies(GSCAN_BATCH_GET_MAX_WAIT));
1806*4882a593Smuzhiyun } else { /* GSCAN_BATCH_RETRIEVAL_COMPLETE */
1807*4882a593Smuzhiyun gscan_results_cache_t *iter;
1808*4882a593Smuzhiyun uint16 num_results = 0;
1809*4882a593Smuzhiyun
1810*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
1811*4882a593Smuzhiyun iter = _params->params_gscan.gscan_batch_cache;
1812*4882a593Smuzhiyun while (iter) {
1813*4882a593Smuzhiyun num_results += iter->tot_count - iter->tot_consumed;
1814*4882a593Smuzhiyun iter = iter->next;
1815*4882a593Smuzhiyun }
1816*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
1817*4882a593Smuzhiyun
1818*4882a593Smuzhiyun /* All results consumed/No results cached??
1819*4882a593Smuzhiyun * Get fresh results from FW
1820*4882a593Smuzhiyun */
1821*4882a593Smuzhiyun if ((_pno_state->pno_mode & DHD_PNO_GSCAN_MODE) && !num_results) {
1822*4882a593Smuzhiyun DHD_PNO(("%s: No results cached, getting from FW..\n", __FUNCTION__));
1823*4882a593Smuzhiyun err = dhd_retreive_batch_scan_results(dhd);
1824*4882a593Smuzhiyun if (err == BCME_OK) {
1825*4882a593Smuzhiyun wait_event_interruptible_timeout(_pno_state->batch_get_wait,
1826*4882a593Smuzhiyun is_batch_retrieval_complete(&_params->params_gscan),
1827*4882a593Smuzhiyun msecs_to_jiffies(GSCAN_BATCH_GET_MAX_WAIT));
1828*4882a593Smuzhiyun }
1829*4882a593Smuzhiyun }
1830*4882a593Smuzhiyun }
1831*4882a593Smuzhiyun DHD_PNO(("%s: Wait complete\n", __FUNCTION__));
1832*4882a593Smuzhiyun return err;
1833*4882a593Smuzhiyun }
1834*4882a593Smuzhiyun
1835*4882a593Smuzhiyun int
dhd_pno_set_cfg_gscan(dhd_pub_t * dhd,dhd_pno_gscan_cmd_cfg_t type,void * buf,bool flush)1836*4882a593Smuzhiyun dhd_pno_set_cfg_gscan(dhd_pub_t *dhd, dhd_pno_gscan_cmd_cfg_t type,
1837*4882a593Smuzhiyun void *buf, bool flush)
1838*4882a593Smuzhiyun {
1839*4882a593Smuzhiyun int err = BCME_OK;
1840*4882a593Smuzhiyun dhd_pno_params_t *_params;
1841*4882a593Smuzhiyun int i;
1842*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
1843*4882a593Smuzhiyun
1844*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
1845*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
1846*4882a593Smuzhiyun
1847*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
1848*4882a593Smuzhiyun
1849*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
1850*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
1851*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
1852*4882a593Smuzhiyun
1853*4882a593Smuzhiyun switch (type) {
1854*4882a593Smuzhiyun case DHD_PNO_BATCH_SCAN_CFG_ID:
1855*4882a593Smuzhiyun {
1856*4882a593Smuzhiyun gscan_batch_params_t *ptr = (gscan_batch_params_t *)buf;
1857*4882a593Smuzhiyun _params->params_gscan.bestn = ptr->bestn;
1858*4882a593Smuzhiyun _params->params_gscan.mscan = ptr->mscan;
1859*4882a593Smuzhiyun _params->params_gscan.buffer_threshold = ptr->buffer_threshold;
1860*4882a593Smuzhiyun }
1861*4882a593Smuzhiyun break;
1862*4882a593Smuzhiyun case DHD_PNO_GEOFENCE_SCAN_CFG_ID:
1863*4882a593Smuzhiyun {
1864*4882a593Smuzhiyun gscan_hotlist_scan_params_t *ptr = (gscan_hotlist_scan_params_t *)buf;
1865*4882a593Smuzhiyun struct dhd_pno_bssid *_pno_bssid;
1866*4882a593Smuzhiyun struct bssid_t *bssid_ptr;
1867*4882a593Smuzhiyun int8 flags;
1868*4882a593Smuzhiyun
1869*4882a593Smuzhiyun if (flush) {
1870*4882a593Smuzhiyun dhd_pno_reset_cfg_gscan(dhd, _params, _pno_state,
1871*4882a593Smuzhiyun GSCAN_FLUSH_HOTLIST_CFG);
1872*4882a593Smuzhiyun }
1873*4882a593Smuzhiyun
1874*4882a593Smuzhiyun if (!ptr->nbssid) {
1875*4882a593Smuzhiyun break;
1876*4882a593Smuzhiyun }
1877*4882a593Smuzhiyun if (!_params->params_gscan.nbssid_hotlist) {
1878*4882a593Smuzhiyun INIT_LIST_HEAD(&_params->params_gscan.hotlist_bssid_list);
1879*4882a593Smuzhiyun }
1880*4882a593Smuzhiyun
1881*4882a593Smuzhiyun if ((_params->params_gscan.nbssid_hotlist +
1882*4882a593Smuzhiyun ptr->nbssid) > PFN_SWC_MAX_NUM_APS) {
1883*4882a593Smuzhiyun DHD_ERROR(("Excessive number of hotlist APs programmed %d\n",
1884*4882a593Smuzhiyun (_params->params_gscan.nbssid_hotlist +
1885*4882a593Smuzhiyun ptr->nbssid)));
1886*4882a593Smuzhiyun err = BCME_RANGE;
1887*4882a593Smuzhiyun goto exit;
1888*4882a593Smuzhiyun }
1889*4882a593Smuzhiyun
1890*4882a593Smuzhiyun for (i = 0, bssid_ptr = ptr->bssid; i < ptr->nbssid; i++, bssid_ptr++) {
1891*4882a593Smuzhiyun _pno_bssid = (struct dhd_pno_bssid *)MALLOCZ(dhd->osh,
1892*4882a593Smuzhiyun sizeof(struct dhd_pno_bssid));
1893*4882a593Smuzhiyun if (!_pno_bssid) {
1894*4882a593Smuzhiyun DHD_ERROR(("_pno_bssid is NULL, cannot kalloc %zd bytes",
1895*4882a593Smuzhiyun sizeof(struct dhd_pno_bssid)));
1896*4882a593Smuzhiyun err = BCME_NOMEM;
1897*4882a593Smuzhiyun goto exit;
1898*4882a593Smuzhiyun }
1899*4882a593Smuzhiyun memcpy(&_pno_bssid->macaddr, &bssid_ptr->macaddr, ETHER_ADDR_LEN);
1900*4882a593Smuzhiyun
1901*4882a593Smuzhiyun flags = (int8) bssid_ptr->rssi_reporting_threshold;
1902*4882a593Smuzhiyun _pno_bssid->flags = flags << WL_PFN_RSSI_SHIFT;
1903*4882a593Smuzhiyun list_add_tail(&_pno_bssid->list,
1904*4882a593Smuzhiyun &_params->params_gscan.hotlist_bssid_list);
1905*4882a593Smuzhiyun }
1906*4882a593Smuzhiyun
1907*4882a593Smuzhiyun _params->params_gscan.nbssid_hotlist += ptr->nbssid;
1908*4882a593Smuzhiyun _params->params_gscan.lost_ap_window = ptr->lost_ap_window;
1909*4882a593Smuzhiyun }
1910*4882a593Smuzhiyun break;
1911*4882a593Smuzhiyun case DHD_PNO_SCAN_CFG_ID:
1912*4882a593Smuzhiyun {
1913*4882a593Smuzhiyun int k;
1914*4882a593Smuzhiyun uint16 band;
1915*4882a593Smuzhiyun gscan_scan_params_t *ptr = (gscan_scan_params_t *)buf;
1916*4882a593Smuzhiyun struct dhd_pno_gscan_channel_bucket *ch_bucket;
1917*4882a593Smuzhiyun
1918*4882a593Smuzhiyun if (ptr->nchannel_buckets <= GSCAN_MAX_CH_BUCKETS) {
1919*4882a593Smuzhiyun _params->params_gscan.nchannel_buckets = ptr->nchannel_buckets;
1920*4882a593Smuzhiyun
1921*4882a593Smuzhiyun memcpy(_params->params_gscan.channel_bucket, ptr->channel_bucket,
1922*4882a593Smuzhiyun _params->params_gscan.nchannel_buckets *
1923*4882a593Smuzhiyun sizeof(struct dhd_pno_gscan_channel_bucket));
1924*4882a593Smuzhiyun ch_bucket = _params->params_gscan.channel_bucket;
1925*4882a593Smuzhiyun
1926*4882a593Smuzhiyun for (i = 0; i < ptr->nchannel_buckets; i++) {
1927*4882a593Smuzhiyun band = ch_bucket[i].band;
1928*4882a593Smuzhiyun for (k = 0; k < ptr->channel_bucket[i].num_channels; k++) {
1929*4882a593Smuzhiyun ch_bucket[i].chan_list[k] =
1930*4882a593Smuzhiyun wf_mhz2channel(ptr->channel_bucket[i].chan_list[k],
1931*4882a593Smuzhiyun 0);
1932*4882a593Smuzhiyun }
1933*4882a593Smuzhiyun ch_bucket[i].band = 0;
1934*4882a593Smuzhiyun /* HAL and DHD use different bits for 2.4G and
1935*4882a593Smuzhiyun * 5G in bitmap. Hence translating it here...
1936*4882a593Smuzhiyun */
1937*4882a593Smuzhiyun if (band & GSCAN_BG_BAND_MASK) {
1938*4882a593Smuzhiyun ch_bucket[i].band |= WLC_BAND_2G;
1939*4882a593Smuzhiyun }
1940*4882a593Smuzhiyun if (band & GSCAN_A_BAND_MASK) {
1941*4882a593Smuzhiyun ch_bucket[i].band |= WLC_BAND_6G | WLC_BAND_5G;
1942*4882a593Smuzhiyun }
1943*4882a593Smuzhiyun if (band & GSCAN_DFS_MASK) {
1944*4882a593Smuzhiyun ch_bucket[i].band |= GSCAN_DFS_MASK;
1945*4882a593Smuzhiyun }
1946*4882a593Smuzhiyun DHD_PNO(("band %d report_flag %d\n", ch_bucket[i].band,
1947*4882a593Smuzhiyun ch_bucket[i].report_flag));
1948*4882a593Smuzhiyun }
1949*4882a593Smuzhiyun
1950*4882a593Smuzhiyun for (i = 0; i < ptr->nchannel_buckets; i++) {
1951*4882a593Smuzhiyun ch_bucket[i].bucket_freq_multiple =
1952*4882a593Smuzhiyun ch_bucket[i].bucket_freq_multiple/ptr->scan_fr;
1953*4882a593Smuzhiyun ch_bucket[i].bucket_max_multiple =
1954*4882a593Smuzhiyun ch_bucket[i].bucket_max_multiple/ptr->scan_fr;
1955*4882a593Smuzhiyun DHD_PNO(("mult %d max_mult %d\n",
1956*4882a593Smuzhiyun ch_bucket[i].bucket_freq_multiple,
1957*4882a593Smuzhiyun ch_bucket[i].bucket_max_multiple));
1958*4882a593Smuzhiyun }
1959*4882a593Smuzhiyun _params->params_gscan.scan_fr = ptr->scan_fr;
1960*4882a593Smuzhiyun
1961*4882a593Smuzhiyun DHD_PNO(("num_buckets %d scan_fr %d\n", ptr->nchannel_buckets,
1962*4882a593Smuzhiyun _params->params_gscan.scan_fr));
1963*4882a593Smuzhiyun } else {
1964*4882a593Smuzhiyun err = BCME_BADARG;
1965*4882a593Smuzhiyun }
1966*4882a593Smuzhiyun }
1967*4882a593Smuzhiyun break;
1968*4882a593Smuzhiyun case DHD_PNO_EPNO_CFG_ID:
1969*4882a593Smuzhiyun if (flush) {
1970*4882a593Smuzhiyun dhd_pno_reset_cfg_gscan(dhd, _params, _pno_state,
1971*4882a593Smuzhiyun GSCAN_FLUSH_EPNO_CFG);
1972*4882a593Smuzhiyun }
1973*4882a593Smuzhiyun break;
1974*4882a593Smuzhiyun case DHD_PNO_EPNO_PARAMS_ID:
1975*4882a593Smuzhiyun if (flush) {
1976*4882a593Smuzhiyun memset(&_params->params_gscan.epno_cfg.params, 0,
1977*4882a593Smuzhiyun sizeof(wl_ssid_ext_params_t));
1978*4882a593Smuzhiyun }
1979*4882a593Smuzhiyun if (buf) {
1980*4882a593Smuzhiyun memcpy(&_params->params_gscan.epno_cfg.params, buf,
1981*4882a593Smuzhiyun sizeof(wl_ssid_ext_params_t));
1982*4882a593Smuzhiyun }
1983*4882a593Smuzhiyun break;
1984*4882a593Smuzhiyun default:
1985*4882a593Smuzhiyun err = BCME_BADARG;
1986*4882a593Smuzhiyun DHD_ERROR(("%s: Unrecognized cmd type - %d\n", __FUNCTION__, type));
1987*4882a593Smuzhiyun break;
1988*4882a593Smuzhiyun }
1989*4882a593Smuzhiyun exit:
1990*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
1991*4882a593Smuzhiyun return err;
1992*4882a593Smuzhiyun
1993*4882a593Smuzhiyun }
1994*4882a593Smuzhiyun
1995*4882a593Smuzhiyun static bool
validate_gscan_params(struct dhd_pno_gscan_params * gscan_params)1996*4882a593Smuzhiyun validate_gscan_params(struct dhd_pno_gscan_params *gscan_params)
1997*4882a593Smuzhiyun {
1998*4882a593Smuzhiyun unsigned int i, k;
1999*4882a593Smuzhiyun
2000*4882a593Smuzhiyun if (!gscan_params->scan_fr || !gscan_params->nchannel_buckets) {
2001*4882a593Smuzhiyun DHD_ERROR(("%s : Scan freq - %d or number of channel buckets - %d is empty\n",
2002*4882a593Smuzhiyun __FUNCTION__, gscan_params->scan_fr, gscan_params->nchannel_buckets));
2003*4882a593Smuzhiyun return false;
2004*4882a593Smuzhiyun }
2005*4882a593Smuzhiyun
2006*4882a593Smuzhiyun for (i = 0; i < gscan_params->nchannel_buckets; i++) {
2007*4882a593Smuzhiyun if (!gscan_params->channel_bucket[i].band) {
2008*4882a593Smuzhiyun for (k = 0; k < gscan_params->channel_bucket[i].num_channels; k++) {
2009*4882a593Smuzhiyun if (gscan_params->channel_bucket[i].chan_list[k] > CHANNEL_5G_MAX) {
2010*4882a593Smuzhiyun DHD_ERROR(("%s : Unknown channel %d\n", __FUNCTION__,
2011*4882a593Smuzhiyun gscan_params->channel_bucket[i].chan_list[k]));
2012*4882a593Smuzhiyun return false;
2013*4882a593Smuzhiyun }
2014*4882a593Smuzhiyun }
2015*4882a593Smuzhiyun }
2016*4882a593Smuzhiyun }
2017*4882a593Smuzhiyun
2018*4882a593Smuzhiyun return true;
2019*4882a593Smuzhiyun }
2020*4882a593Smuzhiyun
2021*4882a593Smuzhiyun static int
dhd_pno_set_for_gscan(dhd_pub_t * dhd,struct dhd_pno_gscan_params * gscan_params)2022*4882a593Smuzhiyun dhd_pno_set_for_gscan(dhd_pub_t *dhd, struct dhd_pno_gscan_params *gscan_params)
2023*4882a593Smuzhiyun {
2024*4882a593Smuzhiyun int err = BCME_OK;
2025*4882a593Smuzhiyun int mode, i = 0;
2026*4882a593Smuzhiyun uint16 _chan_list[WL_NUMCHANNELS];
2027*4882a593Smuzhiyun int tot_nchan = 0;
2028*4882a593Smuzhiyun int num_buckets_to_fw, tot_num_buckets, gscan_param_size;
2029*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state = PNO_GET_PNOSTATE(dhd);
2030*4882a593Smuzhiyun wl_pfn_gscan_ch_bucket_cfg_t *ch_bucket = NULL;
2031*4882a593Smuzhiyun wl_pfn_gscan_cfg_t *pfn_gscan_cfg_t = NULL;
2032*4882a593Smuzhiyun wl_pfn_bssid_t *p_pfn_bssid = NULL;
2033*4882a593Smuzhiyun dhd_pno_params_t *_params;
2034*4882a593Smuzhiyun bool fw_flushed = FALSE;
2035*4882a593Smuzhiyun
2036*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
2037*4882a593Smuzhiyun
2038*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
2039*4882a593Smuzhiyun NULL_CHECK(gscan_params, "gscan_params is NULL", err);
2040*4882a593Smuzhiyun
2041*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
2042*4882a593Smuzhiyun
2043*4882a593Smuzhiyun if (!dhd_support_sta_mode(dhd)) {
2044*4882a593Smuzhiyun err = BCME_BADOPTION;
2045*4882a593Smuzhiyun goto exit;
2046*4882a593Smuzhiyun }
2047*4882a593Smuzhiyun if (!WLS_SUPPORTED(_pno_state)) {
2048*4882a593Smuzhiyun DHD_ERROR(("%s : wifi location service is not supported\n", __FUNCTION__));
2049*4882a593Smuzhiyun err = BCME_UNSUPPORTED;
2050*4882a593Smuzhiyun goto exit;
2051*4882a593Smuzhiyun }
2052*4882a593Smuzhiyun
2053*4882a593Smuzhiyun if (!validate_gscan_params(gscan_params)) {
2054*4882a593Smuzhiyun DHD_ERROR(("%s : Cannot start gscan - bad params\n", __FUNCTION__));
2055*4882a593Smuzhiyun err = BCME_BADARG;
2056*4882a593Smuzhiyun goto exit;
2057*4882a593Smuzhiyun }
2058*4882a593Smuzhiyun
2059*4882a593Smuzhiyun if (!(ch_bucket = dhd_pno_gscan_create_channel_list(dhd, _pno_state,
2060*4882a593Smuzhiyun _chan_list, &tot_num_buckets, &num_buckets_to_fw))) {
2061*4882a593Smuzhiyun goto exit;
2062*4882a593Smuzhiyun }
2063*4882a593Smuzhiyun
2064*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
2065*4882a593Smuzhiyun /* Clear any pre-existing results in our cache
2066*4882a593Smuzhiyun * not consumed by framework
2067*4882a593Smuzhiyun */
2068*4882a593Smuzhiyun dhd_gscan_clear_all_batch_results(dhd);
2069*4882a593Smuzhiyun if (_pno_state->pno_mode & (DHD_PNO_GSCAN_MODE | DHD_PNO_LEGACY_MODE)) {
2070*4882a593Smuzhiyun /* store current pno_mode before disabling pno */
2071*4882a593Smuzhiyun mode = _pno_state->pno_mode;
2072*4882a593Smuzhiyun err = dhd_pno_clean(dhd);
2073*4882a593Smuzhiyun if (err < 0) {
2074*4882a593Smuzhiyun DHD_ERROR(("%s : failed to disable PNO\n", __FUNCTION__));
2075*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
2076*4882a593Smuzhiyun goto exit;
2077*4882a593Smuzhiyun }
2078*4882a593Smuzhiyun fw_flushed = TRUE;
2079*4882a593Smuzhiyun /* restore the previous mode */
2080*4882a593Smuzhiyun _pno_state->pno_mode = mode;
2081*4882a593Smuzhiyun }
2082*4882a593Smuzhiyun _pno_state->pno_mode |= DHD_PNO_GSCAN_MODE;
2083*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
2084*4882a593Smuzhiyun
2085*4882a593Smuzhiyun if ((_pno_state->pno_mode & DHD_PNO_LEGACY_MODE) &&
2086*4882a593Smuzhiyun !gscan_params->epno_cfg.num_epno_ssid) {
2087*4882a593Smuzhiyun struct dhd_pno_legacy_params *params_legacy;
2088*4882a593Smuzhiyun params_legacy =
2089*4882a593Smuzhiyun &(_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS].params_legacy);
2090*4882a593Smuzhiyun
2091*4882a593Smuzhiyun if ((err = _dhd_pno_add_ssid(dhd, ¶ms_legacy->ssid_list,
2092*4882a593Smuzhiyun params_legacy->nssid)) < 0) {
2093*4882a593Smuzhiyun DHD_ERROR(("failed to add ssid list (err %d) in firmware\n", err));
2094*4882a593Smuzhiyun goto exit;
2095*4882a593Smuzhiyun }
2096*4882a593Smuzhiyun }
2097*4882a593Smuzhiyun
2098*4882a593Smuzhiyun if ((err = _dhd_pno_set(dhd, _params, DHD_PNO_GSCAN_MODE)) < 0) {
2099*4882a593Smuzhiyun DHD_ERROR(("failed to set call pno_set (err %d) in firmware\n", err));
2100*4882a593Smuzhiyun goto exit;
2101*4882a593Smuzhiyun }
2102*4882a593Smuzhiyun
2103*4882a593Smuzhiyun gscan_param_size = sizeof(wl_pfn_gscan_cfg_t) +
2104*4882a593Smuzhiyun (num_buckets_to_fw - 1) * sizeof(wl_pfn_gscan_ch_bucket_cfg_t);
2105*4882a593Smuzhiyun pfn_gscan_cfg_t = (wl_pfn_gscan_cfg_t *) MALLOCZ(dhd->osh, gscan_param_size);
2106*4882a593Smuzhiyun
2107*4882a593Smuzhiyun if (!pfn_gscan_cfg_t) {
2108*4882a593Smuzhiyun DHD_ERROR(("%s: failed to malloc memory of size %d\n",
2109*4882a593Smuzhiyun __FUNCTION__, gscan_param_size));
2110*4882a593Smuzhiyun err = BCME_NOMEM;
2111*4882a593Smuzhiyun goto exit;
2112*4882a593Smuzhiyun }
2113*4882a593Smuzhiyun
2114*4882a593Smuzhiyun pfn_gscan_cfg_t->version = WL_GSCAN_CFG_VERSION;
2115*4882a593Smuzhiyun if (gscan_params->mscan)
2116*4882a593Smuzhiyun pfn_gscan_cfg_t->buffer_threshold = gscan_params->buffer_threshold;
2117*4882a593Smuzhiyun else
2118*4882a593Smuzhiyun pfn_gscan_cfg_t->buffer_threshold = GSCAN_BATCH_NO_THR_SET;
2119*4882a593Smuzhiyun
2120*4882a593Smuzhiyun pfn_gscan_cfg_t->flags =
2121*4882a593Smuzhiyun (gscan_params->send_all_results_flag & GSCAN_SEND_ALL_RESULTS_MASK);
2122*4882a593Smuzhiyun pfn_gscan_cfg_t->flags |= GSCAN_ALL_BUCKETS_IN_FIRST_SCAN_MASK;
2123*4882a593Smuzhiyun pfn_gscan_cfg_t->count_of_channel_buckets = num_buckets_to_fw;
2124*4882a593Smuzhiyun pfn_gscan_cfg_t->retry_threshold = GSCAN_RETRY_THRESHOLD;
2125*4882a593Smuzhiyun
2126*4882a593Smuzhiyun for (i = 0; i < num_buckets_to_fw; i++) {
2127*4882a593Smuzhiyun pfn_gscan_cfg_t->channel_bucket[i].bucket_end_index =
2128*4882a593Smuzhiyun ch_bucket[i].bucket_end_index;
2129*4882a593Smuzhiyun pfn_gscan_cfg_t->channel_bucket[i].bucket_freq_multiple =
2130*4882a593Smuzhiyun ch_bucket[i].bucket_freq_multiple;
2131*4882a593Smuzhiyun pfn_gscan_cfg_t->channel_bucket[i].max_freq_multiple =
2132*4882a593Smuzhiyun ch_bucket[i].max_freq_multiple;
2133*4882a593Smuzhiyun pfn_gscan_cfg_t->channel_bucket[i].repeat =
2134*4882a593Smuzhiyun ch_bucket[i].repeat;
2135*4882a593Smuzhiyun pfn_gscan_cfg_t->channel_bucket[i].flag =
2136*4882a593Smuzhiyun ch_bucket[i].flag;
2137*4882a593Smuzhiyun }
2138*4882a593Smuzhiyun
2139*4882a593Smuzhiyun tot_nchan = pfn_gscan_cfg_t->channel_bucket[num_buckets_to_fw - 1].bucket_end_index + 1;
2140*4882a593Smuzhiyun DHD_PNO(("Total channel num %d total ch_buckets %d ch_buckets_to_fw %d \n", tot_nchan,
2141*4882a593Smuzhiyun tot_num_buckets, num_buckets_to_fw));
2142*4882a593Smuzhiyun
2143*4882a593Smuzhiyun if ((err = _dhd_pno_cfg(dhd, _chan_list, tot_nchan)) < 0) {
2144*4882a593Smuzhiyun DHD_ERROR(("%s : failed to set call pno_cfg (err %d) in firmware\n",
2145*4882a593Smuzhiyun __FUNCTION__, err));
2146*4882a593Smuzhiyun goto exit;
2147*4882a593Smuzhiyun }
2148*4882a593Smuzhiyun
2149*4882a593Smuzhiyun if ((err = _dhd_pno_gscan_cfg(dhd, pfn_gscan_cfg_t, gscan_param_size)) < 0) {
2150*4882a593Smuzhiyun DHD_ERROR(("%s : failed to set call pno_gscan_cfg (err %d) in firmware\n",
2151*4882a593Smuzhiyun __FUNCTION__, err));
2152*4882a593Smuzhiyun goto exit;
2153*4882a593Smuzhiyun }
2154*4882a593Smuzhiyun /* Reprogram ePNO cfg from dhd cache if FW has been flushed */
2155*4882a593Smuzhiyun if (fw_flushed) {
2156*4882a593Smuzhiyun dhd_pno_set_epno(dhd);
2157*4882a593Smuzhiyun }
2158*4882a593Smuzhiyun
2159*4882a593Smuzhiyun if (gscan_params->nbssid_hotlist) {
2160*4882a593Smuzhiyun struct dhd_pno_bssid *iter, *next;
2161*4882a593Smuzhiyun wl_pfn_bssid_t *ptr;
2162*4882a593Smuzhiyun p_pfn_bssid = (wl_pfn_bssid_t *)MALLOCZ(dhd->osh,
2163*4882a593Smuzhiyun sizeof(wl_pfn_bssid_t) * gscan_params->nbssid_hotlist);
2164*4882a593Smuzhiyun if (p_pfn_bssid == NULL) {
2165*4882a593Smuzhiyun DHD_ERROR(("%s : failed to allocate wl_pfn_bssid_t array"
2166*4882a593Smuzhiyun " (count: %d)",
2167*4882a593Smuzhiyun __FUNCTION__, _params->params_hotlist.nbssid));
2168*4882a593Smuzhiyun err = BCME_NOMEM;
2169*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_HOTLIST_MODE;
2170*4882a593Smuzhiyun goto exit;
2171*4882a593Smuzhiyun }
2172*4882a593Smuzhiyun ptr = p_pfn_bssid;
2173*4882a593Smuzhiyun /* convert dhd_pno_bssid to wl_pfn_bssid */
2174*4882a593Smuzhiyun DHD_PNO(("nhotlist %d\n", gscan_params->nbssid_hotlist));
2175*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
2176*4882a593Smuzhiyun list_for_each_entry_safe(iter, next,
2177*4882a593Smuzhiyun &gscan_params->hotlist_bssid_list, list) {
2178*4882a593Smuzhiyun char buffer_hotlist[64];
2179*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
2180*4882a593Smuzhiyun memcpy(&ptr->macaddr,
2181*4882a593Smuzhiyun &iter->macaddr, ETHER_ADDR_LEN);
2182*4882a593Smuzhiyun BCM_REFERENCE(buffer_hotlist);
2183*4882a593Smuzhiyun DHD_PNO(("%s\n", bcm_ether_ntoa(&ptr->macaddr, buffer_hotlist)));
2184*4882a593Smuzhiyun ptr->flags = iter->flags;
2185*4882a593Smuzhiyun ptr++;
2186*4882a593Smuzhiyun }
2187*4882a593Smuzhiyun
2188*4882a593Smuzhiyun err = _dhd_pno_add_bssid(dhd, p_pfn_bssid, gscan_params->nbssid_hotlist);
2189*4882a593Smuzhiyun if (err < 0) {
2190*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call _dhd_pno_add_bssid(err :%d)\n",
2191*4882a593Smuzhiyun __FUNCTION__, err));
2192*4882a593Smuzhiyun goto exit;
2193*4882a593Smuzhiyun }
2194*4882a593Smuzhiyun }
2195*4882a593Smuzhiyun
2196*4882a593Smuzhiyun if ((err = _dhd_pno_enable(dhd, PNO_ON)) < 0) {
2197*4882a593Smuzhiyun DHD_ERROR(("%s : failed to enable PNO err %d\n", __FUNCTION__, err));
2198*4882a593Smuzhiyun }
2199*4882a593Smuzhiyun
2200*4882a593Smuzhiyun exit:
2201*4882a593Smuzhiyun /* clear mode in case of error */
2202*4882a593Smuzhiyun if (err < 0) {
2203*4882a593Smuzhiyun int ret = dhd_pno_clean(dhd);
2204*4882a593Smuzhiyun
2205*4882a593Smuzhiyun if (ret < 0) {
2206*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call dhd_pno_clean (err: %d)\n",
2207*4882a593Smuzhiyun __FUNCTION__, ret));
2208*4882a593Smuzhiyun } else {
2209*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_GSCAN_MODE;
2210*4882a593Smuzhiyun }
2211*4882a593Smuzhiyun }
2212*4882a593Smuzhiyun MFREE(dhd->osh, p_pfn_bssid,
2213*4882a593Smuzhiyun sizeof(wl_pfn_bssid_t) * gscan_params->nbssid_hotlist);
2214*4882a593Smuzhiyun if (pfn_gscan_cfg_t) {
2215*4882a593Smuzhiyun MFREE(dhd->osh, pfn_gscan_cfg_t, gscan_param_size);
2216*4882a593Smuzhiyun }
2217*4882a593Smuzhiyun if (ch_bucket) {
2218*4882a593Smuzhiyun MFREE(dhd->osh, ch_bucket,
2219*4882a593Smuzhiyun (tot_num_buckets * sizeof(wl_pfn_gscan_ch_bucket_cfg_t)));
2220*4882a593Smuzhiyun }
2221*4882a593Smuzhiyun return err;
2222*4882a593Smuzhiyun
2223*4882a593Smuzhiyun }
2224*4882a593Smuzhiyun
2225*4882a593Smuzhiyun static wl_pfn_gscan_ch_bucket_cfg_t *
dhd_pno_gscan_create_channel_list(dhd_pub_t * dhd,dhd_pno_status_info_t * _pno_state,uint16 * chan_list,uint32 * num_buckets,uint32 * num_buckets_to_fw)2226*4882a593Smuzhiyun dhd_pno_gscan_create_channel_list(dhd_pub_t *dhd,
2227*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state,
2228*4882a593Smuzhiyun uint16 *chan_list,
2229*4882a593Smuzhiyun uint32 *num_buckets,
2230*4882a593Smuzhiyun uint32 *num_buckets_to_fw)
2231*4882a593Smuzhiyun {
2232*4882a593Smuzhiyun int i, num_channels, err, nchan = WL_NUMCHANNELS, ch_cnt;
2233*4882a593Smuzhiyun uint16 *ptr = chan_list, max;
2234*4882a593Smuzhiyun wl_pfn_gscan_ch_bucket_cfg_t *ch_bucket;
2235*4882a593Smuzhiyun dhd_pno_params_t *_params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
2236*4882a593Smuzhiyun bool is_pno_legacy_running;
2237*4882a593Smuzhiyun dhd_pno_gscan_channel_bucket_t *gscan_buckets = _params->params_gscan.channel_bucket;
2238*4882a593Smuzhiyun
2239*4882a593Smuzhiyun /* ePNO and Legacy PNO do not co-exist */
2240*4882a593Smuzhiyun is_pno_legacy_running = ((_pno_state->pno_mode & DHD_PNO_LEGACY_MODE) &&
2241*4882a593Smuzhiyun !_params->params_gscan.epno_cfg.num_epno_ssid);
2242*4882a593Smuzhiyun
2243*4882a593Smuzhiyun if (is_pno_legacy_running)
2244*4882a593Smuzhiyun *num_buckets = _params->params_gscan.nchannel_buckets + 1;
2245*4882a593Smuzhiyun else
2246*4882a593Smuzhiyun *num_buckets = _params->params_gscan.nchannel_buckets;
2247*4882a593Smuzhiyun
2248*4882a593Smuzhiyun *num_buckets_to_fw = 0;
2249*4882a593Smuzhiyun
2250*4882a593Smuzhiyun ch_bucket = (wl_pfn_gscan_ch_bucket_cfg_t *) MALLOC(dhd->osh,
2251*4882a593Smuzhiyun ((*num_buckets) * sizeof(wl_pfn_gscan_ch_bucket_cfg_t)));
2252*4882a593Smuzhiyun
2253*4882a593Smuzhiyun if (!ch_bucket) {
2254*4882a593Smuzhiyun DHD_ERROR(("%s: failed to malloc memory of size %zd\n",
2255*4882a593Smuzhiyun __FUNCTION__, (*num_buckets) * sizeof(wl_pfn_gscan_ch_bucket_cfg_t)));
2256*4882a593Smuzhiyun *num_buckets_to_fw = *num_buckets = 0;
2257*4882a593Smuzhiyun return NULL;
2258*4882a593Smuzhiyun }
2259*4882a593Smuzhiyun
2260*4882a593Smuzhiyun max = gscan_buckets[0].bucket_freq_multiple;
2261*4882a593Smuzhiyun num_channels = 0;
2262*4882a593Smuzhiyun /* nchan is the remaining space left in chan_list buffer
2263*4882a593Smuzhiyun * So any overflow list of channels is ignored
2264*4882a593Smuzhiyun */
2265*4882a593Smuzhiyun for (i = 0; i < _params->params_gscan.nchannel_buckets && nchan; i++) {
2266*4882a593Smuzhiyun if (!gscan_buckets[i].band) {
2267*4882a593Smuzhiyun ch_cnt = MIN(gscan_buckets[i].num_channels, (uint8)nchan);
2268*4882a593Smuzhiyun num_channels += ch_cnt;
2269*4882a593Smuzhiyun memcpy(ptr, gscan_buckets[i].chan_list,
2270*4882a593Smuzhiyun ch_cnt * sizeof(uint16));
2271*4882a593Smuzhiyun ptr = ptr + ch_cnt;
2272*4882a593Smuzhiyun } else {
2273*4882a593Smuzhiyun /* get a valid channel list based on band B or A */
2274*4882a593Smuzhiyun err = _dhd_pno_get_channels(dhd, ptr,
2275*4882a593Smuzhiyun &nchan, (gscan_buckets[i].band & GSCAN_ABG_BAND_MASK),
2276*4882a593Smuzhiyun !(gscan_buckets[i].band & GSCAN_DFS_MASK));
2277*4882a593Smuzhiyun
2278*4882a593Smuzhiyun if (err < 0) {
2279*4882a593Smuzhiyun DHD_ERROR(("%s: failed to get valid channel list(band : %d)\n",
2280*4882a593Smuzhiyun __FUNCTION__, gscan_buckets[i].band));
2281*4882a593Smuzhiyun MFREE(dhd->osh, ch_bucket,
2282*4882a593Smuzhiyun ((*num_buckets) * sizeof(wl_pfn_gscan_ch_bucket_cfg_t)));
2283*4882a593Smuzhiyun *num_buckets_to_fw = *num_buckets = 0;
2284*4882a593Smuzhiyun return NULL;
2285*4882a593Smuzhiyun }
2286*4882a593Smuzhiyun
2287*4882a593Smuzhiyun num_channels += nchan;
2288*4882a593Smuzhiyun ptr = ptr + nchan;
2289*4882a593Smuzhiyun }
2290*4882a593Smuzhiyun
2291*4882a593Smuzhiyun ch_bucket[i].bucket_end_index = num_channels - 1;
2292*4882a593Smuzhiyun ch_bucket[i].bucket_freq_multiple = gscan_buckets[i].bucket_freq_multiple;
2293*4882a593Smuzhiyun ch_bucket[i].repeat = gscan_buckets[i].repeat;
2294*4882a593Smuzhiyun ch_bucket[i].max_freq_multiple = gscan_buckets[i].bucket_max_multiple;
2295*4882a593Smuzhiyun ch_bucket[i].flag = gscan_buckets[i].report_flag;
2296*4882a593Smuzhiyun /* HAL and FW interpretations are opposite for this bit */
2297*4882a593Smuzhiyun ch_bucket[i].flag ^= DHD_PNO_REPORT_NO_BATCH;
2298*4882a593Smuzhiyun if (max < gscan_buckets[i].bucket_freq_multiple)
2299*4882a593Smuzhiyun max = gscan_buckets[i].bucket_freq_multiple;
2300*4882a593Smuzhiyun nchan = WL_NUMCHANNELS - num_channels;
2301*4882a593Smuzhiyun *num_buckets_to_fw = *num_buckets_to_fw + 1;
2302*4882a593Smuzhiyun DHD_PNO(("end_idx %d freq_mult - %d\n",
2303*4882a593Smuzhiyun ch_bucket[i].bucket_end_index, ch_bucket[i].bucket_freq_multiple));
2304*4882a593Smuzhiyun }
2305*4882a593Smuzhiyun
2306*4882a593Smuzhiyun _params->params_gscan.max_ch_bucket_freq = max;
2307*4882a593Smuzhiyun /* Legacy PNO maybe running, which means we need to create a legacy PNO bucket
2308*4882a593Smuzhiyun * Get GCF of Legacy PNO and Gscan scanfreq
2309*4882a593Smuzhiyun */
2310*4882a593Smuzhiyun if (is_pno_legacy_running) {
2311*4882a593Smuzhiyun dhd_pno_params_t *_params1 = &_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS];
2312*4882a593Smuzhiyun uint16 *legacy_chan_list = _params1->params_legacy.chan_list;
2313*4882a593Smuzhiyun uint16 common_freq;
2314*4882a593Smuzhiyun uint32 legacy_bucket_idx = _params->params_gscan.nchannel_buckets;
2315*4882a593Smuzhiyun /* If no space is left then only gscan buckets will be sent to FW */
2316*4882a593Smuzhiyun if (nchan) {
2317*4882a593Smuzhiyun common_freq = gcd(_params->params_gscan.scan_fr,
2318*4882a593Smuzhiyun _params1->params_legacy.scan_fr);
2319*4882a593Smuzhiyun max = gscan_buckets[0].bucket_freq_multiple;
2320*4882a593Smuzhiyun /* GSCAN buckets */
2321*4882a593Smuzhiyun for (i = 0; i < _params->params_gscan.nchannel_buckets; i++) {
2322*4882a593Smuzhiyun ch_bucket[i].bucket_freq_multiple *= _params->params_gscan.scan_fr;
2323*4882a593Smuzhiyun ch_bucket[i].bucket_freq_multiple /= common_freq;
2324*4882a593Smuzhiyun if (max < gscan_buckets[i].bucket_freq_multiple)
2325*4882a593Smuzhiyun max = gscan_buckets[i].bucket_freq_multiple;
2326*4882a593Smuzhiyun }
2327*4882a593Smuzhiyun /* Legacy PNO bucket */
2328*4882a593Smuzhiyun ch_bucket[legacy_bucket_idx].bucket_freq_multiple =
2329*4882a593Smuzhiyun _params1->params_legacy.scan_fr;
2330*4882a593Smuzhiyun ch_bucket[legacy_bucket_idx].bucket_freq_multiple /=
2331*4882a593Smuzhiyun common_freq;
2332*4882a593Smuzhiyun _params->params_gscan.max_ch_bucket_freq = MAX(max,
2333*4882a593Smuzhiyun ch_bucket[legacy_bucket_idx].bucket_freq_multiple);
2334*4882a593Smuzhiyun ch_bucket[legacy_bucket_idx].flag = CH_BUCKET_REPORT_REGULAR;
2335*4882a593Smuzhiyun /* Now add channels to the legacy scan bucket */
2336*4882a593Smuzhiyun for (i = 0; i < _params1->params_legacy.nchan && nchan; i++, nchan--) {
2337*4882a593Smuzhiyun ptr[i] = legacy_chan_list[i];
2338*4882a593Smuzhiyun num_channels++;
2339*4882a593Smuzhiyun }
2340*4882a593Smuzhiyun ch_bucket[legacy_bucket_idx].bucket_end_index = num_channels - 1;
2341*4882a593Smuzhiyun *num_buckets_to_fw = *num_buckets_to_fw + 1;
2342*4882a593Smuzhiyun DHD_PNO(("end_idx %d freq_mult - %d\n",
2343*4882a593Smuzhiyun ch_bucket[legacy_bucket_idx].bucket_end_index,
2344*4882a593Smuzhiyun ch_bucket[legacy_bucket_idx].bucket_freq_multiple));
2345*4882a593Smuzhiyun }
2346*4882a593Smuzhiyun }
2347*4882a593Smuzhiyun return ch_bucket;
2348*4882a593Smuzhiyun }
2349*4882a593Smuzhiyun
2350*4882a593Smuzhiyun static int
dhd_pno_stop_for_gscan(dhd_pub_t * dhd)2351*4882a593Smuzhiyun dhd_pno_stop_for_gscan(dhd_pub_t *dhd)
2352*4882a593Smuzhiyun {
2353*4882a593Smuzhiyun int err = BCME_OK;
2354*4882a593Smuzhiyun int mode;
2355*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
2356*4882a593Smuzhiyun
2357*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
2358*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
2359*4882a593Smuzhiyun
2360*4882a593Smuzhiyun if (!dhd_support_sta_mode(dhd)) {
2361*4882a593Smuzhiyun err = BCME_BADOPTION;
2362*4882a593Smuzhiyun goto exit;
2363*4882a593Smuzhiyun }
2364*4882a593Smuzhiyun if (!WLS_SUPPORTED(_pno_state)) {
2365*4882a593Smuzhiyun DHD_ERROR(("%s : wifi location service is not supported\n",
2366*4882a593Smuzhiyun __FUNCTION__));
2367*4882a593Smuzhiyun err = BCME_UNSUPPORTED;
2368*4882a593Smuzhiyun goto exit;
2369*4882a593Smuzhiyun }
2370*4882a593Smuzhiyun
2371*4882a593Smuzhiyun if (!(_pno_state->pno_mode & DHD_PNO_GSCAN_MODE)) {
2372*4882a593Smuzhiyun DHD_ERROR(("%s : GSCAN is not enabled\n", __FUNCTION__));
2373*4882a593Smuzhiyun goto exit;
2374*4882a593Smuzhiyun }
2375*4882a593Smuzhiyun if (_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS].params_gscan.mscan) {
2376*4882a593Smuzhiyun /* retrieve the batching data from firmware into host */
2377*4882a593Smuzhiyun err = dhd_wait_batch_results_complete(dhd);
2378*4882a593Smuzhiyun if (err != BCME_OK)
2379*4882a593Smuzhiyun goto exit;
2380*4882a593Smuzhiyun }
2381*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
2382*4882a593Smuzhiyun mode = _pno_state->pno_mode & ~DHD_PNO_GSCAN_MODE;
2383*4882a593Smuzhiyun err = dhd_pno_clean(dhd);
2384*4882a593Smuzhiyun if (err < 0) {
2385*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call dhd_pno_clean (err: %d)\n",
2386*4882a593Smuzhiyun __FUNCTION__, err));
2387*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
2388*4882a593Smuzhiyun return err;
2389*4882a593Smuzhiyun }
2390*4882a593Smuzhiyun _pno_state->pno_mode = mode;
2391*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
2392*4882a593Smuzhiyun
2393*4882a593Smuzhiyun /* Reprogram Legacy PNO if it was running */
2394*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_LEGACY_MODE) {
2395*4882a593Smuzhiyun struct dhd_pno_legacy_params *params_legacy;
2396*4882a593Smuzhiyun uint16 chan_list[WL_NUMCHANNELS];
2397*4882a593Smuzhiyun
2398*4882a593Smuzhiyun params_legacy = &(_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS].params_legacy);
2399*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_LEGACY_MODE;
2400*4882a593Smuzhiyun
2401*4882a593Smuzhiyun DHD_PNO(("Restarting Legacy PNO SSID scan...\n"));
2402*4882a593Smuzhiyun memcpy(chan_list, params_legacy->chan_list,
2403*4882a593Smuzhiyun (params_legacy->nchan * sizeof(uint16)));
2404*4882a593Smuzhiyun err = dhd_pno_set_legacy_pno(dhd, params_legacy->scan_fr,
2405*4882a593Smuzhiyun params_legacy->pno_repeat, params_legacy->pno_freq_expo_max,
2406*4882a593Smuzhiyun chan_list, params_legacy->nchan);
2407*4882a593Smuzhiyun if (err < 0) {
2408*4882a593Smuzhiyun DHD_ERROR(("%s : failed to restart legacy PNO scan(err: %d)\n",
2409*4882a593Smuzhiyun __FUNCTION__, err));
2410*4882a593Smuzhiyun goto exit;
2411*4882a593Smuzhiyun }
2412*4882a593Smuzhiyun
2413*4882a593Smuzhiyun }
2414*4882a593Smuzhiyun
2415*4882a593Smuzhiyun exit:
2416*4882a593Smuzhiyun return err;
2417*4882a593Smuzhiyun }
2418*4882a593Smuzhiyun
2419*4882a593Smuzhiyun int
dhd_pno_initiate_gscan_request(dhd_pub_t * dhd,bool run,bool flush)2420*4882a593Smuzhiyun dhd_pno_initiate_gscan_request(dhd_pub_t *dhd, bool run, bool flush)
2421*4882a593Smuzhiyun {
2422*4882a593Smuzhiyun int err = BCME_OK;
2423*4882a593Smuzhiyun dhd_pno_params_t *params;
2424*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
2425*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
2426*4882a593Smuzhiyun
2427*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL\n", err);
2428*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
2429*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
2430*4882a593Smuzhiyun
2431*4882a593Smuzhiyun DHD_PNO(("%s enter - run %d flush %d\n", __FUNCTION__, run, flush));
2432*4882a593Smuzhiyun
2433*4882a593Smuzhiyun params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
2434*4882a593Smuzhiyun gscan_params = ¶ms->params_gscan;
2435*4882a593Smuzhiyun
2436*4882a593Smuzhiyun if (run) {
2437*4882a593Smuzhiyun err = dhd_pno_set_for_gscan(dhd, gscan_params);
2438*4882a593Smuzhiyun } else {
2439*4882a593Smuzhiyun if (flush) {
2440*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
2441*4882a593Smuzhiyun dhd_pno_reset_cfg_gscan(dhd, params, _pno_state, GSCAN_FLUSH_ALL_CFG);
2442*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
2443*4882a593Smuzhiyun }
2444*4882a593Smuzhiyun /* Need to stop all gscan */
2445*4882a593Smuzhiyun err = dhd_pno_stop_for_gscan(dhd);
2446*4882a593Smuzhiyun }
2447*4882a593Smuzhiyun
2448*4882a593Smuzhiyun return err;
2449*4882a593Smuzhiyun }
2450*4882a593Smuzhiyun
2451*4882a593Smuzhiyun int
dhd_pno_enable_full_scan_result(dhd_pub_t * dhd,bool real_time_flag)2452*4882a593Smuzhiyun dhd_pno_enable_full_scan_result(dhd_pub_t *dhd, bool real_time_flag)
2453*4882a593Smuzhiyun {
2454*4882a593Smuzhiyun int err = BCME_OK;
2455*4882a593Smuzhiyun dhd_pno_params_t *params;
2456*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
2457*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
2458*4882a593Smuzhiyun uint8 old_flag;
2459*4882a593Smuzhiyun
2460*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL\n", err);
2461*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
2462*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
2463*4882a593Smuzhiyun
2464*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
2465*4882a593Smuzhiyun
2466*4882a593Smuzhiyun if (!WLS_SUPPORTED(_pno_state)) {
2467*4882a593Smuzhiyun DHD_ERROR(("%s : wifi location service is not supported\n", __FUNCTION__));
2468*4882a593Smuzhiyun err = BCME_UNSUPPORTED;
2469*4882a593Smuzhiyun goto exit;
2470*4882a593Smuzhiyun }
2471*4882a593Smuzhiyun
2472*4882a593Smuzhiyun params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
2473*4882a593Smuzhiyun gscan_params = ¶ms->params_gscan;
2474*4882a593Smuzhiyun
2475*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
2476*4882a593Smuzhiyun
2477*4882a593Smuzhiyun old_flag = gscan_params->send_all_results_flag;
2478*4882a593Smuzhiyun gscan_params->send_all_results_flag = (uint8) real_time_flag;
2479*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_GSCAN_MODE) {
2480*4882a593Smuzhiyun if (old_flag != gscan_params->send_all_results_flag) {
2481*4882a593Smuzhiyun wl_pfn_gscan_cfg_t gscan_cfg;
2482*4882a593Smuzhiyun
2483*4882a593Smuzhiyun gscan_cfg.version = WL_GSCAN_CFG_VERSION;
2484*4882a593Smuzhiyun gscan_cfg.flags = (gscan_params->send_all_results_flag &
2485*4882a593Smuzhiyun GSCAN_SEND_ALL_RESULTS_MASK);
2486*4882a593Smuzhiyun gscan_cfg.flags |= GSCAN_CFG_FLAGS_ONLY_MASK;
2487*4882a593Smuzhiyun
2488*4882a593Smuzhiyun if ((err = _dhd_pno_gscan_cfg(dhd, &gscan_cfg,
2489*4882a593Smuzhiyun sizeof(wl_pfn_gscan_cfg_t))) < 0) {
2490*4882a593Smuzhiyun DHD_ERROR(("%s : pno_gscan_cfg failed (err %d) in firmware\n",
2491*4882a593Smuzhiyun __FUNCTION__, err));
2492*4882a593Smuzhiyun goto exit_mutex_unlock;
2493*4882a593Smuzhiyun }
2494*4882a593Smuzhiyun } else {
2495*4882a593Smuzhiyun DHD_PNO(("No change in flag - %d\n", old_flag));
2496*4882a593Smuzhiyun }
2497*4882a593Smuzhiyun } else {
2498*4882a593Smuzhiyun DHD_PNO(("Gscan not started\n"));
2499*4882a593Smuzhiyun }
2500*4882a593Smuzhiyun exit_mutex_unlock:
2501*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
2502*4882a593Smuzhiyun exit:
2503*4882a593Smuzhiyun return err;
2504*4882a593Smuzhiyun }
2505*4882a593Smuzhiyun
2506*4882a593Smuzhiyun /* Cleanup any consumed results
2507*4882a593Smuzhiyun * Return TRUE if all results consumed else FALSE
2508*4882a593Smuzhiyun */
dhd_gscan_batch_cache_cleanup(dhd_pub_t * dhd)2509*4882a593Smuzhiyun int dhd_gscan_batch_cache_cleanup(dhd_pub_t *dhd)
2510*4882a593Smuzhiyun {
2511*4882a593Smuzhiyun int ret = 0;
2512*4882a593Smuzhiyun dhd_pno_params_t *params;
2513*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
2514*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
2515*4882a593Smuzhiyun gscan_results_cache_t *iter, *tmp;
2516*4882a593Smuzhiyun
2517*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
2518*4882a593Smuzhiyun params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
2519*4882a593Smuzhiyun gscan_params = ¶ms->params_gscan;
2520*4882a593Smuzhiyun iter = gscan_params->gscan_batch_cache;
2521*4882a593Smuzhiyun
2522*4882a593Smuzhiyun while (iter) {
2523*4882a593Smuzhiyun if (iter->tot_consumed == iter->tot_count) {
2524*4882a593Smuzhiyun tmp = iter->next;
2525*4882a593Smuzhiyun MFREE(dhd->osh, iter,
2526*4882a593Smuzhiyun ((iter->tot_count - 1) * sizeof(wifi_gscan_result_t))
2527*4882a593Smuzhiyun + sizeof(gscan_results_cache_t));
2528*4882a593Smuzhiyun iter = tmp;
2529*4882a593Smuzhiyun } else
2530*4882a593Smuzhiyun break;
2531*4882a593Smuzhiyun }
2532*4882a593Smuzhiyun gscan_params->gscan_batch_cache = iter;
2533*4882a593Smuzhiyun ret = (iter == NULL);
2534*4882a593Smuzhiyun return ret;
2535*4882a593Smuzhiyun }
2536*4882a593Smuzhiyun
2537*4882a593Smuzhiyun static int
_dhd_pno_get_gscan_batch_from_fw(dhd_pub_t * dhd)2538*4882a593Smuzhiyun _dhd_pno_get_gscan_batch_from_fw(dhd_pub_t *dhd)
2539*4882a593Smuzhiyun {
2540*4882a593Smuzhiyun int err = BCME_OK;
2541*4882a593Smuzhiyun uint32 timestamp = 0, ts = 0, i, j, timediff;
2542*4882a593Smuzhiyun dhd_pno_params_t *params;
2543*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
2544*4882a593Smuzhiyun wl_pfn_lnet_info_v1_t *plnetinfo;
2545*4882a593Smuzhiyun wl_pfn_lnet_info_v2_t *plnetinfo_v2;
2546*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
2547*4882a593Smuzhiyun wl_pfn_lscanresults_v1_t *plbestnet_v1 = NULL;
2548*4882a593Smuzhiyun wl_pfn_lscanresults_v2_t *plbestnet_v2 = NULL;
2549*4882a593Smuzhiyun gscan_results_cache_t *iter, *tail;
2550*4882a593Smuzhiyun wifi_gscan_result_t *result;
2551*4882a593Smuzhiyun uint8 *nAPs_per_scan = NULL;
2552*4882a593Smuzhiyun uint8 num_scans_in_cur_iter;
2553*4882a593Smuzhiyun uint16 count;
2554*4882a593Smuzhiyun uint16 fwcount;
2555*4882a593Smuzhiyun uint16 fwstatus = PFN_INCOMPLETE;
2556*4882a593Smuzhiyun struct osl_timespec tm_spec;
2557*4882a593Smuzhiyun
2558*4882a593Smuzhiyun /* Static asserts in _dhd_pno_get_for_batch() below guarantee the v1 and v2
2559*4882a593Smuzhiyun * net_info and subnet_info structures are compatible in size and SSID offset,
2560*4882a593Smuzhiyun * allowing v1 to be safely used in the code below except for lscanresults
2561*4882a593Smuzhiyun * fields themselves (status, count, offset to netinfo).
2562*4882a593Smuzhiyun */
2563*4882a593Smuzhiyun
2564*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL\n", err);
2565*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
2566*4882a593Smuzhiyun
2567*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
2568*4882a593Smuzhiyun params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
2569*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
2570*4882a593Smuzhiyun
2571*4882a593Smuzhiyun if (!WLS_SUPPORTED(_pno_state)) {
2572*4882a593Smuzhiyun DHD_ERROR(("%s : wifi location service is not supported\n", __FUNCTION__));
2573*4882a593Smuzhiyun err = BCME_UNSUPPORTED;
2574*4882a593Smuzhiyun goto exit;
2575*4882a593Smuzhiyun }
2576*4882a593Smuzhiyun if (!(_pno_state->pno_mode & DHD_PNO_GSCAN_MODE)) {
2577*4882a593Smuzhiyun DHD_ERROR(("%s: GSCAN is not enabled\n", __FUNCTION__));
2578*4882a593Smuzhiyun goto exit;
2579*4882a593Smuzhiyun }
2580*4882a593Smuzhiyun gscan_params = ¶ms->params_gscan;
2581*4882a593Smuzhiyun nAPs_per_scan = (uint8 *) MALLOC(dhd->osh, gscan_params->mscan);
2582*4882a593Smuzhiyun
2583*4882a593Smuzhiyun if (!nAPs_per_scan) {
2584*4882a593Smuzhiyun DHD_ERROR(("%s :Out of memory!! Cant malloc %d bytes\n", __FUNCTION__,
2585*4882a593Smuzhiyun gscan_params->mscan));
2586*4882a593Smuzhiyun err = BCME_NOMEM;
2587*4882a593Smuzhiyun goto exit;
2588*4882a593Smuzhiyun }
2589*4882a593Smuzhiyun
2590*4882a593Smuzhiyun plbestnet_v1 = (wl_pfn_lscanresults_v1_t *)MALLOC(dhd->osh, PNO_BESTNET_LEN);
2591*4882a593Smuzhiyun if (!plbestnet_v1) {
2592*4882a593Smuzhiyun DHD_ERROR(("%s :Out of memory!! Cant malloc %d bytes\n", __FUNCTION__,
2593*4882a593Smuzhiyun (int)PNO_BESTNET_LEN));
2594*4882a593Smuzhiyun err = BCME_NOMEM;
2595*4882a593Smuzhiyun goto exit;
2596*4882a593Smuzhiyun }
2597*4882a593Smuzhiyun plbestnet_v2 = (wl_pfn_lscanresults_v2_t *)plbestnet_v1;
2598*4882a593Smuzhiyun
2599*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
2600*4882a593Smuzhiyun
2601*4882a593Smuzhiyun dhd_gscan_clear_all_batch_results(dhd);
2602*4882a593Smuzhiyun
2603*4882a593Smuzhiyun if (!(_pno_state->pno_mode & DHD_PNO_GSCAN_MODE)) {
2604*4882a593Smuzhiyun DHD_ERROR(("%s : GSCAN is not enabled\n", __FUNCTION__));
2605*4882a593Smuzhiyun goto exit_mutex_unlock;
2606*4882a593Smuzhiyun }
2607*4882a593Smuzhiyun
2608*4882a593Smuzhiyun timediff = gscan_params->scan_fr * 1000;
2609*4882a593Smuzhiyun timediff = timediff >> 1;
2610*4882a593Smuzhiyun
2611*4882a593Smuzhiyun /* Ok, now lets start getting results from the FW */
2612*4882a593Smuzhiyun tail = gscan_params->gscan_batch_cache;
2613*4882a593Smuzhiyun do {
2614*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfnlbest", NULL, 0, (char *)plbestnet_v1, PNO_BESTNET_LEN,
2615*4882a593Smuzhiyun FALSE);
2616*4882a593Smuzhiyun if (err < 0) {
2617*4882a593Smuzhiyun DHD_ERROR(("%s : Cannot get all the batch results, err :%d\n",
2618*4882a593Smuzhiyun __FUNCTION__, err));
2619*4882a593Smuzhiyun goto exit_mutex_unlock;
2620*4882a593Smuzhiyun }
2621*4882a593Smuzhiyun osl_get_monotonic_boottime(&tm_spec);
2622*4882a593Smuzhiyun
2623*4882a593Smuzhiyun if (plbestnet_v1->version == PFN_LBEST_SCAN_RESULT_VERSION_V1) {
2624*4882a593Smuzhiyun fwstatus = plbestnet_v1->status;
2625*4882a593Smuzhiyun fwcount = plbestnet_v1->count;
2626*4882a593Smuzhiyun plnetinfo = &plbestnet_v1->netinfo[0];
2627*4882a593Smuzhiyun
2628*4882a593Smuzhiyun DHD_PNO(("ver %d, status : %d, count %d\n",
2629*4882a593Smuzhiyun plbestnet_v1->version, fwstatus, fwcount));
2630*4882a593Smuzhiyun
2631*4882a593Smuzhiyun if (fwcount == 0) {
2632*4882a593Smuzhiyun DHD_PNO(("No more batch results\n"));
2633*4882a593Smuzhiyun goto exit_mutex_unlock;
2634*4882a593Smuzhiyun }
2635*4882a593Smuzhiyun if (fwcount > BESTN_MAX) {
2636*4882a593Smuzhiyun DHD_ERROR(("%s :fwcount %d is greater than BESTN_MAX %d \n",
2637*4882a593Smuzhiyun __FUNCTION__, fwcount, (int)BESTN_MAX));
2638*4882a593Smuzhiyun /* Process only BESTN_MAX number of results per batch */
2639*4882a593Smuzhiyun fwcount = BESTN_MAX;
2640*4882a593Smuzhiyun }
2641*4882a593Smuzhiyun num_scans_in_cur_iter = 0;
2642*4882a593Smuzhiyun
2643*4882a593Smuzhiyun timestamp = plnetinfo->timestamp;
2644*4882a593Smuzhiyun /* find out how many scans' results did we get in
2645*4882a593Smuzhiyun * this batch of FW results
2646*4882a593Smuzhiyun */
2647*4882a593Smuzhiyun for (i = 0, count = 0; i < fwcount; i++, count++, plnetinfo++) {
2648*4882a593Smuzhiyun /* Unlikely to happen, but just in case the results from
2649*4882a593Smuzhiyun * FW doesnt make sense..... Assume its part of one single scan
2650*4882a593Smuzhiyun */
2651*4882a593Smuzhiyun if (num_scans_in_cur_iter >= gscan_params->mscan) {
2652*4882a593Smuzhiyun num_scans_in_cur_iter = 0;
2653*4882a593Smuzhiyun count = fwcount;
2654*4882a593Smuzhiyun break;
2655*4882a593Smuzhiyun }
2656*4882a593Smuzhiyun if (TIME_DIFF_MS(timestamp, plnetinfo->timestamp) > timediff) {
2657*4882a593Smuzhiyun nAPs_per_scan[num_scans_in_cur_iter] = count;
2658*4882a593Smuzhiyun count = 0;
2659*4882a593Smuzhiyun num_scans_in_cur_iter++;
2660*4882a593Smuzhiyun }
2661*4882a593Smuzhiyun timestamp = plnetinfo->timestamp;
2662*4882a593Smuzhiyun }
2663*4882a593Smuzhiyun if (num_scans_in_cur_iter < gscan_params->mscan) {
2664*4882a593Smuzhiyun nAPs_per_scan[num_scans_in_cur_iter] = count;
2665*4882a593Smuzhiyun num_scans_in_cur_iter++;
2666*4882a593Smuzhiyun }
2667*4882a593Smuzhiyun
2668*4882a593Smuzhiyun DHD_PNO(("num_scans_in_cur_iter %d\n", num_scans_in_cur_iter));
2669*4882a593Smuzhiyun /* reset plnetinfo to the first item for the next loop */
2670*4882a593Smuzhiyun plnetinfo -= i;
2671*4882a593Smuzhiyun
2672*4882a593Smuzhiyun for (i = 0; i < num_scans_in_cur_iter; i++) {
2673*4882a593Smuzhiyun iter = (gscan_results_cache_t *)
2674*4882a593Smuzhiyun MALLOCZ(dhd->osh, ((nAPs_per_scan[i] - 1) *
2675*4882a593Smuzhiyun sizeof(wifi_gscan_result_t)) +
2676*4882a593Smuzhiyun sizeof(gscan_results_cache_t));
2677*4882a593Smuzhiyun if (!iter) {
2678*4882a593Smuzhiyun DHD_ERROR(("%s :Out of memory!! Cant malloc %d bytes\n",
2679*4882a593Smuzhiyun __FUNCTION__, gscan_params->mscan));
2680*4882a593Smuzhiyun err = BCME_NOMEM;
2681*4882a593Smuzhiyun goto exit_mutex_unlock;
2682*4882a593Smuzhiyun }
2683*4882a593Smuzhiyun /* Need this check because the new set of results from FW
2684*4882a593Smuzhiyun * maybe a continuation of previous sets' scan results
2685*4882a593Smuzhiyun */
2686*4882a593Smuzhiyun if (TIME_DIFF_MS(ts, plnetinfo->timestamp) > timediff) {
2687*4882a593Smuzhiyun iter->scan_id = ++gscan_params->scan_id;
2688*4882a593Smuzhiyun } else {
2689*4882a593Smuzhiyun iter->scan_id = gscan_params->scan_id;
2690*4882a593Smuzhiyun }
2691*4882a593Smuzhiyun DHD_PNO(("scan_id %d tot_count %d \n",
2692*4882a593Smuzhiyun gscan_params->scan_id, nAPs_per_scan[i]));
2693*4882a593Smuzhiyun iter->tot_count = nAPs_per_scan[i];
2694*4882a593Smuzhiyun iter->tot_consumed = 0;
2695*4882a593Smuzhiyun iter->flag = 0;
2696*4882a593Smuzhiyun if (plnetinfo->flags & PFN_PARTIAL_SCAN_MASK) {
2697*4882a593Smuzhiyun DHD_PNO(("This scan is aborted\n"));
2698*4882a593Smuzhiyun iter->flag = (ENABLE << PNO_STATUS_ABORT);
2699*4882a593Smuzhiyun } else if (gscan_params->reason) {
2700*4882a593Smuzhiyun iter->flag = (ENABLE << gscan_params->reason);
2701*4882a593Smuzhiyun }
2702*4882a593Smuzhiyun
2703*4882a593Smuzhiyun if (!tail) {
2704*4882a593Smuzhiyun gscan_params->gscan_batch_cache = iter;
2705*4882a593Smuzhiyun } else {
2706*4882a593Smuzhiyun tail->next = iter;
2707*4882a593Smuzhiyun }
2708*4882a593Smuzhiyun tail = iter;
2709*4882a593Smuzhiyun iter->next = NULL;
2710*4882a593Smuzhiyun for (j = 0; j < nAPs_per_scan[i]; j++, plnetinfo++) {
2711*4882a593Smuzhiyun result = &iter->results[j];
2712*4882a593Smuzhiyun
2713*4882a593Smuzhiyun result->channel = wl_channel_to_frequency(
2714*4882a593Smuzhiyun wf_chspec_ctlchan(plnetinfo->pfnsubnet.channel),
2715*4882a593Smuzhiyun CHSPEC_BAND(plnetinfo->pfnsubnet.channel));
2716*4882a593Smuzhiyun result->rssi = (int32) plnetinfo->RSSI;
2717*4882a593Smuzhiyun result->beacon_period = 0;
2718*4882a593Smuzhiyun result->capability = 0;
2719*4882a593Smuzhiyun result->rtt = (uint64) plnetinfo->rtt0;
2720*4882a593Smuzhiyun result->rtt_sd = (uint64) plnetinfo->rtt1;
2721*4882a593Smuzhiyun result->ts = convert_fw_rel_time_to_systime(&tm_spec,
2722*4882a593Smuzhiyun plnetinfo->timestamp);
2723*4882a593Smuzhiyun ts = plnetinfo->timestamp;
2724*4882a593Smuzhiyun if (plnetinfo->pfnsubnet.SSID_len > DOT11_MAX_SSID_LEN) {
2725*4882a593Smuzhiyun DHD_ERROR(("%s: Invalid SSID length %d\n",
2726*4882a593Smuzhiyun __FUNCTION__,
2727*4882a593Smuzhiyun plnetinfo->pfnsubnet.SSID_len));
2728*4882a593Smuzhiyun plnetinfo->pfnsubnet.SSID_len = DOT11_MAX_SSID_LEN;
2729*4882a593Smuzhiyun }
2730*4882a593Smuzhiyun (void)memcpy_s(result->ssid, DOT11_MAX_SSID_LEN,
2731*4882a593Smuzhiyun plnetinfo->pfnsubnet.SSID,
2732*4882a593Smuzhiyun plnetinfo->pfnsubnet.SSID_len);
2733*4882a593Smuzhiyun result->ssid[plnetinfo->pfnsubnet.SSID_len] = '\0';
2734*4882a593Smuzhiyun (void)memcpy_s(&result->macaddr, ETHER_ADDR_LEN,
2735*4882a593Smuzhiyun &plnetinfo->pfnsubnet.BSSID, ETHER_ADDR_LEN);
2736*4882a593Smuzhiyun
2737*4882a593Smuzhiyun DHD_PNO(("\tSSID : "));
2738*4882a593Smuzhiyun DHD_PNO(("\n"));
2739*4882a593Smuzhiyun DHD_PNO(("\tBSSID: "MACDBG"\n",
2740*4882a593Smuzhiyun MAC2STRDBG(result->macaddr.octet)));
2741*4882a593Smuzhiyun DHD_PNO(("\tchannel: %d, RSSI: %d, timestamp: %d ms\n",
2742*4882a593Smuzhiyun plnetinfo->pfnsubnet.channel,
2743*4882a593Smuzhiyun plnetinfo->RSSI, plnetinfo->timestamp));
2744*4882a593Smuzhiyun DHD_PNO(("\tRTT0 : %d, RTT1: %d\n",
2745*4882a593Smuzhiyun plnetinfo->rtt0, plnetinfo->rtt1));
2746*4882a593Smuzhiyun
2747*4882a593Smuzhiyun }
2748*4882a593Smuzhiyun }
2749*4882a593Smuzhiyun
2750*4882a593Smuzhiyun } else if (plbestnet_v2->version == PFN_LBEST_SCAN_RESULT_VERSION_V2) {
2751*4882a593Smuzhiyun fwstatus = plbestnet_v2->status;
2752*4882a593Smuzhiyun fwcount = plbestnet_v2->count;
2753*4882a593Smuzhiyun plnetinfo_v2 = (wl_pfn_lnet_info_v2_t*)&plbestnet_v2->netinfo[0];
2754*4882a593Smuzhiyun
2755*4882a593Smuzhiyun DHD_PNO(("ver %d, status : %d, count %d\n",
2756*4882a593Smuzhiyun plbestnet_v2->version, fwstatus, fwcount));
2757*4882a593Smuzhiyun
2758*4882a593Smuzhiyun if (fwcount == 0) {
2759*4882a593Smuzhiyun DHD_PNO(("No more batch results\n"));
2760*4882a593Smuzhiyun goto exit_mutex_unlock;
2761*4882a593Smuzhiyun }
2762*4882a593Smuzhiyun if (fwcount > BESTN_MAX) {
2763*4882a593Smuzhiyun DHD_ERROR(("%s :fwcount %d is greater than BESTN_MAX %d \n",
2764*4882a593Smuzhiyun __FUNCTION__, fwcount, (int)BESTN_MAX));
2765*4882a593Smuzhiyun /* Process only BESTN_MAX number of results per batch */
2766*4882a593Smuzhiyun fwcount = BESTN_MAX;
2767*4882a593Smuzhiyun }
2768*4882a593Smuzhiyun num_scans_in_cur_iter = 0;
2769*4882a593Smuzhiyun
2770*4882a593Smuzhiyun timestamp = plnetinfo_v2->timestamp;
2771*4882a593Smuzhiyun /* find out how many scans' results did we get
2772*4882a593Smuzhiyun * in this batch of FW results
2773*4882a593Smuzhiyun */
2774*4882a593Smuzhiyun for (i = 0, count = 0; i < fwcount; i++, count++, plnetinfo_v2++) {
2775*4882a593Smuzhiyun /* Unlikely to happen, but just in case the results from
2776*4882a593Smuzhiyun * FW doesnt make sense..... Assume its part of one single scan
2777*4882a593Smuzhiyun */
2778*4882a593Smuzhiyun if (num_scans_in_cur_iter >= gscan_params->mscan) {
2779*4882a593Smuzhiyun num_scans_in_cur_iter = 0;
2780*4882a593Smuzhiyun count = fwcount;
2781*4882a593Smuzhiyun break;
2782*4882a593Smuzhiyun }
2783*4882a593Smuzhiyun if (TIME_DIFF_MS(timestamp, plnetinfo_v2->timestamp) > timediff) {
2784*4882a593Smuzhiyun nAPs_per_scan[num_scans_in_cur_iter] = count;
2785*4882a593Smuzhiyun count = 0;
2786*4882a593Smuzhiyun num_scans_in_cur_iter++;
2787*4882a593Smuzhiyun }
2788*4882a593Smuzhiyun timestamp = plnetinfo_v2->timestamp;
2789*4882a593Smuzhiyun }
2790*4882a593Smuzhiyun if (num_scans_in_cur_iter < gscan_params->mscan) {
2791*4882a593Smuzhiyun nAPs_per_scan[num_scans_in_cur_iter] = count;
2792*4882a593Smuzhiyun num_scans_in_cur_iter++;
2793*4882a593Smuzhiyun }
2794*4882a593Smuzhiyun
2795*4882a593Smuzhiyun DHD_PNO(("num_scans_in_cur_iter %d\n", num_scans_in_cur_iter));
2796*4882a593Smuzhiyun /* reset plnetinfo to the first item for the next loop */
2797*4882a593Smuzhiyun plnetinfo_v2 -= i;
2798*4882a593Smuzhiyun
2799*4882a593Smuzhiyun for (i = 0; i < num_scans_in_cur_iter; i++) {
2800*4882a593Smuzhiyun iter = (gscan_results_cache_t *)
2801*4882a593Smuzhiyun MALLOCZ(dhd->osh, ((nAPs_per_scan[i] - 1) *
2802*4882a593Smuzhiyun sizeof(wifi_gscan_result_t)) +
2803*4882a593Smuzhiyun sizeof(gscan_results_cache_t));
2804*4882a593Smuzhiyun if (!iter) {
2805*4882a593Smuzhiyun DHD_ERROR(("%s :Out of memory!! Cant malloc %d bytes\n",
2806*4882a593Smuzhiyun __FUNCTION__, gscan_params->mscan));
2807*4882a593Smuzhiyun err = BCME_NOMEM;
2808*4882a593Smuzhiyun goto exit_mutex_unlock;
2809*4882a593Smuzhiyun }
2810*4882a593Smuzhiyun /* Need this check because the new set of results from FW
2811*4882a593Smuzhiyun * maybe a continuation of previous sets' scan results
2812*4882a593Smuzhiyun */
2813*4882a593Smuzhiyun if (TIME_DIFF_MS(ts, plnetinfo_v2->timestamp) > timediff) {
2814*4882a593Smuzhiyun iter->scan_id = ++gscan_params->scan_id;
2815*4882a593Smuzhiyun } else {
2816*4882a593Smuzhiyun iter->scan_id = gscan_params->scan_id;
2817*4882a593Smuzhiyun }
2818*4882a593Smuzhiyun DHD_PNO(("scan_id %d tot_count %d ch_bucket %x\n",
2819*4882a593Smuzhiyun gscan_params->scan_id, nAPs_per_scan[i],
2820*4882a593Smuzhiyun plbestnet_v2->scan_ch_buckets[i]));
2821*4882a593Smuzhiyun iter->tot_count = nAPs_per_scan[i];
2822*4882a593Smuzhiyun iter->scan_ch_bucket = plbestnet_v2->scan_ch_buckets[i];
2823*4882a593Smuzhiyun iter->tot_consumed = 0;
2824*4882a593Smuzhiyun iter->flag = 0;
2825*4882a593Smuzhiyun if (plnetinfo_v2->flags & PFN_PARTIAL_SCAN_MASK) {
2826*4882a593Smuzhiyun DHD_PNO(("This scan is aborted\n"));
2827*4882a593Smuzhiyun iter->flag = (ENABLE << PNO_STATUS_ABORT);
2828*4882a593Smuzhiyun } else if (gscan_params->reason) {
2829*4882a593Smuzhiyun iter->flag = (ENABLE << gscan_params->reason);
2830*4882a593Smuzhiyun }
2831*4882a593Smuzhiyun
2832*4882a593Smuzhiyun if (!tail) {
2833*4882a593Smuzhiyun gscan_params->gscan_batch_cache = iter;
2834*4882a593Smuzhiyun } else {
2835*4882a593Smuzhiyun tail->next = iter;
2836*4882a593Smuzhiyun }
2837*4882a593Smuzhiyun tail = iter;
2838*4882a593Smuzhiyun iter->next = NULL;
2839*4882a593Smuzhiyun for (j = 0; j < nAPs_per_scan[i]; j++, plnetinfo_v2++) {
2840*4882a593Smuzhiyun result = &iter->results[j];
2841*4882a593Smuzhiyun
2842*4882a593Smuzhiyun result->channel =
2843*4882a593Smuzhiyun wl_channel_to_frequency(
2844*4882a593Smuzhiyun wf_chspec_ctlchan(plnetinfo_v2->pfnsubnet.channel),
2845*4882a593Smuzhiyun CHSPEC_BAND(plnetinfo_v2->pfnsubnet.channel));
2846*4882a593Smuzhiyun result->rssi = (int32) plnetinfo_v2->RSSI;
2847*4882a593Smuzhiyun /* Info not available & not expected */
2848*4882a593Smuzhiyun result->beacon_period = 0;
2849*4882a593Smuzhiyun result->capability = 0;
2850*4882a593Smuzhiyun result->rtt = (uint64) plnetinfo_v2->rtt0;
2851*4882a593Smuzhiyun result->rtt_sd = (uint64) plnetinfo_v2->rtt1;
2852*4882a593Smuzhiyun result->ts = convert_fw_rel_time_to_systime(&tm_spec,
2853*4882a593Smuzhiyun plnetinfo_v2->timestamp);
2854*4882a593Smuzhiyun ts = plnetinfo_v2->timestamp;
2855*4882a593Smuzhiyun if (plnetinfo_v2->pfnsubnet.SSID_len > DOT11_MAX_SSID_LEN) {
2856*4882a593Smuzhiyun DHD_ERROR(("%s: Invalid SSID length %d\n",
2857*4882a593Smuzhiyun __FUNCTION__,
2858*4882a593Smuzhiyun plnetinfo_v2->pfnsubnet.SSID_len));
2859*4882a593Smuzhiyun plnetinfo_v2->pfnsubnet.SSID_len =
2860*4882a593Smuzhiyun DOT11_MAX_SSID_LEN;
2861*4882a593Smuzhiyun }
2862*4882a593Smuzhiyun (void)memcpy_s(result->ssid, DOT11_MAX_SSID_LEN,
2863*4882a593Smuzhiyun plnetinfo_v2->pfnsubnet.u.SSID,
2864*4882a593Smuzhiyun plnetinfo_v2->pfnsubnet.SSID_len);
2865*4882a593Smuzhiyun result->ssid[plnetinfo_v2->pfnsubnet.SSID_len] = '\0';
2866*4882a593Smuzhiyun (void)memcpy_s(&result->macaddr, ETHER_ADDR_LEN,
2867*4882a593Smuzhiyun &plnetinfo_v2->pfnsubnet.BSSID, ETHER_ADDR_LEN);
2868*4882a593Smuzhiyun
2869*4882a593Smuzhiyun DHD_PNO(("\tSSID : "));
2870*4882a593Smuzhiyun DHD_PNO(("\n"));
2871*4882a593Smuzhiyun DHD_PNO(("\tBSSID: "MACDBG"\n",
2872*4882a593Smuzhiyun MAC2STRDBG(result->macaddr.octet)));
2873*4882a593Smuzhiyun DHD_PNO(("\tchannel: %d, RSSI: %d, timestamp: %d ms\n",
2874*4882a593Smuzhiyun plnetinfo_v2->pfnsubnet.channel,
2875*4882a593Smuzhiyun plnetinfo_v2->RSSI, plnetinfo_v2->timestamp));
2876*4882a593Smuzhiyun DHD_PNO(("\tRTT0 : %d, RTT1: %d\n",
2877*4882a593Smuzhiyun plnetinfo_v2->rtt0, plnetinfo_v2->rtt1));
2878*4882a593Smuzhiyun
2879*4882a593Smuzhiyun }
2880*4882a593Smuzhiyun }
2881*4882a593Smuzhiyun
2882*4882a593Smuzhiyun } else {
2883*4882a593Smuzhiyun err = BCME_VERSION;
2884*4882a593Smuzhiyun DHD_ERROR(("bestnet fw version %d not supported\n",
2885*4882a593Smuzhiyun plbestnet_v1->version));
2886*4882a593Smuzhiyun goto exit_mutex_unlock;
2887*4882a593Smuzhiyun }
2888*4882a593Smuzhiyun } while (fwstatus == PFN_INCOMPLETE);
2889*4882a593Smuzhiyun
2890*4882a593Smuzhiyun exit_mutex_unlock:
2891*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
2892*4882a593Smuzhiyun exit:
2893*4882a593Smuzhiyun params->params_gscan.get_batch_flag = GSCAN_BATCH_RETRIEVAL_COMPLETE;
2894*4882a593Smuzhiyun smp_wmb();
2895*4882a593Smuzhiyun wake_up_interruptible(&_pno_state->batch_get_wait);
2896*4882a593Smuzhiyun if (nAPs_per_scan) {
2897*4882a593Smuzhiyun MFREE(dhd->osh, nAPs_per_scan, gscan_params->mscan * sizeof(uint8));
2898*4882a593Smuzhiyun }
2899*4882a593Smuzhiyun if (plbestnet_v1) {
2900*4882a593Smuzhiyun MFREE(dhd->osh, plbestnet_v1, PNO_BESTNET_LEN);
2901*4882a593Smuzhiyun }
2902*4882a593Smuzhiyun DHD_PNO(("Batch retrieval done!\n"));
2903*4882a593Smuzhiyun return err;
2904*4882a593Smuzhiyun }
2905*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
2906*4882a593Smuzhiyun
2907*4882a593Smuzhiyun #if defined (GSCAN_SUPPORT) || defined(DHD_GET_VALID_CHANNELS)
2908*4882a593Smuzhiyun static void *
dhd_get_gscan_batch_results(dhd_pub_t * dhd,uint32 * len)2909*4882a593Smuzhiyun dhd_get_gscan_batch_results(dhd_pub_t *dhd, uint32 *len)
2910*4882a593Smuzhiyun {
2911*4882a593Smuzhiyun gscan_results_cache_t *iter, *results;
2912*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
2913*4882a593Smuzhiyun dhd_pno_params_t *_params;
2914*4882a593Smuzhiyun uint16 num_scan_ids = 0, num_results = 0;
2915*4882a593Smuzhiyun
2916*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
2917*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
2918*4882a593Smuzhiyun
2919*4882a593Smuzhiyun iter = results = _params->params_gscan.gscan_batch_cache;
2920*4882a593Smuzhiyun while (iter) {
2921*4882a593Smuzhiyun num_results += iter->tot_count - iter->tot_consumed;
2922*4882a593Smuzhiyun num_scan_ids++;
2923*4882a593Smuzhiyun iter = iter->next;
2924*4882a593Smuzhiyun }
2925*4882a593Smuzhiyun
2926*4882a593Smuzhiyun *len = ((num_results << 16) | (num_scan_ids));
2927*4882a593Smuzhiyun return results;
2928*4882a593Smuzhiyun }
2929*4882a593Smuzhiyun
2930*4882a593Smuzhiyun void *
dhd_pno_get_gscan(dhd_pub_t * dhd,dhd_pno_gscan_cmd_cfg_t type,void * info,uint32 * len)2931*4882a593Smuzhiyun dhd_pno_get_gscan(dhd_pub_t *dhd, dhd_pno_gscan_cmd_cfg_t type,
2932*4882a593Smuzhiyun void *info, uint32 *len)
2933*4882a593Smuzhiyun {
2934*4882a593Smuzhiyun void *ret = NULL;
2935*4882a593Smuzhiyun dhd_pno_gscan_capabilities_t *ptr;
2936*4882a593Smuzhiyun dhd_pno_ssid_t *ssid_elem;
2937*4882a593Smuzhiyun dhd_pno_params_t *_params;
2938*4882a593Smuzhiyun dhd_epno_ssid_cfg_t *epno_cfg;
2939*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
2940*4882a593Smuzhiyun
2941*4882a593Smuzhiyun if (!dhd || !dhd->pno_state) {
2942*4882a593Smuzhiyun DHD_ERROR(("NULL POINTER : %s\n", __FUNCTION__));
2943*4882a593Smuzhiyun return NULL;
2944*4882a593Smuzhiyun }
2945*4882a593Smuzhiyun
2946*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
2947*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
2948*4882a593Smuzhiyun
2949*4882a593Smuzhiyun if (!len) {
2950*4882a593Smuzhiyun DHD_ERROR(("%s: len is NULL\n", __FUNCTION__));
2951*4882a593Smuzhiyun return NULL;
2952*4882a593Smuzhiyun }
2953*4882a593Smuzhiyun
2954*4882a593Smuzhiyun switch (type) {
2955*4882a593Smuzhiyun case DHD_PNO_GET_CAPABILITIES:
2956*4882a593Smuzhiyun ptr = (dhd_pno_gscan_capabilities_t *)
2957*4882a593Smuzhiyun MALLOCZ(dhd->osh, sizeof(dhd_pno_gscan_capabilities_t));
2958*4882a593Smuzhiyun if (!ptr)
2959*4882a593Smuzhiyun break;
2960*4882a593Smuzhiyun /* Hardcoding these values for now, need to get
2961*4882a593Smuzhiyun * these values from FW, will change in a later check-in
2962*4882a593Smuzhiyun */
2963*4882a593Smuzhiyun ptr->max_scan_cache_size = GSCAN_MAX_AP_CACHE;
2964*4882a593Smuzhiyun ptr->max_scan_buckets = GSCAN_MAX_CH_BUCKETS;
2965*4882a593Smuzhiyun ptr->max_ap_cache_per_scan = GSCAN_MAX_AP_CACHE_PER_SCAN;
2966*4882a593Smuzhiyun ptr->max_rssi_sample_size = PFN_SWC_RSSI_WINDOW_MAX;
2967*4882a593Smuzhiyun ptr->max_scan_reporting_threshold = 100;
2968*4882a593Smuzhiyun ptr->max_hotlist_bssids = PFN_HOTLIST_MAX_NUM_APS;
2969*4882a593Smuzhiyun ptr->max_hotlist_ssids = 0;
2970*4882a593Smuzhiyun ptr->max_significant_wifi_change_aps = 0;
2971*4882a593Smuzhiyun ptr->max_bssid_history_entries = 0;
2972*4882a593Smuzhiyun ptr->max_epno_ssid_crc32 = MAX_EPNO_SSID_NUM;
2973*4882a593Smuzhiyun ptr->max_epno_hidden_ssid = MAX_EPNO_HIDDEN_SSID;
2974*4882a593Smuzhiyun ptr->max_white_list_ssid = MAX_WHITELIST_SSID;
2975*4882a593Smuzhiyun ret = (void *)ptr;
2976*4882a593Smuzhiyun *len = sizeof(dhd_pno_gscan_capabilities_t);
2977*4882a593Smuzhiyun break;
2978*4882a593Smuzhiyun
2979*4882a593Smuzhiyun case DHD_PNO_GET_BATCH_RESULTS:
2980*4882a593Smuzhiyun ret = dhd_get_gscan_batch_results(dhd, len);
2981*4882a593Smuzhiyun break;
2982*4882a593Smuzhiyun case DHD_PNO_GET_CHANNEL_LIST:
2983*4882a593Smuzhiyun if (info) {
2984*4882a593Smuzhiyun uint16 ch_list[WL_NUMCHANNELS];
2985*4882a593Smuzhiyun uint32 *p, mem_needed, i;
2986*4882a593Smuzhiyun int32 err, nchan = WL_NUMCHANNELS;
2987*4882a593Smuzhiyun uint32 *gscan_band = (uint32 *) info;
2988*4882a593Smuzhiyun uint8 band = 0;
2989*4882a593Smuzhiyun
2990*4882a593Smuzhiyun /* No band specified?, nothing to do */
2991*4882a593Smuzhiyun if ((*gscan_band & GSCAN_BAND_MASK) == 0) {
2992*4882a593Smuzhiyun DHD_PNO(("No band specified\n"));
2993*4882a593Smuzhiyun *len = 0;
2994*4882a593Smuzhiyun break;
2995*4882a593Smuzhiyun }
2996*4882a593Smuzhiyun
2997*4882a593Smuzhiyun /* HAL and DHD use different bits for 2.4G and
2998*4882a593Smuzhiyun * 5G in bitmap. Hence translating it here...
2999*4882a593Smuzhiyun */
3000*4882a593Smuzhiyun if (*gscan_band & GSCAN_BG_BAND_MASK) {
3001*4882a593Smuzhiyun band |= WLC_BAND_2G;
3002*4882a593Smuzhiyun }
3003*4882a593Smuzhiyun if (*gscan_band & GSCAN_A_BAND_MASK) {
3004*4882a593Smuzhiyun band |=
3005*4882a593Smuzhiyun #ifdef WL_6G_BAND
3006*4882a593Smuzhiyun WLC_BAND_6G |
3007*4882a593Smuzhiyun #endif /* WL_6G_BAND */
3008*4882a593Smuzhiyun WLC_BAND_5G;
3009*4882a593Smuzhiyun }
3010*4882a593Smuzhiyun
3011*4882a593Smuzhiyun err = _dhd_pno_get_channels(dhd, ch_list, &nchan,
3012*4882a593Smuzhiyun (band & GSCAN_ABG_BAND_MASK),
3013*4882a593Smuzhiyun !(*gscan_band & GSCAN_DFS_MASK));
3014*4882a593Smuzhiyun
3015*4882a593Smuzhiyun if (err < 0) {
3016*4882a593Smuzhiyun DHD_ERROR(("%s: failed to get valid channel list\n",
3017*4882a593Smuzhiyun __FUNCTION__));
3018*4882a593Smuzhiyun *len = 0;
3019*4882a593Smuzhiyun } else {
3020*4882a593Smuzhiyun mem_needed = sizeof(uint32) * nchan;
3021*4882a593Smuzhiyun p = (uint32 *)MALLOC(dhd->osh, mem_needed);
3022*4882a593Smuzhiyun if (!p) {
3023*4882a593Smuzhiyun DHD_ERROR(("%s: Unable to malloc %d bytes\n",
3024*4882a593Smuzhiyun __FUNCTION__, mem_needed));
3025*4882a593Smuzhiyun break;
3026*4882a593Smuzhiyun }
3027*4882a593Smuzhiyun for (i = 0; i < nchan; i++) {
3028*4882a593Smuzhiyun p[i] = wl_channel_to_frequency(
3029*4882a593Smuzhiyun (ch_list[i]),
3030*4882a593Smuzhiyun CHSPEC_BAND(ch_list[i]));
3031*4882a593Smuzhiyun }
3032*4882a593Smuzhiyun ret = p;
3033*4882a593Smuzhiyun *len = mem_needed;
3034*4882a593Smuzhiyun }
3035*4882a593Smuzhiyun } else {
3036*4882a593Smuzhiyun *len = 0;
3037*4882a593Smuzhiyun DHD_ERROR(("%s: info buffer is NULL\n", __FUNCTION__));
3038*4882a593Smuzhiyun }
3039*4882a593Smuzhiyun break;
3040*4882a593Smuzhiyun case DHD_PNO_GET_NEW_EPNO_SSID_ELEM:
3041*4882a593Smuzhiyun epno_cfg = &_params->params_gscan.epno_cfg;
3042*4882a593Smuzhiyun if (epno_cfg->num_epno_ssid >=
3043*4882a593Smuzhiyun MAX_EPNO_SSID_NUM) {
3044*4882a593Smuzhiyun DHD_ERROR(("Excessive number of ePNO SSIDs programmed %d\n",
3045*4882a593Smuzhiyun epno_cfg->num_epno_ssid));
3046*4882a593Smuzhiyun return NULL;
3047*4882a593Smuzhiyun }
3048*4882a593Smuzhiyun if (!epno_cfg->num_epno_ssid) {
3049*4882a593Smuzhiyun INIT_LIST_HEAD(&epno_cfg->epno_ssid_list);
3050*4882a593Smuzhiyun }
3051*4882a593Smuzhiyun ssid_elem = MALLOCZ(dhd->osh, sizeof(dhd_pno_ssid_t));
3052*4882a593Smuzhiyun if (!ssid_elem) {
3053*4882a593Smuzhiyun DHD_ERROR(("EPNO ssid: cannot alloc %zd bytes",
3054*4882a593Smuzhiyun sizeof(dhd_pno_ssid_t)));
3055*4882a593Smuzhiyun return NULL;
3056*4882a593Smuzhiyun }
3057*4882a593Smuzhiyun epno_cfg->num_epno_ssid++;
3058*4882a593Smuzhiyun list_add_tail(&ssid_elem->list, &epno_cfg->epno_ssid_list);
3059*4882a593Smuzhiyun ret = ssid_elem;
3060*4882a593Smuzhiyun break;
3061*4882a593Smuzhiyun default:
3062*4882a593Smuzhiyun DHD_ERROR(("%s: Unrecognized cmd type - %d\n", __FUNCTION__, type));
3063*4882a593Smuzhiyun break;
3064*4882a593Smuzhiyun }
3065*4882a593Smuzhiyun
3066*4882a593Smuzhiyun return ret;
3067*4882a593Smuzhiyun
3068*4882a593Smuzhiyun }
3069*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT || DHD_GET_VALID_CHANNELS */
3070*4882a593Smuzhiyun
3071*4882a593Smuzhiyun static int
_dhd_pno_get_for_batch(dhd_pub_t * dhd,char * buf,int bufsize,int reason)3072*4882a593Smuzhiyun _dhd_pno_get_for_batch(dhd_pub_t *dhd, char *buf, int bufsize, int reason)
3073*4882a593Smuzhiyun {
3074*4882a593Smuzhiyun int err = BCME_OK;
3075*4882a593Smuzhiyun int i, j;
3076*4882a593Smuzhiyun uint32 timestamp = 0;
3077*4882a593Smuzhiyun dhd_pno_params_t *_params = NULL;
3078*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state = NULL;
3079*4882a593Smuzhiyun wl_pfn_lscanresults_v1_t *plbestnet_v1 = NULL;
3080*4882a593Smuzhiyun wl_pfn_lscanresults_v2_t *plbestnet_v2 = NULL;
3081*4882a593Smuzhiyun wl_pfn_lnet_info_v1_t *plnetinfo;
3082*4882a593Smuzhiyun wl_pfn_lnet_info_v2_t *plnetinfo_v2;
3083*4882a593Smuzhiyun dhd_pno_bestnet_entry_t *pbestnet_entry;
3084*4882a593Smuzhiyun dhd_pno_best_header_t *pbestnetheader = NULL;
3085*4882a593Smuzhiyun dhd_pno_scan_results_t *pscan_results = NULL, *siter, *snext;
3086*4882a593Smuzhiyun bool allocate_header = FALSE;
3087*4882a593Smuzhiyun uint16 fwstatus = PFN_INCOMPLETE;
3088*4882a593Smuzhiyun uint16 fwcount;
3089*4882a593Smuzhiyun
3090*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
3091*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
3092*4882a593Smuzhiyun
3093*4882a593Smuzhiyun /* The static asserts below guarantee the v1 and v2 net_info and subnet_info
3094*4882a593Smuzhiyun * structures are compatible in size and SSID offset, allowing v1 to be safely
3095*4882a593Smuzhiyun * used in the code below except for lscanresults fields themselves
3096*4882a593Smuzhiyun * (status, count, offset to netinfo).
3097*4882a593Smuzhiyun */
3098*4882a593Smuzhiyun STATIC_ASSERT(sizeof(wl_pfn_net_info_v1_t) == sizeof(wl_pfn_net_info_v2_t));
3099*4882a593Smuzhiyun STATIC_ASSERT(sizeof(wl_pfn_lnet_info_v1_t) == sizeof(wl_pfn_lnet_info_v2_t));
3100*4882a593Smuzhiyun STATIC_ASSERT(sizeof(wl_pfn_subnet_info_v1_t) == sizeof(wl_pfn_subnet_info_v2_t));
3101*4882a593Smuzhiyun ASSERT(OFFSETOF(wl_pfn_subnet_info_v1_t, SSID) ==
3102*4882a593Smuzhiyun OFFSETOF(wl_pfn_subnet_info_v2_t, u.SSID));
3103*4882a593Smuzhiyun
3104*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
3105*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
3106*4882a593Smuzhiyun
3107*4882a593Smuzhiyun if (!dhd_support_sta_mode(dhd)) {
3108*4882a593Smuzhiyun err = BCME_BADOPTION;
3109*4882a593Smuzhiyun goto exit_no_unlock;
3110*4882a593Smuzhiyun }
3111*4882a593Smuzhiyun
3112*4882a593Smuzhiyun if (!WLS_SUPPORTED(_pno_state)) {
3113*4882a593Smuzhiyun DHD_ERROR(("%s : wifi location service is not supported\n", __FUNCTION__));
3114*4882a593Smuzhiyun err = BCME_UNSUPPORTED;
3115*4882a593Smuzhiyun goto exit_no_unlock;
3116*4882a593Smuzhiyun }
3117*4882a593Smuzhiyun
3118*4882a593Smuzhiyun if (!(_pno_state->pno_mode & DHD_PNO_BATCH_MODE)) {
3119*4882a593Smuzhiyun DHD_ERROR(("%s: Batching SCAN mode is not enabled\n", __FUNCTION__));
3120*4882a593Smuzhiyun goto exit_no_unlock;
3121*4882a593Smuzhiyun }
3122*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
3123*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS];
3124*4882a593Smuzhiyun if (buf && bufsize) {
3125*4882a593Smuzhiyun if (!list_empty(&_params->params_batch.get_batch.expired_scan_results_list)) {
3126*4882a593Smuzhiyun /* need to check whether we have cashed data or not */
3127*4882a593Smuzhiyun DHD_PNO(("%s: have cashed batching data in Driver\n",
3128*4882a593Smuzhiyun __FUNCTION__));
3129*4882a593Smuzhiyun /* convert to results format */
3130*4882a593Smuzhiyun goto convert_format;
3131*4882a593Smuzhiyun } else {
3132*4882a593Smuzhiyun /* this is a first try to get batching results */
3133*4882a593Smuzhiyun if (!list_empty(&_params->params_batch.get_batch.scan_results_list)) {
3134*4882a593Smuzhiyun /* move the scan_results_list to expired_scan_results_lists */
3135*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
3136*4882a593Smuzhiyun list_for_each_entry_safe(siter, snext,
3137*4882a593Smuzhiyun &_params->params_batch.get_batch.scan_results_list, list) {
3138*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
3139*4882a593Smuzhiyun list_move_tail(&siter->list,
3140*4882a593Smuzhiyun &_params->params_batch.get_batch.expired_scan_results_list);
3141*4882a593Smuzhiyun }
3142*4882a593Smuzhiyun _params->params_batch.get_batch.top_node_cnt = 0;
3143*4882a593Smuzhiyun _params->params_batch.get_batch.expired_tot_scan_cnt =
3144*4882a593Smuzhiyun _params->params_batch.get_batch.tot_scan_cnt;
3145*4882a593Smuzhiyun _params->params_batch.get_batch.tot_scan_cnt = 0;
3146*4882a593Smuzhiyun goto convert_format;
3147*4882a593Smuzhiyun }
3148*4882a593Smuzhiyun }
3149*4882a593Smuzhiyun }
3150*4882a593Smuzhiyun /* create dhd_pno_scan_results_t whenever we got event WLC_E_PFN_BEST_BATCHING */
3151*4882a593Smuzhiyun pscan_results = (dhd_pno_scan_results_t *)MALLOC(dhd->osh, SCAN_RESULTS_SIZE);
3152*4882a593Smuzhiyun if (pscan_results == NULL) {
3153*4882a593Smuzhiyun err = BCME_NOMEM;
3154*4882a593Smuzhiyun DHD_ERROR(("failed to allocate dhd_pno_scan_results_t\n"));
3155*4882a593Smuzhiyun goto exit;
3156*4882a593Smuzhiyun }
3157*4882a593Smuzhiyun pscan_results->bestnetheader = NULL;
3158*4882a593Smuzhiyun pscan_results->cnt_header = 0;
3159*4882a593Smuzhiyun /* add the element into list unless total node cnt is less than MAX_NODE_ CNT */
3160*4882a593Smuzhiyun if (_params->params_batch.get_batch.top_node_cnt < MAX_NODE_CNT) {
3161*4882a593Smuzhiyun list_add(&pscan_results->list, &_params->params_batch.get_batch.scan_results_list);
3162*4882a593Smuzhiyun _params->params_batch.get_batch.top_node_cnt++;
3163*4882a593Smuzhiyun } else {
3164*4882a593Smuzhiyun int _removed_scan_cnt;
3165*4882a593Smuzhiyun /* remove oldest one and add new one */
3166*4882a593Smuzhiyun DHD_PNO(("%s : Remove oldest node and add new one\n", __FUNCTION__));
3167*4882a593Smuzhiyun _removed_scan_cnt = _dhd_pno_clear_all_batch_results(dhd,
3168*4882a593Smuzhiyun &_params->params_batch.get_batch.scan_results_list, TRUE);
3169*4882a593Smuzhiyun _params->params_batch.get_batch.tot_scan_cnt -= _removed_scan_cnt;
3170*4882a593Smuzhiyun list_add(&pscan_results->list, &_params->params_batch.get_batch.scan_results_list);
3171*4882a593Smuzhiyun
3172*4882a593Smuzhiyun }
3173*4882a593Smuzhiyun
3174*4882a593Smuzhiyun plbestnet_v1 = (wl_pfn_lscanresults_v1_t *)MALLOC(dhd->osh, PNO_BESTNET_LEN);
3175*4882a593Smuzhiyun if (!plbestnet_v1) {
3176*4882a593Smuzhiyun err = BCME_NOMEM;
3177*4882a593Smuzhiyun DHD_ERROR(("%s: failed to allocate buffer for bestnet", __FUNCTION__));
3178*4882a593Smuzhiyun goto exit;
3179*4882a593Smuzhiyun }
3180*4882a593Smuzhiyun
3181*4882a593Smuzhiyun plbestnet_v2 = (wl_pfn_lscanresults_v2_t*)plbestnet_v1;
3182*4882a593Smuzhiyun
3183*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
3184*4882a593Smuzhiyun do {
3185*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfnlbest", NULL, 0, (char *)plbestnet_v1, PNO_BESTNET_LEN,
3186*4882a593Smuzhiyun FALSE);
3187*4882a593Smuzhiyun if (err < 0) {
3188*4882a593Smuzhiyun if (err == BCME_EPERM) {
3189*4882a593Smuzhiyun DHD_ERROR(("we cannot get the batching data "
3190*4882a593Smuzhiyun "during scanning in firmware, try again\n,"));
3191*4882a593Smuzhiyun msleep(500);
3192*4882a593Smuzhiyun continue;
3193*4882a593Smuzhiyun } else {
3194*4882a593Smuzhiyun DHD_ERROR(("%s : failed to execute pfnlbest (err :%d)\n",
3195*4882a593Smuzhiyun __FUNCTION__, err));
3196*4882a593Smuzhiyun goto exit;
3197*4882a593Smuzhiyun }
3198*4882a593Smuzhiyun }
3199*4882a593Smuzhiyun
3200*4882a593Smuzhiyun if (plbestnet_v1->version == PFN_LBEST_SCAN_RESULT_VERSION_V1) {
3201*4882a593Smuzhiyun fwstatus = plbestnet_v1->status;
3202*4882a593Smuzhiyun fwcount = plbestnet_v1->count;
3203*4882a593Smuzhiyun plnetinfo = &plbestnet_v1->netinfo[0];
3204*4882a593Smuzhiyun if (fwcount == 0) {
3205*4882a593Smuzhiyun DHD_PNO(("No more batch results\n"));
3206*4882a593Smuzhiyun goto exit;
3207*4882a593Smuzhiyun }
3208*4882a593Smuzhiyun if (fwcount > BESTN_MAX) {
3209*4882a593Smuzhiyun DHD_ERROR(("%s :fwcount %d is greater than BESTN_MAX %d \n",
3210*4882a593Smuzhiyun __FUNCTION__, fwcount, (int)BESTN_MAX));
3211*4882a593Smuzhiyun /* Process only BESTN_MAX number of results per batch */
3212*4882a593Smuzhiyun fwcount = BESTN_MAX;
3213*4882a593Smuzhiyun }
3214*4882a593Smuzhiyun for (i = 0; i < fwcount; i++) {
3215*4882a593Smuzhiyun pbestnet_entry = (dhd_pno_bestnet_entry_t *)
3216*4882a593Smuzhiyun MALLOC(dhd->osh, BESTNET_ENTRY_SIZE);
3217*4882a593Smuzhiyun if (pbestnet_entry == NULL) {
3218*4882a593Smuzhiyun err = BCME_NOMEM;
3219*4882a593Smuzhiyun DHD_ERROR(("failed to allocate dhd_pno_bestnet_entry\n"));
3220*4882a593Smuzhiyun goto exit;
3221*4882a593Smuzhiyun }
3222*4882a593Smuzhiyun memset(pbestnet_entry, 0, BESTNET_ENTRY_SIZE);
3223*4882a593Smuzhiyun /* record the current time */
3224*4882a593Smuzhiyun pbestnet_entry->recorded_time = jiffies;
3225*4882a593Smuzhiyun /* create header for the first entry */
3226*4882a593Smuzhiyun allocate_header = (i == 0)? TRUE : FALSE;
3227*4882a593Smuzhiyun /* check whether the new generation is started or not */
3228*4882a593Smuzhiyun if (timestamp && (TIME_DIFF(timestamp, plnetinfo->timestamp)
3229*4882a593Smuzhiyun > TIME_MIN_DIFF))
3230*4882a593Smuzhiyun allocate_header = TRUE;
3231*4882a593Smuzhiyun timestamp = plnetinfo->timestamp;
3232*4882a593Smuzhiyun if (allocate_header) {
3233*4882a593Smuzhiyun pbestnetheader = (dhd_pno_best_header_t *)
3234*4882a593Smuzhiyun MALLOC(dhd->osh, BEST_HEADER_SIZE);
3235*4882a593Smuzhiyun if (pbestnetheader == NULL) {
3236*4882a593Smuzhiyun err = BCME_NOMEM;
3237*4882a593Smuzhiyun if (pbestnet_entry)
3238*4882a593Smuzhiyun MFREE(dhd->osh, pbestnet_entry,
3239*4882a593Smuzhiyun BESTNET_ENTRY_SIZE);
3240*4882a593Smuzhiyun DHD_ERROR(("failed to allocate"
3241*4882a593Smuzhiyun " dhd_pno_bestnet_entry\n"));
3242*4882a593Smuzhiyun goto exit;
3243*4882a593Smuzhiyun }
3244*4882a593Smuzhiyun /* increase total cnt of bestnet header */
3245*4882a593Smuzhiyun pscan_results->cnt_header++;
3246*4882a593Smuzhiyun /* need to record the reason to call dhd_pno_get_for_bach */
3247*4882a593Smuzhiyun if (reason)
3248*4882a593Smuzhiyun pbestnetheader->reason = (ENABLE << reason);
3249*4882a593Smuzhiyun memset(pbestnetheader, 0, BEST_HEADER_SIZE);
3250*4882a593Smuzhiyun /* initialize the head of linked list */
3251*4882a593Smuzhiyun INIT_LIST_HEAD(&(pbestnetheader->entry_list));
3252*4882a593Smuzhiyun /* link the pbestnet heaer into existed list */
3253*4882a593Smuzhiyun if (pscan_results->bestnetheader == NULL)
3254*4882a593Smuzhiyun /* In case of header */
3255*4882a593Smuzhiyun pscan_results->bestnetheader = pbestnetheader;
3256*4882a593Smuzhiyun else {
3257*4882a593Smuzhiyun dhd_pno_best_header_t *head =
3258*4882a593Smuzhiyun pscan_results->bestnetheader;
3259*4882a593Smuzhiyun pscan_results->bestnetheader = pbestnetheader;
3260*4882a593Smuzhiyun pbestnetheader->next = head;
3261*4882a593Smuzhiyun }
3262*4882a593Smuzhiyun }
3263*4882a593Smuzhiyun pbestnet_entry->channel = plnetinfo->pfnsubnet.channel;
3264*4882a593Smuzhiyun pbestnet_entry->RSSI = plnetinfo->RSSI;
3265*4882a593Smuzhiyun if (plnetinfo->flags & PFN_PARTIAL_SCAN_MASK) {
3266*4882a593Smuzhiyun /* if RSSI is positive value, we assume that
3267*4882a593Smuzhiyun * this scan is aborted by other scan
3268*4882a593Smuzhiyun */
3269*4882a593Smuzhiyun DHD_PNO(("This scan is aborted\n"));
3270*4882a593Smuzhiyun pbestnetheader->reason = (ENABLE << PNO_STATUS_ABORT);
3271*4882a593Smuzhiyun }
3272*4882a593Smuzhiyun pbestnet_entry->rtt0 = plnetinfo->rtt0;
3273*4882a593Smuzhiyun pbestnet_entry->rtt1 = plnetinfo->rtt1;
3274*4882a593Smuzhiyun pbestnet_entry->timestamp = plnetinfo->timestamp;
3275*4882a593Smuzhiyun if (plnetinfo->pfnsubnet.SSID_len > DOT11_MAX_SSID_LEN) {
3276*4882a593Smuzhiyun DHD_ERROR(("%s: Invalid SSID length"
3277*4882a593Smuzhiyun " %d: trimming it to max\n",
3278*4882a593Smuzhiyun __FUNCTION__, plnetinfo->pfnsubnet.SSID_len));
3279*4882a593Smuzhiyun plnetinfo->pfnsubnet.SSID_len = DOT11_MAX_SSID_LEN;
3280*4882a593Smuzhiyun }
3281*4882a593Smuzhiyun pbestnet_entry->SSID_len = plnetinfo->pfnsubnet.SSID_len;
3282*4882a593Smuzhiyun memcpy(pbestnet_entry->SSID, plnetinfo->pfnsubnet.SSID,
3283*4882a593Smuzhiyun pbestnet_entry->SSID_len);
3284*4882a593Smuzhiyun memcpy(&pbestnet_entry->BSSID, &plnetinfo->pfnsubnet.BSSID,
3285*4882a593Smuzhiyun ETHER_ADDR_LEN);
3286*4882a593Smuzhiyun /* add the element into list */
3287*4882a593Smuzhiyun list_add_tail(&pbestnet_entry->list, &pbestnetheader->entry_list);
3288*4882a593Smuzhiyun /* increase best entry count */
3289*4882a593Smuzhiyun pbestnetheader->tot_cnt++;
3290*4882a593Smuzhiyun pbestnetheader->tot_size += BESTNET_ENTRY_SIZE;
3291*4882a593Smuzhiyun DHD_PNO(("Header %d\n", pscan_results->cnt_header - 1));
3292*4882a593Smuzhiyun DHD_PNO(("\tSSID : "));
3293*4882a593Smuzhiyun for (j = 0; j < plnetinfo->pfnsubnet.SSID_len; j++)
3294*4882a593Smuzhiyun DHD_PNO(("%c", plnetinfo->pfnsubnet.SSID[j]));
3295*4882a593Smuzhiyun DHD_PNO(("\n"));
3296*4882a593Smuzhiyun DHD_PNO(("\tBSSID: "MACDBG"\n",
3297*4882a593Smuzhiyun MAC2STRDBG(plnetinfo->pfnsubnet.BSSID.octet)));
3298*4882a593Smuzhiyun DHD_PNO(("\tchannel: %d, RSSI: %d, timestamp: %d ms\n",
3299*4882a593Smuzhiyun plnetinfo->pfnsubnet.channel,
3300*4882a593Smuzhiyun plnetinfo->RSSI, plnetinfo->timestamp));
3301*4882a593Smuzhiyun DHD_PNO(("\tRTT0 : %d, RTT1: %d\n", plnetinfo->rtt0,
3302*4882a593Smuzhiyun plnetinfo->rtt1));
3303*4882a593Smuzhiyun plnetinfo++;
3304*4882a593Smuzhiyun }
3305*4882a593Smuzhiyun } else if (plbestnet_v2->version == PFN_LBEST_SCAN_RESULT_VERSION_V2) {
3306*4882a593Smuzhiyun fwstatus = plbestnet_v2->status;
3307*4882a593Smuzhiyun fwcount = plbestnet_v2->count;
3308*4882a593Smuzhiyun plnetinfo_v2 = (wl_pfn_lnet_info_v2_t*)&plbestnet_v2->netinfo[0];
3309*4882a593Smuzhiyun if (fwcount == 0) {
3310*4882a593Smuzhiyun DHD_PNO(("No more batch results\n"));
3311*4882a593Smuzhiyun goto exit;
3312*4882a593Smuzhiyun }
3313*4882a593Smuzhiyun if (fwcount > BESTN_MAX) {
3314*4882a593Smuzhiyun DHD_ERROR(("%s :fwcount %d is greater than BESTN_MAX %d \n",
3315*4882a593Smuzhiyun __FUNCTION__, fwcount, (int)BESTN_MAX));
3316*4882a593Smuzhiyun /* Process only BESTN_MAX number of results per batch */
3317*4882a593Smuzhiyun fwcount = BESTN_MAX;
3318*4882a593Smuzhiyun }
3319*4882a593Smuzhiyun DHD_PNO(("ver %d, status : %d, count %d\n",
3320*4882a593Smuzhiyun plbestnet_v2->version, fwstatus, fwcount));
3321*4882a593Smuzhiyun
3322*4882a593Smuzhiyun for (i = 0; i < fwcount; i++) {
3323*4882a593Smuzhiyun pbestnet_entry = (dhd_pno_bestnet_entry_t *)
3324*4882a593Smuzhiyun MALLOC(dhd->osh, BESTNET_ENTRY_SIZE);
3325*4882a593Smuzhiyun if (pbestnet_entry == NULL) {
3326*4882a593Smuzhiyun err = BCME_NOMEM;
3327*4882a593Smuzhiyun DHD_ERROR(("failed to allocate dhd_pno_bestnet_entry\n"));
3328*4882a593Smuzhiyun goto exit;
3329*4882a593Smuzhiyun }
3330*4882a593Smuzhiyun memset(pbestnet_entry, 0, BESTNET_ENTRY_SIZE);
3331*4882a593Smuzhiyun /* record the current time */
3332*4882a593Smuzhiyun pbestnet_entry->recorded_time = jiffies;
3333*4882a593Smuzhiyun /* create header for the first entry */
3334*4882a593Smuzhiyun allocate_header = (i == 0)? TRUE : FALSE;
3335*4882a593Smuzhiyun /* check whether the new generation is started or not */
3336*4882a593Smuzhiyun if (timestamp && (TIME_DIFF(timestamp, plnetinfo_v2->timestamp)
3337*4882a593Smuzhiyun > TIME_MIN_DIFF))
3338*4882a593Smuzhiyun allocate_header = TRUE;
3339*4882a593Smuzhiyun timestamp = plnetinfo_v2->timestamp;
3340*4882a593Smuzhiyun if (allocate_header) {
3341*4882a593Smuzhiyun pbestnetheader = (dhd_pno_best_header_t *)
3342*4882a593Smuzhiyun MALLOC(dhd->osh, BEST_HEADER_SIZE);
3343*4882a593Smuzhiyun if (pbestnetheader == NULL) {
3344*4882a593Smuzhiyun err = BCME_NOMEM;
3345*4882a593Smuzhiyun if (pbestnet_entry)
3346*4882a593Smuzhiyun MFREE(dhd->osh, pbestnet_entry,
3347*4882a593Smuzhiyun BESTNET_ENTRY_SIZE);
3348*4882a593Smuzhiyun DHD_ERROR(("failed to allocate"
3349*4882a593Smuzhiyun " dhd_pno_bestnet_entry\n"));
3350*4882a593Smuzhiyun goto exit;
3351*4882a593Smuzhiyun }
3352*4882a593Smuzhiyun /* increase total cnt of bestnet header */
3353*4882a593Smuzhiyun pscan_results->cnt_header++;
3354*4882a593Smuzhiyun /* need to record the reason to call dhd_pno_get_for_bach */
3355*4882a593Smuzhiyun if (reason)
3356*4882a593Smuzhiyun pbestnetheader->reason = (ENABLE << reason);
3357*4882a593Smuzhiyun memset(pbestnetheader, 0, BEST_HEADER_SIZE);
3358*4882a593Smuzhiyun /* initialize the head of linked list */
3359*4882a593Smuzhiyun INIT_LIST_HEAD(&(pbestnetheader->entry_list));
3360*4882a593Smuzhiyun /* link the pbestnet heaer into existed list */
3361*4882a593Smuzhiyun if (pscan_results->bestnetheader == NULL)
3362*4882a593Smuzhiyun /* In case of header */
3363*4882a593Smuzhiyun pscan_results->bestnetheader = pbestnetheader;
3364*4882a593Smuzhiyun else {
3365*4882a593Smuzhiyun dhd_pno_best_header_t *head =
3366*4882a593Smuzhiyun pscan_results->bestnetheader;
3367*4882a593Smuzhiyun pscan_results->bestnetheader = pbestnetheader;
3368*4882a593Smuzhiyun pbestnetheader->next = head;
3369*4882a593Smuzhiyun }
3370*4882a593Smuzhiyun }
3371*4882a593Smuzhiyun /* fills the best network info */
3372*4882a593Smuzhiyun pbestnet_entry->channel = plnetinfo_v2->pfnsubnet.channel;
3373*4882a593Smuzhiyun pbestnet_entry->RSSI = plnetinfo_v2->RSSI;
3374*4882a593Smuzhiyun if (plnetinfo_v2->flags & PFN_PARTIAL_SCAN_MASK) {
3375*4882a593Smuzhiyun /* if RSSI is positive value, we assume that
3376*4882a593Smuzhiyun * this scan is aborted by other scan
3377*4882a593Smuzhiyun */
3378*4882a593Smuzhiyun DHD_PNO(("This scan is aborted\n"));
3379*4882a593Smuzhiyun pbestnetheader->reason = (ENABLE << PNO_STATUS_ABORT);
3380*4882a593Smuzhiyun }
3381*4882a593Smuzhiyun pbestnet_entry->rtt0 = plnetinfo_v2->rtt0;
3382*4882a593Smuzhiyun pbestnet_entry->rtt1 = plnetinfo_v2->rtt1;
3383*4882a593Smuzhiyun pbestnet_entry->timestamp = plnetinfo_v2->timestamp;
3384*4882a593Smuzhiyun if (plnetinfo_v2->pfnsubnet.SSID_len > DOT11_MAX_SSID_LEN) {
3385*4882a593Smuzhiyun DHD_ERROR(("%s: Invalid SSID length"
3386*4882a593Smuzhiyun " %d: trimming it to max\n",
3387*4882a593Smuzhiyun __FUNCTION__, plnetinfo_v2->pfnsubnet.SSID_len));
3388*4882a593Smuzhiyun plnetinfo_v2->pfnsubnet.SSID_len = DOT11_MAX_SSID_LEN;
3389*4882a593Smuzhiyun }
3390*4882a593Smuzhiyun pbestnet_entry->SSID_len = plnetinfo_v2->pfnsubnet.SSID_len;
3391*4882a593Smuzhiyun memcpy(pbestnet_entry->SSID, plnetinfo_v2->pfnsubnet.u.SSID,
3392*4882a593Smuzhiyun pbestnet_entry->SSID_len);
3393*4882a593Smuzhiyun memcpy(&pbestnet_entry->BSSID, &plnetinfo_v2->pfnsubnet.BSSID,
3394*4882a593Smuzhiyun ETHER_ADDR_LEN);
3395*4882a593Smuzhiyun /* add the element into list */
3396*4882a593Smuzhiyun list_add_tail(&pbestnet_entry->list, &pbestnetheader->entry_list);
3397*4882a593Smuzhiyun /* increase best entry count */
3398*4882a593Smuzhiyun pbestnetheader->tot_cnt++;
3399*4882a593Smuzhiyun pbestnetheader->tot_size += BESTNET_ENTRY_SIZE;
3400*4882a593Smuzhiyun DHD_PNO(("Header %d\n", pscan_results->cnt_header - 1));
3401*4882a593Smuzhiyun DHD_PNO(("\tSSID : "));
3402*4882a593Smuzhiyun for (j = 0; j < plnetinfo_v2->pfnsubnet.SSID_len; j++)
3403*4882a593Smuzhiyun DHD_PNO(("%c", plnetinfo_v2->pfnsubnet.u.SSID[j]));
3404*4882a593Smuzhiyun DHD_PNO(("\n"));
3405*4882a593Smuzhiyun DHD_PNO(("\tBSSID: "MACDBG"\n",
3406*4882a593Smuzhiyun MAC2STRDBG(plnetinfo_v2->pfnsubnet.BSSID.octet)));
3407*4882a593Smuzhiyun DHD_PNO(("\tchannel: %d, RSSI: %d, timestamp: %d ms\n",
3408*4882a593Smuzhiyun plnetinfo_v2->pfnsubnet.channel,
3409*4882a593Smuzhiyun plnetinfo_v2->RSSI, plnetinfo_v2->timestamp));
3410*4882a593Smuzhiyun DHD_PNO(("\tRTT0 : %d, RTT1: %d\n", plnetinfo_v2->rtt0,
3411*4882a593Smuzhiyun plnetinfo_v2->rtt1));
3412*4882a593Smuzhiyun plnetinfo_v2++;
3413*4882a593Smuzhiyun }
3414*4882a593Smuzhiyun } else {
3415*4882a593Smuzhiyun err = BCME_VERSION;
3416*4882a593Smuzhiyun DHD_ERROR(("bestnet fw version %d not supported\n",
3417*4882a593Smuzhiyun plbestnet_v1->version));
3418*4882a593Smuzhiyun goto exit;
3419*4882a593Smuzhiyun }
3420*4882a593Smuzhiyun } while (fwstatus != PFN_COMPLETE);
3421*4882a593Smuzhiyun
3422*4882a593Smuzhiyun if (pscan_results->cnt_header == 0) {
3423*4882a593Smuzhiyun /* In case that we didn't get any data from the firmware
3424*4882a593Smuzhiyun * Remove the current scan_result list from get_bach.scan_results_list.
3425*4882a593Smuzhiyun */
3426*4882a593Smuzhiyun DHD_PNO(("NO BATCH DATA from Firmware, Delete current SCAN RESULT LIST\n"));
3427*4882a593Smuzhiyun list_del(&pscan_results->list);
3428*4882a593Smuzhiyun MFREE(dhd->osh, pscan_results, SCAN_RESULTS_SIZE);
3429*4882a593Smuzhiyun _params->params_batch.get_batch.top_node_cnt--;
3430*4882a593Smuzhiyun } else {
3431*4882a593Smuzhiyun /* increase total scan count using current scan count */
3432*4882a593Smuzhiyun _params->params_batch.get_batch.tot_scan_cnt += pscan_results->cnt_header;
3433*4882a593Smuzhiyun }
3434*4882a593Smuzhiyun
3435*4882a593Smuzhiyun if (buf && bufsize) {
3436*4882a593Smuzhiyun /* This is a first try to get batching results */
3437*4882a593Smuzhiyun if (!list_empty(&_params->params_batch.get_batch.scan_results_list)) {
3438*4882a593Smuzhiyun /* move the scan_results_list to expired_scan_results_lists */
3439*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
3440*4882a593Smuzhiyun list_for_each_entry_safe(siter, snext,
3441*4882a593Smuzhiyun &_params->params_batch.get_batch.scan_results_list, list) {
3442*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
3443*4882a593Smuzhiyun list_move_tail(&siter->list,
3444*4882a593Smuzhiyun &_params->params_batch.get_batch.expired_scan_results_list);
3445*4882a593Smuzhiyun }
3446*4882a593Smuzhiyun /* reset gloval values after moving to expired list */
3447*4882a593Smuzhiyun _params->params_batch.get_batch.top_node_cnt = 0;
3448*4882a593Smuzhiyun _params->params_batch.get_batch.expired_tot_scan_cnt =
3449*4882a593Smuzhiyun _params->params_batch.get_batch.tot_scan_cnt;
3450*4882a593Smuzhiyun _params->params_batch.get_batch.tot_scan_cnt = 0;
3451*4882a593Smuzhiyun }
3452*4882a593Smuzhiyun convert_format:
3453*4882a593Smuzhiyun err = _dhd_pno_convert_format(dhd, &_params->params_batch, buf, bufsize);
3454*4882a593Smuzhiyun if (err < 0) {
3455*4882a593Smuzhiyun DHD_ERROR(("failed to convert the data into upper layer format\n"));
3456*4882a593Smuzhiyun goto exit;
3457*4882a593Smuzhiyun }
3458*4882a593Smuzhiyun }
3459*4882a593Smuzhiyun exit:
3460*4882a593Smuzhiyun if (plbestnet_v1)
3461*4882a593Smuzhiyun MFREE(dhd->osh, plbestnet_v1, PNO_BESTNET_LEN);
3462*4882a593Smuzhiyun if (_params) {
3463*4882a593Smuzhiyun _params->params_batch.get_batch.buf = NULL;
3464*4882a593Smuzhiyun _params->params_batch.get_batch.bufsize = 0;
3465*4882a593Smuzhiyun _params->params_batch.get_batch.bytes_written = err;
3466*4882a593Smuzhiyun }
3467*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
3468*4882a593Smuzhiyun exit_no_unlock:
3469*4882a593Smuzhiyun #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 7, 0))
3470*4882a593Smuzhiyun if (waitqueue_active(&_pno_state->get_batch_done)) {
3471*4882a593Smuzhiyun _pno_state->batch_recvd = TRUE;
3472*4882a593Smuzhiyun wake_up(&_pno_state->get_batch_done);
3473*4882a593Smuzhiyun }
3474*4882a593Smuzhiyun #else
3475*4882a593Smuzhiyun if (waitqueue_active(&_pno_state->get_batch_done.wait))
3476*4882a593Smuzhiyun complete(&_pno_state->get_batch_done);
3477*4882a593Smuzhiyun #endif
3478*4882a593Smuzhiyun return err;
3479*4882a593Smuzhiyun }
3480*4882a593Smuzhiyun
3481*4882a593Smuzhiyun static void
_dhd_pno_get_batch_handler(struct work_struct * work)3482*4882a593Smuzhiyun _dhd_pno_get_batch_handler(struct work_struct *work)
3483*4882a593Smuzhiyun {
3484*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
3485*4882a593Smuzhiyun dhd_pub_t *dhd;
3486*4882a593Smuzhiyun struct dhd_pno_batch_params *params_batch;
3487*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
3488*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
3489*4882a593Smuzhiyun _pno_state = container_of(work, struct dhd_pno_status_info, work);
3490*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
3491*4882a593Smuzhiyun
3492*4882a593Smuzhiyun dhd = _pno_state->dhd;
3493*4882a593Smuzhiyun if (dhd == NULL) {
3494*4882a593Smuzhiyun DHD_ERROR(("%s : dhd is NULL\n", __FUNCTION__));
3495*4882a593Smuzhiyun return;
3496*4882a593Smuzhiyun }
3497*4882a593Smuzhiyun
3498*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
3499*4882a593Smuzhiyun _dhd_pno_get_gscan_batch_from_fw(dhd);
3500*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
3501*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_BATCH_MODE) {
3502*4882a593Smuzhiyun params_batch = &_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS].params_batch;
3503*4882a593Smuzhiyun
3504*4882a593Smuzhiyun _dhd_pno_get_for_batch(dhd, params_batch->get_batch.buf,
3505*4882a593Smuzhiyun params_batch->get_batch.bufsize, params_batch->get_batch.reason);
3506*4882a593Smuzhiyun }
3507*4882a593Smuzhiyun }
3508*4882a593Smuzhiyun
3509*4882a593Smuzhiyun int
dhd_pno_get_for_batch(dhd_pub_t * dhd,char * buf,int bufsize,int reason)3510*4882a593Smuzhiyun dhd_pno_get_for_batch(dhd_pub_t *dhd, char *buf, int bufsize, int reason)
3511*4882a593Smuzhiyun {
3512*4882a593Smuzhiyun int err = BCME_OK;
3513*4882a593Smuzhiyun char *pbuf = buf;
3514*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
3515*4882a593Smuzhiyun struct dhd_pno_batch_params *params_batch;
3516*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
3517*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
3518*4882a593Smuzhiyun if (!dhd_support_sta_mode(dhd)) {
3519*4882a593Smuzhiyun err = BCME_BADOPTION;
3520*4882a593Smuzhiyun goto exit;
3521*4882a593Smuzhiyun }
3522*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
3523*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
3524*4882a593Smuzhiyun
3525*4882a593Smuzhiyun if (!WLS_SUPPORTED(_pno_state)) {
3526*4882a593Smuzhiyun DHD_ERROR(("%s : wifi location service is not supported\n", __FUNCTION__));
3527*4882a593Smuzhiyun err = BCME_UNSUPPORTED;
3528*4882a593Smuzhiyun goto exit;
3529*4882a593Smuzhiyun }
3530*4882a593Smuzhiyun params_batch = &_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS].params_batch;
3531*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
3532*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_GSCAN_MODE) {
3533*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
3534*4882a593Smuzhiyun gscan_params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS].params_gscan;
3535*4882a593Smuzhiyun gscan_params->reason = reason;
3536*4882a593Smuzhiyun err = dhd_retreive_batch_scan_results(dhd);
3537*4882a593Smuzhiyun if (err == BCME_OK) {
3538*4882a593Smuzhiyun wait_event_interruptible_timeout(_pno_state->batch_get_wait,
3539*4882a593Smuzhiyun is_batch_retrieval_complete(gscan_params),
3540*4882a593Smuzhiyun msecs_to_jiffies(GSCAN_BATCH_GET_MAX_WAIT));
3541*4882a593Smuzhiyun }
3542*4882a593Smuzhiyun } else
3543*4882a593Smuzhiyun #endif
3544*4882a593Smuzhiyun {
3545*4882a593Smuzhiyun if (!(_pno_state->pno_mode & DHD_PNO_BATCH_MODE)) {
3546*4882a593Smuzhiyun DHD_ERROR(("%s: Batching SCAN mode is not enabled\n", __FUNCTION__));
3547*4882a593Smuzhiyun memset(pbuf, 0, bufsize);
3548*4882a593Smuzhiyun pbuf += snprintf(pbuf, bufsize, "scancount=%d\n", 0);
3549*4882a593Smuzhiyun snprintf(pbuf, bufsize, "%s", RESULTS_END_MARKER);
3550*4882a593Smuzhiyun err = strlen(buf);
3551*4882a593Smuzhiyun goto exit;
3552*4882a593Smuzhiyun }
3553*4882a593Smuzhiyun params_batch->get_batch.buf = buf;
3554*4882a593Smuzhiyun params_batch->get_batch.bufsize = bufsize;
3555*4882a593Smuzhiyun params_batch->get_batch.reason = reason;
3556*4882a593Smuzhiyun params_batch->get_batch.bytes_written = 0;
3557*4882a593Smuzhiyun #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 7, 0))
3558*4882a593Smuzhiyun _pno_state->batch_recvd = FALSE;
3559*4882a593Smuzhiyun #endif
3560*4882a593Smuzhiyun schedule_work(&_pno_state->work);
3561*4882a593Smuzhiyun #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 7, 0))
3562*4882a593Smuzhiyun wait_event(_pno_state->get_batch_done, _pno_state->batch_recvd);
3563*4882a593Smuzhiyun #else
3564*4882a593Smuzhiyun wait_for_completion(&_pno_state->get_batch_done);
3565*4882a593Smuzhiyun #endif
3566*4882a593Smuzhiyun }
3567*4882a593Smuzhiyun
3568*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
3569*4882a593Smuzhiyun if (!(_pno_state->pno_mode & DHD_PNO_GSCAN_MODE))
3570*4882a593Smuzhiyun #endif
3571*4882a593Smuzhiyun err = params_batch->get_batch.bytes_written;
3572*4882a593Smuzhiyun exit:
3573*4882a593Smuzhiyun return err;
3574*4882a593Smuzhiyun }
3575*4882a593Smuzhiyun
3576*4882a593Smuzhiyun int
dhd_pno_stop_for_batch(dhd_pub_t * dhd)3577*4882a593Smuzhiyun dhd_pno_stop_for_batch(dhd_pub_t *dhd)
3578*4882a593Smuzhiyun {
3579*4882a593Smuzhiyun int err = BCME_OK;
3580*4882a593Smuzhiyun int mode = 0;
3581*4882a593Smuzhiyun int i = 0;
3582*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
3583*4882a593Smuzhiyun dhd_pno_params_t *_params;
3584*4882a593Smuzhiyun wl_pfn_bssid_t *p_pfn_bssid = NULL;
3585*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
3586*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
3587*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
3588*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
3589*4882a593Smuzhiyun if (!dhd_support_sta_mode(dhd)) {
3590*4882a593Smuzhiyun err = BCME_BADOPTION;
3591*4882a593Smuzhiyun goto exit;
3592*4882a593Smuzhiyun }
3593*4882a593Smuzhiyun if (!WLS_SUPPORTED(_pno_state)) {
3594*4882a593Smuzhiyun DHD_ERROR(("%s : wifi location service is not supported\n",
3595*4882a593Smuzhiyun __FUNCTION__));
3596*4882a593Smuzhiyun err = BCME_UNSUPPORTED;
3597*4882a593Smuzhiyun goto exit;
3598*4882a593Smuzhiyun }
3599*4882a593Smuzhiyun
3600*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
3601*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_GSCAN_MODE) {
3602*4882a593Smuzhiyun DHD_PNO(("Gscan is ongoing, nothing to stop here\n"));
3603*4882a593Smuzhiyun return err;
3604*4882a593Smuzhiyun }
3605*4882a593Smuzhiyun #endif
3606*4882a593Smuzhiyun
3607*4882a593Smuzhiyun if (!(_pno_state->pno_mode & DHD_PNO_BATCH_MODE)) {
3608*4882a593Smuzhiyun DHD_ERROR(("%s : PNO BATCH MODE is not enabled\n", __FUNCTION__));
3609*4882a593Smuzhiyun goto exit;
3610*4882a593Smuzhiyun }
3611*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_BATCH_MODE;
3612*4882a593Smuzhiyun if (_pno_state->pno_mode & (DHD_PNO_LEGACY_MODE | DHD_PNO_HOTLIST_MODE)) {
3613*4882a593Smuzhiyun mode = _pno_state->pno_mode;
3614*4882a593Smuzhiyun err = dhd_pno_clean(dhd);
3615*4882a593Smuzhiyun if (err < 0) {
3616*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call dhd_pno_clean (err: %d)\n",
3617*4882a593Smuzhiyun __FUNCTION__, err));
3618*4882a593Smuzhiyun goto exit;
3619*4882a593Smuzhiyun }
3620*4882a593Smuzhiyun
3621*4882a593Smuzhiyun _pno_state->pno_mode = mode;
3622*4882a593Smuzhiyun /* restart Legacy PNO if the Legacy PNO is on */
3623*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_LEGACY_MODE) {
3624*4882a593Smuzhiyun struct dhd_pno_legacy_params *_params_legacy;
3625*4882a593Smuzhiyun _params_legacy =
3626*4882a593Smuzhiyun &(_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS].params_legacy);
3627*4882a593Smuzhiyun err = dhd_pno_set_legacy_pno(dhd, _params_legacy->scan_fr,
3628*4882a593Smuzhiyun _params_legacy->pno_repeat,
3629*4882a593Smuzhiyun _params_legacy->pno_freq_expo_max,
3630*4882a593Smuzhiyun _params_legacy->chan_list, _params_legacy->nchan);
3631*4882a593Smuzhiyun if (err < 0) {
3632*4882a593Smuzhiyun DHD_ERROR(("%s : failed to restart legacy PNO scan(err: %d)\n",
3633*4882a593Smuzhiyun __FUNCTION__, err));
3634*4882a593Smuzhiyun goto exit;
3635*4882a593Smuzhiyun }
3636*4882a593Smuzhiyun } else if (_pno_state->pno_mode & DHD_PNO_HOTLIST_MODE) {
3637*4882a593Smuzhiyun struct dhd_pno_bssid *iter, *next;
3638*4882a593Smuzhiyun _params = &(_pno_state->pno_params_arr[INDEX_OF_HOTLIST_PARAMS]);
3639*4882a593Smuzhiyun p_pfn_bssid = (wl_pfn_bssid_t *)MALLOCZ(dhd->osh,
3640*4882a593Smuzhiyun sizeof(wl_pfn_bssid_t) * _params->params_hotlist.nbssid);
3641*4882a593Smuzhiyun if (p_pfn_bssid == NULL) {
3642*4882a593Smuzhiyun DHD_ERROR(("%s : failed to allocate wl_pfn_bssid_t array"
3643*4882a593Smuzhiyun " (count: %d)",
3644*4882a593Smuzhiyun __FUNCTION__, _params->params_hotlist.nbssid));
3645*4882a593Smuzhiyun err = BCME_ERROR;
3646*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_HOTLIST_MODE;
3647*4882a593Smuzhiyun goto exit;
3648*4882a593Smuzhiyun }
3649*4882a593Smuzhiyun i = 0;
3650*4882a593Smuzhiyun /* convert dhd_pno_bssid to wl_pfn_bssid */
3651*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
3652*4882a593Smuzhiyun list_for_each_entry_safe(iter, next,
3653*4882a593Smuzhiyun &_params->params_hotlist.bssid_list, list) {
3654*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
3655*4882a593Smuzhiyun memcpy(&p_pfn_bssid[i].macaddr, &iter->macaddr, ETHER_ADDR_LEN);
3656*4882a593Smuzhiyun p_pfn_bssid[i].flags = iter->flags;
3657*4882a593Smuzhiyun i++;
3658*4882a593Smuzhiyun }
3659*4882a593Smuzhiyun err = dhd_pno_set_for_hotlist(dhd, p_pfn_bssid, &_params->params_hotlist);
3660*4882a593Smuzhiyun if (err < 0) {
3661*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_HOTLIST_MODE;
3662*4882a593Smuzhiyun DHD_ERROR(("%s : failed to restart hotlist scan(err: %d)\n",
3663*4882a593Smuzhiyun __FUNCTION__, err));
3664*4882a593Smuzhiyun goto exit;
3665*4882a593Smuzhiyun }
3666*4882a593Smuzhiyun }
3667*4882a593Smuzhiyun } else {
3668*4882a593Smuzhiyun err = dhd_pno_clean(dhd);
3669*4882a593Smuzhiyun if (err < 0) {
3670*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call dhd_pno_clean (err: %d)\n",
3671*4882a593Smuzhiyun __FUNCTION__, err));
3672*4882a593Smuzhiyun goto exit;
3673*4882a593Smuzhiyun }
3674*4882a593Smuzhiyun }
3675*4882a593Smuzhiyun exit:
3676*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS];
3677*4882a593Smuzhiyun _dhd_pno_reinitialize_prof(dhd, _params, DHD_PNO_BATCH_MODE);
3678*4882a593Smuzhiyun MFREE(dhd->osh, p_pfn_bssid,
3679*4882a593Smuzhiyun sizeof(wl_pfn_bssid_t) * _params->params_hotlist.nbssid);
3680*4882a593Smuzhiyun return err;
3681*4882a593Smuzhiyun }
3682*4882a593Smuzhiyun
3683*4882a593Smuzhiyun int
dhd_pno_set_for_hotlist(dhd_pub_t * dhd,wl_pfn_bssid_t * p_pfn_bssid,struct dhd_pno_hotlist_params * hotlist_params)3684*4882a593Smuzhiyun dhd_pno_set_for_hotlist(dhd_pub_t *dhd, wl_pfn_bssid_t *p_pfn_bssid,
3685*4882a593Smuzhiyun struct dhd_pno_hotlist_params *hotlist_params)
3686*4882a593Smuzhiyun {
3687*4882a593Smuzhiyun int err = BCME_OK;
3688*4882a593Smuzhiyun int i;
3689*4882a593Smuzhiyun uint16 _chan_list[WL_NUMCHANNELS];
3690*4882a593Smuzhiyun int rem_nchan = 0;
3691*4882a593Smuzhiyun int tot_nchan = 0;
3692*4882a593Smuzhiyun int mode = 0;
3693*4882a593Smuzhiyun dhd_pno_params_t *_params;
3694*4882a593Smuzhiyun dhd_pno_params_t *_params2;
3695*4882a593Smuzhiyun struct dhd_pno_bssid *_pno_bssid;
3696*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
3697*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
3698*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
3699*4882a593Smuzhiyun NULL_CHECK(hotlist_params, "hotlist_params is NULL", err);
3700*4882a593Smuzhiyun NULL_CHECK(p_pfn_bssid, "p_pfn_bssid is NULL", err);
3701*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
3702*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
3703*4882a593Smuzhiyun
3704*4882a593Smuzhiyun if (!dhd_support_sta_mode(dhd)) {
3705*4882a593Smuzhiyun err = BCME_BADOPTION;
3706*4882a593Smuzhiyun goto exit;
3707*4882a593Smuzhiyun }
3708*4882a593Smuzhiyun if (!WLS_SUPPORTED(_pno_state)) {
3709*4882a593Smuzhiyun DHD_ERROR(("%s : wifi location service is not supported\n", __FUNCTION__));
3710*4882a593Smuzhiyun err = BCME_UNSUPPORTED;
3711*4882a593Smuzhiyun goto exit;
3712*4882a593Smuzhiyun }
3713*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_HOTLIST_PARAMS];
3714*4882a593Smuzhiyun if (!(_pno_state->pno_mode & DHD_PNO_HOTLIST_MODE)) {
3715*4882a593Smuzhiyun _pno_state->pno_mode |= DHD_PNO_HOTLIST_MODE;
3716*4882a593Smuzhiyun err = _dhd_pno_reinitialize_prof(dhd, _params, DHD_PNO_HOTLIST_MODE);
3717*4882a593Smuzhiyun if (err < 0) {
3718*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call _dhd_pno_reinitialize_prof\n",
3719*4882a593Smuzhiyun __FUNCTION__));
3720*4882a593Smuzhiyun goto exit;
3721*4882a593Smuzhiyun }
3722*4882a593Smuzhiyun }
3723*4882a593Smuzhiyun _params->params_batch.nchan = hotlist_params->nchan;
3724*4882a593Smuzhiyun _params->params_batch.scan_fr = hotlist_params->scan_fr;
3725*4882a593Smuzhiyun if (hotlist_params->nchan)
3726*4882a593Smuzhiyun memcpy(_params->params_hotlist.chan_list, hotlist_params->chan_list,
3727*4882a593Smuzhiyun sizeof(_params->params_hotlist.chan_list));
3728*4882a593Smuzhiyun memset(_chan_list, 0, sizeof(_chan_list));
3729*4882a593Smuzhiyun
3730*4882a593Smuzhiyun rem_nchan = ARRAYSIZE(hotlist_params->chan_list) - hotlist_params->nchan;
3731*4882a593Smuzhiyun if (hotlist_params->band == WLC_BAND_2G ||
3732*4882a593Smuzhiyun #ifdef WL_6G_BAND
3733*4882a593Smuzhiyun hotlist_params->band == WLC_BAND_6G ||
3734*4882a593Smuzhiyun #endif /* WL_6G_BAND */
3735*4882a593Smuzhiyun hotlist_params->band == WLC_BAND_5G) {
3736*4882a593Smuzhiyun /* get a valid channel list based on band B or A */
3737*4882a593Smuzhiyun err = _dhd_pno_get_channels(dhd,
3738*4882a593Smuzhiyun &_params->params_hotlist.chan_list[hotlist_params->nchan],
3739*4882a593Smuzhiyun &rem_nchan, hotlist_params->band, FALSE);
3740*4882a593Smuzhiyun if (err < 0) {
3741*4882a593Smuzhiyun DHD_ERROR(("%s: failed to get valid channel list(band : %d)\n",
3742*4882a593Smuzhiyun __FUNCTION__, hotlist_params->band));
3743*4882a593Smuzhiyun goto exit;
3744*4882a593Smuzhiyun }
3745*4882a593Smuzhiyun /* now we need to update nchan because rem_chan has valid channel count */
3746*4882a593Smuzhiyun _params->params_hotlist.nchan += rem_nchan;
3747*4882a593Smuzhiyun /* need to sort channel list */
3748*4882a593Smuzhiyun sort(_params->params_hotlist.chan_list, _params->params_hotlist.nchan,
3749*4882a593Smuzhiyun sizeof(_params->params_hotlist.chan_list[0]), _dhd_pno_cmpfunc, NULL);
3750*4882a593Smuzhiyun }
3751*4882a593Smuzhiyun #ifdef PNO_DEBUG
3752*4882a593Smuzhiyun {
3753*4882a593Smuzhiyun int i;
3754*4882a593Smuzhiyun DHD_PNO(("Channel list : "));
3755*4882a593Smuzhiyun for (i = 0; i < _params->params_batch.nchan; i++) {
3756*4882a593Smuzhiyun DHD_PNO(("%d ", _params->params_batch.chan_list[i]));
3757*4882a593Smuzhiyun }
3758*4882a593Smuzhiyun DHD_PNO(("\n"));
3759*4882a593Smuzhiyun }
3760*4882a593Smuzhiyun #endif
3761*4882a593Smuzhiyun if (_params->params_hotlist.nchan) {
3762*4882a593Smuzhiyun /* copy the channel list into local array */
3763*4882a593Smuzhiyun memcpy(_chan_list, _params->params_hotlist.chan_list,
3764*4882a593Smuzhiyun sizeof(_chan_list));
3765*4882a593Smuzhiyun tot_nchan = _params->params_hotlist.nchan;
3766*4882a593Smuzhiyun }
3767*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_LEGACY_MODE) {
3768*4882a593Smuzhiyun DHD_PNO(("PNO SSID is on progress in firmware\n"));
3769*4882a593Smuzhiyun /* store current pno_mode before disabling pno */
3770*4882a593Smuzhiyun mode = _pno_state->pno_mode;
3771*4882a593Smuzhiyun err = _dhd_pno_enable(dhd, PNO_OFF);
3772*4882a593Smuzhiyun if (err < 0) {
3773*4882a593Smuzhiyun DHD_ERROR(("%s : failed to disable PNO\n", __FUNCTION__));
3774*4882a593Smuzhiyun goto exit;
3775*4882a593Smuzhiyun }
3776*4882a593Smuzhiyun /* restore the previous mode */
3777*4882a593Smuzhiyun _pno_state->pno_mode = mode;
3778*4882a593Smuzhiyun /* Use the superset for channelist between two mode */
3779*4882a593Smuzhiyun _params2 = &(_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS]);
3780*4882a593Smuzhiyun if (_params2->params_legacy.nchan > 0 &&
3781*4882a593Smuzhiyun _params->params_hotlist.nchan > 0) {
3782*4882a593Smuzhiyun err = _dhd_pno_chan_merge(_chan_list, &tot_nchan,
3783*4882a593Smuzhiyun &_params2->params_legacy.chan_list[0],
3784*4882a593Smuzhiyun _params2->params_legacy.nchan,
3785*4882a593Smuzhiyun &_params->params_hotlist.chan_list[0],
3786*4882a593Smuzhiyun _params->params_hotlist.nchan);
3787*4882a593Smuzhiyun if (err < 0) {
3788*4882a593Smuzhiyun DHD_ERROR(("%s : failed to merge channel list"
3789*4882a593Smuzhiyun "between legacy and hotlist\n",
3790*4882a593Smuzhiyun __FUNCTION__));
3791*4882a593Smuzhiyun goto exit;
3792*4882a593Smuzhiyun }
3793*4882a593Smuzhiyun }
3794*4882a593Smuzhiyun
3795*4882a593Smuzhiyun }
3796*4882a593Smuzhiyun
3797*4882a593Smuzhiyun INIT_LIST_HEAD(&(_params->params_hotlist.bssid_list));
3798*4882a593Smuzhiyun
3799*4882a593Smuzhiyun err = _dhd_pno_add_bssid(dhd, p_pfn_bssid, hotlist_params->nbssid);
3800*4882a593Smuzhiyun if (err < 0) {
3801*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call _dhd_pno_add_bssid(err :%d)\n",
3802*4882a593Smuzhiyun __FUNCTION__, err));
3803*4882a593Smuzhiyun goto exit;
3804*4882a593Smuzhiyun }
3805*4882a593Smuzhiyun if ((err = _dhd_pno_set(dhd, _params, DHD_PNO_HOTLIST_MODE)) < 0) {
3806*4882a593Smuzhiyun DHD_ERROR(("%s : failed to set call pno_set (err %d) in firmware\n",
3807*4882a593Smuzhiyun __FUNCTION__, err));
3808*4882a593Smuzhiyun goto exit;
3809*4882a593Smuzhiyun }
3810*4882a593Smuzhiyun if (tot_nchan > 0) {
3811*4882a593Smuzhiyun if ((err = _dhd_pno_cfg(dhd, _chan_list, tot_nchan)) < 0) {
3812*4882a593Smuzhiyun DHD_ERROR(("%s : failed to set call pno_cfg (err %d) in firmware\n",
3813*4882a593Smuzhiyun __FUNCTION__, err));
3814*4882a593Smuzhiyun goto exit;
3815*4882a593Smuzhiyun }
3816*4882a593Smuzhiyun }
3817*4882a593Smuzhiyun for (i = 0; i < hotlist_params->nbssid; i++) {
3818*4882a593Smuzhiyun _pno_bssid = (struct dhd_pno_bssid *)MALLOCZ(dhd->osh,
3819*4882a593Smuzhiyun sizeof(struct dhd_pno_bssid));
3820*4882a593Smuzhiyun NULL_CHECK(_pno_bssid, "_pfn_bssid is NULL", err);
3821*4882a593Smuzhiyun memcpy(&_pno_bssid->macaddr, &p_pfn_bssid[i].macaddr, ETHER_ADDR_LEN);
3822*4882a593Smuzhiyun _pno_bssid->flags = p_pfn_bssid[i].flags;
3823*4882a593Smuzhiyun list_add_tail(&_pno_bssid->list, &_params->params_hotlist.bssid_list);
3824*4882a593Smuzhiyun }
3825*4882a593Smuzhiyun _params->params_hotlist.nbssid = hotlist_params->nbssid;
3826*4882a593Smuzhiyun if (_pno_state->pno_status == DHD_PNO_DISABLED) {
3827*4882a593Smuzhiyun if ((err = _dhd_pno_enable(dhd, PNO_ON)) < 0)
3828*4882a593Smuzhiyun DHD_ERROR(("%s : failed to enable PNO\n", __FUNCTION__));
3829*4882a593Smuzhiyun }
3830*4882a593Smuzhiyun exit:
3831*4882a593Smuzhiyun /* clear mode in case of error */
3832*4882a593Smuzhiyun if (err < 0)
3833*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_HOTLIST_MODE;
3834*4882a593Smuzhiyun return err;
3835*4882a593Smuzhiyun }
3836*4882a593Smuzhiyun
3837*4882a593Smuzhiyun int
dhd_pno_stop_for_hotlist(dhd_pub_t * dhd)3838*4882a593Smuzhiyun dhd_pno_stop_for_hotlist(dhd_pub_t *dhd)
3839*4882a593Smuzhiyun {
3840*4882a593Smuzhiyun int err = BCME_OK;
3841*4882a593Smuzhiyun uint32 mode = 0;
3842*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
3843*4882a593Smuzhiyun dhd_pno_params_t *_params;
3844*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
3845*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
3846*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
3847*4882a593Smuzhiyun
3848*4882a593Smuzhiyun if (!WLS_SUPPORTED(_pno_state)) {
3849*4882a593Smuzhiyun DHD_ERROR(("%s : wifi location service is not supported\n",
3850*4882a593Smuzhiyun __FUNCTION__));
3851*4882a593Smuzhiyun err = BCME_UNSUPPORTED;
3852*4882a593Smuzhiyun goto exit;
3853*4882a593Smuzhiyun }
3854*4882a593Smuzhiyun
3855*4882a593Smuzhiyun if (!(_pno_state->pno_mode & DHD_PNO_HOTLIST_MODE)) {
3856*4882a593Smuzhiyun DHD_ERROR(("%s : Hotlist MODE is not enabled\n",
3857*4882a593Smuzhiyun __FUNCTION__));
3858*4882a593Smuzhiyun goto exit;
3859*4882a593Smuzhiyun }
3860*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_BATCH_MODE;
3861*4882a593Smuzhiyun
3862*4882a593Smuzhiyun if (_pno_state->pno_mode & (DHD_PNO_LEGACY_MODE | DHD_PNO_BATCH_MODE)) {
3863*4882a593Smuzhiyun /* retrieve the batching data from firmware into host */
3864*4882a593Smuzhiyun dhd_pno_get_for_batch(dhd, NULL, 0, PNO_STATUS_DISABLE);
3865*4882a593Smuzhiyun /* save current pno_mode before calling dhd_pno_clean */
3866*4882a593Smuzhiyun mode = _pno_state->pno_mode;
3867*4882a593Smuzhiyun err = dhd_pno_clean(dhd);
3868*4882a593Smuzhiyun if (err < 0) {
3869*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call dhd_pno_clean (err: %d)\n",
3870*4882a593Smuzhiyun __FUNCTION__, err));
3871*4882a593Smuzhiyun goto exit;
3872*4882a593Smuzhiyun }
3873*4882a593Smuzhiyun /* restore previos pno mode */
3874*4882a593Smuzhiyun _pno_state->pno_mode = mode;
3875*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_LEGACY_MODE) {
3876*4882a593Smuzhiyun /* restart Legacy PNO Scan */
3877*4882a593Smuzhiyun struct dhd_pno_legacy_params *_params_legacy;
3878*4882a593Smuzhiyun _params_legacy =
3879*4882a593Smuzhiyun &(_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS].params_legacy);
3880*4882a593Smuzhiyun err = dhd_pno_set_legacy_pno(dhd, _params_legacy->scan_fr,
3881*4882a593Smuzhiyun _params_legacy->pno_repeat, _params_legacy->pno_freq_expo_max,
3882*4882a593Smuzhiyun _params_legacy->chan_list, _params_legacy->nchan);
3883*4882a593Smuzhiyun if (err < 0) {
3884*4882a593Smuzhiyun DHD_ERROR(("%s : failed to restart legacy PNO scan(err: %d)\n",
3885*4882a593Smuzhiyun __FUNCTION__, err));
3886*4882a593Smuzhiyun goto exit;
3887*4882a593Smuzhiyun }
3888*4882a593Smuzhiyun } else if (_pno_state->pno_mode & DHD_PNO_BATCH_MODE) {
3889*4882a593Smuzhiyun /* restart Batching Scan */
3890*4882a593Smuzhiyun _params = &(_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS]);
3891*4882a593Smuzhiyun /* restart BATCH SCAN */
3892*4882a593Smuzhiyun err = dhd_pno_set_for_batch(dhd, &_params->params_batch);
3893*4882a593Smuzhiyun if (err < 0) {
3894*4882a593Smuzhiyun _pno_state->pno_mode &= ~DHD_PNO_BATCH_MODE;
3895*4882a593Smuzhiyun DHD_ERROR(("%s : failed to restart batch scan(err: %d)\n",
3896*4882a593Smuzhiyun __FUNCTION__, err));
3897*4882a593Smuzhiyun goto exit;
3898*4882a593Smuzhiyun }
3899*4882a593Smuzhiyun }
3900*4882a593Smuzhiyun } else {
3901*4882a593Smuzhiyun err = dhd_pno_clean(dhd);
3902*4882a593Smuzhiyun if (err < 0) {
3903*4882a593Smuzhiyun DHD_ERROR(("%s : failed to call dhd_pno_clean (err: %d)\n",
3904*4882a593Smuzhiyun __FUNCTION__, err));
3905*4882a593Smuzhiyun goto exit;
3906*4882a593Smuzhiyun }
3907*4882a593Smuzhiyun }
3908*4882a593Smuzhiyun exit:
3909*4882a593Smuzhiyun return err;
3910*4882a593Smuzhiyun }
3911*4882a593Smuzhiyun
3912*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
3913*4882a593Smuzhiyun int
dhd_retreive_batch_scan_results(dhd_pub_t * dhd)3914*4882a593Smuzhiyun dhd_retreive_batch_scan_results(dhd_pub_t *dhd)
3915*4882a593Smuzhiyun {
3916*4882a593Smuzhiyun int err = BCME_OK;
3917*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
3918*4882a593Smuzhiyun dhd_pno_params_t *_params;
3919*4882a593Smuzhiyun struct dhd_pno_batch_params *params_batch;
3920*4882a593Smuzhiyun
3921*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
3922*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
3923*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
3924*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
3925*4882a593Smuzhiyun
3926*4882a593Smuzhiyun params_batch = &_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS].params_batch;
3927*4882a593Smuzhiyun if (_params->params_gscan.get_batch_flag == GSCAN_BATCH_RETRIEVAL_COMPLETE) {
3928*4882a593Smuzhiyun DHD_PNO(("Retreive batch results\n"));
3929*4882a593Smuzhiyun params_batch->get_batch.buf = NULL;
3930*4882a593Smuzhiyun params_batch->get_batch.bufsize = 0;
3931*4882a593Smuzhiyun params_batch->get_batch.reason = PNO_STATUS_EVENT;
3932*4882a593Smuzhiyun _params->params_gscan.get_batch_flag = GSCAN_BATCH_RETRIEVAL_IN_PROGRESS;
3933*4882a593Smuzhiyun smp_wmb();
3934*4882a593Smuzhiyun schedule_work(&_pno_state->work);
3935*4882a593Smuzhiyun } else {
3936*4882a593Smuzhiyun DHD_PNO(("%s : WLC_E_PFN_BEST_BATCHING retrieval"
3937*4882a593Smuzhiyun "already in progress, will skip\n", __FUNCTION__));
3938*4882a593Smuzhiyun err = BCME_ERROR;
3939*4882a593Smuzhiyun }
3940*4882a593Smuzhiyun
3941*4882a593Smuzhiyun return err;
3942*4882a593Smuzhiyun }
3943*4882a593Smuzhiyun
3944*4882a593Smuzhiyun void
dhd_gscan_hotlist_cache_cleanup(dhd_pub_t * dhd,hotlist_type_t type)3945*4882a593Smuzhiyun dhd_gscan_hotlist_cache_cleanup(dhd_pub_t *dhd, hotlist_type_t type)
3946*4882a593Smuzhiyun {
3947*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state = PNO_GET_PNOSTATE(dhd);
3948*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
3949*4882a593Smuzhiyun gscan_results_cache_t *iter, *tmp;
3950*4882a593Smuzhiyun
3951*4882a593Smuzhiyun if (!_pno_state) {
3952*4882a593Smuzhiyun return;
3953*4882a593Smuzhiyun }
3954*4882a593Smuzhiyun gscan_params = &(_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS].params_gscan);
3955*4882a593Smuzhiyun
3956*4882a593Smuzhiyun if (type == HOTLIST_FOUND) {
3957*4882a593Smuzhiyun iter = gscan_params->gscan_hotlist_found;
3958*4882a593Smuzhiyun gscan_params->gscan_hotlist_found = NULL;
3959*4882a593Smuzhiyun } else {
3960*4882a593Smuzhiyun iter = gscan_params->gscan_hotlist_lost;
3961*4882a593Smuzhiyun gscan_params->gscan_hotlist_lost = NULL;
3962*4882a593Smuzhiyun }
3963*4882a593Smuzhiyun
3964*4882a593Smuzhiyun while (iter) {
3965*4882a593Smuzhiyun tmp = iter->next;
3966*4882a593Smuzhiyun MFREE(dhd->osh, iter,
3967*4882a593Smuzhiyun ((iter->tot_count - 1) * sizeof(wifi_gscan_result_t))
3968*4882a593Smuzhiyun + sizeof(gscan_results_cache_t));
3969*4882a593Smuzhiyun iter = tmp;
3970*4882a593Smuzhiyun }
3971*4882a593Smuzhiyun
3972*4882a593Smuzhiyun return;
3973*4882a593Smuzhiyun }
3974*4882a593Smuzhiyun
3975*4882a593Smuzhiyun void *
dhd_process_full_gscan_result(dhd_pub_t * dhd,const void * data,uint32 len,int * size)3976*4882a593Smuzhiyun dhd_process_full_gscan_result(dhd_pub_t *dhd, const void *data, uint32 len, int *size)
3977*4882a593Smuzhiyun {
3978*4882a593Smuzhiyun wl_bss_info_t *bi = NULL;
3979*4882a593Smuzhiyun wl_gscan_result_t *gscan_result;
3980*4882a593Smuzhiyun wifi_gscan_full_result_t *result = NULL;
3981*4882a593Smuzhiyun u32 bi_length = 0;
3982*4882a593Smuzhiyun uint8 channel;
3983*4882a593Smuzhiyun uint32 mem_needed;
3984*4882a593Smuzhiyun struct osl_timespec ts;
3985*4882a593Smuzhiyun u32 bi_ie_length = 0;
3986*4882a593Smuzhiyun u32 bi_ie_offset = 0;
3987*4882a593Smuzhiyun
3988*4882a593Smuzhiyun *size = 0;
3989*4882a593Smuzhiyun GCC_DIAGNOSTIC_PUSH_SUPPRESS_CAST();
3990*4882a593Smuzhiyun gscan_result = (wl_gscan_result_t *)data;
3991*4882a593Smuzhiyun GCC_DIAGNOSTIC_POP();
3992*4882a593Smuzhiyun if (!gscan_result) {
3993*4882a593Smuzhiyun DHD_ERROR(("Invalid gscan result (NULL pointer)\n"));
3994*4882a593Smuzhiyun goto exit;
3995*4882a593Smuzhiyun }
3996*4882a593Smuzhiyun
3997*4882a593Smuzhiyun if ((len < sizeof(*gscan_result)) ||
3998*4882a593Smuzhiyun (len < dtoh32(gscan_result->buflen)) ||
3999*4882a593Smuzhiyun (dtoh32(gscan_result->buflen) >
4000*4882a593Smuzhiyun (sizeof(*gscan_result) + WL_SCAN_IE_LEN_MAX))) {
4001*4882a593Smuzhiyun DHD_ERROR(("%s: invalid gscan buflen:%u\n", __FUNCTION__,
4002*4882a593Smuzhiyun dtoh32(gscan_result->buflen)));
4003*4882a593Smuzhiyun goto exit;
4004*4882a593Smuzhiyun }
4005*4882a593Smuzhiyun
4006*4882a593Smuzhiyun bi = &gscan_result->bss_info[0].info;
4007*4882a593Smuzhiyun bi_length = dtoh32(bi->length);
4008*4882a593Smuzhiyun if (bi_length != (dtoh32(gscan_result->buflen) -
4009*4882a593Smuzhiyun WL_GSCAN_RESULTS_FIXED_SIZE - WL_GSCAN_INFO_FIXED_FIELD_SIZE)) {
4010*4882a593Smuzhiyun DHD_ERROR(("Invalid bss_info length %d: ignoring\n", bi_length));
4011*4882a593Smuzhiyun goto exit;
4012*4882a593Smuzhiyun }
4013*4882a593Smuzhiyun bi_ie_offset = dtoh32(bi->ie_offset);
4014*4882a593Smuzhiyun bi_ie_length = dtoh32(bi->ie_length);
4015*4882a593Smuzhiyun if ((bi_ie_offset + bi_ie_length) > bi_length) {
4016*4882a593Smuzhiyun DHD_ERROR(("%s: Invalid ie_length:%u or ie_offset:%u\n",
4017*4882a593Smuzhiyun __FUNCTION__, bi_ie_length, bi_ie_offset));
4018*4882a593Smuzhiyun goto exit;
4019*4882a593Smuzhiyun }
4020*4882a593Smuzhiyun if (bi->SSID_len > DOT11_MAX_SSID_LEN) {
4021*4882a593Smuzhiyun DHD_ERROR(("%s: Invalid SSID length:%u\n", __FUNCTION__, bi->SSID_len));
4022*4882a593Smuzhiyun goto exit;
4023*4882a593Smuzhiyun }
4024*4882a593Smuzhiyun
4025*4882a593Smuzhiyun mem_needed = OFFSETOF(wifi_gscan_full_result_t, ie_data) + bi->ie_length;
4026*4882a593Smuzhiyun result = (wifi_gscan_full_result_t *)MALLOC(dhd->osh, mem_needed);
4027*4882a593Smuzhiyun if (!result) {
4028*4882a593Smuzhiyun DHD_ERROR(("%s Cannot malloc scan result buffer %d bytes\n",
4029*4882a593Smuzhiyun __FUNCTION__, mem_needed));
4030*4882a593Smuzhiyun goto exit;
4031*4882a593Smuzhiyun }
4032*4882a593Smuzhiyun
4033*4882a593Smuzhiyun result->scan_ch_bucket = gscan_result->scan_ch_bucket;
4034*4882a593Smuzhiyun memcpy(result->fixed.ssid, bi->SSID, bi->SSID_len);
4035*4882a593Smuzhiyun result->fixed.ssid[bi->SSID_len] = '\0';
4036*4882a593Smuzhiyun channel = wf_chspec_ctlchspec(bi->chanspec);
4037*4882a593Smuzhiyun result->fixed.channel = wl_channel_to_frequency(channel, CHSPEC_BAND(channel));
4038*4882a593Smuzhiyun result->fixed.rssi = (int32) bi->RSSI;
4039*4882a593Smuzhiyun result->fixed.rtt = 0;
4040*4882a593Smuzhiyun result->fixed.rtt_sd = 0;
4041*4882a593Smuzhiyun osl_get_monotonic_boottime(&ts);
4042*4882a593Smuzhiyun result->fixed.ts = (uint64) TIMESPEC_TO_US(ts);
4043*4882a593Smuzhiyun result->fixed.beacon_period = dtoh16(bi->beacon_period);
4044*4882a593Smuzhiyun result->fixed.capability = dtoh16(bi->capability);
4045*4882a593Smuzhiyun result->ie_length = bi_ie_length;
4046*4882a593Smuzhiyun memcpy(&result->fixed.macaddr, &bi->BSSID, ETHER_ADDR_LEN);
4047*4882a593Smuzhiyun memcpy(result->ie_data, ((uint8 *)bi + bi_ie_offset), bi_ie_length);
4048*4882a593Smuzhiyun *size = mem_needed;
4049*4882a593Smuzhiyun exit:
4050*4882a593Smuzhiyun return result;
4051*4882a593Smuzhiyun }
4052*4882a593Smuzhiyun
4053*4882a593Smuzhiyun static void *
dhd_pno_update_pfn_v3_results(dhd_pub_t * dhd,wl_pfn_scanresults_v3_t * pfn_result,uint32 * mem_needed,struct dhd_pno_gscan_params * gscan_params,uint32 event)4054*4882a593Smuzhiyun dhd_pno_update_pfn_v3_results(dhd_pub_t *dhd, wl_pfn_scanresults_v3_t *pfn_result,
4055*4882a593Smuzhiyun uint32 *mem_needed, struct dhd_pno_gscan_params *gscan_params, uint32 event)
4056*4882a593Smuzhiyun {
4057*4882a593Smuzhiyun uint32 i;
4058*4882a593Smuzhiyun uint8 ssid[DOT11_MAX_SSID_LEN + 1];
4059*4882a593Smuzhiyun struct ether_addr *bssid;
4060*4882a593Smuzhiyun wl_pfn_net_info_v3_t *net_info = NULL;
4061*4882a593Smuzhiyun dhd_epno_results_t *results = NULL;
4062*4882a593Smuzhiyun
4063*4882a593Smuzhiyun if ((pfn_result->count == 0) || (pfn_result->count > EVENT_MAX_NETCNT_V3)) {
4064*4882a593Smuzhiyun DHD_ERROR(("%s event %d: wrong pfn v3 results count %d\n",
4065*4882a593Smuzhiyun __FUNCTION__, event, pfn_result->count));
4066*4882a593Smuzhiyun return NULL;
4067*4882a593Smuzhiyun }
4068*4882a593Smuzhiyun
4069*4882a593Smuzhiyun *mem_needed = sizeof(dhd_epno_results_t) * pfn_result->count;
4070*4882a593Smuzhiyun results = (dhd_epno_results_t *)MALLOC(dhd->osh, (*mem_needed));
4071*4882a593Smuzhiyun if (!results) {
4072*4882a593Smuzhiyun DHD_ERROR(("%s: Can't malloc %d bytes for results\n", __FUNCTION__,
4073*4882a593Smuzhiyun *mem_needed));
4074*4882a593Smuzhiyun return NULL;
4075*4882a593Smuzhiyun }
4076*4882a593Smuzhiyun for (i = 0; i < pfn_result->count; i++) {
4077*4882a593Smuzhiyun net_info = &pfn_result->netinfo[i];
4078*4882a593Smuzhiyun results[i].rssi = net_info->RSSI;
4079*4882a593Smuzhiyun results[i].channel = wl_channel_to_frequency(
4080*4882a593Smuzhiyun CHSPEC_CHANNEL(net_info->pfnsubnet.chanspec),
4081*4882a593Smuzhiyun CHSPEC_BAND(net_info->pfnsubnet.chanspec));
4082*4882a593Smuzhiyun results[i].flags = (event == WLC_E_PFN_NET_FOUND) ?
4083*4882a593Smuzhiyun WL_PFN_SSID_EXT_FOUND: WL_PFN_SSID_EXT_LOST;
4084*4882a593Smuzhiyun results[i].ssid_len = min(net_info->pfnsubnet.SSID_len,
4085*4882a593Smuzhiyun (uint8)DOT11_MAX_SSID_LEN);
4086*4882a593Smuzhiyun bssid = &results[i].bssid;
4087*4882a593Smuzhiyun (void)memcpy_s(bssid, ETHER_ADDR_LEN,
4088*4882a593Smuzhiyun &net_info->pfnsubnet.BSSID, ETHER_ADDR_LEN);
4089*4882a593Smuzhiyun if (!net_info->pfnsubnet.SSID_len) {
4090*4882a593Smuzhiyun dhd_pno_idx_to_ssid(gscan_params, &results[i],
4091*4882a593Smuzhiyun net_info->pfnsubnet.u.index);
4092*4882a593Smuzhiyun } else {
4093*4882a593Smuzhiyun (void)memcpy_s(results[i].ssid, DOT11_MAX_SSID_LEN,
4094*4882a593Smuzhiyun net_info->pfnsubnet.u.SSID, results[i].ssid_len);
4095*4882a593Smuzhiyun }
4096*4882a593Smuzhiyun (void)memcpy_s(ssid, DOT11_MAX_SSID_LEN, results[i].ssid, results[i].ssid_len);
4097*4882a593Smuzhiyun ssid[results[i].ssid_len] = '\0';
4098*4882a593Smuzhiyun DHD_PNO(("ssid - %s bssid "MACDBG" ch %d rssi %d flags %d\n",
4099*4882a593Smuzhiyun ssid, MAC2STRDBG(bssid->octet), results[i].channel,
4100*4882a593Smuzhiyun results[i].rssi, results[i].flags));
4101*4882a593Smuzhiyun }
4102*4882a593Smuzhiyun
4103*4882a593Smuzhiyun return results;
4104*4882a593Smuzhiyun }
4105*4882a593Smuzhiyun
4106*4882a593Smuzhiyun void *
dhd_pno_process_epno_result(dhd_pub_t * dhd,const void * data,uint32 event,int * size)4107*4882a593Smuzhiyun dhd_pno_process_epno_result(dhd_pub_t *dhd, const void *data, uint32 event, int *size)
4108*4882a593Smuzhiyun {
4109*4882a593Smuzhiyun dhd_epno_results_t *results = NULL;
4110*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state = PNO_GET_PNOSTATE(dhd);
4111*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
4112*4882a593Smuzhiyun uint32 count, mem_needed = 0, i;
4113*4882a593Smuzhiyun uint8 ssid[DOT11_MAX_SSID_LEN + 1];
4114*4882a593Smuzhiyun struct ether_addr *bssid;
4115*4882a593Smuzhiyun
4116*4882a593Smuzhiyun *size = 0;
4117*4882a593Smuzhiyun if (!_pno_state)
4118*4882a593Smuzhiyun return NULL;
4119*4882a593Smuzhiyun gscan_params = &(_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS].params_gscan);
4120*4882a593Smuzhiyun
4121*4882a593Smuzhiyun if (event == WLC_E_PFN_NET_FOUND || event == WLC_E_PFN_NET_LOST) {
4122*4882a593Smuzhiyun wl_pfn_scanresults_v1_t *pfn_result = (wl_pfn_scanresults_v1_t *)data;
4123*4882a593Smuzhiyun wl_pfn_scanresults_v2_t *pfn_result_v2 = (wl_pfn_scanresults_v2_t *)data;
4124*4882a593Smuzhiyun wl_pfn_scanresults_v3_t *pfn_result_v3 = (wl_pfn_scanresults_v3_t *)data;
4125*4882a593Smuzhiyun wl_pfn_net_info_v1_t *net;
4126*4882a593Smuzhiyun wl_pfn_net_info_v2_t *net_v2;
4127*4882a593Smuzhiyun
4128*4882a593Smuzhiyun if (pfn_result->version == PFN_SCANRESULT_VERSION_V1) {
4129*4882a593Smuzhiyun if ((pfn_result->count == 0) || (pfn_result->count > EVENT_MAX_NETCNT_V1)) {
4130*4882a593Smuzhiyun DHD_ERROR(("%s event %d: wrong pfn v1 results count %d\n",
4131*4882a593Smuzhiyun __FUNCTION__, event, pfn_result->count));
4132*4882a593Smuzhiyun return NULL;
4133*4882a593Smuzhiyun }
4134*4882a593Smuzhiyun count = pfn_result->count;
4135*4882a593Smuzhiyun mem_needed = sizeof(dhd_epno_results_t) * count;
4136*4882a593Smuzhiyun results = (dhd_epno_results_t *)MALLOC(dhd->osh, mem_needed);
4137*4882a593Smuzhiyun if (!results) {
4138*4882a593Smuzhiyun DHD_ERROR(("%s: Can't malloc %d bytes for results\n", __FUNCTION__,
4139*4882a593Smuzhiyun mem_needed));
4140*4882a593Smuzhiyun return NULL;
4141*4882a593Smuzhiyun }
4142*4882a593Smuzhiyun for (i = 0; i < count; i++) {
4143*4882a593Smuzhiyun net = &pfn_result->netinfo[i];
4144*4882a593Smuzhiyun results[i].rssi = net->RSSI;
4145*4882a593Smuzhiyun results[i].channel = wf_channel2mhz(net->pfnsubnet.channel,
4146*4882a593Smuzhiyun (net->pfnsubnet.channel <= CH_MAX_2G_CHANNEL ?
4147*4882a593Smuzhiyun WF_CHAN_FACTOR_2_4_G : WF_CHAN_FACTOR_5_G));
4148*4882a593Smuzhiyun results[i].flags = (event == WLC_E_PFN_NET_FOUND) ?
4149*4882a593Smuzhiyun WL_PFN_SSID_EXT_FOUND: WL_PFN_SSID_EXT_LOST;
4150*4882a593Smuzhiyun results[i].ssid_len = min(net->pfnsubnet.SSID_len,
4151*4882a593Smuzhiyun (uint8)DOT11_MAX_SSID_LEN);
4152*4882a593Smuzhiyun bssid = &results[i].bssid;
4153*4882a593Smuzhiyun (void)memcpy_s(bssid, ETHER_ADDR_LEN,
4154*4882a593Smuzhiyun &net->pfnsubnet.BSSID, ETHER_ADDR_LEN);
4155*4882a593Smuzhiyun if (!net->pfnsubnet.SSID_len) {
4156*4882a593Smuzhiyun DHD_ERROR(("%s: Gscan results indexing is not"
4157*4882a593Smuzhiyun " supported in version 1 \n", __FUNCTION__));
4158*4882a593Smuzhiyun MFREE(dhd->osh, results, mem_needed);
4159*4882a593Smuzhiyun return NULL;
4160*4882a593Smuzhiyun } else {
4161*4882a593Smuzhiyun (void)memcpy_s(results[i].ssid, DOT11_MAX_SSID_LEN,
4162*4882a593Smuzhiyun net->pfnsubnet.SSID, results[i].ssid_len);
4163*4882a593Smuzhiyun }
4164*4882a593Smuzhiyun (void)memcpy_s(ssid, DOT11_MAX_SSID_LEN,
4165*4882a593Smuzhiyun results[i].ssid, results[i].ssid_len);
4166*4882a593Smuzhiyun ssid[results[i].ssid_len] = '\0';
4167*4882a593Smuzhiyun DHD_PNO(("ssid - %s bssid "MACDBG" ch %d rssi %d flags %d\n",
4168*4882a593Smuzhiyun ssid, MAC2STRDBG(bssid->octet), results[i].channel,
4169*4882a593Smuzhiyun results[i].rssi, results[i].flags));
4170*4882a593Smuzhiyun }
4171*4882a593Smuzhiyun } else if (pfn_result_v2->version == PFN_SCANRESULT_VERSION_V2) {
4172*4882a593Smuzhiyun if ((pfn_result->count == 0) || (pfn_result->count > EVENT_MAX_NETCNT_V2)) {
4173*4882a593Smuzhiyun DHD_ERROR(("%s event %d: wrong pfn v2 results count %d\n",
4174*4882a593Smuzhiyun __FUNCTION__, event, pfn_result->count));
4175*4882a593Smuzhiyun return NULL;
4176*4882a593Smuzhiyun }
4177*4882a593Smuzhiyun count = pfn_result_v2->count;
4178*4882a593Smuzhiyun mem_needed = sizeof(dhd_epno_results_t) * count;
4179*4882a593Smuzhiyun results = (dhd_epno_results_t *)MALLOC(dhd->osh, mem_needed);
4180*4882a593Smuzhiyun if (!results) {
4181*4882a593Smuzhiyun DHD_ERROR(("%s: Can't malloc %d bytes for results\n", __FUNCTION__,
4182*4882a593Smuzhiyun mem_needed));
4183*4882a593Smuzhiyun return NULL;
4184*4882a593Smuzhiyun }
4185*4882a593Smuzhiyun for (i = 0; i < count; i++) {
4186*4882a593Smuzhiyun net_v2 = &pfn_result_v2->netinfo[i];
4187*4882a593Smuzhiyun results[i].rssi = net_v2->RSSI;
4188*4882a593Smuzhiyun results[i].channel = wf_channel2mhz(net_v2->pfnsubnet.channel,
4189*4882a593Smuzhiyun (net_v2->pfnsubnet.channel <= CH_MAX_2G_CHANNEL ?
4190*4882a593Smuzhiyun WF_CHAN_FACTOR_2_4_G : WF_CHAN_FACTOR_5_G));
4191*4882a593Smuzhiyun results[i].flags = (event == WLC_E_PFN_NET_FOUND) ?
4192*4882a593Smuzhiyun WL_PFN_SSID_EXT_FOUND: WL_PFN_SSID_EXT_LOST;
4193*4882a593Smuzhiyun results[i].ssid_len = min(net_v2->pfnsubnet.SSID_len,
4194*4882a593Smuzhiyun (uint8)DOT11_MAX_SSID_LEN);
4195*4882a593Smuzhiyun bssid = &results[i].bssid;
4196*4882a593Smuzhiyun (void)memcpy_s(bssid, ETHER_ADDR_LEN,
4197*4882a593Smuzhiyun &net_v2->pfnsubnet.BSSID, ETHER_ADDR_LEN);
4198*4882a593Smuzhiyun if (!net_v2->pfnsubnet.SSID_len) {
4199*4882a593Smuzhiyun dhd_pno_idx_to_ssid(gscan_params, &results[i],
4200*4882a593Smuzhiyun net_v2->pfnsubnet.u.index);
4201*4882a593Smuzhiyun } else {
4202*4882a593Smuzhiyun (void)memcpy_s(results[i].ssid, DOT11_MAX_SSID_LEN,
4203*4882a593Smuzhiyun net_v2->pfnsubnet.u.SSID, results[i].ssid_len);
4204*4882a593Smuzhiyun }
4205*4882a593Smuzhiyun (void)memcpy_s(ssid, DOT11_MAX_SSID_LEN,
4206*4882a593Smuzhiyun results[i].ssid, results[i].ssid_len);
4207*4882a593Smuzhiyun ssid[results[i].ssid_len] = '\0';
4208*4882a593Smuzhiyun DHD_PNO(("ssid - %s bssid "MACDBG" ch %d rssi %d flags %d\n",
4209*4882a593Smuzhiyun ssid, MAC2STRDBG(bssid->octet), results[i].channel,
4210*4882a593Smuzhiyun results[i].rssi, results[i].flags));
4211*4882a593Smuzhiyun }
4212*4882a593Smuzhiyun } else if (pfn_result_v3->version == PFN_SCANRESULT_VERSION_V3) {
4213*4882a593Smuzhiyun results = dhd_pno_update_pfn_v3_results(dhd, pfn_result_v3, &mem_needed,
4214*4882a593Smuzhiyun gscan_params, event);
4215*4882a593Smuzhiyun if (results == NULL) {
4216*4882a593Smuzhiyun return results;
4217*4882a593Smuzhiyun }
4218*4882a593Smuzhiyun } else {
4219*4882a593Smuzhiyun DHD_ERROR(("%s event %d: Incorrect version %d , not supported\n",
4220*4882a593Smuzhiyun __FUNCTION__, event, pfn_result->version));
4221*4882a593Smuzhiyun return NULL;
4222*4882a593Smuzhiyun }
4223*4882a593Smuzhiyun }
4224*4882a593Smuzhiyun *size = mem_needed;
4225*4882a593Smuzhiyun return results;
4226*4882a593Smuzhiyun }
4227*4882a593Smuzhiyun
4228*4882a593Smuzhiyun static void *
dhd_pno_update_hotlist_v3_results(dhd_pub_t * dhd,wl_pfn_scanresults_v3_t * pfn_result,int * send_evt_bytes,hotlist_type_t type,u32 * buf_len)4229*4882a593Smuzhiyun dhd_pno_update_hotlist_v3_results(dhd_pub_t *dhd, wl_pfn_scanresults_v3_t *pfn_result,
4230*4882a593Smuzhiyun int *send_evt_bytes, hotlist_type_t type, u32 *buf_len)
4231*4882a593Smuzhiyun {
4232*4882a593Smuzhiyun u32 malloc_size = 0, i;
4233*4882a593Smuzhiyun struct osl_timespec tm_spec;
4234*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
4235*4882a593Smuzhiyun gscan_results_cache_t *gscan_hotlist_cache;
4236*4882a593Smuzhiyun wifi_gscan_result_t *hotlist_found_array;
4237*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state = PNO_GET_PNOSTATE(dhd);
4238*4882a593Smuzhiyun wl_pfn_net_info_v3_t *pnetinfo = (wl_pfn_net_info_v3_t*)&pfn_result->netinfo[0];
4239*4882a593Smuzhiyun
4240*4882a593Smuzhiyun gscan_params = &(_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS].params_gscan);
4241*4882a593Smuzhiyun
4242*4882a593Smuzhiyun if (!pfn_result->count || (pfn_result->count > EVENT_MAX_NETCNT_V3)) {
4243*4882a593Smuzhiyun DHD_ERROR(("%s: wrong v3 fwcount:%d\n", __FUNCTION__, pfn_result->count));
4244*4882a593Smuzhiyun *send_evt_bytes = 0;
4245*4882a593Smuzhiyun return NULL;
4246*4882a593Smuzhiyun }
4247*4882a593Smuzhiyun
4248*4882a593Smuzhiyun osl_get_monotonic_boottime(&tm_spec);
4249*4882a593Smuzhiyun malloc_size = sizeof(gscan_results_cache_t) +
4250*4882a593Smuzhiyun ((pfn_result->count - 1) * sizeof(wifi_gscan_result_t));
4251*4882a593Smuzhiyun gscan_hotlist_cache =
4252*4882a593Smuzhiyun (gscan_results_cache_t *)MALLOC(dhd->osh, malloc_size);
4253*4882a593Smuzhiyun if (!gscan_hotlist_cache) {
4254*4882a593Smuzhiyun DHD_ERROR(("%s Cannot Malloc %d bytes!!\n", __FUNCTION__, malloc_size));
4255*4882a593Smuzhiyun *send_evt_bytes = 0;
4256*4882a593Smuzhiyun return NULL;
4257*4882a593Smuzhiyun }
4258*4882a593Smuzhiyun *buf_len = malloc_size;
4259*4882a593Smuzhiyun if (type == HOTLIST_FOUND) {
4260*4882a593Smuzhiyun gscan_hotlist_cache->next = gscan_params->gscan_hotlist_found;
4261*4882a593Smuzhiyun gscan_params->gscan_hotlist_found = gscan_hotlist_cache;
4262*4882a593Smuzhiyun DHD_PNO(("%s enter, FOUND results count %d\n", __FUNCTION__, pfn_result->count));
4263*4882a593Smuzhiyun } else {
4264*4882a593Smuzhiyun gscan_hotlist_cache->next = gscan_params->gscan_hotlist_lost;
4265*4882a593Smuzhiyun gscan_params->gscan_hotlist_lost = gscan_hotlist_cache;
4266*4882a593Smuzhiyun DHD_PNO(("%s enter, LOST results count %d\n", __FUNCTION__, pfn_result->count));
4267*4882a593Smuzhiyun }
4268*4882a593Smuzhiyun
4269*4882a593Smuzhiyun gscan_hotlist_cache->tot_count = pfn_result->count;
4270*4882a593Smuzhiyun gscan_hotlist_cache->tot_consumed = 0;
4271*4882a593Smuzhiyun gscan_hotlist_cache->scan_ch_bucket = pfn_result->scan_ch_bucket;
4272*4882a593Smuzhiyun
4273*4882a593Smuzhiyun for (i = 0; i < pfn_result->count; i++, pnetinfo++) {
4274*4882a593Smuzhiyun hotlist_found_array = &gscan_hotlist_cache->results[i];
4275*4882a593Smuzhiyun (void)memset_s(hotlist_found_array, sizeof(wifi_gscan_result_t),
4276*4882a593Smuzhiyun 0, sizeof(wifi_gscan_result_t));
4277*4882a593Smuzhiyun hotlist_found_array->channel = wl_channel_to_frequency(
4278*4882a593Smuzhiyun CHSPEC_CHANNEL(pnetinfo->pfnsubnet.chanspec),
4279*4882a593Smuzhiyun CHSPEC_BAND(pnetinfo->pfnsubnet.chanspec));
4280*4882a593Smuzhiyun hotlist_found_array->rssi = (int32) pnetinfo->RSSI;
4281*4882a593Smuzhiyun
4282*4882a593Smuzhiyun hotlist_found_array->ts =
4283*4882a593Smuzhiyun convert_fw_rel_time_to_systime(&tm_spec,
4284*4882a593Smuzhiyun (pnetinfo->timestamp * 1000));
4285*4882a593Smuzhiyun if (pnetinfo->pfnsubnet.SSID_len > DOT11_MAX_SSID_LEN) {
4286*4882a593Smuzhiyun DHD_ERROR(("Invalid SSID length %d: trimming it to max\n",
4287*4882a593Smuzhiyun pnetinfo->pfnsubnet.SSID_len));
4288*4882a593Smuzhiyun pnetinfo->pfnsubnet.SSID_len = DOT11_MAX_SSID_LEN;
4289*4882a593Smuzhiyun }
4290*4882a593Smuzhiyun (void)memcpy_s(hotlist_found_array->ssid, DOT11_MAX_SSID_LEN,
4291*4882a593Smuzhiyun pnetinfo->pfnsubnet.u.SSID, pnetinfo->pfnsubnet.SSID_len);
4292*4882a593Smuzhiyun hotlist_found_array->ssid[pnetinfo->pfnsubnet.SSID_len] = '\0';
4293*4882a593Smuzhiyun
4294*4882a593Smuzhiyun (void)memcpy_s(&hotlist_found_array->macaddr, ETHER_ADDR_LEN,
4295*4882a593Smuzhiyun &pnetinfo->pfnsubnet.BSSID, ETHER_ADDR_LEN);
4296*4882a593Smuzhiyun DHD_PNO(("\t%s "MACDBG" rssi %d\n",
4297*4882a593Smuzhiyun hotlist_found_array->ssid,
4298*4882a593Smuzhiyun MAC2STRDBG(hotlist_found_array->macaddr.octet),
4299*4882a593Smuzhiyun hotlist_found_array->rssi));
4300*4882a593Smuzhiyun }
4301*4882a593Smuzhiyun
4302*4882a593Smuzhiyun return gscan_hotlist_cache;
4303*4882a593Smuzhiyun }
4304*4882a593Smuzhiyun
4305*4882a593Smuzhiyun void *
dhd_handle_hotlist_scan_evt(dhd_pub_t * dhd,const void * event_data,int * send_evt_bytes,hotlist_type_t type,u32 * buf_len)4306*4882a593Smuzhiyun dhd_handle_hotlist_scan_evt(dhd_pub_t *dhd, const void *event_data,
4307*4882a593Smuzhiyun int *send_evt_bytes, hotlist_type_t type, u32 *buf_len)
4308*4882a593Smuzhiyun {
4309*4882a593Smuzhiyun void *ptr = NULL;
4310*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state = PNO_GET_PNOSTATE(dhd);
4311*4882a593Smuzhiyun struct dhd_pno_gscan_params *gscan_params;
4312*4882a593Smuzhiyun wl_pfn_scanresults_v1_t *results_v1 = (wl_pfn_scanresults_v1_t *)event_data;
4313*4882a593Smuzhiyun wl_pfn_scanresults_v2_t *results_v2 = (wl_pfn_scanresults_v2_t *)event_data;
4314*4882a593Smuzhiyun wl_pfn_scanresults_v3_t *results_v3 = (wl_pfn_scanresults_v3_t *)event_data;
4315*4882a593Smuzhiyun wifi_gscan_result_t *hotlist_found_array;
4316*4882a593Smuzhiyun wl_pfn_net_info_v1_t *pnetinfo;
4317*4882a593Smuzhiyun wl_pfn_net_info_v2_t *pnetinfo_v2;
4318*4882a593Smuzhiyun gscan_results_cache_t *gscan_hotlist_cache;
4319*4882a593Smuzhiyun u32 malloc_size = 0, i, total = 0;
4320*4882a593Smuzhiyun struct osl_timespec tm_spec;
4321*4882a593Smuzhiyun uint16 fwstatus;
4322*4882a593Smuzhiyun uint16 fwcount;
4323*4882a593Smuzhiyun
4324*4882a593Smuzhiyun /* Static asserts in _dhd_pno_get_for_batch() above guarantee the v1 and v2
4325*4882a593Smuzhiyun * net_info and subnet_info structures are compatible in size and SSID offset,
4326*4882a593Smuzhiyun * allowing v1 to be safely used in the code below except for lscanresults
4327*4882a593Smuzhiyun * fields themselves (status, count, offset to netinfo).
4328*4882a593Smuzhiyun */
4329*4882a593Smuzhiyun
4330*4882a593Smuzhiyun *buf_len = 0;
4331*4882a593Smuzhiyun if (results_v1->version == PFN_SCANRESULTS_VERSION_V1) {
4332*4882a593Smuzhiyun fwstatus = results_v1->status;
4333*4882a593Smuzhiyun fwcount = results_v1->count;
4334*4882a593Smuzhiyun pnetinfo = &results_v1->netinfo[0];
4335*4882a593Smuzhiyun
4336*4882a593Smuzhiyun gscan_params = &(_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS].params_gscan);
4337*4882a593Smuzhiyun
4338*4882a593Smuzhiyun if (!fwcount || (fwcount > EVENT_MAX_NETCNT_V1)) {
4339*4882a593Smuzhiyun DHD_ERROR(("%s: wrong v1 fwcount:%d\n", __FUNCTION__, fwcount));
4340*4882a593Smuzhiyun *send_evt_bytes = 0;
4341*4882a593Smuzhiyun return ptr;
4342*4882a593Smuzhiyun }
4343*4882a593Smuzhiyun
4344*4882a593Smuzhiyun osl_get_monotonic_boottime(&tm_spec);
4345*4882a593Smuzhiyun malloc_size = sizeof(gscan_results_cache_t) +
4346*4882a593Smuzhiyun ((fwcount - 1) * sizeof(wifi_gscan_result_t));
4347*4882a593Smuzhiyun gscan_hotlist_cache = (gscan_results_cache_t *)MALLOC(dhd->osh, malloc_size);
4348*4882a593Smuzhiyun if (!gscan_hotlist_cache) {
4349*4882a593Smuzhiyun DHD_ERROR(("%s Cannot Malloc %d bytes!!\n", __FUNCTION__, malloc_size));
4350*4882a593Smuzhiyun *send_evt_bytes = 0;
4351*4882a593Smuzhiyun return ptr;
4352*4882a593Smuzhiyun }
4353*4882a593Smuzhiyun
4354*4882a593Smuzhiyun *buf_len = malloc_size;
4355*4882a593Smuzhiyun if (type == HOTLIST_FOUND) {
4356*4882a593Smuzhiyun gscan_hotlist_cache->next = gscan_params->gscan_hotlist_found;
4357*4882a593Smuzhiyun gscan_params->gscan_hotlist_found = gscan_hotlist_cache;
4358*4882a593Smuzhiyun DHD_PNO(("%s enter, FOUND results count %d\n", __FUNCTION__, fwcount));
4359*4882a593Smuzhiyun } else {
4360*4882a593Smuzhiyun gscan_hotlist_cache->next = gscan_params->gscan_hotlist_lost;
4361*4882a593Smuzhiyun gscan_params->gscan_hotlist_lost = gscan_hotlist_cache;
4362*4882a593Smuzhiyun DHD_PNO(("%s enter, LOST results count %d\n", __FUNCTION__, fwcount));
4363*4882a593Smuzhiyun }
4364*4882a593Smuzhiyun
4365*4882a593Smuzhiyun gscan_hotlist_cache->tot_count = fwcount;
4366*4882a593Smuzhiyun gscan_hotlist_cache->tot_consumed = 0;
4367*4882a593Smuzhiyun
4368*4882a593Smuzhiyun for (i = 0; i < fwcount; i++, pnetinfo++) {
4369*4882a593Smuzhiyun hotlist_found_array = &gscan_hotlist_cache->results[i];
4370*4882a593Smuzhiyun memset(hotlist_found_array, 0, sizeof(wifi_gscan_result_t));
4371*4882a593Smuzhiyun hotlist_found_array->channel = wf_channel2mhz(pnetinfo->pfnsubnet.channel,
4372*4882a593Smuzhiyun (pnetinfo->pfnsubnet.channel <= CH_MAX_2G_CHANNEL?
4373*4882a593Smuzhiyun WF_CHAN_FACTOR_2_4_G : WF_CHAN_FACTOR_5_G));
4374*4882a593Smuzhiyun hotlist_found_array->rssi = (int32) pnetinfo->RSSI;
4375*4882a593Smuzhiyun
4376*4882a593Smuzhiyun hotlist_found_array->ts =
4377*4882a593Smuzhiyun convert_fw_rel_time_to_systime(&tm_spec,
4378*4882a593Smuzhiyun (pnetinfo->timestamp * 1000));
4379*4882a593Smuzhiyun if (pnetinfo->pfnsubnet.SSID_len > DOT11_MAX_SSID_LEN) {
4380*4882a593Smuzhiyun DHD_ERROR(("Invalid SSID length %d: trimming it to max\n",
4381*4882a593Smuzhiyun pnetinfo->pfnsubnet.SSID_len));
4382*4882a593Smuzhiyun pnetinfo->pfnsubnet.SSID_len = DOT11_MAX_SSID_LEN;
4383*4882a593Smuzhiyun }
4384*4882a593Smuzhiyun (void)memcpy_s(hotlist_found_array->ssid, DOT11_MAX_SSID_LEN,
4385*4882a593Smuzhiyun pnetinfo->pfnsubnet.SSID, pnetinfo->pfnsubnet.SSID_len);
4386*4882a593Smuzhiyun hotlist_found_array->ssid[pnetinfo->pfnsubnet.SSID_len] = '\0';
4387*4882a593Smuzhiyun
4388*4882a593Smuzhiyun (void)memcpy_s(&hotlist_found_array->macaddr, ETHER_ADDR_LEN,
4389*4882a593Smuzhiyun &pnetinfo->pfnsubnet.BSSID, ETHER_ADDR_LEN);
4390*4882a593Smuzhiyun DHD_PNO(("\t%s "MACDBG" rssi %d\n",
4391*4882a593Smuzhiyun hotlist_found_array->ssid,
4392*4882a593Smuzhiyun MAC2STRDBG(hotlist_found_array->macaddr.octet),
4393*4882a593Smuzhiyun hotlist_found_array->rssi));
4394*4882a593Smuzhiyun }
4395*4882a593Smuzhiyun } else if (results_v2->version == PFN_SCANRESULTS_VERSION_V2) {
4396*4882a593Smuzhiyun fwstatus = results_v2->status;
4397*4882a593Smuzhiyun fwcount = results_v2->count;
4398*4882a593Smuzhiyun pnetinfo_v2 = (wl_pfn_net_info_v2_t*)&results_v2->netinfo[0];
4399*4882a593Smuzhiyun
4400*4882a593Smuzhiyun gscan_params = &(_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS].params_gscan);
4401*4882a593Smuzhiyun
4402*4882a593Smuzhiyun if (!fwcount || (fwcount > EVENT_MAX_NETCNT_V2)) {
4403*4882a593Smuzhiyun DHD_ERROR(("%s: wrong v2 fwcount:%d\n", __FUNCTION__, fwcount));
4404*4882a593Smuzhiyun *send_evt_bytes = 0;
4405*4882a593Smuzhiyun return ptr;
4406*4882a593Smuzhiyun }
4407*4882a593Smuzhiyun
4408*4882a593Smuzhiyun osl_get_monotonic_boottime(&tm_spec);
4409*4882a593Smuzhiyun malloc_size = sizeof(gscan_results_cache_t) +
4410*4882a593Smuzhiyun ((fwcount - 1) * sizeof(wifi_gscan_result_t));
4411*4882a593Smuzhiyun gscan_hotlist_cache =
4412*4882a593Smuzhiyun (gscan_results_cache_t *)MALLOC(dhd->osh, malloc_size);
4413*4882a593Smuzhiyun if (!gscan_hotlist_cache) {
4414*4882a593Smuzhiyun DHD_ERROR(("%s Cannot Malloc %d bytes!!\n", __FUNCTION__, malloc_size));
4415*4882a593Smuzhiyun *send_evt_bytes = 0;
4416*4882a593Smuzhiyun return ptr;
4417*4882a593Smuzhiyun }
4418*4882a593Smuzhiyun *buf_len = malloc_size;
4419*4882a593Smuzhiyun if (type == HOTLIST_FOUND) {
4420*4882a593Smuzhiyun gscan_hotlist_cache->next = gscan_params->gscan_hotlist_found;
4421*4882a593Smuzhiyun gscan_params->gscan_hotlist_found = gscan_hotlist_cache;
4422*4882a593Smuzhiyun DHD_PNO(("%s enter, FOUND results count %d\n", __FUNCTION__, fwcount));
4423*4882a593Smuzhiyun } else {
4424*4882a593Smuzhiyun gscan_hotlist_cache->next = gscan_params->gscan_hotlist_lost;
4425*4882a593Smuzhiyun gscan_params->gscan_hotlist_lost = gscan_hotlist_cache;
4426*4882a593Smuzhiyun DHD_PNO(("%s enter, LOST results count %d\n", __FUNCTION__, fwcount));
4427*4882a593Smuzhiyun }
4428*4882a593Smuzhiyun
4429*4882a593Smuzhiyun gscan_hotlist_cache->tot_count = fwcount;
4430*4882a593Smuzhiyun gscan_hotlist_cache->tot_consumed = 0;
4431*4882a593Smuzhiyun gscan_hotlist_cache->scan_ch_bucket = results_v2->scan_ch_bucket;
4432*4882a593Smuzhiyun
4433*4882a593Smuzhiyun for (i = 0; i < fwcount; i++, pnetinfo_v2++) {
4434*4882a593Smuzhiyun hotlist_found_array = &gscan_hotlist_cache->results[i];
4435*4882a593Smuzhiyun memset(hotlist_found_array, 0, sizeof(wifi_gscan_result_t));
4436*4882a593Smuzhiyun hotlist_found_array->channel =
4437*4882a593Smuzhiyun wf_channel2mhz(pnetinfo_v2->pfnsubnet.channel,
4438*4882a593Smuzhiyun (pnetinfo_v2->pfnsubnet.channel <= CH_MAX_2G_CHANNEL?
4439*4882a593Smuzhiyun WF_CHAN_FACTOR_2_4_G : WF_CHAN_FACTOR_5_G));
4440*4882a593Smuzhiyun hotlist_found_array->rssi = (int32) pnetinfo_v2->RSSI;
4441*4882a593Smuzhiyun
4442*4882a593Smuzhiyun hotlist_found_array->ts =
4443*4882a593Smuzhiyun convert_fw_rel_time_to_systime(&tm_spec,
4444*4882a593Smuzhiyun (pnetinfo_v2->timestamp * 1000));
4445*4882a593Smuzhiyun if (pnetinfo_v2->pfnsubnet.SSID_len > DOT11_MAX_SSID_LEN) {
4446*4882a593Smuzhiyun DHD_ERROR(("Invalid SSID length %d: trimming it to max\n",
4447*4882a593Smuzhiyun pnetinfo_v2->pfnsubnet.SSID_len));
4448*4882a593Smuzhiyun pnetinfo_v2->pfnsubnet.SSID_len = DOT11_MAX_SSID_LEN;
4449*4882a593Smuzhiyun }
4450*4882a593Smuzhiyun (void)memcpy_s(hotlist_found_array->ssid, DOT11_MAX_SSID_LEN,
4451*4882a593Smuzhiyun pnetinfo_v2->pfnsubnet.u.SSID, pnetinfo_v2->pfnsubnet.SSID_len);
4452*4882a593Smuzhiyun hotlist_found_array->ssid[pnetinfo_v2->pfnsubnet.SSID_len] = '\0';
4453*4882a593Smuzhiyun
4454*4882a593Smuzhiyun (void)memcpy_s(&hotlist_found_array->macaddr, ETHER_ADDR_LEN,
4455*4882a593Smuzhiyun &pnetinfo_v2->pfnsubnet.BSSID, ETHER_ADDR_LEN);
4456*4882a593Smuzhiyun DHD_PNO(("\t%s "MACDBG" rssi %d\n",
4457*4882a593Smuzhiyun hotlist_found_array->ssid,
4458*4882a593Smuzhiyun MAC2STRDBG(hotlist_found_array->macaddr.octet),
4459*4882a593Smuzhiyun hotlist_found_array->rssi));
4460*4882a593Smuzhiyun }
4461*4882a593Smuzhiyun } else if (results_v3->version == PFN_SCANRESULTS_VERSION_V3) {
4462*4882a593Smuzhiyun fwstatus = results_v3->status;
4463*4882a593Smuzhiyun gscan_hotlist_cache = (gscan_results_cache_t *)dhd_pno_update_hotlist_v3_results(
4464*4882a593Smuzhiyun dhd, results_v3, send_evt_bytes, type, buf_len);
4465*4882a593Smuzhiyun } else {
4466*4882a593Smuzhiyun DHD_ERROR(("%s: event version %d not supported\n",
4467*4882a593Smuzhiyun __FUNCTION__, results_v1->version));
4468*4882a593Smuzhiyun *send_evt_bytes = 0;
4469*4882a593Smuzhiyun return ptr;
4470*4882a593Smuzhiyun }
4471*4882a593Smuzhiyun if (fwstatus == PFN_COMPLETE) {
4472*4882a593Smuzhiyun ptr = (void *) gscan_hotlist_cache;
4473*4882a593Smuzhiyun while (gscan_hotlist_cache) {
4474*4882a593Smuzhiyun total += gscan_hotlist_cache->tot_count;
4475*4882a593Smuzhiyun gscan_hotlist_cache = gscan_hotlist_cache->next;
4476*4882a593Smuzhiyun }
4477*4882a593Smuzhiyun *send_evt_bytes = total * sizeof(wifi_gscan_result_t);
4478*4882a593Smuzhiyun }
4479*4882a593Smuzhiyun
4480*4882a593Smuzhiyun return ptr;
4481*4882a593Smuzhiyun }
4482*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
4483*4882a593Smuzhiyun
4484*4882a593Smuzhiyun int
dhd_pno_event_handler(dhd_pub_t * dhd,wl_event_msg_t * event,void * event_data)4485*4882a593Smuzhiyun dhd_pno_event_handler(dhd_pub_t *dhd, wl_event_msg_t *event, void *event_data)
4486*4882a593Smuzhiyun {
4487*4882a593Smuzhiyun int err = BCME_OK;
4488*4882a593Smuzhiyun uint event_type;
4489*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
4490*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
4491*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "pno_state is NULL", err);
4492*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
4493*4882a593Smuzhiyun if (!WLS_SUPPORTED(_pno_state)) {
4494*4882a593Smuzhiyun DHD_ERROR(("%s : wifi location service is not supported\n", __FUNCTION__));
4495*4882a593Smuzhiyun err = BCME_UNSUPPORTED;
4496*4882a593Smuzhiyun goto exit;
4497*4882a593Smuzhiyun }
4498*4882a593Smuzhiyun event_type = ntoh32(event->event_type);
4499*4882a593Smuzhiyun DHD_PNO(("%s enter : event_type :%d\n", __FUNCTION__, event_type));
4500*4882a593Smuzhiyun switch (event_type) {
4501*4882a593Smuzhiyun case WLC_E_PFN_BSSID_NET_FOUND:
4502*4882a593Smuzhiyun case WLC_E_PFN_BSSID_NET_LOST:
4503*4882a593Smuzhiyun /* how can we inform this to framework ? */
4504*4882a593Smuzhiyun /* TODO : need to implement event logic using generic netlink */
4505*4882a593Smuzhiyun break;
4506*4882a593Smuzhiyun case WLC_E_PFN_BEST_BATCHING:
4507*4882a593Smuzhiyun #ifndef GSCAN_SUPPORT
4508*4882a593Smuzhiyun {
4509*4882a593Smuzhiyun struct dhd_pno_batch_params *params_batch;
4510*4882a593Smuzhiyun params_batch = &_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS].params_batch;
4511*4882a593Smuzhiyun #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 7, 0))
4512*4882a593Smuzhiyun if (!waitqueue_active(&_pno_state->get_batch_done))
4513*4882a593Smuzhiyun #else
4514*4882a593Smuzhiyun if (!waitqueue_active(&_pno_state->get_batch_done.wait))
4515*4882a593Smuzhiyun #endif
4516*4882a593Smuzhiyun {
4517*4882a593Smuzhiyun DHD_PNO(("%s : WLC_E_PFN_BEST_BATCHING\n", __FUNCTION__));
4518*4882a593Smuzhiyun params_batch->get_batch.buf = NULL;
4519*4882a593Smuzhiyun params_batch->get_batch.bufsize = 0;
4520*4882a593Smuzhiyun params_batch->get_batch.reason = PNO_STATUS_EVENT;
4521*4882a593Smuzhiyun schedule_work(&_pno_state->work);
4522*4882a593Smuzhiyun } else
4523*4882a593Smuzhiyun DHD_PNO(("%s : WLC_E_PFN_BEST_BATCHING"
4524*4882a593Smuzhiyun "will skip this event\n", __FUNCTION__));
4525*4882a593Smuzhiyun break;
4526*4882a593Smuzhiyun }
4527*4882a593Smuzhiyun #else
4528*4882a593Smuzhiyun break;
4529*4882a593Smuzhiyun #endif /* !GSCAN_SUPPORT */
4530*4882a593Smuzhiyun default:
4531*4882a593Smuzhiyun DHD_ERROR(("unknown event : %d\n", event_type));
4532*4882a593Smuzhiyun }
4533*4882a593Smuzhiyun exit:
4534*4882a593Smuzhiyun return err;
4535*4882a593Smuzhiyun }
4536*4882a593Smuzhiyun
dhd_pno_init(dhd_pub_t * dhd)4537*4882a593Smuzhiyun int dhd_pno_init(dhd_pub_t *dhd)
4538*4882a593Smuzhiyun {
4539*4882a593Smuzhiyun int err = BCME_OK;
4540*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
4541*4882a593Smuzhiyun char *buf = NULL;
4542*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
4543*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
4544*4882a593Smuzhiyun UNUSED_PARAMETER(_dhd_pno_suspend);
4545*4882a593Smuzhiyun if (dhd->pno_state)
4546*4882a593Smuzhiyun goto exit;
4547*4882a593Smuzhiyun dhd->pno_state = MALLOC(dhd->osh, sizeof(dhd_pno_status_info_t));
4548*4882a593Smuzhiyun NULL_CHECK(dhd->pno_state, "failed to create dhd_pno_state", err);
4549*4882a593Smuzhiyun memset(dhd->pno_state, 0, sizeof(dhd_pno_status_info_t));
4550*4882a593Smuzhiyun /* need to check whether current firmware support batching and hotlist scan */
4551*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
4552*4882a593Smuzhiyun _pno_state->wls_supported = TRUE;
4553*4882a593Smuzhiyun _pno_state->dhd = dhd;
4554*4882a593Smuzhiyun mutex_init(&_pno_state->pno_mutex);
4555*4882a593Smuzhiyun INIT_WORK(&_pno_state->work, _dhd_pno_get_batch_handler);
4556*4882a593Smuzhiyun #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 7, 0))
4557*4882a593Smuzhiyun init_waitqueue_head(&_pno_state->get_batch_done);
4558*4882a593Smuzhiyun #else
4559*4882a593Smuzhiyun init_completion(&_pno_state->get_batch_done);
4560*4882a593Smuzhiyun #endif
4561*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
4562*4882a593Smuzhiyun init_waitqueue_head(&_pno_state->batch_get_wait);
4563*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
4564*4882a593Smuzhiyun buf = MALLOC(dhd->osh, WLC_IOCTL_SMLEN);
4565*4882a593Smuzhiyun if (!buf) {
4566*4882a593Smuzhiyun DHD_ERROR((":%s buf alloc err.\n", __FUNCTION__));
4567*4882a593Smuzhiyun return BCME_NOMEM;
4568*4882a593Smuzhiyun }
4569*4882a593Smuzhiyun err = dhd_iovar(dhd, 0, "pfnlbest", NULL, 0, buf, WLC_IOCTL_SMLEN,
4570*4882a593Smuzhiyun FALSE);
4571*4882a593Smuzhiyun if (err == BCME_UNSUPPORTED) {
4572*4882a593Smuzhiyun _pno_state->wls_supported = FALSE;
4573*4882a593Smuzhiyun DHD_ERROR(("Android Location Service, UNSUPPORTED\n"));
4574*4882a593Smuzhiyun DHD_INFO(("Current firmware doesn't support"
4575*4882a593Smuzhiyun " Android Location Service\n"));
4576*4882a593Smuzhiyun } else {
4577*4882a593Smuzhiyun DHD_ERROR(("%s: Support Android Location Service\n",
4578*4882a593Smuzhiyun __FUNCTION__));
4579*4882a593Smuzhiyun }
4580*4882a593Smuzhiyun exit:
4581*4882a593Smuzhiyun MFREE(dhd->osh, buf, WLC_IOCTL_SMLEN);
4582*4882a593Smuzhiyun return err;
4583*4882a593Smuzhiyun }
4584*4882a593Smuzhiyun
dhd_pno_deinit(dhd_pub_t * dhd)4585*4882a593Smuzhiyun int dhd_pno_deinit(dhd_pub_t *dhd)
4586*4882a593Smuzhiyun {
4587*4882a593Smuzhiyun int err = BCME_OK;
4588*4882a593Smuzhiyun dhd_pno_status_info_t *_pno_state;
4589*4882a593Smuzhiyun dhd_pno_params_t *_params;
4590*4882a593Smuzhiyun NULL_CHECK(dhd, "dhd is NULL", err);
4591*4882a593Smuzhiyun
4592*4882a593Smuzhiyun DHD_PNO(("%s enter\n", __FUNCTION__));
4593*4882a593Smuzhiyun _pno_state = PNO_GET_PNOSTATE(dhd);
4594*4882a593Smuzhiyun NULL_CHECK(_pno_state, "pno_state is NULL", err);
4595*4882a593Smuzhiyun /* may need to free legacy ssid_list */
4596*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_LEGACY_MODE) {
4597*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_LEGACY_PARAMS];
4598*4882a593Smuzhiyun _dhd_pno_reinitialize_prof(dhd, _params, DHD_PNO_LEGACY_MODE);
4599*4882a593Smuzhiyun }
4600*4882a593Smuzhiyun
4601*4882a593Smuzhiyun #ifdef GSCAN_SUPPORT
4602*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_GSCAN_MODE) {
4603*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_GSCAN_PARAMS];
4604*4882a593Smuzhiyun mutex_lock(&_pno_state->pno_mutex);
4605*4882a593Smuzhiyun dhd_pno_reset_cfg_gscan(dhd, _params, _pno_state, GSCAN_FLUSH_ALL_CFG);
4606*4882a593Smuzhiyun mutex_unlock(&_pno_state->pno_mutex);
4607*4882a593Smuzhiyun }
4608*4882a593Smuzhiyun #endif /* GSCAN_SUPPORT */
4609*4882a593Smuzhiyun
4610*4882a593Smuzhiyun if (_pno_state->pno_mode & DHD_PNO_BATCH_MODE) {
4611*4882a593Smuzhiyun _params = &_pno_state->pno_params_arr[INDEX_OF_BATCH_PARAMS];
4612*4882a593Smuzhiyun /* clear resource if the BATCH MODE is on */
4613*4882a593Smuzhiyun _dhd_pno_reinitialize_prof(dhd, _params, DHD_PNO_BATCH_MODE);
4614*4882a593Smuzhiyun }
4615*4882a593Smuzhiyun cancel_work_sync(&_pno_state->work);
4616*4882a593Smuzhiyun MFREE(dhd->osh, _pno_state, sizeof(dhd_pno_status_info_t));
4617*4882a593Smuzhiyun dhd->pno_state = NULL;
4618*4882a593Smuzhiyun return err;
4619*4882a593Smuzhiyun }
4620*4882a593Smuzhiyun #endif /* OEM_ANDROID */
4621*4882a593Smuzhiyun
4622*4882a593Smuzhiyun #ifndef OEM_ANDROID
4623*4882a593Smuzhiyun #if defined(NDIS)
4624*4882a593Smuzhiyun #define DHD_IOVAR_BUF_SIZE 128
4625*4882a593Smuzhiyun int
dhd_pno_cfg(dhd_pub_t * dhd,wl_pfn_cfg_t * pcfg)4626*4882a593Smuzhiyun dhd_pno_cfg(dhd_pub_t *dhd, wl_pfn_cfg_t *pcfg)
4627*4882a593Smuzhiyun {
4628*4882a593Smuzhiyun int ret = -1;
4629*4882a593Smuzhiyun uint len = 0;
4630*4882a593Smuzhiyun char iovbuf[2 * DHD_IOVAR_BUF_SIZE];
4631*4882a593Smuzhiyun
4632*4882a593Smuzhiyun if (!dhd)
4633*4882a593Smuzhiyun return ret;
4634*4882a593Smuzhiyun memset(iovbuf, 0, sizeof(iovbuf));
4635*4882a593Smuzhiyun if ((len =
4636*4882a593Smuzhiyun bcm_mkiovar("pfn_cfg", (char *)pcfg,
4637*4882a593Smuzhiyun sizeof(wl_pfn_cfg_t), iovbuf, sizeof(iovbuf))) > 0) {
4638*4882a593Smuzhiyun if ((ret =
4639*4882a593Smuzhiyun dhd_wl_ioctl_cmd(dhd, WLC_SET_VAR, iovbuf, len, TRUE, 0)) < 0)
4640*4882a593Smuzhiyun DHD_ERROR(("%s failed for error=%d\n",
4641*4882a593Smuzhiyun __FUNCTION__, ret));
4642*4882a593Smuzhiyun else
4643*4882a593Smuzhiyun DHD_ERROR(("%s set OK\n", __FUNCTION__));
4644*4882a593Smuzhiyun } else {
4645*4882a593Smuzhiyun DHD_ERROR(("%s iovar failed\n", __FUNCTION__));
4646*4882a593Smuzhiyun ret = -1;
4647*4882a593Smuzhiyun }
4648*4882a593Smuzhiyun
4649*4882a593Smuzhiyun return ret;
4650*4882a593Smuzhiyun }
4651*4882a593Smuzhiyun
4652*4882a593Smuzhiyun int
dhd_pno_suspend(dhd_pub_t * dhd,int pfn_suspend)4653*4882a593Smuzhiyun dhd_pno_suspend(dhd_pub_t *dhd, int pfn_suspend)
4654*4882a593Smuzhiyun {
4655*4882a593Smuzhiyun char iovbuf[DHD_IOVAR_BUF_SIZE];
4656*4882a593Smuzhiyun int ret = -1;
4657*4882a593Smuzhiyun
4658*4882a593Smuzhiyun if ((!dhd) || ((pfn_suspend != 0) && (pfn_suspend != 1))) {
4659*4882a593Smuzhiyun DHD_ERROR(("%s error exit\n", __FUNCTION__));
4660*4882a593Smuzhiyun return ret;
4661*4882a593Smuzhiyun }
4662*4882a593Smuzhiyun
4663*4882a593Smuzhiyun memset(iovbuf, 0, sizeof(iovbuf));
4664*4882a593Smuzhiyun /* suspend/resume PNO */
4665*4882a593Smuzhiyun if ((ret = bcm_mkiovar("pfn_suspend", (char *)&pfn_suspend, 4, iovbuf,
4666*4882a593Smuzhiyun sizeof(iovbuf))) > 0) {
4667*4882a593Smuzhiyun if ((ret = dhd_wl_ioctl_cmd(dhd, WLC_SET_VAR, iovbuf,
4668*4882a593Smuzhiyun sizeof(iovbuf), TRUE, 0)) < 0)
4669*4882a593Smuzhiyun DHD_ERROR(("%s failed for error=%d\n", __FUNCTION__, ret));
4670*4882a593Smuzhiyun else {
4671*4882a593Smuzhiyun DHD_TRACE(("%s set pno to %s\n", __FUNCTION__,
4672*4882a593Smuzhiyun (pfn_suspend? "suspend" : "resume")));
4673*4882a593Smuzhiyun dhd->pno_suspend = pfn_suspend;
4674*4882a593Smuzhiyun }
4675*4882a593Smuzhiyun }
4676*4882a593Smuzhiyun else {
4677*4882a593Smuzhiyun DHD_ERROR(("%s failed at mkiovar, err=%d\n", __FUNCTION__, ret));
4678*4882a593Smuzhiyun ret = -1;
4679*4882a593Smuzhiyun }
4680*4882a593Smuzhiyun
4681*4882a593Smuzhiyun return ret;
4682*4882a593Smuzhiyun }
4683*4882a593Smuzhiyun
4684*4882a593Smuzhiyun int
dhd_pno_set_add(dhd_pub_t * dhd,wl_pfn_t * netinfo,int nssid,ushort scan_fr,ushort slowscan_fr,uint8 pno_repeat,uint8 pno_freq_expo_max,int16 flags)4685*4882a593Smuzhiyun dhd_pno_set_add(dhd_pub_t *dhd, wl_pfn_t *netinfo, int nssid, ushort scan_fr, ushort slowscan_fr,
4686*4882a593Smuzhiyun uint8 pno_repeat, uint8 pno_freq_expo_max, int16 flags)
4687*4882a593Smuzhiyun {
4688*4882a593Smuzhiyun int err = -1;
4689*4882a593Smuzhiyun char iovbuf[DHD_IOVAR_BUF_SIZE];
4690*4882a593Smuzhiyun int k, i;
4691*4882a593Smuzhiyun wl_pfn_param_t pfn_param;
4692*4882a593Smuzhiyun wl_pfn_t pfn_element;
4693*4882a593Smuzhiyun uint len = 0;
4694*4882a593Smuzhiyun
4695*4882a593Smuzhiyun DHD_TRACE(("%s nssid=%d scan_fr=%d\n", __FUNCTION__, nssid, scan_fr));
4696*4882a593Smuzhiyun
4697*4882a593Smuzhiyun if ((!dhd) || (!netinfo) ||
4698*4882a593Smuzhiyun (nssid > MAX_PFN_LIST_COUNT) || (nssid <= 0)) {
4699*4882a593Smuzhiyun DHD_ERROR(("%s error exit\n", __FUNCTION__));
4700*4882a593Smuzhiyun return err;
4701*4882a593Smuzhiyun }
4702*4882a593Smuzhiyun
4703*4882a593Smuzhiyun /* Check for broadcast ssid */
4704*4882a593Smuzhiyun for (k = 0; k < nssid; k++) {
4705*4882a593Smuzhiyun if (!netinfo[k].ssid.SSID_len) {
4706*4882a593Smuzhiyun DHD_ERROR(("%d: Broadcast SSID is ilegal for PNO setting\n", k));
4707*4882a593Smuzhiyun return err;
4708*4882a593Smuzhiyun }
4709*4882a593Smuzhiyun }
4710*4882a593Smuzhiyun
4711*4882a593Smuzhiyun /* clean up everything */
4712*4882a593Smuzhiyun if (dhd_pno_clean(dhd) < 0) {
4713*4882a593Smuzhiyun DHD_ERROR(("%s failed\n", __FUNCTION__));
4714*4882a593Smuzhiyun return err;
4715*4882a593Smuzhiyun }
4716*4882a593Smuzhiyun memset(&pfn_param, 0, sizeof(pfn_param));
4717*4882a593Smuzhiyun memset(&pfn_element, 0, sizeof(pfn_element));
4718*4882a593Smuzhiyun
4719*4882a593Smuzhiyun /* set pfn parameters */
4720*4882a593Smuzhiyun pfn_param.version = htod32(PFN_VERSION);
4721*4882a593Smuzhiyun pfn_param.flags = htod16(flags |(PFN_LIST_ORDER << SORT_CRITERIA_BIT));
4722*4882a593Smuzhiyun
4723*4882a593Smuzhiyun /* set extra pno params */
4724*4882a593Smuzhiyun pfn_param.repeat = pno_repeat;
4725*4882a593Smuzhiyun pfn_param.exp = pno_freq_expo_max;
4726*4882a593Smuzhiyun pfn_param.slow_freq = slowscan_fr;
4727*4882a593Smuzhiyun
4728*4882a593Smuzhiyun /* set up pno scan fr */
4729*4882a593Smuzhiyun if (scan_fr > PNO_SCAN_MAX_FW_SEC) {
4730*4882a593Smuzhiyun DHD_ERROR(("%s pno freq above %d sec\n", __FUNCTION__, PNO_SCAN_MAX_FW_SEC));
4731*4882a593Smuzhiyun return err;
4732*4882a593Smuzhiyun }
4733*4882a593Smuzhiyun if (scan_fr < PNO_SCAN_MIN_FW_SEC) {
4734*4882a593Smuzhiyun DHD_ERROR(("%s pno freq less %d sec\n", __FUNCTION__, PNO_SCAN_MIN_FW_SEC));
4735*4882a593Smuzhiyun return err;
4736*4882a593Smuzhiyun }
4737*4882a593Smuzhiyun pfn_param.scan_freq = htod32(scan_fr);
4738*4882a593Smuzhiyun if (slowscan_fr)
4739*4882a593Smuzhiyun pfn_param.lost_network_timeout = -1; /* so no aging out */
4740*4882a593Smuzhiyun memset(iovbuf, 0, sizeof(iovbuf));
4741*4882a593Smuzhiyun len = bcm_mkiovar("pfn_set", (char *)&pfn_param, sizeof(pfn_param), iovbuf, sizeof(iovbuf));
4742*4882a593Smuzhiyun if (!len)
4743*4882a593Smuzhiyun return err;
4744*4882a593Smuzhiyun
4745*4882a593Smuzhiyun if (dhd_wl_ioctl_cmd(dhd, WLC_SET_VAR, iovbuf, len, TRUE, 0) < 0)
4746*4882a593Smuzhiyun return err;
4747*4882a593Smuzhiyun
4748*4882a593Smuzhiyun /* set all pfn ssid */
4749*4882a593Smuzhiyun for (i = 0; i < nssid; i++) {
4750*4882a593Smuzhiyun pfn_element.infra = htod32(1);
4751*4882a593Smuzhiyun pfn_element.auth = htod32(netinfo[i].auth);
4752*4882a593Smuzhiyun pfn_element.wpa_auth = htod32(netinfo[i].wpa_auth);
4753*4882a593Smuzhiyun pfn_element.wsec = htod32(netinfo[i].wsec);
4754*4882a593Smuzhiyun pfn_element.flags = htod32(netinfo[i].flags);
4755*4882a593Smuzhiyun
4756*4882a593Smuzhiyun memcpy((char *)pfn_element.ssid.SSID, netinfo[i].ssid.SSID,
4757*4882a593Smuzhiyun netinfo[i].ssid.SSID_len);
4758*4882a593Smuzhiyun pfn_element.ssid.SSID_len = netinfo[i].ssid.SSID_len;
4759*4882a593Smuzhiyun
4760*4882a593Smuzhiyun if ((len =
4761*4882a593Smuzhiyun bcm_mkiovar("pfn_add", (char *)&pfn_element,
4762*4882a593Smuzhiyun sizeof(pfn_element), iovbuf, sizeof(iovbuf))) > 0) {
4763*4882a593Smuzhiyun if ((err =
4764*4882a593Smuzhiyun dhd_wl_ioctl_cmd(dhd, WLC_SET_VAR, iovbuf, len, TRUE, 0)) < 0) {
4765*4882a593Smuzhiyun DHD_ERROR(("%s failed for i=%d error=%d\n",
4766*4882a593Smuzhiyun __FUNCTION__, i, err));
4767*4882a593Smuzhiyun return err;
4768*4882a593Smuzhiyun }
4769*4882a593Smuzhiyun else
4770*4882a593Smuzhiyun DHD_ERROR(("%s set ssid %s\n",
4771*4882a593Smuzhiyun __FUNCTION__, netinfo[i].ssid.SSID));
4772*4882a593Smuzhiyun }
4773*4882a593Smuzhiyun else
4774*4882a593Smuzhiyun DHD_ERROR(("%s: mkiovar pfn_add failed\n", __FUNCTION__));
4775*4882a593Smuzhiyun
4776*4882a593Smuzhiyun memset(&pfn_element, 0, sizeof(pfn_element));
4777*4882a593Smuzhiyun }
4778*4882a593Smuzhiyun
4779*4882a593Smuzhiyun return err;
4780*4882a593Smuzhiyun }
4781*4882a593Smuzhiyun
4782*4882a593Smuzhiyun int
dhd_pno_enable(dhd_pub_t * dhd,int pfn_enabled)4783*4882a593Smuzhiyun dhd_pno_enable(dhd_pub_t *dhd, int pfn_enabled)
4784*4882a593Smuzhiyun {
4785*4882a593Smuzhiyun char iovbuf[DHD_IOVAR_BUF_SIZE];
4786*4882a593Smuzhiyun int ret = -1;
4787*4882a593Smuzhiyun
4788*4882a593Smuzhiyun if ((!dhd) || ((pfn_enabled != 0) && (pfn_enabled != 1))) {
4789*4882a593Smuzhiyun DHD_ERROR(("%s error exit\n", __FUNCTION__));
4790*4882a593Smuzhiyun return ret;
4791*4882a593Smuzhiyun }
4792*4882a593Smuzhiyun
4793*4882a593Smuzhiyun #ifndef WL_SCHED_SCAN
4794*4882a593Smuzhiyun memset(iovbuf, 0, sizeof(iovbuf));
4795*4882a593Smuzhiyun
4796*4882a593Smuzhiyun if ((pfn_enabled) && (dhd_is_associated(dhd, 0, NULL) == TRUE)) {
4797*4882a593Smuzhiyun DHD_ERROR(("%s pno is NOT enable : called in assoc mode , ignore\n", __FUNCTION__));
4798*4882a593Smuzhiyun return ret;
4799*4882a593Smuzhiyun }
4800*4882a593Smuzhiyun #endif /* !WL_SCHED_SCAN */
4801*4882a593Smuzhiyun
4802*4882a593Smuzhiyun /* make sure PNO is not suspended when it is going to be enabled */
4803*4882a593Smuzhiyun if (pfn_enabled) {
4804*4882a593Smuzhiyun int pfn_suspend = 0;
4805*4882a593Smuzhiyun memset(iovbuf, 0, sizeof(iovbuf));
4806*4882a593Smuzhiyun if ((ret = bcm_mkiovar("pfn_suspend", (char *)&pfn_suspend, 4, iovbuf,
4807*4882a593Smuzhiyun sizeof(iovbuf))) > 0) {
4808*4882a593Smuzhiyun if ((ret = dhd_wl_ioctl_cmd(dhd, WLC_SET_VAR, iovbuf,
4809*4882a593Smuzhiyun sizeof(iovbuf), TRUE, 0)) < 0) {
4810*4882a593Smuzhiyun DHD_ERROR(("pfn_suspend failed for error=%d\n", __FUNCTION__, ret));
4811*4882a593Smuzhiyun return ret;
4812*4882a593Smuzhiyun } else {
4813*4882a593Smuzhiyun DHD_TRACE(("pno resumed\n"));
4814*4882a593Smuzhiyun }
4815*4882a593Smuzhiyun } else {
4816*4882a593Smuzhiyun return -1;
4817*4882a593Smuzhiyun }
4818*4882a593Smuzhiyun }
4819*4882a593Smuzhiyun
4820*4882a593Smuzhiyun /* Enable/disable PNO */
4821*4882a593Smuzhiyun if ((ret = bcm_mkiovar("pfn", (char *)&pfn_enabled, 4, iovbuf, sizeof(iovbuf))) > 0) {
4822*4882a593Smuzhiyun if ((ret = dhd_wl_ioctl_cmd(dhd, WLC_SET_VAR,
4823*4882a593Smuzhiyun iovbuf, sizeof(iovbuf), TRUE, 0)) < 0) {
4824*4882a593Smuzhiyun DHD_ERROR(("%s failed for error=%d\n", __FUNCTION__, ret));
4825*4882a593Smuzhiyun return ret;
4826*4882a593Smuzhiyun } else {
4827*4882a593Smuzhiyun dhd->pno_enable = pfn_enabled;
4828*4882a593Smuzhiyun DHD_TRACE(("%s set pno as %s\n",
4829*4882a593Smuzhiyun __FUNCTION__, dhd->pno_enable ? "Enable" : "Disable"));
4830*4882a593Smuzhiyun }
4831*4882a593Smuzhiyun }
4832*4882a593Smuzhiyun else DHD_ERROR(("%s failed err=%d\n", __FUNCTION__, ret));
4833*4882a593Smuzhiyun
4834*4882a593Smuzhiyun return ret;
4835*4882a593Smuzhiyun }
4836*4882a593Smuzhiyun
4837*4882a593Smuzhiyun int
dhd_pno_clean(dhd_pub_t * dhd)4838*4882a593Smuzhiyun dhd_pno_clean(dhd_pub_t *dhd)
4839*4882a593Smuzhiyun {
4840*4882a593Smuzhiyun char iovbuf[DHD_IOVAR_BUF_SIZE];
4841*4882a593Smuzhiyun int pfn_enabled = 0;
4842*4882a593Smuzhiyun int iov_len = 0;
4843*4882a593Smuzhiyun int ret;
4844*4882a593Smuzhiyun
4845*4882a593Smuzhiyun /* Disable pfn */
4846*4882a593Smuzhiyun iov_len = bcm_mkiovar("pfn", (char *)&pfn_enabled, 4, iovbuf, sizeof(iovbuf));
4847*4882a593Smuzhiyun if (!iov_len) {
4848*4882a593Smuzhiyun DHD_ERROR(("%s: Insufficient iovar buffer size %d \n",
4849*4882a593Smuzhiyun __FUNCTION__, sizeof(iovbuf)));
4850*4882a593Smuzhiyun return -1;
4851*4882a593Smuzhiyun }
4852*4882a593Smuzhiyun if ((ret = dhd_wl_ioctl_cmd(dhd, WLC_SET_VAR, iovbuf, iov_len, TRUE, 0)) >= 0) {
4853*4882a593Smuzhiyun /* clear pfn */
4854*4882a593Smuzhiyun iov_len = bcm_mkiovar("pfnclear", 0, 0, iovbuf, sizeof(iovbuf));
4855*4882a593Smuzhiyun if (iov_len) {
4856*4882a593Smuzhiyun if ((ret = dhd_wl_ioctl_cmd(dhd, WLC_SET_VAR, iovbuf,
4857*4882a593Smuzhiyun iov_len, TRUE, 0)) < 0) {
4858*4882a593Smuzhiyun DHD_ERROR(("%s failed code %d\n", __FUNCTION__, ret));
4859*4882a593Smuzhiyun }
4860*4882a593Smuzhiyun } else {
4861*4882a593Smuzhiyun ret = -1;
4862*4882a593Smuzhiyun DHD_ERROR(("%s failed code %d\n", __FUNCTION__, iov_len));
4863*4882a593Smuzhiyun }
4864*4882a593Smuzhiyun } else
4865*4882a593Smuzhiyun DHD_ERROR(("%s failed code %d\n", __FUNCTION__, ret));
4866*4882a593Smuzhiyun
4867*4882a593Smuzhiyun return ret;
4868*4882a593Smuzhiyun }
4869*4882a593Smuzhiyun #endif /* defined(NDIS) */
4870*4882a593Smuzhiyun #endif /* OEM_ANDROID */
4871*4882a593Smuzhiyun #endif /* PNO_SUPPORT */
4872