wps_supplicant.c 78 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920
  1. /*
  2. * wpa_supplicant / WPS integration
  3. * Copyright (c) 2008-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 "eloop.h"
  11. #include "uuid.h"
  12. #include "crypto/random.h"
  13. #include "crypto/dh_group5.h"
  14. #include "common/ieee802_11_defs.h"
  15. #include "common/ieee802_11_common.h"
  16. #include "common/wpa_common.h"
  17. #include "common/wpa_ctrl.h"
  18. #include "eap_common/eap_wsc_common.h"
  19. #include "eap_peer/eap.h"
  20. #include "eapol_supp/eapol_supp_sm.h"
  21. #include "rsn_supp/wpa.h"
  22. #include "wps/wps_attr_parse.h"
  23. #include "config.h"
  24. #include "wpa_supplicant_i.h"
  25. #include "driver_i.h"
  26. #include "notify.h"
  27. #include "blacklist.h"
  28. #include "bss.h"
  29. #include "scan.h"
  30. #include "ap.h"
  31. #include "p2p/p2p.h"
  32. #include "p2p_supplicant.h"
  33. #include "wps_supplicant.h"
  34. #ifndef WPS_PIN_SCAN_IGNORE_SEL_REG
  35. #define WPS_PIN_SCAN_IGNORE_SEL_REG 3
  36. #endif /* WPS_PIN_SCAN_IGNORE_SEL_REG */
  37. /*
  38. * The minimum time in seconds before trying to associate to a WPS PIN AP that
  39. * does not have Selected Registrar TRUE.
  40. */
  41. #ifndef WPS_PIN_TIME_IGNORE_SEL_REG
  42. #define WPS_PIN_TIME_IGNORE_SEL_REG 5
  43. #endif /* WPS_PIN_TIME_IGNORE_SEL_REG */
  44. static void wpas_wps_timeout(void *eloop_ctx, void *timeout_ctx);
  45. static void wpas_clear_wps(struct wpa_supplicant *wpa_s);
  46. static void wpas_wps_clear_ap_info(struct wpa_supplicant *wpa_s)
  47. {
  48. os_free(wpa_s->wps_ap);
  49. wpa_s->wps_ap = NULL;
  50. wpa_s->num_wps_ap = 0;
  51. wpa_s->wps_ap_iter = 0;
  52. }
  53. static void wpas_wps_assoc_with_cred(void *eloop_ctx, void *timeout_ctx)
  54. {
  55. struct wpa_supplicant *wpa_s = eloop_ctx;
  56. int use_fast_assoc = timeout_ctx != NULL;
  57. wpa_printf(MSG_DEBUG, "WPS: Continuing association after eapol_cb");
  58. if (!use_fast_assoc ||
  59. wpa_supplicant_fast_associate(wpa_s) != 1)
  60. wpa_supplicant_req_scan(wpa_s, 0, 0);
  61. }
  62. static void wpas_wps_assoc_with_cred_cancel(struct wpa_supplicant *wpa_s)
  63. {
  64. eloop_cancel_timeout(wpas_wps_assoc_with_cred, wpa_s, (void *) 0);
  65. eloop_cancel_timeout(wpas_wps_assoc_with_cred, wpa_s, (void *) 1);
  66. }
  67. int wpas_wps_eapol_cb(struct wpa_supplicant *wpa_s)
  68. {
  69. if (wpas_p2p_wps_eapol_cb(wpa_s) > 0)
  70. return 1;
  71. if (!wpa_s->wps_success &&
  72. wpa_s->current_ssid &&
  73. eap_is_wps_pin_enrollee(&wpa_s->current_ssid->eap)) {
  74. const u8 *bssid = wpa_s->bssid;
  75. if (is_zero_ether_addr(bssid))
  76. bssid = wpa_s->pending_bssid;
  77. wpa_printf(MSG_DEBUG, "WPS: PIN registration with " MACSTR
  78. " did not succeed - continue trying to find "
  79. "suitable AP", MAC2STR(bssid));
  80. wpa_blacklist_add(wpa_s, bssid);
  81. wpa_supplicant_deauthenticate(wpa_s,
  82. WLAN_REASON_DEAUTH_LEAVING);
  83. wpa_s->reassociate = 1;
  84. wpa_supplicant_req_scan(wpa_s,
  85. wpa_s->blacklist_cleared ? 5 : 0, 0);
  86. wpa_s->blacklist_cleared = 0;
  87. return 1;
  88. }
  89. wpas_wps_clear_ap_info(wpa_s);
  90. eloop_cancel_timeout(wpas_wps_timeout, wpa_s, NULL);
  91. if (wpa_s->key_mgmt == WPA_KEY_MGMT_WPS && !wpa_s->wps_success)
  92. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_FAIL);
  93. if (wpa_s->key_mgmt == WPA_KEY_MGMT_WPS && wpa_s->current_ssid &&
  94. !(wpa_s->current_ssid->key_mgmt & WPA_KEY_MGMT_WPS)) {
  95. int disabled = wpa_s->current_ssid->disabled;
  96. unsigned int freq = wpa_s->assoc_freq;
  97. struct wpa_bss *bss;
  98. struct wpa_ssid *ssid = NULL;
  99. int use_fast_assoc = 0;
  100. wpa_printf(MSG_DEBUG, "WPS: Network configuration replaced - "
  101. "try to associate with the received credential "
  102. "(freq=%u)", freq);
  103. wpa_s->own_disconnect_req = 1;
  104. wpa_supplicant_deauthenticate(wpa_s,
  105. WLAN_REASON_DEAUTH_LEAVING);
  106. if (disabled) {
  107. wpa_printf(MSG_DEBUG, "WPS: Current network is "
  108. "disabled - wait for user to enable");
  109. return 1;
  110. }
  111. wpa_s->after_wps = 5;
  112. wpa_s->wps_freq = freq;
  113. wpa_s->normal_scans = 0;
  114. wpa_s->reassociate = 1;
  115. wpa_printf(MSG_DEBUG, "WPS: Checking whether fast association "
  116. "without a new scan can be used");
  117. bss = wpa_supplicant_pick_network(wpa_s, &ssid);
  118. if (bss) {
  119. struct wpabuf *wps;
  120. struct wps_parse_attr attr;
  121. wps = wpa_bss_get_vendor_ie_multi(bss,
  122. WPS_IE_VENDOR_TYPE);
  123. if (wps && wps_parse_msg(wps, &attr) == 0 &&
  124. attr.wps_state &&
  125. *attr.wps_state == WPS_STATE_CONFIGURED)
  126. use_fast_assoc = 1;
  127. wpabuf_free(wps);
  128. }
  129. /*
  130. * Complete the next step from an eloop timeout to allow pending
  131. * driver events related to the disconnection to be processed
  132. * first. This makes it less likely for disconnection event to
  133. * cause problems with the following connection.
  134. */
  135. wpa_printf(MSG_DEBUG, "WPS: Continue association from timeout");
  136. wpas_wps_assoc_with_cred_cancel(wpa_s);
  137. eloop_register_timeout(0, 10000,
  138. wpas_wps_assoc_with_cred, wpa_s,
  139. use_fast_assoc ? (void *) 1 :
  140. (void *) 0);
  141. return 1;
  142. }
  143. if (wpa_s->key_mgmt == WPA_KEY_MGMT_WPS && wpa_s->current_ssid) {
  144. wpa_printf(MSG_DEBUG, "WPS: Registration completed - waiting "
  145. "for external credential processing");
  146. wpas_clear_wps(wpa_s);
  147. wpa_s->own_disconnect_req = 1;
  148. wpa_supplicant_deauthenticate(wpa_s,
  149. WLAN_REASON_DEAUTH_LEAVING);
  150. return 1;
  151. }
  152. return 0;
  153. }
  154. static void wpas_wps_security_workaround(struct wpa_supplicant *wpa_s,
  155. struct wpa_ssid *ssid,
  156. const struct wps_credential *cred)
  157. {
  158. struct wpa_driver_capa capa;
  159. struct wpa_bss *bss;
  160. const u8 *ie;
  161. struct wpa_ie_data adv;
  162. int wpa2 = 0, ccmp = 0;
  163. /*
  164. * Many existing WPS APs do not know how to negotiate WPA2 or CCMP in
  165. * case they are configured for mixed mode operation (WPA+WPA2 and
  166. * TKIP+CCMP). Try to use scan results to figure out whether the AP
  167. * actually supports stronger security and select that if the client
  168. * has support for it, too.
  169. */
  170. if (wpa_drv_get_capa(wpa_s, &capa))
  171. return; /* Unknown what driver supports */
  172. if (ssid->ssid == NULL)
  173. return;
  174. bss = wpa_bss_get(wpa_s, cred->mac_addr, ssid->ssid, ssid->ssid_len);
  175. if (bss == NULL) {
  176. wpa_printf(MSG_DEBUG, "WPS: The AP was not found from BSS "
  177. "table - use credential as-is");
  178. return;
  179. }
  180. wpa_printf(MSG_DEBUG, "WPS: AP found from BSS table");
  181. ie = wpa_bss_get_ie(bss, WLAN_EID_RSN);
  182. if (ie && wpa_parse_wpa_ie(ie, 2 + ie[1], &adv) == 0) {
  183. wpa2 = 1;
  184. if (adv.pairwise_cipher & WPA_CIPHER_CCMP)
  185. ccmp = 1;
  186. } else {
  187. ie = wpa_bss_get_vendor_ie(bss, WPA_IE_VENDOR_TYPE);
  188. if (ie && wpa_parse_wpa_ie(ie, 2 + ie[1], &adv) == 0 &&
  189. adv.pairwise_cipher & WPA_CIPHER_CCMP)
  190. ccmp = 1;
  191. }
  192. if (ie == NULL && (ssid->proto & WPA_PROTO_WPA) &&
  193. (ssid->pairwise_cipher & WPA_CIPHER_TKIP)) {
  194. /*
  195. * TODO: This could be the initial AP configuration and the
  196. * Beacon contents could change shortly. Should request a new
  197. * scan and delay addition of the network until the updated
  198. * scan results are available.
  199. */
  200. wpa_printf(MSG_DEBUG, "WPS: The AP did not yet advertise WPA "
  201. "support - use credential as-is");
  202. return;
  203. }
  204. if (ccmp && !(ssid->pairwise_cipher & WPA_CIPHER_CCMP) &&
  205. (ssid->pairwise_cipher & WPA_CIPHER_TKIP) &&
  206. (capa.key_mgmt & WPA_DRIVER_CAPA_KEY_MGMT_WPA2_PSK)) {
  207. wpa_printf(MSG_DEBUG, "WPS: Add CCMP into the credential "
  208. "based on scan results");
  209. if (wpa_s->conf->ap_scan == 1)
  210. ssid->pairwise_cipher |= WPA_CIPHER_CCMP;
  211. else
  212. ssid->pairwise_cipher = WPA_CIPHER_CCMP;
  213. }
  214. if (wpa2 && !(ssid->proto & WPA_PROTO_RSN) &&
  215. (ssid->proto & WPA_PROTO_WPA) &&
  216. (capa.enc & WPA_DRIVER_CAPA_ENC_CCMP)) {
  217. wpa_printf(MSG_DEBUG, "WPS: Add WPA2 into the credential "
  218. "based on scan results");
  219. if (wpa_s->conf->ap_scan == 1)
  220. ssid->proto |= WPA_PROTO_RSN;
  221. else
  222. ssid->proto = WPA_PROTO_RSN;
  223. }
  224. }
  225. static void wpas_wps_remove_dup_network(struct wpa_supplicant *wpa_s,
  226. struct wpa_ssid *new_ssid)
  227. {
  228. struct wpa_ssid *ssid, *next;
  229. for (ssid = wpa_s->conf->ssid, next = ssid ? ssid->next : NULL; ssid;
  230. ssid = next, next = ssid ? ssid->next : NULL) {
  231. /*
  232. * new_ssid has already been added to the list in
  233. * wpas_wps_add_network(), so skip it.
  234. */
  235. if (ssid == new_ssid)
  236. continue;
  237. if (ssid->bssid_set || new_ssid->bssid_set) {
  238. if (ssid->bssid_set != new_ssid->bssid_set)
  239. continue;
  240. if (os_memcmp(ssid->bssid, new_ssid->bssid, ETH_ALEN) !=
  241. 0)
  242. continue;
  243. }
  244. /* compare SSID */
  245. if (ssid->ssid_len == 0 || ssid->ssid_len != new_ssid->ssid_len)
  246. continue;
  247. if (ssid->ssid && new_ssid->ssid) {
  248. if (os_memcmp(ssid->ssid, new_ssid->ssid,
  249. ssid->ssid_len) != 0)
  250. continue;
  251. } else if (ssid->ssid || new_ssid->ssid)
  252. continue;
  253. /* compare security parameters */
  254. if (ssid->auth_alg != new_ssid->auth_alg ||
  255. ssid->key_mgmt != new_ssid->key_mgmt ||
  256. (ssid->group_cipher != new_ssid->group_cipher &&
  257. !(ssid->group_cipher & new_ssid->group_cipher &
  258. WPA_CIPHER_CCMP)))
  259. continue;
  260. /*
  261. * Some existing WPS APs will send two creds in case they are
  262. * configured for mixed mode operation (WPA+WPA2 and TKIP+CCMP).
  263. * Try to merge these two creds if they are received in the same
  264. * M8 message.
  265. */
  266. if (ssid->wps_run && ssid->wps_run == new_ssid->wps_run &&
  267. wpa_key_mgmt_wpa_psk(ssid->key_mgmt)) {
  268. if (new_ssid->passphrase && ssid->passphrase &&
  269. os_strcmp(new_ssid->passphrase, ssid->passphrase) !=
  270. 0) {
  271. wpa_printf(MSG_DEBUG,
  272. "WPS: M8 Creds with different passphrase - do not merge");
  273. continue;
  274. }
  275. if (new_ssid->psk_set &&
  276. (!ssid->psk_set ||
  277. os_memcmp(new_ssid->psk, ssid->psk, 32) != 0)) {
  278. wpa_printf(MSG_DEBUG,
  279. "WPS: M8 Creds with different PSK - do not merge");
  280. continue;
  281. }
  282. if ((new_ssid->passphrase && !ssid->passphrase) ||
  283. (!new_ssid->passphrase && ssid->passphrase)) {
  284. wpa_printf(MSG_DEBUG,
  285. "WPS: M8 Creds with different passphrase/PSK type - do not merge");
  286. continue;
  287. }
  288. wpa_printf(MSG_DEBUG,
  289. "WPS: Workaround - merge likely WPA/WPA2-mixed mode creds in same M8 message");
  290. new_ssid->proto |= ssid->proto;
  291. new_ssid->pairwise_cipher |= ssid->pairwise_cipher;
  292. } else {
  293. /*
  294. * proto and pairwise_cipher difference matter for
  295. * non-mixed-mode creds.
  296. */
  297. if (ssid->proto != new_ssid->proto ||
  298. ssid->pairwise_cipher != new_ssid->pairwise_cipher)
  299. continue;
  300. }
  301. /* Remove the duplicated older network entry. */
  302. wpa_printf(MSG_DEBUG, "Remove duplicate network %d", ssid->id);
  303. wpas_notify_network_removed(wpa_s, ssid);
  304. if (wpa_s->current_ssid == ssid)
  305. wpa_s->current_ssid = NULL;
  306. wpa_config_remove_network(wpa_s->conf, ssid->id);
  307. }
  308. }
  309. static int wpa_supplicant_wps_cred(void *ctx,
  310. const struct wps_credential *cred)
  311. {
  312. struct wpa_supplicant *wpa_s = ctx;
  313. struct wpa_ssid *ssid = wpa_s->current_ssid;
  314. u16 auth_type;
  315. #ifdef CONFIG_WPS_REG_DISABLE_OPEN
  316. int registrar = 0;
  317. #endif /* CONFIG_WPS_REG_DISABLE_OPEN */
  318. if ((wpa_s->conf->wps_cred_processing == 1 ||
  319. wpa_s->conf->wps_cred_processing == 2) && cred->cred_attr) {
  320. size_t blen = cred->cred_attr_len * 2 + 1;
  321. char *buf = os_malloc(blen);
  322. if (buf) {
  323. wpa_snprintf_hex(buf, blen,
  324. cred->cred_attr, cred->cred_attr_len);
  325. wpa_msg(wpa_s, MSG_INFO, "%s%s",
  326. WPS_EVENT_CRED_RECEIVED, buf);
  327. os_free(buf);
  328. }
  329. wpas_notify_wps_credential(wpa_s, cred);
  330. } else
  331. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_CRED_RECEIVED);
  332. wpa_hexdump_key(MSG_DEBUG, "WPS: Received Credential attribute",
  333. cred->cred_attr, cred->cred_attr_len);
  334. if (wpa_s->conf->wps_cred_processing == 1)
  335. return 0;
  336. wpa_hexdump_ascii(MSG_DEBUG, "WPS: SSID", cred->ssid, cred->ssid_len);
  337. wpa_printf(MSG_DEBUG, "WPS: Authentication Type 0x%x",
  338. cred->auth_type);
  339. wpa_printf(MSG_DEBUG, "WPS: Encryption Type 0x%x", cred->encr_type);
  340. wpa_printf(MSG_DEBUG, "WPS: Network Key Index %d", cred->key_idx);
  341. wpa_hexdump_key(MSG_DEBUG, "WPS: Network Key",
  342. cred->key, cred->key_len);
  343. wpa_printf(MSG_DEBUG, "WPS: MAC Address " MACSTR,
  344. MAC2STR(cred->mac_addr));
  345. auth_type = cred->auth_type;
  346. if (auth_type == (WPS_AUTH_WPAPSK | WPS_AUTH_WPA2PSK)) {
  347. wpa_printf(MSG_DEBUG, "WPS: Workaround - convert mixed-mode "
  348. "auth_type into WPA2PSK");
  349. auth_type = WPS_AUTH_WPA2PSK;
  350. }
  351. if (auth_type != WPS_AUTH_OPEN &&
  352. auth_type != WPS_AUTH_WPAPSK &&
  353. auth_type != WPS_AUTH_WPA2PSK) {
  354. wpa_printf(MSG_DEBUG, "WPS: Ignored credentials for "
  355. "unsupported authentication type 0x%x",
  356. auth_type);
  357. return 0;
  358. }
  359. if (auth_type == WPS_AUTH_WPAPSK || auth_type == WPS_AUTH_WPA2PSK) {
  360. if (cred->key_len < 8 || cred->key_len > 2 * PMK_LEN) {
  361. wpa_printf(MSG_ERROR, "WPS: Reject PSK credential with "
  362. "invalid Network Key length %lu",
  363. (unsigned long) cred->key_len);
  364. return -1;
  365. }
  366. }
  367. if (ssid && (ssid->key_mgmt & WPA_KEY_MGMT_WPS)) {
  368. wpa_printf(MSG_DEBUG, "WPS: Replace WPS network block based "
  369. "on the received credential");
  370. #ifdef CONFIG_WPS_REG_DISABLE_OPEN
  371. if (ssid->eap.identity &&
  372. ssid->eap.identity_len == WSC_ID_REGISTRAR_LEN &&
  373. os_memcmp(ssid->eap.identity, WSC_ID_REGISTRAR,
  374. WSC_ID_REGISTRAR_LEN) == 0)
  375. registrar = 1;
  376. #endif /* CONFIG_WPS_REG_DISABLE_OPEN */
  377. os_free(ssid->eap.identity);
  378. ssid->eap.identity = NULL;
  379. ssid->eap.identity_len = 0;
  380. os_free(ssid->eap.phase1);
  381. ssid->eap.phase1 = NULL;
  382. os_free(ssid->eap.eap_methods);
  383. ssid->eap.eap_methods = NULL;
  384. if (!ssid->p2p_group) {
  385. ssid->temporary = 0;
  386. ssid->bssid_set = 0;
  387. }
  388. ssid->disabled_until.sec = 0;
  389. ssid->disabled_until.usec = 0;
  390. ssid->auth_failures = 0;
  391. } else {
  392. wpa_printf(MSG_DEBUG, "WPS: Create a new network based on the "
  393. "received credential");
  394. ssid = wpa_config_add_network(wpa_s->conf);
  395. if (ssid == NULL)
  396. return -1;
  397. if (wpa_s->current_ssid) {
  398. /*
  399. * Should the GO issue multiple credentials for some
  400. * reason, each credential should be marked as a
  401. * temporary P2P group similarly to the one that gets
  402. * marked as such based on the pre-configured values
  403. * used for the WPS network block.
  404. */
  405. ssid->p2p_group = wpa_s->current_ssid->p2p_group;
  406. ssid->temporary = wpa_s->current_ssid->temporary;
  407. }
  408. wpas_notify_network_added(wpa_s, ssid);
  409. }
  410. wpa_config_set_network_defaults(ssid);
  411. ssid->wps_run = wpa_s->wps_run;
  412. os_free(ssid->ssid);
  413. ssid->ssid = os_malloc(cred->ssid_len);
  414. if (ssid->ssid) {
  415. os_memcpy(ssid->ssid, cred->ssid, cred->ssid_len);
  416. ssid->ssid_len = cred->ssid_len;
  417. }
  418. switch (cred->encr_type) {
  419. case WPS_ENCR_NONE:
  420. break;
  421. case WPS_ENCR_TKIP:
  422. ssid->pairwise_cipher = WPA_CIPHER_TKIP;
  423. break;
  424. case WPS_ENCR_AES:
  425. ssid->pairwise_cipher = WPA_CIPHER_CCMP;
  426. if (wpa_s->drv_capa_known &&
  427. (wpa_s->drv_enc & WPA_DRIVER_CAPA_ENC_GCMP)) {
  428. ssid->pairwise_cipher |= WPA_CIPHER_GCMP;
  429. ssid->group_cipher |= WPA_CIPHER_GCMP;
  430. }
  431. break;
  432. }
  433. switch (auth_type) {
  434. case WPS_AUTH_OPEN:
  435. ssid->auth_alg = WPA_AUTH_ALG_OPEN;
  436. ssid->key_mgmt = WPA_KEY_MGMT_NONE;
  437. ssid->proto = 0;
  438. #ifdef CONFIG_WPS_REG_DISABLE_OPEN
  439. if (registrar) {
  440. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_OPEN_NETWORK
  441. "id=%d - Credentials for an open "
  442. "network disabled by default - use "
  443. "'select_network %d' to enable",
  444. ssid->id, ssid->id);
  445. ssid->disabled = 1;
  446. }
  447. #endif /* CONFIG_WPS_REG_DISABLE_OPEN */
  448. break;
  449. case WPS_AUTH_WPAPSK:
  450. ssid->auth_alg = WPA_AUTH_ALG_OPEN;
  451. ssid->key_mgmt = WPA_KEY_MGMT_PSK;
  452. ssid->proto = WPA_PROTO_WPA;
  453. break;
  454. case WPS_AUTH_WPA2PSK:
  455. ssid->auth_alg = WPA_AUTH_ALG_OPEN;
  456. ssid->key_mgmt = WPA_KEY_MGMT_PSK;
  457. ssid->proto = WPA_PROTO_RSN;
  458. break;
  459. }
  460. if (ssid->key_mgmt == WPA_KEY_MGMT_PSK) {
  461. if (cred->key_len == 2 * PMK_LEN) {
  462. if (hexstr2bin((const char *) cred->key, ssid->psk,
  463. PMK_LEN)) {
  464. wpa_printf(MSG_ERROR, "WPS: Invalid Network "
  465. "Key");
  466. return -1;
  467. }
  468. ssid->psk_set = 1;
  469. ssid->export_keys = 1;
  470. } else if (cred->key_len >= 8 && cred->key_len < 2 * PMK_LEN) {
  471. os_free(ssid->passphrase);
  472. ssid->passphrase = os_malloc(cred->key_len + 1);
  473. if (ssid->passphrase == NULL)
  474. return -1;
  475. os_memcpy(ssid->passphrase, cred->key, cred->key_len);
  476. ssid->passphrase[cred->key_len] = '\0';
  477. wpa_config_update_psk(ssid);
  478. ssid->export_keys = 1;
  479. } else {
  480. wpa_printf(MSG_ERROR, "WPS: Invalid Network Key "
  481. "length %lu",
  482. (unsigned long) cred->key_len);
  483. return -1;
  484. }
  485. }
  486. ssid->priority = wpa_s->conf->wps_priority;
  487. wpas_wps_security_workaround(wpa_s, ssid, cred);
  488. wpas_wps_remove_dup_network(wpa_s, ssid);
  489. #ifndef CONFIG_NO_CONFIG_WRITE
  490. if (wpa_s->conf->update_config &&
  491. wpa_config_write(wpa_s->confname, wpa_s->conf)) {
  492. wpa_printf(MSG_DEBUG, "WPS: Failed to update configuration");
  493. return -1;
  494. }
  495. #endif /* CONFIG_NO_CONFIG_WRITE */
  496. if (ssid->priority)
  497. wpa_config_update_prio_list(wpa_s->conf);
  498. /*
  499. * Optimize the post-WPS scan based on the channel used during
  500. * the provisioning in case EAP-Failure is not received.
  501. */
  502. wpa_s->after_wps = 5;
  503. wpa_s->wps_freq = wpa_s->assoc_freq;
  504. return 0;
  505. }
  506. static void wpa_supplicant_wps_event_m2d(struct wpa_supplicant *wpa_s,
  507. struct wps_event_m2d *m2d)
  508. {
  509. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_M2D
  510. "dev_password_id=%d config_error=%d",
  511. m2d->dev_password_id, m2d->config_error);
  512. wpas_notify_wps_event_m2d(wpa_s, m2d);
  513. #ifdef CONFIG_P2P
  514. if (wpa_s->p2pdev && wpa_s->p2pdev != wpa_s) {
  515. wpa_msg(wpa_s->p2pdev, MSG_INFO, WPS_EVENT_M2D
  516. "dev_password_id=%d config_error=%d",
  517. m2d->dev_password_id, m2d->config_error);
  518. }
  519. if (m2d->config_error == WPS_CFG_MULTIPLE_PBC_DETECTED) {
  520. /*
  521. * Notify P2P from eloop timeout to avoid issues with the
  522. * interface getting removed while processing a message.
  523. */
  524. eloop_register_timeout(0, 0, wpas_p2p_pbc_overlap_cb, wpa_s,
  525. NULL);
  526. }
  527. #endif /* CONFIG_P2P */
  528. }
  529. static void wpas_wps_clear_timeout(void *eloop_ctx, void *timeout_ctx)
  530. {
  531. struct wpa_supplicant *wpa_s = eloop_ctx;
  532. wpa_printf(MSG_DEBUG, "WPS: Clear WPS network from timeout");
  533. wpas_clear_wps(wpa_s);
  534. }
  535. static void wpa_supplicant_wps_event_fail(struct wpa_supplicant *wpa_s,
  536. struct wps_event_fail *fail)
  537. {
  538. if (fail->error_indication > 0 &&
  539. fail->error_indication < NUM_WPS_EI_VALUES) {
  540. wpa_msg(wpa_s, MSG_INFO,
  541. WPS_EVENT_FAIL "msg=%d config_error=%d reason=%d (%s)",
  542. fail->msg, fail->config_error, fail->error_indication,
  543. wps_ei_str(fail->error_indication));
  544. if (wpa_s->p2pdev && wpa_s->p2pdev != wpa_s)
  545. wpa_msg(wpa_s->p2pdev, MSG_INFO, WPS_EVENT_FAIL
  546. "msg=%d config_error=%d reason=%d (%s)",
  547. fail->msg, fail->config_error,
  548. fail->error_indication,
  549. wps_ei_str(fail->error_indication));
  550. } else {
  551. wpa_msg(wpa_s, MSG_INFO,
  552. WPS_EVENT_FAIL "msg=%d config_error=%d",
  553. fail->msg, fail->config_error);
  554. if (wpa_s->p2pdev && wpa_s->p2pdev != wpa_s)
  555. wpa_msg(wpa_s->p2pdev, MSG_INFO, WPS_EVENT_FAIL
  556. "msg=%d config_error=%d",
  557. fail->msg, fail->config_error);
  558. }
  559. /*
  560. * Need to allow WPS processing to complete, e.g., by sending WSC_NACK.
  561. */
  562. wpa_printf(MSG_DEBUG, "WPS: Register timeout to clear WPS network");
  563. eloop_cancel_timeout(wpas_wps_clear_timeout, wpa_s, NULL);
  564. eloop_register_timeout(0, 100000, wpas_wps_clear_timeout, wpa_s, NULL);
  565. wpas_notify_wps_event_fail(wpa_s, fail);
  566. wpas_p2p_wps_failed(wpa_s, fail);
  567. }
  568. static void wpas_wps_reenable_networks_cb(void *eloop_ctx, void *timeout_ctx);
  569. static void wpas_wps_reenable_networks(struct wpa_supplicant *wpa_s)
  570. {
  571. struct wpa_ssid *ssid;
  572. int changed = 0;
  573. eloop_cancel_timeout(wpas_wps_reenable_networks_cb, wpa_s, NULL);
  574. for (ssid = wpa_s->conf->ssid; ssid; ssid = ssid->next) {
  575. if (ssid->disabled_for_connect && ssid->disabled) {
  576. ssid->disabled_for_connect = 0;
  577. ssid->disabled = 0;
  578. wpas_notify_network_enabled_changed(wpa_s, ssid);
  579. changed++;
  580. }
  581. }
  582. if (changed) {
  583. #ifndef CONFIG_NO_CONFIG_WRITE
  584. if (wpa_s->conf->update_config &&
  585. wpa_config_write(wpa_s->confname, wpa_s->conf)) {
  586. wpa_printf(MSG_DEBUG, "WPS: Failed to update "
  587. "configuration");
  588. }
  589. #endif /* CONFIG_NO_CONFIG_WRITE */
  590. }
  591. }
  592. static void wpas_wps_reenable_networks_cb(void *eloop_ctx, void *timeout_ctx)
  593. {
  594. struct wpa_supplicant *wpa_s = eloop_ctx;
  595. /* Enable the networks disabled during wpas_wps_reassoc */
  596. wpas_wps_reenable_networks(wpa_s);
  597. }
  598. int wpas_wps_reenable_networks_pending(struct wpa_supplicant *wpa_s)
  599. {
  600. return eloop_is_timeout_registered(wpas_wps_reenable_networks_cb,
  601. wpa_s, NULL);
  602. }
  603. static void wpa_supplicant_wps_event_success(struct wpa_supplicant *wpa_s)
  604. {
  605. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_SUCCESS);
  606. wpa_s->wps_success = 1;
  607. wpas_notify_wps_event_success(wpa_s);
  608. if (wpa_s->current_ssid)
  609. wpas_clear_temp_disabled(wpa_s, wpa_s->current_ssid, 1);
  610. wpa_s->extra_blacklist_count = 0;
  611. /*
  612. * Enable the networks disabled during wpas_wps_reassoc after 10
  613. * seconds. The 10 seconds timer is to allow the data connection to be
  614. * formed before allowing other networks to be selected.
  615. */
  616. eloop_register_timeout(10, 0, wpas_wps_reenable_networks_cb, wpa_s,
  617. NULL);
  618. wpas_p2p_wps_success(wpa_s, wpa_s->bssid, 0);
  619. }
  620. static void wpa_supplicant_wps_event_er_ap_add(struct wpa_supplicant *wpa_s,
  621. struct wps_event_er_ap *ap)
  622. {
  623. char uuid_str[100];
  624. char dev_type[WPS_DEV_TYPE_BUFSIZE];
  625. uuid_bin2str(ap->uuid, uuid_str, sizeof(uuid_str));
  626. if (ap->pri_dev_type)
  627. wps_dev_type_bin2str(ap->pri_dev_type, dev_type,
  628. sizeof(dev_type));
  629. else
  630. dev_type[0] = '\0';
  631. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_AP_ADD "%s " MACSTR
  632. " pri_dev_type=%s wps_state=%d |%s|%s|%s|%s|%s|%s|",
  633. uuid_str, MAC2STR(ap->mac_addr), dev_type, ap->wps_state,
  634. ap->friendly_name ? ap->friendly_name : "",
  635. ap->manufacturer ? ap->manufacturer : "",
  636. ap->model_description ? ap->model_description : "",
  637. ap->model_name ? ap->model_name : "",
  638. ap->manufacturer_url ? ap->manufacturer_url : "",
  639. ap->model_url ? ap->model_url : "");
  640. }
  641. static void wpa_supplicant_wps_event_er_ap_remove(struct wpa_supplicant *wpa_s,
  642. struct wps_event_er_ap *ap)
  643. {
  644. char uuid_str[100];
  645. uuid_bin2str(ap->uuid, uuid_str, sizeof(uuid_str));
  646. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_AP_REMOVE "%s", uuid_str);
  647. }
  648. static void wpa_supplicant_wps_event_er_enrollee_add(
  649. struct wpa_supplicant *wpa_s, struct wps_event_er_enrollee *enrollee)
  650. {
  651. char uuid_str[100];
  652. char dev_type[WPS_DEV_TYPE_BUFSIZE];
  653. uuid_bin2str(enrollee->uuid, uuid_str, sizeof(uuid_str));
  654. if (enrollee->pri_dev_type)
  655. wps_dev_type_bin2str(enrollee->pri_dev_type, dev_type,
  656. sizeof(dev_type));
  657. else
  658. dev_type[0] = '\0';
  659. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_ENROLLEE_ADD "%s " MACSTR
  660. " M1=%d config_methods=0x%x dev_passwd_id=%d pri_dev_type=%s "
  661. "|%s|%s|%s|%s|%s|",
  662. uuid_str, MAC2STR(enrollee->mac_addr), enrollee->m1_received,
  663. enrollee->config_methods, enrollee->dev_passwd_id, dev_type,
  664. enrollee->dev_name ? enrollee->dev_name : "",
  665. enrollee->manufacturer ? enrollee->manufacturer : "",
  666. enrollee->model_name ? enrollee->model_name : "",
  667. enrollee->model_number ? enrollee->model_number : "",
  668. enrollee->serial_number ? enrollee->serial_number : "");
  669. }
  670. static void wpa_supplicant_wps_event_er_enrollee_remove(
  671. struct wpa_supplicant *wpa_s, struct wps_event_er_enrollee *enrollee)
  672. {
  673. char uuid_str[100];
  674. uuid_bin2str(enrollee->uuid, uuid_str, sizeof(uuid_str));
  675. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_ENROLLEE_REMOVE "%s " MACSTR,
  676. uuid_str, MAC2STR(enrollee->mac_addr));
  677. }
  678. static void wpa_supplicant_wps_event_er_ap_settings(
  679. struct wpa_supplicant *wpa_s,
  680. struct wps_event_er_ap_settings *ap_settings)
  681. {
  682. char uuid_str[100];
  683. char key_str[65];
  684. const struct wps_credential *cred = ap_settings->cred;
  685. key_str[0] = '\0';
  686. if (cred->auth_type & (WPS_AUTH_WPAPSK | WPS_AUTH_WPA2PSK)) {
  687. if (cred->key_len >= 8 && cred->key_len <= 64) {
  688. os_memcpy(key_str, cred->key, cred->key_len);
  689. key_str[cred->key_len] = '\0';
  690. }
  691. }
  692. uuid_bin2str(ap_settings->uuid, uuid_str, sizeof(uuid_str));
  693. /* Use wpa_msg_ctrl to avoid showing the key in debug log */
  694. wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_ER_AP_SETTINGS
  695. "uuid=%s ssid=%s auth_type=0x%04x encr_type=0x%04x "
  696. "key=%s",
  697. uuid_str, wpa_ssid_txt(cred->ssid, cred->ssid_len),
  698. cred->auth_type, cred->encr_type, key_str);
  699. }
  700. static void wpa_supplicant_wps_event_er_set_sel_reg(
  701. struct wpa_supplicant *wpa_s,
  702. struct wps_event_er_set_selected_registrar *ev)
  703. {
  704. char uuid_str[100];
  705. uuid_bin2str(ev->uuid, uuid_str, sizeof(uuid_str));
  706. switch (ev->state) {
  707. case WPS_ER_SET_SEL_REG_START:
  708. wpa_msg(wpa_s, MSG_DEBUG, WPS_EVENT_ER_SET_SEL_REG
  709. "uuid=%s state=START sel_reg=%d dev_passwd_id=%u "
  710. "sel_reg_config_methods=0x%x",
  711. uuid_str, ev->sel_reg, ev->dev_passwd_id,
  712. ev->sel_reg_config_methods);
  713. break;
  714. case WPS_ER_SET_SEL_REG_DONE:
  715. wpa_msg(wpa_s, MSG_DEBUG, WPS_EVENT_ER_SET_SEL_REG
  716. "uuid=%s state=DONE", uuid_str);
  717. break;
  718. case WPS_ER_SET_SEL_REG_FAILED:
  719. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_SET_SEL_REG
  720. "uuid=%s state=FAILED", uuid_str);
  721. break;
  722. }
  723. }
  724. static void wpa_supplicant_wps_event(void *ctx, enum wps_event event,
  725. union wps_event_data *data)
  726. {
  727. struct wpa_supplicant *wpa_s = ctx;
  728. switch (event) {
  729. case WPS_EV_M2D:
  730. wpa_supplicant_wps_event_m2d(wpa_s, &data->m2d);
  731. break;
  732. case WPS_EV_FAIL:
  733. wpa_supplicant_wps_event_fail(wpa_s, &data->fail);
  734. break;
  735. case WPS_EV_SUCCESS:
  736. wpa_supplicant_wps_event_success(wpa_s);
  737. break;
  738. case WPS_EV_PWD_AUTH_FAIL:
  739. #ifdef CONFIG_AP
  740. if (wpa_s->ap_iface && data->pwd_auth_fail.enrollee)
  741. wpa_supplicant_ap_pwd_auth_fail(wpa_s);
  742. #endif /* CONFIG_AP */
  743. break;
  744. case WPS_EV_PBC_OVERLAP:
  745. break;
  746. case WPS_EV_PBC_TIMEOUT:
  747. break;
  748. case WPS_EV_PBC_ACTIVE:
  749. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ACTIVE);
  750. break;
  751. case WPS_EV_PBC_DISABLE:
  752. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_DISABLE);
  753. break;
  754. case WPS_EV_ER_AP_ADD:
  755. wpa_supplicant_wps_event_er_ap_add(wpa_s, &data->ap);
  756. break;
  757. case WPS_EV_ER_AP_REMOVE:
  758. wpa_supplicant_wps_event_er_ap_remove(wpa_s, &data->ap);
  759. break;
  760. case WPS_EV_ER_ENROLLEE_ADD:
  761. wpa_supplicant_wps_event_er_enrollee_add(wpa_s,
  762. &data->enrollee);
  763. break;
  764. case WPS_EV_ER_ENROLLEE_REMOVE:
  765. wpa_supplicant_wps_event_er_enrollee_remove(wpa_s,
  766. &data->enrollee);
  767. break;
  768. case WPS_EV_ER_AP_SETTINGS:
  769. wpa_supplicant_wps_event_er_ap_settings(wpa_s,
  770. &data->ap_settings);
  771. break;
  772. case WPS_EV_ER_SET_SELECTED_REGISTRAR:
  773. wpa_supplicant_wps_event_er_set_sel_reg(wpa_s,
  774. &data->set_sel_reg);
  775. break;
  776. case WPS_EV_AP_PIN_SUCCESS:
  777. break;
  778. }
  779. }
  780. static int wpa_supplicant_wps_rf_band(void *ctx)
  781. {
  782. struct wpa_supplicant *wpa_s = ctx;
  783. if (!wpa_s->current_ssid || !wpa_s->assoc_freq)
  784. return 0;
  785. return (wpa_s->assoc_freq > 50000) ? WPS_RF_60GHZ :
  786. (wpa_s->assoc_freq > 2484) ? WPS_RF_50GHZ : WPS_RF_24GHZ;
  787. }
  788. enum wps_request_type wpas_wps_get_req_type(struct wpa_ssid *ssid)
  789. {
  790. if (eap_is_wps_pbc_enrollee(&ssid->eap) ||
  791. eap_is_wps_pin_enrollee(&ssid->eap))
  792. return WPS_REQ_ENROLLEE;
  793. else
  794. return WPS_REQ_REGISTRAR;
  795. }
  796. static void wpas_clear_wps(struct wpa_supplicant *wpa_s)
  797. {
  798. int id;
  799. struct wpa_ssid *ssid, *remove_ssid = NULL, *prev_current;
  800. wpa_s->after_wps = 0;
  801. wpa_s->known_wps_freq = 0;
  802. prev_current = wpa_s->current_ssid;
  803. /* Enable the networks disabled during wpas_wps_reassoc */
  804. wpas_wps_reenable_networks(wpa_s);
  805. eloop_cancel_timeout(wpas_wps_timeout, wpa_s, NULL);
  806. eloop_cancel_timeout(wpas_wps_clear_timeout, wpa_s, NULL);
  807. /* Remove any existing WPS network from configuration */
  808. ssid = wpa_s->conf->ssid;
  809. while (ssid) {
  810. if (ssid->key_mgmt & WPA_KEY_MGMT_WPS) {
  811. if (ssid == wpa_s->current_ssid) {
  812. wpa_s->own_disconnect_req = 1;
  813. wpa_supplicant_deauthenticate(
  814. wpa_s, WLAN_REASON_DEAUTH_LEAVING);
  815. }
  816. id = ssid->id;
  817. remove_ssid = ssid;
  818. } else
  819. id = -1;
  820. ssid = ssid->next;
  821. if (id >= 0) {
  822. if (prev_current == remove_ssid) {
  823. wpa_sm_set_config(wpa_s->wpa, NULL);
  824. eapol_sm_notify_config(wpa_s->eapol, NULL,
  825. NULL);
  826. }
  827. wpas_notify_network_removed(wpa_s, remove_ssid);
  828. wpa_config_remove_network(wpa_s->conf, id);
  829. }
  830. }
  831. wpas_wps_clear_ap_info(wpa_s);
  832. }
  833. static void wpas_wps_timeout(void *eloop_ctx, void *timeout_ctx)
  834. {
  835. struct wpa_supplicant *wpa_s = eloop_ctx;
  836. union wps_event_data data;
  837. wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_TIMEOUT "Requested operation timed "
  838. "out");
  839. os_memset(&data, 0, sizeof(data));
  840. data.fail.config_error = WPS_CFG_MSG_TIMEOUT;
  841. data.fail.error_indication = WPS_EI_NO_ERROR;
  842. /*
  843. * Call wpas_notify_wps_event_fail() directly instead of through
  844. * wpa_supplicant_wps_event() which would end up registering unnecessary
  845. * timeouts (those are only for the case where the failure happens
  846. * during an EAP-WSC exchange).
  847. */
  848. wpas_notify_wps_event_fail(wpa_s, &data.fail);
  849. wpas_clear_wps(wpa_s);
  850. }
  851. static struct wpa_ssid * wpas_wps_add_network(struct wpa_supplicant *wpa_s,
  852. int registrar, const u8 *dev_addr,
  853. const u8 *bssid)
  854. {
  855. struct wpa_ssid *ssid;
  856. ssid = wpa_config_add_network(wpa_s->conf);
  857. if (ssid == NULL)
  858. return NULL;
  859. wpas_notify_network_added(wpa_s, ssid);
  860. wpa_config_set_network_defaults(ssid);
  861. ssid->temporary = 1;
  862. if (wpa_config_set(ssid, "key_mgmt", "WPS", 0) < 0 ||
  863. wpa_config_set(ssid, "eap", "WSC", 0) < 0 ||
  864. wpa_config_set(ssid, "identity", registrar ?
  865. "\"" WSC_ID_REGISTRAR "\"" :
  866. "\"" WSC_ID_ENROLLEE "\"", 0) < 0) {
  867. wpas_notify_network_removed(wpa_s, ssid);
  868. wpa_config_remove_network(wpa_s->conf, ssid->id);
  869. return NULL;
  870. }
  871. #ifdef CONFIG_P2P
  872. if (dev_addr)
  873. os_memcpy(ssid->go_p2p_dev_addr, dev_addr, ETH_ALEN);
  874. #endif /* CONFIG_P2P */
  875. if (bssid) {
  876. #ifndef CONFIG_P2P
  877. struct wpa_bss *bss;
  878. int count = 0;
  879. #endif /* CONFIG_P2P */
  880. os_memcpy(ssid->bssid, bssid, ETH_ALEN);
  881. ssid->bssid_set = 1;
  882. /*
  883. * Note: With P2P, the SSID may change at the time the WPS
  884. * provisioning is started, so better not filter the AP based
  885. * on the current SSID in the scan results.
  886. */
  887. #ifndef CONFIG_P2P
  888. dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
  889. if (os_memcmp(bssid, bss->bssid, ETH_ALEN) != 0)
  890. continue;
  891. os_free(ssid->ssid);
  892. ssid->ssid = os_malloc(bss->ssid_len);
  893. if (ssid->ssid == NULL)
  894. break;
  895. os_memcpy(ssid->ssid, bss->ssid, bss->ssid_len);
  896. ssid->ssid_len = bss->ssid_len;
  897. wpa_hexdump_ascii(MSG_DEBUG, "WPS: Picked SSID from "
  898. "scan results",
  899. ssid->ssid, ssid->ssid_len);
  900. count++;
  901. }
  902. if (count > 1) {
  903. wpa_printf(MSG_DEBUG, "WPS: More than one SSID found "
  904. "for the AP; use wildcard");
  905. os_free(ssid->ssid);
  906. ssid->ssid = NULL;
  907. ssid->ssid_len = 0;
  908. }
  909. #endif /* CONFIG_P2P */
  910. }
  911. return ssid;
  912. }
  913. static void wpas_wps_temp_disable(struct wpa_supplicant *wpa_s,
  914. struct wpa_ssid *selected)
  915. {
  916. struct wpa_ssid *ssid;
  917. if (wpa_s->current_ssid) {
  918. wpa_s->own_disconnect_req = 1;
  919. wpa_supplicant_deauthenticate(
  920. wpa_s, WLAN_REASON_DEAUTH_LEAVING);
  921. }
  922. /* Mark all other networks disabled and trigger reassociation */
  923. ssid = wpa_s->conf->ssid;
  924. while (ssid) {
  925. int was_disabled = ssid->disabled;
  926. ssid->disabled_for_connect = 0;
  927. /*
  928. * In case the network object corresponds to a persistent group
  929. * then do not send out network disabled signal. In addition,
  930. * do not change disabled status of persistent network objects
  931. * from 2 to 1 should we connect to another network.
  932. */
  933. if (was_disabled != 2) {
  934. ssid->disabled = ssid != selected;
  935. if (was_disabled != ssid->disabled) {
  936. if (ssid->disabled)
  937. ssid->disabled_for_connect = 1;
  938. wpas_notify_network_enabled_changed(wpa_s,
  939. ssid);
  940. }
  941. }
  942. ssid = ssid->next;
  943. }
  944. }
  945. static void wpas_wps_reassoc(struct wpa_supplicant *wpa_s,
  946. struct wpa_ssid *selected, const u8 *bssid,
  947. int freq)
  948. {
  949. struct wpa_bss *bss;
  950. wpa_s->wps_run++;
  951. if (wpa_s->wps_run == 0)
  952. wpa_s->wps_run++;
  953. wpa_s->after_wps = 0;
  954. wpa_s->known_wps_freq = 0;
  955. if (freq) {
  956. wpa_s->after_wps = 5;
  957. wpa_s->wps_freq = freq;
  958. } else if (bssid) {
  959. bss = wpa_bss_get_bssid_latest(wpa_s, bssid);
  960. if (bss && bss->freq > 0) {
  961. wpa_s->known_wps_freq = 1;
  962. wpa_s->wps_freq = bss->freq;
  963. }
  964. }
  965. wpas_wps_temp_disable(wpa_s, selected);
  966. wpa_s->disconnected = 0;
  967. wpa_s->reassociate = 1;
  968. wpa_s->scan_runs = 0;
  969. wpa_s->normal_scans = 0;
  970. wpa_s->wps_success = 0;
  971. wpa_s->blacklist_cleared = 0;
  972. wpa_supplicant_cancel_sched_scan(wpa_s);
  973. wpa_supplicant_req_scan(wpa_s, 0, 0);
  974. }
  975. int wpas_wps_start_pbc(struct wpa_supplicant *wpa_s, const u8 *bssid,
  976. int p2p_group)
  977. {
  978. struct wpa_ssid *ssid;
  979. #ifdef CONFIG_AP
  980. if (wpa_s->ap_iface) {
  981. wpa_printf(MSG_DEBUG,
  982. "WPS: Reject request to start Registrar(as station) operation while AP mode is enabled");
  983. return -1;
  984. }
  985. #endif /* CONFIG_AP */
  986. wpas_clear_wps(wpa_s);
  987. ssid = wpas_wps_add_network(wpa_s, 0, NULL, bssid);
  988. if (ssid == NULL)
  989. return -1;
  990. ssid->temporary = 1;
  991. ssid->p2p_group = p2p_group;
  992. #ifdef CONFIG_P2P
  993. if (p2p_group && wpa_s->go_params && wpa_s->go_params->ssid_len) {
  994. ssid->ssid = os_zalloc(wpa_s->go_params->ssid_len + 1);
  995. if (ssid->ssid) {
  996. ssid->ssid_len = wpa_s->go_params->ssid_len;
  997. os_memcpy(ssid->ssid, wpa_s->go_params->ssid,
  998. ssid->ssid_len);
  999. if (wpa_s->go_params->freq > 56160) {
  1000. /* P2P in 60 GHz uses PBSS */
  1001. ssid->pbss = 1;
  1002. }
  1003. wpa_hexdump_ascii(MSG_DEBUG, "WPS: Use specific AP "
  1004. "SSID", ssid->ssid, ssid->ssid_len);
  1005. }
  1006. }
  1007. #endif /* CONFIG_P2P */
  1008. if (wpa_config_set(ssid, "phase1", "\"pbc=1\"", 0) < 0)
  1009. return -1;
  1010. if (wpa_s->wps_fragment_size)
  1011. ssid->eap.fragment_size = wpa_s->wps_fragment_size;
  1012. eloop_register_timeout(WPS_PBC_WALK_TIME, 0, wpas_wps_timeout,
  1013. wpa_s, NULL);
  1014. wpas_wps_reassoc(wpa_s, ssid, bssid, 0);
  1015. return 0;
  1016. }
  1017. static int wpas_wps_start_dev_pw(struct wpa_supplicant *wpa_s,
  1018. const u8 *dev_addr, const u8 *bssid,
  1019. const char *pin, int p2p_group, u16 dev_pw_id,
  1020. const u8 *peer_pubkey_hash,
  1021. const u8 *ssid_val, size_t ssid_len, int freq)
  1022. {
  1023. struct wpa_ssid *ssid;
  1024. char val[128 + 2 * WPS_OOB_PUBKEY_HASH_LEN];
  1025. unsigned int rpin = 0;
  1026. char hash[2 * WPS_OOB_PUBKEY_HASH_LEN + 10];
  1027. #ifdef CONFIG_AP
  1028. if (wpa_s->ap_iface) {
  1029. wpa_printf(MSG_DEBUG,
  1030. "WPS: Reject request to start Registrar(as station) operation while AP mode is enabled");
  1031. return -1;
  1032. }
  1033. #endif /* CONFIG_AP */
  1034. wpas_clear_wps(wpa_s);
  1035. if (bssid && is_zero_ether_addr(bssid))
  1036. bssid = NULL;
  1037. ssid = wpas_wps_add_network(wpa_s, 0, dev_addr, bssid);
  1038. if (ssid == NULL) {
  1039. wpa_printf(MSG_DEBUG, "WPS: Could not add network");
  1040. return -1;
  1041. }
  1042. ssid->temporary = 1;
  1043. ssid->p2p_group = p2p_group;
  1044. if (ssid_val) {
  1045. ssid->ssid = os_malloc(ssid_len);
  1046. if (ssid->ssid) {
  1047. os_memcpy(ssid->ssid, ssid_val, ssid_len);
  1048. ssid->ssid_len = ssid_len;
  1049. }
  1050. }
  1051. if (peer_pubkey_hash) {
  1052. os_memcpy(hash, " pkhash=", 8);
  1053. wpa_snprintf_hex_uppercase(hash + 8, sizeof(hash) - 8,
  1054. peer_pubkey_hash,
  1055. WPS_OOB_PUBKEY_HASH_LEN);
  1056. } else {
  1057. hash[0] = '\0';
  1058. }
  1059. #ifdef CONFIG_P2P
  1060. if (p2p_group && wpa_s->go_params && wpa_s->go_params->ssid_len) {
  1061. os_free(ssid->ssid);
  1062. ssid->ssid = os_zalloc(wpa_s->go_params->ssid_len + 1);
  1063. if (ssid->ssid) {
  1064. ssid->ssid_len = wpa_s->go_params->ssid_len;
  1065. os_memcpy(ssid->ssid, wpa_s->go_params->ssid,
  1066. ssid->ssid_len);
  1067. if (wpa_s->go_params->freq > 56160) {
  1068. /* P2P in 60 GHz uses PBSS */
  1069. ssid->pbss = 1;
  1070. }
  1071. wpa_hexdump_ascii(MSG_DEBUG, "WPS: Use specific AP "
  1072. "SSID", ssid->ssid, ssid->ssid_len);
  1073. }
  1074. }
  1075. #endif /* CONFIG_P2P */
  1076. if (pin)
  1077. os_snprintf(val, sizeof(val), "\"pin=%s dev_pw_id=%u%s\"",
  1078. pin, dev_pw_id, hash);
  1079. else if (pin == NULL && dev_pw_id == DEV_PW_NFC_CONNECTION_HANDOVER) {
  1080. os_snprintf(val, sizeof(val), "\"dev_pw_id=%u%s\"",
  1081. dev_pw_id, hash);
  1082. } else {
  1083. if (wps_generate_pin(&rpin) < 0) {
  1084. wpa_printf(MSG_DEBUG, "WPS: Could not generate PIN");
  1085. return -1;
  1086. }
  1087. os_snprintf(val, sizeof(val), "\"pin=%08d dev_pw_id=%u%s\"",
  1088. rpin, dev_pw_id, hash);
  1089. }
  1090. if (wpa_config_set(ssid, "phase1", val, 0) < 0) {
  1091. wpa_printf(MSG_DEBUG, "WPS: Failed to set phase1 '%s'", val);
  1092. return -1;
  1093. }
  1094. if (wpa_s->wps_fragment_size)
  1095. ssid->eap.fragment_size = wpa_s->wps_fragment_size;
  1096. eloop_register_timeout(WPS_PBC_WALK_TIME, 0, wpas_wps_timeout,
  1097. wpa_s, NULL);
  1098. wpa_s->wps_ap_iter = 1;
  1099. wpas_wps_reassoc(wpa_s, ssid, bssid, freq);
  1100. return rpin;
  1101. }
  1102. int wpas_wps_start_pin(struct wpa_supplicant *wpa_s, const u8 *bssid,
  1103. const char *pin, int p2p_group, u16 dev_pw_id)
  1104. {
  1105. os_get_reltime(&wpa_s->wps_pin_start_time);
  1106. return wpas_wps_start_dev_pw(wpa_s, NULL, bssid, pin, p2p_group,
  1107. dev_pw_id, NULL, NULL, 0, 0);
  1108. }
  1109. void wpas_wps_pbc_overlap(struct wpa_supplicant *wpa_s)
  1110. {
  1111. union wps_event_data data;
  1112. os_memset(&data, 0, sizeof(data));
  1113. data.fail.config_error = WPS_CFG_MULTIPLE_PBC_DETECTED;
  1114. data.fail.error_indication = WPS_EI_NO_ERROR;
  1115. /*
  1116. * Call wpas_notify_wps_event_fail() directly instead of through
  1117. * wpa_supplicant_wps_event() which would end up registering unnecessary
  1118. * timeouts (those are only for the case where the failure happens
  1119. * during an EAP-WSC exchange).
  1120. */
  1121. wpas_notify_wps_event_fail(wpa_s, &data.fail);
  1122. }
  1123. /* Cancel the wps pbc/pin requests */
  1124. int wpas_wps_cancel(struct wpa_supplicant *wpa_s)
  1125. {
  1126. #ifdef CONFIG_AP
  1127. if (wpa_s->ap_iface) {
  1128. wpa_printf(MSG_DEBUG, "WPS: Cancelling in AP mode");
  1129. return wpa_supplicant_ap_wps_cancel(wpa_s);
  1130. }
  1131. #endif /* CONFIG_AP */
  1132. if (wpa_s->wpa_state == WPA_SCANNING ||
  1133. wpa_s->wpa_state == WPA_DISCONNECTED) {
  1134. wpa_printf(MSG_DEBUG, "WPS: Cancel operation - cancel scan");
  1135. wpa_supplicant_cancel_scan(wpa_s);
  1136. wpas_clear_wps(wpa_s);
  1137. } else if (wpa_s->wpa_state >= WPA_ASSOCIATED) {
  1138. wpa_printf(MSG_DEBUG, "WPS: Cancel operation - "
  1139. "deauthenticate");
  1140. wpa_s->own_disconnect_req = 1;
  1141. wpa_supplicant_deauthenticate(wpa_s,
  1142. WLAN_REASON_DEAUTH_LEAVING);
  1143. wpas_clear_wps(wpa_s);
  1144. } else {
  1145. wpas_wps_reenable_networks(wpa_s);
  1146. wpas_wps_clear_ap_info(wpa_s);
  1147. if (eloop_cancel_timeout(wpas_wps_clear_timeout, wpa_s, NULL) >
  1148. 0)
  1149. wpas_clear_wps(wpa_s);
  1150. }
  1151. wpa_s->after_wps = 0;
  1152. return 0;
  1153. }
  1154. int wpas_wps_start_reg(struct wpa_supplicant *wpa_s, const u8 *bssid,
  1155. const char *pin, struct wps_new_ap_settings *settings)
  1156. {
  1157. struct wpa_ssid *ssid;
  1158. char val[200];
  1159. char *pos, *end;
  1160. int res;
  1161. #ifdef CONFIG_AP
  1162. if (wpa_s->ap_iface) {
  1163. wpa_printf(MSG_DEBUG,
  1164. "WPS: Reject request to start Registrar(as station) operation while AP mode is enabled");
  1165. return -1;
  1166. }
  1167. #endif /* CONFIG_AP */
  1168. if (!pin)
  1169. return -1;
  1170. wpas_clear_wps(wpa_s);
  1171. ssid = wpas_wps_add_network(wpa_s, 1, NULL, bssid);
  1172. if (ssid == NULL)
  1173. return -1;
  1174. ssid->temporary = 1;
  1175. pos = val;
  1176. end = pos + sizeof(val);
  1177. res = os_snprintf(pos, end - pos, "\"pin=%s", pin);
  1178. if (os_snprintf_error(end - pos, res))
  1179. return -1;
  1180. pos += res;
  1181. if (settings) {
  1182. res = os_snprintf(pos, end - pos, " new_ssid=%s new_auth=%s "
  1183. "new_encr=%s new_key=%s",
  1184. settings->ssid_hex, settings->auth,
  1185. settings->encr, settings->key_hex);
  1186. if (os_snprintf_error(end - pos, res))
  1187. return -1;
  1188. pos += res;
  1189. }
  1190. res = os_snprintf(pos, end - pos, "\"");
  1191. if (os_snprintf_error(end - pos, res))
  1192. return -1;
  1193. if (wpa_config_set(ssid, "phase1", val, 0) < 0)
  1194. return -1;
  1195. if (wpa_s->wps_fragment_size)
  1196. ssid->eap.fragment_size = wpa_s->wps_fragment_size;
  1197. eloop_register_timeout(WPS_PBC_WALK_TIME, 0, wpas_wps_timeout,
  1198. wpa_s, NULL);
  1199. wpas_wps_reassoc(wpa_s, ssid, bssid, 0);
  1200. return 0;
  1201. }
  1202. static int wpas_wps_new_psk_cb(void *ctx, const u8 *mac_addr,
  1203. const u8 *p2p_dev_addr, const u8 *psk,
  1204. size_t psk_len)
  1205. {
  1206. if (is_zero_ether_addr(p2p_dev_addr)) {
  1207. wpa_printf(MSG_DEBUG,
  1208. "Received new WPA/WPA2-PSK from WPS for STA " MACSTR,
  1209. MAC2STR(mac_addr));
  1210. } else {
  1211. wpa_printf(MSG_DEBUG,
  1212. "Received new WPA/WPA2-PSK from WPS for STA " MACSTR
  1213. " P2P Device Addr " MACSTR,
  1214. MAC2STR(mac_addr), MAC2STR(p2p_dev_addr));
  1215. }
  1216. wpa_hexdump_key(MSG_DEBUG, "Per-device PSK", psk, psk_len);
  1217. /* TODO */
  1218. return 0;
  1219. }
  1220. static void wpas_wps_pin_needed_cb(void *ctx, const u8 *uuid_e,
  1221. const struct wps_device_data *dev)
  1222. {
  1223. char uuid[40], txt[400];
  1224. int len;
  1225. char devtype[WPS_DEV_TYPE_BUFSIZE];
  1226. if (uuid_bin2str(uuid_e, uuid, sizeof(uuid)))
  1227. return;
  1228. wpa_printf(MSG_DEBUG, "WPS: PIN needed for UUID-E %s", uuid);
  1229. len = os_snprintf(txt, sizeof(txt), "WPS-EVENT-PIN-NEEDED %s " MACSTR
  1230. " [%s|%s|%s|%s|%s|%s]",
  1231. uuid, MAC2STR(dev->mac_addr), dev->device_name,
  1232. dev->manufacturer, dev->model_name,
  1233. dev->model_number, dev->serial_number,
  1234. wps_dev_type_bin2str(dev->pri_dev_type, devtype,
  1235. sizeof(devtype)));
  1236. if (!os_snprintf_error(sizeof(txt), len))
  1237. wpa_printf(MSG_INFO, "%s", txt);
  1238. }
  1239. static void wpas_wps_set_sel_reg_cb(void *ctx, int sel_reg, u16 dev_passwd_id,
  1240. u16 sel_reg_config_methods)
  1241. {
  1242. #ifdef CONFIG_WPS_ER
  1243. struct wpa_supplicant *wpa_s = ctx;
  1244. if (wpa_s->wps_er == NULL)
  1245. return;
  1246. wpa_printf(MSG_DEBUG, "WPS ER: SetSelectedRegistrar - sel_reg=%d "
  1247. "dev_password_id=%u sel_reg_config_methods=0x%x",
  1248. sel_reg, dev_passwd_id, sel_reg_config_methods);
  1249. wps_er_set_sel_reg(wpa_s->wps_er, sel_reg, dev_passwd_id,
  1250. sel_reg_config_methods);
  1251. #endif /* CONFIG_WPS_ER */
  1252. }
  1253. static u16 wps_fix_config_methods(u16 config_methods)
  1254. {
  1255. if ((config_methods &
  1256. (WPS_CONFIG_DISPLAY | WPS_CONFIG_VIRT_DISPLAY |
  1257. WPS_CONFIG_PHY_DISPLAY)) == WPS_CONFIG_DISPLAY) {
  1258. wpa_printf(MSG_INFO, "WPS: Converting display to "
  1259. "virtual_display for WPS 2.0 compliance");
  1260. config_methods |= WPS_CONFIG_VIRT_DISPLAY;
  1261. }
  1262. if ((config_methods &
  1263. (WPS_CONFIG_PUSHBUTTON | WPS_CONFIG_VIRT_PUSHBUTTON |
  1264. WPS_CONFIG_PHY_PUSHBUTTON)) == WPS_CONFIG_PUSHBUTTON) {
  1265. wpa_printf(MSG_INFO, "WPS: Converting push_button to "
  1266. "virtual_push_button for WPS 2.0 compliance");
  1267. config_methods |= WPS_CONFIG_VIRT_PUSHBUTTON;
  1268. }
  1269. return config_methods;
  1270. }
  1271. static void wpas_wps_set_uuid(struct wpa_supplicant *wpa_s,
  1272. struct wps_context *wps)
  1273. {
  1274. char buf[50];
  1275. const char *src;
  1276. if (is_nil_uuid(wpa_s->conf->uuid)) {
  1277. struct wpa_supplicant *first;
  1278. first = wpa_s->global->ifaces;
  1279. while (first && first->next)
  1280. first = first->next;
  1281. if (first && first != wpa_s) {
  1282. if (wps != wpa_s->global->ifaces->wps)
  1283. os_memcpy(wps->uuid,
  1284. wpa_s->global->ifaces->wps->uuid,
  1285. WPS_UUID_LEN);
  1286. src = "from the first interface";
  1287. } else {
  1288. uuid_gen_mac_addr(wpa_s->own_addr, wps->uuid);
  1289. src = "based on MAC address";
  1290. }
  1291. } else {
  1292. os_memcpy(wps->uuid, wpa_s->conf->uuid, WPS_UUID_LEN);
  1293. src = "based on configuration";
  1294. }
  1295. uuid_bin2str(wps->uuid, buf, sizeof(buf));
  1296. wpa_dbg(wpa_s, MSG_DEBUG, "WPS: UUID %s: %s", src, buf);
  1297. }
  1298. static void wpas_wps_set_vendor_ext_m1(struct wpa_supplicant *wpa_s,
  1299. struct wps_context *wps)
  1300. {
  1301. wpabuf_free(wps->dev.vendor_ext_m1);
  1302. wps->dev.vendor_ext_m1 = NULL;
  1303. if (wpa_s->conf->wps_vendor_ext_m1) {
  1304. wps->dev.vendor_ext_m1 =
  1305. wpabuf_dup(wpa_s->conf->wps_vendor_ext_m1);
  1306. if (!wps->dev.vendor_ext_m1) {
  1307. wpa_printf(MSG_ERROR, "WPS: Cannot "
  1308. "allocate memory for vendor_ext_m1");
  1309. }
  1310. }
  1311. }
  1312. int wpas_wps_init(struct wpa_supplicant *wpa_s)
  1313. {
  1314. struct wps_context *wps;
  1315. struct wps_registrar_config rcfg;
  1316. struct hostapd_hw_modes *modes;
  1317. u16 m;
  1318. wps = os_zalloc(sizeof(*wps));
  1319. if (wps == NULL)
  1320. return -1;
  1321. wps->cred_cb = wpa_supplicant_wps_cred;
  1322. wps->event_cb = wpa_supplicant_wps_event;
  1323. wps->rf_band_cb = wpa_supplicant_wps_rf_band;
  1324. wps->cb_ctx = wpa_s;
  1325. wps->dev.device_name = wpa_s->conf->device_name;
  1326. wps->dev.manufacturer = wpa_s->conf->manufacturer;
  1327. wps->dev.model_name = wpa_s->conf->model_name;
  1328. wps->dev.model_number = wpa_s->conf->model_number;
  1329. wps->dev.serial_number = wpa_s->conf->serial_number;
  1330. wps->config_methods =
  1331. wps_config_methods_str2bin(wpa_s->conf->config_methods);
  1332. if ((wps->config_methods & (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) ==
  1333. (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) {
  1334. wpa_printf(MSG_ERROR, "WPS: Both Label and Display config "
  1335. "methods are not allowed at the same time");
  1336. os_free(wps);
  1337. return -1;
  1338. }
  1339. wps->config_methods = wps_fix_config_methods(wps->config_methods);
  1340. wps->dev.config_methods = wps->config_methods;
  1341. os_memcpy(wps->dev.pri_dev_type, wpa_s->conf->device_type,
  1342. WPS_DEV_TYPE_LEN);
  1343. wps->dev.num_sec_dev_types = wpa_s->conf->num_sec_device_types;
  1344. os_memcpy(wps->dev.sec_dev_type, wpa_s->conf->sec_device_type,
  1345. WPS_DEV_TYPE_LEN * wps->dev.num_sec_dev_types);
  1346. wpas_wps_set_vendor_ext_m1(wpa_s, wps);
  1347. wps->dev.os_version = WPA_GET_BE32(wpa_s->conf->os_version);
  1348. modes = wpa_s->hw.modes;
  1349. if (modes) {
  1350. for (m = 0; m < wpa_s->hw.num_modes; m++) {
  1351. if (modes[m].mode == HOSTAPD_MODE_IEEE80211B ||
  1352. modes[m].mode == HOSTAPD_MODE_IEEE80211G)
  1353. wps->dev.rf_bands |= WPS_RF_24GHZ;
  1354. else if (modes[m].mode == HOSTAPD_MODE_IEEE80211A)
  1355. wps->dev.rf_bands |= WPS_RF_50GHZ;
  1356. else if (modes[m].mode == HOSTAPD_MODE_IEEE80211AD)
  1357. wps->dev.rf_bands |= WPS_RF_60GHZ;
  1358. }
  1359. }
  1360. if (wps->dev.rf_bands == 0) {
  1361. /*
  1362. * Default to claiming support for both bands if the driver
  1363. * does not provide support for fetching supported bands.
  1364. */
  1365. wps->dev.rf_bands = WPS_RF_24GHZ | WPS_RF_50GHZ;
  1366. }
  1367. os_memcpy(wps->dev.mac_addr, wpa_s->own_addr, ETH_ALEN);
  1368. wpas_wps_set_uuid(wpa_s, wps);
  1369. wps->auth_types = WPS_AUTH_WPA2PSK | WPS_AUTH_WPAPSK;
  1370. wps->encr_types = WPS_ENCR_AES | WPS_ENCR_TKIP;
  1371. os_memset(&rcfg, 0, sizeof(rcfg));
  1372. rcfg.new_psk_cb = wpas_wps_new_psk_cb;
  1373. rcfg.pin_needed_cb = wpas_wps_pin_needed_cb;
  1374. rcfg.set_sel_reg_cb = wpas_wps_set_sel_reg_cb;
  1375. rcfg.cb_ctx = wpa_s;
  1376. wps->registrar = wps_registrar_init(wps, &rcfg);
  1377. if (wps->registrar == NULL) {
  1378. wpa_printf(MSG_DEBUG, "Failed to initialize WPS Registrar");
  1379. os_free(wps);
  1380. return -1;
  1381. }
  1382. wpa_s->wps = wps;
  1383. return 0;
  1384. }
  1385. #ifdef CONFIG_WPS_ER
  1386. static void wpas_wps_nfc_clear(struct wps_context *wps)
  1387. {
  1388. wps->ap_nfc_dev_pw_id = 0;
  1389. wpabuf_free(wps->ap_nfc_dh_pubkey);
  1390. wps->ap_nfc_dh_pubkey = NULL;
  1391. wpabuf_free(wps->ap_nfc_dh_privkey);
  1392. wps->ap_nfc_dh_privkey = NULL;
  1393. wpabuf_free(wps->ap_nfc_dev_pw);
  1394. wps->ap_nfc_dev_pw = NULL;
  1395. }
  1396. #endif /* CONFIG_WPS_ER */
  1397. void wpas_wps_deinit(struct wpa_supplicant *wpa_s)
  1398. {
  1399. wpas_wps_assoc_with_cred_cancel(wpa_s);
  1400. eloop_cancel_timeout(wpas_wps_timeout, wpa_s, NULL);
  1401. eloop_cancel_timeout(wpas_wps_clear_timeout, wpa_s, NULL);
  1402. eloop_cancel_timeout(wpas_wps_reenable_networks_cb, wpa_s, NULL);
  1403. wpas_wps_clear_ap_info(wpa_s);
  1404. #ifdef CONFIG_P2P
  1405. eloop_cancel_timeout(wpas_p2p_pbc_overlap_cb, wpa_s, NULL);
  1406. #endif /* CONFIG_P2P */
  1407. if (wpa_s->wps == NULL)
  1408. return;
  1409. #ifdef CONFIG_WPS_ER
  1410. wps_er_deinit(wpa_s->wps_er, NULL, NULL);
  1411. wpa_s->wps_er = NULL;
  1412. wpas_wps_nfc_clear(wpa_s->wps);
  1413. #endif /* CONFIG_WPS_ER */
  1414. wps_registrar_deinit(wpa_s->wps->registrar);
  1415. wpabuf_free(wpa_s->wps->dh_pubkey);
  1416. wpabuf_free(wpa_s->wps->dh_privkey);
  1417. wpabuf_free(wpa_s->wps->dev.vendor_ext_m1);
  1418. os_free(wpa_s->wps->network_key);
  1419. os_free(wpa_s->wps);
  1420. wpa_s->wps = NULL;
  1421. }
  1422. int wpas_wps_ssid_bss_match(struct wpa_supplicant *wpa_s,
  1423. struct wpa_ssid *ssid, struct wpa_bss *bss)
  1424. {
  1425. struct wpabuf *wps_ie;
  1426. if (!(ssid->key_mgmt & WPA_KEY_MGMT_WPS))
  1427. return -1;
  1428. wps_ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
  1429. if (eap_is_wps_pbc_enrollee(&ssid->eap)) {
  1430. if (!wps_ie) {
  1431. wpa_printf(MSG_DEBUG, " skip - non-WPS AP");
  1432. return 0;
  1433. }
  1434. if (!wps_is_selected_pbc_registrar(wps_ie)) {
  1435. wpa_printf(MSG_DEBUG, " skip - WPS AP "
  1436. "without active PBC Registrar");
  1437. wpabuf_free(wps_ie);
  1438. return 0;
  1439. }
  1440. /* TODO: overlap detection */
  1441. wpa_printf(MSG_DEBUG, " selected based on WPS IE "
  1442. "(Active PBC)");
  1443. wpabuf_free(wps_ie);
  1444. return 1;
  1445. }
  1446. if (eap_is_wps_pin_enrollee(&ssid->eap)) {
  1447. if (!wps_ie) {
  1448. wpa_printf(MSG_DEBUG, " skip - non-WPS AP");
  1449. return 0;
  1450. }
  1451. /*
  1452. * Start with WPS APs that advertise our address as an
  1453. * authorized MAC (v2.0) or active PIN Registrar (v1.0) and
  1454. * allow any WPS AP after couple of scans since some APs do not
  1455. * set Selected Registrar attribute properly when using
  1456. * external Registrar.
  1457. */
  1458. if (!wps_is_addr_authorized(wps_ie, wpa_s->own_addr, 1)) {
  1459. struct os_reltime age;
  1460. os_reltime_age(&wpa_s->wps_pin_start_time, &age);
  1461. if (wpa_s->scan_runs < WPS_PIN_SCAN_IGNORE_SEL_REG ||
  1462. age.sec < WPS_PIN_TIME_IGNORE_SEL_REG) {
  1463. wpa_printf(MSG_DEBUG,
  1464. " skip - WPS AP without active PIN Registrar (scan_runs=%d age=%d)",
  1465. wpa_s->scan_runs, (int) age.sec);
  1466. wpabuf_free(wps_ie);
  1467. return 0;
  1468. }
  1469. wpa_printf(MSG_DEBUG, " selected based on WPS IE");
  1470. } else {
  1471. wpa_printf(MSG_DEBUG, " selected based on WPS IE "
  1472. "(Authorized MAC or Active PIN)");
  1473. }
  1474. wpabuf_free(wps_ie);
  1475. return 1;
  1476. }
  1477. if (wps_ie) {
  1478. wpa_printf(MSG_DEBUG, " selected based on WPS IE");
  1479. wpabuf_free(wps_ie);
  1480. return 1;
  1481. }
  1482. return -1;
  1483. }
  1484. int wpas_wps_ssid_wildcard_ok(struct wpa_supplicant *wpa_s,
  1485. struct wpa_ssid *ssid,
  1486. struct wpa_bss *bss)
  1487. {
  1488. struct wpabuf *wps_ie = NULL;
  1489. int ret = 0;
  1490. if (eap_is_wps_pbc_enrollee(&ssid->eap)) {
  1491. wps_ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
  1492. if (wps_ie && wps_is_selected_pbc_registrar(wps_ie)) {
  1493. /* allow wildcard SSID for WPS PBC */
  1494. ret = 1;
  1495. }
  1496. } else if (eap_is_wps_pin_enrollee(&ssid->eap)) {
  1497. wps_ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
  1498. if (wps_ie &&
  1499. (wps_is_addr_authorized(wps_ie, wpa_s->own_addr, 1) ||
  1500. wpa_s->scan_runs >= WPS_PIN_SCAN_IGNORE_SEL_REG)) {
  1501. /* allow wildcard SSID for WPS PIN */
  1502. ret = 1;
  1503. }
  1504. }
  1505. if (!ret && ssid->bssid_set &&
  1506. os_memcmp(ssid->bssid, bss->bssid, ETH_ALEN) == 0) {
  1507. /* allow wildcard SSID due to hardcoded BSSID match */
  1508. ret = 1;
  1509. }
  1510. #ifdef CONFIG_WPS_STRICT
  1511. if (wps_ie) {
  1512. if (wps_validate_beacon_probe_resp(wps_ie, bss->beacon_ie_len >
  1513. 0, bss->bssid) < 0)
  1514. ret = 0;
  1515. if (bss->beacon_ie_len) {
  1516. struct wpabuf *bcn_wps;
  1517. bcn_wps = wpa_bss_get_vendor_ie_multi_beacon(
  1518. bss, WPS_IE_VENDOR_TYPE);
  1519. if (bcn_wps == NULL) {
  1520. wpa_printf(MSG_DEBUG, "WPS: Mandatory WPS IE "
  1521. "missing from AP Beacon");
  1522. ret = 0;
  1523. } else {
  1524. if (wps_validate_beacon(wps_ie) < 0)
  1525. ret = 0;
  1526. wpabuf_free(bcn_wps);
  1527. }
  1528. }
  1529. }
  1530. #endif /* CONFIG_WPS_STRICT */
  1531. wpabuf_free(wps_ie);
  1532. return ret;
  1533. }
  1534. int wpas_wps_scan_pbc_overlap(struct wpa_supplicant *wpa_s,
  1535. struct wpa_bss *selected, struct wpa_ssid *ssid)
  1536. {
  1537. const u8 *sel_uuid;
  1538. struct wpabuf *wps_ie;
  1539. int ret = 0;
  1540. size_t i;
  1541. if (!eap_is_wps_pbc_enrollee(&ssid->eap))
  1542. return 0;
  1543. wpa_printf(MSG_DEBUG, "WPS: Check whether PBC session overlap is "
  1544. "present in scan results; selected BSSID " MACSTR,
  1545. MAC2STR(selected->bssid));
  1546. /* Make sure that only one AP is in active PBC mode */
  1547. wps_ie = wpa_bss_get_vendor_ie_multi(selected, WPS_IE_VENDOR_TYPE);
  1548. if (wps_ie) {
  1549. sel_uuid = wps_get_uuid_e(wps_ie);
  1550. wpa_hexdump(MSG_DEBUG, "WPS: UUID of the selected BSS",
  1551. sel_uuid, UUID_LEN);
  1552. } else {
  1553. wpa_printf(MSG_DEBUG, "WPS: Selected BSS does not include "
  1554. "WPS IE?!");
  1555. sel_uuid = NULL;
  1556. }
  1557. for (i = 0; i < wpa_s->num_wps_ap; i++) {
  1558. struct wps_ap_info *ap = &wpa_s->wps_ap[i];
  1559. if (!ap->pbc_active ||
  1560. os_memcmp(selected->bssid, ap->bssid, ETH_ALEN) == 0)
  1561. continue;
  1562. wpa_printf(MSG_DEBUG, "WPS: Another BSS in active PBC mode: "
  1563. MACSTR, MAC2STR(ap->bssid));
  1564. wpa_hexdump(MSG_DEBUG, "WPS: UUID of the other BSS",
  1565. ap->uuid, UUID_LEN);
  1566. if (sel_uuid == NULL ||
  1567. os_memcmp(sel_uuid, ap->uuid, UUID_LEN) != 0) {
  1568. ret = 1; /* PBC overlap */
  1569. wpa_msg(wpa_s, MSG_INFO, "WPS: PBC overlap detected: "
  1570. MACSTR " and " MACSTR,
  1571. MAC2STR(selected->bssid),
  1572. MAC2STR(ap->bssid));
  1573. break;
  1574. }
  1575. /* TODO: verify that this is reasonable dual-band situation */
  1576. }
  1577. wpabuf_free(wps_ie);
  1578. return ret;
  1579. }
  1580. void wpas_wps_notify_scan_results(struct wpa_supplicant *wpa_s)
  1581. {
  1582. struct wpa_bss *bss;
  1583. unsigned int pbc = 0, auth = 0, pin = 0, wps = 0;
  1584. if (wpa_s->disconnected || wpa_s->wpa_state >= WPA_ASSOCIATED)
  1585. return;
  1586. dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
  1587. struct wpabuf *ie;
  1588. ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
  1589. if (!ie)
  1590. continue;
  1591. if (wps_is_selected_pbc_registrar(ie))
  1592. pbc++;
  1593. else if (wps_is_addr_authorized(ie, wpa_s->own_addr, 0))
  1594. auth++;
  1595. else if (wps_is_selected_pin_registrar(ie))
  1596. pin++;
  1597. else
  1598. wps++;
  1599. wpabuf_free(ie);
  1600. }
  1601. if (pbc)
  1602. wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE_PBC);
  1603. else if (auth)
  1604. wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE_AUTH);
  1605. else if (pin)
  1606. wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE_PIN);
  1607. else if (wps)
  1608. wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE);
  1609. }
  1610. int wpas_wps_searching(struct wpa_supplicant *wpa_s)
  1611. {
  1612. struct wpa_ssid *ssid;
  1613. for (ssid = wpa_s->conf->ssid; ssid; ssid = ssid->next) {
  1614. if ((ssid->key_mgmt & WPA_KEY_MGMT_WPS) && !ssid->disabled)
  1615. return 1;
  1616. }
  1617. return 0;
  1618. }
  1619. int wpas_wps_scan_result_text(const u8 *ies, size_t ies_len, char *buf,
  1620. char *end)
  1621. {
  1622. struct wpabuf *wps_ie;
  1623. int ret;
  1624. wps_ie = ieee802_11_vendor_ie_concat(ies, ies_len, WPS_DEV_OUI_WFA);
  1625. if (wps_ie == NULL)
  1626. return 0;
  1627. ret = wps_attr_text(wps_ie, buf, end);
  1628. wpabuf_free(wps_ie);
  1629. return ret;
  1630. }
  1631. int wpas_wps_er_start(struct wpa_supplicant *wpa_s, const char *filter)
  1632. {
  1633. #ifdef CONFIG_WPS_ER
  1634. if (wpa_s->wps_er) {
  1635. wps_er_refresh(wpa_s->wps_er);
  1636. return 0;
  1637. }
  1638. wpa_s->wps_er = wps_er_init(wpa_s->wps, wpa_s->ifname, filter);
  1639. if (wpa_s->wps_er == NULL)
  1640. return -1;
  1641. return 0;
  1642. #else /* CONFIG_WPS_ER */
  1643. return 0;
  1644. #endif /* CONFIG_WPS_ER */
  1645. }
  1646. void wpas_wps_er_stop(struct wpa_supplicant *wpa_s)
  1647. {
  1648. #ifdef CONFIG_WPS_ER
  1649. wps_er_deinit(wpa_s->wps_er, NULL, NULL);
  1650. wpa_s->wps_er = NULL;
  1651. #endif /* CONFIG_WPS_ER */
  1652. }
  1653. #ifdef CONFIG_WPS_ER
  1654. int wpas_wps_er_add_pin(struct wpa_supplicant *wpa_s, const u8 *addr,
  1655. const char *uuid, const char *pin)
  1656. {
  1657. u8 u[UUID_LEN];
  1658. const u8 *use_uuid = NULL;
  1659. u8 addr_buf[ETH_ALEN];
  1660. if (os_strcmp(uuid, "any") == 0) {
  1661. } else if (uuid_str2bin(uuid, u) == 0) {
  1662. use_uuid = u;
  1663. } else if (hwaddr_aton(uuid, addr_buf) == 0) {
  1664. use_uuid = wps_er_get_sta_uuid(wpa_s->wps_er, addr_buf);
  1665. if (use_uuid == NULL)
  1666. return -1;
  1667. } else
  1668. return -1;
  1669. return wps_registrar_add_pin(wpa_s->wps->registrar, addr,
  1670. use_uuid,
  1671. (const u8 *) pin, os_strlen(pin), 300);
  1672. }
  1673. int wpas_wps_er_pbc(struct wpa_supplicant *wpa_s, const char *uuid)
  1674. {
  1675. u8 u[UUID_LEN], *use_uuid = NULL;
  1676. u8 addr[ETH_ALEN], *use_addr = NULL;
  1677. if (uuid_str2bin(uuid, u) == 0)
  1678. use_uuid = u;
  1679. else if (hwaddr_aton(uuid, addr) == 0)
  1680. use_addr = addr;
  1681. else
  1682. return -1;
  1683. return wps_er_pbc(wpa_s->wps_er, use_uuid, use_addr);
  1684. }
  1685. int wpas_wps_er_learn(struct wpa_supplicant *wpa_s, const char *uuid,
  1686. const char *pin)
  1687. {
  1688. u8 u[UUID_LEN], *use_uuid = NULL;
  1689. u8 addr[ETH_ALEN], *use_addr = NULL;
  1690. if (uuid_str2bin(uuid, u) == 0)
  1691. use_uuid = u;
  1692. else if (hwaddr_aton(uuid, addr) == 0)
  1693. use_addr = addr;
  1694. else
  1695. return -1;
  1696. return wps_er_learn(wpa_s->wps_er, use_uuid, use_addr, (const u8 *) pin,
  1697. os_strlen(pin));
  1698. }
  1699. static int wpas_wps_network_to_cred(struct wpa_ssid *ssid,
  1700. struct wps_credential *cred)
  1701. {
  1702. os_memset(cred, 0, sizeof(*cred));
  1703. if (ssid->ssid_len > SSID_MAX_LEN)
  1704. return -1;
  1705. os_memcpy(cred->ssid, ssid->ssid, ssid->ssid_len);
  1706. cred->ssid_len = ssid->ssid_len;
  1707. if (ssid->key_mgmt & WPA_KEY_MGMT_PSK) {
  1708. cred->auth_type = (ssid->proto & WPA_PROTO_RSN) ?
  1709. WPS_AUTH_WPA2PSK : WPS_AUTH_WPAPSK;
  1710. if (ssid->pairwise_cipher & WPA_CIPHER_CCMP)
  1711. cred->encr_type = WPS_ENCR_AES;
  1712. else
  1713. cred->encr_type = WPS_ENCR_TKIP;
  1714. if (ssid->passphrase) {
  1715. cred->key_len = os_strlen(ssid->passphrase);
  1716. if (cred->key_len >= 64)
  1717. return -1;
  1718. os_memcpy(cred->key, ssid->passphrase, cred->key_len);
  1719. } else if (ssid->psk_set) {
  1720. cred->key_len = 32;
  1721. os_memcpy(cred->key, ssid->psk, 32);
  1722. } else
  1723. return -1;
  1724. } else {
  1725. cred->auth_type = WPS_AUTH_OPEN;
  1726. cred->encr_type = WPS_ENCR_NONE;
  1727. }
  1728. return 0;
  1729. }
  1730. int wpas_wps_er_set_config(struct wpa_supplicant *wpa_s, const char *uuid,
  1731. int id)
  1732. {
  1733. u8 u[UUID_LEN], *use_uuid = NULL;
  1734. u8 addr[ETH_ALEN], *use_addr = NULL;
  1735. struct wpa_ssid *ssid;
  1736. struct wps_credential cred;
  1737. int ret;
  1738. if (uuid_str2bin(uuid, u) == 0)
  1739. use_uuid = u;
  1740. else if (hwaddr_aton(uuid, addr) == 0)
  1741. use_addr = addr;
  1742. else
  1743. return -1;
  1744. ssid = wpa_config_get_network(wpa_s->conf, id);
  1745. if (ssid == NULL || ssid->ssid == NULL)
  1746. return -1;
  1747. if (wpas_wps_network_to_cred(ssid, &cred) < 0)
  1748. return -1;
  1749. ret = wps_er_set_config(wpa_s->wps_er, use_uuid, use_addr, &cred);
  1750. os_memset(&cred, 0, sizeof(cred));
  1751. return ret;
  1752. }
  1753. int wpas_wps_er_config(struct wpa_supplicant *wpa_s, const char *uuid,
  1754. const char *pin, struct wps_new_ap_settings *settings)
  1755. {
  1756. u8 u[UUID_LEN], *use_uuid = NULL;
  1757. u8 addr[ETH_ALEN], *use_addr = NULL;
  1758. struct wps_credential cred;
  1759. size_t len;
  1760. if (uuid_str2bin(uuid, u) == 0)
  1761. use_uuid = u;
  1762. else if (hwaddr_aton(uuid, addr) == 0)
  1763. use_addr = addr;
  1764. else
  1765. return -1;
  1766. if (settings->ssid_hex == NULL || settings->auth == NULL ||
  1767. settings->encr == NULL || settings->key_hex == NULL)
  1768. return -1;
  1769. os_memset(&cred, 0, sizeof(cred));
  1770. len = os_strlen(settings->ssid_hex);
  1771. if ((len & 1) || len > 2 * sizeof(cred.ssid) ||
  1772. hexstr2bin(settings->ssid_hex, cred.ssid, len / 2))
  1773. return -1;
  1774. cred.ssid_len = len / 2;
  1775. len = os_strlen(settings->key_hex);
  1776. if ((len & 1) || len > 2 * sizeof(cred.key) ||
  1777. hexstr2bin(settings->key_hex, cred.key, len / 2))
  1778. return -1;
  1779. cred.key_len = len / 2;
  1780. if (os_strcmp(settings->auth, "OPEN") == 0)
  1781. cred.auth_type = WPS_AUTH_OPEN;
  1782. else if (os_strcmp(settings->auth, "WPAPSK") == 0)
  1783. cred.auth_type = WPS_AUTH_WPAPSK;
  1784. else if (os_strcmp(settings->auth, "WPA2PSK") == 0)
  1785. cred.auth_type = WPS_AUTH_WPA2PSK;
  1786. else
  1787. return -1;
  1788. if (os_strcmp(settings->encr, "NONE") == 0)
  1789. cred.encr_type = WPS_ENCR_NONE;
  1790. #ifdef CONFIG_TESTING_OPTIONS
  1791. else if (os_strcmp(settings->encr, "WEP") == 0)
  1792. cred.encr_type = WPS_ENCR_WEP;
  1793. #endif /* CONFIG_TESTING_OPTIONS */
  1794. else if (os_strcmp(settings->encr, "TKIP") == 0)
  1795. cred.encr_type = WPS_ENCR_TKIP;
  1796. else if (os_strcmp(settings->encr, "CCMP") == 0)
  1797. cred.encr_type = WPS_ENCR_AES;
  1798. else
  1799. return -1;
  1800. return wps_er_config(wpa_s->wps_er, use_uuid, use_addr,
  1801. (const u8 *) pin, os_strlen(pin), &cred);
  1802. }
  1803. #ifdef CONFIG_WPS_NFC
  1804. struct wpabuf * wpas_wps_er_nfc_config_token(struct wpa_supplicant *wpa_s,
  1805. int ndef, const char *uuid)
  1806. {
  1807. struct wpabuf *ret;
  1808. u8 u[UUID_LEN], *use_uuid = NULL;
  1809. u8 addr[ETH_ALEN], *use_addr = NULL;
  1810. if (!wpa_s->wps_er)
  1811. return NULL;
  1812. if (uuid_str2bin(uuid, u) == 0)
  1813. use_uuid = u;
  1814. else if (hwaddr_aton(uuid, addr) == 0)
  1815. use_addr = addr;
  1816. else
  1817. return NULL;
  1818. ret = wps_er_nfc_config_token(wpa_s->wps_er, use_uuid, use_addr);
  1819. if (ndef && ret) {
  1820. struct wpabuf *tmp;
  1821. tmp = ndef_build_wifi(ret);
  1822. wpabuf_free(ret);
  1823. if (tmp == NULL)
  1824. return NULL;
  1825. ret = tmp;
  1826. }
  1827. return ret;
  1828. }
  1829. #endif /* CONFIG_WPS_NFC */
  1830. static int callbacks_pending = 0;
  1831. static void wpas_wps_terminate_cb(void *ctx)
  1832. {
  1833. wpa_printf(MSG_DEBUG, "WPS ER: Terminated");
  1834. if (--callbacks_pending <= 0)
  1835. eloop_terminate();
  1836. }
  1837. #endif /* CONFIG_WPS_ER */
  1838. int wpas_wps_terminate_pending(struct wpa_supplicant *wpa_s)
  1839. {
  1840. #ifdef CONFIG_WPS_ER
  1841. if (wpa_s->wps_er) {
  1842. callbacks_pending++;
  1843. wps_er_deinit(wpa_s->wps_er, wpas_wps_terminate_cb, wpa_s);
  1844. wpa_s->wps_er = NULL;
  1845. return 1;
  1846. }
  1847. #endif /* CONFIG_WPS_ER */
  1848. return 0;
  1849. }
  1850. void wpas_wps_update_config(struct wpa_supplicant *wpa_s)
  1851. {
  1852. struct wps_context *wps = wpa_s->wps;
  1853. if (wps == NULL)
  1854. return;
  1855. if (wpa_s->conf->changed_parameters & CFG_CHANGED_CONFIG_METHODS) {
  1856. wps->config_methods = wps_config_methods_str2bin(
  1857. wpa_s->conf->config_methods);
  1858. if ((wps->config_methods &
  1859. (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) ==
  1860. (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) {
  1861. wpa_printf(MSG_ERROR, "WPS: Both Label and Display "
  1862. "config methods are not allowed at the "
  1863. "same time");
  1864. wps->config_methods &= ~WPS_CONFIG_LABEL;
  1865. }
  1866. }
  1867. wps->config_methods = wps_fix_config_methods(wps->config_methods);
  1868. wps->dev.config_methods = wps->config_methods;
  1869. if (wpa_s->conf->changed_parameters & CFG_CHANGED_DEVICE_TYPE)
  1870. os_memcpy(wps->dev.pri_dev_type, wpa_s->conf->device_type,
  1871. WPS_DEV_TYPE_LEN);
  1872. if (wpa_s->conf->changed_parameters & CFG_CHANGED_SEC_DEVICE_TYPE) {
  1873. wps->dev.num_sec_dev_types = wpa_s->conf->num_sec_device_types;
  1874. os_memcpy(wps->dev.sec_dev_type, wpa_s->conf->sec_device_type,
  1875. wps->dev.num_sec_dev_types * WPS_DEV_TYPE_LEN);
  1876. }
  1877. if (wpa_s->conf->changed_parameters & CFG_CHANGED_VENDOR_EXTENSION)
  1878. wpas_wps_set_vendor_ext_m1(wpa_s, wps);
  1879. if (wpa_s->conf->changed_parameters & CFG_CHANGED_OS_VERSION)
  1880. wps->dev.os_version = WPA_GET_BE32(wpa_s->conf->os_version);
  1881. if (wpa_s->conf->changed_parameters & CFG_CHANGED_UUID)
  1882. wpas_wps_set_uuid(wpa_s, wps);
  1883. if (wpa_s->conf->changed_parameters &
  1884. (CFG_CHANGED_DEVICE_NAME | CFG_CHANGED_WPS_STRING)) {
  1885. /* Update pointers to make sure they refer current values */
  1886. wps->dev.device_name = wpa_s->conf->device_name;
  1887. wps->dev.manufacturer = wpa_s->conf->manufacturer;
  1888. wps->dev.model_name = wpa_s->conf->model_name;
  1889. wps->dev.model_number = wpa_s->conf->model_number;
  1890. wps->dev.serial_number = wpa_s->conf->serial_number;
  1891. }
  1892. }
  1893. #ifdef CONFIG_WPS_NFC
  1894. #ifdef CONFIG_WPS_ER
  1895. static struct wpabuf *
  1896. wpas_wps_network_config_token(struct wpa_supplicant *wpa_s, int ndef,
  1897. struct wpa_ssid *ssid)
  1898. {
  1899. struct wpabuf *ret;
  1900. struct wps_credential cred;
  1901. if (wpas_wps_network_to_cred(ssid, &cred) < 0)
  1902. return NULL;
  1903. ret = wps_er_config_token_from_cred(wpa_s->wps, &cred);
  1904. if (ndef && ret) {
  1905. struct wpabuf *tmp;
  1906. tmp = ndef_build_wifi(ret);
  1907. wpabuf_free(ret);
  1908. if (tmp == NULL)
  1909. return NULL;
  1910. ret = tmp;
  1911. }
  1912. return ret;
  1913. }
  1914. #endif /* CONFIG_WPS_ER */
  1915. struct wpabuf * wpas_wps_nfc_config_token(struct wpa_supplicant *wpa_s,
  1916. int ndef, const char *id_str)
  1917. {
  1918. #ifdef CONFIG_WPS_ER
  1919. if (id_str) {
  1920. int id;
  1921. char *end = NULL;
  1922. struct wpa_ssid *ssid;
  1923. id = strtol(id_str, &end, 10);
  1924. if (end && *end)
  1925. return NULL;
  1926. ssid = wpa_config_get_network(wpa_s->conf, id);
  1927. if (ssid == NULL)
  1928. return NULL;
  1929. return wpas_wps_network_config_token(wpa_s, ndef, ssid);
  1930. }
  1931. #endif /* CONFIG_WPS_ER */
  1932. #ifdef CONFIG_AP
  1933. if (wpa_s->ap_iface)
  1934. return wpas_ap_wps_nfc_config_token(wpa_s, ndef);
  1935. #endif /* CONFIG_AP */
  1936. return NULL;
  1937. }
  1938. struct wpabuf * wpas_wps_nfc_token(struct wpa_supplicant *wpa_s, int ndef)
  1939. {
  1940. if (wpa_s->conf->wps_nfc_pw_from_config) {
  1941. return wps_nfc_token_build(ndef,
  1942. wpa_s->conf->wps_nfc_dev_pw_id,
  1943. wpa_s->conf->wps_nfc_dh_pubkey,
  1944. wpa_s->conf->wps_nfc_dev_pw);
  1945. }
  1946. return wps_nfc_token_gen(ndef, &wpa_s->conf->wps_nfc_dev_pw_id,
  1947. &wpa_s->conf->wps_nfc_dh_pubkey,
  1948. &wpa_s->conf->wps_nfc_dh_privkey,
  1949. &wpa_s->conf->wps_nfc_dev_pw);
  1950. }
  1951. int wpas_wps_start_nfc(struct wpa_supplicant *wpa_s, const u8 *go_dev_addr,
  1952. const u8 *bssid,
  1953. const struct wpabuf *dev_pw, u16 dev_pw_id,
  1954. int p2p_group, const u8 *peer_pubkey_hash,
  1955. const u8 *ssid, size_t ssid_len, int freq)
  1956. {
  1957. struct wps_context *wps = wpa_s->wps;
  1958. char pw[32 * 2 + 1];
  1959. if (dev_pw_id != DEV_PW_NFC_CONNECTION_HANDOVER && dev_pw == NULL) {
  1960. dev_pw = wpa_s->conf->wps_nfc_dev_pw;
  1961. dev_pw_id = wpa_s->conf->wps_nfc_dev_pw_id;
  1962. }
  1963. if (wpa_s->conf->wps_nfc_dh_pubkey == NULL ||
  1964. wpa_s->conf->wps_nfc_dh_privkey == NULL) {
  1965. wpa_printf(MSG_DEBUG, "WPS: Missing DH params - "
  1966. "cannot start NFC-triggered connection");
  1967. return -1;
  1968. }
  1969. if (dev_pw_id != DEV_PW_NFC_CONNECTION_HANDOVER && dev_pw == NULL) {
  1970. wpa_printf(MSG_DEBUG, "WPS: Missing Device Password (id=%u) - "
  1971. "cannot start NFC-triggered connection", dev_pw_id);
  1972. return -1;
  1973. }
  1974. dh5_free(wps->dh_ctx);
  1975. wpabuf_free(wps->dh_pubkey);
  1976. wpabuf_free(wps->dh_privkey);
  1977. wps->dh_privkey = wpabuf_dup(wpa_s->conf->wps_nfc_dh_privkey);
  1978. wps->dh_pubkey = wpabuf_dup(wpa_s->conf->wps_nfc_dh_pubkey);
  1979. if (wps->dh_privkey == NULL || wps->dh_pubkey == NULL) {
  1980. wps->dh_ctx = NULL;
  1981. wpabuf_free(wps->dh_pubkey);
  1982. wps->dh_pubkey = NULL;
  1983. wpabuf_free(wps->dh_privkey);
  1984. wps->dh_privkey = NULL;
  1985. wpa_printf(MSG_DEBUG, "WPS: Failed to get DH priv/pub key");
  1986. return -1;
  1987. }
  1988. wps->dh_ctx = dh5_init_fixed(wps->dh_privkey, wps->dh_pubkey);
  1989. if (wps->dh_ctx == NULL) {
  1990. wpabuf_free(wps->dh_pubkey);
  1991. wps->dh_pubkey = NULL;
  1992. wpabuf_free(wps->dh_privkey);
  1993. wps->dh_privkey = NULL;
  1994. wpa_printf(MSG_DEBUG, "WPS: Failed to initialize DH context");
  1995. return -1;
  1996. }
  1997. if (dev_pw) {
  1998. wpa_snprintf_hex_uppercase(pw, sizeof(pw),
  1999. wpabuf_head(dev_pw),
  2000. wpabuf_len(dev_pw));
  2001. }
  2002. return wpas_wps_start_dev_pw(wpa_s, go_dev_addr, bssid,
  2003. dev_pw ? pw : NULL,
  2004. p2p_group, dev_pw_id, peer_pubkey_hash,
  2005. ssid, ssid_len, freq);
  2006. }
  2007. static int wpas_wps_use_cred(struct wpa_supplicant *wpa_s,
  2008. struct wps_parse_attr *attr)
  2009. {
  2010. /*
  2011. * Disable existing networks temporarily to allow the newly learned
  2012. * credential to be preferred. Enable the temporarily disabled networks
  2013. * after 10 seconds.
  2014. */
  2015. wpas_wps_temp_disable(wpa_s, NULL);
  2016. eloop_register_timeout(10, 0, wpas_wps_reenable_networks_cb, wpa_s,
  2017. NULL);
  2018. if (wps_oob_use_cred(wpa_s->wps, attr) < 0)
  2019. return -1;
  2020. if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
  2021. return 0;
  2022. if (attr->ap_channel) {
  2023. u16 chan = WPA_GET_BE16(attr->ap_channel);
  2024. int freq = 0;
  2025. if (chan >= 1 && chan <= 13)
  2026. freq = 2407 + 5 * chan;
  2027. else if (chan == 14)
  2028. freq = 2484;
  2029. else if (chan >= 30)
  2030. freq = 5000 + 5 * chan;
  2031. if (freq) {
  2032. wpa_printf(MSG_DEBUG, "WPS: Credential container indicated AP channel %u -> %u MHz",
  2033. chan, freq);
  2034. wpa_s->after_wps = 5;
  2035. wpa_s->wps_freq = freq;
  2036. }
  2037. }
  2038. wpa_printf(MSG_DEBUG, "WPS: Request reconnection with new network "
  2039. "based on the received credential added");
  2040. wpa_s->normal_scans = 0;
  2041. wpa_supplicant_reinit_autoscan(wpa_s);
  2042. wpa_s->disconnected = 0;
  2043. wpa_s->reassociate = 1;
  2044. wpa_supplicant_cancel_sched_scan(wpa_s);
  2045. wpa_supplicant_req_scan(wpa_s, 0, 0);
  2046. return 0;
  2047. }
  2048. #ifdef CONFIG_WPS_ER
  2049. static int wpas_wps_add_nfc_password_token(struct wpa_supplicant *wpa_s,
  2050. struct wps_parse_attr *attr)
  2051. {
  2052. return wps_registrar_add_nfc_password_token(
  2053. wpa_s->wps->registrar, attr->oob_dev_password,
  2054. attr->oob_dev_password_len);
  2055. }
  2056. #endif /* CONFIG_WPS_ER */
  2057. static int wpas_wps_nfc_tag_process(struct wpa_supplicant *wpa_s,
  2058. const struct wpabuf *wps)
  2059. {
  2060. struct wps_parse_attr attr;
  2061. wpa_hexdump_buf(MSG_DEBUG, "WPS: Received NFC tag payload", wps);
  2062. if (wps_parse_msg(wps, &attr)) {
  2063. wpa_printf(MSG_DEBUG, "WPS: Ignore invalid data from NFC tag");
  2064. return -1;
  2065. }
  2066. if (attr.num_cred)
  2067. return wpas_wps_use_cred(wpa_s, &attr);
  2068. #ifdef CONFIG_WPS_ER
  2069. if (attr.oob_dev_password)
  2070. return wpas_wps_add_nfc_password_token(wpa_s, &attr);
  2071. #endif /* CONFIG_WPS_ER */
  2072. wpa_printf(MSG_DEBUG, "WPS: Ignore unrecognized NFC tag");
  2073. return -1;
  2074. }
  2075. int wpas_wps_nfc_tag_read(struct wpa_supplicant *wpa_s,
  2076. const struct wpabuf *data, int forced_freq)
  2077. {
  2078. const struct wpabuf *wps = data;
  2079. struct wpabuf *tmp = NULL;
  2080. int ret;
  2081. if (wpabuf_len(data) < 4)
  2082. return -1;
  2083. if (*wpabuf_head_u8(data) != 0x10) {
  2084. /* Assume this contains full NDEF record */
  2085. tmp = ndef_parse_wifi(data);
  2086. if (tmp == NULL) {
  2087. #ifdef CONFIG_P2P
  2088. tmp = ndef_parse_p2p(data);
  2089. if (tmp) {
  2090. ret = wpas_p2p_nfc_tag_process(wpa_s, tmp,
  2091. forced_freq);
  2092. wpabuf_free(tmp);
  2093. return ret;
  2094. }
  2095. #endif /* CONFIG_P2P */
  2096. wpa_printf(MSG_DEBUG, "WPS: Could not parse NDEF");
  2097. return -1;
  2098. }
  2099. wps = tmp;
  2100. }
  2101. ret = wpas_wps_nfc_tag_process(wpa_s, wps);
  2102. wpabuf_free(tmp);
  2103. return ret;
  2104. }
  2105. struct wpabuf * wpas_wps_nfc_handover_req(struct wpa_supplicant *wpa_s,
  2106. int ndef)
  2107. {
  2108. struct wpabuf *ret;
  2109. if (wpa_s->conf->wps_nfc_dh_pubkey == NULL &&
  2110. wps_nfc_gen_dh(&wpa_s->conf->wps_nfc_dh_pubkey,
  2111. &wpa_s->conf->wps_nfc_dh_privkey) < 0)
  2112. return NULL;
  2113. ret = wps_build_nfc_handover_req(wpa_s->wps,
  2114. wpa_s->conf->wps_nfc_dh_pubkey);
  2115. if (ndef && ret) {
  2116. struct wpabuf *tmp;
  2117. tmp = ndef_build_wifi(ret);
  2118. wpabuf_free(ret);
  2119. if (tmp == NULL)
  2120. return NULL;
  2121. ret = tmp;
  2122. }
  2123. return ret;
  2124. }
  2125. #ifdef CONFIG_WPS_NFC
  2126. static struct wpabuf *
  2127. wpas_wps_er_nfc_handover_sel(struct wpa_supplicant *wpa_s, int ndef,
  2128. const char *uuid)
  2129. {
  2130. #ifdef CONFIG_WPS_ER
  2131. struct wpabuf *ret;
  2132. u8 u[UUID_LEN], *use_uuid = NULL;
  2133. u8 addr[ETH_ALEN], *use_addr = NULL;
  2134. struct wps_context *wps = wpa_s->wps;
  2135. if (wps == NULL)
  2136. return NULL;
  2137. if (uuid == NULL)
  2138. return NULL;
  2139. if (uuid_str2bin(uuid, u) == 0)
  2140. use_uuid = u;
  2141. else if (hwaddr_aton(uuid, addr) == 0)
  2142. use_addr = addr;
  2143. else
  2144. return NULL;
  2145. if (wpa_s->conf->wps_nfc_dh_pubkey == NULL) {
  2146. if (wps_nfc_gen_dh(&wpa_s->conf->wps_nfc_dh_pubkey,
  2147. &wpa_s->conf->wps_nfc_dh_privkey) < 0)
  2148. return NULL;
  2149. }
  2150. wpas_wps_nfc_clear(wps);
  2151. wps->ap_nfc_dev_pw_id = DEV_PW_NFC_CONNECTION_HANDOVER;
  2152. wps->ap_nfc_dh_pubkey = wpabuf_dup(wpa_s->conf->wps_nfc_dh_pubkey);
  2153. wps->ap_nfc_dh_privkey = wpabuf_dup(wpa_s->conf->wps_nfc_dh_privkey);
  2154. if (!wps->ap_nfc_dh_pubkey || !wps->ap_nfc_dh_privkey) {
  2155. wpas_wps_nfc_clear(wps);
  2156. return NULL;
  2157. }
  2158. ret = wps_er_nfc_handover_sel(wpa_s->wps_er, wpa_s->wps, use_uuid,
  2159. use_addr, wpa_s->conf->wps_nfc_dh_pubkey);
  2160. if (ndef && ret) {
  2161. struct wpabuf *tmp;
  2162. tmp = ndef_build_wifi(ret);
  2163. wpabuf_free(ret);
  2164. if (tmp == NULL)
  2165. return NULL;
  2166. ret = tmp;
  2167. }
  2168. return ret;
  2169. #else /* CONFIG_WPS_ER */
  2170. return NULL;
  2171. #endif /* CONFIG_WPS_ER */
  2172. }
  2173. #endif /* CONFIG_WPS_NFC */
  2174. struct wpabuf * wpas_wps_nfc_handover_sel(struct wpa_supplicant *wpa_s,
  2175. int ndef, int cr, const char *uuid)
  2176. {
  2177. struct wpabuf *ret;
  2178. if (!cr)
  2179. return NULL;
  2180. ret = wpas_ap_wps_nfc_handover_sel(wpa_s, ndef);
  2181. if (ret)
  2182. return ret;
  2183. return wpas_wps_er_nfc_handover_sel(wpa_s, ndef, uuid);
  2184. }
  2185. static int wpas_wps_nfc_rx_handover_sel(struct wpa_supplicant *wpa_s,
  2186. const struct wpabuf *data)
  2187. {
  2188. struct wpabuf *wps;
  2189. int ret = -1;
  2190. u16 wsc_len;
  2191. const u8 *pos;
  2192. struct wpabuf msg;
  2193. struct wps_parse_attr attr;
  2194. u16 dev_pw_id;
  2195. const u8 *bssid = NULL;
  2196. int freq = 0;
  2197. wps = ndef_parse_wifi(data);
  2198. if (wps == NULL)
  2199. return -1;
  2200. wpa_printf(MSG_DEBUG, "WPS: Received application/vnd.wfa.wsc "
  2201. "payload from NFC connection handover");
  2202. wpa_hexdump_buf(MSG_DEBUG, "WPS: NFC payload", wps);
  2203. if (wpabuf_len(wps) < 2) {
  2204. wpa_printf(MSG_DEBUG, "WPS: Too short Wi-Fi Handover Select "
  2205. "Message");
  2206. goto out;
  2207. }
  2208. pos = wpabuf_head(wps);
  2209. wsc_len = WPA_GET_BE16(pos);
  2210. if (wsc_len > wpabuf_len(wps) - 2) {
  2211. wpa_printf(MSG_DEBUG, "WPS: Invalid WSC attribute length (%u) "
  2212. "in Wi-Fi Handover Select Message", wsc_len);
  2213. goto out;
  2214. }
  2215. pos += 2;
  2216. wpa_hexdump(MSG_DEBUG,
  2217. "WPS: WSC attributes in Wi-Fi Handover Select Message",
  2218. pos, wsc_len);
  2219. if (wsc_len < wpabuf_len(wps) - 2) {
  2220. wpa_hexdump(MSG_DEBUG,
  2221. "WPS: Ignore extra data after WSC attributes",
  2222. pos + wsc_len, wpabuf_len(wps) - 2 - wsc_len);
  2223. }
  2224. wpabuf_set(&msg, pos, wsc_len);
  2225. ret = wps_parse_msg(&msg, &attr);
  2226. if (ret < 0) {
  2227. wpa_printf(MSG_DEBUG, "WPS: Could not parse WSC attributes in "
  2228. "Wi-Fi Handover Select Message");
  2229. goto out;
  2230. }
  2231. if (attr.oob_dev_password == NULL ||
  2232. attr.oob_dev_password_len < WPS_OOB_PUBKEY_HASH_LEN + 2) {
  2233. wpa_printf(MSG_DEBUG, "WPS: No Out-of-Band Device Password "
  2234. "included in Wi-Fi Handover Select Message");
  2235. ret = -1;
  2236. goto out;
  2237. }
  2238. if (attr.ssid == NULL) {
  2239. wpa_printf(MSG_DEBUG, "WPS: No SSID included in Wi-Fi Handover "
  2240. "Select Message");
  2241. ret = -1;
  2242. goto out;
  2243. }
  2244. wpa_hexdump_ascii(MSG_DEBUG, "WPS: SSID", attr.ssid, attr.ssid_len);
  2245. if (attr.mac_addr) {
  2246. bssid = attr.mac_addr;
  2247. wpa_printf(MSG_DEBUG, "WPS: MAC Address (BSSID): " MACSTR,
  2248. MAC2STR(bssid));
  2249. }
  2250. if (attr.rf_bands)
  2251. wpa_printf(MSG_DEBUG, "WPS: RF Bands: %d", *attr.rf_bands);
  2252. if (attr.ap_channel) {
  2253. u16 chan = WPA_GET_BE16(attr.ap_channel);
  2254. wpa_printf(MSG_DEBUG, "WPS: AP Channel: %d", chan);
  2255. if (chan >= 1 && chan <= 13 &&
  2256. (attr.rf_bands == NULL || *attr.rf_bands & WPS_RF_24GHZ))
  2257. freq = 2407 + 5 * chan;
  2258. else if (chan == 14 &&
  2259. (attr.rf_bands == NULL ||
  2260. *attr.rf_bands & WPS_RF_24GHZ))
  2261. freq = 2484;
  2262. else if (chan >= 30 &&
  2263. (attr.rf_bands == NULL ||
  2264. *attr.rf_bands & WPS_RF_50GHZ))
  2265. freq = 5000 + 5 * chan;
  2266. else if (chan >= 1 && chan <= 4 &&
  2267. (attr.rf_bands == NULL ||
  2268. *attr.rf_bands & WPS_RF_60GHZ))
  2269. freq = 56160 + 2160 * chan;
  2270. if (freq) {
  2271. wpa_printf(MSG_DEBUG,
  2272. "WPS: AP indicated channel %u -> %u MHz",
  2273. chan, freq);
  2274. }
  2275. }
  2276. wpa_hexdump(MSG_DEBUG, "WPS: Out-of-Band Device Password",
  2277. attr.oob_dev_password, attr.oob_dev_password_len);
  2278. dev_pw_id = WPA_GET_BE16(attr.oob_dev_password +
  2279. WPS_OOB_PUBKEY_HASH_LEN);
  2280. if (dev_pw_id != DEV_PW_NFC_CONNECTION_HANDOVER) {
  2281. wpa_printf(MSG_DEBUG, "WPS: Unexpected OOB Device Password ID "
  2282. "%u in Wi-Fi Handover Select Message", dev_pw_id);
  2283. ret = -1;
  2284. goto out;
  2285. }
  2286. wpa_hexdump(MSG_DEBUG, "WPS: AP Public Key hash",
  2287. attr.oob_dev_password, WPS_OOB_PUBKEY_HASH_LEN);
  2288. ret = wpas_wps_start_nfc(wpa_s, NULL, bssid, NULL, dev_pw_id, 0,
  2289. attr.oob_dev_password,
  2290. attr.ssid, attr.ssid_len, freq);
  2291. out:
  2292. wpabuf_free(wps);
  2293. return ret;
  2294. }
  2295. int wpas_wps_nfc_report_handover(struct wpa_supplicant *wpa_s,
  2296. const struct wpabuf *req,
  2297. const struct wpabuf *sel)
  2298. {
  2299. wpa_printf(MSG_DEBUG, "NFC: WPS connection handover reported");
  2300. wpa_hexdump_buf_key(MSG_DEBUG, "WPS: Carrier record in request", req);
  2301. wpa_hexdump_buf_key(MSG_DEBUG, "WPS: Carrier record in select", sel);
  2302. return wpas_wps_nfc_rx_handover_sel(wpa_s, sel);
  2303. }
  2304. int wpas_er_wps_nfc_report_handover(struct wpa_supplicant *wpa_s,
  2305. const struct wpabuf *req,
  2306. const struct wpabuf *sel)
  2307. {
  2308. struct wpabuf *wps;
  2309. int ret = -1;
  2310. u16 wsc_len;
  2311. const u8 *pos;
  2312. struct wpabuf msg;
  2313. struct wps_parse_attr attr;
  2314. u16 dev_pw_id;
  2315. /*
  2316. * Enrollee/station is always initiator of the NFC connection handover,
  2317. * so use the request message here to find Enrollee public key hash.
  2318. */
  2319. wps = ndef_parse_wifi(req);
  2320. if (wps == NULL)
  2321. return -1;
  2322. wpa_printf(MSG_DEBUG, "WPS: Received application/vnd.wfa.wsc "
  2323. "payload from NFC connection handover");
  2324. wpa_hexdump_buf(MSG_DEBUG, "WPS: NFC payload", wps);
  2325. if (wpabuf_len(wps) < 2) {
  2326. wpa_printf(MSG_DEBUG, "WPS: Too short Wi-Fi Handover Request "
  2327. "Message");
  2328. goto out;
  2329. }
  2330. pos = wpabuf_head(wps);
  2331. wsc_len = WPA_GET_BE16(pos);
  2332. if (wsc_len > wpabuf_len(wps) - 2) {
  2333. wpa_printf(MSG_DEBUG, "WPS: Invalid WSC attribute length (%u) "
  2334. "in rt Wi-Fi Handover Request Message", wsc_len);
  2335. goto out;
  2336. }
  2337. pos += 2;
  2338. wpa_hexdump(MSG_DEBUG,
  2339. "WPS: WSC attributes in Wi-Fi Handover Request Message",
  2340. pos, wsc_len);
  2341. if (wsc_len < wpabuf_len(wps) - 2) {
  2342. wpa_hexdump(MSG_DEBUG,
  2343. "WPS: Ignore extra data after WSC attributes",
  2344. pos + wsc_len, wpabuf_len(wps) - 2 - wsc_len);
  2345. }
  2346. wpabuf_set(&msg, pos, wsc_len);
  2347. ret = wps_parse_msg(&msg, &attr);
  2348. if (ret < 0) {
  2349. wpa_printf(MSG_DEBUG, "WPS: Could not parse WSC attributes in "
  2350. "Wi-Fi Handover Request Message");
  2351. goto out;
  2352. }
  2353. if (attr.oob_dev_password == NULL ||
  2354. attr.oob_dev_password_len < WPS_OOB_PUBKEY_HASH_LEN + 2) {
  2355. wpa_printf(MSG_DEBUG, "WPS: No Out-of-Band Device Password "
  2356. "included in Wi-Fi Handover Request Message");
  2357. ret = -1;
  2358. goto out;
  2359. }
  2360. if (attr.uuid_e == NULL) {
  2361. wpa_printf(MSG_DEBUG, "WPS: No UUID-E included in Wi-Fi "
  2362. "Handover Request Message");
  2363. ret = -1;
  2364. goto out;
  2365. }
  2366. wpa_hexdump(MSG_DEBUG, "WPS: UUID-E", attr.uuid_e, WPS_UUID_LEN);
  2367. wpa_hexdump(MSG_DEBUG, "WPS: Out-of-Band Device Password",
  2368. attr.oob_dev_password, attr.oob_dev_password_len);
  2369. dev_pw_id = WPA_GET_BE16(attr.oob_dev_password +
  2370. WPS_OOB_PUBKEY_HASH_LEN);
  2371. if (dev_pw_id != DEV_PW_NFC_CONNECTION_HANDOVER) {
  2372. wpa_printf(MSG_DEBUG, "WPS: Unexpected OOB Device Password ID "
  2373. "%u in Wi-Fi Handover Request Message", dev_pw_id);
  2374. ret = -1;
  2375. goto out;
  2376. }
  2377. wpa_hexdump(MSG_DEBUG, "WPS: Enrollee Public Key hash",
  2378. attr.oob_dev_password, WPS_OOB_PUBKEY_HASH_LEN);
  2379. ret = wps_registrar_add_nfc_pw_token(wpa_s->wps->registrar,
  2380. attr.oob_dev_password,
  2381. DEV_PW_NFC_CONNECTION_HANDOVER,
  2382. NULL, 0, 1);
  2383. out:
  2384. wpabuf_free(wps);
  2385. return ret;
  2386. }
  2387. #endif /* CONFIG_WPS_NFC */
  2388. static void wpas_wps_dump_ap_info(struct wpa_supplicant *wpa_s)
  2389. {
  2390. size_t i;
  2391. struct os_reltime now;
  2392. if (wpa_debug_level > MSG_DEBUG)
  2393. return;
  2394. if (wpa_s->wps_ap == NULL)
  2395. return;
  2396. os_get_reltime(&now);
  2397. for (i = 0; i < wpa_s->num_wps_ap; i++) {
  2398. struct wps_ap_info *ap = &wpa_s->wps_ap[i];
  2399. struct wpa_blacklist *e = wpa_blacklist_get(wpa_s, ap->bssid);
  2400. wpa_printf(MSG_DEBUG, "WPS: AP[%d] " MACSTR " type=%d "
  2401. "tries=%d last_attempt=%d sec ago blacklist=%d",
  2402. (int) i, MAC2STR(ap->bssid), ap->type, ap->tries,
  2403. ap->last_attempt.sec > 0 ?
  2404. (int) now.sec - (int) ap->last_attempt.sec : -1,
  2405. e ? e->count : 0);
  2406. }
  2407. }
  2408. static struct wps_ap_info * wpas_wps_get_ap_info(struct wpa_supplicant *wpa_s,
  2409. const u8 *bssid)
  2410. {
  2411. size_t i;
  2412. if (wpa_s->wps_ap == NULL)
  2413. return NULL;
  2414. for (i = 0; i < wpa_s->num_wps_ap; i++) {
  2415. struct wps_ap_info *ap = &wpa_s->wps_ap[i];
  2416. if (os_memcmp(ap->bssid, bssid, ETH_ALEN) == 0)
  2417. return ap;
  2418. }
  2419. return NULL;
  2420. }
  2421. static void wpas_wps_update_ap_info_bss(struct wpa_supplicant *wpa_s,
  2422. struct wpa_scan_res *res)
  2423. {
  2424. struct wpabuf *wps;
  2425. enum wps_ap_info_type type;
  2426. struct wps_ap_info *ap;
  2427. int r, pbc_active;
  2428. const u8 *uuid;
  2429. if (wpa_scan_get_vendor_ie(res, WPS_IE_VENDOR_TYPE) == NULL)
  2430. return;
  2431. wps = wpa_scan_get_vendor_ie_multi(res, WPS_IE_VENDOR_TYPE);
  2432. if (wps == NULL)
  2433. return;
  2434. r = wps_is_addr_authorized(wps, wpa_s->own_addr, 1);
  2435. if (r == 2)
  2436. type = WPS_AP_SEL_REG_OUR;
  2437. else if (r == 1)
  2438. type = WPS_AP_SEL_REG;
  2439. else
  2440. type = WPS_AP_NOT_SEL_REG;
  2441. uuid = wps_get_uuid_e(wps);
  2442. pbc_active = wps_is_selected_pbc_registrar(wps);
  2443. ap = wpas_wps_get_ap_info(wpa_s, res->bssid);
  2444. if (ap) {
  2445. if (ap->type != type) {
  2446. wpa_printf(MSG_DEBUG, "WPS: AP " MACSTR
  2447. " changed type %d -> %d",
  2448. MAC2STR(res->bssid), ap->type, type);
  2449. ap->type = type;
  2450. if (type != WPS_AP_NOT_SEL_REG)
  2451. wpa_blacklist_del(wpa_s, ap->bssid);
  2452. }
  2453. ap->pbc_active = pbc_active;
  2454. if (uuid)
  2455. os_memcpy(ap->uuid, uuid, WPS_UUID_LEN);
  2456. goto out;
  2457. }
  2458. ap = os_realloc_array(wpa_s->wps_ap, wpa_s->num_wps_ap + 1,
  2459. sizeof(struct wps_ap_info));
  2460. if (ap == NULL)
  2461. goto out;
  2462. wpa_s->wps_ap = ap;
  2463. ap = &wpa_s->wps_ap[wpa_s->num_wps_ap];
  2464. wpa_s->num_wps_ap++;
  2465. os_memset(ap, 0, sizeof(*ap));
  2466. os_memcpy(ap->bssid, res->bssid, ETH_ALEN);
  2467. ap->type = type;
  2468. ap->pbc_active = pbc_active;
  2469. if (uuid)
  2470. os_memcpy(ap->uuid, uuid, WPS_UUID_LEN);
  2471. wpa_printf(MSG_DEBUG, "WPS: AP " MACSTR " type %d added",
  2472. MAC2STR(ap->bssid), ap->type);
  2473. out:
  2474. wpabuf_free(wps);
  2475. }
  2476. void wpas_wps_update_ap_info(struct wpa_supplicant *wpa_s,
  2477. struct wpa_scan_results *scan_res)
  2478. {
  2479. size_t i;
  2480. for (i = 0; i < scan_res->num; i++)
  2481. wpas_wps_update_ap_info_bss(wpa_s, scan_res->res[i]);
  2482. wpas_wps_dump_ap_info(wpa_s);
  2483. }
  2484. void wpas_wps_notify_assoc(struct wpa_supplicant *wpa_s, const u8 *bssid)
  2485. {
  2486. struct wps_ap_info *ap;
  2487. wpa_s->after_wps = 0;
  2488. if (!wpa_s->wps_ap_iter)
  2489. return;
  2490. ap = wpas_wps_get_ap_info(wpa_s, bssid);
  2491. if (ap == NULL)
  2492. return;
  2493. ap->tries++;
  2494. os_get_reltime(&ap->last_attempt);
  2495. }