2 * WPA Supplicant - background scan and roaming module: learn
3 * Copyright (c) 2009-2010, Jouni Malinen <j@w1.fi>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
9 * Alternatively, this software may be distributed under the terms of BSD
12 * See README and COPYING for more details.
20 #include "common/ieee802_11_defs.h"
21 #include "drivers/driver.h"
22 #include "config_ssid.h"
23 #include "wpa_supplicant_i.h"
28 struct bgscan_learn_bss
{
32 u8
*neigh
; /* num_neigh * ETH_ALEN buffer */
36 struct bgscan_learn_data
{
37 struct wpa_supplicant
*wpa_s
;
38 const struct wpa_ssid
*ssid
;
41 int short_interval
; /* use if signal < threshold */
42 int long_interval
; /* use if signal > threshold */
43 struct os_time last_bgscan
;
51 static void bss_free(struct bgscan_learn_bss
*bss
)
58 static int bssid_in_array(u8
*array
, size_t array_len
, const u8
*bssid
)
62 if (array
== NULL
|| array_len
== 0)
65 for (i
= 0; i
< array_len
; i
++) {
66 if (os_memcmp(array
+ i
* ETH_ALEN
, bssid
, ETH_ALEN
) == 0)
74 static void bgscan_learn_add_neighbor(struct bgscan_learn_bss
*bss
,
79 if (os_memcmp(bss
->bssid
, bssid
, ETH_ALEN
) == 0)
81 if (bssid_in_array(bss
->neigh
, bss
->num_neigh
, bssid
))
84 n
= os_realloc(bss
->neigh
, (bss
->num_neigh
+ 1) * ETH_ALEN
);
88 os_memcpy(n
+ bss
->num_neigh
* ETH_ALEN
, bssid
, ETH_ALEN
);
94 static struct bgscan_learn_bss
* bgscan_learn_get_bss(
95 struct bgscan_learn_data
*data
, const u8
*bssid
)
97 struct bgscan_learn_bss
*bss
;
99 dl_list_for_each(bss
, &data
->bss
, struct bgscan_learn_bss
, list
) {
100 if (os_memcmp(bss
->bssid
, bssid
, ETH_ALEN
) == 0)
107 static int bgscan_learn_load(struct bgscan_learn_data
*data
)
111 struct bgscan_learn_bss
*bss
;
113 if (data
->fname
== NULL
)
116 f
= fopen(data
->fname
, "r");
120 wpa_printf(MSG_DEBUG
, "bgscan learn: Loading data from %s",
123 if (fgets(buf
, sizeof(buf
), f
) == NULL
||
124 os_strncmp(buf
, "wpa_supplicant-bgscan-learn\n", 28) != 0) {
125 wpa_printf(MSG_INFO
, "bgscan learn: Invalid data file %s",
131 while (fgets(buf
, sizeof(buf
), f
)) {
132 if (os_strncmp(buf
, "BSS ", 4) == 0) {
133 bss
= os_zalloc(sizeof(*bss
));
136 if (hwaddr_aton(buf
+ 4, bss
->bssid
) < 0) {
140 bss
->freq
= atoi(buf
+ 4 + 18);
141 dl_list_add(&data
->bss
, &bss
->list
);
142 wpa_printf(MSG_DEBUG
, "bgscan learn: Loaded BSS "
143 "entry: " MACSTR
" freq=%d",
144 MAC2STR(bss
->bssid
), bss
->freq
);
147 if (os_strncmp(buf
, "NEIGHBOR ", 9) == 0) {
150 if (hwaddr_aton(buf
+ 9, addr
) < 0)
152 bss
= bgscan_learn_get_bss(data
, addr
);
155 if (hwaddr_aton(buf
+ 9 + 18, addr
) < 0)
158 bgscan_learn_add_neighbor(bss
, addr
);
167 static void bgscan_learn_save(struct bgscan_learn_data
*data
)
170 struct bgscan_learn_bss
*bss
;
172 if (data
->fname
== NULL
)
175 wpa_printf(MSG_DEBUG
, "bgscan learn: Saving data to %s",
178 f
= fopen(data
->fname
, "w");
181 fprintf(f
, "wpa_supplicant-bgscan-learn\n");
183 dl_list_for_each(bss
, &data
->bss
, struct bgscan_learn_bss
, list
) {
184 fprintf(f
, "BSS " MACSTR
" %d\n",
185 MAC2STR(bss
->bssid
), bss
->freq
);
188 dl_list_for_each(bss
, &data
->bss
, struct bgscan_learn_bss
, list
) {
190 for (i
= 0; i
< bss
->num_neigh
; i
++) {
191 fprintf(f
, "NEIGHBOR " MACSTR
" " MACSTR
"\n",
193 MAC2STR(bss
->neigh
+ i
* ETH_ALEN
));
201 static int in_array(int *array
, int val
)
208 for (i
= 0; array
[i
]; i
++) {
217 static int * bgscan_learn_get_freqs(struct bgscan_learn_data
*data
,
220 struct bgscan_learn_bss
*bss
;
221 int *freqs
= NULL
, *n
;
225 dl_list_for_each(bss
, &data
->bss
, struct bgscan_learn_bss
, list
) {
226 if (in_array(freqs
, bss
->freq
))
228 n
= os_realloc(freqs
, (*count
+ 2) * sizeof(int));
232 freqs
[*count
] = bss
->freq
;
241 static int * bgscan_learn_get_probe_freq(struct bgscan_learn_data
*data
,
242 int *freqs
, size_t count
)
246 if (data
->supp_freqs
== NULL
)
249 idx
= data
->probe_idx
+ 1;
250 while (idx
!= data
->probe_idx
) {
251 if (data
->supp_freqs
[idx
] == 0)
253 if (!in_array(freqs
, data
->supp_freqs
[idx
])) {
254 wpa_printf(MSG_DEBUG
, "bgscan learn: Probe new freq "
255 "%u", data
->supp_freqs
[idx
]);
256 data
->probe_idx
= idx
;
257 n
= os_realloc(freqs
, (count
+ 2) * sizeof(int));
261 freqs
[count
] = data
->supp_freqs
[idx
];
274 static void bgscan_learn_timeout(void *eloop_ctx
, void *timeout_ctx
)
276 struct bgscan_learn_data
*data
= eloop_ctx
;
277 struct wpa_supplicant
*wpa_s
= data
->wpa_s
;
278 struct wpa_driver_scan_params params
;
283 os_memset(¶ms
, 0, sizeof(params
));
284 params
.num_ssids
= 1;
285 params
.ssids
[0].ssid
= data
->ssid
->ssid
;
286 params
.ssids
[0].ssid_len
= data
->ssid
->ssid_len
;
287 if (data
->ssid
->scan_freq
)
288 params
.freqs
= data
->ssid
->scan_freq
;
290 freqs
= bgscan_learn_get_freqs(data
, &count
);
291 wpa_printf(MSG_DEBUG
, "bgscan learn: BSSes in this ESS have "
292 "been seen on %u channels", (unsigned int) count
);
293 freqs
= bgscan_learn_get_probe_freq(data
, freqs
, count
);
297 for (i
= 0; freqs
&& freqs
[i
]; i
++) {
299 ret
= os_snprintf(pos
, msg
+ sizeof(msg
) - pos
, " %d",
301 if (ret
< 0 || ret
>= msg
+ sizeof(msg
) - pos
)
306 wpa_printf(MSG_DEBUG
, "bgscan learn: Scanning frequencies:%s",
308 params
.freqs
= freqs
;
311 wpa_printf(MSG_DEBUG
, "bgscan learn: Request a background scan");
312 if (wpa_supplicant_trigger_scan(wpa_s
, ¶ms
)) {
313 wpa_printf(MSG_DEBUG
, "bgscan learn: Failed to trigger scan");
314 eloop_register_timeout(data
->scan_interval
, 0,
315 bgscan_learn_timeout
, data
, NULL
);
317 os_get_time(&data
->last_bgscan
);
322 static int bgscan_learn_get_params(struct bgscan_learn_data
*data
,
330 data
->short_interval
= atoi(params
);
332 pos
= os_strchr(params
, ':');
336 data
->signal_threshold
= atoi(pos
);
337 pos
= os_strchr(pos
, ':');
339 wpa_printf(MSG_ERROR
, "bgscan learn: Missing scan interval "
344 data
->long_interval
= atoi(pos
);
345 pos
= os_strchr(pos
, ':');
348 data
->fname
= os_strdup(pos
);
355 static int * bgscan_learn_get_supp_freqs(struct wpa_supplicant
*wpa_s
)
357 struct hostapd_hw_modes
*modes
;
358 u16 num_modes
, flags
;
359 int i
, j
, *freqs
= NULL
, *n
;
362 modes
= wpa_drv_get_hw_feature_data(wpa_s
, &num_modes
, &flags
);
366 for (i
= 0; i
< num_modes
; i
++) {
367 for (j
= 0; j
< modes
[i
].num_channels
; j
++) {
368 if (modes
[i
].channels
[j
].flag
& HOSTAPD_CHAN_DISABLED
)
370 n
= os_realloc(freqs
, (count
+ 2) * sizeof(int));
375 freqs
[count
] = modes
[i
].channels
[j
].freq
;
379 os_free(modes
[i
].channels
);
380 os_free(modes
[i
].rates
);
388 static void * bgscan_learn_init(struct wpa_supplicant
*wpa_s
,
390 const struct wpa_ssid
*ssid
)
392 struct bgscan_learn_data
*data
;
394 data
= os_zalloc(sizeof(*data
));
397 dl_list_init(&data
->bss
);
400 if (bgscan_learn_get_params(data
, params
) < 0) {
401 os_free(data
->fname
);
405 if (data
->short_interval
<= 0)
406 data
->short_interval
= 30;
407 if (data
->long_interval
<= 0)
408 data
->long_interval
= 30;
410 if (bgscan_learn_load(data
) < 0) {
411 os_free(data
->fname
);
416 wpa_printf(MSG_DEBUG
, "bgscan learn: Signal strength threshold %d "
417 "Short bgscan interval %d Long bgscan interval %d",
418 data
->signal_threshold
, data
->short_interval
,
419 data
->long_interval
);
421 if (data
->signal_threshold
&&
422 wpa_drv_signal_monitor(wpa_s
, data
->signal_threshold
, 4) < 0) {
423 wpa_printf(MSG_ERROR
, "bgscan learn: Failed to enable "
424 "signal strength monitoring");
427 data
->supp_freqs
= bgscan_learn_get_supp_freqs(wpa_s
);
428 data
->scan_interval
= data
->short_interval
;
429 eloop_register_timeout(data
->scan_interval
, 0, bgscan_learn_timeout
,
433 * This function is called immediately after an association, so it is
434 * reasonable to assume that a scan was completed recently. This makes
435 * us skip an immediate new scan in cases where the current signal
436 * level is below the bgscan threshold.
438 os_get_time(&data
->last_bgscan
);
444 static void bgscan_learn_deinit(void *priv
)
446 struct bgscan_learn_data
*data
= priv
;
447 struct bgscan_learn_bss
*bss
, *n
;
449 bgscan_learn_save(data
);
450 eloop_cancel_timeout(bgscan_learn_timeout
, data
, NULL
);
451 if (data
->signal_threshold
)
452 wpa_drv_signal_monitor(data
->wpa_s
, 0, 0);
453 os_free(data
->fname
);
454 dl_list_for_each_safe(bss
, n
, &data
->bss
, struct bgscan_learn_bss
,
456 dl_list_del(&bss
->list
);
459 os_free(data
->supp_freqs
);
464 static int bgscan_learn_bss_match(struct bgscan_learn_data
*data
,
465 struct wpa_scan_res
*bss
)
469 ie
= wpa_scan_get_ie(bss
, WLAN_EID_SSID
);
473 if (data
->ssid
->ssid_len
!= ie
[1] ||
474 os_memcmp(data
->ssid
->ssid
, ie
+ 2, ie
[1]) != 0)
475 return 0; /* SSID mismatch */
481 static int bgscan_learn_notify_scan(void *priv
,
482 struct wpa_scan_results
*scan_res
)
484 struct bgscan_learn_data
*data
= priv
;
487 u8 bssid
[MAX_BSS
* ETH_ALEN
];
488 size_t num_bssid
= 0;
490 wpa_printf(MSG_DEBUG
, "bgscan learn: scan result notification");
492 eloop_cancel_timeout(bgscan_learn_timeout
, data
, NULL
);
493 eloop_register_timeout(data
->scan_interval
, 0, bgscan_learn_timeout
,
496 for (i
= 0; i
< scan_res
->num
; i
++) {
497 struct wpa_scan_res
*res
= scan_res
->res
[i
];
498 if (!bgscan_learn_bss_match(data
, res
))
501 if (num_bssid
< MAX_BSS
) {
502 os_memcpy(bssid
+ num_bssid
* ETH_ALEN
, res
->bssid
,
507 wpa_printf(MSG_DEBUG
, "bgscan learn: %u matching BSSes in scan "
508 "results", (unsigned int) num_bssid
);
510 for (i
= 0; i
< scan_res
->num
; i
++) {
511 struct wpa_scan_res
*res
= scan_res
->res
[i
];
512 struct bgscan_learn_bss
*bss
;
514 if (!bgscan_learn_bss_match(data
, res
))
517 bss
= bgscan_learn_get_bss(data
, res
->bssid
);
518 if (bss
&& bss
->freq
!= res
->freq
) {
519 wpa_printf(MSG_DEBUG
, "bgscan learn: Update BSS "
520 MACSTR
" freq %d -> %d",
521 MAC2STR(res
->bssid
), bss
->freq
, res
->freq
);
522 bss
->freq
= res
->freq
;
524 wpa_printf(MSG_DEBUG
, "bgscan learn: Add BSS " MACSTR
525 " freq=%d", MAC2STR(res
->bssid
), res
->freq
);
526 bss
= os_zalloc(sizeof(*bss
));
529 os_memcpy(bss
->bssid
, res
->bssid
, ETH_ALEN
);
530 bss
->freq
= res
->freq
;
531 dl_list_add(&data
->bss
, &bss
->list
);
534 for (j
= 0; j
< num_bssid
; j
++) {
535 u8
*addr
= bssid
+ j
* ETH_ALEN
;
536 bgscan_learn_add_neighbor(bss
, addr
);
541 * A more advanced bgscan could process scan results internally, select
542 * the BSS and request roam if needed. This sample uses the existing
543 * BSS/ESS selection routine. Change this to return 1 if selection is
544 * done inside the bgscan module.
551 static void bgscan_learn_notify_beacon_loss(void *priv
)
553 wpa_printf(MSG_DEBUG
, "bgscan learn: beacon loss");
554 /* TODO: speed up background scanning */
558 static void bgscan_learn_notify_signal_change(void *priv
, int above
,
563 struct bgscan_learn_data
*data
= priv
;
567 if (data
->short_interval
== data
->long_interval
||
568 data
->signal_threshold
== 0)
571 wpa_printf(MSG_DEBUG
, "bgscan learn: signal level changed "
572 "(above=%d current_signal=%d current_noise=%d "
573 "current_txrate=%d)", above
, current_signal
,
574 current_noise
, current_txrate
);
575 if (data
->scan_interval
== data
->long_interval
&& !above
) {
576 wpa_printf(MSG_DEBUG
, "bgscan learn: Start using short bgscan "
578 data
->scan_interval
= data
->short_interval
;
580 if (now
.sec
> data
->last_bgscan
.sec
+ 1)
582 } else if (data
->scan_interval
== data
->short_interval
&& above
) {
583 wpa_printf(MSG_DEBUG
, "bgscan learn: Start using long bgscan "
585 data
->scan_interval
= data
->long_interval
;
586 eloop_cancel_timeout(bgscan_learn_timeout
, data
, NULL
);
587 eloop_register_timeout(data
->scan_interval
, 0,
588 bgscan_learn_timeout
, data
, NULL
);
591 * Signal dropped further 4 dB. Request a new scan if we have
592 * not yet scanned in a while.
595 if (now
.sec
> data
->last_bgscan
.sec
+ 10)
600 wpa_printf(MSG_DEBUG
, "bgscan learn: Trigger immediate scan");
601 eloop_cancel_timeout(bgscan_learn_timeout
, data
, NULL
);
602 eloop_register_timeout(0, 0, bgscan_learn_timeout
, data
, NULL
);
607 const struct bgscan_ops bgscan_learn_ops
= {
609 .init
= bgscan_learn_init
,
610 .deinit
= bgscan_learn_deinit
,
611 .notify_scan
= bgscan_learn_notify_scan
,
612 .notify_beacon_loss
= bgscan_learn_notify_beacon_loss
,
613 .notify_signal_change
= bgscan_learn_notify_signal_change
,