driver_nl80211.c 53 KB

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