1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
|
/*
* Linux roam cache
*
* Copyright (C) 1999-2012, Broadcom Corporation
*
* Unless you and Broadcom execute a separate written software license
* agreement governing use of this software, this software is licensed to you
* under the terms of the GNU General Public License version 2 (the "GPL"),
* available at http://www.broadcom.com/licenses/GPLv2.php, with the
* following added to such license:
*
* As a special exception, the copyright holders of this software give you
* permission to link this software with independent modules, and to copy and
* distribute the resulting executable under terms of your choice, provided that
* you also meet, for each linked independent module, the terms and conditions of
* the license of that module. An independent module is a module which is not
* derived from this software. The special exception does not apply to any
* modifications of the software.
*
* Notwithstanding the above, under no circumstances may you combine this
* software in any way with any other Broadcom software provided under a license
* other than the GPL, without Broadcom's express prior written consent.
*
* $Id: wl_roam.c 334946 2012-05-24 20:38:00Z $
*/
#include <typedefs.h>
#include <osl.h>
#include <bcmwifi_channels.h>
#include <wlioctl.h>
#if defined(CUSTOMER_HW4) && defined(WES_SUPPORT)
#include <wldev_common.h>
#define WL_ERROR(x) printk x
#endif
#define WL_DBG(x)
#define MAX_ROAM_CACHE 100
typedef struct {
chanspec_t chanspec;
int ssid_len;
char ssid[36];
} roam_channel_cache;
static int n_roam_cache = 0;
static int roam_band = WLC_BAND_AUTO;
static roam_channel_cache roam_cache[MAX_ROAM_CACHE];
#if defined(CUSTOMER_HW4) && defined(WES_SUPPORT)
static int roamscan_mode = 0;
#endif
#if defined(CUSTOMER_HW4) && defined(WES_SUPPORT)
int get_roamscan_mode(struct net_device *dev, int *mode)
{
*mode = roamscan_mode;
return 0;
}
int set_roamscan_mode(struct net_device *dev, int mode)
{
int error = 0;
roamscan_mode = mode;
n_roam_cache = 0;
error = wldev_iovar_setint(dev, "roamscan_mode", mode);
if (error) {
WL_ERROR(("Failed to set roamscan mode to %d, error = %d\n", mode, error));
}
return error;
}
int get_roamscan_channel_list(struct net_device *dev, unsigned char channels[])
{
int n = 0;
if (roamscan_mode) {
for (n = 0; n < n_roam_cache; n++) {
channels[n] = roam_cache[n].chanspec & WL_CHANSPEC_CHAN_MASK;
WL_DBG(("%s: channel[%d] - [%02d] \n", __FUNCTION__, n, channels[n]));
}
}
return n;
}
int set_roamscan_channel_list(struct net_device *dev,
unsigned char n, unsigned char channels[], int ioctl_ver)
{
int i;
int error;
struct {
int n;
chanspec_t channels[20];
} channel_list;
char iobuf[200];
uint band, band2G, band5G, bw;
roamscan_mode = 1;
if (n > 20)
n = 20;
#ifdef D11AC_IOTYPES
if (ioctl_ver == 1) {
/* legacy chanspec */
band2G = WL_LCHANSPEC_BAND_2G;
band5G = WL_LCHANSPEC_BAND_5G;
bw = WL_LCHANSPEC_BW_20 | WL_LCHANSPEC_CTL_SB_NONE;
} else {
band2G = WL_CHANSPEC_BAND_2G;
band5G = WL_CHANSPEC_BAND_5G;
bw = WL_CHANSPEC_BW_20;
}
#else
band2G = WL_CHANSPEC_BAND_2G;
band5G = WL_CHANSPEC_BAND_5G;
bw = WL_CHANSPEC_BW_20 | WL_CHANSPEC_CTL_SB_NONE;
#endif /* D11AC_IOTYPES */
for (i = 0; i < n; i++) {
chanspec_t chanspec;
if (channels[i] <= 14) {
chanspec = band2G | bw | channels[i];
} else {
chanspec = band5G | bw | channels[i];
}
roam_cache[i].chanspec = chanspec;
channel_list.channels[i] = chanspec;
WL_DBG(("%s: channel[%d] - [%02d] \n", __FUNCTION__, i, channels[i]));
}
n_roam_cache = n;
channel_list.n = n;
error = wldev_iovar_setbuf(dev, "roamscan_channels", &channel_list,
sizeof(channel_list), iobuf, sizeof(iobuf), NULL);
if (error) {
WL_ERROR(("Failed to set roamscan channels, error = %d\n", error));
}
return error;
}
#endif /* WES_SUPPORT */
void set_roam_band(int band)
{
roam_band = band;
}
void reset_roam_cache(void)
{
#if defined(CUSTOMER_HW4) && defined(WES_SUPPORT)
if (roamscan_mode)
return;
#endif
n_roam_cache = 0;
}
void add_roam_cache(wl_bss_info_t *bi)
{
int i;
uint8 channel;
#if defined(CUSTOMER_HW4) && defined(WES_SUPPORT)
if (roamscan_mode)
return;
#endif
if (n_roam_cache == MAX_ROAM_CACHE)
return;
for (i = 0; i < n_roam_cache; i++) {
if ((roam_cache[i].ssid_len == bi->SSID_len) &&
(roam_cache[i].chanspec == bi->chanspec) &&
(memcmp(roam_cache[i].ssid, bi->SSID, bi->SSID_len) == 0)) {
/* identical one found, just return */
return;
}
}
roam_cache[n_roam_cache].ssid_len = bi->SSID_len;
channel = (bi->ctl_ch == 0) ? CHSPEC_CHANNEL(bi->chanspec) : bi->ctl_ch;
roam_cache[n_roam_cache].chanspec =
WL_CHANSPEC_BW_20 |
(channel <= 14 ? WL_CHANSPEC_BAND_2G : WL_CHANSPEC_BAND_5G) |
channel;
memcpy(roam_cache[n_roam_cache].ssid, bi->SSID, bi->SSID_len);
n_roam_cache++;
}
int get_roam_channel_list(int target_chan,
chanspec_t *channels, const wlc_ssid_t *ssid, int ioctl_ver)
{
int i, n = 1;
uint band, band2G, band5G, bw;
#ifdef D11AC_IOTYPES
if (ioctl_ver == 1) {
/* legacy chanspec */
band2G = WL_LCHANSPEC_BAND_2G;
band5G = WL_LCHANSPEC_BAND_5G;
bw = WL_LCHANSPEC_BW_20 | WL_LCHANSPEC_CTL_SB_NONE;
} else {
band2G = WL_CHANSPEC_BAND_2G;
band5G = WL_CHANSPEC_BAND_5G;
bw = WL_CHANSPEC_BW_20;
}
#else
band2G = WL_CHANSPEC_BAND_2G;
band5G = WL_CHANSPEC_BAND_5G;
bw = WL_CHANSPEC_BW_20 | WL_CHANSPEC_CTL_SB_NONE;
#endif /* D11AC_IOTYPES */
if (target_chan <= 14)
band = band2G;
else
band = band5G;
*channels = (target_chan & WL_CHANSPEC_CHAN_MASK) | band | bw;
WL_DBG((" %s: %02d 0x%04X\n", __FUNCTION__, target_chan, *channels));
++channels;
#if defined(CUSTOMER_HW4) && defined(WES_SUPPORT)
if (roamscan_mode) {
for (i = 0; i < n_roam_cache; i++) {
if ((roam_cache[i].chanspec & WL_CHANSPEC_CHAN_MASK) != target_chan) {
*channels = roam_cache[i].chanspec & WL_CHANSPEC_CHAN_MASK;
WL_DBG((" %s: %02d\n", __FUNCTION__, *channels));
if (*channels <= 14)
*channels |= band2G | bw;
else
*channels |= band5G | bw;
channels++;
n++;
}
}
return n;
}
#endif /* WES_SUPPORT */
for (i = 0; i < n_roam_cache; i++) {
chanspec_t ch = roam_cache[i].chanspec;
if ((roam_cache[i].ssid_len == ssid->SSID_len) &&
((ch & WL_CHANSPEC_CHAN_MASK) != target_chan) &&
((roam_band == WLC_BAND_AUTO) ||
((roam_band == WLC_BAND_2G) && CHSPEC_IS2G(ch)) ||
((roam_band == WLC_BAND_5G) && CHSPEC_IS5G(ch))) &&
(memcmp(roam_cache[i].ssid, ssid->SSID, ssid->SSID_len) == 0)) {
/* match found, add it */
*channels = ch & WL_CHANSPEC_CHAN_MASK;
if (*channels <= 14)
*channels |= band2G | bw;
else
*channels |= band5G | bw;
WL_DBG((" %s: %02d 0x%04X\n", __FUNCTION__,
ch & WL_CHANSPEC_CHAN_MASK, *channels));
channels++; n++;
}
}
return n;
}
void print_roam_cache(void)
{
int i;
WL_DBG((" %d cache\n", n_roam_cache));
for (i = 0; i < n_roam_cache; i++) {
roam_cache[i].ssid[roam_cache[i].ssid_len] = 0;
WL_DBG(("0x%02X %02d %s\n", roam_cache[i].chanspec,
roam_cache[i].ssid_len, roam_cache[i].ssid));
}
}
|
