driver_prism54.c 36 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453
  1. /*
  2. * WPA Supplicant - driver interaction with Linux Prism54.org driver
  3. * Copyright (c) 2002-2007, Jouni Malinen <j@w1.fi>
  4. * Copyright (c) 2004, Luis R. Rodriguez <mcgrof@ruslug.rutgers.edu>
  5. * Copyright (c) 2004, Bell Kin <bell_kin@pek.com.tw>
  6. *
  7. * This program is free software; you can redistribute it and/or modify
  8. * it under the terms of the GNU General Public License version 2 as
  9. * published by the Free Software Foundation.
  10. *
  11. * Alternatively, this software may be distributed under the terms of BSD
  12. * license.
  13. *
  14. * See README and COPYING for more details.
  15. */
  16. #include "includes.h"
  17. #include <sys/ioctl.h>
  18. #include "wireless_copy.h"
  19. #include "common.h"
  20. #include "driver.h"
  21. #include "driver_wext.h"
  22. #include "driver_hostap.h"
  23. #ifdef HOSTAPD
  24. #include <net/if_arp.h>
  25. #include <netpacket/packet.h>
  26. #include "driver.h"
  27. #include "eloop.h"
  28. #include "prism54.h"
  29. #include "radius/radius.h"
  30. #include "../../hostapd/hostapd.h"
  31. #include "../../hostapd/config.h"
  32. #include "../../hostapd/ieee802_1x.h"
  33. #include "../../hostapd/ieee802_11.h"
  34. #include "../../hostapd/wpa.h"
  35. #include "../../hostapd/sta_info.h"
  36. #include "../../hostapd/accounting.h"
  37. const int PIM_BUF_SIZE = 4096;
  38. struct prism54_driver_data {
  39. struct hostapd_data *hapd;
  40. char iface[IFNAMSIZ + 1];
  41. int sock; /* raw packet socket for 802.3 access */
  42. int pim_sock; /* socket for pimfor packet */
  43. char macs[2007][6];
  44. };
  45. static int mac_id_refresh(struct prism54_driver_data *data, int id, char *mac)
  46. {
  47. if (id < 0 || id > 2006) {
  48. return -1;
  49. }
  50. memcpy(&data->macs[id][0], mac, ETH_ALEN);
  51. return 0;
  52. }
  53. static char * mac_id_get(struct prism54_driver_data *data, int id)
  54. {
  55. if (id < 0 || id > 2006) {
  56. return NULL;
  57. }
  58. return &data->macs[id][0];
  59. }
  60. /* wait for a specific pimfor, timeout in 10ms resolution */
  61. /* pim_sock must be non-block to prevent dead lock from no response */
  62. /* or same response type in series */
  63. static int prism54_waitpim(void *priv, unsigned long oid, void *buf, int len,
  64. int timeout)
  65. {
  66. struct prism54_driver_data *drv = priv;
  67. struct timeval tv, stv, ctv;
  68. fd_set pfd;
  69. int rlen;
  70. pimdev_hdr *pkt;
  71. pkt = malloc(8192);
  72. if (pkt == NULL)
  73. return -1;
  74. FD_ZERO(&pfd);
  75. gettimeofday(&stv, NULL);
  76. do {
  77. FD_SET(drv->pim_sock, &pfd);
  78. tv.tv_sec = 0;
  79. tv.tv_usec = 10000;
  80. if (select(drv->pim_sock + 1, &pfd, NULL, NULL, &tv)) {
  81. rlen = recv(drv->pim_sock, pkt, 8192, 0);
  82. if (rlen > 0) {
  83. if (pkt->oid == htonl(oid)) {
  84. if (rlen <= len) {
  85. if (buf != NULL) {
  86. memcpy(buf, pkt, rlen);
  87. }
  88. free(pkt);
  89. return rlen;
  90. } else {
  91. printf("buffer too small\n");
  92. free(pkt);
  93. return -1;
  94. }
  95. } else {
  96. gettimeofday(&ctv, NULL);
  97. continue;
  98. }
  99. }
  100. }
  101. gettimeofday(&ctv, NULL);
  102. } while (((ctv.tv_sec - stv.tv_sec) * 100 +
  103. (ctv.tv_usec - stv.tv_usec) / 10000) > timeout);
  104. free(pkt);
  105. return 0;
  106. }
  107. /* send an eapol packet */
  108. static int prism54_send_eapol(void *priv, const u8 *addr,
  109. const u8 *data, size_t data_len, int encrypt,
  110. const u8 *own_addr)
  111. {
  112. struct prism54_driver_data *drv = priv;
  113. ieee802_3_hdr *hdr;
  114. size_t len;
  115. u8 *pos;
  116. int res;
  117. len = sizeof(*hdr) + data_len;
  118. hdr = os_zalloc(len);
  119. if (hdr == NULL) {
  120. printf("malloc() failed for prism54_send_data(len=%lu)\n",
  121. (unsigned long) len);
  122. return -1;
  123. }
  124. memcpy(&hdr->da[0], addr, ETH_ALEN);
  125. memcpy(&hdr->sa[0], own_addr, ETH_ALEN);
  126. hdr->type = htons(ETH_P_PAE);
  127. pos = (u8 *) (hdr + 1);
  128. memcpy(pos, data, data_len);
  129. res = send(drv->sock, hdr, len, 0);
  130. free(hdr);
  131. if (res < 0) {
  132. perror("hostapd_send_eapol: send");
  133. printf("hostapd_send_eapol - packet len: %lu - failed\n",
  134. (unsigned long) len);
  135. }
  136. return res;
  137. }
  138. /* open data channel(auth-1) or eapol only(unauth-0) */
  139. static int prism54_set_sta_authorized(void *priv, const u8 *addr,
  140. int authorized)
  141. {
  142. struct prism54_driver_data *drv = priv;
  143. pimdev_hdr *hdr;
  144. char *pos;
  145. hdr = malloc(sizeof(*hdr) + ETH_ALEN);
  146. if (hdr == NULL)
  147. return -1;
  148. hdr->op = htonl(PIMOP_SET);
  149. if (authorized) {
  150. hdr->oid = htonl(DOT11_OID_EAPAUTHSTA);
  151. } else {
  152. hdr->oid = htonl(DOT11_OID_EAPUNAUTHSTA);
  153. }
  154. pos = (char *) (hdr + 1);
  155. memcpy(pos, addr, ETH_ALEN);
  156. send(drv->pim_sock, hdr, sizeof(*hdr) + ETH_ALEN, 0);
  157. prism54_waitpim(priv, hdr->oid, hdr, sizeof(*hdr) + ETH_ALEN, 10);
  158. free(hdr);
  159. return 0;
  160. }
  161. static int
  162. prism54_sta_set_flags(void *priv, const u8 *addr, int total_flags,
  163. int flags_or, int flags_and)
  164. {
  165. /* For now, only support setting Authorized flag */
  166. if (flags_or & WLAN_STA_AUTHORIZED)
  167. return prism54_set_sta_authorized(priv, addr, 1);
  168. if (flags_and & WLAN_STA_AUTHORIZED)
  169. return prism54_set_sta_authorized(priv, addr, 0);
  170. return 0;
  171. }
  172. static int prism54_set_key(const char *ifname, void *priv, wpa_alg alg,
  173. const u8 *addr, int key_idx, int set_tx,
  174. const u8 *seq, size_t seq_len,
  175. const u8 *key, size_t key_len)
  176. {
  177. struct prism54_driver_data *drv = priv;
  178. pimdev_hdr *hdr;
  179. struct obj_stakey *keys;
  180. u8 *buf;
  181. size_t blen;
  182. int ret = 0;
  183. blen = sizeof(struct obj_stakey) + sizeof(pimdev_hdr);
  184. hdr = malloc(blen);
  185. if (hdr == NULL) {
  186. printf("memory low\n");
  187. return -1;
  188. }
  189. keys = (struct obj_stakey *) &hdr[1];
  190. if (!addr) {
  191. memset(&keys->address[0], 0xff, ETH_ALEN);
  192. } else {
  193. memcpy(&keys->address[0], addr, ETH_ALEN);
  194. }
  195. switch (alg) {
  196. case WPA_ALG_WEP:
  197. keys->type = DOT11_PRIV_WEP;
  198. break;
  199. case WPA_ALG_TKIP:
  200. keys->type = DOT11_PRIV_TKIP;
  201. break;
  202. case WPA_ALG_NONE:
  203. /* the only way to clear the key is to deauth it */
  204. /* and prism54 is capable to receive unencrypted packet */
  205. /* so we do nothing here */
  206. free(hdr);
  207. return 0;
  208. default:
  209. printf("bad auth type: %d\n", alg);
  210. free(hdr);
  211. return -1;
  212. }
  213. buf = (u8 *) &keys->key[0];
  214. keys->length = key_len;
  215. keys->keyid = key_idx;
  216. keys->options = htons(DOT11_STAKEY_OPTION_DEFAULTKEY);
  217. keys->reserved = 0;
  218. hdr->op = htonl(PIMOP_SET);
  219. hdr->oid = htonl(DOT11_OID_STAKEY);
  220. memcpy(buf, key, key_len);
  221. ret = send(drv->pim_sock, hdr, blen, 0);
  222. if (ret < 0) {
  223. free(hdr);
  224. return ret;
  225. }
  226. prism54_waitpim(priv, hdr->oid, hdr, blen, 10);
  227. free(hdr);
  228. return 0;
  229. }
  230. /* get TKIP station sequence counter, prism54 is only 6 bytes */
  231. static int prism54_get_seqnum(const char *ifname, void *priv, const u8 *addr,
  232. int idx, u8 *seq)
  233. {
  234. struct prism54_driver_data *drv = priv;
  235. struct obj_stasc *stasc;
  236. pimdev_hdr *hdr;
  237. size_t blen;
  238. int ret = 0;
  239. blen = sizeof(*stasc) + sizeof(*hdr);
  240. hdr = malloc(blen);
  241. if (hdr == NULL)
  242. return -1;
  243. stasc = (struct obj_stasc *) &hdr[1];
  244. if (addr == NULL)
  245. memset(&stasc->address[0], 0xff, ETH_ALEN);
  246. else
  247. memcpy(&stasc->address[0], addr, ETH_ALEN);
  248. hdr->oid = htonl(DOT11_OID_STASC);
  249. hdr->op = htonl(PIMOP_GET);
  250. stasc->keyid = idx;
  251. if (send(drv->pim_sock,hdr,blen,0) <= 0) {
  252. free(hdr);
  253. return -1;
  254. }
  255. if (prism54_waitpim(priv, DOT11_OID_STASC, hdr, blen, 10) <= 0) {
  256. ret = -1;
  257. } else {
  258. if (hdr->op == (int) htonl(PIMOP_RESPONSE)) {
  259. memcpy(seq + 2, &stasc->sc_high, ETH_ALEN);
  260. memset(seq, 0, 2);
  261. } else {
  262. ret = -1;
  263. }
  264. }
  265. free(hdr);
  266. return ret;
  267. }
  268. /* include unencrypted, set mlme autolevel to extended */
  269. static int prism54_init_1x(void *priv)
  270. {
  271. struct prism54_driver_data *drv = priv;
  272. pimdev_hdr *hdr;
  273. unsigned long *ul;
  274. int blen = sizeof(*hdr) + sizeof(*ul);
  275. hdr = malloc(blen);
  276. if (hdr == NULL)
  277. return -1;
  278. ul = (unsigned long *) &hdr[1];
  279. hdr->op = htonl(PIMOP_SET);
  280. hdr->oid = htonl(DOT11_OID_EXUNENCRYPTED);
  281. *ul = htonl(DOT11_BOOL_TRUE); /* not accept */
  282. send(drv->pim_sock, hdr, blen, 0);
  283. prism54_waitpim(priv, DOT11_OID_EXUNENCRYPTED, hdr, blen, 10);
  284. hdr->op = htonl(PIMOP_SET);
  285. hdr->oid = htonl(DOT11_OID_MLMEAUTOLEVEL);
  286. *ul = htonl(DOT11_MLME_EXTENDED);
  287. send(drv->pim_sock, hdr, blen, 0);
  288. prism54_waitpim(priv, DOT11_OID_MLMEAUTOLEVEL, hdr, blen, 10);
  289. hdr->op = htonl(PIMOP_SET);
  290. hdr->oid = htonl(DOT11_OID_DOT1XENABLE);
  291. *ul = htonl(DOT11_BOOL_TRUE);
  292. send(drv->pim_sock, hdr, blen, 0);
  293. prism54_waitpim(priv, DOT11_OID_DOT1XENABLE, hdr, blen, 10);
  294. hdr->op = htonl(PIMOP_SET);
  295. hdr->oid = htonl(DOT11_OID_AUTHENABLE);
  296. *ul = htonl(DOT11_AUTH_OS); /* OS */
  297. send(drv->pim_sock, hdr, blen, 0);
  298. prism54_waitpim(priv, DOT11_OID_AUTHENABLE, hdr, blen, 10);
  299. free(hdr);
  300. return 0;
  301. }
  302. static int prism54_set_privacy_invoked(const char *ifname, void *priv,
  303. int flag)
  304. {
  305. struct prism54_driver_data *drv = priv;
  306. pimdev_hdr *hdr;
  307. unsigned long *ul;
  308. int ret;
  309. int blen = sizeof(*hdr) + sizeof(*ul);
  310. hdr = malloc(blen);
  311. if (hdr == NULL)
  312. return -1;
  313. ul = (unsigned long *) &hdr[1];
  314. hdr->op = htonl(PIMOP_SET);
  315. hdr->oid = htonl(DOT11_OID_PRIVACYINVOKED);
  316. if (flag) {
  317. *ul = htonl(DOT11_BOOL_TRUE); /* has privacy */
  318. } else {
  319. *ul = 0;
  320. }
  321. ret = send(drv->pim_sock, hdr, blen, 0);
  322. if (ret >= 0) {
  323. ret = prism54_waitpim(priv, DOT11_OID_PRIVACYINVOKED, hdr,
  324. blen, 10);
  325. }
  326. free(hdr);
  327. return ret;
  328. }
  329. static int prism54_ioctl_setiwessid(const char *ifname, void *priv,
  330. const u8 *buf, int len)
  331. {
  332. #if 0
  333. struct prism54_driver_data *drv = priv;
  334. struct iwreq iwr;
  335. memset(&iwr, 0, sizeof(iwr));
  336. os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ);
  337. iwr.u.essid.flags = 1; /* SSID active */
  338. iwr.u.essid.pointer = (caddr_t) buf;
  339. iwr.u.essid.length = len + 1;
  340. if (ioctl(drv->pim_sock, SIOCSIWESSID, &iwr) < 0) {
  341. perror("ioctl[SIOCSIWESSID]");
  342. printf("len=%d\n", len);
  343. return -1;
  344. }
  345. #endif
  346. return 0;
  347. }
  348. /* kick all stations */
  349. /* does not work during init, but at least it won't crash firmware */
  350. static int prism54_flush(void *priv)
  351. {
  352. struct prism54_driver_data *drv = priv;
  353. struct obj_mlmeex *mlme;
  354. pimdev_hdr *hdr;
  355. int ret;
  356. unsigned int i;
  357. long *nsta;
  358. int blen = sizeof(*hdr) + sizeof(*mlme);
  359. char *mac_id;
  360. hdr = os_zalloc(blen);
  361. if (hdr == NULL)
  362. return -1;
  363. mlme = (struct obj_mlmeex *) &hdr[1];
  364. nsta = (long *) &hdr[1];
  365. hdr->op = htonl(PIMOP_GET);
  366. hdr->oid = htonl(DOT11_OID_CLIENTS);
  367. ret = send(drv->pim_sock, hdr, sizeof(*hdr) + sizeof(long), 0);
  368. ret = prism54_waitpim(priv, DOT11_OID_CLIENTS, hdr, blen, 10);
  369. if ((ret < 0) || (hdr->op != (int) htonl(PIMOP_RESPONSE)) ||
  370. (le_to_host32(*nsta) > 2007)) {
  371. free(hdr);
  372. return 0;
  373. }
  374. for (i = 0; i < le_to_host32(*nsta); i++) {
  375. mlme->id = -1;
  376. mac_id = mac_id_get(drv, i);
  377. if (mac_id)
  378. memcpy(&mlme->address[0], mac_id, ETH_ALEN);
  379. mlme->code = host_to_le16(WLAN_REASON_UNSPECIFIED);
  380. mlme->state = htons(DOT11_STATE_NONE);
  381. mlme->size = 0;
  382. hdr->op = htonl(PIMOP_SET);
  383. hdr->oid = htonl(DOT11_OID_DISASSOCIATEEX);
  384. ret = send(drv->pim_sock, hdr, blen, 0);
  385. prism54_waitpim(priv, DOT11_OID_DISASSOCIATEEX, hdr, blen,
  386. 100);
  387. }
  388. for (i = 0; i < le_to_host32(*nsta); i++) {
  389. mlme->id = -1;
  390. mac_id = mac_id_get(drv, i);
  391. if (mac_id)
  392. memcpy(&mlme->address[0], mac_id, ETH_ALEN);
  393. mlme->code = host_to_le16(WLAN_REASON_UNSPECIFIED);
  394. mlme->state = htons(DOT11_STATE_NONE);
  395. mlme->size = 0;
  396. hdr->op = htonl(PIMOP_SET);
  397. hdr->oid = htonl(DOT11_OID_DEAUTHENTICATEEX);
  398. ret = send(drv->pim_sock, hdr, blen, 0);
  399. prism54_waitpim(priv, DOT11_OID_DEAUTHENTICATEEX, hdr, blen,
  400. 100);
  401. }
  402. free(hdr);
  403. return 0;
  404. }
  405. static int prism54_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr,
  406. int reason)
  407. {
  408. struct prism54_driver_data *drv = priv;
  409. pimdev_hdr *hdr;
  410. struct obj_mlmeex *mlme;
  411. int ret;
  412. int blen = sizeof(*hdr) + sizeof(*mlme);
  413. hdr = malloc(blen);
  414. if (hdr == NULL)
  415. return -1;
  416. mlme = (struct obj_mlmeex *) &hdr[1];
  417. hdr->op = htonl(PIMOP_SET);
  418. hdr->oid = htonl(DOT11_OID_DEAUTHENTICATEEX);
  419. memcpy(&mlme->address[0], addr, ETH_ALEN);
  420. mlme->id = -1;
  421. mlme->state = htons(DOT11_STATE_NONE);
  422. mlme->code = host_to_le16(reason);
  423. mlme->size = 0;
  424. ret = send(drv->pim_sock, hdr, blen, 0);
  425. prism54_waitpim(priv, DOT11_OID_DEAUTHENTICATEEX, hdr, blen, 10);
  426. free(hdr);
  427. return ret;
  428. }
  429. static int prism54_sta_disassoc(void *priv, const u8 *own_addr, const u8 *addr,
  430. int reason)
  431. {
  432. struct prism54_driver_data *drv = priv;
  433. pimdev_hdr *hdr;
  434. struct obj_mlmeex *mlme;
  435. int ret;
  436. int blen = sizeof(*hdr) + sizeof(*mlme);
  437. hdr = malloc(blen);
  438. if (hdr == NULL)
  439. return -1;
  440. mlme = (struct obj_mlmeex *) &hdr[1];
  441. hdr->op = htonl(PIMOP_SET);
  442. hdr->oid = htonl(DOT11_OID_DISASSOCIATEEX);
  443. memcpy(&mlme->address[0], addr, ETH_ALEN);
  444. mlme->id = -1;
  445. mlme->state = htons(DOT11_STATE_NONE);
  446. mlme->code = host_to_le16(reason);
  447. mlme->size = 0;
  448. ret = send(drv->pim_sock, hdr, blen, 0);
  449. prism54_waitpim(priv, DOT11_OID_DISASSOCIATEEX, hdr, blen, 10);
  450. free(hdr);
  451. return ret;
  452. }
  453. static int prism54_get_inact_sec(void *priv, const u8 *addr)
  454. {
  455. struct prism54_driver_data *drv = priv;
  456. pimdev_hdr *hdr;
  457. struct obj_sta *sta;
  458. int blen = sizeof(*hdr) + sizeof(*sta);
  459. int ret;
  460. hdr = malloc(blen);
  461. if (hdr == NULL)
  462. return -1;
  463. hdr->op = htonl(PIMOP_GET);
  464. hdr->oid = htonl(DOT11_OID_CLIENTFIND);
  465. sta = (struct obj_sta *) &hdr[1];
  466. memcpy(&sta->address[0], addr, ETH_ALEN);
  467. ret = send(drv->pim_sock, hdr, blen, 0);
  468. ret = prism54_waitpim(priv, DOT11_OID_CLIENTFIND, hdr, blen, 10);
  469. if (ret != blen) {
  470. printf("get_inact_sec: bad return %d\n", ret);
  471. free(hdr);
  472. return -1;
  473. }
  474. if (hdr->op != (int) htonl(PIMOP_RESPONSE)) {
  475. printf("get_inact_sec: bad resp\n");
  476. free(hdr);
  477. return -1;
  478. }
  479. free(hdr);
  480. return le_to_host16(sta->age);
  481. }
  482. /* set attachments */
  483. static int prism54_set_generic_elem(const char *ifname, void *priv,
  484. const u8 *elem, size_t elem_len)
  485. {
  486. struct prism54_driver_data *drv = priv;
  487. pimdev_hdr *hdr;
  488. char *pos;
  489. struct obj_attachment_hdr *attach;
  490. size_t blen = sizeof(*hdr) + sizeof(*attach) + elem_len;
  491. hdr = os_zalloc(blen);
  492. if (hdr == NULL) {
  493. printf("%s: memory low\n", __func__);
  494. return -1;
  495. }
  496. hdr->op = htonl(PIMOP_SET);
  497. hdr->oid = htonl(DOT11_OID_ATTACHMENT);
  498. attach = (struct obj_attachment_hdr *)&hdr[1];
  499. attach->type = DOT11_PKT_BEACON;
  500. attach->id = -1;
  501. attach->size = host_to_le16((short)elem_len);
  502. pos = ((char*) attach) + sizeof(*attach);
  503. if (elem)
  504. memcpy(pos, elem, elem_len);
  505. send(drv->pim_sock, hdr, blen, 0);
  506. attach->type = DOT11_PKT_PROBE_RESP;
  507. send(drv->pim_sock, hdr, blen, 0);
  508. free(hdr);
  509. return 0;
  510. }
  511. /* tell the card to auth the sta */
  512. static void prism54_handle_probe(struct prism54_driver_data *drv,
  513. void *buf, size_t len)
  514. {
  515. struct obj_mlmeex *mlme;
  516. pimdev_hdr *hdr;
  517. struct sta_info *sta;
  518. hdr = (pimdev_hdr *)buf;
  519. mlme = (struct obj_mlmeex *) &hdr[1];
  520. sta = ap_get_sta(drv->hapd, (u8 *) &mlme->address[0]);
  521. if (sta != NULL) {
  522. if (sta->flags & (WLAN_STA_AUTH | WLAN_STA_ASSOC))
  523. return;
  524. }
  525. if (len < sizeof(*mlme)) {
  526. printf("bad probe packet\n");
  527. return;
  528. }
  529. mlme->state = htons(DOT11_STATE_AUTHING);
  530. mlme->code = 0;
  531. hdr->op = htonl(PIMOP_SET);
  532. hdr->oid = htonl(DOT11_OID_AUTHENTICATEEX);
  533. mlme->size = 0;
  534. send(drv->pim_sock, hdr, sizeof(*hdr)+sizeof(*mlme), 0);
  535. }
  536. static void prism54_handle_deauth(struct prism54_driver_data *drv,
  537. void *buf, size_t len)
  538. {
  539. struct obj_mlme *mlme;
  540. pimdev_hdr *hdr;
  541. struct sta_info *sta;
  542. char *mac_id;
  543. hdr = (pimdev_hdr *) buf;
  544. mlme = (struct obj_mlme *) &hdr[1];
  545. sta = ap_get_sta(drv->hapd, (u8 *) &mlme->address[0]);
  546. mac_id = mac_id_get(drv, mlme->id);
  547. if (sta == NULL || mac_id == NULL)
  548. return;
  549. memcpy(&mlme->address[0], mac_id, ETH_ALEN);
  550. sta->flags &= ~(WLAN_STA_AUTH | WLAN_STA_ASSOC);
  551. wpa_auth_sm_event(sta->wpa_sm, WPA_DEAUTH);
  552. sta->acct_terminate_cause = RADIUS_ACCT_TERMINATE_CAUSE_USER_REQUEST;
  553. ieee802_1x_notify_port_enabled(sta->eapol_sm, 0);
  554. ap_free_sta(drv->hapd, sta);
  555. }
  556. static void prism54_handle_disassoc(struct prism54_driver_data *drv,
  557. void *buf, size_t len)
  558. {
  559. struct obj_mlme *mlme;
  560. pimdev_hdr *hdr;
  561. struct sta_info *sta;
  562. char *mac_id;
  563. hdr = (pimdev_hdr *) buf;
  564. mlme = (struct obj_mlme *) &hdr[1];
  565. mac_id = mac_id_get(drv, mlme->id);
  566. if (mac_id == NULL)
  567. return;
  568. memcpy(&mlme->address[0], mac_id, ETH_ALEN);
  569. sta = ap_get_sta(drv->hapd, (u8 *) &mlme->address[0]);
  570. if (sta == NULL) {
  571. return;
  572. }
  573. sta->flags &= ~WLAN_STA_ASSOC;
  574. wpa_auth_sm_event(sta->wpa_sm, WPA_DISASSOC);
  575. sta->acct_terminate_cause = RADIUS_ACCT_TERMINATE_CAUSE_USER_REQUEST;
  576. ieee802_1x_notify_port_enabled(sta->eapol_sm, 0);
  577. accounting_sta_stop(drv->hapd, sta);
  578. ieee802_1x_free_station(sta);
  579. }
  580. /* to auth it, just allow it now, later for os/sk */
  581. static void prism54_handle_auth(struct prism54_driver_data *drv,
  582. void *buf, size_t len)
  583. {
  584. struct obj_mlmeex *mlme;
  585. pimdev_hdr *hdr;
  586. struct sta_info *sta;
  587. int resp;
  588. hdr = (pimdev_hdr *) buf;
  589. mlme = (struct obj_mlmeex *) &hdr[1];
  590. if (len < sizeof(*mlme)) {
  591. printf("bad auth packet\n");
  592. return;
  593. }
  594. if (mlme->state == htons(DOT11_STATE_AUTHING)) {
  595. sta = ap_sta_add(drv->hapd, (u8 *) &mlme->address[0]);
  596. if (drv->hapd->tkip_countermeasures) {
  597. resp = WLAN_REASON_MICHAEL_MIC_FAILURE;
  598. goto fail;
  599. }
  600. mac_id_refresh(drv, mlme->id, &mlme->address[0]);
  601. if (!sta) {
  602. resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
  603. goto fail;
  604. }
  605. sta->flags &= ~WLAN_STA_PREAUTH;
  606. ieee802_1x_notify_pre_auth(sta->eapol_sm, 0);
  607. sta->flags |= WLAN_STA_AUTH;
  608. wpa_auth_sm_event(sta->wpa_sm, WPA_AUTH);
  609. mlme->code = 0;
  610. mlme->state=htons(DOT11_STATE_AUTH);
  611. hdr->op = htonl(PIMOP_SET);
  612. hdr->oid = htonl(DOT11_OID_AUTHENTICATEEX);
  613. mlme->size = 0;
  614. sta->timeout_next = STA_NULLFUNC;
  615. send(drv->pim_sock, hdr, sizeof(*hdr) + sizeof(*mlme), 0);
  616. }
  617. return;
  618. fail:
  619. printf("auth fail: %x\n", resp);
  620. mlme->code = host_to_le16(resp);
  621. mlme->size = 0;
  622. if (sta)
  623. sta->flags &= ~(WLAN_STA_AUTH | WLAN_STA_ASSOC);
  624. hdr->oid = htonl(DOT11_OID_DEAUTHENTICATEEX);
  625. hdr->op = htonl(PIMOP_SET);
  626. send(drv->pim_sock, hdr, sizeof(*hdr)+sizeof(*mlme), 0);
  627. }
  628. /* do the wpa thing */
  629. static void prism54_handle_assoc(struct prism54_driver_data *drv,
  630. void *buf, size_t len)
  631. {
  632. pimdev_hdr *hdr;
  633. struct obj_mlmeex *mlme;
  634. struct ieee802_11_elems elems;
  635. struct sta_info *sta;
  636. u8 *wpa_ie;
  637. u8 *cb;
  638. int ieofs = 0;
  639. size_t wpa_ie_len;
  640. int resp, new_assoc;
  641. char *mac_id;
  642. resp = 0;
  643. hdr = (pimdev_hdr *) buf;
  644. mlme = (struct obj_mlmeex *) &hdr[1];
  645. switch (ntohl(hdr->oid)) {
  646. case DOT11_OID_ASSOCIATE:
  647. case DOT11_OID_REASSOCIATE:
  648. mlme->size = 0;
  649. default:
  650. break;
  651. }
  652. if ((mlme->state == (int) htonl(DOT11_STATE_ASSOCING)) ||
  653. (mlme->state == (int) htonl(DOT11_STATE_REASSOCING))) {
  654. if (len < sizeof(pimdev_hdr) + sizeof(struct obj_mlme)) {
  655. printf("bad assoc packet\n");
  656. return;
  657. }
  658. mac_id = mac_id_get(drv, mlme->id);
  659. if (mac_id == NULL)
  660. return;
  661. memcpy(&mlme->address[0], mac_id, ETH_ALEN);
  662. sta = ap_get_sta(drv->hapd, (u8 *) &mlme->address[0]);
  663. if (sta == NULL) {
  664. printf("cannot get sta\n");
  665. return;
  666. }
  667. cb = (u8 *) &mlme->data[0];
  668. if (hdr->oid == htonl(DOT11_OID_ASSOCIATEEX)) {
  669. ieofs = 4;
  670. } else if (hdr->oid == htonl(DOT11_OID_REASSOCIATEEX)) {
  671. ieofs = 10;
  672. }
  673. if (le_to_host16(mlme->size) <= ieofs) {
  674. printf("attach too small\n");
  675. resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
  676. goto fail;
  677. }
  678. if (ieee802_11_parse_elems(cb + ieofs,
  679. le_to_host16(mlme->size) - ieofs,
  680. &elems, 1) == ParseFailed) {
  681. printf("STA " MACSTR " sent invalid association "
  682. "request\n", MAC2STR(sta->addr));
  683. resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
  684. goto fail;
  685. }
  686. if ((drv->hapd->conf->wpa & WPA_PROTO_RSN) &&
  687. elems.rsn_ie) {
  688. wpa_ie = elems.rsn_ie;
  689. wpa_ie_len = elems.rsn_ie_len;
  690. } else if ((drv->hapd->conf->wpa & WPA_PROTO_WPA) &&
  691. elems.wpa_ie) {
  692. wpa_ie = elems.wpa_ie;
  693. wpa_ie_len = elems.wpa_ie_len;
  694. } else {
  695. wpa_ie = NULL;
  696. wpa_ie_len = 0;
  697. }
  698. if (drv->hapd->conf->wpa && wpa_ie == NULL) {
  699. printf("STA " MACSTR ": No WPA/RSN IE in association "
  700. "request\n", MAC2STR(sta->addr));
  701. resp = WLAN_STATUS_INVALID_IE;
  702. goto fail;
  703. }
  704. if (drv->hapd->conf->wpa) {
  705. int res;
  706. wpa_ie -= 2;
  707. wpa_ie_len += 2;
  708. if (sta->wpa_sm == NULL)
  709. sta->wpa_sm = wpa_auth_sta_init(
  710. drv->hapd->wpa_auth, sta->addr);
  711. if (sta->wpa_sm == NULL) {
  712. printf("Failed to initialize WPA state "
  713. "machine\n");
  714. resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
  715. goto fail;
  716. }
  717. res = wpa_validate_wpa_ie(drv->hapd->wpa_auth,
  718. sta->wpa_sm,
  719. wpa_ie, wpa_ie_len,
  720. NULL, 0);
  721. if (res == WPA_INVALID_GROUP)
  722. resp = WLAN_STATUS_GROUP_CIPHER_NOT_VALID;
  723. else if (res == WPA_INVALID_PAIRWISE)
  724. resp = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID;
  725. else if (res == WPA_INVALID_AKMP)
  726. resp = WLAN_STATUS_AKMP_NOT_VALID;
  727. else if (res == WPA_ALLOC_FAIL)
  728. resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
  729. else if (res != WPA_IE_OK)
  730. resp = WLAN_STATUS_INVALID_IE;
  731. if (resp != WLAN_STATUS_SUCCESS)
  732. goto fail;
  733. }
  734. hdr->oid = (hdr->oid == htonl(DOT11_OID_ASSOCIATEEX)) ?
  735. htonl(DOT11_OID_ASSOCIATEEX) :
  736. htonl(DOT11_OID_REASSOCIATEEX);
  737. hdr->op = htonl(PIMOP_SET);
  738. mlme->code = 0;
  739. mlme->state = htons(DOT11_STATE_ASSOC);
  740. mlme->size = 0;
  741. send(drv->pim_sock, hdr, sizeof(*hdr) + sizeof(*mlme), 0);
  742. return;
  743. } else if (mlme->state==htons(DOT11_STATE_ASSOC)) {
  744. if (len < sizeof(pimdev_hdr) + sizeof(struct obj_mlme)) {
  745. printf("bad assoc packet\n");
  746. return;
  747. }
  748. mac_id = mac_id_get(drv, mlme->id);
  749. if (mac_id == NULL)
  750. return;
  751. memcpy(&mlme->address[0], mac_id, ETH_ALEN);
  752. sta = ap_get_sta(drv->hapd, (u8 *) &mlme->address[0]);
  753. if (sta == NULL) {
  754. printf("cannot get sta\n");
  755. return;
  756. }
  757. new_assoc = (sta->flags & WLAN_STA_ASSOC) == 0;
  758. sta->flags |= WLAN_STA_AUTH | WLAN_STA_ASSOC;
  759. wpa_auth_sm_event(sta->wpa_sm, WPA_ASSOC);
  760. hostapd_new_assoc_sta(drv->hapd, sta, !new_assoc);
  761. ieee802_1x_notify_port_enabled(sta->eapol_sm, 1);
  762. sta->timeout_next = STA_NULLFUNC;
  763. return;
  764. }
  765. return;
  766. fail:
  767. printf("Prism54: assoc fail: %x\n", resp);
  768. mlme->code = host_to_le16(resp);
  769. mlme->size = 0;
  770. mlme->state = htons(DOT11_STATE_ASSOCING);
  771. hdr->oid = htonl(DOT11_OID_DISASSOCIATEEX);
  772. hdr->op = htonl(PIMOP_SET);
  773. sta->flags &= ~(WLAN_STA_AUTH | WLAN_STA_ASSOC);
  774. send(drv->pim_sock, hdr, sizeof(*hdr) + sizeof(*mlme), 0);
  775. }
  776. static void handle_pim(int sock, void *eloop_ctx, void *sock_ctx)
  777. {
  778. struct prism54_driver_data *drv = eloop_ctx;
  779. int len;
  780. pimdev_hdr *hdr;
  781. hdr = malloc(PIM_BUF_SIZE);
  782. if (hdr == NULL)
  783. return;
  784. len = recv(sock, hdr, PIM_BUF_SIZE, 0);
  785. if (len < 0) {
  786. perror("recv");
  787. free(hdr);
  788. return;
  789. }
  790. if (len < 8) {
  791. printf("handle_pim: too short (%d)\n", len);
  792. free(hdr);
  793. return;
  794. }
  795. if (hdr->op != (int) htonl(PIMOP_TRAP)) {
  796. free(hdr);
  797. return;
  798. }
  799. switch (ntohl(hdr->oid)) {
  800. case DOT11_OID_PROBE:
  801. prism54_handle_probe(drv, hdr, len);
  802. break;
  803. case DOT11_OID_DEAUTHENTICATEEX:
  804. case DOT11_OID_DEAUTHENTICATE:
  805. prism54_handle_deauth(drv, hdr, len);
  806. break;
  807. case DOT11_OID_DISASSOCIATEEX:
  808. case DOT11_OID_DISASSOCIATE:
  809. prism54_handle_disassoc(drv, hdr, len);
  810. break;
  811. case DOT11_OID_AUTHENTICATEEX:
  812. case DOT11_OID_AUTHENTICATE:
  813. prism54_handle_auth(drv, hdr, len);
  814. break;
  815. case DOT11_OID_ASSOCIATEEX:
  816. case DOT11_OID_REASSOCIATEEX:
  817. case DOT11_OID_ASSOCIATE:
  818. case DOT11_OID_REASSOCIATE:
  819. prism54_handle_assoc(drv, hdr, len);
  820. default:
  821. break;
  822. }
  823. free(hdr);
  824. }
  825. static void handle_802_3(int sock, void *eloop_ctx, void *sock_ctx)
  826. {
  827. struct hostapd_data *hapd = (struct hostapd_data *) eloop_ctx;
  828. int len;
  829. ieee802_3_hdr *hdr;
  830. hdr = malloc(PIM_BUF_SIZE);
  831. if (hdr == NULL)
  832. return;
  833. len = recv(sock, hdr, PIM_BUF_SIZE, 0);
  834. if (len < 0) {
  835. perror("recv");
  836. free(hdr);
  837. return;
  838. }
  839. if (len < 14) {
  840. wpa_printf(MSG_MSGDUMP, "handle_802_3: too short (%d)", len);
  841. free(hdr);
  842. return;
  843. }
  844. if (hdr->type == htons(ETH_P_PAE)) {
  845. hostapd_eapol_receive(hapd, (u8 *) &hdr->sa[0], (u8 *) &hdr[1],
  846. len - sizeof(*hdr));
  847. }
  848. free(hdr);
  849. }
  850. static int prism54_init_sockets(struct prism54_driver_data *drv,
  851. struct wpa_init_params *params)
  852. {
  853. struct ifreq ifr;
  854. struct sockaddr_ll addr;
  855. drv->sock = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_PAE));
  856. if (drv->sock < 0) {
  857. perror("socket[PF_PACKET,SOCK_RAW]");
  858. return -1;
  859. }
  860. if (eloop_register_read_sock(drv->sock, handle_802_3, drv->hapd, NULL))
  861. {
  862. printf("Could not register read socket\n");
  863. return -1;
  864. }
  865. memset(&ifr, 0, sizeof(ifr));
  866. if (params->num_bridge && params->bridge[0]) {
  867. printf("opening bridge: %s\n", params->bridge[0]);
  868. os_strlcpy(ifr.ifr_name, params->bridge[0],
  869. sizeof(ifr.ifr_name));
  870. } else {
  871. os_strlcpy(ifr.ifr_name, drv->iface, sizeof(ifr.ifr_name));
  872. }
  873. if (ioctl(drv->sock, SIOCGIFINDEX, &ifr) != 0) {
  874. perror("ioctl(SIOCGIFINDEX)");
  875. return -1;
  876. }
  877. memset(&addr, 0, sizeof(addr));
  878. addr.sll_family = AF_PACKET;
  879. addr.sll_ifindex = ifr.ifr_ifindex;
  880. addr.sll_protocol = htons(ETH_P_PAE);
  881. wpa_printf(MSG_DEBUG, "Opening raw packet socket for ifindex %d",
  882. addr.sll_ifindex);
  883. if (bind(drv->sock, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
  884. perror("bind");
  885. return -1;
  886. }
  887. memset(&ifr, 0, sizeof(ifr));
  888. os_strlcpy(ifr.ifr_name, drv->iface, sizeof(ifr.ifr_name));
  889. if (ioctl(drv->sock, SIOCGIFHWADDR, &ifr) != 0) {
  890. perror("ioctl(SIOCGIFHWADDR)");
  891. return -1;
  892. }
  893. if (ifr.ifr_hwaddr.sa_family != ARPHRD_ETHER) {
  894. printf("Invalid HW-addr family 0x%04x\n",
  895. ifr.ifr_hwaddr.sa_family);
  896. return -1;
  897. }
  898. memcpy(params->own_addr, ifr.ifr_hwaddr.sa_data, ETH_ALEN);
  899. drv->pim_sock = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_ALL));
  900. if (drv->pim_sock < 0) {
  901. perror("socket[PF_PACKET,SOCK_RAW]");
  902. return -1;
  903. }
  904. if (eloop_register_read_sock(drv->pim_sock, handle_pim, drv, NULL)) {
  905. printf("Could not register read socket\n");
  906. return -1;
  907. }
  908. memset(&ifr, 0, sizeof(ifr));
  909. snprintf(ifr.ifr_name, sizeof(ifr.ifr_name), "%sap", drv->iface);
  910. if (ioctl(drv->pim_sock, SIOCGIFINDEX, &ifr) != 0) {
  911. perror("ioctl(SIOCGIFINDEX)");
  912. return -1;
  913. }
  914. memset(&addr, 0, sizeof(addr));
  915. addr.sll_family = AF_PACKET;
  916. addr.sll_ifindex = ifr.ifr_ifindex;
  917. addr.sll_protocol = htons(ETH_P_ALL);
  918. wpa_printf(MSG_DEBUG, "Opening raw packet socket for ifindex %d",
  919. addr.sll_ifindex);
  920. if (bind(drv->pim_sock, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
  921. perror("bind");
  922. return -1;
  923. }
  924. return 0;
  925. }
  926. static void * prism54_driver_init(struct hostapd_data *hapd,
  927. struct wpa_init_params *params)
  928. {
  929. struct prism54_driver_data *drv;
  930. drv = os_zalloc(sizeof(struct prism54_driver_data));
  931. if (drv == NULL) {
  932. printf("Could not allocate memory for hostapd Prism54 driver "
  933. "data\n");
  934. return NULL;
  935. }
  936. drv->hapd = hapd;
  937. drv->pim_sock = drv->sock = -1;
  938. memcpy(drv->iface, params->ifname, sizeof(drv->iface));
  939. if (prism54_init_sockets(drv, params)) {
  940. free(drv);
  941. return NULL;
  942. }
  943. prism54_init_1x(drv);
  944. /* must clean previous elems */
  945. prism54_set_generic_elem(drv->iface, drv, NULL, 0);
  946. return drv;
  947. }
  948. static void prism54_driver_deinit(void *priv)
  949. {
  950. struct prism54_driver_data *drv = priv;
  951. if (drv->pim_sock >= 0)
  952. close(drv->pim_sock);
  953. if (drv->sock >= 0)
  954. close(drv->sock);
  955. free(drv);
  956. }
  957. #else /* HOSTAPD */
  958. struct wpa_driver_prism54_data {
  959. void *wext; /* private data for driver_wext */
  960. void *ctx;
  961. char ifname[IFNAMSIZ + 1];
  962. int sock;
  963. };
  964. #define PRISM54_SET_WPA SIOCIWFIRSTPRIV+12
  965. #define PRISM54_HOSTAPD SIOCIWFIRSTPRIV+25
  966. #define PRISM54_DROP_UNENCRYPTED SIOCIWFIRSTPRIV+26
  967. static void show_set_key_error(struct prism2_hostapd_param *);
  968. static int hostapd_ioctl_prism54(struct wpa_driver_prism54_data *drv,
  969. struct prism2_hostapd_param *param,
  970. int len, int show_err)
  971. {
  972. struct iwreq iwr;
  973. os_memset(&iwr, 0, sizeof(iwr));
  974. os_strlcpy(iwr.ifr_name, drv->ifname, IFNAMSIZ);
  975. iwr.u.data.pointer = (caddr_t) param;
  976. iwr.u.data.length = len;
  977. if (ioctl(drv->sock, PRISM54_HOSTAPD, &iwr) < 0) {
  978. int ret = errno;
  979. if (show_err)
  980. perror("ioctl[PRISM54_HOSTAPD]");
  981. return ret;
  982. }
  983. return 0;
  984. }
  985. static int wpa_driver_prism54_set_wpa_ie(struct wpa_driver_prism54_data *drv,
  986. const u8 *wpa_ie,
  987. size_t wpa_ie_len)
  988. {
  989. struct prism2_hostapd_param *param;
  990. int res;
  991. size_t blen = PRISM2_HOSTAPD_GENERIC_ELEMENT_HDR_LEN + wpa_ie_len;
  992. if (blen < sizeof(*param))
  993. blen = sizeof(*param);
  994. param = os_zalloc(blen);
  995. if (param == NULL)
  996. return -1;
  997. param->cmd = PRISM2_HOSTAPD_SET_GENERIC_ELEMENT;
  998. param->u.generic_elem.len = wpa_ie_len;
  999. os_memcpy(param->u.generic_elem.data, wpa_ie, wpa_ie_len);
  1000. res = hostapd_ioctl_prism54(drv, param, blen, 1);
  1001. os_free(param);
  1002. return res;
  1003. }
  1004. /* This is called at wpa_supplicant daemon init time */
  1005. static int wpa_driver_prism54_set_wpa(void *priv, int enabled)
  1006. {
  1007. struct wpa_driver_prism54_data *drv = priv;
  1008. struct prism2_hostapd_param *param;
  1009. int res;
  1010. size_t blen = PRISM2_HOSTAPD_GENERIC_ELEMENT_HDR_LEN;
  1011. if (blen < sizeof(*param))
  1012. blen = sizeof(*param);
  1013. param = os_zalloc(blen);
  1014. if (param == NULL)
  1015. return -1;
  1016. param->cmd = PRISM54_SET_WPA;
  1017. param->u.generic_elem.len = 0;
  1018. res = hostapd_ioctl_prism54(drv, param, blen, 1);
  1019. os_free(param);
  1020. return res;
  1021. }
  1022. static int wpa_driver_prism54_set_key(void *priv, wpa_alg alg,
  1023. const u8 *addr, int key_idx, int set_tx,
  1024. const u8 *seq, size_t seq_len,
  1025. const u8 *key, size_t key_len)
  1026. {
  1027. struct wpa_driver_prism54_data *drv = priv;
  1028. struct prism2_hostapd_param *param;
  1029. u8 *buf;
  1030. size_t blen;
  1031. int ret = 0;
  1032. char *alg_name;
  1033. switch (alg) {
  1034. case WPA_ALG_NONE:
  1035. alg_name = "none";
  1036. return -1;
  1037. break;
  1038. case WPA_ALG_WEP:
  1039. alg_name = "WEP";
  1040. return -1;
  1041. break;
  1042. case WPA_ALG_TKIP:
  1043. alg_name = "TKIP";
  1044. break;
  1045. case WPA_ALG_CCMP:
  1046. alg_name = "CCMP";
  1047. return -1;
  1048. break;
  1049. default:
  1050. return -1;
  1051. }
  1052. wpa_printf(MSG_DEBUG, "%s: alg=%s key_idx=%d set_tx=%d seq_len=%lu "
  1053. "key_len=%lu", __FUNCTION__, alg_name, key_idx, set_tx,
  1054. (unsigned long) seq_len, (unsigned long) key_len);
  1055. if (seq_len > 8)
  1056. return -2;
  1057. blen = sizeof(*param) + key_len;
  1058. buf = os_zalloc(blen);
  1059. if (buf == NULL)
  1060. return -1;
  1061. param = (struct prism2_hostapd_param *) buf;
  1062. param->cmd = PRISM2_SET_ENCRYPTION;
  1063. /* TODO: In theory, STA in client mode can use five keys; four default
  1064. * keys for receiving (with keyidx 0..3) and one individual key for
  1065. * both transmitting and receiving (keyidx 0) _unicast_ packets. Now,
  1066. * keyidx 0 is reserved for this unicast use and default keys can only
  1067. * use keyidx 1..3 (i.e., default key with keyidx 0 is not supported).
  1068. * This should be fine for more or less all cases, but for completeness
  1069. * sake, the driver could be enhanced to support the missing key. */
  1070. #if 0
  1071. if (addr == NULL)
  1072. os_memset(param->sta_addr, 0xff, ETH_ALEN);
  1073. else
  1074. os_memcpy(param->sta_addr, addr, ETH_ALEN);
  1075. #else
  1076. os_memset(param->sta_addr, 0xff, ETH_ALEN);
  1077. #endif
  1078. os_strlcpy((char *) param->u.crypt.alg, alg_name,
  1079. HOSTAP_CRYPT_ALG_NAME_LEN);
  1080. param->u.crypt.flags = set_tx ? HOSTAP_CRYPT_FLAG_SET_TX_KEY : 0;
  1081. param->u.crypt.idx = key_idx;
  1082. os_memcpy(param->u.crypt.seq, seq, seq_len);
  1083. param->u.crypt.key_len = key_len;
  1084. os_memcpy((u8 *) (param + 1), key, key_len);
  1085. if (hostapd_ioctl_prism54(drv, param, blen, 1)) {
  1086. wpa_printf(MSG_WARNING, "Failed to set encryption.");
  1087. show_set_key_error(param);
  1088. ret = -1;
  1089. }
  1090. os_free(buf);
  1091. return ret;
  1092. }
  1093. static int wpa_driver_prism54_set_countermeasures(void *priv,
  1094. int enabled)
  1095. {
  1096. /* FIX */
  1097. printf("wpa_driver_prism54_set_countermeasures - not yet "
  1098. "implemented\n");
  1099. return 0;
  1100. }
  1101. static int wpa_driver_prism54_set_drop_unencrypted(void *priv,
  1102. int enabled)
  1103. {
  1104. struct wpa_driver_prism54_data *drv = priv;
  1105. struct prism2_hostapd_param *param;
  1106. int res;
  1107. size_t blen = PRISM2_HOSTAPD_GENERIC_ELEMENT_HDR_LEN;
  1108. if (blen < sizeof(*param))
  1109. blen = sizeof(*param);
  1110. param = os_zalloc(blen);
  1111. if (param == NULL)
  1112. return -1;
  1113. param->cmd = PRISM54_DROP_UNENCRYPTED;
  1114. param->u.generic_elem.len = 0;
  1115. res = hostapd_ioctl_prism54(drv, param, blen, 1);
  1116. os_free(param);
  1117. return res;
  1118. }
  1119. static int wpa_driver_prism54_deauthenticate(void *priv, const u8 *addr,
  1120. int reason_code)
  1121. {
  1122. /* FIX */
  1123. printf("wpa_driver_prism54_deauthenticate - not yet implemented\n");
  1124. return 0;
  1125. }
  1126. static int wpa_driver_prism54_disassociate(void *priv, const u8 *addr,
  1127. int reason_code)
  1128. {
  1129. /* FIX */
  1130. printf("wpa_driver_prism54_disassociate - not yet implemented\n");
  1131. return 0;
  1132. }
  1133. static int
  1134. wpa_driver_prism54_associate(void *priv,
  1135. struct wpa_driver_associate_params *params)
  1136. {
  1137. struct wpa_driver_prism54_data *drv = priv;
  1138. int ret = 0;
  1139. if (wpa_driver_prism54_set_wpa_ie(drv, params->wpa_ie,
  1140. params->wpa_ie_len) < 0)
  1141. ret = -1;
  1142. if (wpa_driver_wext_set_freq(drv->wext, params->freq) < 0)
  1143. ret = -1;
  1144. if (wpa_driver_wext_set_ssid(drv->wext, params->ssid,
  1145. params->ssid_len) < 0)
  1146. ret = -1;
  1147. if (wpa_driver_wext_set_bssid(drv->wext, params->bssid) < 0)
  1148. ret = -1;
  1149. return ret;
  1150. }
  1151. static void show_set_key_error(struct prism2_hostapd_param *param)
  1152. {
  1153. switch (param->u.crypt.err) {
  1154. case HOSTAP_CRYPT_ERR_UNKNOWN_ALG:
  1155. wpa_printf(MSG_INFO, "Unknown algorithm '%s'.",
  1156. param->u.crypt.alg);
  1157. wpa_printf(MSG_INFO, "You may need to load kernel module to "
  1158. "register that algorithm.");
  1159. wpa_printf(MSG_INFO, "E.g., 'modprobe hostap_crypt_wep' for "
  1160. "WEP.");
  1161. break;
  1162. case HOSTAP_CRYPT_ERR_UNKNOWN_ADDR:
  1163. wpa_printf(MSG_INFO, "Unknown address " MACSTR ".",
  1164. MAC2STR(param->sta_addr));
  1165. break;
  1166. case HOSTAP_CRYPT_ERR_CRYPT_INIT_FAILED:
  1167. wpa_printf(MSG_INFO, "Crypt algorithm initialization failed.");
  1168. break;
  1169. case HOSTAP_CRYPT_ERR_KEY_SET_FAILED:
  1170. wpa_printf(MSG_INFO, "Key setting failed.");
  1171. break;
  1172. case HOSTAP_CRYPT_ERR_TX_KEY_SET_FAILED:
  1173. wpa_printf(MSG_INFO, "TX key index setting failed.");
  1174. break;
  1175. case HOSTAP_CRYPT_ERR_CARD_CONF_FAILED:
  1176. wpa_printf(MSG_INFO, "Card configuration failed.");
  1177. break;
  1178. }
  1179. }
  1180. static int wpa_driver_prism54_get_bssid(void *priv, u8 *bssid)
  1181. {
  1182. struct wpa_driver_prism54_data *drv = priv;
  1183. return wpa_driver_wext_get_bssid(drv->wext, bssid);
  1184. }
  1185. static int wpa_driver_prism54_get_ssid(void *priv, u8 *ssid)
  1186. {
  1187. struct wpa_driver_prism54_data *drv = priv;
  1188. return wpa_driver_wext_get_ssid(drv->wext, ssid);
  1189. }
  1190. static int wpa_driver_prism54_scan(void *priv, const u8 *ssid, size_t ssid_len)
  1191. {
  1192. struct wpa_driver_prism54_data *drv = priv;
  1193. return wpa_driver_wext_scan(drv->wext, ssid, ssid_len);
  1194. }
  1195. static struct wpa_scan_results *
  1196. wpa_driver_prism54_get_scan_results(void *priv)
  1197. {
  1198. struct wpa_driver_prism54_data *drv = priv;
  1199. return wpa_driver_wext_get_scan_results(drv->wext);
  1200. }
  1201. static int wpa_driver_prism54_set_operstate(void *priv, int state)
  1202. {
  1203. struct wpa_driver_prism54_data *drv = priv;
  1204. return wpa_driver_wext_set_operstate(drv->wext, state);
  1205. }
  1206. static void * wpa_driver_prism54_init(void *ctx, const char *ifname)
  1207. {
  1208. struct wpa_driver_prism54_data *drv;
  1209. drv = os_zalloc(sizeof(*drv));
  1210. if (drv == NULL)
  1211. return NULL;
  1212. drv->wext = wpa_driver_wext_init(ctx, ifname);
  1213. if (drv->wext == NULL) {
  1214. os_free(drv);
  1215. return NULL;
  1216. }
  1217. drv->ctx = ctx;
  1218. os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname));
  1219. drv->sock = socket(PF_INET, SOCK_DGRAM, 0);
  1220. if (drv->sock < 0) {
  1221. wpa_driver_wext_deinit(drv->wext);
  1222. os_free(drv);
  1223. return NULL;
  1224. }
  1225. return drv;
  1226. }
  1227. static void wpa_driver_prism54_deinit(void *priv)
  1228. {
  1229. struct wpa_driver_prism54_data *drv = priv;
  1230. wpa_driver_wext_deinit(drv->wext);
  1231. close(drv->sock);
  1232. os_free(drv);
  1233. }
  1234. #endif /* HOSTAPD */
  1235. const struct wpa_driver_ops wpa_driver_prism54_ops = {
  1236. .name = "prism54",
  1237. .desc = "Prism54.org driver (Intersil Prism GT/Duette/Indigo)",
  1238. #ifdef HOSTAPD
  1239. .hapd_init = prism54_driver_init,
  1240. .hapd_deinit = prism54_driver_deinit,
  1241. /* .set_ieee8021x = prism54_init_1x, */
  1242. .set_privacy = prism54_set_privacy_invoked,
  1243. .hapd_set_key = prism54_set_key,
  1244. .get_seqnum = prism54_get_seqnum,
  1245. .flush = prism54_flush,
  1246. .set_generic_elem = prism54_set_generic_elem,
  1247. .hapd_send_eapol = prism54_send_eapol,
  1248. .sta_set_flags = prism54_sta_set_flags,
  1249. .sta_deauth = prism54_sta_deauth,
  1250. .sta_disassoc = prism54_sta_disassoc,
  1251. .hapd_set_ssid = prism54_ioctl_setiwessid,
  1252. .get_inact_sec = prism54_get_inact_sec,
  1253. #else /* HOSTAPD */
  1254. .get_bssid = wpa_driver_prism54_get_bssid,
  1255. .get_ssid = wpa_driver_prism54_get_ssid,
  1256. .set_wpa = wpa_driver_prism54_set_wpa,
  1257. .set_key = wpa_driver_prism54_set_key,
  1258. .set_countermeasures = wpa_driver_prism54_set_countermeasures,
  1259. .set_drop_unencrypted = wpa_driver_prism54_set_drop_unencrypted,
  1260. .scan = wpa_driver_prism54_scan,
  1261. .get_scan_results2 = wpa_driver_prism54_get_scan_results,
  1262. .deauthenticate = wpa_driver_prism54_deauthenticate,
  1263. .disassociate = wpa_driver_prism54_disassociate,
  1264. .associate = wpa_driver_prism54_associate,
  1265. .init = wpa_driver_prism54_init,
  1266. .deinit = wpa_driver_prism54_deinit,
  1267. .set_operstate = wpa_driver_prism54_set_operstate,
  1268. #endif /* HOSTAPD */
  1269. };