dbus: add BSS Age property to indicate last-seen time
[mech_eap.git] / wpa_supplicant / bss.c
1 /*
2  * BSS table
3  * Copyright (c) 2009-2012, Jouni Malinen <j@w1.fi>
4  *
5  * This software may be distributed under the terms of the BSD license.
6  * See README for more details.
7  */
8
9 #include "utils/includes.h"
10
11 #include "utils/common.h"
12 #include "utils/eloop.h"
13 #include "common/ieee802_11_defs.h"
14 #include "drivers/driver.h"
15 #include "wpa_supplicant_i.h"
16 #include "config.h"
17 #include "notify.h"
18 #include "scan.h"
19 #include "bss.h"
20
21
22 /**
23  * WPA_BSS_EXPIRATION_PERIOD - Period of expiration run in seconds
24  */
25 #define WPA_BSS_EXPIRATION_PERIOD 10
26
27 #define WPA_BSS_FREQ_CHANGED_FLAG       BIT(0)
28 #define WPA_BSS_SIGNAL_CHANGED_FLAG     BIT(1)
29 #define WPA_BSS_PRIVACY_CHANGED_FLAG    BIT(2)
30 #define WPA_BSS_MODE_CHANGED_FLAG       BIT(3)
31 #define WPA_BSS_WPAIE_CHANGED_FLAG      BIT(4)
32 #define WPA_BSS_RSNIE_CHANGED_FLAG      BIT(5)
33 #define WPA_BSS_WPS_CHANGED_FLAG        BIT(6)
34 #define WPA_BSS_RATES_CHANGED_FLAG      BIT(7)
35 #define WPA_BSS_IES_CHANGED_FLAG        BIT(8)
36
37
38 static void wpa_bss_set_hessid(struct wpa_bss *bss)
39 {
40 #ifdef CONFIG_INTERWORKING
41         const u8 *ie = wpa_bss_get_ie(bss, WLAN_EID_INTERWORKING);
42         if (ie == NULL || (ie[1] != 7 && ie[1] != 9)) {
43                 os_memset(bss->hessid, 0, ETH_ALEN);
44                 return;
45         }
46         if (ie[1] == 7)
47                 os_memcpy(bss->hessid, ie + 3, ETH_ALEN);
48         else
49                 os_memcpy(bss->hessid, ie + 5, ETH_ALEN);
50 #endif /* CONFIG_INTERWORKING */
51 }
52
53
54 /**
55  * wpa_bss_anqp_alloc - Allocate ANQP data structure for a BSS entry
56  * Returns: Allocated ANQP data structure or %NULL on failure
57  *
58  * The allocated ANQP data structure has its users count set to 1. It may be
59  * shared by multiple BSS entries and each shared entry is freed with
60  * wpa_bss_anqp_free().
61  */
62 struct wpa_bss_anqp * wpa_bss_anqp_alloc(void)
63 {
64         struct wpa_bss_anqp *anqp;
65         anqp = os_zalloc(sizeof(*anqp));
66         if (anqp == NULL)
67                 return NULL;
68         anqp->users = 1;
69         return anqp;
70 }
71
72
73 /**
74  * wpa_bss_anqp_clone - Clone an ANQP data structure
75  * @anqp: ANQP data structure from wpa_bss_anqp_alloc()
76  * Returns: Cloned ANQP data structure or %NULL on failure
77  */
78 static struct wpa_bss_anqp * wpa_bss_anqp_clone(struct wpa_bss_anqp *anqp)
79 {
80         struct wpa_bss_anqp *n;
81
82         n = os_zalloc(sizeof(*n));
83         if (n == NULL)
84                 return NULL;
85
86 #define ANQP_DUP(f) if (anqp->f) n->f = wpabuf_dup(anqp->f)
87 #ifdef CONFIG_INTERWORKING
88         ANQP_DUP(venue_name);
89         ANQP_DUP(network_auth_type);
90         ANQP_DUP(roaming_consortium);
91         ANQP_DUP(ip_addr_type_availability);
92         ANQP_DUP(nai_realm);
93         ANQP_DUP(anqp_3gpp);
94         ANQP_DUP(domain_name);
95 #endif /* CONFIG_INTERWORKING */
96 #ifdef CONFIG_HS20
97         ANQP_DUP(hs20_operator_friendly_name);
98         ANQP_DUP(hs20_wan_metrics);
99         ANQP_DUP(hs20_connection_capability);
100         ANQP_DUP(hs20_operating_class);
101         ANQP_DUP(hs20_osu_providers_list);
102 #endif /* CONFIG_HS20 */
103 #undef ANQP_DUP
104
105         return n;
106 }
107
108
109 /**
110  * wpa_bss_anqp_unshare_alloc - Unshare ANQP data (if shared) in a BSS entry
111  * @bss: BSS entry
112  * Returns: 0 on success, -1 on failure
113  *
114  * This function ensures the specific BSS entry has an ANQP data structure that
115  * is not shared with any other BSS entry.
116  */
117 int wpa_bss_anqp_unshare_alloc(struct wpa_bss *bss)
118 {
119         struct wpa_bss_anqp *anqp;
120
121         if (bss->anqp && bss->anqp->users > 1) {
122                 /* allocated, but shared - clone an unshared copy */
123                 anqp = wpa_bss_anqp_clone(bss->anqp);
124                 if (anqp == NULL)
125                         return -1;
126                 anqp->users = 1;
127                 bss->anqp->users--;
128                 bss->anqp = anqp;
129                 return 0;
130         }
131
132         if (bss->anqp)
133                 return 0; /* already allocated and not shared */
134
135         /* not allocated - allocate a new storage area */
136         bss->anqp = wpa_bss_anqp_alloc();
137         return bss->anqp ? 0 : -1;
138 }
139
140
141 /**
142  * wpa_bss_anqp_free - Free an ANQP data structure
143  * @anqp: ANQP data structure from wpa_bss_anqp_alloc() or wpa_bss_anqp_clone()
144  */
145 static void wpa_bss_anqp_free(struct wpa_bss_anqp *anqp)
146 {
147         if (anqp == NULL)
148                 return;
149
150         anqp->users--;
151         if (anqp->users > 0) {
152                 /* Another BSS entry holds a pointer to this ANQP info */
153                 return;
154         }
155
156 #ifdef CONFIG_INTERWORKING
157         wpabuf_free(anqp->venue_name);
158         wpabuf_free(anqp->network_auth_type);
159         wpabuf_free(anqp->roaming_consortium);
160         wpabuf_free(anqp->ip_addr_type_availability);
161         wpabuf_free(anqp->nai_realm);
162         wpabuf_free(anqp->anqp_3gpp);
163         wpabuf_free(anqp->domain_name);
164 #endif /* CONFIG_INTERWORKING */
165 #ifdef CONFIG_HS20
166         wpabuf_free(anqp->hs20_operator_friendly_name);
167         wpabuf_free(anqp->hs20_wan_metrics);
168         wpabuf_free(anqp->hs20_connection_capability);
169         wpabuf_free(anqp->hs20_operating_class);
170         wpabuf_free(anqp->hs20_osu_providers_list);
171 #endif /* CONFIG_HS20 */
172
173         os_free(anqp);
174 }
175
176
177 static void wpa_bss_remove(struct wpa_supplicant *wpa_s, struct wpa_bss *bss,
178                            const char *reason)
179 {
180         if (wpa_s->last_scan_res) {
181                 unsigned int i;
182                 for (i = 0; i < wpa_s->last_scan_res_used; i++) {
183                         if (wpa_s->last_scan_res[i] == bss) {
184                                 os_memmove(&wpa_s->last_scan_res[i],
185                                            &wpa_s->last_scan_res[i + 1],
186                                            (wpa_s->last_scan_res_used - i - 1)
187                                            * sizeof(struct wpa_bss *));
188                                 wpa_s->last_scan_res_used--;
189                                 break;
190                         }
191                 }
192         }
193         dl_list_del(&bss->list);
194         dl_list_del(&bss->list_id);
195         wpa_s->num_bss--;
196         wpa_dbg(wpa_s, MSG_DEBUG, "BSS: Remove id %u BSSID " MACSTR
197                 " SSID '%s' due to %s", bss->id, MAC2STR(bss->bssid),
198                 wpa_ssid_txt(bss->ssid, bss->ssid_len), reason);
199         wpas_notify_bss_removed(wpa_s, bss->bssid, bss->id);
200         wpa_bss_anqp_free(bss->anqp);
201         os_free(bss);
202 }
203
204
205 /**
206  * wpa_bss_get - Fetch a BSS table entry based on BSSID and SSID
207  * @wpa_s: Pointer to wpa_supplicant data
208  * @bssid: BSSID
209  * @ssid: SSID
210  * @ssid_len: Length of @ssid
211  * Returns: Pointer to the BSS entry or %NULL if not found
212  */
213 struct wpa_bss * wpa_bss_get(struct wpa_supplicant *wpa_s, const u8 *bssid,
214                              const u8 *ssid, size_t ssid_len)
215 {
216         struct wpa_bss *bss;
217         if (!wpa_supplicant_filter_bssid_match(wpa_s, bssid))
218                 return NULL;
219         dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
220                 if (os_memcmp(bss->bssid, bssid, ETH_ALEN) == 0 &&
221                     bss->ssid_len == ssid_len &&
222                     os_memcmp(bss->ssid, ssid, ssid_len) == 0)
223                         return bss;
224         }
225         return NULL;
226 }
227
228
229 static void calculate_update_time(const struct os_reltime *fetch_time,
230                                   unsigned int age_ms,
231                                   struct os_reltime *update_time)
232 {
233         os_time_t usec;
234
235         update_time->sec = fetch_time->sec;
236         update_time->usec = fetch_time->usec;
237         update_time->sec -= age_ms / 1000;
238         usec = (age_ms % 1000) * 1000;
239         if (update_time->usec < usec) {
240                 update_time->sec--;
241                 update_time->usec += 1000000;
242         }
243         update_time->usec -= usec;
244 }
245
246
247 static void wpa_bss_copy_res(struct wpa_bss *dst, struct wpa_scan_res *src,
248                              struct os_reltime *fetch_time)
249 {
250         dst->flags = src->flags;
251         os_memcpy(dst->bssid, src->bssid, ETH_ALEN);
252         dst->freq = src->freq;
253         dst->beacon_int = src->beacon_int;
254         dst->caps = src->caps;
255         dst->qual = src->qual;
256         dst->noise = src->noise;
257         dst->level = src->level;
258         dst->tsf = src->tsf;
259
260         calculate_update_time(fetch_time, src->age, &dst->last_update);
261 }
262
263
264 static int wpa_bss_known(struct wpa_supplicant *wpa_s, struct wpa_bss *bss)
265 {
266         struct wpa_ssid *ssid;
267
268         for (ssid = wpa_s->conf->ssid; ssid; ssid = ssid->next) {
269                 if (ssid->ssid == NULL || ssid->ssid_len == 0)
270                         continue;
271                 if (ssid->ssid_len == bss->ssid_len &&
272                     os_memcmp(ssid->ssid, bss->ssid, ssid->ssid_len) == 0)
273                         return 1;
274         }
275
276         return 0;
277 }
278
279
280 static int wpa_bss_in_use(struct wpa_supplicant *wpa_s, struct wpa_bss *bss)
281 {
282         return bss == wpa_s->current_bss ||
283                 os_memcmp(bss->bssid, wpa_s->bssid, ETH_ALEN) == 0 ||
284                 os_memcmp(bss->bssid, wpa_s->pending_bssid, ETH_ALEN) == 0;
285 }
286
287
288 static int wpa_bss_remove_oldest_unknown(struct wpa_supplicant *wpa_s)
289 {
290         struct wpa_bss *bss;
291
292         dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
293                 if (!wpa_bss_known(wpa_s, bss)) {
294                         wpa_bss_remove(wpa_s, bss, __func__);
295                         return 0;
296                 }
297         }
298
299         return -1;
300 }
301
302
303 static int wpa_bss_remove_oldest(struct wpa_supplicant *wpa_s)
304 {
305         struct wpa_bss *bss;
306
307         /*
308          * Remove the oldest entry that does not match with any configured
309          * network.
310          */
311         if (wpa_bss_remove_oldest_unknown(wpa_s) == 0)
312                 return 0;
313
314         /*
315          * Remove the oldest entry that isn't currently in use.
316          */
317         dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
318                 if (!wpa_bss_in_use(wpa_s, bss)) {
319                         wpa_bss_remove(wpa_s, bss, __func__);
320                         return 0;
321                 }
322         }
323
324         return -1;
325 }
326
327
328 static struct wpa_bss * wpa_bss_add(struct wpa_supplicant *wpa_s,
329                                     const u8 *ssid, size_t ssid_len,
330                                     struct wpa_scan_res *res,
331                                     struct os_reltime *fetch_time)
332 {
333         struct wpa_bss *bss;
334
335         bss = os_zalloc(sizeof(*bss) + res->ie_len + res->beacon_ie_len);
336         if (bss == NULL)
337                 return NULL;
338         bss->id = wpa_s->bss_next_id++;
339         bss->last_update_idx = wpa_s->bss_update_idx;
340         wpa_bss_copy_res(bss, res, fetch_time);
341         os_memcpy(bss->ssid, ssid, ssid_len);
342         bss->ssid_len = ssid_len;
343         bss->ie_len = res->ie_len;
344         bss->beacon_ie_len = res->beacon_ie_len;
345         os_memcpy(bss + 1, res + 1, res->ie_len + res->beacon_ie_len);
346         wpa_bss_set_hessid(bss);
347
348         if (wpa_s->num_bss + 1 > wpa_s->conf->bss_max_count &&
349             wpa_bss_remove_oldest(wpa_s) != 0) {
350                 wpa_printf(MSG_ERROR, "Increasing the MAX BSS count to %d "
351                            "because all BSSes are in use. We should normally "
352                            "not get here!", (int) wpa_s->num_bss + 1);
353                 wpa_s->conf->bss_max_count = wpa_s->num_bss + 1;
354         }
355
356         dl_list_add_tail(&wpa_s->bss, &bss->list);
357         dl_list_add_tail(&wpa_s->bss_id, &bss->list_id);
358         wpa_s->num_bss++;
359         wpa_dbg(wpa_s, MSG_DEBUG, "BSS: Add new id %u BSSID " MACSTR
360                 " SSID '%s'",
361                 bss->id, MAC2STR(bss->bssid), wpa_ssid_txt(ssid, ssid_len));
362         wpas_notify_bss_added(wpa_s, bss->bssid, bss->id);
363         return bss;
364 }
365
366
367 static int are_ies_equal(const struct wpa_bss *old,
368                          const struct wpa_scan_res *new, u32 ie)
369 {
370         const u8 *old_ie, *new_ie;
371         struct wpabuf *old_ie_buff = NULL;
372         struct wpabuf *new_ie_buff = NULL;
373         int new_ie_len, old_ie_len, ret, is_multi;
374
375         switch (ie) {
376         case WPA_IE_VENDOR_TYPE:
377                 old_ie = wpa_bss_get_vendor_ie(old, ie);
378                 new_ie = wpa_scan_get_vendor_ie(new, ie);
379                 is_multi = 0;
380                 break;
381         case WPS_IE_VENDOR_TYPE:
382                 old_ie_buff = wpa_bss_get_vendor_ie_multi(old, ie);
383                 new_ie_buff = wpa_scan_get_vendor_ie_multi(new, ie);
384                 is_multi = 1;
385                 break;
386         case WLAN_EID_RSN:
387         case WLAN_EID_SUPP_RATES:
388         case WLAN_EID_EXT_SUPP_RATES:
389                 old_ie = wpa_bss_get_ie(old, ie);
390                 new_ie = wpa_scan_get_ie(new, ie);
391                 is_multi = 0;
392                 break;
393         default:
394                 wpa_printf(MSG_DEBUG, "bss: %s: cannot compare IEs", __func__);
395                 return 0;
396         }
397
398         if (is_multi) {
399                 /* in case of multiple IEs stored in buffer */
400                 old_ie = old_ie_buff ? wpabuf_head_u8(old_ie_buff) : NULL;
401                 new_ie = new_ie_buff ? wpabuf_head_u8(new_ie_buff) : NULL;
402                 old_ie_len = old_ie_buff ? wpabuf_len(old_ie_buff) : 0;
403                 new_ie_len = new_ie_buff ? wpabuf_len(new_ie_buff) : 0;
404         } else {
405                 /* in case of single IE */
406                 old_ie_len = old_ie ? old_ie[1] + 2 : 0;
407                 new_ie_len = new_ie ? new_ie[1] + 2 : 0;
408         }
409
410         if (!old_ie || !new_ie)
411                 ret = !old_ie && !new_ie;
412         else
413                 ret = (old_ie_len == new_ie_len &&
414                        os_memcmp(old_ie, new_ie, old_ie_len) == 0);
415
416         wpabuf_free(old_ie_buff);
417         wpabuf_free(new_ie_buff);
418
419         return ret;
420 }
421
422
423 static u32 wpa_bss_compare_res(const struct wpa_bss *old,
424                                const struct wpa_scan_res *new)
425 {
426         u32 changes = 0;
427         int caps_diff = old->caps ^ new->caps;
428
429         if (old->freq != new->freq)
430                 changes |= WPA_BSS_FREQ_CHANGED_FLAG;
431
432         if (old->level != new->level)
433                 changes |= WPA_BSS_SIGNAL_CHANGED_FLAG;
434
435         if (caps_diff & IEEE80211_CAP_PRIVACY)
436                 changes |= WPA_BSS_PRIVACY_CHANGED_FLAG;
437
438         if (caps_diff & IEEE80211_CAP_IBSS)
439                 changes |= WPA_BSS_MODE_CHANGED_FLAG;
440
441         if (old->ie_len == new->ie_len &&
442             os_memcmp(old + 1, new + 1, old->ie_len) == 0)
443                 return changes;
444         changes |= WPA_BSS_IES_CHANGED_FLAG;
445
446         if (!are_ies_equal(old, new, WPA_IE_VENDOR_TYPE))
447                 changes |= WPA_BSS_WPAIE_CHANGED_FLAG;
448
449         if (!are_ies_equal(old, new, WLAN_EID_RSN))
450                 changes |= WPA_BSS_RSNIE_CHANGED_FLAG;
451
452         if (!are_ies_equal(old, new, WPS_IE_VENDOR_TYPE))
453                 changes |= WPA_BSS_WPS_CHANGED_FLAG;
454
455         if (!are_ies_equal(old, new, WLAN_EID_SUPP_RATES) ||
456             !are_ies_equal(old, new, WLAN_EID_EXT_SUPP_RATES))
457                 changes |= WPA_BSS_RATES_CHANGED_FLAG;
458
459         return changes;
460 }
461
462
463 static void notify_bss_changes(struct wpa_supplicant *wpa_s, u32 changes,
464                                const struct wpa_bss *bss)
465 {
466         if (changes & WPA_BSS_FREQ_CHANGED_FLAG)
467                 wpas_notify_bss_freq_changed(wpa_s, bss->id);
468
469         if (changes & WPA_BSS_SIGNAL_CHANGED_FLAG)
470                 wpas_notify_bss_signal_changed(wpa_s, bss->id);
471
472         if (changes & WPA_BSS_PRIVACY_CHANGED_FLAG)
473                 wpas_notify_bss_privacy_changed(wpa_s, bss->id);
474
475         if (changes & WPA_BSS_MODE_CHANGED_FLAG)
476                 wpas_notify_bss_mode_changed(wpa_s, bss->id);
477
478         if (changes & WPA_BSS_WPAIE_CHANGED_FLAG)
479                 wpas_notify_bss_wpaie_changed(wpa_s, bss->id);
480
481         if (changes & WPA_BSS_RSNIE_CHANGED_FLAG)
482                 wpas_notify_bss_rsnie_changed(wpa_s, bss->id);
483
484         if (changes & WPA_BSS_WPS_CHANGED_FLAG)
485                 wpas_notify_bss_wps_changed(wpa_s, bss->id);
486
487         if (changes & WPA_BSS_IES_CHANGED_FLAG)
488                 wpas_notify_bss_ies_changed(wpa_s, bss->id);
489
490         if (changes & WPA_BSS_RATES_CHANGED_FLAG)
491                 wpas_notify_bss_rates_changed(wpa_s, bss->id);
492
493         wpas_notify_bss_seen(wpa_s, bss->id);
494 }
495
496
497 static struct wpa_bss *
498 wpa_bss_update(struct wpa_supplicant *wpa_s, struct wpa_bss *bss,
499                struct wpa_scan_res *res, struct os_reltime *fetch_time)
500 {
501         u32 changes;
502
503         changes = wpa_bss_compare_res(bss, res);
504         bss->scan_miss_count = 0;
505         bss->last_update_idx = wpa_s->bss_update_idx;
506         wpa_bss_copy_res(bss, res, fetch_time);
507         /* Move the entry to the end of the list */
508         dl_list_del(&bss->list);
509 #ifdef CONFIG_P2P
510         if (wpa_bss_get_vendor_ie(bss, P2P_IE_VENDOR_TYPE) &&
511             !wpa_scan_get_vendor_ie(res, P2P_IE_VENDOR_TYPE)) {
512                 /*
513                  * This can happen when non-P2P station interface runs a scan
514                  * without P2P IE in the Probe Request frame. P2P GO would reply
515                  * to that with a Probe Response that does not include P2P IE.
516                  * Do not update the IEs in this BSS entry to avoid such loss of
517                  * information that may be needed for P2P operations to
518                  * determine group information.
519                  */
520                 wpa_dbg(wpa_s, MSG_DEBUG, "BSS: Do not update scan IEs for "
521                         MACSTR " since that would remove P2P IE information",
522                         MAC2STR(bss->bssid));
523         } else
524 #endif /* CONFIG_P2P */
525         if (bss->ie_len + bss->beacon_ie_len >=
526             res->ie_len + res->beacon_ie_len) {
527                 os_memcpy(bss + 1, res + 1, res->ie_len + res->beacon_ie_len);
528                 bss->ie_len = res->ie_len;
529                 bss->beacon_ie_len = res->beacon_ie_len;
530         } else {
531                 struct wpa_bss *nbss;
532                 struct dl_list *prev = bss->list_id.prev;
533                 dl_list_del(&bss->list_id);
534                 nbss = os_realloc(bss, sizeof(*bss) + res->ie_len +
535                                   res->beacon_ie_len);
536                 if (nbss) {
537                         unsigned int i;
538                         for (i = 0; i < wpa_s->last_scan_res_used; i++) {
539                                 if (wpa_s->last_scan_res[i] == bss) {
540                                         wpa_s->last_scan_res[i] = nbss;
541                                         break;
542                                 }
543                         }
544                         if (wpa_s->current_bss == bss)
545                                 wpa_s->current_bss = nbss;
546                         bss = nbss;
547                         os_memcpy(bss + 1, res + 1,
548                                   res->ie_len + res->beacon_ie_len);
549                         bss->ie_len = res->ie_len;
550                         bss->beacon_ie_len = res->beacon_ie_len;
551                 }
552                 dl_list_add(prev, &bss->list_id);
553         }
554         if (changes & WPA_BSS_IES_CHANGED_FLAG)
555                 wpa_bss_set_hessid(bss);
556         dl_list_add_tail(&wpa_s->bss, &bss->list);
557
558         notify_bss_changes(wpa_s, changes, bss);
559
560         return bss;
561 }
562
563
564 /**
565  * wpa_bss_update_start - Start a BSS table update from scan results
566  * @wpa_s: Pointer to wpa_supplicant data
567  *
568  * This function is called at the start of each BSS table update round for new
569  * scan results. The actual scan result entries are indicated with calls to
570  * wpa_bss_update_scan_res() and the update round is finished with a call to
571  * wpa_bss_update_end().
572  */
573 void wpa_bss_update_start(struct wpa_supplicant *wpa_s)
574 {
575         wpa_s->bss_update_idx++;
576         wpa_dbg(wpa_s, MSG_DEBUG, "BSS: Start scan result update %u",
577                 wpa_s->bss_update_idx);
578         wpa_s->last_scan_res_used = 0;
579 }
580
581
582 /**
583  * wpa_bss_update_scan_res - Update a BSS table entry based on a scan result
584  * @wpa_s: Pointer to wpa_supplicant data
585  * @res: Scan result
586  * @fetch_time: Time when the result was fetched from the driver
587  *
588  * This function updates a BSS table entry (or adds one) based on a scan result.
589  * This is called separately for each scan result between the calls to
590  * wpa_bss_update_start() and wpa_bss_update_end().
591  */
592 void wpa_bss_update_scan_res(struct wpa_supplicant *wpa_s,
593                              struct wpa_scan_res *res,
594                              struct os_reltime *fetch_time)
595 {
596         const u8 *ssid, *p2p;
597         struct wpa_bss *bss;
598
599         if (wpa_s->conf->ignore_old_scan_res) {
600                 struct os_reltime update;
601                 calculate_update_time(fetch_time, res->age, &update);
602                 if (os_reltime_before(&update, &wpa_s->scan_trigger_time)) {
603                         struct os_reltime age;
604                         os_reltime_sub(&wpa_s->scan_trigger_time, &update,
605                                        &age);
606                         wpa_dbg(wpa_s, MSG_DEBUG, "BSS: Ignore driver BSS "
607                                 "table entry that is %u.%06u seconds older "
608                                 "than our scan trigger",
609                                 (unsigned int) age.sec,
610                                 (unsigned int) age.usec);
611                         return;
612                 }
613         }
614
615         ssid = wpa_scan_get_ie(res, WLAN_EID_SSID);
616         if (ssid == NULL) {
617                 wpa_dbg(wpa_s, MSG_DEBUG, "BSS: No SSID IE included for "
618                         MACSTR, MAC2STR(res->bssid));
619                 return;
620         }
621         if (ssid[1] > 32) {
622                 wpa_dbg(wpa_s, MSG_DEBUG, "BSS: Too long SSID IE included for "
623                         MACSTR, MAC2STR(res->bssid));
624                 return;
625         }
626
627         p2p = wpa_scan_get_vendor_ie(res, P2P_IE_VENDOR_TYPE);
628 #ifdef CONFIG_P2P
629         if (p2p == NULL &&
630             wpa_s->p2p_group_interface != NOT_P2P_GROUP_INTERFACE) {
631                 /*
632                  * If it's a P2P specific interface, then don't update
633                  * the scan result without a P2P IE.
634                  */
635                 wpa_printf(MSG_DEBUG, "BSS: No P2P IE - skipping BSS " MACSTR
636                            " update for P2P interface", MAC2STR(res->bssid));
637                 return;
638         }
639 #endif /* CONFIG_P2P */
640         if (p2p && ssid[1] == P2P_WILDCARD_SSID_LEN &&
641             os_memcmp(ssid + 2, P2P_WILDCARD_SSID, P2P_WILDCARD_SSID_LEN) == 0)
642                 return; /* Skip P2P listen discovery results here */
643
644         /* TODO: add option for ignoring BSSes we are not interested in
645          * (to save memory) */
646         bss = wpa_bss_get(wpa_s, res->bssid, ssid + 2, ssid[1]);
647         if (bss == NULL)
648                 bss = wpa_bss_add(wpa_s, ssid + 2, ssid[1], res, fetch_time);
649         else {
650                 bss = wpa_bss_update(wpa_s, bss, res, fetch_time);
651                 if (wpa_s->last_scan_res) {
652                         unsigned int i;
653                         for (i = 0; i < wpa_s->last_scan_res_used; i++) {
654                                 if (bss == wpa_s->last_scan_res[i]) {
655                                         /* Already in the list */
656                                         return;
657                                 }
658                         }
659                 }
660         }
661
662         if (bss == NULL)
663                 return;
664         if (wpa_s->last_scan_res_used >= wpa_s->last_scan_res_size) {
665                 struct wpa_bss **n;
666                 unsigned int siz;
667                 if (wpa_s->last_scan_res_size == 0)
668                         siz = 32;
669                 else
670                         siz = wpa_s->last_scan_res_size * 2;
671                 n = os_realloc_array(wpa_s->last_scan_res, siz,
672                                      sizeof(struct wpa_bss *));
673                 if (n == NULL)
674                         return;
675                 wpa_s->last_scan_res = n;
676                 wpa_s->last_scan_res_size = siz;
677         }
678
679         if (wpa_s->last_scan_res)
680                 wpa_s->last_scan_res[wpa_s->last_scan_res_used++] = bss;
681 }
682
683
684 static int wpa_bss_included_in_scan(const struct wpa_bss *bss,
685                                     const struct scan_info *info)
686 {
687         int found;
688         size_t i;
689
690         if (info == NULL)
691                 return 1;
692
693         if (info->num_freqs) {
694                 found = 0;
695                 for (i = 0; i < info->num_freqs; i++) {
696                         if (bss->freq == info->freqs[i]) {
697                                 found = 1;
698                                 break;
699                         }
700                 }
701                 if (!found)
702                         return 0;
703         }
704
705         if (info->num_ssids) {
706                 found = 0;
707                 for (i = 0; i < info->num_ssids; i++) {
708                         const struct wpa_driver_scan_ssid *s = &info->ssids[i];
709                         if ((s->ssid == NULL || s->ssid_len == 0) ||
710                             (s->ssid_len == bss->ssid_len &&
711                              os_memcmp(s->ssid, bss->ssid, bss->ssid_len) ==
712                              0)) {
713                                 found = 1;
714                                 break;
715                         }
716                 }
717                 if (!found)
718                         return 0;
719         }
720
721         return 1;
722 }
723
724
725 /**
726  * wpa_bss_update_end - End a BSS table update from scan results
727  * @wpa_s: Pointer to wpa_supplicant data
728  * @info: Information about scan parameters
729  * @new_scan: Whether this update round was based on a new scan
730  *
731  * This function is called at the end of each BSS table update round for new
732  * scan results. The start of the update was indicated with a call to
733  * wpa_bss_update_start().
734  */
735 void wpa_bss_update_end(struct wpa_supplicant *wpa_s, struct scan_info *info,
736                         int new_scan)
737 {
738         struct wpa_bss *bss, *n;
739
740         os_get_reltime(&wpa_s->last_scan);
741         if (!new_scan)
742                 return; /* do not expire entries without new scan */
743
744         dl_list_for_each_safe(bss, n, &wpa_s->bss, struct wpa_bss, list) {
745                 if (wpa_bss_in_use(wpa_s, bss))
746                         continue;
747                 if (!wpa_bss_included_in_scan(bss, info))
748                         continue; /* expire only BSSes that were scanned */
749                 if (bss->last_update_idx < wpa_s->bss_update_idx)
750                         bss->scan_miss_count++;
751                 if (bss->scan_miss_count >=
752                     wpa_s->conf->bss_expiration_scan_count) {
753                         wpa_bss_remove(wpa_s, bss, "no match in scan");
754                 }
755         }
756
757         wpa_printf(MSG_DEBUG, "BSS: last_scan_res_used=%u/%u",
758                    wpa_s->last_scan_res_used, wpa_s->last_scan_res_size);
759 }
760
761
762 /**
763  * wpa_bss_flush_by_age - Flush old BSS entries
764  * @wpa_s: Pointer to wpa_supplicant data
765  * @age: Maximum entry age in seconds
766  *
767  * Remove BSS entries that have not been updated during the last @age seconds.
768  */
769 void wpa_bss_flush_by_age(struct wpa_supplicant *wpa_s, int age)
770 {
771         struct wpa_bss *bss, *n;
772         struct os_reltime t;
773
774         if (dl_list_empty(&wpa_s->bss))
775                 return;
776
777         os_get_reltime(&t);
778         t.sec -= age;
779
780         dl_list_for_each_safe(bss, n, &wpa_s->bss, struct wpa_bss, list) {
781                 if (wpa_bss_in_use(wpa_s, bss))
782                         continue;
783
784                 if (os_reltime_before(&bss->last_update, &t)) {
785                         wpa_bss_remove(wpa_s, bss, __func__);
786                 } else
787                         break;
788         }
789 }
790
791
792 static void wpa_bss_timeout(void *eloop_ctx, void *timeout_ctx)
793 {
794         struct wpa_supplicant *wpa_s = eloop_ctx;
795
796         wpa_bss_flush_by_age(wpa_s, wpa_s->conf->bss_expiration_age);
797         eloop_register_timeout(WPA_BSS_EXPIRATION_PERIOD, 0,
798                                wpa_bss_timeout, wpa_s, NULL);
799 }
800
801
802 /**
803  * wpa_bss_init - Initialize BSS table
804  * @wpa_s: Pointer to wpa_supplicant data
805  * Returns: 0 on success, -1 on failure
806  *
807  * This prepares BSS table lists and timer for periodic updates. The BSS table
808  * is deinitialized with wpa_bss_deinit() once not needed anymore.
809  */
810 int wpa_bss_init(struct wpa_supplicant *wpa_s)
811 {
812         dl_list_init(&wpa_s->bss);
813         dl_list_init(&wpa_s->bss_id);
814         eloop_register_timeout(WPA_BSS_EXPIRATION_PERIOD, 0,
815                                wpa_bss_timeout, wpa_s, NULL);
816         return 0;
817 }
818
819
820 /**
821  * wpa_bss_flush - Flush all unused BSS entries
822  * @wpa_s: Pointer to wpa_supplicant data
823  */
824 void wpa_bss_flush(struct wpa_supplicant *wpa_s)
825 {
826         struct wpa_bss *bss, *n;
827
828         wpa_s->clear_driver_scan_cache = 1;
829
830         if (wpa_s->bss.next == NULL)
831                 return; /* BSS table not yet initialized */
832
833         dl_list_for_each_safe(bss, n, &wpa_s->bss, struct wpa_bss, list) {
834                 if (wpa_bss_in_use(wpa_s, bss))
835                         continue;
836                 wpa_bss_remove(wpa_s, bss, __func__);
837         }
838 }
839
840
841 /**
842  * wpa_bss_deinit - Deinitialize BSS table
843  * @wpa_s: Pointer to wpa_supplicant data
844  */
845 void wpa_bss_deinit(struct wpa_supplicant *wpa_s)
846 {
847         eloop_cancel_timeout(wpa_bss_timeout, wpa_s, NULL);
848         wpa_bss_flush(wpa_s);
849 }
850
851
852 /**
853  * wpa_bss_get_bssid - Fetch a BSS table entry based on BSSID
854  * @wpa_s: Pointer to wpa_supplicant data
855  * @bssid: BSSID
856  * Returns: Pointer to the BSS entry or %NULL if not found
857  */
858 struct wpa_bss * wpa_bss_get_bssid(struct wpa_supplicant *wpa_s,
859                                    const u8 *bssid)
860 {
861         struct wpa_bss *bss;
862         if (!wpa_supplicant_filter_bssid_match(wpa_s, bssid))
863                 return NULL;
864         dl_list_for_each_reverse(bss, &wpa_s->bss, struct wpa_bss, list) {
865                 if (os_memcmp(bss->bssid, bssid, ETH_ALEN) == 0)
866                         return bss;
867         }
868         return NULL;
869 }
870
871
872 /**
873  * wpa_bss_get_bssid_latest - Fetch the latest BSS table entry based on BSSID
874  * @wpa_s: Pointer to wpa_supplicant data
875  * @bssid: BSSID
876  * Returns: Pointer to the BSS entry or %NULL if not found
877  *
878  * This function is like wpa_bss_get_bssid(), but full BSS table is iterated to
879  * find the entry that has the most recent update. This can help in finding the
880  * correct entry in cases where the SSID of the AP may have changed recently
881  * (e.g., in WPS reconfiguration cases).
882  */
883 struct wpa_bss * wpa_bss_get_bssid_latest(struct wpa_supplicant *wpa_s,
884                                           const u8 *bssid)
885 {
886         struct wpa_bss *bss, *found = NULL;
887         if (!wpa_supplicant_filter_bssid_match(wpa_s, bssid))
888                 return NULL;
889         dl_list_for_each_reverse(bss, &wpa_s->bss, struct wpa_bss, list) {
890                 if (os_memcmp(bss->bssid, bssid, ETH_ALEN) != 0)
891                         continue;
892                 if (found == NULL ||
893                     os_reltime_before(&found->last_update, &bss->last_update))
894                         found = bss;
895         }
896         return found;
897 }
898
899
900 #ifdef CONFIG_P2P
901 /**
902  * wpa_bss_get_p2p_dev_addr - Fetch a BSS table entry based on P2P Device Addr
903  * @wpa_s: Pointer to wpa_supplicant data
904  * @dev_addr: P2P Device Address of the GO
905  * Returns: Pointer to the BSS entry or %NULL if not found
906  */
907 struct wpa_bss * wpa_bss_get_p2p_dev_addr(struct wpa_supplicant *wpa_s,
908                                           const u8 *dev_addr)
909 {
910         struct wpa_bss *bss;
911         dl_list_for_each_reverse(bss, &wpa_s->bss, struct wpa_bss, list) {
912                 u8 addr[ETH_ALEN];
913                 if (p2p_parse_dev_addr((const u8 *) (bss + 1), bss->ie_len,
914                                        addr) == 0 &&
915                     os_memcmp(addr, dev_addr, ETH_ALEN) == 0)
916                         return bss;
917         }
918         return NULL;
919 }
920 #endif /* CONFIG_P2P */
921
922
923 /**
924  * wpa_bss_get_id - Fetch a BSS table entry based on identifier
925  * @wpa_s: Pointer to wpa_supplicant data
926  * @id: Unique identifier (struct wpa_bss::id) assigned for the entry
927  * Returns: Pointer to the BSS entry or %NULL if not found
928  */
929 struct wpa_bss * wpa_bss_get_id(struct wpa_supplicant *wpa_s, unsigned int id)
930 {
931         struct wpa_bss *bss;
932         dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
933                 if (bss->id == id)
934                         return bss;
935         }
936         return NULL;
937 }
938
939
940 /**
941  * wpa_bss_get_id_range - Fetch a BSS table entry based on identifier range
942  * @wpa_s: Pointer to wpa_supplicant data
943  * @idf: Smallest allowed identifier assigned for the entry
944  * @idf: Largest allowed identifier assigned for the entry
945  * Returns: Pointer to the BSS entry or %NULL if not found
946  *
947  * This function is similar to wpa_bss_get_id() but allows a BSS entry with the
948  * smallest id value to be fetched within the specified range without the
949  * caller having to know the exact id.
950  */
951 struct wpa_bss * wpa_bss_get_id_range(struct wpa_supplicant *wpa_s,
952                                       unsigned int idf, unsigned int idl)
953 {
954         struct wpa_bss *bss;
955         dl_list_for_each(bss, &wpa_s->bss_id, struct wpa_bss, list_id) {
956                 if (bss->id >= idf && bss->id <= idl)
957                         return bss;
958         }
959         return NULL;
960 }
961
962
963 /**
964  * wpa_bss_get_ie - Fetch a specified information element from a BSS entry
965  * @bss: BSS table entry
966  * @ie: Information element identitifier (WLAN_EID_*)
967  * Returns: Pointer to the information element (id field) or %NULL if not found
968  *
969  * This function returns the first matching information element in the BSS
970  * entry.
971  */
972 const u8 * wpa_bss_get_ie(const struct wpa_bss *bss, u8 ie)
973 {
974         const u8 *end, *pos;
975
976         pos = (const u8 *) (bss + 1);
977         end = pos + bss->ie_len;
978
979         while (pos + 1 < end) {
980                 if (pos + 2 + pos[1] > end)
981                         break;
982                 if (pos[0] == ie)
983                         return pos;
984                 pos += 2 + pos[1];
985         }
986
987         return NULL;
988 }
989
990
991 /**
992  * wpa_bss_get_vendor_ie - Fetch a vendor information element from a BSS entry
993  * @bss: BSS table entry
994  * @vendor_type: Vendor type (four octets starting the IE payload)
995  * Returns: Pointer to the information element (id field) or %NULL if not found
996  *
997  * This function returns the first matching information element in the BSS
998  * entry.
999  */
1000 const u8 * wpa_bss_get_vendor_ie(const struct wpa_bss *bss, u32 vendor_type)
1001 {
1002         const u8 *end, *pos;
1003
1004         pos = (const u8 *) (bss + 1);
1005         end = pos + bss->ie_len;
1006
1007         while (pos + 1 < end) {
1008                 if (pos + 2 + pos[1] > end)
1009                         break;
1010                 if (pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
1011                     vendor_type == WPA_GET_BE32(&pos[2]))
1012                         return pos;
1013                 pos += 2 + pos[1];
1014         }
1015
1016         return NULL;
1017 }
1018
1019
1020 /**
1021  * wpa_bss_get_vendor_ie_beacon - Fetch a vendor information from a BSS entry
1022  * @bss: BSS table entry
1023  * @vendor_type: Vendor type (four octets starting the IE payload)
1024  * Returns: Pointer to the information element (id field) or %NULL if not found
1025  *
1026  * This function returns the first matching information element in the BSS
1027  * entry.
1028  *
1029  * This function is like wpa_bss_get_vendor_ie(), but uses IE buffer only
1030  * from Beacon frames instead of either Beacon or Probe Response frames.
1031  */
1032 const u8 * wpa_bss_get_vendor_ie_beacon(const struct wpa_bss *bss,
1033                                         u32 vendor_type)
1034 {
1035         const u8 *end, *pos;
1036
1037         if (bss->beacon_ie_len == 0)
1038                 return NULL;
1039
1040         pos = (const u8 *) (bss + 1);
1041         pos += bss->ie_len;
1042         end = pos + bss->beacon_ie_len;
1043
1044         while (pos + 1 < end) {
1045                 if (pos + 2 + pos[1] > end)
1046                         break;
1047                 if (pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
1048                     vendor_type == WPA_GET_BE32(&pos[2]))
1049                         return pos;
1050                 pos += 2 + pos[1];
1051         }
1052
1053         return NULL;
1054 }
1055
1056
1057 /**
1058  * wpa_bss_get_vendor_ie_multi - Fetch vendor IE data from a BSS entry
1059  * @bss: BSS table entry
1060  * @vendor_type: Vendor type (four octets starting the IE payload)
1061  * Returns: Pointer to the information element payload or %NULL if not found
1062  *
1063  * This function returns concatenated payload of possibly fragmented vendor
1064  * specific information elements in the BSS entry. The caller is responsible for
1065  * freeing the returned buffer.
1066  */
1067 struct wpabuf * wpa_bss_get_vendor_ie_multi(const struct wpa_bss *bss,
1068                                             u32 vendor_type)
1069 {
1070         struct wpabuf *buf;
1071         const u8 *end, *pos;
1072
1073         buf = wpabuf_alloc(bss->ie_len);
1074         if (buf == NULL)
1075                 return NULL;
1076
1077         pos = (const u8 *) (bss + 1);
1078         end = pos + bss->ie_len;
1079
1080         while (pos + 1 < end) {
1081                 if (pos + 2 + pos[1] > end)
1082                         break;
1083                 if (pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
1084                     vendor_type == WPA_GET_BE32(&pos[2]))
1085                         wpabuf_put_data(buf, pos + 2 + 4, pos[1] - 4);
1086                 pos += 2 + pos[1];
1087         }
1088
1089         if (wpabuf_len(buf) == 0) {
1090                 wpabuf_free(buf);
1091                 buf = NULL;
1092         }
1093
1094         return buf;
1095 }
1096
1097
1098 /**
1099  * wpa_bss_get_vendor_ie_multi_beacon - Fetch vendor IE data from a BSS entry
1100  * @bss: BSS table entry
1101  * @vendor_type: Vendor type (four octets starting the IE payload)
1102  * Returns: Pointer to the information element payload or %NULL if not found
1103  *
1104  * This function returns concatenated payload of possibly fragmented vendor
1105  * specific information elements in the BSS entry. The caller is responsible for
1106  * freeing the returned buffer.
1107  *
1108  * This function is like wpa_bss_get_vendor_ie_multi(), but uses IE buffer only
1109  * from Beacon frames instead of either Beacon or Probe Response frames.
1110  */
1111 struct wpabuf * wpa_bss_get_vendor_ie_multi_beacon(const struct wpa_bss *bss,
1112                                                    u32 vendor_type)
1113 {
1114         struct wpabuf *buf;
1115         const u8 *end, *pos;
1116
1117         buf = wpabuf_alloc(bss->beacon_ie_len);
1118         if (buf == NULL)
1119                 return NULL;
1120
1121         pos = (const u8 *) (bss + 1);
1122         pos += bss->ie_len;
1123         end = pos + bss->beacon_ie_len;
1124
1125         while (pos + 1 < end) {
1126                 if (pos + 2 + pos[1] > end)
1127                         break;
1128                 if (pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
1129                     vendor_type == WPA_GET_BE32(&pos[2]))
1130                         wpabuf_put_data(buf, pos + 2 + 4, pos[1] - 4);
1131                 pos += 2 + pos[1];
1132         }
1133
1134         if (wpabuf_len(buf) == 0) {
1135                 wpabuf_free(buf);
1136                 buf = NULL;
1137         }
1138
1139         return buf;
1140 }
1141
1142
1143 /**
1144  * wpa_bss_get_max_rate - Get maximum legacy TX rate supported in a BSS
1145  * @bss: BSS table entry
1146  * Returns: Maximum legacy rate in units of 500 kbps
1147  */
1148 int wpa_bss_get_max_rate(const struct wpa_bss *bss)
1149 {
1150         int rate = 0;
1151         const u8 *ie;
1152         int i;
1153
1154         ie = wpa_bss_get_ie(bss, WLAN_EID_SUPP_RATES);
1155         for (i = 0; ie && i < ie[1]; i++) {
1156                 if ((ie[i + 2] & 0x7f) > rate)
1157                         rate = ie[i + 2] & 0x7f;
1158         }
1159
1160         ie = wpa_bss_get_ie(bss, WLAN_EID_EXT_SUPP_RATES);
1161         for (i = 0; ie && i < ie[1]; i++) {
1162                 if ((ie[i + 2] & 0x7f) > rate)
1163                         rate = ie[i + 2] & 0x7f;
1164         }
1165
1166         return rate;
1167 }
1168
1169
1170 /**
1171  * wpa_bss_get_bit_rates - Get legacy TX rates supported in a BSS
1172  * @bss: BSS table entry
1173  * @rates: Buffer for returning a pointer to the rates list (units of 500 kbps)
1174  * Returns: number of legacy TX rates or -1 on failure
1175  *
1176  * The caller is responsible for freeing the returned buffer with os_free() in
1177  * case of success.
1178  */
1179 int wpa_bss_get_bit_rates(const struct wpa_bss *bss, u8 **rates)
1180 {
1181         const u8 *ie, *ie2;
1182         int i, j;
1183         unsigned int len;
1184         u8 *r;
1185
1186         ie = wpa_bss_get_ie(bss, WLAN_EID_SUPP_RATES);
1187         ie2 = wpa_bss_get_ie(bss, WLAN_EID_EXT_SUPP_RATES);
1188
1189         len = (ie ? ie[1] : 0) + (ie2 ? ie2[1] : 0);
1190
1191         r = os_malloc(len);
1192         if (!r)
1193                 return -1;
1194
1195         for (i = 0; ie && i < ie[1]; i++)
1196                 r[i] = ie[i + 2] & 0x7f;
1197
1198         for (j = 0; ie2 && j < ie2[1]; j++)
1199                 r[i + j] = ie2[j + 2] & 0x7f;
1200
1201         *rates = r;
1202         return len;
1203 }