scan.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888
  1. /*
  2. * WPA Supplicant - Scanning
  3. * Copyright (c) 2003-2010, Jouni Malinen <j@w1.fi>
  4. *
  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.
  8. *
  9. * Alternatively, this software may be distributed under the terms of BSD
  10. * license.
  11. *
  12. * See README and COPYING for more details.
  13. */
  14. #include "utils/includes.h"
  15. #include "utils/common.h"
  16. #include "utils/eloop.h"
  17. #include "common/ieee802_11_defs.h"
  18. #include "config.h"
  19. #include "wpa_supplicant_i.h"
  20. #include "driver_i.h"
  21. #include "mlme.h"
  22. #include "wps_supplicant.h"
  23. #include "p2p_supplicant.h"
  24. #include "p2p/p2p.h"
  25. #include "notify.h"
  26. #include "bss.h"
  27. #include "scan.h"
  28. static void wpa_supplicant_gen_assoc_event(struct wpa_supplicant *wpa_s)
  29. {
  30. struct wpa_ssid *ssid;
  31. union wpa_event_data data;
  32. ssid = wpa_supplicant_get_ssid(wpa_s);
  33. if (ssid == NULL)
  34. return;
  35. if (wpa_s->current_ssid == NULL) {
  36. wpa_s->current_ssid = ssid;
  37. if (wpa_s->current_ssid != NULL)
  38. wpas_notify_network_changed(wpa_s);
  39. }
  40. wpa_supplicant_initiate_eapol(wpa_s);
  41. wpa_dbg(wpa_s, MSG_DEBUG, "Already associated with a configured "
  42. "network - generating associated event");
  43. os_memset(&data, 0, sizeof(data));
  44. wpa_supplicant_event(wpa_s, EVENT_ASSOC, &data);
  45. }
  46. #ifdef CONFIG_WPS
  47. static int wpas_wps_in_use(struct wpa_supplicant *wpa_s,
  48. enum wps_request_type *req_type)
  49. {
  50. struct wpa_ssid *ssid;
  51. int wps = 0;
  52. for (ssid = wpa_s->conf->ssid; ssid; ssid = ssid->next) {
  53. if (!(ssid->key_mgmt & WPA_KEY_MGMT_WPS))
  54. continue;
  55. wps = 1;
  56. *req_type = wpas_wps_get_req_type(ssid);
  57. if (!ssid->eap.phase1)
  58. continue;
  59. if (os_strstr(ssid->eap.phase1, "pbc=1"))
  60. return 2;
  61. }
  62. #ifdef CONFIG_P2P
  63. wpa_s->wps->dev.p2p = 1;
  64. if (!wps) {
  65. wps = 1;
  66. *req_type = WPS_REQ_ENROLLEE_INFO;
  67. }
  68. #endif /* CONFIG_P2P */
  69. return wps;
  70. }
  71. #endif /* CONFIG_WPS */
  72. int wpa_supplicant_enabled_networks(struct wpa_config *conf)
  73. {
  74. struct wpa_ssid *ssid = conf->ssid;
  75. int count = 0;
  76. while (ssid) {
  77. if (!ssid->disabled)
  78. count++;
  79. ssid = ssid->next;
  80. }
  81. return count;
  82. }
  83. static void wpa_supplicant_assoc_try(struct wpa_supplicant *wpa_s,
  84. struct wpa_ssid *ssid)
  85. {
  86. while (ssid) {
  87. if (!ssid->disabled)
  88. break;
  89. ssid = ssid->next;
  90. }
  91. /* ap_scan=2 mode - try to associate with each SSID. */
  92. if (ssid == NULL) {
  93. wpa_dbg(wpa_s, MSG_DEBUG, "wpa_supplicant_assoc_try: Reached "
  94. "end of scan list - go back to beginning");
  95. wpa_s->prev_scan_ssid = WILDCARD_SSID_SCAN;
  96. wpa_supplicant_req_scan(wpa_s, 0, 0);
  97. return;
  98. }
  99. if (ssid->next) {
  100. /* Continue from the next SSID on the next attempt. */
  101. wpa_s->prev_scan_ssid = ssid;
  102. } else {
  103. /* Start from the beginning of the SSID list. */
  104. wpa_s->prev_scan_ssid = WILDCARD_SSID_SCAN;
  105. }
  106. wpa_supplicant_associate(wpa_s, NULL, ssid);
  107. }
  108. static int int_array_len(const int *a)
  109. {
  110. int i;
  111. for (i = 0; a && a[i]; i++)
  112. ;
  113. return i;
  114. }
  115. static void int_array_concat(int **res, const int *a)
  116. {
  117. int reslen, alen, i;
  118. int *n;
  119. reslen = int_array_len(*res);
  120. alen = int_array_len(a);
  121. n = os_realloc(*res, (reslen + alen + 1) * sizeof(int));
  122. if (n == NULL) {
  123. os_free(*res);
  124. *res = NULL;
  125. return;
  126. }
  127. for (i = 0; i <= alen; i++)
  128. n[reslen + i] = a[i];
  129. *res = n;
  130. }
  131. static int freq_cmp(const void *a, const void *b)
  132. {
  133. int _a = *(int *) a;
  134. int _b = *(int *) b;
  135. if (_a == 0)
  136. return 1;
  137. if (_b == 0)
  138. return -1;
  139. return _a - _b;
  140. }
  141. static void int_array_sort_unique(int *a)
  142. {
  143. int alen;
  144. int i, j;
  145. if (a == NULL)
  146. return;
  147. alen = int_array_len(a);
  148. qsort(a, alen, sizeof(int), freq_cmp);
  149. i = 0;
  150. j = 1;
  151. while (a[i] && a[j]) {
  152. if (a[i] == a[j]) {
  153. j++;
  154. continue;
  155. }
  156. a[++i] = a[j++];
  157. }
  158. if (a[i])
  159. i++;
  160. a[i] = 0;
  161. }
  162. int wpa_supplicant_trigger_scan(struct wpa_supplicant *wpa_s,
  163. struct wpa_driver_scan_params *params)
  164. {
  165. int ret;
  166. wpa_supplicant_notify_scanning(wpa_s, 1);
  167. if (wpa_s->drv_flags & WPA_DRIVER_FLAGS_USER_SPACE_MLME)
  168. ret = ieee80211_sta_req_scan(wpa_s, params);
  169. else
  170. ret = wpa_drv_scan(wpa_s, params);
  171. if (ret) {
  172. wpa_supplicant_notify_scanning(wpa_s, 0);
  173. wpas_notify_scan_done(wpa_s, 0);
  174. } else
  175. wpa_s->scan_runs++;
  176. return ret;
  177. }
  178. static struct wpa_driver_scan_filter *
  179. wpa_supplicant_build_filter_ssids(struct wpa_config *conf, size_t *num_ssids)
  180. {
  181. struct wpa_driver_scan_filter *ssids;
  182. struct wpa_ssid *ssid;
  183. size_t count;
  184. *num_ssids = 0;
  185. if (!conf->filter_ssids)
  186. return NULL;
  187. for (count = 0, ssid = conf->ssid; ssid; ssid = ssid->next) {
  188. if (ssid->ssid && ssid->ssid_len)
  189. count++;
  190. }
  191. if (count == 0)
  192. return NULL;
  193. ssids = os_zalloc(count * sizeof(struct wpa_driver_scan_filter));
  194. if (ssids == NULL)
  195. return NULL;
  196. for (ssid = conf->ssid; ssid; ssid = ssid->next) {
  197. if (!ssid->ssid || !ssid->ssid_len)
  198. continue;
  199. os_memcpy(ssids[*num_ssids].ssid, ssid->ssid, ssid->ssid_len);
  200. ssids[*num_ssids].ssid_len = ssid->ssid_len;
  201. (*num_ssids)++;
  202. }
  203. return ssids;
  204. }
  205. static void wpa_supplicant_optimize_freqs(
  206. struct wpa_supplicant *wpa_s, struct wpa_driver_scan_params *params)
  207. {
  208. #ifdef CONFIG_P2P
  209. if (params->freqs == NULL && wpa_s->p2p_in_provisioning &&
  210. wpa_s->go_params) {
  211. /* Optimize provisioning state scan based on GO information */
  212. if (wpa_s->p2p_in_provisioning < 5 &&
  213. wpa_s->go_params->freq > 0) {
  214. wpa_dbg(wpa_s, MSG_DEBUG, "P2P: Scan only GO "
  215. "preferred frequency %d MHz",
  216. wpa_s->go_params->freq);
  217. params->freqs = os_zalloc(2 * sizeof(int));
  218. if (params->freqs)
  219. params->freqs[0] = wpa_s->go_params->freq;
  220. } else if (wpa_s->p2p_in_provisioning < 8 &&
  221. wpa_s->go_params->freq_list[0]) {
  222. wpa_dbg(wpa_s, MSG_DEBUG, "P2P: Scan only common "
  223. "channels");
  224. int_array_concat(&params->freqs,
  225. wpa_s->go_params->freq_list);
  226. if (params->freqs)
  227. int_array_sort_unique(params->freqs);
  228. }
  229. wpa_s->p2p_in_provisioning++;
  230. }
  231. #endif /* CONFIG_P2P */
  232. #ifdef CONFIG_WPS
  233. if (params->freqs == NULL && wpa_s->after_wps && wpa_s->wps_freq) {
  234. /*
  235. * Optimize post-provisioning scan based on channel used
  236. * during provisioning.
  237. */
  238. wpa_dbg(wpa_s, MSG_DEBUG, "WPS: Scan only frequency %u MHz "
  239. "that was used during provisioning", wpa_s->wps_freq);
  240. params->freqs = os_zalloc(2 * sizeof(int));
  241. if (params->freqs)
  242. params->freqs[0] = wpa_s->wps_freq;
  243. wpa_s->after_wps--;
  244. }
  245. #endif /* CONFIG_WPS */
  246. }
  247. static struct wpabuf *
  248. wpa_supplicant_extra_ies(struct wpa_supplicant *wpa_s,
  249. struct wpa_driver_scan_params *params)
  250. {
  251. struct wpabuf *wps_ie = NULL;
  252. #ifdef CONFIG_WPS
  253. int wps = 0;
  254. enum wps_request_type req_type = WPS_REQ_ENROLLEE_INFO;
  255. wps = wpas_wps_in_use(wpa_s, &req_type);
  256. if (wps) {
  257. wps_ie = wps_build_probe_req_ie(wps == 2, &wpa_s->wps->dev,
  258. wpa_s->wps->uuid, req_type,
  259. 0, NULL);
  260. if (wps_ie) {
  261. params->extra_ies = wpabuf_head(wps_ie);
  262. params->extra_ies_len = wpabuf_len(wps_ie);
  263. }
  264. }
  265. #ifdef CONFIG_P2P
  266. if (wps_ie) {
  267. size_t ielen = p2p_scan_ie_buf_len(wpa_s->global->p2p);
  268. if (wpabuf_resize(&wps_ie, ielen) == 0) {
  269. wpas_p2p_scan_ie(wpa_s, wps_ie);
  270. params->extra_ies = wpabuf_head(wps_ie);
  271. params->extra_ies_len = wpabuf_len(wps_ie);
  272. }
  273. }
  274. #endif /* CONFIG_P2P */
  275. #endif /* CONFIG_WPS */
  276. return wps_ie;
  277. }
  278. static void wpa_supplicant_scan(void *eloop_ctx, void *timeout_ctx)
  279. {
  280. struct wpa_supplicant *wpa_s = eloop_ctx;
  281. struct wpa_ssid *ssid;
  282. int scan_req = 0, ret;
  283. struct wpabuf *wps_ie;
  284. struct wpa_driver_scan_params params;
  285. size_t max_ssids;
  286. enum wpa_states prev_state;
  287. if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED) {
  288. wpa_dbg(wpa_s, MSG_DEBUG, "Skip scan - interface disabled");
  289. return;
  290. }
  291. if (wpa_s->disconnected && !wpa_s->scan_req) {
  292. wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
  293. return;
  294. }
  295. if (!wpa_supplicant_enabled_networks(wpa_s->conf) &&
  296. !wpa_s->scan_req) {
  297. wpa_dbg(wpa_s, MSG_DEBUG, "No enabled networks - do not scan");
  298. wpa_supplicant_set_state(wpa_s, WPA_INACTIVE);
  299. return;
  300. }
  301. if (wpa_s->conf->ap_scan != 0 &&
  302. (wpa_s->drv_flags & WPA_DRIVER_FLAGS_WIRED)) {
  303. wpa_dbg(wpa_s, MSG_DEBUG, "Using wired authentication - "
  304. "overriding ap_scan configuration");
  305. wpa_s->conf->ap_scan = 0;
  306. wpas_notify_ap_scan_changed(wpa_s);
  307. }
  308. if (wpa_s->conf->ap_scan == 0) {
  309. wpa_supplicant_gen_assoc_event(wpa_s);
  310. return;
  311. }
  312. #ifdef CONFIG_P2P
  313. if (wpas_p2p_in_progress(wpa_s)) {
  314. if (wpa_s->wpa_state == WPA_SCANNING) {
  315. wpa_dbg(wpa_s, MSG_DEBUG, "Delay station mode scan "
  316. "while P2P operation is in progress");
  317. wpa_supplicant_req_scan(wpa_s, 5, 0);
  318. } else {
  319. wpa_dbg(wpa_s, MSG_DEBUG, "Do not request scan while "
  320. "P2P operation is in progress");
  321. }
  322. return;
  323. }
  324. #endif /* CONFIG_P2P */
  325. if ((wpa_s->drv_flags & WPA_DRIVER_FLAGS_USER_SPACE_MLME) ||
  326. wpa_s->conf->ap_scan == 2)
  327. max_ssids = 1;
  328. else {
  329. max_ssids = wpa_s->max_scan_ssids;
  330. if (max_ssids > WPAS_MAX_SCAN_SSIDS)
  331. max_ssids = WPAS_MAX_SCAN_SSIDS;
  332. }
  333. scan_req = wpa_s->scan_req;
  334. wpa_s->scan_req = 0;
  335. os_memset(&params, 0, sizeof(params));
  336. prev_state = wpa_s->wpa_state;
  337. if (wpa_s->wpa_state == WPA_DISCONNECTED ||
  338. wpa_s->wpa_state == WPA_INACTIVE)
  339. wpa_supplicant_set_state(wpa_s, WPA_SCANNING);
  340. if (scan_req != 2 && wpa_s->connect_without_scan) {
  341. for (ssid = wpa_s->conf->ssid; ssid; ssid = ssid->next) {
  342. if (ssid == wpa_s->connect_without_scan)
  343. break;
  344. }
  345. wpa_s->connect_without_scan = NULL;
  346. if (ssid) {
  347. wpa_printf(MSG_DEBUG, "Start a pre-selected network "
  348. "without scan step");
  349. wpa_supplicant_associate(wpa_s, NULL, ssid);
  350. return;
  351. }
  352. }
  353. /* Find the starting point from which to continue scanning */
  354. ssid = wpa_s->conf->ssid;
  355. if (wpa_s->prev_scan_ssid != WILDCARD_SSID_SCAN) {
  356. while (ssid) {
  357. if (ssid == wpa_s->prev_scan_ssid) {
  358. ssid = ssid->next;
  359. break;
  360. }
  361. ssid = ssid->next;
  362. }
  363. }
  364. if (scan_req != 2 && wpa_s->conf->ap_scan == 2) {
  365. wpa_s->connect_without_scan = NULL;
  366. wpa_supplicant_assoc_try(wpa_s, ssid);
  367. return;
  368. } else if (wpa_s->conf->ap_scan == 2) {
  369. /*
  370. * User-initiated scan request in ap_scan == 2; scan with
  371. * wildcard SSID.
  372. */
  373. ssid = NULL;
  374. } else {
  375. struct wpa_ssid *start = ssid, *tssid;
  376. int freqs_set = 0;
  377. if (ssid == NULL && max_ssids > 1)
  378. ssid = wpa_s->conf->ssid;
  379. while (ssid) {
  380. if (!ssid->disabled && ssid->scan_ssid) {
  381. wpa_hexdump_ascii(MSG_DEBUG, "Scan SSID",
  382. ssid->ssid, ssid->ssid_len);
  383. params.ssids[params.num_ssids].ssid =
  384. ssid->ssid;
  385. params.ssids[params.num_ssids].ssid_len =
  386. ssid->ssid_len;
  387. params.num_ssids++;
  388. if (params.num_ssids + 1 >= max_ssids)
  389. break;
  390. }
  391. ssid = ssid->next;
  392. if (ssid == start)
  393. break;
  394. if (ssid == NULL && max_ssids > 1 &&
  395. start != wpa_s->conf->ssid)
  396. ssid = wpa_s->conf->ssid;
  397. }
  398. for (tssid = wpa_s->conf->ssid; tssid; tssid = tssid->next) {
  399. if (tssid->disabled)
  400. continue;
  401. if ((params.freqs || !freqs_set) && tssid->scan_freq) {
  402. int_array_concat(&params.freqs,
  403. tssid->scan_freq);
  404. } else {
  405. os_free(params.freqs);
  406. params.freqs = NULL;
  407. }
  408. freqs_set = 1;
  409. }
  410. int_array_sort_unique(params.freqs);
  411. }
  412. if (ssid) {
  413. wpa_s->prev_scan_ssid = ssid;
  414. if (max_ssids > 1) {
  415. wpa_dbg(wpa_s, MSG_DEBUG, "Include wildcard SSID in "
  416. "the scan request");
  417. params.num_ssids++;
  418. }
  419. wpa_dbg(wpa_s, MSG_DEBUG, "Starting AP scan for specific "
  420. "SSID(s)");
  421. } else {
  422. wpa_s->prev_scan_ssid = WILDCARD_SSID_SCAN;
  423. params.num_ssids++;
  424. wpa_dbg(wpa_s, MSG_DEBUG, "Starting AP scan for wildcard "
  425. "SSID");
  426. }
  427. wpa_supplicant_optimize_freqs(wpa_s, &params);
  428. wps_ie = wpa_supplicant_extra_ies(wpa_s, &params);
  429. if (params.freqs == NULL && wpa_s->next_scan_freqs) {
  430. wpa_dbg(wpa_s, MSG_DEBUG, "Optimize scan based on previously "
  431. "generated frequency list");
  432. params.freqs = wpa_s->next_scan_freqs;
  433. } else
  434. os_free(wpa_s->next_scan_freqs);
  435. wpa_s->next_scan_freqs = NULL;
  436. params.filter_ssids = wpa_supplicant_build_filter_ssids(
  437. wpa_s->conf, &params.num_filter_ssids);
  438. ret = wpa_supplicant_trigger_scan(wpa_s, &params);
  439. wpabuf_free(wps_ie);
  440. os_free(params.freqs);
  441. os_free(params.filter_ssids);
  442. if (ret) {
  443. wpa_msg(wpa_s, MSG_WARNING, "Failed to initiate AP scan");
  444. if (prev_state != wpa_s->wpa_state)
  445. wpa_supplicant_set_state(wpa_s, prev_state);
  446. wpa_supplicant_req_scan(wpa_s, 1, 0);
  447. }
  448. }
  449. /**
  450. * wpa_supplicant_req_scan - Schedule a scan for neighboring access points
  451. * @wpa_s: Pointer to wpa_supplicant data
  452. * @sec: Number of seconds after which to scan
  453. * @usec: Number of microseconds after which to scan
  454. *
  455. * This function is used to schedule a scan for neighboring access points after
  456. * the specified time.
  457. */
  458. void wpa_supplicant_req_scan(struct wpa_supplicant *wpa_s, int sec, int usec)
  459. {
  460. /* If there's at least one network that should be specifically scanned
  461. * then don't cancel the scan and reschedule. Some drivers do
  462. * background scanning which generates frequent scan results, and that
  463. * causes the specific SSID scan to get continually pushed back and
  464. * never happen, which causes hidden APs to never get probe-scanned.
  465. */
  466. if (eloop_is_timeout_registered(wpa_supplicant_scan, wpa_s, NULL) &&
  467. wpa_s->conf->ap_scan == 1) {
  468. struct wpa_ssid *ssid = wpa_s->conf->ssid;
  469. while (ssid) {
  470. if (!ssid->disabled && ssid->scan_ssid)
  471. break;
  472. ssid = ssid->next;
  473. }
  474. if (ssid) {
  475. wpa_dbg(wpa_s, MSG_DEBUG, "Not rescheduling scan to "
  476. "ensure that specific SSID scans occur");
  477. return;
  478. }
  479. }
  480. wpa_dbg(wpa_s, MSG_DEBUG, "Setting scan request: %d sec %d usec",
  481. sec, usec);
  482. eloop_cancel_timeout(wpa_supplicant_scan, wpa_s, NULL);
  483. eloop_register_timeout(sec, usec, wpa_supplicant_scan, wpa_s, NULL);
  484. }
  485. /**
  486. * wpa_supplicant_cancel_scan - Cancel a scheduled scan request
  487. * @wpa_s: Pointer to wpa_supplicant data
  488. *
  489. * This function is used to cancel a scan request scheduled with
  490. * wpa_supplicant_req_scan().
  491. */
  492. void wpa_supplicant_cancel_scan(struct wpa_supplicant *wpa_s)
  493. {
  494. wpa_dbg(wpa_s, MSG_DEBUG, "Cancelling scan request");
  495. eloop_cancel_timeout(wpa_supplicant_scan, wpa_s, NULL);
  496. }
  497. void wpa_supplicant_notify_scanning(struct wpa_supplicant *wpa_s,
  498. int scanning)
  499. {
  500. if (wpa_s->scanning != scanning) {
  501. wpa_s->scanning = scanning;
  502. wpas_notify_scanning(wpa_s);
  503. }
  504. }
  505. static int wpa_scan_get_max_rate(const struct wpa_scan_res *res)
  506. {
  507. int rate = 0;
  508. const u8 *ie;
  509. int i;
  510. ie = wpa_scan_get_ie(res, WLAN_EID_SUPP_RATES);
  511. for (i = 0; ie && i < ie[1]; i++) {
  512. if ((ie[i + 2] & 0x7f) > rate)
  513. rate = ie[i + 2] & 0x7f;
  514. }
  515. ie = wpa_scan_get_ie(res, WLAN_EID_EXT_SUPP_RATES);
  516. for (i = 0; ie && i < ie[1]; i++) {
  517. if ((ie[i + 2] & 0x7f) > rate)
  518. rate = ie[i + 2] & 0x7f;
  519. }
  520. return rate;
  521. }
  522. const u8 * wpa_scan_get_ie(const struct wpa_scan_res *res, u8 ie)
  523. {
  524. const u8 *end, *pos;
  525. pos = (const u8 *) (res + 1);
  526. end = pos + res->ie_len;
  527. while (pos + 1 < end) {
  528. if (pos + 2 + pos[1] > end)
  529. break;
  530. if (pos[0] == ie)
  531. return pos;
  532. pos += 2 + pos[1];
  533. }
  534. return NULL;
  535. }
  536. const u8 * wpa_scan_get_vendor_ie(const struct wpa_scan_res *res,
  537. u32 vendor_type)
  538. {
  539. const u8 *end, *pos;
  540. pos = (const u8 *) (res + 1);
  541. end = pos + res->ie_len;
  542. while (pos + 1 < end) {
  543. if (pos + 2 + pos[1] > end)
  544. break;
  545. if (pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
  546. vendor_type == WPA_GET_BE32(&pos[2]))
  547. return pos;
  548. pos += 2 + pos[1];
  549. }
  550. return NULL;
  551. }
  552. struct wpabuf * wpa_scan_get_vendor_ie_multi(const struct wpa_scan_res *res,
  553. u32 vendor_type)
  554. {
  555. struct wpabuf *buf;
  556. const u8 *end, *pos;
  557. buf = wpabuf_alloc(res->ie_len);
  558. if (buf == NULL)
  559. return NULL;
  560. pos = (const u8 *) (res + 1);
  561. end = pos + res->ie_len;
  562. while (pos + 1 < end) {
  563. if (pos + 2 + pos[1] > end)
  564. break;
  565. if (pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
  566. vendor_type == WPA_GET_BE32(&pos[2]))
  567. wpabuf_put_data(buf, pos + 2 + 4, pos[1] - 4);
  568. pos += 2 + pos[1];
  569. }
  570. if (wpabuf_len(buf) == 0) {
  571. wpabuf_free(buf);
  572. buf = NULL;
  573. }
  574. return buf;
  575. }
  576. struct wpabuf * wpa_scan_get_vendor_ie_multi_beacon(
  577. const struct wpa_scan_res *res, u32 vendor_type)
  578. {
  579. struct wpabuf *buf;
  580. const u8 *end, *pos;
  581. if (res->beacon_ie_len == 0)
  582. return NULL;
  583. buf = wpabuf_alloc(res->beacon_ie_len);
  584. if (buf == NULL)
  585. return NULL;
  586. pos = (const u8 *) (res + 1);
  587. pos += res->ie_len;
  588. end = pos + res->beacon_ie_len;
  589. while (pos + 1 < end) {
  590. if (pos + 2 + pos[1] > end)
  591. break;
  592. if (pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 &&
  593. vendor_type == WPA_GET_BE32(&pos[2]))
  594. wpabuf_put_data(buf, pos + 2 + 4, pos[1] - 4);
  595. pos += 2 + pos[1];
  596. }
  597. if (wpabuf_len(buf) == 0) {
  598. wpabuf_free(buf);
  599. buf = NULL;
  600. }
  601. return buf;
  602. }
  603. /* Compare function for sorting scan results. Return >0 if @b is considered
  604. * better. */
  605. static int wpa_scan_result_compar(const void *a, const void *b)
  606. {
  607. struct wpa_scan_res **_wa = (void *) a;
  608. struct wpa_scan_res **_wb = (void *) b;
  609. struct wpa_scan_res *wa = *_wa;
  610. struct wpa_scan_res *wb = *_wb;
  611. int wpa_a, wpa_b, maxrate_a, maxrate_b;
  612. /* WPA/WPA2 support preferred */
  613. wpa_a = wpa_scan_get_vendor_ie(wa, WPA_IE_VENDOR_TYPE) != NULL ||
  614. wpa_scan_get_ie(wa, WLAN_EID_RSN) != NULL;
  615. wpa_b = wpa_scan_get_vendor_ie(wb, WPA_IE_VENDOR_TYPE) != NULL ||
  616. wpa_scan_get_ie(wb, WLAN_EID_RSN) != NULL;
  617. if (wpa_b && !wpa_a)
  618. return 1;
  619. if (!wpa_b && wpa_a)
  620. return -1;
  621. /* privacy support preferred */
  622. if ((wa->caps & IEEE80211_CAP_PRIVACY) == 0 &&
  623. (wb->caps & IEEE80211_CAP_PRIVACY))
  624. return 1;
  625. if ((wa->caps & IEEE80211_CAP_PRIVACY) &&
  626. (wb->caps & IEEE80211_CAP_PRIVACY) == 0)
  627. return -1;
  628. /* best/max rate preferred if signal level close enough XXX */
  629. if ((wa->level && wb->level && abs(wb->level - wa->level) < 5) ||
  630. (wa->qual && wb->qual && abs(wb->qual - wa->qual) < 10)) {
  631. maxrate_a = wpa_scan_get_max_rate(wa);
  632. maxrate_b = wpa_scan_get_max_rate(wb);
  633. if (maxrate_a != maxrate_b)
  634. return maxrate_b - maxrate_a;
  635. }
  636. /* use freq for channel preference */
  637. /* all things being equal, use signal level; if signal levels are
  638. * identical, use quality values since some drivers may only report
  639. * that value and leave the signal level zero */
  640. if (wb->level == wa->level)
  641. return wb->qual - wa->qual;
  642. return wb->level - wa->level;
  643. }
  644. #ifdef CONFIG_WPS
  645. /* Compare function for sorting scan results when searching a WPS AP for
  646. * provisioning. Return >0 if @b is considered better. */
  647. static int wpa_scan_result_wps_compar(const void *a, const void *b)
  648. {
  649. struct wpa_scan_res **_wa = (void *) a;
  650. struct wpa_scan_res **_wb = (void *) b;
  651. struct wpa_scan_res *wa = *_wa;
  652. struct wpa_scan_res *wb = *_wb;
  653. int uses_wps_a, uses_wps_b;
  654. struct wpabuf *wps_a, *wps_b;
  655. int res;
  656. /* Optimization - check WPS IE existence before allocated memory and
  657. * doing full reassembly. */
  658. uses_wps_a = wpa_scan_get_vendor_ie(wa, WPS_IE_VENDOR_TYPE) != NULL;
  659. uses_wps_b = wpa_scan_get_vendor_ie(wb, WPS_IE_VENDOR_TYPE) != NULL;
  660. if (uses_wps_a && !uses_wps_b)
  661. return -1;
  662. if (!uses_wps_a && uses_wps_b)
  663. return 1;
  664. if (uses_wps_a && uses_wps_b) {
  665. wps_a = wpa_scan_get_vendor_ie_multi(wa, WPS_IE_VENDOR_TYPE);
  666. wps_b = wpa_scan_get_vendor_ie_multi(wb, WPS_IE_VENDOR_TYPE);
  667. res = wps_ap_priority_compar(wps_a, wps_b);
  668. wpabuf_free(wps_a);
  669. wpabuf_free(wps_b);
  670. if (res)
  671. return res;
  672. }
  673. /*
  674. * Do not use current AP security policy as a sorting criteria during
  675. * WPS provisioning step since the AP may get reconfigured at the
  676. * completion of provisioning.
  677. */
  678. /* all things being equal, use signal level; if signal levels are
  679. * identical, use quality values since some drivers may only report
  680. * that value and leave the signal level zero */
  681. if (wb->level == wa->level)
  682. return wb->qual - wa->qual;
  683. return wb->level - wa->level;
  684. }
  685. #endif /* CONFIG_WPS */
  686. /**
  687. * wpa_supplicant_get_scan_results - Get scan results
  688. * @wpa_s: Pointer to wpa_supplicant data
  689. * @info: Information about what was scanned or %NULL if not available
  690. * @new_scan: Whether a new scan was performed
  691. * Returns: Scan results, %NULL on failure
  692. *
  693. * This function request the current scan results from the driver and updates
  694. * the local BSS list wpa_s->bss. The caller is responsible for freeing the
  695. * results with wpa_scan_results_free().
  696. */
  697. struct wpa_scan_results *
  698. wpa_supplicant_get_scan_results(struct wpa_supplicant *wpa_s,
  699. struct scan_info *info, int new_scan)
  700. {
  701. struct wpa_scan_results *scan_res;
  702. size_t i;
  703. int (*compar)(const void *, const void *) = wpa_scan_result_compar;
  704. if (wpa_s->drv_flags & WPA_DRIVER_FLAGS_USER_SPACE_MLME)
  705. scan_res = ieee80211_sta_get_scan_results(wpa_s);
  706. else
  707. scan_res = wpa_drv_get_scan_results2(wpa_s);
  708. if (scan_res == NULL) {
  709. wpa_dbg(wpa_s, MSG_DEBUG, "Failed to get scan results");
  710. return NULL;
  711. }
  712. #ifdef CONFIG_WPS
  713. if (wpas_wps_in_progress(wpa_s)) {
  714. wpa_dbg(wpa_s, MSG_DEBUG, "WPS: Order scan results with WPS "
  715. "provisioning rules");
  716. compar = wpa_scan_result_wps_compar;
  717. }
  718. #endif /* CONFIG_WPS */
  719. qsort(scan_res->res, scan_res->num, sizeof(struct wpa_scan_res *),
  720. compar);
  721. wpa_bss_update_start(wpa_s);
  722. for (i = 0; i < scan_res->num; i++)
  723. wpa_bss_update_scan_res(wpa_s, scan_res->res[i]);
  724. wpa_bss_update_end(wpa_s, info, new_scan);
  725. return scan_res;
  726. }
  727. int wpa_supplicant_update_scan_results(struct wpa_supplicant *wpa_s)
  728. {
  729. struct wpa_scan_results *scan_res;
  730. scan_res = wpa_supplicant_get_scan_results(wpa_s, NULL, 0);
  731. if (scan_res == NULL)
  732. return -1;
  733. wpa_scan_results_free(scan_res);
  734. return 0;
  735. }
  736. void wpa_scan_results_free(struct wpa_scan_results *res)
  737. {
  738. size_t i;
  739. if (res == NULL)
  740. return;
  741. for (i = 0; i < res->num; i++)
  742. os_free(res->res[i]);
  743. os_free(res->res);
  744. os_free(res);
  745. }