driver_wext.c 58 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231
  1. /*
  2. * WPA Supplicant - driver interaction with generic Linux Wireless Extensions
  3. * Copyright (c) 2003-2007, Jouni Malinen <j@w1.fi>
  4. *
  5. * This program is free software; you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License version 2 as
  7. * published by the Free Software Foundation.
  8. *
  9. * Alternatively, this software may be distributed under the terms of BSD
  10. * license.
  11. *
  12. * See README and COPYING for more details.
  13. *
  14. * This file implements a driver interface for the Linux Wireless Extensions.
  15. * When used with WE-18 or newer, this interface can be used as-is with number
  16. * of drivers. In addition to this, some of the common functions in this file
  17. * can be used by other driver interface implementations that use generic WE
  18. * ioctls, but require private ioctls for some of the functionality.
  19. */
  20. #include "includes.h"
  21. #include <sys/ioctl.h>
  22. #include <net/if_arp.h>
  23. #include "wireless_copy.h"
  24. #include "common.h"
  25. #include "eloop.h"
  26. #include "common/ieee802_11_defs.h"
  27. #include "common/wpa_common.h"
  28. #include "priv_netlink.h"
  29. #include "netlink.h"
  30. #include "driver.h"
  31. #include "driver_wext.h"
  32. static int wpa_driver_wext_flush_pmkid(void *priv);
  33. static int wpa_driver_wext_get_range(void *priv);
  34. static int wpa_driver_wext_finish_drv_init(struct wpa_driver_wext_data *drv);
  35. static void wpa_driver_wext_disconnect(struct wpa_driver_wext_data *drv);
  36. static int wpa_driver_wext_set_auth_alg(void *priv, int auth_alg);
  37. int wpa_driver_wext_set_auth_param(struct wpa_driver_wext_data *drv,
  38. int idx, u32 value)
  39. {
  40. struct iwreq iwr;
  41. int ret = 0;
  42. os_memset(&iwr, 0, sizeof(iwr));
  43. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  44. iwr.u.param.flags = idx & IW_AUTH_INDEX;
  45. iwr.u.param.value = value;
  46. if (ioctl(drv->ioctl_sock, SIOCSIWAUTH, &iwr) < 0) {
  47. if (errno != EOPNOTSUPP) {
  48. wpa_printf(MSG_DEBUG, "WEXT: SIOCSIWAUTH(param %d "
  49. "value 0x%x) failed: %s)",
  50. idx, value, strerror(errno));
  51. }
  52. ret = errno == EOPNOTSUPP ? -2 : -1;
  53. }
  54. return ret;
  55. }
  56. /**
  57. * wpa_driver_wext_get_bssid - Get BSSID, SIOCGIWAP
  58. * @priv: Pointer to private wext data from wpa_driver_wext_init()
  59. * @bssid: Buffer for BSSID
  60. * Returns: 0 on success, -1 on failure
  61. */
  62. int wpa_driver_wext_get_bssid(void *priv, u8 *bssid)
  63. {
  64. struct wpa_driver_wext_data *drv = priv;
  65. struct iwreq iwr;
  66. int ret = 0;
  67. os_memset(&iwr, 0, sizeof(iwr));
  68. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  69. if (ioctl(drv->ioctl_sock, SIOCGIWAP, &iwr) < 0) {
  70. perror("ioctl[SIOCGIWAP]");
  71. ret = -1;
  72. }
  73. os_memcpy(bssid, iwr.u.ap_addr.sa_data, ETH_ALEN);
  74. return ret;
  75. }
  76. /**
  77. * wpa_driver_wext_set_bssid - Set BSSID, SIOCSIWAP
  78. * @priv: Pointer to private wext data from wpa_driver_wext_init()
  79. * @bssid: BSSID
  80. * Returns: 0 on success, -1 on failure
  81. */
  82. int wpa_driver_wext_set_bssid(void *priv, const u8 *bssid)
  83. {
  84. struct wpa_driver_wext_data *drv = priv;
  85. struct iwreq iwr;
  86. int ret = 0;
  87. os_memset(&iwr, 0, sizeof(iwr));
  88. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  89. iwr.u.ap_addr.sa_family = ARPHRD_ETHER;
  90. if (bssid)
  91. os_memcpy(iwr.u.ap_addr.sa_data, bssid, ETH_ALEN);
  92. else
  93. os_memset(iwr.u.ap_addr.sa_data, 0, ETH_ALEN);
  94. if (ioctl(drv->ioctl_sock, SIOCSIWAP, &iwr) < 0) {
  95. perror("ioctl[SIOCSIWAP]");
  96. ret = -1;
  97. }
  98. return ret;
  99. }
  100. /**
  101. * wpa_driver_wext_get_ssid - Get SSID, SIOCGIWESSID
  102. * @priv: Pointer to private wext data from wpa_driver_wext_init()
  103. * @ssid: Buffer for the SSID; must be at least 32 bytes long
  104. * Returns: SSID length on success, -1 on failure
  105. */
  106. int wpa_driver_wext_get_ssid(void *priv, u8 *ssid)
  107. {
  108. struct wpa_driver_wext_data *drv = priv;
  109. struct iwreq iwr;
  110. int ret = 0;
  111. os_memset(&iwr, 0, sizeof(iwr));
  112. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  113. iwr.u.essid.pointer = (caddr_t) ssid;
  114. iwr.u.essid.length = 32;
  115. if (ioctl(drv->ioctl_sock, SIOCGIWESSID, &iwr) < 0) {
  116. perror("ioctl[SIOCGIWESSID]");
  117. ret = -1;
  118. } else {
  119. ret = iwr.u.essid.length;
  120. if (ret > 32)
  121. ret = 32;
  122. /* Some drivers include nul termination in the SSID, so let's
  123. * remove it here before further processing. WE-21 changes this
  124. * to explicitly require the length _not_ to include nul
  125. * termination. */
  126. if (ret > 0 && ssid[ret - 1] == '\0' &&
  127. drv->we_version_compiled < 21)
  128. ret--;
  129. }
  130. return ret;
  131. }
  132. /**
  133. * wpa_driver_wext_set_ssid - Set SSID, SIOCSIWESSID
  134. * @priv: Pointer to private wext data from wpa_driver_wext_init()
  135. * @ssid: SSID
  136. * @ssid_len: Length of SSID (0..32)
  137. * Returns: 0 on success, -1 on failure
  138. */
  139. int wpa_driver_wext_set_ssid(void *priv, const u8 *ssid, size_t ssid_len)
  140. {
  141. struct wpa_driver_wext_data *drv = priv;
  142. struct iwreq iwr;
  143. int ret = 0;
  144. char buf[33];
  145. if (ssid_len > 32)
  146. return -1;
  147. os_memset(&iwr, 0, sizeof(iwr));
  148. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  149. /* flags: 1 = ESSID is active, 0 = not (promiscuous) */
  150. iwr.u.essid.flags = (ssid_len != 0);
  151. os_memset(buf, 0, sizeof(buf));
  152. os_memcpy(buf, ssid, ssid_len);
  153. iwr.u.essid.pointer = (caddr_t) buf;
  154. if (drv->we_version_compiled < 21) {
  155. /* For historic reasons, set SSID length to include one extra
  156. * character, C string nul termination, even though SSID is
  157. * really an octet string that should not be presented as a C
  158. * string. Some Linux drivers decrement the length by one and
  159. * can thus end up missing the last octet of the SSID if the
  160. * length is not incremented here. WE-21 changes this to
  161. * explicitly require the length _not_ to include nul
  162. * termination. */
  163. if (ssid_len)
  164. ssid_len++;
  165. }
  166. iwr.u.essid.length = ssid_len;
  167. if (ioctl(drv->ioctl_sock, SIOCSIWESSID, &iwr) < 0) {
  168. perror("ioctl[SIOCSIWESSID]");
  169. ret = -1;
  170. }
  171. return ret;
  172. }
  173. /**
  174. * wpa_driver_wext_set_freq - Set frequency/channel, SIOCSIWFREQ
  175. * @priv: Pointer to private wext data from wpa_driver_wext_init()
  176. * @freq: Frequency in MHz
  177. * Returns: 0 on success, -1 on failure
  178. */
  179. int wpa_driver_wext_set_freq(void *priv, int freq)
  180. {
  181. struct wpa_driver_wext_data *drv = priv;
  182. struct iwreq iwr;
  183. int ret = 0;
  184. os_memset(&iwr, 0, sizeof(iwr));
  185. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  186. iwr.u.freq.m = freq * 100000;
  187. iwr.u.freq.e = 1;
  188. if (ioctl(drv->ioctl_sock, SIOCSIWFREQ, &iwr) < 0) {
  189. perror("ioctl[SIOCSIWFREQ]");
  190. ret = -1;
  191. }
  192. return ret;
  193. }
  194. static void
  195. wpa_driver_wext_event_wireless_custom(void *ctx, char *custom)
  196. {
  197. union wpa_event_data data;
  198. wpa_printf(MSG_MSGDUMP, "WEXT: Custom wireless event: '%s'",
  199. custom);
  200. os_memset(&data, 0, sizeof(data));
  201. /* Host AP driver */
  202. if (os_strncmp(custom, "MLME-MICHAELMICFAILURE.indication", 33) == 0) {
  203. data.michael_mic_failure.unicast =
  204. os_strstr(custom, " unicast ") != NULL;
  205. /* TODO: parse parameters(?) */
  206. wpa_supplicant_event(ctx, EVENT_MICHAEL_MIC_FAILURE, &data);
  207. } else if (os_strncmp(custom, "ASSOCINFO(ReqIEs=", 17) == 0) {
  208. char *spos;
  209. int bytes;
  210. spos = custom + 17;
  211. bytes = strspn(spos, "0123456789abcdefABCDEF");
  212. if (!bytes || (bytes & 1))
  213. return;
  214. bytes /= 2;
  215. data.assoc_info.req_ies = os_malloc(bytes);
  216. if (data.assoc_info.req_ies == NULL)
  217. return;
  218. data.assoc_info.req_ies_len = bytes;
  219. hexstr2bin(spos, data.assoc_info.req_ies, bytes);
  220. spos += bytes * 2;
  221. data.assoc_info.resp_ies = NULL;
  222. data.assoc_info.resp_ies_len = 0;
  223. if (os_strncmp(spos, " RespIEs=", 9) == 0) {
  224. spos += 9;
  225. bytes = strspn(spos, "0123456789abcdefABCDEF");
  226. if (!bytes || (bytes & 1))
  227. goto done;
  228. bytes /= 2;
  229. data.assoc_info.resp_ies = os_malloc(bytes);
  230. if (data.assoc_info.resp_ies == NULL)
  231. goto done;
  232. data.assoc_info.resp_ies_len = bytes;
  233. hexstr2bin(spos, data.assoc_info.resp_ies, bytes);
  234. }
  235. wpa_supplicant_event(ctx, EVENT_ASSOCINFO, &data);
  236. done:
  237. os_free(data.assoc_info.resp_ies);
  238. os_free(data.assoc_info.req_ies);
  239. #ifdef CONFIG_PEERKEY
  240. } else if (os_strncmp(custom, "STKSTART.request=", 17) == 0) {
  241. if (hwaddr_aton(custom + 17, data.stkstart.peer)) {
  242. wpa_printf(MSG_DEBUG, "WEXT: unrecognized "
  243. "STKSTART.request '%s'", custom + 17);
  244. return;
  245. }
  246. wpa_supplicant_event(ctx, EVENT_STKSTART, &data);
  247. #endif /* CONFIG_PEERKEY */
  248. }
  249. }
  250. static int wpa_driver_wext_event_wireless_michaelmicfailure(
  251. void *ctx, const char *ev, size_t len)
  252. {
  253. const struct iw_michaelmicfailure *mic;
  254. union wpa_event_data data;
  255. if (len < sizeof(*mic))
  256. return -1;
  257. mic = (const struct iw_michaelmicfailure *) ev;
  258. wpa_printf(MSG_DEBUG, "Michael MIC failure wireless event: "
  259. "flags=0x%x src_addr=" MACSTR, mic->flags,
  260. MAC2STR(mic->src_addr.sa_data));
  261. os_memset(&data, 0, sizeof(data));
  262. data.michael_mic_failure.unicast = !(mic->flags & IW_MICFAILURE_GROUP);
  263. wpa_supplicant_event(ctx, EVENT_MICHAEL_MIC_FAILURE, &data);
  264. return 0;
  265. }
  266. static int wpa_driver_wext_event_wireless_pmkidcand(
  267. struct wpa_driver_wext_data *drv, const char *ev, size_t len)
  268. {
  269. const struct iw_pmkid_cand *cand;
  270. union wpa_event_data data;
  271. const u8 *addr;
  272. if (len < sizeof(*cand))
  273. return -1;
  274. cand = (const struct iw_pmkid_cand *) ev;
  275. addr = (const u8 *) cand->bssid.sa_data;
  276. wpa_printf(MSG_DEBUG, "PMKID candidate wireless event: "
  277. "flags=0x%x index=%d bssid=" MACSTR, cand->flags,
  278. cand->index, MAC2STR(addr));
  279. os_memset(&data, 0, sizeof(data));
  280. os_memcpy(data.pmkid_candidate.bssid, addr, ETH_ALEN);
  281. data.pmkid_candidate.index = cand->index;
  282. data.pmkid_candidate.preauth = cand->flags & IW_PMKID_CAND_PREAUTH;
  283. wpa_supplicant_event(drv->ctx, EVENT_PMKID_CANDIDATE, &data);
  284. return 0;
  285. }
  286. static int wpa_driver_wext_event_wireless_assocreqie(
  287. struct wpa_driver_wext_data *drv, const char *ev, int len)
  288. {
  289. if (len < 0)
  290. return -1;
  291. wpa_hexdump(MSG_DEBUG, "AssocReq IE wireless event", (const u8 *) ev,
  292. len);
  293. os_free(drv->assoc_req_ies);
  294. drv->assoc_req_ies = os_malloc(len);
  295. if (drv->assoc_req_ies == NULL) {
  296. drv->assoc_req_ies_len = 0;
  297. return -1;
  298. }
  299. os_memcpy(drv->assoc_req_ies, ev, len);
  300. drv->assoc_req_ies_len = len;
  301. return 0;
  302. }
  303. static int wpa_driver_wext_event_wireless_assocrespie(
  304. struct wpa_driver_wext_data *drv, const char *ev, int len)
  305. {
  306. if (len < 0)
  307. return -1;
  308. wpa_hexdump(MSG_DEBUG, "AssocResp IE wireless event", (const u8 *) ev,
  309. len);
  310. os_free(drv->assoc_resp_ies);
  311. drv->assoc_resp_ies = os_malloc(len);
  312. if (drv->assoc_resp_ies == NULL) {
  313. drv->assoc_resp_ies_len = 0;
  314. return -1;
  315. }
  316. os_memcpy(drv->assoc_resp_ies, ev, len);
  317. drv->assoc_resp_ies_len = len;
  318. return 0;
  319. }
  320. static void wpa_driver_wext_event_assoc_ies(struct wpa_driver_wext_data *drv)
  321. {
  322. union wpa_event_data data;
  323. if (drv->assoc_req_ies == NULL && drv->assoc_resp_ies == NULL)
  324. return;
  325. os_memset(&data, 0, sizeof(data));
  326. if (drv->assoc_req_ies) {
  327. data.assoc_info.req_ies = drv->assoc_req_ies;
  328. drv->assoc_req_ies = NULL;
  329. data.assoc_info.req_ies_len = drv->assoc_req_ies_len;
  330. }
  331. if (drv->assoc_resp_ies) {
  332. data.assoc_info.resp_ies = drv->assoc_resp_ies;
  333. drv->assoc_resp_ies = NULL;
  334. data.assoc_info.resp_ies_len = drv->assoc_resp_ies_len;
  335. }
  336. wpa_supplicant_event(drv->ctx, EVENT_ASSOCINFO, &data);
  337. os_free(data.assoc_info.req_ies);
  338. os_free(data.assoc_info.resp_ies);
  339. }
  340. static void wpa_driver_wext_event_wireless(struct wpa_driver_wext_data *drv,
  341. char *data, int len)
  342. {
  343. struct iw_event iwe_buf, *iwe = &iwe_buf;
  344. char *pos, *end, *custom, *buf;
  345. pos = data;
  346. end = data + len;
  347. while (pos + IW_EV_LCP_LEN <= end) {
  348. /* Event data may be unaligned, so make a local, aligned copy
  349. * before processing. */
  350. os_memcpy(&iwe_buf, pos, IW_EV_LCP_LEN);
  351. wpa_printf(MSG_DEBUG, "Wireless event: cmd=0x%x len=%d",
  352. iwe->cmd, iwe->len);
  353. if (iwe->len <= IW_EV_LCP_LEN)
  354. return;
  355. custom = pos + IW_EV_POINT_LEN;
  356. if (drv->we_version_compiled > 18 &&
  357. (iwe->cmd == IWEVMICHAELMICFAILURE ||
  358. iwe->cmd == IWEVCUSTOM ||
  359. iwe->cmd == IWEVASSOCREQIE ||
  360. iwe->cmd == IWEVASSOCRESPIE ||
  361. iwe->cmd == IWEVPMKIDCAND)) {
  362. /* WE-19 removed the pointer from struct iw_point */
  363. char *dpos = (char *) &iwe_buf.u.data.length;
  364. int dlen = dpos - (char *) &iwe_buf;
  365. os_memcpy(dpos, pos + IW_EV_LCP_LEN,
  366. sizeof(struct iw_event) - dlen);
  367. } else {
  368. os_memcpy(&iwe_buf, pos, sizeof(struct iw_event));
  369. custom += IW_EV_POINT_OFF;
  370. }
  371. switch (iwe->cmd) {
  372. case SIOCGIWAP:
  373. wpa_printf(MSG_DEBUG, "Wireless event: new AP: "
  374. MACSTR,
  375. MAC2STR((u8 *) iwe->u.ap_addr.sa_data));
  376. if (is_zero_ether_addr(
  377. (const u8 *) iwe->u.ap_addr.sa_data) ||
  378. os_memcmp(iwe->u.ap_addr.sa_data,
  379. "\x44\x44\x44\x44\x44\x44", ETH_ALEN) ==
  380. 0) {
  381. os_free(drv->assoc_req_ies);
  382. drv->assoc_req_ies = NULL;
  383. os_free(drv->assoc_resp_ies);
  384. drv->assoc_resp_ies = NULL;
  385. wpa_supplicant_event(drv->ctx, EVENT_DISASSOC,
  386. NULL);
  387. } else {
  388. wpa_driver_wext_event_assoc_ies(drv);
  389. wpa_supplicant_event(drv->ctx, EVENT_ASSOC,
  390. NULL);
  391. }
  392. break;
  393. case IWEVMICHAELMICFAILURE:
  394. if (custom + iwe->u.data.length > end) {
  395. wpa_printf(MSG_DEBUG, "WEXT: Invalid "
  396. "IWEVMICHAELMICFAILURE length");
  397. return;
  398. }
  399. wpa_driver_wext_event_wireless_michaelmicfailure(
  400. drv->ctx, custom, iwe->u.data.length);
  401. break;
  402. case IWEVCUSTOM:
  403. if (custom + iwe->u.data.length > end) {
  404. wpa_printf(MSG_DEBUG, "WEXT: Invalid "
  405. "IWEVCUSTOM length");
  406. return;
  407. }
  408. buf = os_malloc(iwe->u.data.length + 1);
  409. if (buf == NULL)
  410. return;
  411. os_memcpy(buf, custom, iwe->u.data.length);
  412. buf[iwe->u.data.length] = '\0';
  413. wpa_driver_wext_event_wireless_custom(drv->ctx, buf);
  414. os_free(buf);
  415. break;
  416. case SIOCGIWSCAN:
  417. drv->scan_complete_events = 1;
  418. eloop_cancel_timeout(wpa_driver_wext_scan_timeout,
  419. drv, drv->ctx);
  420. wpa_supplicant_event(drv->ctx, EVENT_SCAN_RESULTS,
  421. NULL);
  422. break;
  423. case IWEVASSOCREQIE:
  424. if (custom + iwe->u.data.length > end) {
  425. wpa_printf(MSG_DEBUG, "WEXT: Invalid "
  426. "IWEVASSOCREQIE length");
  427. return;
  428. }
  429. wpa_driver_wext_event_wireless_assocreqie(
  430. drv, custom, iwe->u.data.length);
  431. break;
  432. case IWEVASSOCRESPIE:
  433. if (custom + iwe->u.data.length > end) {
  434. wpa_printf(MSG_DEBUG, "WEXT: Invalid "
  435. "IWEVASSOCRESPIE length");
  436. return;
  437. }
  438. wpa_driver_wext_event_wireless_assocrespie(
  439. drv, custom, iwe->u.data.length);
  440. break;
  441. case IWEVPMKIDCAND:
  442. if (custom + iwe->u.data.length > end) {
  443. wpa_printf(MSG_DEBUG, "WEXT: Invalid "
  444. "IWEVPMKIDCAND length");
  445. return;
  446. }
  447. wpa_driver_wext_event_wireless_pmkidcand(
  448. drv, custom, iwe->u.data.length);
  449. break;
  450. }
  451. pos += iwe->len;
  452. }
  453. }
  454. static void wpa_driver_wext_event_link(struct wpa_driver_wext_data *drv,
  455. char *buf, size_t len, int del)
  456. {
  457. union wpa_event_data event;
  458. os_memset(&event, 0, sizeof(event));
  459. if (len > sizeof(event.interface_status.ifname))
  460. len = sizeof(event.interface_status.ifname) - 1;
  461. os_memcpy(event.interface_status.ifname, buf, len);
  462. event.interface_status.ievent = del ? EVENT_INTERFACE_REMOVED :
  463. EVENT_INTERFACE_ADDED;
  464. wpa_printf(MSG_DEBUG, "RTM_%sLINK, IFLA_IFNAME: Interface '%s' %s",
  465. del ? "DEL" : "NEW",
  466. event.interface_status.ifname,
  467. del ? "removed" : "added");
  468. if (os_strcmp(drv->ifname, event.interface_status.ifname) == 0) {
  469. if (del)
  470. drv->if_removed = 1;
  471. else
  472. drv->if_removed = 0;
  473. }
  474. wpa_supplicant_event(drv->ctx, EVENT_INTERFACE_STATUS, &event);
  475. }
  476. static int wpa_driver_wext_own_ifname(struct wpa_driver_wext_data *drv,
  477. u8 *buf, size_t len)
  478. {
  479. int attrlen, rta_len;
  480. struct rtattr *attr;
  481. attrlen = len;
  482. attr = (struct rtattr *) buf;
  483. rta_len = RTA_ALIGN(sizeof(struct rtattr));
  484. while (RTA_OK(attr, attrlen)) {
  485. if (attr->rta_type == IFLA_IFNAME) {
  486. if (os_strcmp(((char *) attr) + rta_len, drv->ifname)
  487. == 0)
  488. return 1;
  489. else
  490. break;
  491. }
  492. attr = RTA_NEXT(attr, attrlen);
  493. }
  494. return 0;
  495. }
  496. static int wpa_driver_wext_own_ifindex(struct wpa_driver_wext_data *drv,
  497. int ifindex, u8 *buf, size_t len)
  498. {
  499. if (drv->ifindex == ifindex || drv->ifindex2 == ifindex)
  500. return 1;
  501. if (drv->if_removed && wpa_driver_wext_own_ifname(drv, buf, len)) {
  502. drv->ifindex = if_nametoindex(drv->ifname);
  503. wpa_printf(MSG_DEBUG, "WEXT: Update ifindex for a removed "
  504. "interface");
  505. wpa_driver_wext_finish_drv_init(drv);
  506. return 1;
  507. }
  508. return 0;
  509. }
  510. static void wpa_driver_wext_event_rtm_newlink(void *ctx, struct ifinfomsg *ifi,
  511. u8 *buf, size_t len)
  512. {
  513. struct wpa_driver_wext_data *drv = ctx;
  514. int attrlen, rta_len;
  515. struct rtattr *attr;
  516. if (!wpa_driver_wext_own_ifindex(drv, ifi->ifi_index, buf, len)) {
  517. wpa_printf(MSG_DEBUG, "Ignore event for foreign ifindex %d",
  518. ifi->ifi_index);
  519. return;
  520. }
  521. wpa_printf(MSG_DEBUG, "RTM_NEWLINK: operstate=%d ifi_flags=0x%x "
  522. "(%s%s%s%s)",
  523. drv->operstate, ifi->ifi_flags,
  524. (ifi->ifi_flags & IFF_UP) ? "[UP]" : "",
  525. (ifi->ifi_flags & IFF_RUNNING) ? "[RUNNING]" : "",
  526. (ifi->ifi_flags & IFF_LOWER_UP) ? "[LOWER_UP]" : "",
  527. (ifi->ifi_flags & IFF_DORMANT) ? "[DORMANT]" : "");
  528. /*
  529. * Some drivers send the association event before the operup event--in
  530. * this case, lifting operstate in wpa_driver_wext_set_operstate()
  531. * fails. This will hit us when wpa_supplicant does not need to do
  532. * IEEE 802.1X authentication
  533. */
  534. if (drv->operstate == 1 &&
  535. (ifi->ifi_flags & (IFF_LOWER_UP | IFF_DORMANT)) == IFF_LOWER_UP &&
  536. !(ifi->ifi_flags & IFF_RUNNING))
  537. netlink_send_oper_ifla(drv->netlink, drv->ifindex,
  538. -1, IF_OPER_UP);
  539. attrlen = len;
  540. attr = (struct rtattr *) buf;
  541. rta_len = RTA_ALIGN(sizeof(struct rtattr));
  542. while (RTA_OK(attr, attrlen)) {
  543. if (attr->rta_type == IFLA_WIRELESS) {
  544. wpa_driver_wext_event_wireless(
  545. drv, ((char *) attr) + rta_len,
  546. attr->rta_len - rta_len);
  547. } else if (attr->rta_type == IFLA_IFNAME) {
  548. wpa_driver_wext_event_link(drv,
  549. ((char *) attr) + rta_len,
  550. attr->rta_len - rta_len, 0);
  551. }
  552. attr = RTA_NEXT(attr, attrlen);
  553. }
  554. }
  555. static void wpa_driver_wext_event_rtm_dellink(void *ctx, struct ifinfomsg *ifi,
  556. u8 *buf, size_t len)
  557. {
  558. struct wpa_driver_wext_data *drv = ctx;
  559. int attrlen, rta_len;
  560. struct rtattr *attr;
  561. attrlen = len;
  562. attr = (struct rtattr *) buf;
  563. rta_len = RTA_ALIGN(sizeof(struct rtattr));
  564. while (RTA_OK(attr, attrlen)) {
  565. if (attr->rta_type == IFLA_IFNAME) {
  566. wpa_driver_wext_event_link(drv,
  567. ((char *) attr) + rta_len,
  568. attr->rta_len - rta_len, 1);
  569. }
  570. attr = RTA_NEXT(attr, attrlen);
  571. }
  572. }
  573. static int wpa_driver_wext_get_ifflags_ifname(struct wpa_driver_wext_data *drv,
  574. const char *ifname, int *flags)
  575. {
  576. struct ifreq ifr;
  577. os_memset(&ifr, 0, sizeof(ifr));
  578. os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
  579. if (ioctl(drv->ioctl_sock, SIOCGIFFLAGS, (caddr_t) &ifr) < 0) {
  580. perror("ioctl[SIOCGIFFLAGS]");
  581. return -1;
  582. }
  583. *flags = ifr.ifr_flags & 0xffff;
  584. return 0;
  585. }
  586. /**
  587. * wpa_driver_wext_get_ifflags - Get interface flags (SIOCGIFFLAGS)
  588. * @drv: driver_wext private data
  589. * @flags: Pointer to returned flags value
  590. * Returns: 0 on success, -1 on failure
  591. */
  592. int wpa_driver_wext_get_ifflags(struct wpa_driver_wext_data *drv, int *flags)
  593. {
  594. return wpa_driver_wext_get_ifflags_ifname(drv, drv->ifname, flags);
  595. }
  596. static int wpa_driver_wext_set_ifflags_ifname(struct wpa_driver_wext_data *drv,
  597. const char *ifname, int flags)
  598. {
  599. struct ifreq ifr;
  600. os_memset(&ifr, 0, sizeof(ifr));
  601. os_strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
  602. ifr.ifr_flags = flags & 0xffff;
  603. if (ioctl(drv->ioctl_sock, SIOCSIFFLAGS, (caddr_t) &ifr) < 0) {
  604. perror("SIOCSIFFLAGS");
  605. return -1;
  606. }
  607. return 0;
  608. }
  609. /**
  610. * wpa_driver_wext_set_ifflags - Set interface flags (SIOCSIFFLAGS)
  611. * @drv: driver_wext private data
  612. * @flags: New value for flags
  613. * Returns: 0 on success, -1 on failure
  614. */
  615. int wpa_driver_wext_set_ifflags(struct wpa_driver_wext_data *drv, int flags)
  616. {
  617. return wpa_driver_wext_set_ifflags_ifname(drv, drv->ifname, flags);
  618. }
  619. /**
  620. * wpa_driver_wext_init - Initialize WE driver interface
  621. * @ctx: context to be used when calling wpa_supplicant functions,
  622. * e.g., wpa_supplicant_event()
  623. * @ifname: interface name, e.g., wlan0
  624. * Returns: Pointer to private data, %NULL on failure
  625. */
  626. void * wpa_driver_wext_init(void *ctx, const char *ifname)
  627. {
  628. struct wpa_driver_wext_data *drv;
  629. struct netlink_config *cfg;
  630. drv = os_zalloc(sizeof(*drv));
  631. if (drv == NULL)
  632. return NULL;
  633. drv->ctx = ctx;
  634. os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname));
  635. drv->ioctl_sock = socket(PF_INET, SOCK_DGRAM, 0);
  636. if (drv->ioctl_sock < 0) {
  637. perror("socket(PF_INET,SOCK_DGRAM)");
  638. goto err1;
  639. }
  640. cfg = os_zalloc(sizeof(*cfg));
  641. if (cfg == NULL)
  642. goto err1;
  643. cfg->ctx = drv;
  644. cfg->newlink_cb = wpa_driver_wext_event_rtm_newlink;
  645. cfg->dellink_cb = wpa_driver_wext_event_rtm_dellink;
  646. drv->netlink = netlink_init(cfg);
  647. if (drv->netlink == NULL) {
  648. os_free(cfg);
  649. goto err2;
  650. }
  651. drv->mlme_sock = -1;
  652. if (wpa_driver_wext_finish_drv_init(drv) < 0)
  653. goto err3;
  654. wpa_driver_wext_set_auth_param(drv, IW_AUTH_WPA_ENABLED, 1);
  655. return drv;
  656. err3:
  657. netlink_deinit(drv->netlink);
  658. err2:
  659. close(drv->ioctl_sock);
  660. err1:
  661. os_free(drv);
  662. return NULL;
  663. }
  664. static int wpa_driver_wext_finish_drv_init(struct wpa_driver_wext_data *drv)
  665. {
  666. int flags;
  667. if (wpa_driver_wext_get_ifflags(drv, &flags) != 0) {
  668. wpa_printf(MSG_ERROR, "Could not get interface '%s' flags",
  669. drv->ifname);
  670. return -1;
  671. }
  672. if (!(flags & IFF_UP)) {
  673. if (wpa_driver_wext_set_ifflags(drv, flags | IFF_UP) != 0) {
  674. wpa_printf(MSG_ERROR, "Could not set interface '%s' "
  675. "UP", drv->ifname);
  676. return -1;
  677. } else {
  678. /*
  679. * Wait some time to allow driver to initialize before
  680. * starting configuring the driver. This seems to be
  681. * needed at least some drivers that load firmware etc.
  682. * when the interface is set up.
  683. */
  684. wpa_printf(MSG_DEBUG, "Interface %s set UP - waiting "
  685. "a second for the driver to complete "
  686. "initialization", drv->ifname);
  687. sleep(1);
  688. }
  689. }
  690. /*
  691. * Make sure that the driver does not have any obsolete PMKID entries.
  692. */
  693. wpa_driver_wext_flush_pmkid(drv);
  694. if (wpa_driver_wext_set_mode(drv, 0) < 0) {
  695. wpa_printf(MSG_DEBUG, "Could not configure driver to use "
  696. "managed mode");
  697. /* Try to use it anyway */
  698. }
  699. wpa_driver_wext_get_range(drv);
  700. /*
  701. * Unlock the driver's BSSID and force to a random SSID to clear any
  702. * previous association the driver might have when the supplicant
  703. * starts up.
  704. */
  705. wpa_driver_wext_disconnect(drv);
  706. drv->ifindex = if_nametoindex(drv->ifname);
  707. if (os_strncmp(drv->ifname, "wlan", 4) == 0) {
  708. /*
  709. * Host AP driver may use both wlan# and wifi# interface in
  710. * wireless events. Since some of the versions included WE-18
  711. * support, let's add the alternative ifindex also from
  712. * driver_wext.c for the time being. This may be removed at
  713. * some point once it is believed that old versions of the
  714. * driver are not in use anymore.
  715. */
  716. char ifname2[IFNAMSIZ + 1];
  717. os_strlcpy(ifname2, drv->ifname, sizeof(ifname2));
  718. os_memcpy(ifname2, "wifi", 4);
  719. wpa_driver_wext_alternative_ifindex(drv, ifname2);
  720. }
  721. netlink_send_oper_ifla(drv->netlink, drv->ifindex,
  722. 1, IF_OPER_DORMANT);
  723. return 0;
  724. }
  725. /**
  726. * wpa_driver_wext_deinit - Deinitialize WE driver interface
  727. * @priv: Pointer to private wext data from wpa_driver_wext_init()
  728. *
  729. * Shut down driver interface and processing of driver events. Free
  730. * private data buffer if one was allocated in wpa_driver_wext_init().
  731. */
  732. void wpa_driver_wext_deinit(void *priv)
  733. {
  734. struct wpa_driver_wext_data *drv = priv;
  735. int flags;
  736. wpa_driver_wext_set_auth_param(drv, IW_AUTH_WPA_ENABLED, 0);
  737. eloop_cancel_timeout(wpa_driver_wext_scan_timeout, drv, drv->ctx);
  738. /*
  739. * Clear possibly configured driver parameters in order to make it
  740. * easier to use the driver after wpa_supplicant has been terminated.
  741. */
  742. wpa_driver_wext_disconnect(drv);
  743. netlink_send_oper_ifla(drv->netlink, drv->ifindex, 0, IF_OPER_UP);
  744. netlink_deinit(drv->netlink);
  745. if (drv->mlme_sock >= 0)
  746. eloop_unregister_read_sock(drv->mlme_sock);
  747. if (wpa_driver_wext_get_ifflags(drv, &flags) == 0)
  748. (void) wpa_driver_wext_set_ifflags(drv, flags & ~IFF_UP);
  749. close(drv->ioctl_sock);
  750. if (drv->mlme_sock >= 0)
  751. close(drv->mlme_sock);
  752. os_free(drv->assoc_req_ies);
  753. os_free(drv->assoc_resp_ies);
  754. os_free(drv);
  755. }
  756. /**
  757. * wpa_driver_wext_scan_timeout - Scan timeout to report scan completion
  758. * @eloop_ctx: Unused
  759. * @timeout_ctx: ctx argument given to wpa_driver_wext_init()
  760. *
  761. * This function can be used as registered timeout when starting a scan to
  762. * generate a scan completed event if the driver does not report this.
  763. */
  764. void wpa_driver_wext_scan_timeout(void *eloop_ctx, void *timeout_ctx)
  765. {
  766. wpa_printf(MSG_DEBUG, "Scan timeout - try to get results");
  767. wpa_supplicant_event(timeout_ctx, EVENT_SCAN_RESULTS, NULL);
  768. }
  769. /**
  770. * wpa_driver_wext_scan - Request the driver to initiate scan
  771. * @priv: Pointer to private wext data from wpa_driver_wext_init()
  772. * @param: Scan parameters (specific SSID to scan for (ProbeReq), etc.)
  773. * Returns: 0 on success, -1 on failure
  774. */
  775. int wpa_driver_wext_scan(void *priv, struct wpa_driver_scan_params *params)
  776. {
  777. struct wpa_driver_wext_data *drv = priv;
  778. struct iwreq iwr;
  779. int ret = 0, timeout;
  780. struct iw_scan_req req;
  781. const u8 *ssid = params->ssids[0].ssid;
  782. size_t ssid_len = params->ssids[0].ssid_len;
  783. if (ssid_len > IW_ESSID_MAX_SIZE) {
  784. wpa_printf(MSG_DEBUG, "%s: too long SSID (%lu)",
  785. __FUNCTION__, (unsigned long) ssid_len);
  786. return -1;
  787. }
  788. os_memset(&iwr, 0, sizeof(iwr));
  789. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  790. if (ssid && ssid_len) {
  791. os_memset(&req, 0, sizeof(req));
  792. req.essid_len = ssid_len;
  793. req.bssid.sa_family = ARPHRD_ETHER;
  794. os_memset(req.bssid.sa_data, 0xff, ETH_ALEN);
  795. os_memcpy(req.essid, ssid, ssid_len);
  796. iwr.u.data.pointer = (caddr_t) &req;
  797. iwr.u.data.length = sizeof(req);
  798. iwr.u.data.flags = IW_SCAN_THIS_ESSID;
  799. }
  800. if (ioctl(drv->ioctl_sock, SIOCSIWSCAN, &iwr) < 0) {
  801. perror("ioctl[SIOCSIWSCAN]");
  802. ret = -1;
  803. }
  804. /* Not all drivers generate "scan completed" wireless event, so try to
  805. * read results after a timeout. */
  806. timeout = 5;
  807. if (drv->scan_complete_events) {
  808. /*
  809. * The driver seems to deliver SIOCGIWSCAN events to notify
  810. * when scan is complete, so use longer timeout to avoid race
  811. * conditions with scanning and following association request.
  812. */
  813. timeout = 30;
  814. }
  815. wpa_printf(MSG_DEBUG, "Scan requested (ret=%d) - scan timeout %d "
  816. "seconds", ret, timeout);
  817. eloop_cancel_timeout(wpa_driver_wext_scan_timeout, drv, drv->ctx);
  818. eloop_register_timeout(timeout, 0, wpa_driver_wext_scan_timeout, drv,
  819. drv->ctx);
  820. return ret;
  821. }
  822. static u8 * wpa_driver_wext_giwscan(struct wpa_driver_wext_data *drv,
  823. size_t *len)
  824. {
  825. struct iwreq iwr;
  826. u8 *res_buf;
  827. size_t res_buf_len;
  828. res_buf_len = IW_SCAN_MAX_DATA;
  829. for (;;) {
  830. res_buf = os_malloc(res_buf_len);
  831. if (res_buf == NULL)
  832. return NULL;
  833. os_memset(&iwr, 0, sizeof(iwr));
  834. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  835. iwr.u.data.pointer = res_buf;
  836. iwr.u.data.length = res_buf_len;
  837. if (ioctl(drv->ioctl_sock, SIOCGIWSCAN, &iwr) == 0)
  838. break;
  839. if (errno == E2BIG && res_buf_len < 65535) {
  840. os_free(res_buf);
  841. res_buf = NULL;
  842. res_buf_len *= 2;
  843. if (res_buf_len > 65535)
  844. res_buf_len = 65535; /* 16-bit length field */
  845. wpa_printf(MSG_DEBUG, "Scan results did not fit - "
  846. "trying larger buffer (%lu bytes)",
  847. (unsigned long) res_buf_len);
  848. } else {
  849. perror("ioctl[SIOCGIWSCAN]");
  850. os_free(res_buf);
  851. return NULL;
  852. }
  853. }
  854. if (iwr.u.data.length > res_buf_len) {
  855. os_free(res_buf);
  856. return NULL;
  857. }
  858. *len = iwr.u.data.length;
  859. return res_buf;
  860. }
  861. /*
  862. * Data structure for collecting WEXT scan results. This is needed to allow
  863. * the various methods of reporting IEs to be combined into a single IE buffer.
  864. */
  865. struct wext_scan_data {
  866. struct wpa_scan_res res;
  867. u8 *ie;
  868. size_t ie_len;
  869. u8 ssid[32];
  870. size_t ssid_len;
  871. int maxrate;
  872. };
  873. static void wext_get_scan_mode(struct iw_event *iwe,
  874. struct wext_scan_data *res)
  875. {
  876. if (iwe->u.mode == IW_MODE_ADHOC)
  877. res->res.caps |= IEEE80211_CAP_IBSS;
  878. else if (iwe->u.mode == IW_MODE_MASTER || iwe->u.mode == IW_MODE_INFRA)
  879. res->res.caps |= IEEE80211_CAP_ESS;
  880. }
  881. static void wext_get_scan_ssid(struct iw_event *iwe,
  882. struct wext_scan_data *res, char *custom,
  883. char *end)
  884. {
  885. int ssid_len = iwe->u.essid.length;
  886. if (custom + ssid_len > end)
  887. return;
  888. if (iwe->u.essid.flags &&
  889. ssid_len > 0 &&
  890. ssid_len <= IW_ESSID_MAX_SIZE) {
  891. os_memcpy(res->ssid, custom, ssid_len);
  892. res->ssid_len = ssid_len;
  893. }
  894. }
  895. static void wext_get_scan_freq(struct iw_event *iwe,
  896. struct wext_scan_data *res)
  897. {
  898. int divi = 1000000, i;
  899. if (iwe->u.freq.e == 0) {
  900. /*
  901. * Some drivers do not report frequency, but a channel.
  902. * Try to map this to frequency by assuming they are using
  903. * IEEE 802.11b/g. But don't overwrite a previously parsed
  904. * frequency if the driver sends both frequency and channel,
  905. * since the driver may be sending an A-band channel that we
  906. * don't handle here.
  907. */
  908. if (res->res.freq)
  909. return;
  910. if (iwe->u.freq.m >= 1 && iwe->u.freq.m <= 13) {
  911. res->res.freq = 2407 + 5 * iwe->u.freq.m;
  912. return;
  913. } else if (iwe->u.freq.m == 14) {
  914. res->res.freq = 2484;
  915. return;
  916. }
  917. }
  918. if (iwe->u.freq.e > 6) {
  919. wpa_printf(MSG_DEBUG, "Invalid freq in scan results (BSSID="
  920. MACSTR " m=%d e=%d)",
  921. MAC2STR(res->res.bssid), iwe->u.freq.m,
  922. iwe->u.freq.e);
  923. return;
  924. }
  925. for (i = 0; i < iwe->u.freq.e; i++)
  926. divi /= 10;
  927. res->res.freq = iwe->u.freq.m / divi;
  928. }
  929. static void wext_get_scan_qual(struct iw_event *iwe,
  930. struct wext_scan_data *res)
  931. {
  932. res->res.qual = iwe->u.qual.qual;
  933. res->res.noise = iwe->u.qual.noise;
  934. res->res.level = iwe->u.qual.level;
  935. if (iwe->u.qual.updated & IW_QUAL_QUAL_INVALID)
  936. res->res.flags |= WPA_SCAN_QUAL_INVALID;
  937. if (iwe->u.qual.updated & IW_QUAL_LEVEL_INVALID)
  938. res->res.flags |= WPA_SCAN_LEVEL_INVALID;
  939. if (iwe->u.qual.updated & IW_QUAL_NOISE_INVALID)
  940. res->res.flags |= WPA_SCAN_NOISE_INVALID;
  941. if (iwe->u.qual.updated & IW_QUAL_DBM)
  942. res->res.flags |= WPA_SCAN_LEVEL_DBM;
  943. }
  944. static void wext_get_scan_encode(struct iw_event *iwe,
  945. struct wext_scan_data *res)
  946. {
  947. if (!(iwe->u.data.flags & IW_ENCODE_DISABLED))
  948. res->res.caps |= IEEE80211_CAP_PRIVACY;
  949. }
  950. static void wext_get_scan_rate(struct iw_event *iwe,
  951. struct wext_scan_data *res, char *pos,
  952. char *end)
  953. {
  954. int maxrate;
  955. char *custom = pos + IW_EV_LCP_LEN;
  956. struct iw_param p;
  957. size_t clen;
  958. clen = iwe->len;
  959. if (custom + clen > end)
  960. return;
  961. maxrate = 0;
  962. while (((ssize_t) clen) >= (ssize_t) sizeof(struct iw_param)) {
  963. /* Note: may be misaligned, make a local, aligned copy */
  964. os_memcpy(&p, custom, sizeof(struct iw_param));
  965. if (p.value > maxrate)
  966. maxrate = p.value;
  967. clen -= sizeof(struct iw_param);
  968. custom += sizeof(struct iw_param);
  969. }
  970. /* Convert the maxrate from WE-style (b/s units) to
  971. * 802.11 rates (500000 b/s units).
  972. */
  973. res->maxrate = maxrate / 500000;
  974. }
  975. static void wext_get_scan_iwevgenie(struct iw_event *iwe,
  976. struct wext_scan_data *res, char *custom,
  977. char *end)
  978. {
  979. char *genie, *gpos, *gend;
  980. u8 *tmp;
  981. if (iwe->u.data.length == 0)
  982. return;
  983. gpos = genie = custom;
  984. gend = genie + iwe->u.data.length;
  985. if (gend > end) {
  986. wpa_printf(MSG_INFO, "IWEVGENIE overflow");
  987. return;
  988. }
  989. tmp = os_realloc(res->ie, res->ie_len + gend - gpos);
  990. if (tmp == NULL)
  991. return;
  992. os_memcpy(tmp + res->ie_len, gpos, gend - gpos);
  993. res->ie = tmp;
  994. res->ie_len += gend - gpos;
  995. }
  996. static void wext_get_scan_custom(struct iw_event *iwe,
  997. struct wext_scan_data *res, char *custom,
  998. char *end)
  999. {
  1000. size_t clen;
  1001. u8 *tmp;
  1002. clen = iwe->u.data.length;
  1003. if (custom + clen > end)
  1004. return;
  1005. if (clen > 7 && os_strncmp(custom, "wpa_ie=", 7) == 0) {
  1006. char *spos;
  1007. int bytes;
  1008. spos = custom + 7;
  1009. bytes = custom + clen - spos;
  1010. if (bytes & 1 || bytes == 0)
  1011. return;
  1012. bytes /= 2;
  1013. tmp = os_realloc(res->ie, res->ie_len + bytes);
  1014. if (tmp == NULL)
  1015. return;
  1016. hexstr2bin(spos, tmp + res->ie_len, bytes);
  1017. res->ie = tmp;
  1018. res->ie_len += bytes;
  1019. } else if (clen > 7 && os_strncmp(custom, "rsn_ie=", 7) == 0) {
  1020. char *spos;
  1021. int bytes;
  1022. spos = custom + 7;
  1023. bytes = custom + clen - spos;
  1024. if (bytes & 1 || bytes == 0)
  1025. return;
  1026. bytes /= 2;
  1027. tmp = os_realloc(res->ie, res->ie_len + bytes);
  1028. if (tmp == NULL)
  1029. return;
  1030. hexstr2bin(spos, tmp + res->ie_len, bytes);
  1031. res->ie = tmp;
  1032. res->ie_len += bytes;
  1033. } else if (clen > 4 && os_strncmp(custom, "tsf=", 4) == 0) {
  1034. char *spos;
  1035. int bytes;
  1036. u8 bin[8];
  1037. spos = custom + 4;
  1038. bytes = custom + clen - spos;
  1039. if (bytes != 16) {
  1040. wpa_printf(MSG_INFO, "Invalid TSF length (%d)", bytes);
  1041. return;
  1042. }
  1043. bytes /= 2;
  1044. hexstr2bin(spos, bin, bytes);
  1045. res->res.tsf += WPA_GET_BE64(bin);
  1046. }
  1047. }
  1048. static int wext_19_iw_point(struct wpa_driver_wext_data *drv, u16 cmd)
  1049. {
  1050. return drv->we_version_compiled > 18 &&
  1051. (cmd == SIOCGIWESSID || cmd == SIOCGIWENCODE ||
  1052. cmd == IWEVGENIE || cmd == IWEVCUSTOM);
  1053. }
  1054. static void wpa_driver_wext_add_scan_entry(struct wpa_scan_results *res,
  1055. struct wext_scan_data *data)
  1056. {
  1057. struct wpa_scan_res **tmp;
  1058. struct wpa_scan_res *r;
  1059. size_t extra_len;
  1060. u8 *pos, *end, *ssid_ie = NULL, *rate_ie = NULL;
  1061. /* Figure out whether we need to fake any IEs */
  1062. pos = data->ie;
  1063. end = pos + data->ie_len;
  1064. while (pos && pos + 1 < end) {
  1065. if (pos + 2 + pos[1] > end)
  1066. break;
  1067. if (pos[0] == WLAN_EID_SSID)
  1068. ssid_ie = pos;
  1069. else if (pos[0] == WLAN_EID_SUPP_RATES)
  1070. rate_ie = pos;
  1071. else if (pos[0] == WLAN_EID_EXT_SUPP_RATES)
  1072. rate_ie = pos;
  1073. pos += 2 + pos[1];
  1074. }
  1075. extra_len = 0;
  1076. if (ssid_ie == NULL)
  1077. extra_len += 2 + data->ssid_len;
  1078. if (rate_ie == NULL && data->maxrate)
  1079. extra_len += 3;
  1080. r = os_zalloc(sizeof(*r) + extra_len + data->ie_len);
  1081. if (r == NULL)
  1082. return;
  1083. os_memcpy(r, &data->res, sizeof(*r));
  1084. r->ie_len = extra_len + data->ie_len;
  1085. pos = (u8 *) (r + 1);
  1086. if (ssid_ie == NULL) {
  1087. /*
  1088. * Generate a fake SSID IE since the driver did not report
  1089. * a full IE list.
  1090. */
  1091. *pos++ = WLAN_EID_SSID;
  1092. *pos++ = data->ssid_len;
  1093. os_memcpy(pos, data->ssid, data->ssid_len);
  1094. pos += data->ssid_len;
  1095. }
  1096. if (rate_ie == NULL && data->maxrate) {
  1097. /*
  1098. * Generate a fake Supported Rates IE since the driver did not
  1099. * report a full IE list.
  1100. */
  1101. *pos++ = WLAN_EID_SUPP_RATES;
  1102. *pos++ = 1;
  1103. *pos++ = data->maxrate;
  1104. }
  1105. if (data->ie)
  1106. os_memcpy(pos, data->ie, data->ie_len);
  1107. tmp = os_realloc(res->res,
  1108. (res->num + 1) * sizeof(struct wpa_scan_res *));
  1109. if (tmp == NULL) {
  1110. os_free(r);
  1111. return;
  1112. }
  1113. tmp[res->num++] = r;
  1114. res->res = tmp;
  1115. }
  1116. /**
  1117. * wpa_driver_wext_get_scan_results - Fetch the latest scan results
  1118. * @priv: Pointer to private wext data from wpa_driver_wext_init()
  1119. * Returns: Scan results on success, -1 on failure
  1120. */
  1121. struct wpa_scan_results * wpa_driver_wext_get_scan_results(void *priv)
  1122. {
  1123. struct wpa_driver_wext_data *drv = priv;
  1124. size_t ap_num = 0, len;
  1125. int first;
  1126. u8 *res_buf;
  1127. struct iw_event iwe_buf, *iwe = &iwe_buf;
  1128. char *pos, *end, *custom;
  1129. struct wpa_scan_results *res;
  1130. struct wext_scan_data data;
  1131. res_buf = wpa_driver_wext_giwscan(drv, &len);
  1132. if (res_buf == NULL)
  1133. return NULL;
  1134. ap_num = 0;
  1135. first = 1;
  1136. res = os_zalloc(sizeof(*res));
  1137. if (res == NULL) {
  1138. os_free(res_buf);
  1139. return NULL;
  1140. }
  1141. pos = (char *) res_buf;
  1142. end = (char *) res_buf + len;
  1143. os_memset(&data, 0, sizeof(data));
  1144. while (pos + IW_EV_LCP_LEN <= end) {
  1145. /* Event data may be unaligned, so make a local, aligned copy
  1146. * before processing. */
  1147. os_memcpy(&iwe_buf, pos, IW_EV_LCP_LEN);
  1148. if (iwe->len <= IW_EV_LCP_LEN)
  1149. break;
  1150. custom = pos + IW_EV_POINT_LEN;
  1151. if (wext_19_iw_point(drv, iwe->cmd)) {
  1152. /* WE-19 removed the pointer from struct iw_point */
  1153. char *dpos = (char *) &iwe_buf.u.data.length;
  1154. int dlen = dpos - (char *) &iwe_buf;
  1155. os_memcpy(dpos, pos + IW_EV_LCP_LEN,
  1156. sizeof(struct iw_event) - dlen);
  1157. } else {
  1158. os_memcpy(&iwe_buf, pos, sizeof(struct iw_event));
  1159. custom += IW_EV_POINT_OFF;
  1160. }
  1161. switch (iwe->cmd) {
  1162. case SIOCGIWAP:
  1163. if (!first)
  1164. wpa_driver_wext_add_scan_entry(res, &data);
  1165. first = 0;
  1166. os_free(data.ie);
  1167. os_memset(&data, 0, sizeof(data));
  1168. os_memcpy(data.res.bssid,
  1169. iwe->u.ap_addr.sa_data, ETH_ALEN);
  1170. break;
  1171. case SIOCGIWMODE:
  1172. wext_get_scan_mode(iwe, &data);
  1173. break;
  1174. case SIOCGIWESSID:
  1175. wext_get_scan_ssid(iwe, &data, custom, end);
  1176. break;
  1177. case SIOCGIWFREQ:
  1178. wext_get_scan_freq(iwe, &data);
  1179. break;
  1180. case IWEVQUAL:
  1181. wext_get_scan_qual(iwe, &data);
  1182. break;
  1183. case SIOCGIWENCODE:
  1184. wext_get_scan_encode(iwe, &data);
  1185. break;
  1186. case SIOCGIWRATE:
  1187. wext_get_scan_rate(iwe, &data, pos, end);
  1188. break;
  1189. case IWEVGENIE:
  1190. wext_get_scan_iwevgenie(iwe, &data, custom, end);
  1191. break;
  1192. case IWEVCUSTOM:
  1193. wext_get_scan_custom(iwe, &data, custom, end);
  1194. break;
  1195. }
  1196. pos += iwe->len;
  1197. }
  1198. os_free(res_buf);
  1199. res_buf = NULL;
  1200. if (!first)
  1201. wpa_driver_wext_add_scan_entry(res, &data);
  1202. os_free(data.ie);
  1203. wpa_printf(MSG_DEBUG, "Received %lu bytes of scan results (%lu BSSes)",
  1204. (unsigned long) len, (unsigned long) res->num);
  1205. return res;
  1206. }
  1207. static int wpa_driver_wext_get_range(void *priv)
  1208. {
  1209. struct wpa_driver_wext_data *drv = priv;
  1210. struct iw_range *range;
  1211. struct iwreq iwr;
  1212. int minlen;
  1213. size_t buflen;
  1214. /*
  1215. * Use larger buffer than struct iw_range in order to allow the
  1216. * structure to grow in the future.
  1217. */
  1218. buflen = sizeof(struct iw_range) + 500;
  1219. range = os_zalloc(buflen);
  1220. if (range == NULL)
  1221. return -1;
  1222. os_memset(&iwr, 0, sizeof(iwr));
  1223. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  1224. iwr.u.data.pointer = (caddr_t) range;
  1225. iwr.u.data.length = buflen;
  1226. minlen = ((char *) &range->enc_capa) - (char *) range +
  1227. sizeof(range->enc_capa);
  1228. if (ioctl(drv->ioctl_sock, SIOCGIWRANGE, &iwr) < 0) {
  1229. perror("ioctl[SIOCGIWRANGE]");
  1230. os_free(range);
  1231. return -1;
  1232. } else if (iwr.u.data.length >= minlen &&
  1233. range->we_version_compiled >= 18) {
  1234. wpa_printf(MSG_DEBUG, "SIOCGIWRANGE: WE(compiled)=%d "
  1235. "WE(source)=%d enc_capa=0x%x",
  1236. range->we_version_compiled,
  1237. range->we_version_source,
  1238. range->enc_capa);
  1239. drv->has_capability = 1;
  1240. drv->we_version_compiled = range->we_version_compiled;
  1241. if (range->enc_capa & IW_ENC_CAPA_WPA) {
  1242. drv->capa.key_mgmt |= WPA_DRIVER_CAPA_KEY_MGMT_WPA |
  1243. WPA_DRIVER_CAPA_KEY_MGMT_WPA_PSK;
  1244. }
  1245. if (range->enc_capa & IW_ENC_CAPA_WPA2) {
  1246. drv->capa.key_mgmt |= WPA_DRIVER_CAPA_KEY_MGMT_WPA2 |
  1247. WPA_DRIVER_CAPA_KEY_MGMT_WPA2_PSK;
  1248. }
  1249. drv->capa.enc |= WPA_DRIVER_CAPA_ENC_WEP40 |
  1250. WPA_DRIVER_CAPA_ENC_WEP104;
  1251. if (range->enc_capa & IW_ENC_CAPA_CIPHER_TKIP)
  1252. drv->capa.enc |= WPA_DRIVER_CAPA_ENC_TKIP;
  1253. if (range->enc_capa & IW_ENC_CAPA_CIPHER_CCMP)
  1254. drv->capa.enc |= WPA_DRIVER_CAPA_ENC_CCMP;
  1255. if (range->enc_capa & IW_ENC_CAPA_4WAY_HANDSHAKE)
  1256. drv->capa.flags |= WPA_DRIVER_FLAGS_4WAY_HANDSHAKE;
  1257. drv->capa.max_scan_ssids = 1;
  1258. wpa_printf(MSG_DEBUG, " capabilities: key_mgmt 0x%x enc 0x%x "
  1259. "flags 0x%x",
  1260. drv->capa.key_mgmt, drv->capa.enc, drv->capa.flags);
  1261. } else {
  1262. wpa_printf(MSG_DEBUG, "SIOCGIWRANGE: too old (short) data - "
  1263. "assuming WPA is not supported");
  1264. }
  1265. os_free(range);
  1266. return 0;
  1267. }
  1268. static int wpa_driver_wext_set_psk(struct wpa_driver_wext_data *drv,
  1269. const u8 *psk)
  1270. {
  1271. struct iw_encode_ext *ext;
  1272. struct iwreq iwr;
  1273. int ret;
  1274. wpa_printf(MSG_DEBUG, "%s", __FUNCTION__);
  1275. if (!(drv->capa.flags & WPA_DRIVER_FLAGS_4WAY_HANDSHAKE))
  1276. return 0;
  1277. if (!psk)
  1278. return 0;
  1279. os_memset(&iwr, 0, sizeof(iwr));
  1280. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  1281. ext = os_zalloc(sizeof(*ext) + PMK_LEN);
  1282. if (ext == NULL)
  1283. return -1;
  1284. iwr.u.encoding.pointer = (caddr_t) ext;
  1285. iwr.u.encoding.length = sizeof(*ext) + PMK_LEN;
  1286. ext->key_len = PMK_LEN;
  1287. os_memcpy(&ext->key, psk, ext->key_len);
  1288. ext->alg = IW_ENCODE_ALG_PMK;
  1289. ret = ioctl(drv->ioctl_sock, SIOCSIWENCODEEXT, &iwr);
  1290. if (ret < 0)
  1291. perror("ioctl[SIOCSIWENCODEEXT] PMK");
  1292. os_free(ext);
  1293. return ret;
  1294. }
  1295. static int wpa_driver_wext_set_key_ext(void *priv, wpa_alg alg,
  1296. const u8 *addr, int key_idx,
  1297. int set_tx, const u8 *seq,
  1298. size_t seq_len,
  1299. const u8 *key, size_t key_len)
  1300. {
  1301. struct wpa_driver_wext_data *drv = priv;
  1302. struct iwreq iwr;
  1303. int ret = 0;
  1304. struct iw_encode_ext *ext;
  1305. if (seq_len > IW_ENCODE_SEQ_MAX_SIZE) {
  1306. wpa_printf(MSG_DEBUG, "%s: Invalid seq_len %lu",
  1307. __FUNCTION__, (unsigned long) seq_len);
  1308. return -1;
  1309. }
  1310. ext = os_zalloc(sizeof(*ext) + key_len);
  1311. if (ext == NULL)
  1312. return -1;
  1313. os_memset(&iwr, 0, sizeof(iwr));
  1314. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  1315. iwr.u.encoding.flags = key_idx + 1;
  1316. iwr.u.encoding.flags |= IW_ENCODE_TEMP;
  1317. if (alg == WPA_ALG_NONE)
  1318. iwr.u.encoding.flags |= IW_ENCODE_DISABLED;
  1319. iwr.u.encoding.pointer = (caddr_t) ext;
  1320. iwr.u.encoding.length = sizeof(*ext) + key_len;
  1321. if (addr == NULL ||
  1322. os_memcmp(addr, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) == 0)
  1323. ext->ext_flags |= IW_ENCODE_EXT_GROUP_KEY;
  1324. if (set_tx)
  1325. ext->ext_flags |= IW_ENCODE_EXT_SET_TX_KEY;
  1326. ext->addr.sa_family = ARPHRD_ETHER;
  1327. if (addr)
  1328. os_memcpy(ext->addr.sa_data, addr, ETH_ALEN);
  1329. else
  1330. os_memset(ext->addr.sa_data, 0xff, ETH_ALEN);
  1331. if (key && key_len) {
  1332. os_memcpy(ext + 1, key, key_len);
  1333. ext->key_len = key_len;
  1334. }
  1335. switch (alg) {
  1336. case WPA_ALG_NONE:
  1337. ext->alg = IW_ENCODE_ALG_NONE;
  1338. break;
  1339. case WPA_ALG_WEP:
  1340. ext->alg = IW_ENCODE_ALG_WEP;
  1341. break;
  1342. case WPA_ALG_TKIP:
  1343. ext->alg = IW_ENCODE_ALG_TKIP;
  1344. break;
  1345. case WPA_ALG_CCMP:
  1346. ext->alg = IW_ENCODE_ALG_CCMP;
  1347. break;
  1348. case WPA_ALG_PMK:
  1349. ext->alg = IW_ENCODE_ALG_PMK;
  1350. break;
  1351. #ifdef CONFIG_IEEE80211W
  1352. case WPA_ALG_IGTK:
  1353. ext->alg = IW_ENCODE_ALG_AES_CMAC;
  1354. break;
  1355. #endif /* CONFIG_IEEE80211W */
  1356. default:
  1357. wpa_printf(MSG_DEBUG, "%s: Unknown algorithm %d",
  1358. __FUNCTION__, alg);
  1359. os_free(ext);
  1360. return -1;
  1361. }
  1362. if (seq && seq_len) {
  1363. ext->ext_flags |= IW_ENCODE_EXT_RX_SEQ_VALID;
  1364. os_memcpy(ext->rx_seq, seq, seq_len);
  1365. }
  1366. if (ioctl(drv->ioctl_sock, SIOCSIWENCODEEXT, &iwr) < 0) {
  1367. ret = errno == EOPNOTSUPP ? -2 : -1;
  1368. if (errno == ENODEV) {
  1369. /*
  1370. * ndiswrapper seems to be returning incorrect error
  1371. * code.. */
  1372. ret = -2;
  1373. }
  1374. perror("ioctl[SIOCSIWENCODEEXT]");
  1375. }
  1376. os_free(ext);
  1377. return ret;
  1378. }
  1379. /**
  1380. * wpa_driver_wext_set_key - Configure encryption key
  1381. * @priv: Pointer to private wext data from wpa_driver_wext_init()
  1382. * @priv: Private driver interface data
  1383. * @alg: Encryption algorithm (%WPA_ALG_NONE, %WPA_ALG_WEP,
  1384. * %WPA_ALG_TKIP, %WPA_ALG_CCMP); %WPA_ALG_NONE clears the key.
  1385. * @addr: Address of the peer STA or ff:ff:ff:ff:ff:ff for
  1386. * broadcast/default keys
  1387. * @key_idx: key index (0..3), usually 0 for unicast keys
  1388. * @set_tx: Configure this key as the default Tx key (only used when
  1389. * driver does not support separate unicast/individual key
  1390. * @seq: Sequence number/packet number, seq_len octets, the next
  1391. * packet number to be used for in replay protection; configured
  1392. * for Rx keys (in most cases, this is only used with broadcast
  1393. * keys and set to zero for unicast keys)
  1394. * @seq_len: Length of the seq, depends on the algorithm:
  1395. * TKIP: 6 octets, CCMP: 6 octets
  1396. * @key: Key buffer; TKIP: 16-byte temporal key, 8-byte Tx Mic key,
  1397. * 8-byte Rx Mic Key
  1398. * @key_len: Length of the key buffer in octets (WEP: 5 or 13,
  1399. * TKIP: 32, CCMP: 16)
  1400. * Returns: 0 on success, -1 on failure
  1401. *
  1402. * This function uses SIOCSIWENCODEEXT by default, but tries to use
  1403. * SIOCSIWENCODE if the extended ioctl fails when configuring a WEP key.
  1404. */
  1405. int wpa_driver_wext_set_key(const char *ifname, void *priv, wpa_alg alg,
  1406. const u8 *addr, int key_idx,
  1407. int set_tx, const u8 *seq, size_t seq_len,
  1408. const u8 *key, size_t key_len)
  1409. {
  1410. struct wpa_driver_wext_data *drv = priv;
  1411. struct iwreq iwr;
  1412. int ret = 0;
  1413. wpa_printf(MSG_DEBUG, "%s: alg=%d key_idx=%d set_tx=%d seq_len=%lu "
  1414. "key_len=%lu",
  1415. __FUNCTION__, alg, key_idx, set_tx,
  1416. (unsigned long) seq_len, (unsigned long) key_len);
  1417. ret = wpa_driver_wext_set_key_ext(drv, alg, addr, key_idx, set_tx,
  1418. seq, seq_len, key, key_len);
  1419. if (ret == 0)
  1420. return 0;
  1421. if (ret == -2 &&
  1422. (alg == WPA_ALG_NONE || alg == WPA_ALG_WEP)) {
  1423. wpa_printf(MSG_DEBUG, "Driver did not support "
  1424. "SIOCSIWENCODEEXT, trying SIOCSIWENCODE");
  1425. ret = 0;
  1426. } else {
  1427. wpa_printf(MSG_DEBUG, "Driver did not support "
  1428. "SIOCSIWENCODEEXT");
  1429. return ret;
  1430. }
  1431. os_memset(&iwr, 0, sizeof(iwr));
  1432. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  1433. iwr.u.encoding.flags = key_idx + 1;
  1434. iwr.u.encoding.flags |= IW_ENCODE_TEMP;
  1435. if (alg == WPA_ALG_NONE)
  1436. iwr.u.encoding.flags |= IW_ENCODE_DISABLED;
  1437. iwr.u.encoding.pointer = (caddr_t) key;
  1438. iwr.u.encoding.length = key_len;
  1439. if (ioctl(drv->ioctl_sock, SIOCSIWENCODE, &iwr) < 0) {
  1440. perror("ioctl[SIOCSIWENCODE]");
  1441. ret = -1;
  1442. }
  1443. if (set_tx && alg != WPA_ALG_NONE) {
  1444. os_memset(&iwr, 0, sizeof(iwr));
  1445. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  1446. iwr.u.encoding.flags = key_idx + 1;
  1447. iwr.u.encoding.flags |= IW_ENCODE_TEMP;
  1448. iwr.u.encoding.pointer = (caddr_t) NULL;
  1449. iwr.u.encoding.length = 0;
  1450. if (ioctl(drv->ioctl_sock, SIOCSIWENCODE, &iwr) < 0) {
  1451. perror("ioctl[SIOCSIWENCODE] (set_tx)");
  1452. ret = -1;
  1453. }
  1454. }
  1455. return ret;
  1456. }
  1457. static int wpa_driver_wext_set_countermeasures(void *priv,
  1458. int enabled)
  1459. {
  1460. struct wpa_driver_wext_data *drv = priv;
  1461. wpa_printf(MSG_DEBUG, "%s", __FUNCTION__);
  1462. return wpa_driver_wext_set_auth_param(drv,
  1463. IW_AUTH_TKIP_COUNTERMEASURES,
  1464. enabled);
  1465. }
  1466. static int wpa_driver_wext_set_drop_unencrypted(void *priv,
  1467. int enabled)
  1468. {
  1469. struct wpa_driver_wext_data *drv = priv;
  1470. wpa_printf(MSG_DEBUG, "%s", __FUNCTION__);
  1471. drv->use_crypt = enabled;
  1472. return wpa_driver_wext_set_auth_param(drv, IW_AUTH_DROP_UNENCRYPTED,
  1473. enabled);
  1474. }
  1475. static int wpa_driver_wext_mlme(struct wpa_driver_wext_data *drv,
  1476. const u8 *addr, int cmd, int reason_code)
  1477. {
  1478. struct iwreq iwr;
  1479. struct iw_mlme mlme;
  1480. int ret = 0;
  1481. os_memset(&iwr, 0, sizeof(iwr));
  1482. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  1483. os_memset(&mlme, 0, sizeof(mlme));
  1484. mlme.cmd = cmd;
  1485. mlme.reason_code = reason_code;
  1486. mlme.addr.sa_family = ARPHRD_ETHER;
  1487. os_memcpy(mlme.addr.sa_data, addr, ETH_ALEN);
  1488. iwr.u.data.pointer = (caddr_t) &mlme;
  1489. iwr.u.data.length = sizeof(mlme);
  1490. if (ioctl(drv->ioctl_sock, SIOCSIWMLME, &iwr) < 0) {
  1491. perror("ioctl[SIOCSIWMLME]");
  1492. ret = -1;
  1493. }
  1494. return ret;
  1495. }
  1496. static void wpa_driver_wext_disconnect(struct wpa_driver_wext_data *drv)
  1497. {
  1498. struct iwreq iwr;
  1499. const u8 null_bssid[ETH_ALEN] = { 0, 0, 0, 0, 0, 0 };
  1500. u8 ssid[32];
  1501. int i;
  1502. /*
  1503. * Only force-disconnect when the card is in infrastructure mode,
  1504. * otherwise the driver might interpret the cleared BSSID and random
  1505. * SSID as an attempt to create a new ad-hoc network.
  1506. */
  1507. os_memset(&iwr, 0, sizeof(iwr));
  1508. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  1509. if (ioctl(drv->ioctl_sock, SIOCGIWMODE, &iwr) < 0) {
  1510. perror("ioctl[SIOCGIWMODE]");
  1511. iwr.u.mode = IW_MODE_INFRA;
  1512. }
  1513. if (iwr.u.mode == IW_MODE_INFRA) {
  1514. /*
  1515. * Clear the BSSID selection and set a random SSID to make sure
  1516. * the driver will not be trying to associate with something
  1517. * even if it does not understand SIOCSIWMLME commands (or
  1518. * tries to associate automatically after deauth/disassoc).
  1519. */
  1520. wpa_driver_wext_set_bssid(drv, null_bssid);
  1521. for (i = 0; i < 32; i++)
  1522. ssid[i] = rand() & 0xFF;
  1523. wpa_driver_wext_set_ssid(drv, ssid, 32);
  1524. }
  1525. }
  1526. static int wpa_driver_wext_deauthenticate(void *priv, const u8 *addr,
  1527. int reason_code)
  1528. {
  1529. struct wpa_driver_wext_data *drv = priv;
  1530. int ret;
  1531. wpa_printf(MSG_DEBUG, "%s", __FUNCTION__);
  1532. ret = wpa_driver_wext_mlme(drv, addr, IW_MLME_DEAUTH, reason_code);
  1533. wpa_driver_wext_disconnect(drv);
  1534. return ret;
  1535. }
  1536. static int wpa_driver_wext_disassociate(void *priv, const u8 *addr,
  1537. int reason_code)
  1538. {
  1539. struct wpa_driver_wext_data *drv = priv;
  1540. int ret;
  1541. wpa_printf(MSG_DEBUG, "%s", __FUNCTION__);
  1542. ret = wpa_driver_wext_mlme(drv, addr, IW_MLME_DISASSOC, reason_code);
  1543. wpa_driver_wext_disconnect(drv);
  1544. return ret;
  1545. }
  1546. static int wpa_driver_wext_set_gen_ie(void *priv, const u8 *ie,
  1547. size_t ie_len)
  1548. {
  1549. struct wpa_driver_wext_data *drv = priv;
  1550. struct iwreq iwr;
  1551. int ret = 0;
  1552. os_memset(&iwr, 0, sizeof(iwr));
  1553. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  1554. iwr.u.data.pointer = (caddr_t) ie;
  1555. iwr.u.data.length = ie_len;
  1556. if (ioctl(drv->ioctl_sock, SIOCSIWGENIE, &iwr) < 0) {
  1557. perror("ioctl[SIOCSIWGENIE]");
  1558. ret = -1;
  1559. }
  1560. return ret;
  1561. }
  1562. int wpa_driver_wext_cipher2wext(int cipher)
  1563. {
  1564. switch (cipher) {
  1565. case CIPHER_NONE:
  1566. return IW_AUTH_CIPHER_NONE;
  1567. case CIPHER_WEP40:
  1568. return IW_AUTH_CIPHER_WEP40;
  1569. case CIPHER_TKIP:
  1570. return IW_AUTH_CIPHER_TKIP;
  1571. case CIPHER_CCMP:
  1572. return IW_AUTH_CIPHER_CCMP;
  1573. case CIPHER_WEP104:
  1574. return IW_AUTH_CIPHER_WEP104;
  1575. default:
  1576. return 0;
  1577. }
  1578. }
  1579. int wpa_driver_wext_keymgmt2wext(int keymgmt)
  1580. {
  1581. switch (keymgmt) {
  1582. case KEY_MGMT_802_1X:
  1583. case KEY_MGMT_802_1X_NO_WPA:
  1584. return IW_AUTH_KEY_MGMT_802_1X;
  1585. case KEY_MGMT_PSK:
  1586. return IW_AUTH_KEY_MGMT_PSK;
  1587. default:
  1588. return 0;
  1589. }
  1590. }
  1591. static int
  1592. wpa_driver_wext_auth_alg_fallback(struct wpa_driver_wext_data *drv,
  1593. struct wpa_driver_associate_params *params)
  1594. {
  1595. struct iwreq iwr;
  1596. int ret = 0;
  1597. wpa_printf(MSG_DEBUG, "WEXT: Driver did not support "
  1598. "SIOCSIWAUTH for AUTH_ALG, trying SIOCSIWENCODE");
  1599. os_memset(&iwr, 0, sizeof(iwr));
  1600. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  1601. /* Just changing mode, not actual keys */
  1602. iwr.u.encoding.flags = 0;
  1603. iwr.u.encoding.pointer = (caddr_t) NULL;
  1604. iwr.u.encoding.length = 0;
  1605. /*
  1606. * Note: IW_ENCODE_{OPEN,RESTRICTED} can be interpreted to mean two
  1607. * different things. Here they are used to indicate Open System vs.
  1608. * Shared Key authentication algorithm. However, some drivers may use
  1609. * them to select between open/restricted WEP encrypted (open = allow
  1610. * both unencrypted and encrypted frames; restricted = only allow
  1611. * encrypted frames).
  1612. */
  1613. if (!drv->use_crypt) {
  1614. iwr.u.encoding.flags |= IW_ENCODE_DISABLED;
  1615. } else {
  1616. if (params->auth_alg & AUTH_ALG_OPEN_SYSTEM)
  1617. iwr.u.encoding.flags |= IW_ENCODE_OPEN;
  1618. if (params->auth_alg & AUTH_ALG_SHARED_KEY)
  1619. iwr.u.encoding.flags |= IW_ENCODE_RESTRICTED;
  1620. }
  1621. if (ioctl(drv->ioctl_sock, SIOCSIWENCODE, &iwr) < 0) {
  1622. perror("ioctl[SIOCSIWENCODE]");
  1623. ret = -1;
  1624. }
  1625. return ret;
  1626. }
  1627. int wpa_driver_wext_associate(void *priv,
  1628. struct wpa_driver_associate_params *params)
  1629. {
  1630. struct wpa_driver_wext_data *drv = priv;
  1631. int ret = 0;
  1632. int allow_unencrypted_eapol;
  1633. int value;
  1634. wpa_printf(MSG_DEBUG, "%s", __FUNCTION__);
  1635. if (wpa_driver_wext_set_drop_unencrypted(drv, params->drop_unencrypted)
  1636. < 0)
  1637. ret = -1;
  1638. if (wpa_driver_wext_set_auth_alg(drv, params->auth_alg) < 0)
  1639. ret = -1;
  1640. if (wpa_driver_wext_set_mode(drv, params->mode) < 0)
  1641. ret = -1;
  1642. /*
  1643. * If the driver did not support SIOCSIWAUTH, fallback to
  1644. * SIOCSIWENCODE here.
  1645. */
  1646. if (drv->auth_alg_fallback &&
  1647. wpa_driver_wext_auth_alg_fallback(drv, params) < 0)
  1648. ret = -1;
  1649. if (!params->bssid &&
  1650. wpa_driver_wext_set_bssid(drv, NULL) < 0)
  1651. ret = -1;
  1652. /* TODO: should consider getting wpa version and cipher/key_mgmt suites
  1653. * from configuration, not from here, where only the selected suite is
  1654. * available */
  1655. if (wpa_driver_wext_set_gen_ie(drv, params->wpa_ie, params->wpa_ie_len)
  1656. < 0)
  1657. ret = -1;
  1658. if (params->wpa_ie == NULL || params->wpa_ie_len == 0)
  1659. value = IW_AUTH_WPA_VERSION_DISABLED;
  1660. else if (params->wpa_ie[0] == WLAN_EID_RSN)
  1661. value = IW_AUTH_WPA_VERSION_WPA2;
  1662. else
  1663. value = IW_AUTH_WPA_VERSION_WPA;
  1664. if (wpa_driver_wext_set_auth_param(drv,
  1665. IW_AUTH_WPA_VERSION, value) < 0)
  1666. ret = -1;
  1667. value = wpa_driver_wext_cipher2wext(params->pairwise_suite);
  1668. if (wpa_driver_wext_set_auth_param(drv,
  1669. IW_AUTH_CIPHER_PAIRWISE, value) < 0)
  1670. ret = -1;
  1671. value = wpa_driver_wext_cipher2wext(params->group_suite);
  1672. if (wpa_driver_wext_set_auth_param(drv,
  1673. IW_AUTH_CIPHER_GROUP, value) < 0)
  1674. ret = -1;
  1675. value = wpa_driver_wext_keymgmt2wext(params->key_mgmt_suite);
  1676. if (wpa_driver_wext_set_auth_param(drv,
  1677. IW_AUTH_KEY_MGMT, value) < 0)
  1678. ret = -1;
  1679. value = params->key_mgmt_suite != KEY_MGMT_NONE ||
  1680. params->pairwise_suite != CIPHER_NONE ||
  1681. params->group_suite != CIPHER_NONE ||
  1682. params->wpa_ie_len;
  1683. if (wpa_driver_wext_set_auth_param(drv,
  1684. IW_AUTH_PRIVACY_INVOKED, value) < 0)
  1685. ret = -1;
  1686. /* Allow unencrypted EAPOL messages even if pairwise keys are set when
  1687. * not using WPA. IEEE 802.1X specifies that these frames are not
  1688. * encrypted, but WPA encrypts them when pairwise keys are in use. */
  1689. if (params->key_mgmt_suite == KEY_MGMT_802_1X ||
  1690. params->key_mgmt_suite == KEY_MGMT_PSK)
  1691. allow_unencrypted_eapol = 0;
  1692. else
  1693. allow_unencrypted_eapol = 1;
  1694. if (wpa_driver_wext_set_psk(drv, params->psk) < 0)
  1695. ret = -1;
  1696. if (wpa_driver_wext_set_auth_param(drv,
  1697. IW_AUTH_RX_UNENCRYPTED_EAPOL,
  1698. allow_unencrypted_eapol) < 0)
  1699. ret = -1;
  1700. #ifdef CONFIG_IEEE80211W
  1701. switch (params->mgmt_frame_protection) {
  1702. case NO_MGMT_FRAME_PROTECTION:
  1703. value = IW_AUTH_MFP_DISABLED;
  1704. break;
  1705. case MGMT_FRAME_PROTECTION_OPTIONAL:
  1706. value = IW_AUTH_MFP_OPTIONAL;
  1707. break;
  1708. case MGMT_FRAME_PROTECTION_REQUIRED:
  1709. value = IW_AUTH_MFP_REQUIRED;
  1710. break;
  1711. };
  1712. if (wpa_driver_wext_set_auth_param(drv, IW_AUTH_MFP, value) < 0)
  1713. ret = -1;
  1714. #endif /* CONFIG_IEEE80211W */
  1715. if (params->freq && wpa_driver_wext_set_freq(drv, params->freq) < 0)
  1716. ret = -1;
  1717. if (wpa_driver_wext_set_ssid(drv, params->ssid, params->ssid_len) < 0)
  1718. ret = -1;
  1719. if (params->bssid &&
  1720. wpa_driver_wext_set_bssid(drv, params->bssid) < 0)
  1721. ret = -1;
  1722. return ret;
  1723. }
  1724. static int wpa_driver_wext_set_auth_alg(void *priv, int auth_alg)
  1725. {
  1726. struct wpa_driver_wext_data *drv = priv;
  1727. int algs = 0, res;
  1728. if (auth_alg & AUTH_ALG_OPEN_SYSTEM)
  1729. algs |= IW_AUTH_ALG_OPEN_SYSTEM;
  1730. if (auth_alg & AUTH_ALG_SHARED_KEY)
  1731. algs |= IW_AUTH_ALG_SHARED_KEY;
  1732. if (auth_alg & AUTH_ALG_LEAP)
  1733. algs |= IW_AUTH_ALG_LEAP;
  1734. if (algs == 0) {
  1735. /* at least one algorithm should be set */
  1736. algs = IW_AUTH_ALG_OPEN_SYSTEM;
  1737. }
  1738. res = wpa_driver_wext_set_auth_param(drv, IW_AUTH_80211_AUTH_ALG,
  1739. algs);
  1740. drv->auth_alg_fallback = res == -2;
  1741. return res;
  1742. }
  1743. /**
  1744. * wpa_driver_wext_set_mode - Set wireless mode (infra/adhoc), SIOCSIWMODE
  1745. * @priv: Pointer to private wext data from wpa_driver_wext_init()
  1746. * @mode: 0 = infra/BSS (associate with an AP), 1 = adhoc/IBSS
  1747. * Returns: 0 on success, -1 on failure
  1748. */
  1749. int wpa_driver_wext_set_mode(void *priv, int mode)
  1750. {
  1751. struct wpa_driver_wext_data *drv = priv;
  1752. struct iwreq iwr;
  1753. int ret = -1, flags;
  1754. unsigned int new_mode = mode ? IW_MODE_ADHOC : IW_MODE_INFRA;
  1755. os_memset(&iwr, 0, sizeof(iwr));
  1756. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  1757. iwr.u.mode = new_mode;
  1758. if (ioctl(drv->ioctl_sock, SIOCSIWMODE, &iwr) == 0) {
  1759. ret = 0;
  1760. goto done;
  1761. }
  1762. if (errno != EBUSY) {
  1763. perror("ioctl[SIOCSIWMODE]");
  1764. goto done;
  1765. }
  1766. /* mac80211 doesn't allow mode changes while the device is up, so if
  1767. * the device isn't in the mode we're about to change to, take device
  1768. * down, try to set the mode again, and bring it back up.
  1769. */
  1770. if (ioctl(drv->ioctl_sock, SIOCGIWMODE, &iwr) < 0) {
  1771. perror("ioctl[SIOCGIWMODE]");
  1772. goto done;
  1773. }
  1774. if (iwr.u.mode == new_mode) {
  1775. ret = 0;
  1776. goto done;
  1777. }
  1778. if (wpa_driver_wext_get_ifflags(drv, &flags) == 0) {
  1779. (void) wpa_driver_wext_set_ifflags(drv, flags & ~IFF_UP);
  1780. /* Try to set the mode again while the interface is down */
  1781. iwr.u.mode = new_mode;
  1782. if (ioctl(drv->ioctl_sock, SIOCSIWMODE, &iwr) < 0)
  1783. perror("ioctl[SIOCSIWMODE]");
  1784. else
  1785. ret = 0;
  1786. /* Ignore return value of get_ifflags to ensure that the device
  1787. * is always up like it was before this function was called.
  1788. */
  1789. (void) wpa_driver_wext_get_ifflags(drv, &flags);
  1790. (void) wpa_driver_wext_set_ifflags(drv, flags | IFF_UP);
  1791. }
  1792. done:
  1793. return ret;
  1794. }
  1795. static int wpa_driver_wext_pmksa(struct wpa_driver_wext_data *drv,
  1796. u32 cmd, const u8 *bssid, const u8 *pmkid)
  1797. {
  1798. struct iwreq iwr;
  1799. struct iw_pmksa pmksa;
  1800. int ret = 0;
  1801. os_memset(&iwr, 0, sizeof(iwr));
  1802. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  1803. os_memset(&pmksa, 0, sizeof(pmksa));
  1804. pmksa.cmd = cmd;
  1805. pmksa.bssid.sa_family = ARPHRD_ETHER;
  1806. if (bssid)
  1807. os_memcpy(pmksa.bssid.sa_data, bssid, ETH_ALEN);
  1808. if (pmkid)
  1809. os_memcpy(pmksa.pmkid, pmkid, IW_PMKID_LEN);
  1810. iwr.u.data.pointer = (caddr_t) &pmksa;
  1811. iwr.u.data.length = sizeof(pmksa);
  1812. if (ioctl(drv->ioctl_sock, SIOCSIWPMKSA, &iwr) < 0) {
  1813. if (errno != EOPNOTSUPP)
  1814. perror("ioctl[SIOCSIWPMKSA]");
  1815. ret = -1;
  1816. }
  1817. return ret;
  1818. }
  1819. static int wpa_driver_wext_add_pmkid(void *priv, const u8 *bssid,
  1820. const u8 *pmkid)
  1821. {
  1822. struct wpa_driver_wext_data *drv = priv;
  1823. return wpa_driver_wext_pmksa(drv, IW_PMKSA_ADD, bssid, pmkid);
  1824. }
  1825. static int wpa_driver_wext_remove_pmkid(void *priv, const u8 *bssid,
  1826. const u8 *pmkid)
  1827. {
  1828. struct wpa_driver_wext_data *drv = priv;
  1829. return wpa_driver_wext_pmksa(drv, IW_PMKSA_REMOVE, bssid, pmkid);
  1830. }
  1831. static int wpa_driver_wext_flush_pmkid(void *priv)
  1832. {
  1833. struct wpa_driver_wext_data *drv = priv;
  1834. return wpa_driver_wext_pmksa(drv, IW_PMKSA_FLUSH, NULL, NULL);
  1835. }
  1836. int wpa_driver_wext_get_capa(void *priv, struct wpa_driver_capa *capa)
  1837. {
  1838. struct wpa_driver_wext_data *drv = priv;
  1839. if (!drv->has_capability)
  1840. return -1;
  1841. os_memcpy(capa, &drv->capa, sizeof(*capa));
  1842. return 0;
  1843. }
  1844. int wpa_driver_wext_alternative_ifindex(struct wpa_driver_wext_data *drv,
  1845. const char *ifname)
  1846. {
  1847. if (ifname == NULL) {
  1848. drv->ifindex2 = -1;
  1849. return 0;
  1850. }
  1851. drv->ifindex2 = if_nametoindex(ifname);
  1852. if (drv->ifindex2 <= 0)
  1853. return -1;
  1854. wpa_printf(MSG_DEBUG, "Added alternative ifindex %d (%s) for "
  1855. "wireless events", drv->ifindex2, ifname);
  1856. return 0;
  1857. }
  1858. int wpa_driver_wext_set_operstate(void *priv, int state)
  1859. {
  1860. struct wpa_driver_wext_data *drv = priv;
  1861. wpa_printf(MSG_DEBUG, "%s: operstate %d->%d (%s)",
  1862. __func__, drv->operstate, state, state ? "UP" : "DORMANT");
  1863. drv->operstate = state;
  1864. return netlink_send_oper_ifla(drv->netlink, drv->ifindex, -1,
  1865. state ? IF_OPER_UP : IF_OPER_DORMANT);
  1866. }
  1867. int wpa_driver_wext_get_version(struct wpa_driver_wext_data *drv)
  1868. {
  1869. return drv->we_version_compiled;
  1870. }
  1871. const struct wpa_driver_ops wpa_driver_wext_ops = {
  1872. .name = "wext",
  1873. .desc = "Linux wireless extensions (generic)",
  1874. .get_bssid = wpa_driver_wext_get_bssid,
  1875. .get_ssid = wpa_driver_wext_get_ssid,
  1876. .set_key = wpa_driver_wext_set_key,
  1877. .set_countermeasures = wpa_driver_wext_set_countermeasures,
  1878. .scan2 = wpa_driver_wext_scan,
  1879. .get_scan_results2 = wpa_driver_wext_get_scan_results,
  1880. .deauthenticate = wpa_driver_wext_deauthenticate,
  1881. .disassociate = wpa_driver_wext_disassociate,
  1882. .associate = wpa_driver_wext_associate,
  1883. .init = wpa_driver_wext_init,
  1884. .deinit = wpa_driver_wext_deinit,
  1885. .add_pmkid = wpa_driver_wext_add_pmkid,
  1886. .remove_pmkid = wpa_driver_wext_remove_pmkid,
  1887. .flush_pmkid = wpa_driver_wext_flush_pmkid,
  1888. .get_capa = wpa_driver_wext_get_capa,
  1889. .set_operstate = wpa_driver_wext_set_operstate,
  1890. };