sme.c 48 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701
  1. /*
  2. * wpa_supplicant - SME
  3. * Copyright (c) 2009-2014, 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. #include "includes.h"
  9. #include "common.h"
  10. #include "utils/eloop.h"
  11. #include "common/ieee802_11_defs.h"
  12. #include "common/ieee802_11_common.h"
  13. #include "eapol_supp/eapol_supp_sm.h"
  14. #include "common/wpa_common.h"
  15. #include "common/sae.h"
  16. #include "rsn_supp/wpa.h"
  17. #include "rsn_supp/pmksa_cache.h"
  18. #include "config.h"
  19. #include "wpa_supplicant_i.h"
  20. #include "driver_i.h"
  21. #include "wpas_glue.h"
  22. #include "wps_supplicant.h"
  23. #include "p2p_supplicant.h"
  24. #include "notify.h"
  25. #include "bss.h"
  26. #include "scan.h"
  27. #include "sme.h"
  28. #include "hs20_supplicant.h"
  29. #define SME_AUTH_TIMEOUT 5
  30. #define SME_ASSOC_TIMEOUT 5
  31. static void sme_auth_timer(void *eloop_ctx, void *timeout_ctx);
  32. static void sme_assoc_timer(void *eloop_ctx, void *timeout_ctx);
  33. static void sme_obss_scan_timeout(void *eloop_ctx, void *timeout_ctx);
  34. #ifdef CONFIG_IEEE80211W
  35. static void sme_stop_sa_query(struct wpa_supplicant *wpa_s);
  36. #endif /* CONFIG_IEEE80211W */
  37. #ifdef CONFIG_SAE
  38. static int index_within_array(const int *array, int idx)
  39. {
  40. int i;
  41. for (i = 0; i < idx; i++) {
  42. if (array[i] <= 0)
  43. return 0;
  44. }
  45. return 1;
  46. }
  47. static int sme_set_sae_group(struct wpa_supplicant *wpa_s)
  48. {
  49. int *groups = wpa_s->conf->sae_groups;
  50. int default_groups[] = { 19, 20, 21, 25, 26, 0 };
  51. if (!groups || groups[0] <= 0)
  52. groups = default_groups;
  53. /* Configuration may have changed, so validate current index */
  54. if (!index_within_array(groups, wpa_s->sme.sae_group_index))
  55. return -1;
  56. for (;;) {
  57. int group = groups[wpa_s->sme.sae_group_index];
  58. if (group <= 0)
  59. break;
  60. if (sae_set_group(&wpa_s->sme.sae, group) == 0) {
  61. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Selected SAE group %d",
  62. wpa_s->sme.sae.group);
  63. return 0;
  64. }
  65. wpa_s->sme.sae_group_index++;
  66. }
  67. return -1;
  68. }
  69. static struct wpabuf * sme_auth_build_sae_commit(struct wpa_supplicant *wpa_s,
  70. struct wpa_ssid *ssid,
  71. const u8 *bssid)
  72. {
  73. struct wpabuf *buf;
  74. size_t len;
  75. if (ssid->passphrase == NULL) {
  76. wpa_printf(MSG_DEBUG, "SAE: No password available");
  77. return NULL;
  78. }
  79. if (sme_set_sae_group(wpa_s) < 0) {
  80. wpa_printf(MSG_DEBUG, "SAE: Failed to select group");
  81. return NULL;
  82. }
  83. if (sae_prepare_commit(wpa_s->own_addr, bssid,
  84. (u8 *) ssid->passphrase,
  85. os_strlen(ssid->passphrase),
  86. &wpa_s->sme.sae) < 0) {
  87. wpa_printf(MSG_DEBUG, "SAE: Could not pick PWE");
  88. return NULL;
  89. }
  90. len = wpa_s->sme.sae_token ? wpabuf_len(wpa_s->sme.sae_token) : 0;
  91. buf = wpabuf_alloc(4 + SAE_COMMIT_MAX_LEN + len);
  92. if (buf == NULL)
  93. return NULL;
  94. wpabuf_put_le16(buf, 1); /* Transaction seq# */
  95. wpabuf_put_le16(buf, WLAN_STATUS_SUCCESS);
  96. sae_write_commit(&wpa_s->sme.sae, buf, wpa_s->sme.sae_token);
  97. return buf;
  98. }
  99. static struct wpabuf * sme_auth_build_sae_confirm(struct wpa_supplicant *wpa_s)
  100. {
  101. struct wpabuf *buf;
  102. buf = wpabuf_alloc(4 + SAE_CONFIRM_MAX_LEN);
  103. if (buf == NULL)
  104. return NULL;
  105. wpabuf_put_le16(buf, 2); /* Transaction seq# */
  106. wpabuf_put_le16(buf, WLAN_STATUS_SUCCESS);
  107. sae_write_confirm(&wpa_s->sme.sae, buf);
  108. return buf;
  109. }
  110. #endif /* CONFIG_SAE */
  111. /**
  112. * sme_auth_handle_rrm - Handle RRM aspects of current authentication attempt
  113. * @wpa_s: Pointer to wpa_supplicant data
  114. * @bss: Pointer to the bss which is the target of authentication attempt
  115. */
  116. static void sme_auth_handle_rrm(struct wpa_supplicant *wpa_s,
  117. struct wpa_bss *bss)
  118. {
  119. const u8 rrm_ie_len = 5;
  120. u8 *pos;
  121. const u8 *rrm_ie;
  122. wpa_s->rrm.rrm_used = 0;
  123. wpa_printf(MSG_DEBUG,
  124. "RRM: Determining whether RRM can be used - device support: 0x%x",
  125. wpa_s->drv_rrm_flags);
  126. rrm_ie = wpa_bss_get_ie(bss, WLAN_EID_RRM_ENABLED_CAPABILITIES);
  127. if (!rrm_ie || !(bss->caps & IEEE80211_CAP_RRM)) {
  128. wpa_printf(MSG_DEBUG, "RRM: No RRM in network");
  129. return;
  130. }
  131. if (!((wpa_s->drv_rrm_flags &
  132. WPA_DRIVER_FLAGS_DS_PARAM_SET_IE_IN_PROBES) &&
  133. (wpa_s->drv_rrm_flags & WPA_DRIVER_FLAGS_QUIET)) &&
  134. !(wpa_s->drv_rrm_flags & WPA_DRIVER_FLAGS_SUPPORT_RRM)) {
  135. wpa_printf(MSG_DEBUG,
  136. "RRM: Insufficient RRM support in driver - do not use RRM");
  137. return;
  138. }
  139. if (sizeof(wpa_s->sme.assoc_req_ie) <
  140. wpa_s->sme.assoc_req_ie_len + rrm_ie_len + 2) {
  141. wpa_printf(MSG_INFO,
  142. "RRM: Unable to use RRM, no room for RRM IE");
  143. return;
  144. }
  145. wpa_printf(MSG_DEBUG, "RRM: Adding RRM IE to Association Request");
  146. pos = wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len;
  147. os_memset(pos, 0, 2 + rrm_ie_len);
  148. *pos++ = WLAN_EID_RRM_ENABLED_CAPABILITIES;
  149. *pos++ = rrm_ie_len;
  150. /* Set supported capabilites flags */
  151. if (wpa_s->drv_rrm_flags & WPA_DRIVER_FLAGS_TX_POWER_INSERTION)
  152. *pos |= WLAN_RRM_CAPS_LINK_MEASUREMENT;
  153. if (wpa_s->lci)
  154. pos[1] |= WLAN_RRM_CAPS_LCI_MEASUREMENT;
  155. wpa_s->sme.assoc_req_ie_len += rrm_ie_len + 2;
  156. wpa_s->rrm.rrm_used = 1;
  157. }
  158. static void sme_send_authentication(struct wpa_supplicant *wpa_s,
  159. struct wpa_bss *bss, struct wpa_ssid *ssid,
  160. int start)
  161. {
  162. struct wpa_driver_auth_params params;
  163. struct wpa_ssid *old_ssid;
  164. #ifdef CONFIG_IEEE80211R
  165. const u8 *ie;
  166. #endif /* CONFIG_IEEE80211R */
  167. #ifdef CONFIG_IEEE80211R
  168. const u8 *md = NULL;
  169. #endif /* CONFIG_IEEE80211R */
  170. int i, bssid_changed;
  171. struct wpabuf *resp = NULL;
  172. u8 ext_capab[18];
  173. int ext_capab_len;
  174. int skip_auth;
  175. #ifdef CONFIG_MBO
  176. const u8 *mbo;
  177. #endif /* CONFIG_MBO */
  178. if (bss == NULL) {
  179. wpa_msg(wpa_s, MSG_ERROR, "SME: No scan result available for "
  180. "the network");
  181. wpas_connect_work_done(wpa_s);
  182. return;
  183. }
  184. skip_auth = wpa_s->conf->reassoc_same_bss_optim &&
  185. wpa_s->reassoc_same_bss;
  186. wpa_s->current_bss = bss;
  187. os_memset(&params, 0, sizeof(params));
  188. wpa_s->reassociate = 0;
  189. params.freq = bss->freq;
  190. params.bssid = bss->bssid;
  191. params.ssid = bss->ssid;
  192. params.ssid_len = bss->ssid_len;
  193. params.p2p = ssid->p2p_group;
  194. if (wpa_s->sme.ssid_len != params.ssid_len ||
  195. os_memcmp(wpa_s->sme.ssid, params.ssid, params.ssid_len) != 0)
  196. wpa_s->sme.prev_bssid_set = 0;
  197. wpa_s->sme.freq = params.freq;
  198. os_memcpy(wpa_s->sme.ssid, params.ssid, params.ssid_len);
  199. wpa_s->sme.ssid_len = params.ssid_len;
  200. params.auth_alg = WPA_AUTH_ALG_OPEN;
  201. #ifdef IEEE8021X_EAPOL
  202. if (ssid->key_mgmt & WPA_KEY_MGMT_IEEE8021X_NO_WPA) {
  203. if (ssid->leap) {
  204. if (ssid->non_leap == 0)
  205. params.auth_alg = WPA_AUTH_ALG_LEAP;
  206. else
  207. params.auth_alg |= WPA_AUTH_ALG_LEAP;
  208. }
  209. }
  210. #endif /* IEEE8021X_EAPOL */
  211. wpa_dbg(wpa_s, MSG_DEBUG, "Automatic auth_alg selection: 0x%x",
  212. params.auth_alg);
  213. if (ssid->auth_alg) {
  214. params.auth_alg = ssid->auth_alg;
  215. wpa_dbg(wpa_s, MSG_DEBUG, "Overriding auth_alg selection: "
  216. "0x%x", params.auth_alg);
  217. }
  218. #ifdef CONFIG_SAE
  219. wpa_s->sme.sae_pmksa_caching = 0;
  220. if (wpa_key_mgmt_sae(ssid->key_mgmt)) {
  221. const u8 *rsn;
  222. struct wpa_ie_data ied;
  223. rsn = wpa_bss_get_ie(bss, WLAN_EID_RSN);
  224. if (!rsn) {
  225. wpa_dbg(wpa_s, MSG_DEBUG,
  226. "SAE enabled, but target BSS does not advertise RSN");
  227. } else if (wpa_parse_wpa_ie(rsn, 2 + rsn[1], &ied) == 0 &&
  228. wpa_key_mgmt_sae(ied.key_mgmt)) {
  229. wpa_dbg(wpa_s, MSG_DEBUG, "Using SAE auth_alg");
  230. params.auth_alg = WPA_AUTH_ALG_SAE;
  231. } else {
  232. wpa_dbg(wpa_s, MSG_DEBUG,
  233. "SAE enabled, but target BSS does not advertise SAE AKM for RSN");
  234. }
  235. }
  236. #endif /* CONFIG_SAE */
  237. for (i = 0; i < NUM_WEP_KEYS; i++) {
  238. if (ssid->wep_key_len[i])
  239. params.wep_key[i] = ssid->wep_key[i];
  240. params.wep_key_len[i] = ssid->wep_key_len[i];
  241. }
  242. params.wep_tx_keyidx = ssid->wep_tx_keyidx;
  243. bssid_changed = !is_zero_ether_addr(wpa_s->bssid);
  244. os_memset(wpa_s->bssid, 0, ETH_ALEN);
  245. os_memcpy(wpa_s->pending_bssid, bss->bssid, ETH_ALEN);
  246. if (bssid_changed)
  247. wpas_notify_bssid_changed(wpa_s);
  248. if ((wpa_bss_get_vendor_ie(bss, WPA_IE_VENDOR_TYPE) ||
  249. wpa_bss_get_ie(bss, WLAN_EID_RSN)) &&
  250. wpa_key_mgmt_wpa(ssid->key_mgmt)) {
  251. int try_opportunistic;
  252. try_opportunistic = (ssid->proactive_key_caching < 0 ?
  253. wpa_s->conf->okc :
  254. ssid->proactive_key_caching) &&
  255. (ssid->proto & WPA_PROTO_RSN);
  256. if (pmksa_cache_set_current(wpa_s->wpa, NULL, bss->bssid,
  257. wpa_s->current_ssid,
  258. try_opportunistic) == 0)
  259. eapol_sm_notify_pmkid_attempt(wpa_s->eapol);
  260. wpa_s->sme.assoc_req_ie_len = sizeof(wpa_s->sme.assoc_req_ie);
  261. if (wpa_supplicant_set_suites(wpa_s, bss, ssid,
  262. wpa_s->sme.assoc_req_ie,
  263. &wpa_s->sme.assoc_req_ie_len)) {
  264. wpa_msg(wpa_s, MSG_WARNING, "SME: Failed to set WPA "
  265. "key management and encryption suites");
  266. wpas_connect_work_done(wpa_s);
  267. return;
  268. }
  269. } else if ((ssid->key_mgmt & WPA_KEY_MGMT_IEEE8021X_NO_WPA) &&
  270. wpa_key_mgmt_wpa_ieee8021x(ssid->key_mgmt)) {
  271. /*
  272. * Both WPA and non-WPA IEEE 802.1X enabled in configuration -
  273. * use non-WPA since the scan results did not indicate that the
  274. * AP is using WPA or WPA2.
  275. */
  276. wpa_supplicant_set_non_wpa_policy(wpa_s, ssid);
  277. wpa_s->sme.assoc_req_ie_len = 0;
  278. } else if (wpa_key_mgmt_wpa_any(ssid->key_mgmt)) {
  279. wpa_s->sme.assoc_req_ie_len = sizeof(wpa_s->sme.assoc_req_ie);
  280. if (wpa_supplicant_set_suites(wpa_s, NULL, ssid,
  281. wpa_s->sme.assoc_req_ie,
  282. &wpa_s->sme.assoc_req_ie_len)) {
  283. wpa_msg(wpa_s, MSG_WARNING, "SME: Failed to set WPA "
  284. "key management and encryption suites (no "
  285. "scan results)");
  286. wpas_connect_work_done(wpa_s);
  287. return;
  288. }
  289. #ifdef CONFIG_WPS
  290. } else if (ssid->key_mgmt & WPA_KEY_MGMT_WPS) {
  291. struct wpabuf *wps_ie;
  292. wps_ie = wps_build_assoc_req_ie(wpas_wps_get_req_type(ssid));
  293. if (wps_ie && wpabuf_len(wps_ie) <=
  294. sizeof(wpa_s->sme.assoc_req_ie)) {
  295. wpa_s->sme.assoc_req_ie_len = wpabuf_len(wps_ie);
  296. os_memcpy(wpa_s->sme.assoc_req_ie, wpabuf_head(wps_ie),
  297. wpa_s->sme.assoc_req_ie_len);
  298. } else
  299. wpa_s->sme.assoc_req_ie_len = 0;
  300. wpabuf_free(wps_ie);
  301. wpa_supplicant_set_non_wpa_policy(wpa_s, ssid);
  302. #endif /* CONFIG_WPS */
  303. } else {
  304. wpa_supplicant_set_non_wpa_policy(wpa_s, ssid);
  305. wpa_s->sme.assoc_req_ie_len = 0;
  306. }
  307. #ifdef CONFIG_IEEE80211R
  308. ie = wpa_bss_get_ie(bss, WLAN_EID_MOBILITY_DOMAIN);
  309. if (ie && ie[1] >= MOBILITY_DOMAIN_ID_LEN)
  310. md = ie + 2;
  311. wpa_sm_set_ft_params(wpa_s->wpa, ie, ie ? 2 + ie[1] : 0);
  312. if (md) {
  313. /* Prepare for the next transition */
  314. wpa_ft_prepare_auth_request(wpa_s->wpa, ie);
  315. }
  316. if (md && wpa_key_mgmt_ft(ssid->key_mgmt)) {
  317. if (wpa_s->sme.assoc_req_ie_len + 5 <
  318. sizeof(wpa_s->sme.assoc_req_ie)) {
  319. struct rsn_mdie *mdie;
  320. u8 *pos = wpa_s->sme.assoc_req_ie +
  321. wpa_s->sme.assoc_req_ie_len;
  322. *pos++ = WLAN_EID_MOBILITY_DOMAIN;
  323. *pos++ = sizeof(*mdie);
  324. mdie = (struct rsn_mdie *) pos;
  325. os_memcpy(mdie->mobility_domain, md,
  326. MOBILITY_DOMAIN_ID_LEN);
  327. mdie->ft_capab = md[MOBILITY_DOMAIN_ID_LEN];
  328. wpa_s->sme.assoc_req_ie_len += 5;
  329. }
  330. if (wpa_s->sme.ft_used &&
  331. os_memcmp(md, wpa_s->sme.mobility_domain, 2) == 0 &&
  332. wpa_sm_has_ptk(wpa_s->wpa)) {
  333. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Trying to use FT "
  334. "over-the-air");
  335. params.auth_alg = WPA_AUTH_ALG_FT;
  336. params.ie = wpa_s->sme.ft_ies;
  337. params.ie_len = wpa_s->sme.ft_ies_len;
  338. }
  339. }
  340. #endif /* CONFIG_IEEE80211R */
  341. #ifdef CONFIG_IEEE80211W
  342. wpa_s->sme.mfp = wpas_get_ssid_pmf(wpa_s, ssid);
  343. if (wpa_s->sme.mfp != NO_MGMT_FRAME_PROTECTION) {
  344. const u8 *rsn = wpa_bss_get_ie(bss, WLAN_EID_RSN);
  345. struct wpa_ie_data _ie;
  346. if (rsn && wpa_parse_wpa_ie(rsn, 2 + rsn[1], &_ie) == 0 &&
  347. _ie.capabilities &
  348. (WPA_CAPABILITY_MFPC | WPA_CAPABILITY_MFPR)) {
  349. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Selected AP supports "
  350. "MFP: require MFP");
  351. wpa_s->sme.mfp = MGMT_FRAME_PROTECTION_REQUIRED;
  352. }
  353. }
  354. #endif /* CONFIG_IEEE80211W */
  355. #ifdef CONFIG_P2P
  356. if (wpa_s->global->p2p) {
  357. u8 *pos;
  358. size_t len;
  359. int res;
  360. pos = wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len;
  361. len = sizeof(wpa_s->sme.assoc_req_ie) -
  362. wpa_s->sme.assoc_req_ie_len;
  363. res = wpas_p2p_assoc_req_ie(wpa_s, bss, pos, len,
  364. ssid->p2p_group);
  365. if (res >= 0)
  366. wpa_s->sme.assoc_req_ie_len += res;
  367. }
  368. #endif /* CONFIG_P2P */
  369. #ifdef CONFIG_FST
  370. if (wpa_s->fst_ies) {
  371. int fst_ies_len = wpabuf_len(wpa_s->fst_ies);
  372. if (wpa_s->sme.assoc_req_ie_len + fst_ies_len <=
  373. sizeof(wpa_s->sme.assoc_req_ie)) {
  374. os_memcpy(wpa_s->sme.assoc_req_ie +
  375. wpa_s->sme.assoc_req_ie_len,
  376. wpabuf_head(wpa_s->fst_ies),
  377. fst_ies_len);
  378. wpa_s->sme.assoc_req_ie_len += fst_ies_len;
  379. }
  380. }
  381. #endif /* CONFIG_FST */
  382. sme_auth_handle_rrm(wpa_s, bss);
  383. #ifdef CONFIG_MBO
  384. mbo = wpa_bss_get_vendor_ie(bss, MBO_IE_VENDOR_TYPE);
  385. if (mbo) {
  386. int len;
  387. len = wpas_mbo_supp_op_class_ie(
  388. wpa_s, bss->freq,
  389. wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len,
  390. sizeof(wpa_s->sme.assoc_req_ie) -
  391. wpa_s->sme.assoc_req_ie_len);
  392. if (len > 0)
  393. wpa_s->sme.assoc_req_ie_len += len;
  394. }
  395. #endif /* CONFIG_MBO */
  396. if (params.p2p)
  397. wpa_drv_get_ext_capa(wpa_s, WPA_IF_P2P_CLIENT);
  398. else
  399. wpa_drv_get_ext_capa(wpa_s, WPA_IF_STATION);
  400. ext_capab_len = wpas_build_ext_capab(wpa_s, ext_capab,
  401. sizeof(ext_capab));
  402. if (ext_capab_len > 0) {
  403. u8 *pos = wpa_s->sme.assoc_req_ie;
  404. if (wpa_s->sme.assoc_req_ie_len > 0 && pos[0] == WLAN_EID_RSN)
  405. pos += 2 + pos[1];
  406. os_memmove(pos + ext_capab_len, pos,
  407. wpa_s->sme.assoc_req_ie_len -
  408. (pos - wpa_s->sme.assoc_req_ie));
  409. wpa_s->sme.assoc_req_ie_len += ext_capab_len;
  410. os_memcpy(pos, ext_capab, ext_capab_len);
  411. }
  412. #ifdef CONFIG_HS20
  413. if (is_hs20_network(wpa_s, ssid, bss)) {
  414. struct wpabuf *hs20;
  415. hs20 = wpabuf_alloc(20);
  416. if (hs20) {
  417. int pps_mo_id = hs20_get_pps_mo_id(wpa_s, ssid);
  418. size_t len;
  419. wpas_hs20_add_indication(hs20, pps_mo_id);
  420. len = sizeof(wpa_s->sme.assoc_req_ie) -
  421. wpa_s->sme.assoc_req_ie_len;
  422. if (wpabuf_len(hs20) <= len) {
  423. os_memcpy(wpa_s->sme.assoc_req_ie +
  424. wpa_s->sme.assoc_req_ie_len,
  425. wpabuf_head(hs20), wpabuf_len(hs20));
  426. wpa_s->sme.assoc_req_ie_len += wpabuf_len(hs20);
  427. }
  428. wpabuf_free(hs20);
  429. }
  430. }
  431. #endif /* CONFIG_HS20 */
  432. if (wpa_s->vendor_elem[VENDOR_ELEM_ASSOC_REQ]) {
  433. struct wpabuf *buf = wpa_s->vendor_elem[VENDOR_ELEM_ASSOC_REQ];
  434. size_t len;
  435. len = sizeof(wpa_s->sme.assoc_req_ie) -
  436. wpa_s->sme.assoc_req_ie_len;
  437. if (wpabuf_len(buf) <= len) {
  438. os_memcpy(wpa_s->sme.assoc_req_ie +
  439. wpa_s->sme.assoc_req_ie_len,
  440. wpabuf_head(buf), wpabuf_len(buf));
  441. wpa_s->sme.assoc_req_ie_len += wpabuf_len(buf);
  442. }
  443. }
  444. #ifdef CONFIG_MBO
  445. if (mbo) {
  446. int len;
  447. len = wpas_mbo_ie(wpa_s, wpa_s->sme.assoc_req_ie +
  448. wpa_s->sme.assoc_req_ie_len,
  449. sizeof(wpa_s->sme.assoc_req_ie) -
  450. wpa_s->sme.assoc_req_ie_len);
  451. if (len >= 0)
  452. wpa_s->sme.assoc_req_ie_len += len;
  453. }
  454. #endif /* CONFIG_MBO */
  455. #ifdef CONFIG_SAE
  456. if (!skip_auth && params.auth_alg == WPA_AUTH_ALG_SAE &&
  457. pmksa_cache_set_current(wpa_s->wpa, NULL, bss->bssid, ssid, 0) == 0)
  458. {
  459. wpa_dbg(wpa_s, MSG_DEBUG,
  460. "PMKSA cache entry found - try to use PMKSA caching instead of new SAE authentication");
  461. params.auth_alg = WPA_AUTH_ALG_OPEN;
  462. wpa_s->sme.sae_pmksa_caching = 1;
  463. }
  464. if (!skip_auth && params.auth_alg == WPA_AUTH_ALG_SAE) {
  465. if (start)
  466. resp = sme_auth_build_sae_commit(wpa_s, ssid,
  467. bss->bssid);
  468. else
  469. resp = sme_auth_build_sae_confirm(wpa_s);
  470. if (resp == NULL) {
  471. wpas_connection_failed(wpa_s, bss->bssid);
  472. return;
  473. }
  474. params.auth_data = wpabuf_head(resp);
  475. params.auth_data_len = wpabuf_len(resp);
  476. wpa_s->sme.sae.state = start ? SAE_COMMITTED : SAE_CONFIRMED;
  477. }
  478. #endif /* CONFIG_SAE */
  479. wpa_supplicant_cancel_sched_scan(wpa_s);
  480. wpa_supplicant_cancel_scan(wpa_s);
  481. wpa_msg(wpa_s, MSG_INFO, "SME: Trying to authenticate with " MACSTR
  482. " (SSID='%s' freq=%d MHz)", MAC2STR(params.bssid),
  483. wpa_ssid_txt(params.ssid, params.ssid_len), params.freq);
  484. wpa_clear_keys(wpa_s, bss->bssid);
  485. wpa_supplicant_set_state(wpa_s, WPA_AUTHENTICATING);
  486. old_ssid = wpa_s->current_ssid;
  487. wpa_s->current_ssid = ssid;
  488. wpa_supplicant_rsn_supp_set_config(wpa_s, wpa_s->current_ssid);
  489. wpa_supplicant_initiate_eapol(wpa_s);
  490. if (old_ssid != wpa_s->current_ssid)
  491. wpas_notify_network_changed(wpa_s);
  492. #ifdef CONFIG_HS20
  493. hs20_configure_frame_filters(wpa_s);
  494. #endif /* CONFIG_HS20 */
  495. #ifdef CONFIG_P2P
  496. /*
  497. * If multi-channel concurrency is not supported, check for any
  498. * frequency conflict. In case of any frequency conflict, remove the
  499. * least prioritized connection.
  500. */
  501. if (wpa_s->num_multichan_concurrent < 2) {
  502. int freq, num;
  503. num = get_shared_radio_freqs(wpa_s, &freq, 1);
  504. if (num > 0 && freq > 0 && freq != params.freq) {
  505. wpa_printf(MSG_DEBUG,
  506. "Conflicting frequency found (%d != %d)",
  507. freq, params.freq);
  508. if (wpas_p2p_handle_frequency_conflicts(wpa_s,
  509. params.freq,
  510. ssid) < 0) {
  511. wpas_connection_failed(wpa_s, bss->bssid);
  512. wpa_supplicant_mark_disassoc(wpa_s);
  513. wpabuf_free(resp);
  514. wpas_connect_work_done(wpa_s);
  515. return;
  516. }
  517. }
  518. }
  519. #endif /* CONFIG_P2P */
  520. if (skip_auth) {
  521. wpa_msg(wpa_s, MSG_DEBUG,
  522. "SME: Skip authentication step on reassoc-to-same-BSS");
  523. wpabuf_free(resp);
  524. sme_associate(wpa_s, ssid->mode, bss->bssid, WLAN_AUTH_OPEN);
  525. return;
  526. }
  527. wpa_s->sme.auth_alg = params.auth_alg;
  528. if (wpa_drv_authenticate(wpa_s, &params) < 0) {
  529. wpa_msg(wpa_s, MSG_INFO, "SME: Authentication request to the "
  530. "driver failed");
  531. wpas_connection_failed(wpa_s, bss->bssid);
  532. wpa_supplicant_mark_disassoc(wpa_s);
  533. wpabuf_free(resp);
  534. wpas_connect_work_done(wpa_s);
  535. return;
  536. }
  537. eloop_register_timeout(SME_AUTH_TIMEOUT, 0, sme_auth_timer, wpa_s,
  538. NULL);
  539. /*
  540. * Association will be started based on the authentication event from
  541. * the driver.
  542. */
  543. wpabuf_free(resp);
  544. }
  545. static void sme_auth_start_cb(struct wpa_radio_work *work, int deinit)
  546. {
  547. struct wpa_connect_work *cwork = work->ctx;
  548. struct wpa_supplicant *wpa_s = work->wpa_s;
  549. if (deinit) {
  550. if (work->started)
  551. wpa_s->connect_work = NULL;
  552. wpas_connect_work_free(cwork);
  553. return;
  554. }
  555. wpa_s->connect_work = work;
  556. if (cwork->bss_removed ||
  557. !wpas_valid_bss_ssid(wpa_s, cwork->bss, cwork->ssid) ||
  558. wpas_network_disabled(wpa_s, cwork->ssid)) {
  559. wpa_dbg(wpa_s, MSG_DEBUG, "SME: BSS/SSID entry for authentication not valid anymore - drop connection attempt");
  560. wpas_connect_work_done(wpa_s);
  561. return;
  562. }
  563. /* Starting new connection, so clear the possibly used WPA IE from the
  564. * previous association. */
  565. wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, NULL, 0);
  566. sme_send_authentication(wpa_s, cwork->bss, cwork->ssid, 1);
  567. }
  568. void sme_authenticate(struct wpa_supplicant *wpa_s,
  569. struct wpa_bss *bss, struct wpa_ssid *ssid)
  570. {
  571. struct wpa_connect_work *cwork;
  572. if (bss == NULL || ssid == NULL)
  573. return;
  574. if (wpa_s->connect_work) {
  575. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Reject sme_authenticate() call since connect_work exist");
  576. return;
  577. }
  578. if (radio_work_pending(wpa_s, "sme-connect")) {
  579. /*
  580. * The previous sme-connect work might no longer be valid due to
  581. * the fact that the BSS list was updated. In addition, it makes
  582. * sense to adhere to the 'newer' decision.
  583. */
  584. wpa_dbg(wpa_s, MSG_DEBUG,
  585. "SME: Remove previous pending sme-connect");
  586. radio_remove_works(wpa_s, "sme-connect", 0);
  587. }
  588. wpas_abort_ongoing_scan(wpa_s);
  589. cwork = os_zalloc(sizeof(*cwork));
  590. if (cwork == NULL)
  591. return;
  592. cwork->bss = bss;
  593. cwork->ssid = ssid;
  594. cwork->sme = 1;
  595. #ifdef CONFIG_SAE
  596. wpa_s->sme.sae.state = SAE_NOTHING;
  597. wpa_s->sme.sae.send_confirm = 0;
  598. wpa_s->sme.sae_group_index = 0;
  599. #endif /* CONFIG_SAE */
  600. if (radio_add_work(wpa_s, bss->freq, "sme-connect", 1,
  601. sme_auth_start_cb, cwork) < 0)
  602. wpas_connect_work_free(cwork);
  603. }
  604. #ifdef CONFIG_SAE
  605. static int sme_sae_auth(struct wpa_supplicant *wpa_s, u16 auth_transaction,
  606. u16 status_code, const u8 *data, size_t len)
  607. {
  608. int *groups;
  609. wpa_dbg(wpa_s, MSG_DEBUG, "SME: SAE authentication transaction %u "
  610. "status code %u", auth_transaction, status_code);
  611. if (auth_transaction == 1 &&
  612. status_code == WLAN_STATUS_ANTI_CLOGGING_TOKEN_REQ &&
  613. wpa_s->sme.sae.state == SAE_COMMITTED &&
  614. wpa_s->current_bss && wpa_s->current_ssid) {
  615. int default_groups[] = { 19, 20, 21, 25, 26, 0 };
  616. u16 group;
  617. groups = wpa_s->conf->sae_groups;
  618. if (!groups || groups[0] <= 0)
  619. groups = default_groups;
  620. if (len < sizeof(le16)) {
  621. wpa_dbg(wpa_s, MSG_DEBUG,
  622. "SME: Too short SAE anti-clogging token request");
  623. return -1;
  624. }
  625. group = WPA_GET_LE16(data);
  626. wpa_dbg(wpa_s, MSG_DEBUG,
  627. "SME: SAE anti-clogging token requested (group %u)",
  628. group);
  629. if (sae_group_allowed(&wpa_s->sme.sae, groups, group) !=
  630. WLAN_STATUS_SUCCESS) {
  631. wpa_dbg(wpa_s, MSG_ERROR,
  632. "SME: SAE group %u of anti-clogging request is invalid",
  633. group);
  634. return -1;
  635. }
  636. wpabuf_free(wpa_s->sme.sae_token);
  637. wpa_s->sme.sae_token = wpabuf_alloc_copy(data + sizeof(le16),
  638. len - sizeof(le16));
  639. sme_send_authentication(wpa_s, wpa_s->current_bss,
  640. wpa_s->current_ssid, 1);
  641. return 0;
  642. }
  643. if (auth_transaction == 1 &&
  644. status_code == WLAN_STATUS_FINITE_CYCLIC_GROUP_NOT_SUPPORTED &&
  645. wpa_s->sme.sae.state == SAE_COMMITTED &&
  646. wpa_s->current_bss && wpa_s->current_ssid) {
  647. wpa_dbg(wpa_s, MSG_DEBUG, "SME: SAE group not supported");
  648. wpa_s->sme.sae_group_index++;
  649. if (sme_set_sae_group(wpa_s) < 0)
  650. return -1; /* no other groups enabled */
  651. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Try next enabled SAE group");
  652. sme_send_authentication(wpa_s, wpa_s->current_bss,
  653. wpa_s->current_ssid, 1);
  654. return 0;
  655. }
  656. if (status_code != WLAN_STATUS_SUCCESS)
  657. return -1;
  658. if (auth_transaction == 1) {
  659. u16 res;
  660. groups = wpa_s->conf->sae_groups;
  661. wpa_dbg(wpa_s, MSG_DEBUG, "SME SAE commit");
  662. if (wpa_s->current_bss == NULL ||
  663. wpa_s->current_ssid == NULL)
  664. return -1;
  665. if (wpa_s->sme.sae.state != SAE_COMMITTED)
  666. return -1;
  667. if (groups && groups[0] <= 0)
  668. groups = NULL;
  669. res = sae_parse_commit(&wpa_s->sme.sae, data, len, NULL, NULL,
  670. groups);
  671. if (res == SAE_SILENTLY_DISCARD) {
  672. wpa_printf(MSG_DEBUG,
  673. "SAE: Drop commit message due to reflection attack");
  674. return 0;
  675. }
  676. if (res != WLAN_STATUS_SUCCESS)
  677. return -1;
  678. if (sae_process_commit(&wpa_s->sme.sae) < 0) {
  679. wpa_printf(MSG_DEBUG, "SAE: Failed to process peer "
  680. "commit");
  681. return -1;
  682. }
  683. wpabuf_free(wpa_s->sme.sae_token);
  684. wpa_s->sme.sae_token = NULL;
  685. sme_send_authentication(wpa_s, wpa_s->current_bss,
  686. wpa_s->current_ssid, 0);
  687. return 0;
  688. } else if (auth_transaction == 2) {
  689. wpa_dbg(wpa_s, MSG_DEBUG, "SME SAE confirm");
  690. if (wpa_s->sme.sae.state != SAE_CONFIRMED)
  691. return -1;
  692. if (sae_check_confirm(&wpa_s->sme.sae, data, len) < 0)
  693. return -1;
  694. wpa_s->sme.sae.state = SAE_ACCEPTED;
  695. sae_clear_temp_data(&wpa_s->sme.sae);
  696. return 1;
  697. }
  698. return -1;
  699. }
  700. #endif /* CONFIG_SAE */
  701. void sme_event_auth(struct wpa_supplicant *wpa_s, union wpa_event_data *data)
  702. {
  703. struct wpa_ssid *ssid = wpa_s->current_ssid;
  704. if (ssid == NULL) {
  705. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Ignore authentication event "
  706. "when network is not selected");
  707. return;
  708. }
  709. if (wpa_s->wpa_state != WPA_AUTHENTICATING) {
  710. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Ignore authentication event "
  711. "when not in authenticating state");
  712. return;
  713. }
  714. if (os_memcmp(wpa_s->pending_bssid, data->auth.peer, ETH_ALEN) != 0) {
  715. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Ignore authentication with "
  716. "unexpected peer " MACSTR,
  717. MAC2STR(data->auth.peer));
  718. return;
  719. }
  720. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Authentication response: peer=" MACSTR
  721. " auth_type=%d auth_transaction=%d status_code=%d",
  722. MAC2STR(data->auth.peer), data->auth.auth_type,
  723. data->auth.auth_transaction, data->auth.status_code);
  724. wpa_hexdump(MSG_MSGDUMP, "SME: Authentication response IEs",
  725. data->auth.ies, data->auth.ies_len);
  726. eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
  727. #ifdef CONFIG_SAE
  728. if (data->auth.auth_type == WLAN_AUTH_SAE) {
  729. int res;
  730. res = sme_sae_auth(wpa_s, data->auth.auth_transaction,
  731. data->auth.status_code, data->auth.ies,
  732. data->auth.ies_len);
  733. if (res < 0) {
  734. wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
  735. wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
  736. }
  737. if (res != 1)
  738. return;
  739. wpa_printf(MSG_DEBUG, "SME: SAE completed - setting PMK for "
  740. "4-way handshake");
  741. wpa_sm_set_pmk(wpa_s->wpa, wpa_s->sme.sae.pmk, PMK_LEN,
  742. wpa_s->sme.sae.pmkid, wpa_s->pending_bssid);
  743. }
  744. #endif /* CONFIG_SAE */
  745. if (data->auth.status_code != WLAN_STATUS_SUCCESS) {
  746. char *ie_txt = NULL;
  747. if (data->auth.ies && data->auth.ies_len) {
  748. size_t buflen = 2 * data->auth.ies_len + 1;
  749. ie_txt = os_malloc(buflen);
  750. if (ie_txt) {
  751. wpa_snprintf_hex(ie_txt, buflen, data->auth.ies,
  752. data->auth.ies_len);
  753. }
  754. }
  755. wpa_msg(wpa_s, MSG_INFO, WPA_EVENT_AUTH_REJECT MACSTR
  756. " auth_type=%u auth_transaction=%u status_code=%u ie=%s",
  757. MAC2STR(data->auth.peer), data->auth.auth_type,
  758. data->auth.auth_transaction, data->auth.status_code,
  759. ie_txt);
  760. os_free(ie_txt);
  761. if (data->auth.status_code !=
  762. WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG ||
  763. wpa_s->sme.auth_alg == data->auth.auth_type ||
  764. wpa_s->current_ssid->auth_alg == WPA_AUTH_ALG_LEAP) {
  765. wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
  766. wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
  767. return;
  768. }
  769. wpas_connect_work_done(wpa_s);
  770. switch (data->auth.auth_type) {
  771. case WLAN_AUTH_OPEN:
  772. wpa_s->current_ssid->auth_alg = WPA_AUTH_ALG_SHARED;
  773. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Trying SHARED auth");
  774. wpa_supplicant_associate(wpa_s, wpa_s->current_bss,
  775. wpa_s->current_ssid);
  776. return;
  777. case WLAN_AUTH_SHARED_KEY:
  778. wpa_s->current_ssid->auth_alg = WPA_AUTH_ALG_LEAP;
  779. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Trying LEAP auth");
  780. wpa_supplicant_associate(wpa_s, wpa_s->current_bss,
  781. wpa_s->current_ssid);
  782. return;
  783. default:
  784. return;
  785. }
  786. }
  787. #ifdef CONFIG_IEEE80211R
  788. if (data->auth.auth_type == WLAN_AUTH_FT) {
  789. if (wpa_ft_process_response(wpa_s->wpa, data->auth.ies,
  790. data->auth.ies_len, 0,
  791. data->auth.peer, NULL, 0) < 0) {
  792. wpa_dbg(wpa_s, MSG_DEBUG,
  793. "SME: FT Authentication response processing failed");
  794. wpa_msg(wpa_s, MSG_INFO, WPA_EVENT_DISCONNECTED "bssid="
  795. MACSTR
  796. " reason=%d locally_generated=1",
  797. MAC2STR(wpa_s->pending_bssid),
  798. WLAN_REASON_DEAUTH_LEAVING);
  799. wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
  800. wpa_supplicant_mark_disassoc(wpa_s);
  801. return;
  802. }
  803. }
  804. #endif /* CONFIG_IEEE80211R */
  805. sme_associate(wpa_s, ssid->mode, data->auth.peer,
  806. data->auth.auth_type);
  807. }
  808. void sme_associate(struct wpa_supplicant *wpa_s, enum wpas_mode mode,
  809. const u8 *bssid, u16 auth_type)
  810. {
  811. struct wpa_driver_associate_params params;
  812. struct ieee802_11_elems elems;
  813. #ifdef CONFIG_HT_OVERRIDES
  814. struct ieee80211_ht_capabilities htcaps;
  815. struct ieee80211_ht_capabilities htcaps_mask;
  816. #endif /* CONFIG_HT_OVERRIDES */
  817. #ifdef CONFIG_VHT_OVERRIDES
  818. struct ieee80211_vht_capabilities vhtcaps;
  819. struct ieee80211_vht_capabilities vhtcaps_mask;
  820. #endif /* CONFIG_VHT_OVERRIDES */
  821. os_memset(&params, 0, sizeof(params));
  822. params.bssid = bssid;
  823. params.ssid = wpa_s->sme.ssid;
  824. params.ssid_len = wpa_s->sme.ssid_len;
  825. params.freq.freq = wpa_s->sme.freq;
  826. params.bg_scan_period = wpa_s->current_ssid ?
  827. wpa_s->current_ssid->bg_scan_period : -1;
  828. params.wpa_ie = wpa_s->sme.assoc_req_ie_len ?
  829. wpa_s->sme.assoc_req_ie : NULL;
  830. params.wpa_ie_len = wpa_s->sme.assoc_req_ie_len;
  831. params.pairwise_suite = wpa_s->pairwise_cipher;
  832. params.group_suite = wpa_s->group_cipher;
  833. params.key_mgmt_suite = wpa_s->key_mgmt;
  834. params.wpa_proto = wpa_s->wpa_proto;
  835. #ifdef CONFIG_HT_OVERRIDES
  836. os_memset(&htcaps, 0, sizeof(htcaps));
  837. os_memset(&htcaps_mask, 0, sizeof(htcaps_mask));
  838. params.htcaps = (u8 *) &htcaps;
  839. params.htcaps_mask = (u8 *) &htcaps_mask;
  840. wpa_supplicant_apply_ht_overrides(wpa_s, wpa_s->current_ssid, &params);
  841. #endif /* CONFIG_HT_OVERRIDES */
  842. #ifdef CONFIG_VHT_OVERRIDES
  843. os_memset(&vhtcaps, 0, sizeof(vhtcaps));
  844. os_memset(&vhtcaps_mask, 0, sizeof(vhtcaps_mask));
  845. params.vhtcaps = &vhtcaps;
  846. params.vhtcaps_mask = &vhtcaps_mask;
  847. wpa_supplicant_apply_vht_overrides(wpa_s, wpa_s->current_ssid, &params);
  848. #endif /* CONFIG_VHT_OVERRIDES */
  849. #ifdef CONFIG_IEEE80211R
  850. if (auth_type == WLAN_AUTH_FT && wpa_s->sme.ft_ies) {
  851. params.wpa_ie = wpa_s->sme.ft_ies;
  852. params.wpa_ie_len = wpa_s->sme.ft_ies_len;
  853. }
  854. #endif /* CONFIG_IEEE80211R */
  855. params.mode = mode;
  856. params.mgmt_frame_protection = wpa_s->sme.mfp;
  857. params.rrm_used = wpa_s->rrm.rrm_used;
  858. if (wpa_s->sme.prev_bssid_set)
  859. params.prev_bssid = wpa_s->sme.prev_bssid;
  860. wpa_msg(wpa_s, MSG_INFO, "Trying to associate with " MACSTR
  861. " (SSID='%s' freq=%d MHz)", MAC2STR(params.bssid),
  862. params.ssid ? wpa_ssid_txt(params.ssid, params.ssid_len) : "",
  863. params.freq.freq);
  864. wpa_supplicant_set_state(wpa_s, WPA_ASSOCIATING);
  865. if (params.wpa_ie == NULL ||
  866. ieee802_11_parse_elems(params.wpa_ie, params.wpa_ie_len, &elems, 0)
  867. < 0) {
  868. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Could not parse own IEs?!");
  869. os_memset(&elems, 0, sizeof(elems));
  870. }
  871. if (elems.rsn_ie) {
  872. params.wpa_proto = WPA_PROTO_RSN;
  873. wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, elems.rsn_ie - 2,
  874. elems.rsn_ie_len + 2);
  875. } else if (elems.wpa_ie) {
  876. params.wpa_proto = WPA_PROTO_WPA;
  877. wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, elems.wpa_ie - 2,
  878. elems.wpa_ie_len + 2);
  879. } else if (elems.osen) {
  880. params.wpa_proto = WPA_PROTO_OSEN;
  881. wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, elems.osen - 2,
  882. elems.osen_len + 2);
  883. } else
  884. wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, NULL, 0);
  885. if (wpa_s->current_ssid && wpa_s->current_ssid->p2p_group)
  886. params.p2p = 1;
  887. if (wpa_s->p2pdev->set_sta_uapsd)
  888. params.uapsd = wpa_s->p2pdev->sta_uapsd;
  889. else
  890. params.uapsd = -1;
  891. if (wpa_drv_associate(wpa_s, &params) < 0) {
  892. wpa_msg(wpa_s, MSG_INFO, "SME: Association request to the "
  893. "driver failed");
  894. wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
  895. wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
  896. os_memset(wpa_s->pending_bssid, 0, ETH_ALEN);
  897. return;
  898. }
  899. eloop_register_timeout(SME_ASSOC_TIMEOUT, 0, sme_assoc_timer, wpa_s,
  900. NULL);
  901. }
  902. int sme_update_ft_ies(struct wpa_supplicant *wpa_s, const u8 *md,
  903. const u8 *ies, size_t ies_len)
  904. {
  905. if (md == NULL || ies == NULL) {
  906. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Remove mobility domain");
  907. os_free(wpa_s->sme.ft_ies);
  908. wpa_s->sme.ft_ies = NULL;
  909. wpa_s->sme.ft_ies_len = 0;
  910. wpa_s->sme.ft_used = 0;
  911. return 0;
  912. }
  913. os_memcpy(wpa_s->sme.mobility_domain, md, MOBILITY_DOMAIN_ID_LEN);
  914. wpa_hexdump(MSG_DEBUG, "SME: FT IEs", ies, ies_len);
  915. os_free(wpa_s->sme.ft_ies);
  916. wpa_s->sme.ft_ies = os_malloc(ies_len);
  917. if (wpa_s->sme.ft_ies == NULL)
  918. return -1;
  919. os_memcpy(wpa_s->sme.ft_ies, ies, ies_len);
  920. wpa_s->sme.ft_ies_len = ies_len;
  921. return 0;
  922. }
  923. static void sme_deauth(struct wpa_supplicant *wpa_s)
  924. {
  925. int bssid_changed;
  926. bssid_changed = !is_zero_ether_addr(wpa_s->bssid);
  927. if (wpa_drv_deauthenticate(wpa_s, wpa_s->pending_bssid,
  928. WLAN_REASON_DEAUTH_LEAVING) < 0) {
  929. wpa_msg(wpa_s, MSG_INFO, "SME: Deauth request to the driver "
  930. "failed");
  931. }
  932. wpa_s->sme.prev_bssid_set = 0;
  933. wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
  934. wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
  935. os_memset(wpa_s->bssid, 0, ETH_ALEN);
  936. os_memset(wpa_s->pending_bssid, 0, ETH_ALEN);
  937. if (bssid_changed)
  938. wpas_notify_bssid_changed(wpa_s);
  939. }
  940. void sme_event_assoc_reject(struct wpa_supplicant *wpa_s,
  941. union wpa_event_data *data)
  942. {
  943. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Association with " MACSTR " failed: "
  944. "status code %d", MAC2STR(wpa_s->pending_bssid),
  945. data->assoc_reject.status_code);
  946. eloop_cancel_timeout(sme_assoc_timer, wpa_s, NULL);
  947. #ifdef CONFIG_SAE
  948. if (wpa_s->sme.sae_pmksa_caching && wpa_s->current_ssid &&
  949. wpa_key_mgmt_sae(wpa_s->current_ssid->key_mgmt)) {
  950. wpa_dbg(wpa_s, MSG_DEBUG,
  951. "PMKSA caching attempt rejected - drop PMKSA cache entry and fall back to SAE authentication");
  952. wpa_sm_aborted_cached(wpa_s->wpa);
  953. wpa_sm_pmksa_cache_flush(wpa_s->wpa, wpa_s->current_ssid);
  954. if (wpa_s->current_bss) {
  955. struct wpa_bss *bss = wpa_s->current_bss;
  956. struct wpa_ssid *ssid = wpa_s->current_ssid;
  957. wpa_drv_deauthenticate(wpa_s, wpa_s->pending_bssid,
  958. WLAN_REASON_DEAUTH_LEAVING);
  959. wpas_connect_work_done(wpa_s);
  960. wpa_supplicant_mark_disassoc(wpa_s);
  961. wpa_supplicant_connect(wpa_s, bss, ssid);
  962. return;
  963. }
  964. }
  965. #endif /* CONFIG_SAE */
  966. /*
  967. * For now, unconditionally terminate the previous authentication. In
  968. * theory, this should not be needed, but mac80211 gets quite confused
  969. * if the authentication is left pending.. Some roaming cases might
  970. * benefit from using the previous authentication, so this could be
  971. * optimized in the future.
  972. */
  973. sme_deauth(wpa_s);
  974. }
  975. void sme_event_auth_timed_out(struct wpa_supplicant *wpa_s,
  976. union wpa_event_data *data)
  977. {
  978. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Authentication timed out");
  979. wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
  980. wpa_supplicant_mark_disassoc(wpa_s);
  981. }
  982. void sme_event_assoc_timed_out(struct wpa_supplicant *wpa_s,
  983. union wpa_event_data *data)
  984. {
  985. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Association timed out");
  986. wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
  987. wpa_supplicant_mark_disassoc(wpa_s);
  988. }
  989. void sme_event_disassoc(struct wpa_supplicant *wpa_s,
  990. struct disassoc_info *info)
  991. {
  992. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Disassociation event received");
  993. if (wpa_s->sme.prev_bssid_set) {
  994. /*
  995. * cfg80211/mac80211 can get into somewhat confused state if
  996. * the AP only disassociates us and leaves us in authenticated
  997. * state. For now, force the state to be cleared to avoid
  998. * confusing errors if we try to associate with the AP again.
  999. */
  1000. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Deauthenticate to clear "
  1001. "driver state");
  1002. wpa_drv_deauthenticate(wpa_s, wpa_s->sme.prev_bssid,
  1003. WLAN_REASON_DEAUTH_LEAVING);
  1004. }
  1005. }
  1006. static void sme_auth_timer(void *eloop_ctx, void *timeout_ctx)
  1007. {
  1008. struct wpa_supplicant *wpa_s = eloop_ctx;
  1009. if (wpa_s->wpa_state == WPA_AUTHENTICATING) {
  1010. wpa_msg(wpa_s, MSG_DEBUG, "SME: Authentication timeout");
  1011. sme_deauth(wpa_s);
  1012. }
  1013. }
  1014. static void sme_assoc_timer(void *eloop_ctx, void *timeout_ctx)
  1015. {
  1016. struct wpa_supplicant *wpa_s = eloop_ctx;
  1017. if (wpa_s->wpa_state == WPA_ASSOCIATING) {
  1018. wpa_msg(wpa_s, MSG_DEBUG, "SME: Association timeout");
  1019. sme_deauth(wpa_s);
  1020. }
  1021. }
  1022. void sme_state_changed(struct wpa_supplicant *wpa_s)
  1023. {
  1024. /* Make sure timers are cleaned up appropriately. */
  1025. if (wpa_s->wpa_state != WPA_ASSOCIATING)
  1026. eloop_cancel_timeout(sme_assoc_timer, wpa_s, NULL);
  1027. if (wpa_s->wpa_state != WPA_AUTHENTICATING)
  1028. eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
  1029. }
  1030. void sme_disassoc_while_authenticating(struct wpa_supplicant *wpa_s,
  1031. const u8 *prev_pending_bssid)
  1032. {
  1033. /*
  1034. * mac80211-workaround to force deauth on failed auth cmd,
  1035. * requires us to remain in authenticating state to allow the
  1036. * second authentication attempt to be continued properly.
  1037. */
  1038. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Allow pending authentication "
  1039. "to proceed after disconnection event");
  1040. wpa_supplicant_set_state(wpa_s, WPA_AUTHENTICATING);
  1041. os_memcpy(wpa_s->pending_bssid, prev_pending_bssid, ETH_ALEN);
  1042. /*
  1043. * Re-arm authentication timer in case auth fails for whatever reason.
  1044. */
  1045. eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
  1046. eloop_register_timeout(SME_AUTH_TIMEOUT, 0, sme_auth_timer, wpa_s,
  1047. NULL);
  1048. }
  1049. void sme_clear_on_disassoc(struct wpa_supplicant *wpa_s)
  1050. {
  1051. wpa_s->sme.prev_bssid_set = 0;
  1052. #ifdef CONFIG_SAE
  1053. wpabuf_free(wpa_s->sme.sae_token);
  1054. wpa_s->sme.sae_token = NULL;
  1055. sae_clear_data(&wpa_s->sme.sae);
  1056. #endif /* CONFIG_SAE */
  1057. #ifdef CONFIG_IEEE80211R
  1058. if (wpa_s->sme.ft_ies)
  1059. sme_update_ft_ies(wpa_s, NULL, NULL, 0);
  1060. #endif /* CONFIG_IEEE80211R */
  1061. }
  1062. void sme_deinit(struct wpa_supplicant *wpa_s)
  1063. {
  1064. os_free(wpa_s->sme.ft_ies);
  1065. wpa_s->sme.ft_ies = NULL;
  1066. wpa_s->sme.ft_ies_len = 0;
  1067. #ifdef CONFIG_IEEE80211W
  1068. sme_stop_sa_query(wpa_s);
  1069. #endif /* CONFIG_IEEE80211W */
  1070. sme_clear_on_disassoc(wpa_s);
  1071. eloop_cancel_timeout(sme_assoc_timer, wpa_s, NULL);
  1072. eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
  1073. eloop_cancel_timeout(sme_obss_scan_timeout, wpa_s, NULL);
  1074. }
  1075. static void sme_send_2040_bss_coex(struct wpa_supplicant *wpa_s,
  1076. const u8 *chan_list, u8 num_channels,
  1077. u8 num_intol)
  1078. {
  1079. struct ieee80211_2040_bss_coex_ie *bc_ie;
  1080. struct ieee80211_2040_intol_chan_report *ic_report;
  1081. struct wpabuf *buf;
  1082. wpa_printf(MSG_DEBUG, "SME: Send 20/40 BSS Coexistence to " MACSTR
  1083. " (num_channels=%u num_intol=%u)",
  1084. MAC2STR(wpa_s->bssid), num_channels, num_intol);
  1085. wpa_hexdump(MSG_DEBUG, "SME: 20/40 BSS Intolerant Channels",
  1086. chan_list, num_channels);
  1087. buf = wpabuf_alloc(2 + /* action.category + action_code */
  1088. sizeof(struct ieee80211_2040_bss_coex_ie) +
  1089. sizeof(struct ieee80211_2040_intol_chan_report) +
  1090. num_channels);
  1091. if (buf == NULL)
  1092. return;
  1093. wpabuf_put_u8(buf, WLAN_ACTION_PUBLIC);
  1094. wpabuf_put_u8(buf, WLAN_PA_20_40_BSS_COEX);
  1095. bc_ie = wpabuf_put(buf, sizeof(*bc_ie));
  1096. bc_ie->element_id = WLAN_EID_20_40_BSS_COEXISTENCE;
  1097. bc_ie->length = 1;
  1098. if (num_intol)
  1099. bc_ie->coex_param |= WLAN_20_40_BSS_COEX_20MHZ_WIDTH_REQ;
  1100. if (num_channels > 0) {
  1101. ic_report = wpabuf_put(buf, sizeof(*ic_report));
  1102. ic_report->element_id = WLAN_EID_20_40_BSS_INTOLERANT;
  1103. ic_report->length = num_channels + 1;
  1104. ic_report->op_class = 0;
  1105. os_memcpy(wpabuf_put(buf, num_channels), chan_list,
  1106. num_channels);
  1107. }
  1108. if (wpa_drv_send_action(wpa_s, wpa_s->assoc_freq, 0, wpa_s->bssid,
  1109. wpa_s->own_addr, wpa_s->bssid,
  1110. wpabuf_head(buf), wpabuf_len(buf), 0) < 0) {
  1111. wpa_msg(wpa_s, MSG_INFO,
  1112. "SME: Failed to send 20/40 BSS Coexistence frame");
  1113. }
  1114. wpabuf_free(buf);
  1115. }
  1116. int sme_proc_obss_scan(struct wpa_supplicant *wpa_s)
  1117. {
  1118. struct wpa_bss *bss;
  1119. const u8 *ie;
  1120. u16 ht_cap;
  1121. u8 chan_list[P2P_MAX_CHANNELS], channel;
  1122. u8 num_channels = 0, num_intol = 0, i;
  1123. if (!wpa_s->sme.sched_obss_scan)
  1124. return 0;
  1125. wpa_s->sme.sched_obss_scan = 0;
  1126. if (!wpa_s->current_bss || wpa_s->wpa_state != WPA_COMPLETED)
  1127. return 1;
  1128. /*
  1129. * Check whether AP uses regulatory triplet or channel triplet in
  1130. * country info. Right now the operating class of the BSS channel
  1131. * width trigger event is "unknown" (IEEE Std 802.11-2012 10.15.12),
  1132. * based on the assumption that operating class triplet is not used in
  1133. * beacon frame. If the First Channel Number/Operating Extension
  1134. * Identifier octet has a positive integer value of 201 or greater,
  1135. * then its operating class triplet.
  1136. *
  1137. * TODO: If Supported Operating Classes element is present in beacon
  1138. * frame, have to lookup operating class in Annex E and fill them in
  1139. * 2040 coex frame.
  1140. */
  1141. ie = wpa_bss_get_ie(wpa_s->current_bss, WLAN_EID_COUNTRY);
  1142. if (ie && (ie[1] >= 6) && (ie[5] >= 201))
  1143. return 1;
  1144. os_memset(chan_list, 0, sizeof(chan_list));
  1145. dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
  1146. /* Skip other band bss */
  1147. enum hostapd_hw_mode mode;
  1148. mode = ieee80211_freq_to_chan(bss->freq, &channel);
  1149. if (mode != HOSTAPD_MODE_IEEE80211G &&
  1150. mode != HOSTAPD_MODE_IEEE80211B)
  1151. continue;
  1152. ie = wpa_bss_get_ie(bss, WLAN_EID_HT_CAP);
  1153. ht_cap = (ie && (ie[1] == 26)) ? WPA_GET_LE16(ie + 2) : 0;
  1154. wpa_printf(MSG_DEBUG, "SME OBSS scan BSS " MACSTR
  1155. " freq=%u chan=%u ht_cap=0x%x",
  1156. MAC2STR(bss->bssid), bss->freq, channel, ht_cap);
  1157. if (!ht_cap || (ht_cap & HT_CAP_INFO_40MHZ_INTOLERANT)) {
  1158. if (ht_cap & HT_CAP_INFO_40MHZ_INTOLERANT)
  1159. num_intol++;
  1160. /* Check whether the channel is already considered */
  1161. for (i = 0; i < num_channels; i++) {
  1162. if (channel == chan_list[i])
  1163. break;
  1164. }
  1165. if (i != num_channels)
  1166. continue;
  1167. chan_list[num_channels++] = channel;
  1168. }
  1169. }
  1170. sme_send_2040_bss_coex(wpa_s, chan_list, num_channels, num_intol);
  1171. return 1;
  1172. }
  1173. static void wpa_obss_scan_freqs_list(struct wpa_supplicant *wpa_s,
  1174. struct wpa_driver_scan_params *params)
  1175. {
  1176. /* Include only affected channels */
  1177. struct hostapd_hw_modes *mode;
  1178. int count, i;
  1179. int start, end;
  1180. mode = get_mode(wpa_s->hw.modes, wpa_s->hw.num_modes,
  1181. HOSTAPD_MODE_IEEE80211G);
  1182. if (mode == NULL) {
  1183. /* No channels supported in this band - use empty list */
  1184. params->freqs = os_zalloc(sizeof(int));
  1185. return;
  1186. }
  1187. if (wpa_s->sme.ht_sec_chan == HT_SEC_CHAN_UNKNOWN &&
  1188. wpa_s->current_bss) {
  1189. const u8 *ie;
  1190. ie = wpa_bss_get_ie(wpa_s->current_bss, WLAN_EID_HT_OPERATION);
  1191. if (ie && ie[1] >= 2) {
  1192. u8 o;
  1193. o = ie[3] & HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK;
  1194. if (o == HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE)
  1195. wpa_s->sme.ht_sec_chan = HT_SEC_CHAN_ABOVE;
  1196. else if (o == HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW)
  1197. wpa_s->sme.ht_sec_chan = HT_SEC_CHAN_BELOW;
  1198. }
  1199. }
  1200. start = wpa_s->assoc_freq - 10;
  1201. end = wpa_s->assoc_freq + 10;
  1202. switch (wpa_s->sme.ht_sec_chan) {
  1203. case HT_SEC_CHAN_UNKNOWN:
  1204. /* HT40+ possible on channels 1..9 */
  1205. if (wpa_s->assoc_freq <= 2452)
  1206. start -= 20;
  1207. /* HT40- possible on channels 5-13 */
  1208. if (wpa_s->assoc_freq >= 2432)
  1209. end += 20;
  1210. break;
  1211. case HT_SEC_CHAN_ABOVE:
  1212. end += 20;
  1213. break;
  1214. case HT_SEC_CHAN_BELOW:
  1215. start -= 20;
  1216. break;
  1217. }
  1218. wpa_printf(MSG_DEBUG,
  1219. "OBSS: assoc_freq %d possible affected range %d-%d",
  1220. wpa_s->assoc_freq, start, end);
  1221. params->freqs = os_calloc(mode->num_channels + 1, sizeof(int));
  1222. if (params->freqs == NULL)
  1223. return;
  1224. for (count = 0, i = 0; i < mode->num_channels; i++) {
  1225. int freq;
  1226. if (mode->channels[i].flag & HOSTAPD_CHAN_DISABLED)
  1227. continue;
  1228. freq = mode->channels[i].freq;
  1229. if (freq - 10 >= end || freq + 10 <= start)
  1230. continue; /* not affected */
  1231. params->freqs[count++] = freq;
  1232. }
  1233. }
  1234. static void sme_obss_scan_timeout(void *eloop_ctx, void *timeout_ctx)
  1235. {
  1236. struct wpa_supplicant *wpa_s = eloop_ctx;
  1237. struct wpa_driver_scan_params params;
  1238. if (!wpa_s->current_bss) {
  1239. wpa_printf(MSG_DEBUG, "SME OBSS: Ignore scan request");
  1240. return;
  1241. }
  1242. os_memset(&params, 0, sizeof(params));
  1243. wpa_obss_scan_freqs_list(wpa_s, &params);
  1244. params.low_priority = 1;
  1245. wpa_printf(MSG_DEBUG, "SME OBSS: Request an OBSS scan");
  1246. if (wpa_supplicant_trigger_scan(wpa_s, &params))
  1247. wpa_printf(MSG_DEBUG, "SME OBSS: Failed to trigger scan");
  1248. else
  1249. wpa_s->sme.sched_obss_scan = 1;
  1250. os_free(params.freqs);
  1251. eloop_register_timeout(wpa_s->sme.obss_scan_int, 0,
  1252. sme_obss_scan_timeout, wpa_s, NULL);
  1253. }
  1254. void sme_sched_obss_scan(struct wpa_supplicant *wpa_s, int enable)
  1255. {
  1256. const u8 *ie;
  1257. struct wpa_bss *bss = wpa_s->current_bss;
  1258. struct wpa_ssid *ssid = wpa_s->current_ssid;
  1259. struct hostapd_hw_modes *hw_mode = NULL;
  1260. int i;
  1261. eloop_cancel_timeout(sme_obss_scan_timeout, wpa_s, NULL);
  1262. wpa_s->sme.sched_obss_scan = 0;
  1263. wpa_s->sme.ht_sec_chan = HT_SEC_CHAN_UNKNOWN;
  1264. if (!enable)
  1265. return;
  1266. /*
  1267. * Schedule OBSS scan if driver is using station SME in wpa_supplicant
  1268. * or it expects OBSS scan to be performed by wpa_supplicant.
  1269. */
  1270. if (!((wpa_s->drv_flags & WPA_DRIVER_FLAGS_SME) ||
  1271. (wpa_s->drv_flags & WPA_DRIVER_FLAGS_OBSS_SCAN)) ||
  1272. ssid == NULL || ssid->mode != IEEE80211_MODE_INFRA)
  1273. return;
  1274. if (!wpa_s->hw.modes)
  1275. return;
  1276. /* only HT caps in 11g mode are relevant */
  1277. for (i = 0; i < wpa_s->hw.num_modes; i++) {
  1278. hw_mode = &wpa_s->hw.modes[i];
  1279. if (hw_mode->mode == HOSTAPD_MODE_IEEE80211G)
  1280. break;
  1281. }
  1282. /* Driver does not support HT40 for 11g or doesn't have 11g. */
  1283. if (i == wpa_s->hw.num_modes || !hw_mode ||
  1284. !(hw_mode->ht_capab & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET))
  1285. return;
  1286. if (bss == NULL || bss->freq < 2400 || bss->freq > 2500)
  1287. return; /* Not associated on 2.4 GHz band */
  1288. /* Check whether AP supports HT40 */
  1289. ie = wpa_bss_get_ie(wpa_s->current_bss, WLAN_EID_HT_CAP);
  1290. if (!ie || ie[1] < 2 ||
  1291. !(WPA_GET_LE16(ie + 2) & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET))
  1292. return; /* AP does not support HT40 */
  1293. ie = wpa_bss_get_ie(wpa_s->current_bss,
  1294. WLAN_EID_OVERLAPPING_BSS_SCAN_PARAMS);
  1295. if (!ie || ie[1] < 14)
  1296. return; /* AP does not request OBSS scans */
  1297. wpa_s->sme.obss_scan_int = WPA_GET_LE16(ie + 6);
  1298. if (wpa_s->sme.obss_scan_int < 10) {
  1299. wpa_printf(MSG_DEBUG, "SME: Invalid OBSS Scan Interval %u "
  1300. "replaced with the minimum 10 sec",
  1301. wpa_s->sme.obss_scan_int);
  1302. wpa_s->sme.obss_scan_int = 10;
  1303. }
  1304. wpa_printf(MSG_DEBUG, "SME: OBSS Scan Interval %u sec",
  1305. wpa_s->sme.obss_scan_int);
  1306. eloop_register_timeout(wpa_s->sme.obss_scan_int, 0,
  1307. sme_obss_scan_timeout, wpa_s, NULL);
  1308. }
  1309. #ifdef CONFIG_IEEE80211W
  1310. static const unsigned int sa_query_max_timeout = 1000;
  1311. static const unsigned int sa_query_retry_timeout = 201;
  1312. static int sme_check_sa_query_timeout(struct wpa_supplicant *wpa_s)
  1313. {
  1314. u32 tu;
  1315. struct os_reltime now, passed;
  1316. os_get_reltime(&now);
  1317. os_reltime_sub(&now, &wpa_s->sme.sa_query_start, &passed);
  1318. tu = (passed.sec * 1000000 + passed.usec) / 1024;
  1319. if (sa_query_max_timeout < tu) {
  1320. wpa_dbg(wpa_s, MSG_DEBUG, "SME: SA Query timed out");
  1321. sme_stop_sa_query(wpa_s);
  1322. wpa_supplicant_deauthenticate(
  1323. wpa_s, WLAN_REASON_PREV_AUTH_NOT_VALID);
  1324. return 1;
  1325. }
  1326. return 0;
  1327. }
  1328. static void sme_send_sa_query_req(struct wpa_supplicant *wpa_s,
  1329. const u8 *trans_id)
  1330. {
  1331. u8 req[2 + WLAN_SA_QUERY_TR_ID_LEN];
  1332. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Sending SA Query Request to "
  1333. MACSTR, MAC2STR(wpa_s->bssid));
  1334. wpa_hexdump(MSG_DEBUG, "SME: SA Query Transaction ID",
  1335. trans_id, WLAN_SA_QUERY_TR_ID_LEN);
  1336. req[0] = WLAN_ACTION_SA_QUERY;
  1337. req[1] = WLAN_SA_QUERY_REQUEST;
  1338. os_memcpy(req + 2, trans_id, WLAN_SA_QUERY_TR_ID_LEN);
  1339. if (wpa_drv_send_action(wpa_s, wpa_s->assoc_freq, 0, wpa_s->bssid,
  1340. wpa_s->own_addr, wpa_s->bssid,
  1341. req, sizeof(req), 0) < 0)
  1342. wpa_msg(wpa_s, MSG_INFO, "SME: Failed to send SA Query "
  1343. "Request");
  1344. }
  1345. static void sme_sa_query_timer(void *eloop_ctx, void *timeout_ctx)
  1346. {
  1347. struct wpa_supplicant *wpa_s = eloop_ctx;
  1348. unsigned int timeout, sec, usec;
  1349. u8 *trans_id, *nbuf;
  1350. if (wpa_s->sme.sa_query_count > 0 &&
  1351. sme_check_sa_query_timeout(wpa_s))
  1352. return;
  1353. nbuf = os_realloc_array(wpa_s->sme.sa_query_trans_id,
  1354. wpa_s->sme.sa_query_count + 1,
  1355. WLAN_SA_QUERY_TR_ID_LEN);
  1356. if (nbuf == NULL) {
  1357. sme_stop_sa_query(wpa_s);
  1358. return;
  1359. }
  1360. if (wpa_s->sme.sa_query_count == 0) {
  1361. /* Starting a new SA Query procedure */
  1362. os_get_reltime(&wpa_s->sme.sa_query_start);
  1363. }
  1364. trans_id = nbuf + wpa_s->sme.sa_query_count * WLAN_SA_QUERY_TR_ID_LEN;
  1365. wpa_s->sme.sa_query_trans_id = nbuf;
  1366. wpa_s->sme.sa_query_count++;
  1367. if (os_get_random(trans_id, WLAN_SA_QUERY_TR_ID_LEN) < 0) {
  1368. wpa_printf(MSG_DEBUG, "Could not generate SA Query ID");
  1369. sme_stop_sa_query(wpa_s);
  1370. return;
  1371. }
  1372. timeout = sa_query_retry_timeout;
  1373. sec = ((timeout / 1000) * 1024) / 1000;
  1374. usec = (timeout % 1000) * 1024;
  1375. eloop_register_timeout(sec, usec, sme_sa_query_timer, wpa_s, NULL);
  1376. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Association SA Query attempt %d",
  1377. wpa_s->sme.sa_query_count);
  1378. sme_send_sa_query_req(wpa_s, trans_id);
  1379. }
  1380. static void sme_start_sa_query(struct wpa_supplicant *wpa_s)
  1381. {
  1382. sme_sa_query_timer(wpa_s, NULL);
  1383. }
  1384. static void sme_stop_sa_query(struct wpa_supplicant *wpa_s)
  1385. {
  1386. eloop_cancel_timeout(sme_sa_query_timer, wpa_s, NULL);
  1387. os_free(wpa_s->sme.sa_query_trans_id);
  1388. wpa_s->sme.sa_query_trans_id = NULL;
  1389. wpa_s->sme.sa_query_count = 0;
  1390. }
  1391. void sme_event_unprot_disconnect(struct wpa_supplicant *wpa_s, const u8 *sa,
  1392. const u8 *da, u16 reason_code)
  1393. {
  1394. struct wpa_ssid *ssid;
  1395. struct os_reltime now;
  1396. if (wpa_s->wpa_state != WPA_COMPLETED)
  1397. return;
  1398. ssid = wpa_s->current_ssid;
  1399. if (wpas_get_ssid_pmf(wpa_s, ssid) == NO_MGMT_FRAME_PROTECTION)
  1400. return;
  1401. if (os_memcmp(sa, wpa_s->bssid, ETH_ALEN) != 0)
  1402. return;
  1403. if (reason_code != WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA &&
  1404. reason_code != WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA)
  1405. return;
  1406. if (wpa_s->sme.sa_query_count > 0)
  1407. return;
  1408. os_get_reltime(&now);
  1409. if (wpa_s->sme.last_unprot_disconnect.sec &&
  1410. !os_reltime_expired(&now, &wpa_s->sme.last_unprot_disconnect, 10))
  1411. return; /* limit SA Query procedure frequency */
  1412. wpa_s->sme.last_unprot_disconnect = now;
  1413. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Unprotected disconnect dropped - "
  1414. "possible AP/STA state mismatch - trigger SA Query");
  1415. sme_start_sa_query(wpa_s);
  1416. }
  1417. void sme_sa_query_rx(struct wpa_supplicant *wpa_s, const u8 *sa,
  1418. const u8 *data, size_t len)
  1419. {
  1420. int i;
  1421. if (wpa_s->sme.sa_query_trans_id == NULL ||
  1422. len < 1 + WLAN_SA_QUERY_TR_ID_LEN ||
  1423. data[0] != WLAN_SA_QUERY_RESPONSE)
  1424. return;
  1425. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Received SA Query response from "
  1426. MACSTR " (trans_id %02x%02x)", MAC2STR(sa), data[1], data[2]);
  1427. if (os_memcmp(sa, wpa_s->bssid, ETH_ALEN) != 0)
  1428. return;
  1429. for (i = 0; i < wpa_s->sme.sa_query_count; i++) {
  1430. if (os_memcmp(wpa_s->sme.sa_query_trans_id +
  1431. i * WLAN_SA_QUERY_TR_ID_LEN,
  1432. data + 1, WLAN_SA_QUERY_TR_ID_LEN) == 0)
  1433. break;
  1434. }
  1435. if (i >= wpa_s->sme.sa_query_count) {
  1436. wpa_dbg(wpa_s, MSG_DEBUG, "SME: No matching SA Query "
  1437. "transaction identifier found");
  1438. return;
  1439. }
  1440. wpa_dbg(wpa_s, MSG_DEBUG, "SME: Reply to pending SA Query received "
  1441. "from " MACSTR, MAC2STR(sa));
  1442. sme_stop_sa_query(wpa_s);
  1443. }
  1444. #endif /* CONFIG_IEEE80211W */