driver_privsep.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775
  1. /*
  2. * WPA Supplicant - privilege separated driver interface
  3. * Copyright (c) 2007-2009, 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/un.h>
  16. #include "common.h"
  17. #include "driver.h"
  18. #include "eloop.h"
  19. #include "privsep_commands.h"
  20. struct wpa_driver_privsep_data {
  21. void *ctx;
  22. u8 own_addr[ETH_ALEN];
  23. int priv_socket;
  24. char *own_socket_path;
  25. int cmd_socket;
  26. char *own_cmd_path;
  27. struct sockaddr_un priv_addr;
  28. char ifname[16];
  29. };
  30. static int wpa_priv_reg_cmd(struct wpa_driver_privsep_data *drv, int cmd)
  31. {
  32. int res;
  33. res = sendto(drv->priv_socket, &cmd, sizeof(cmd), 0,
  34. (struct sockaddr *) &drv->priv_addr,
  35. sizeof(drv->priv_addr));
  36. if (res < 0)
  37. perror("sendto");
  38. return res < 0 ? -1 : 0;
  39. }
  40. static int wpa_priv_cmd(struct wpa_driver_privsep_data *drv, int cmd,
  41. const void *data, size_t data_len,
  42. void *reply, size_t *reply_len)
  43. {
  44. struct msghdr msg;
  45. struct iovec io[2];
  46. io[0].iov_base = &cmd;
  47. io[0].iov_len = sizeof(cmd);
  48. io[1].iov_base = (u8 *) data;
  49. io[1].iov_len = data_len;
  50. os_memset(&msg, 0, sizeof(msg));
  51. msg.msg_iov = io;
  52. msg.msg_iovlen = data ? 2 : 1;
  53. msg.msg_name = &drv->priv_addr;
  54. msg.msg_namelen = sizeof(drv->priv_addr);
  55. if (sendmsg(drv->cmd_socket, &msg, 0) < 0) {
  56. perror("sendmsg(cmd_socket)");
  57. return -1;
  58. }
  59. if (reply) {
  60. fd_set rfds;
  61. struct timeval tv;
  62. int res;
  63. FD_ZERO(&rfds);
  64. FD_SET(drv->cmd_socket, &rfds);
  65. tv.tv_sec = 5;
  66. tv.tv_usec = 0;
  67. res = select(drv->cmd_socket + 1, &rfds, NULL, NULL, &tv);
  68. if (res < 0 && errno != EINTR) {
  69. perror("select");
  70. return -1;
  71. }
  72. if (FD_ISSET(drv->cmd_socket, &rfds)) {
  73. res = recv(drv->cmd_socket, reply, *reply_len, 0);
  74. if (res < 0) {
  75. perror("recv");
  76. return -1;
  77. }
  78. *reply_len = res;
  79. } else {
  80. wpa_printf(MSG_DEBUG, "PRIVSEP: Timeout while waiting "
  81. "for reply (cmd=%d)", cmd);
  82. return -1;
  83. }
  84. }
  85. return 0;
  86. }
  87. static int wpa_driver_privsep_scan(void *priv, const u8 *ssid, size_t ssid_len)
  88. {
  89. struct wpa_driver_privsep_data *drv = priv;
  90. wpa_printf(MSG_DEBUG, "%s: priv=%p", __func__, priv);
  91. return wpa_priv_cmd(drv, PRIVSEP_CMD_SCAN, ssid, ssid_len,
  92. NULL, NULL);
  93. }
  94. static struct wpa_scan_results *
  95. wpa_driver_privsep_get_scan_results2(void *priv)
  96. {
  97. struct wpa_driver_privsep_data *drv = priv;
  98. int res, num;
  99. u8 *buf, *pos, *end;
  100. size_t reply_len = 60000;
  101. struct wpa_scan_results *results;
  102. struct wpa_scan_res *r;
  103. buf = os_malloc(reply_len);
  104. if (buf == NULL)
  105. return NULL;
  106. res = wpa_priv_cmd(drv, PRIVSEP_CMD_GET_SCAN_RESULTS,
  107. NULL, 0, buf, &reply_len);
  108. if (res < 0) {
  109. os_free(buf);
  110. return NULL;
  111. }
  112. wpa_printf(MSG_DEBUG, "privsep: Received %lu bytes of scan results",
  113. (unsigned long) reply_len);
  114. if (reply_len < sizeof(int)) {
  115. wpa_printf(MSG_DEBUG, "privsep: Invalid scan result len %lu",
  116. (unsigned long) reply_len);
  117. os_free(buf);
  118. return NULL;
  119. }
  120. pos = buf;
  121. end = buf + reply_len;
  122. os_memcpy(&num, pos, sizeof(int));
  123. if (num < 0 || num > 1000) {
  124. os_free(buf);
  125. return NULL;
  126. }
  127. pos += sizeof(int);
  128. results = os_zalloc(sizeof(*results));
  129. if (results == NULL) {
  130. os_free(buf);
  131. return NULL;
  132. }
  133. results->res = os_zalloc(num * sizeof(struct wpa_scan_res *));
  134. if (results->res == NULL) {
  135. os_free(results);
  136. os_free(buf);
  137. return NULL;
  138. }
  139. while (results->num < (size_t) num && pos + sizeof(int) < end) {
  140. int len;
  141. os_memcpy(&len, pos, sizeof(int));
  142. pos += sizeof(int);
  143. if (len < 0 || len > 10000 || pos + len > end)
  144. break;
  145. r = os_malloc(len);
  146. if (r == NULL)
  147. break;
  148. os_memcpy(r, pos, len);
  149. pos += len;
  150. if (sizeof(*r) + r->ie_len > (size_t) len) {
  151. os_free(r);
  152. break;
  153. }
  154. results->res[results->num++] = r;
  155. }
  156. os_free(buf);
  157. return results;
  158. }
  159. static int wpa_driver_privsep_set_key(const char *ifname, void *priv,
  160. wpa_alg alg, const u8 *addr,
  161. int key_idx, int set_tx,
  162. const u8 *seq, size_t seq_len,
  163. const u8 *key, size_t key_len)
  164. {
  165. struct wpa_driver_privsep_data *drv = priv;
  166. struct privsep_cmd_set_key cmd;
  167. wpa_printf(MSG_DEBUG, "%s: priv=%p alg=%d key_idx=%d set_tx=%d",
  168. __func__, priv, alg, key_idx, set_tx);
  169. os_memset(&cmd, 0, sizeof(cmd));
  170. cmd.alg = alg;
  171. if (addr)
  172. os_memcpy(cmd.addr, addr, ETH_ALEN);
  173. else
  174. os_memset(cmd.addr, 0xff, ETH_ALEN);
  175. cmd.key_idx = key_idx;
  176. cmd.set_tx = set_tx;
  177. if (seq && seq_len > 0 && seq_len < sizeof(cmd.seq)) {
  178. os_memcpy(cmd.seq, seq, seq_len);
  179. cmd.seq_len = seq_len;
  180. }
  181. if (key && key_len > 0 && key_len < sizeof(cmd.key)) {
  182. os_memcpy(cmd.key, key, key_len);
  183. cmd.key_len = key_len;
  184. }
  185. return wpa_priv_cmd(drv, PRIVSEP_CMD_SET_KEY, &cmd, sizeof(cmd),
  186. NULL, NULL);
  187. }
  188. static int wpa_driver_privsep_associate(
  189. void *priv, struct wpa_driver_associate_params *params)
  190. {
  191. struct wpa_driver_privsep_data *drv = priv;
  192. struct privsep_cmd_associate *data;
  193. int res;
  194. size_t buflen;
  195. wpa_printf(MSG_DEBUG, "%s: priv=%p freq=%d pairwise_suite=%d "
  196. "group_suite=%d key_mgmt_suite=%d auth_alg=%d mode=%d",
  197. __func__, priv, params->freq, params->pairwise_suite,
  198. params->group_suite, params->key_mgmt_suite,
  199. params->auth_alg, params->mode);
  200. buflen = sizeof(*data) + params->wpa_ie_len;
  201. data = os_zalloc(buflen);
  202. if (data == NULL)
  203. return -1;
  204. if (params->bssid)
  205. os_memcpy(data->bssid, params->bssid, ETH_ALEN);
  206. os_memcpy(data->ssid, params->ssid, params->ssid_len);
  207. data->ssid_len = params->ssid_len;
  208. data->freq = params->freq;
  209. data->pairwise_suite = params->pairwise_suite;
  210. data->group_suite = params->group_suite;
  211. data->key_mgmt_suite = params->key_mgmt_suite;
  212. data->auth_alg = params->auth_alg;
  213. data->mode = params->mode;
  214. data->wpa_ie_len = params->wpa_ie_len;
  215. if (params->wpa_ie)
  216. os_memcpy(data + 1, params->wpa_ie, params->wpa_ie_len);
  217. /* TODO: add support for other assoc parameters */
  218. res = wpa_priv_cmd(drv, PRIVSEP_CMD_ASSOCIATE, data, buflen,
  219. NULL, NULL);
  220. os_free(data);
  221. return res;
  222. }
  223. static int wpa_driver_privsep_get_bssid(void *priv, u8 *bssid)
  224. {
  225. struct wpa_driver_privsep_data *drv = priv;
  226. int res;
  227. size_t len = ETH_ALEN;
  228. res = wpa_priv_cmd(drv, PRIVSEP_CMD_GET_BSSID, NULL, 0, bssid, &len);
  229. if (res < 0 || len != ETH_ALEN)
  230. return -1;
  231. return 0;
  232. }
  233. static int wpa_driver_privsep_get_ssid(void *priv, u8 *ssid)
  234. {
  235. struct wpa_driver_privsep_data *drv = priv;
  236. int res, ssid_len;
  237. u8 reply[sizeof(int) + 32];
  238. size_t len = sizeof(reply);
  239. res = wpa_priv_cmd(drv, PRIVSEP_CMD_GET_SSID, NULL, 0, reply, &len);
  240. if (res < 0 || len < sizeof(int))
  241. return -1;
  242. os_memcpy(&ssid_len, reply, sizeof(int));
  243. if (ssid_len < 0 || ssid_len > 32 || sizeof(int) + ssid_len > len) {
  244. wpa_printf(MSG_DEBUG, "privsep: Invalid get SSID reply");
  245. return -1;
  246. }
  247. os_memcpy(ssid, &reply[sizeof(int)], ssid_len);
  248. return ssid_len;
  249. }
  250. static int wpa_driver_privsep_deauthenticate(void *priv, const u8 *addr,
  251. int reason_code)
  252. {
  253. //struct wpa_driver_privsep_data *drv = priv;
  254. wpa_printf(MSG_DEBUG, "%s addr=" MACSTR " reason_code=%d",
  255. __func__, MAC2STR(addr), reason_code);
  256. wpa_printf(MSG_DEBUG, "%s - TODO", __func__);
  257. return 0;
  258. }
  259. static int wpa_driver_privsep_disassociate(void *priv, const u8 *addr,
  260. int reason_code)
  261. {
  262. //struct wpa_driver_privsep_data *drv = priv;
  263. wpa_printf(MSG_DEBUG, "%s addr=" MACSTR " reason_code=%d",
  264. __func__, MAC2STR(addr), reason_code);
  265. wpa_printf(MSG_DEBUG, "%s - TODO", __func__);
  266. return 0;
  267. }
  268. static void wpa_driver_privsep_event_assoc(void *ctx, wpa_event_type event,
  269. u8 *buf, size_t len)
  270. {
  271. union wpa_event_data data;
  272. int inc_data = 0;
  273. u8 *pos, *end;
  274. int ie_len;
  275. os_memset(&data, 0, sizeof(data));
  276. pos = buf;
  277. end = buf + len;
  278. if (end - pos < (int) sizeof(int))
  279. return;
  280. os_memcpy(&ie_len, pos, sizeof(int));
  281. pos += sizeof(int);
  282. if (ie_len < 0 || ie_len > end - pos)
  283. return;
  284. if (ie_len) {
  285. data.assoc_info.req_ies = pos;
  286. data.assoc_info.req_ies_len = ie_len;
  287. pos += ie_len;
  288. inc_data = 1;
  289. }
  290. wpa_supplicant_event(ctx, event, inc_data ? &data : NULL);
  291. }
  292. static void wpa_driver_privsep_event_interface_status(void *ctx, u8 *buf,
  293. size_t len)
  294. {
  295. union wpa_event_data data;
  296. int ievent;
  297. if (len < sizeof(int) ||
  298. len - sizeof(int) > sizeof(data.interface_status.ifname))
  299. return;
  300. os_memcpy(&ievent, buf, sizeof(int));
  301. os_memset(&data, 0, sizeof(data));
  302. data.interface_status.ievent = ievent;
  303. os_memcpy(data.interface_status.ifname, buf + sizeof(int),
  304. len - sizeof(int));
  305. wpa_supplicant_event(ctx, EVENT_INTERFACE_STATUS, &data);
  306. }
  307. static void wpa_driver_privsep_event_michael_mic_failure(
  308. void *ctx, u8 *buf, size_t len)
  309. {
  310. union wpa_event_data data;
  311. if (len != sizeof(int))
  312. return;
  313. os_memset(&data, 0, sizeof(data));
  314. os_memcpy(&data.michael_mic_failure.unicast, buf, sizeof(int));
  315. wpa_supplicant_event(ctx, EVENT_MICHAEL_MIC_FAILURE, &data);
  316. }
  317. static void wpa_driver_privsep_event_pmkid_candidate(void *ctx, u8 *buf,
  318. size_t len)
  319. {
  320. union wpa_event_data data;
  321. if (len != sizeof(struct pmkid_candidate))
  322. return;
  323. os_memset(&data, 0, sizeof(data));
  324. os_memcpy(&data.pmkid_candidate, buf, len);
  325. wpa_supplicant_event(ctx, EVENT_PMKID_CANDIDATE, &data);
  326. }
  327. static void wpa_driver_privsep_event_stkstart(void *ctx, u8 *buf, size_t len)
  328. {
  329. union wpa_event_data data;
  330. if (len != ETH_ALEN)
  331. return;
  332. os_memset(&data, 0, sizeof(data));
  333. os_memcpy(data.stkstart.peer, buf, ETH_ALEN);
  334. wpa_supplicant_event(ctx, EVENT_STKSTART, &data);
  335. }
  336. static void wpa_driver_privsep_event_ft_response(void *ctx, u8 *buf,
  337. size_t len)
  338. {
  339. union wpa_event_data data;
  340. if (len < sizeof(int) + ETH_ALEN)
  341. return;
  342. os_memset(&data, 0, sizeof(data));
  343. os_memcpy(&data.ft_ies.ft_action, buf, sizeof(int));
  344. os_memcpy(data.ft_ies.target_ap, buf + sizeof(int), ETH_ALEN);
  345. data.ft_ies.ies = buf + sizeof(int) + ETH_ALEN;
  346. data.ft_ies.ies_len = len - sizeof(int) - ETH_ALEN;
  347. wpa_supplicant_event(ctx, EVENT_FT_RESPONSE, &data);
  348. }
  349. static void wpa_driver_privsep_event_rx_eapol(void *ctx, u8 *buf, size_t len)
  350. {
  351. if (len < ETH_ALEN)
  352. return;
  353. wpa_supplicant_rx_eapol(ctx, buf, buf + ETH_ALEN, len - ETH_ALEN);
  354. }
  355. static void wpa_driver_privsep_event_sta_rx(void *ctx, u8 *buf, size_t len)
  356. {
  357. #ifdef CONFIG_CLIENT_MLME
  358. struct ieee80211_rx_status *rx_status;
  359. if (len < sizeof(*rx_status))
  360. return;
  361. rx_status = (struct ieee80211_rx_status *) buf;
  362. buf += sizeof(*rx_status);
  363. len -= sizeof(*rx_status);
  364. wpa_supplicant_sta_rx(ctx, buf, len, rx_status);
  365. #endif /* CONFIG_CLIENT_MLME */
  366. }
  367. static void wpa_driver_privsep_receive(int sock, void *eloop_ctx,
  368. void *sock_ctx)
  369. {
  370. struct wpa_driver_privsep_data *drv = eloop_ctx;
  371. u8 *buf, *event_buf;
  372. size_t event_len;
  373. int res, event;
  374. enum privsep_event e;
  375. struct sockaddr_un from;
  376. socklen_t fromlen = sizeof(from);
  377. const size_t buflen = 2000;
  378. buf = os_malloc(buflen);
  379. if (buf == NULL)
  380. return;
  381. res = recvfrom(sock, buf, buflen, 0,
  382. (struct sockaddr *) &from, &fromlen);
  383. if (res < 0) {
  384. perror("recvfrom(priv_socket)");
  385. os_free(buf);
  386. return;
  387. }
  388. wpa_printf(MSG_DEBUG, "privsep_driver: received %u bytes", res);
  389. if (res < (int) sizeof(int)) {
  390. wpa_printf(MSG_DEBUG, "Too short event message (len=%d)", res);
  391. return;
  392. }
  393. os_memcpy(&event, buf, sizeof(int));
  394. event_buf = &buf[sizeof(int)];
  395. event_len = res - sizeof(int);
  396. wpa_printf(MSG_DEBUG, "privsep: Event %d received (len=%lu)",
  397. event, (unsigned long) event_len);
  398. e = event;
  399. switch (e) {
  400. case PRIVSEP_EVENT_SCAN_RESULTS:
  401. wpa_supplicant_event(drv->ctx, EVENT_SCAN_RESULTS, NULL);
  402. break;
  403. case PRIVSEP_EVENT_ASSOC:
  404. wpa_driver_privsep_event_assoc(drv->ctx, EVENT_ASSOC,
  405. event_buf, event_len);
  406. break;
  407. case PRIVSEP_EVENT_DISASSOC:
  408. wpa_supplicant_event(drv->ctx, EVENT_DISASSOC, NULL);
  409. break;
  410. case PRIVSEP_EVENT_ASSOCINFO:
  411. wpa_driver_privsep_event_assoc(drv->ctx, EVENT_ASSOCINFO,
  412. event_buf, event_len);
  413. break;
  414. case PRIVSEP_EVENT_MICHAEL_MIC_FAILURE:
  415. wpa_driver_privsep_event_michael_mic_failure(
  416. drv->ctx, event_buf, event_len);
  417. break;
  418. case PRIVSEP_EVENT_INTERFACE_STATUS:
  419. wpa_driver_privsep_event_interface_status(drv->ctx, event_buf,
  420. event_len);
  421. break;
  422. case PRIVSEP_EVENT_PMKID_CANDIDATE:
  423. wpa_driver_privsep_event_pmkid_candidate(drv->ctx, event_buf,
  424. event_len);
  425. break;
  426. case PRIVSEP_EVENT_STKSTART:
  427. wpa_driver_privsep_event_stkstart(drv->ctx, event_buf,
  428. event_len);
  429. break;
  430. case PRIVSEP_EVENT_FT_RESPONSE:
  431. wpa_driver_privsep_event_ft_response(drv->ctx, event_buf,
  432. event_len);
  433. break;
  434. case PRIVSEP_EVENT_RX_EAPOL:
  435. wpa_driver_privsep_event_rx_eapol(drv->ctx, event_buf,
  436. event_len);
  437. break;
  438. case PRIVSEP_EVENT_STA_RX:
  439. wpa_driver_privsep_event_sta_rx(drv->ctx, event_buf,
  440. event_len);
  441. break;
  442. }
  443. os_free(buf);
  444. }
  445. static void * wpa_driver_privsep_init(void *ctx, const char *ifname)
  446. {
  447. struct wpa_driver_privsep_data *drv;
  448. drv = os_zalloc(sizeof(*drv));
  449. if (drv == NULL)
  450. return NULL;
  451. drv->ctx = ctx;
  452. drv->priv_socket = -1;
  453. drv->cmd_socket = -1;
  454. os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname));
  455. return drv;
  456. }
  457. static void wpa_driver_privsep_deinit(void *priv)
  458. {
  459. struct wpa_driver_privsep_data *drv = priv;
  460. if (drv->priv_socket >= 0) {
  461. wpa_priv_reg_cmd(drv, PRIVSEP_CMD_UNREGISTER);
  462. eloop_unregister_read_sock(drv->priv_socket);
  463. close(drv->priv_socket);
  464. }
  465. if (drv->own_socket_path) {
  466. unlink(drv->own_socket_path);
  467. os_free(drv->own_socket_path);
  468. }
  469. if (drv->cmd_socket >= 0) {
  470. eloop_unregister_read_sock(drv->cmd_socket);
  471. close(drv->cmd_socket);
  472. }
  473. if (drv->own_cmd_path) {
  474. unlink(drv->own_cmd_path);
  475. os_free(drv->own_cmd_path);
  476. }
  477. os_free(drv);
  478. }
  479. static int wpa_driver_privsep_set_param(void *priv, const char *param)
  480. {
  481. struct wpa_driver_privsep_data *drv = priv;
  482. const char *pos;
  483. char *own_dir, *priv_dir;
  484. static unsigned int counter = 0;
  485. size_t len;
  486. struct sockaddr_un addr;
  487. wpa_printf(MSG_DEBUG, "%s: param='%s'", __func__, param);
  488. if (param == NULL)
  489. pos = NULL;
  490. else
  491. pos = os_strstr(param, "own_dir=");
  492. if (pos) {
  493. char *end;
  494. own_dir = os_strdup(pos + 8);
  495. if (own_dir == NULL)
  496. return -1;
  497. end = os_strchr(own_dir, ' ');
  498. if (end)
  499. *end = '\0';
  500. } else {
  501. own_dir = os_strdup("/tmp");
  502. if (own_dir == NULL)
  503. return -1;
  504. }
  505. if (param == NULL)
  506. pos = NULL;
  507. else
  508. pos = os_strstr(param, "priv_dir=");
  509. if (pos) {
  510. char *end;
  511. priv_dir = os_strdup(pos + 9);
  512. if (priv_dir == NULL) {
  513. os_free(own_dir);
  514. return -1;
  515. }
  516. end = os_strchr(priv_dir, ' ');
  517. if (end)
  518. *end = '\0';
  519. } else {
  520. priv_dir = os_strdup("/var/run/wpa_priv");
  521. if (priv_dir == NULL) {
  522. os_free(own_dir);
  523. return -1;
  524. }
  525. }
  526. len = os_strlen(own_dir) + 50;
  527. drv->own_socket_path = os_malloc(len);
  528. if (drv->own_socket_path == NULL) {
  529. os_free(priv_dir);
  530. os_free(own_dir);
  531. return -1;
  532. }
  533. os_snprintf(drv->own_socket_path, len, "%s/wpa_privsep-%d-%d",
  534. own_dir, getpid(), counter++);
  535. len = os_strlen(own_dir) + 50;
  536. drv->own_cmd_path = os_malloc(len);
  537. if (drv->own_cmd_path == NULL) {
  538. os_free(drv->own_socket_path);
  539. drv->own_socket_path = NULL;
  540. os_free(priv_dir);
  541. os_free(own_dir);
  542. return -1;
  543. }
  544. os_snprintf(drv->own_cmd_path, len, "%s/wpa_privsep-%d-%d",
  545. own_dir, getpid(), counter++);
  546. os_free(own_dir);
  547. drv->priv_addr.sun_family = AF_UNIX;
  548. os_snprintf(drv->priv_addr.sun_path, sizeof(drv->priv_addr.sun_path),
  549. "%s/%s", priv_dir, drv->ifname);
  550. os_free(priv_dir);
  551. drv->priv_socket = socket(PF_UNIX, SOCK_DGRAM, 0);
  552. if (drv->priv_socket < 0) {
  553. perror("socket(PF_UNIX)");
  554. os_free(drv->own_socket_path);
  555. drv->own_socket_path = NULL;
  556. return -1;
  557. }
  558. os_memset(&addr, 0, sizeof(addr));
  559. addr.sun_family = AF_UNIX;
  560. os_strlcpy(addr.sun_path, drv->own_socket_path, sizeof(addr.sun_path));
  561. if (bind(drv->priv_socket, (struct sockaddr *) &addr, sizeof(addr)) <
  562. 0) {
  563. perror("bind(PF_UNIX)");
  564. close(drv->priv_socket);
  565. drv->priv_socket = -1;
  566. unlink(drv->own_socket_path);
  567. os_free(drv->own_socket_path);
  568. drv->own_socket_path = NULL;
  569. return -1;
  570. }
  571. eloop_register_read_sock(drv->priv_socket, wpa_driver_privsep_receive,
  572. drv, NULL);
  573. drv->cmd_socket = socket(PF_UNIX, SOCK_DGRAM, 0);
  574. if (drv->cmd_socket < 0) {
  575. perror("socket(PF_UNIX)");
  576. os_free(drv->own_cmd_path);
  577. drv->own_cmd_path = NULL;
  578. return -1;
  579. }
  580. os_memset(&addr, 0, sizeof(addr));
  581. addr.sun_family = AF_UNIX;
  582. os_strlcpy(addr.sun_path, drv->own_cmd_path, sizeof(addr.sun_path));
  583. if (bind(drv->cmd_socket, (struct sockaddr *) &addr, sizeof(addr)) < 0)
  584. {
  585. perror("bind(PF_UNIX)");
  586. close(drv->cmd_socket);
  587. drv->cmd_socket = -1;
  588. unlink(drv->own_cmd_path);
  589. os_free(drv->own_cmd_path);
  590. drv->own_cmd_path = NULL;
  591. return -1;
  592. }
  593. if (wpa_priv_reg_cmd(drv, PRIVSEP_CMD_REGISTER) < 0) {
  594. wpa_printf(MSG_ERROR, "Failed to register with wpa_priv");
  595. return -1;
  596. }
  597. return 0;
  598. }
  599. static int wpa_driver_privsep_get_capa(void *priv,
  600. struct wpa_driver_capa *capa)
  601. {
  602. struct wpa_driver_privsep_data *drv = priv;
  603. int res;
  604. size_t len = sizeof(*capa);
  605. res = wpa_priv_cmd(drv, PRIVSEP_CMD_GET_CAPA, NULL, 0, capa, &len);
  606. if (res < 0 || len != sizeof(*capa))
  607. return -1;
  608. return 0;
  609. }
  610. static const u8 * wpa_driver_privsep_get_mac_addr(void *priv)
  611. {
  612. struct wpa_driver_privsep_data *drv = priv;
  613. wpa_printf(MSG_DEBUG, "%s", __func__);
  614. return drv->own_addr;
  615. }
  616. static int wpa_driver_privsep_set_country(void *priv, const char *alpha2)
  617. {
  618. struct wpa_driver_privsep_data *drv = priv;
  619. wpa_printf(MSG_DEBUG, "%s country='%s'", __func__, alpha2);
  620. return wpa_priv_cmd(drv, PRIVSEP_CMD_SET_COUNTRY, alpha2,
  621. os_strlen(alpha2), NULL, NULL);
  622. }
  623. struct wpa_driver_ops wpa_driver_privsep_ops = {
  624. "privsep",
  625. "wpa_supplicant privilege separated driver",
  626. .get_bssid = wpa_driver_privsep_get_bssid,
  627. .get_ssid = wpa_driver_privsep_get_ssid,
  628. .set_key = wpa_driver_privsep_set_key,
  629. .init = wpa_driver_privsep_init,
  630. .deinit = wpa_driver_privsep_deinit,
  631. .set_param = wpa_driver_privsep_set_param,
  632. .scan = wpa_driver_privsep_scan,
  633. .deauthenticate = wpa_driver_privsep_deauthenticate,
  634. .disassociate = wpa_driver_privsep_disassociate,
  635. .associate = wpa_driver_privsep_associate,
  636. .get_capa = wpa_driver_privsep_get_capa,
  637. .get_mac_addr = wpa_driver_privsep_get_mac_addr,
  638. .get_scan_results2 = wpa_driver_privsep_get_scan_results2,
  639. .set_country = wpa_driver_privsep_set_country,
  640. };
  641. struct wpa_driver_ops *wpa_drivers[] =
  642. {
  643. &wpa_driver_privsep_ops,
  644. NULL
  645. };