mesh.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653
  1. /*
  2. * WPA Supplicant - Basic mesh mode routines
  3. * Copyright (c) 2013-2014, cozybit, Inc. All rights reserved.
  4. *
  5. * This software may be distributed under the terms of the BSD license.
  6. * See README for more details.
  7. */
  8. #include "utils/includes.h"
  9. #include "utils/common.h"
  10. #include "utils/eloop.h"
  11. #include "utils/uuid.h"
  12. #include "common/ieee802_11_defs.h"
  13. #include "common/wpa_ctrl.h"
  14. #include "ap/sta_info.h"
  15. #include "ap/hostapd.h"
  16. #include "ap/ieee802_11.h"
  17. #include "config_ssid.h"
  18. #include "config.h"
  19. #include "wpa_supplicant_i.h"
  20. #include "driver_i.h"
  21. #include "notify.h"
  22. #include "ap.h"
  23. #include "mesh_mpm.h"
  24. #include "mesh_rsn.h"
  25. #include "mesh.h"
  26. static void wpa_supplicant_mesh_deinit(struct wpa_supplicant *wpa_s)
  27. {
  28. wpa_supplicant_mesh_iface_deinit(wpa_s, wpa_s->ifmsh);
  29. wpa_s->ifmsh = NULL;
  30. wpa_s->current_ssid = NULL;
  31. os_free(wpa_s->mesh_rsn);
  32. wpa_s->mesh_rsn = NULL;
  33. /* TODO: leave mesh (stop beacon). This will happen on link down
  34. * anyway, so it's not urgent */
  35. }
  36. void wpa_supplicant_mesh_iface_deinit(struct wpa_supplicant *wpa_s,
  37. struct hostapd_iface *ifmsh)
  38. {
  39. if (!ifmsh)
  40. return;
  41. if (ifmsh->mconf) {
  42. mesh_mpm_deinit(wpa_s, ifmsh);
  43. if (ifmsh->mconf->rsn_ie) {
  44. ifmsh->mconf->rsn_ie = NULL;
  45. /* We cannot free this struct
  46. * because wpa_authenticator on
  47. * hostapd side is also using it
  48. * for now just set to NULL and
  49. * let hostapd code free it.
  50. */
  51. }
  52. os_free(ifmsh->mconf);
  53. ifmsh->mconf = NULL;
  54. }
  55. /* take care of shared data */
  56. hostapd_interface_deinit(ifmsh);
  57. hostapd_interface_free(ifmsh);
  58. }
  59. static struct mesh_conf * mesh_config_create(struct wpa_supplicant *wpa_s,
  60. struct wpa_ssid *ssid)
  61. {
  62. struct mesh_conf *conf;
  63. int cipher;
  64. conf = os_zalloc(sizeof(struct mesh_conf));
  65. if (!conf)
  66. return NULL;
  67. os_memcpy(conf->meshid, ssid->ssid, ssid->ssid_len);
  68. conf->meshid_len = ssid->ssid_len;
  69. if (ssid->key_mgmt & WPA_KEY_MGMT_SAE)
  70. conf->security |= MESH_CONF_SEC_AUTH |
  71. MESH_CONF_SEC_AMPE;
  72. else
  73. conf->security |= MESH_CONF_SEC_NONE;
  74. conf->ieee80211w = ssid->ieee80211w;
  75. if (conf->ieee80211w == MGMT_FRAME_PROTECTION_DEFAULT) {
  76. if (wpa_s->drv_enc & WPA_DRIVER_CAPA_ENC_BIP)
  77. conf->ieee80211w = wpa_s->conf->pmf;
  78. else
  79. conf->ieee80211w = NO_MGMT_FRAME_PROTECTION;
  80. }
  81. cipher = wpa_pick_pairwise_cipher(ssid->pairwise_cipher, 0);
  82. if (cipher < 0 || cipher == WPA_CIPHER_TKIP) {
  83. wpa_msg(wpa_s, MSG_INFO, "mesh: Invalid pairwise cipher");
  84. os_free(conf);
  85. return NULL;
  86. }
  87. conf->pairwise_cipher = cipher;
  88. cipher = wpa_pick_group_cipher(ssid->group_cipher);
  89. if (cipher < 0 || cipher == WPA_CIPHER_TKIP ||
  90. cipher == WPA_CIPHER_GTK_NOT_USED) {
  91. wpa_msg(wpa_s, MSG_INFO, "mesh: Invalid group cipher");
  92. os_free(conf);
  93. return NULL;
  94. }
  95. conf->group_cipher = cipher;
  96. if (conf->ieee80211w != NO_MGMT_FRAME_PROTECTION)
  97. conf->mgmt_group_cipher = WPA_CIPHER_AES_128_CMAC;
  98. /* defaults */
  99. conf->mesh_pp_id = MESH_PATH_PROTOCOL_HWMP;
  100. conf->mesh_pm_id = MESH_PATH_METRIC_AIRTIME;
  101. conf->mesh_cc_id = 0;
  102. conf->mesh_sp_id = MESH_SYNC_METHOD_NEIGHBOR_OFFSET;
  103. conf->mesh_auth_id = (conf->security & MESH_CONF_SEC_AUTH) ? 1 : 0;
  104. conf->dot11MeshMaxRetries = ssid->dot11MeshMaxRetries;
  105. conf->dot11MeshRetryTimeout = ssid->dot11MeshRetryTimeout;
  106. conf->dot11MeshConfirmTimeout = ssid->dot11MeshConfirmTimeout;
  107. conf->dot11MeshHoldingTimeout = ssid->dot11MeshHoldingTimeout;
  108. return conf;
  109. }
  110. static void wpas_mesh_copy_groups(struct hostapd_data *bss,
  111. struct wpa_supplicant *wpa_s)
  112. {
  113. int num_groups;
  114. size_t groups_size;
  115. for (num_groups = 0; wpa_s->conf->sae_groups[num_groups] > 0;
  116. num_groups++)
  117. ;
  118. groups_size = (num_groups + 1) * sizeof(wpa_s->conf->sae_groups[0]);
  119. bss->conf->sae_groups = os_malloc(groups_size);
  120. if (bss->conf->sae_groups)
  121. os_memcpy(bss->conf->sae_groups, wpa_s->conf->sae_groups,
  122. groups_size);
  123. }
  124. static int wpa_supplicant_mesh_init(struct wpa_supplicant *wpa_s,
  125. struct wpa_ssid *ssid,
  126. struct hostapd_freq_params *freq)
  127. {
  128. struct hostapd_iface *ifmsh;
  129. struct hostapd_data *bss;
  130. struct hostapd_config *conf;
  131. struct mesh_conf *mconf;
  132. int basic_rates_erp[] = { 10, 20, 55, 60, 110, 120, 240, -1 };
  133. static int default_groups[] = { 19, 20, 21, 25, 26, -1 };
  134. size_t len;
  135. int rate_len;
  136. int frequency;
  137. if (!wpa_s->conf->user_mpm) {
  138. /* not much for us to do here */
  139. wpa_msg(wpa_s, MSG_WARNING,
  140. "user_mpm is not enabled in configuration");
  141. return 0;
  142. }
  143. wpa_s->ifmsh = ifmsh = os_zalloc(sizeof(*wpa_s->ifmsh));
  144. if (!ifmsh)
  145. return -ENOMEM;
  146. ifmsh->drv_flags = wpa_s->drv_flags;
  147. ifmsh->num_bss = 1;
  148. ifmsh->bss = os_calloc(wpa_s->ifmsh->num_bss,
  149. sizeof(struct hostapd_data *));
  150. if (!ifmsh->bss)
  151. goto out_free;
  152. ifmsh->bss[0] = bss = os_zalloc(sizeof(struct hostapd_data));
  153. if (!bss)
  154. goto out_free;
  155. dl_list_init(&bss->nr_db);
  156. os_memcpy(bss->own_addr, wpa_s->own_addr, ETH_ALEN);
  157. bss->driver = wpa_s->driver;
  158. bss->drv_priv = wpa_s->drv_priv;
  159. bss->iface = ifmsh;
  160. bss->mesh_sta_free_cb = mesh_mpm_free_sta;
  161. frequency = ssid->frequency;
  162. if (frequency != freq->freq &&
  163. frequency == freq->freq + freq->sec_channel_offset * 20) {
  164. wpa_printf(MSG_DEBUG, "mesh: pri/sec channels switched");
  165. frequency = freq->freq;
  166. }
  167. wpa_s->assoc_freq = frequency;
  168. wpa_s->current_ssid = ssid;
  169. /* setup an AP config for auth processing */
  170. conf = hostapd_config_defaults();
  171. if (!conf)
  172. goto out_free;
  173. bss->conf = *conf->bss;
  174. bss->conf->start_disabled = 1;
  175. bss->conf->mesh = MESH_ENABLED;
  176. bss->conf->ap_max_inactivity = wpa_s->conf->mesh_max_inactivity;
  177. bss->iconf = conf;
  178. ifmsh->conf = conf;
  179. ifmsh->bss[0]->max_plinks = wpa_s->conf->max_peer_links;
  180. ifmsh->bss[0]->dot11RSNASAERetransPeriod =
  181. wpa_s->conf->dot11RSNASAERetransPeriod;
  182. os_strlcpy(bss->conf->iface, wpa_s->ifname, sizeof(bss->conf->iface));
  183. mconf = mesh_config_create(wpa_s, ssid);
  184. if (!mconf)
  185. goto out_free;
  186. ifmsh->mconf = mconf;
  187. /* need conf->hw_mode for supported rates. */
  188. conf->hw_mode = ieee80211_freq_to_chan(frequency, &conf->channel);
  189. if (conf->hw_mode == NUM_HOSTAPD_MODES) {
  190. wpa_printf(MSG_ERROR, "Unsupported mesh mode frequency: %d MHz",
  191. frequency);
  192. goto out_free;
  193. }
  194. if (ssid->ht40)
  195. conf->secondary_channel = ssid->ht40;
  196. if (conf->hw_mode == HOSTAPD_MODE_IEEE80211A && ssid->vht) {
  197. conf->vht_oper_chwidth = ssid->max_oper_chwidth;
  198. switch (conf->vht_oper_chwidth) {
  199. case VHT_CHANWIDTH_80MHZ:
  200. case VHT_CHANWIDTH_80P80MHZ:
  201. ieee80211_freq_to_chan(
  202. frequency,
  203. &conf->vht_oper_centr_freq_seg0_idx);
  204. conf->vht_oper_centr_freq_seg0_idx += ssid->ht40 * 2;
  205. break;
  206. case VHT_CHANWIDTH_160MHZ:
  207. ieee80211_freq_to_chan(
  208. frequency,
  209. &conf->vht_oper_centr_freq_seg0_idx);
  210. conf->vht_oper_centr_freq_seg0_idx += ssid->ht40 * 2;
  211. conf->vht_oper_centr_freq_seg0_idx += 40 / 5;
  212. break;
  213. }
  214. ieee80211_freq_to_chan(ssid->vht_center_freq2,
  215. &conf->vht_oper_centr_freq_seg1_idx);
  216. }
  217. if (ssid->mesh_basic_rates == NULL) {
  218. /*
  219. * XXX: Hack! This is so an MPM which correctly sets the ERP
  220. * mandatory rates as BSSBasicRateSet doesn't reject us. We
  221. * could add a new hw_mode HOSTAPD_MODE_IEEE80211G_ERP, but
  222. * this is way easier. This also makes our BSSBasicRateSet
  223. * advertised in beacons match the one in peering frames, sigh.
  224. */
  225. if (conf->hw_mode == HOSTAPD_MODE_IEEE80211G) {
  226. conf->basic_rates = os_malloc(sizeof(basic_rates_erp));
  227. if (!conf->basic_rates)
  228. goto out_free;
  229. os_memcpy(conf->basic_rates, basic_rates_erp,
  230. sizeof(basic_rates_erp));
  231. }
  232. } else {
  233. rate_len = 0;
  234. while (1) {
  235. if (ssid->mesh_basic_rates[rate_len] < 1)
  236. break;
  237. rate_len++;
  238. }
  239. conf->basic_rates = os_calloc(rate_len + 1, sizeof(int));
  240. if (conf->basic_rates == NULL)
  241. goto out_free;
  242. os_memcpy(conf->basic_rates, ssid->mesh_basic_rates,
  243. rate_len * sizeof(int));
  244. conf->basic_rates[rate_len] = -1;
  245. }
  246. if (hostapd_setup_interface(ifmsh)) {
  247. wpa_printf(MSG_ERROR,
  248. "Failed to initialize hostapd interface for mesh");
  249. return -1;
  250. }
  251. if (wpa_drv_init_mesh(wpa_s)) {
  252. wpa_msg(wpa_s, MSG_ERROR, "Failed to init mesh in driver");
  253. return -1;
  254. }
  255. if (mconf->security != MESH_CONF_SEC_NONE) {
  256. if (ssid->passphrase == NULL) {
  257. wpa_printf(MSG_ERROR,
  258. "mesh: Passphrase for SAE not configured");
  259. goto out_free;
  260. }
  261. bss->conf->wpa = ssid->proto;
  262. bss->conf->wpa_key_mgmt = ssid->key_mgmt;
  263. if (wpa_s->conf->sae_groups &&
  264. wpa_s->conf->sae_groups[0] > 0) {
  265. wpas_mesh_copy_groups(bss, wpa_s);
  266. } else {
  267. bss->conf->sae_groups =
  268. os_malloc(sizeof(default_groups));
  269. if (!bss->conf->sae_groups)
  270. goto out_free;
  271. os_memcpy(bss->conf->sae_groups, default_groups,
  272. sizeof(default_groups));
  273. }
  274. len = os_strlen(ssid->passphrase);
  275. bss->conf->ssid.wpa_passphrase =
  276. dup_binstr(ssid->passphrase, len);
  277. wpa_s->mesh_rsn = mesh_rsn_auth_init(wpa_s, mconf);
  278. if (!wpa_s->mesh_rsn)
  279. goto out_free;
  280. }
  281. wpa_supplicant_conf_ap_ht(wpa_s, ssid, conf);
  282. return 0;
  283. out_free:
  284. wpa_supplicant_mesh_deinit(wpa_s);
  285. return -ENOMEM;
  286. }
  287. void wpa_mesh_notify_peer(struct wpa_supplicant *wpa_s, const u8 *addr,
  288. const u8 *ies, size_t ie_len)
  289. {
  290. struct ieee802_11_elems elems;
  291. wpa_msg(wpa_s, MSG_INFO,
  292. "new peer notification for " MACSTR, MAC2STR(addr));
  293. if (ieee802_11_parse_elems(ies, ie_len, &elems, 0) == ParseFailed) {
  294. wpa_msg(wpa_s, MSG_INFO, "Could not parse beacon from " MACSTR,
  295. MAC2STR(addr));
  296. return;
  297. }
  298. wpa_mesh_new_mesh_peer(wpa_s, addr, &elems);
  299. }
  300. void wpa_supplicant_mesh_add_scan_ie(struct wpa_supplicant *wpa_s,
  301. struct wpabuf **extra_ie)
  302. {
  303. /* EID + 0-length (wildcard) mesh-id */
  304. size_t ielen = 2;
  305. if (wpabuf_resize(extra_ie, ielen) == 0) {
  306. wpabuf_put_u8(*extra_ie, WLAN_EID_MESH_ID);
  307. wpabuf_put_u8(*extra_ie, 0);
  308. }
  309. }
  310. int wpa_supplicant_join_mesh(struct wpa_supplicant *wpa_s,
  311. struct wpa_ssid *ssid)
  312. {
  313. struct wpa_driver_mesh_join_params params;
  314. int ret = 0;
  315. if (!ssid || !ssid->ssid || !ssid->ssid_len || !ssid->frequency) {
  316. ret = -ENOENT;
  317. goto out;
  318. }
  319. wpa_supplicant_mesh_deinit(wpa_s);
  320. wpa_s->pairwise_cipher = WPA_CIPHER_NONE;
  321. wpa_s->group_cipher = WPA_CIPHER_NONE;
  322. wpa_s->mgmt_group_cipher = 0;
  323. os_memset(&params, 0, sizeof(params));
  324. params.meshid = ssid->ssid;
  325. params.meshid_len = ssid->ssid_len;
  326. ibss_mesh_setup_freq(wpa_s, ssid, &params.freq);
  327. wpa_s->mesh_ht_enabled = !!params.freq.ht_enabled;
  328. wpa_s->mesh_vht_enabled = !!params.freq.vht_enabled;
  329. if (params.freq.ht_enabled && params.freq.sec_channel_offset)
  330. ssid->ht40 = params.freq.sec_channel_offset;
  331. if (wpa_s->mesh_vht_enabled) {
  332. ssid->vht = 1;
  333. switch (params.freq.bandwidth) {
  334. case 80:
  335. if (params.freq.center_freq2) {
  336. ssid->max_oper_chwidth = VHT_CHANWIDTH_80P80MHZ;
  337. ssid->vht_center_freq2 =
  338. params.freq.center_freq2;
  339. } else {
  340. ssid->max_oper_chwidth = VHT_CHANWIDTH_80MHZ;
  341. }
  342. break;
  343. case 160:
  344. ssid->max_oper_chwidth = VHT_CHANWIDTH_160MHZ;
  345. break;
  346. default:
  347. ssid->max_oper_chwidth = VHT_CHANWIDTH_USE_HT;
  348. break;
  349. }
  350. }
  351. if (ssid->beacon_int > 0)
  352. params.beacon_int = ssid->beacon_int;
  353. else if (wpa_s->conf->beacon_int > 0)
  354. params.beacon_int = wpa_s->conf->beacon_int;
  355. if (ssid->dtim_period > 0)
  356. params.dtim_period = ssid->dtim_period;
  357. else if (wpa_s->conf->dtim_period > 0)
  358. params.dtim_period = wpa_s->conf->dtim_period;
  359. params.conf.max_peer_links = wpa_s->conf->max_peer_links;
  360. if (ssid->key_mgmt & WPA_KEY_MGMT_SAE) {
  361. params.flags |= WPA_DRIVER_MESH_FLAG_SAE_AUTH;
  362. params.flags |= WPA_DRIVER_MESH_FLAG_AMPE;
  363. wpa_s->conf->user_mpm = 1;
  364. }
  365. if (wpa_s->conf->user_mpm) {
  366. params.flags |= WPA_DRIVER_MESH_FLAG_USER_MPM;
  367. params.conf.auto_plinks = 0;
  368. } else {
  369. params.flags |= WPA_DRIVER_MESH_FLAG_DRIVER_MPM;
  370. params.conf.auto_plinks = 1;
  371. }
  372. params.conf.peer_link_timeout = wpa_s->conf->mesh_max_inactivity;
  373. if (wpa_supplicant_mesh_init(wpa_s, ssid, &params.freq)) {
  374. wpa_msg(wpa_s, MSG_ERROR, "Failed to init mesh");
  375. wpa_drv_leave_mesh(wpa_s);
  376. ret = -1;
  377. goto out;
  378. }
  379. if (ssid->key_mgmt & WPA_KEY_MGMT_SAE) {
  380. wpa_s->pairwise_cipher = wpa_s->mesh_rsn->pairwise_cipher;
  381. wpa_s->group_cipher = wpa_s->mesh_rsn->group_cipher;
  382. wpa_s->mgmt_group_cipher = wpa_s->mesh_rsn->mgmt_group_cipher;
  383. }
  384. if (wpa_s->ifmsh) {
  385. params.ies = wpa_s->ifmsh->mconf->rsn_ie;
  386. params.ie_len = wpa_s->ifmsh->mconf->rsn_ie_len;
  387. params.basic_rates = wpa_s->ifmsh->basic_rates;
  388. params.conf.flags |= WPA_DRIVER_MESH_CONF_FLAG_HT_OP_MODE;
  389. params.conf.ht_opmode = wpa_s->ifmsh->bss[0]->iface->ht_op_mode;
  390. }
  391. wpa_msg(wpa_s, MSG_INFO, "joining mesh %s",
  392. wpa_ssid_txt(ssid->ssid, ssid->ssid_len));
  393. ret = wpa_drv_join_mesh(wpa_s, &params);
  394. if (ret)
  395. wpa_msg(wpa_s, MSG_ERROR, "mesh join error=%d", ret);
  396. /* hostapd sets the interface down until we associate */
  397. wpa_drv_set_operstate(wpa_s, 1);
  398. if (!ret)
  399. wpa_supplicant_set_state(wpa_s, WPA_COMPLETED);
  400. out:
  401. return ret;
  402. }
  403. int wpa_supplicant_leave_mesh(struct wpa_supplicant *wpa_s)
  404. {
  405. int ret = 0;
  406. wpa_msg(wpa_s, MSG_INFO, "leaving mesh");
  407. /* Need to send peering close messages first */
  408. wpa_supplicant_mesh_deinit(wpa_s);
  409. ret = wpa_drv_leave_mesh(wpa_s);
  410. if (ret)
  411. wpa_msg(wpa_s, MSG_ERROR, "mesh leave error=%d", ret);
  412. wpa_drv_set_operstate(wpa_s, 1);
  413. return ret;
  414. }
  415. static int mesh_attr_text(const u8 *ies, size_t ies_len, char *buf, char *end)
  416. {
  417. struct ieee802_11_elems elems;
  418. char *mesh_id, *pos = buf;
  419. u8 *bss_basic_rate_set;
  420. int bss_basic_rate_set_len, ret, i;
  421. if (ieee802_11_parse_elems(ies, ies_len, &elems, 0) == ParseFailed)
  422. return -1;
  423. if (elems.mesh_id_len < 1)
  424. return 0;
  425. mesh_id = os_malloc(elems.mesh_id_len + 1);
  426. if (mesh_id == NULL)
  427. return -1;
  428. os_memcpy(mesh_id, elems.mesh_id, elems.mesh_id_len);
  429. mesh_id[elems.mesh_id_len] = '\0';
  430. ret = os_snprintf(pos, end - pos, "mesh_id=%s\n", mesh_id);
  431. os_free(mesh_id);
  432. if (os_snprintf_error(end - pos, ret))
  433. return pos - buf;
  434. pos += ret;
  435. if (elems.mesh_config_len > 6) {
  436. ret = os_snprintf(pos, end - pos,
  437. "active_path_selection_protocol_id=0x%02x\n"
  438. "active_path_selection_metric_id=0x%02x\n"
  439. "congestion_control_mode_id=0x%02x\n"
  440. "synchronization_method_id=0x%02x\n"
  441. "authentication_protocol_id=0x%02x\n"
  442. "mesh_formation_info=0x%02x\n"
  443. "mesh_capability=0x%02x\n",
  444. elems.mesh_config[0], elems.mesh_config[1],
  445. elems.mesh_config[2], elems.mesh_config[3],
  446. elems.mesh_config[4], elems.mesh_config[5],
  447. elems.mesh_config[6]);
  448. if (os_snprintf_error(end - pos, ret))
  449. return pos - buf;
  450. pos += ret;
  451. }
  452. bss_basic_rate_set = os_malloc(elems.supp_rates_len +
  453. elems.ext_supp_rates_len);
  454. if (bss_basic_rate_set == NULL)
  455. return -1;
  456. bss_basic_rate_set_len = 0;
  457. for (i = 0; i < elems.supp_rates_len; i++) {
  458. if (elems.supp_rates[i] & 0x80) {
  459. bss_basic_rate_set[bss_basic_rate_set_len++] =
  460. (elems.supp_rates[i] & 0x7f) * 5;
  461. }
  462. }
  463. for (i = 0; i < elems.ext_supp_rates_len; i++) {
  464. if (elems.ext_supp_rates[i] & 0x80) {
  465. bss_basic_rate_set[bss_basic_rate_set_len++] =
  466. (elems.ext_supp_rates[i] & 0x7f) * 5;
  467. }
  468. }
  469. if (bss_basic_rate_set_len > 0) {
  470. ret = os_snprintf(pos, end - pos, "bss_basic_rate_set=%d",
  471. bss_basic_rate_set[0]);
  472. if (os_snprintf_error(end - pos, ret))
  473. goto fail;
  474. pos += ret;
  475. for (i = 1; i < bss_basic_rate_set_len; i++) {
  476. ret = os_snprintf(pos, end - pos, " %d",
  477. bss_basic_rate_set[i]);
  478. if (os_snprintf_error(end - pos, ret))
  479. goto fail;
  480. pos += ret;
  481. }
  482. ret = os_snprintf(pos, end - pos, "\n");
  483. if (os_snprintf_error(end - pos, ret))
  484. goto fail;
  485. pos += ret;
  486. }
  487. fail:
  488. os_free(bss_basic_rate_set);
  489. return pos - buf;
  490. }
  491. int wpas_mesh_scan_result_text(const u8 *ies, size_t ies_len, char *buf,
  492. char *end)
  493. {
  494. return mesh_attr_text(ies, ies_len, buf, end);
  495. }
  496. static int wpas_mesh_get_ifname(struct wpa_supplicant *wpa_s, char *ifname,
  497. size_t len)
  498. {
  499. char *ifname_ptr = wpa_s->ifname;
  500. int res;
  501. res = os_snprintf(ifname, len, "mesh-%s-%d", ifname_ptr,
  502. wpa_s->mesh_if_idx);
  503. if (os_snprintf_error(len, res) ||
  504. (os_strlen(ifname) >= IFNAMSIZ &&
  505. os_strlen(wpa_s->ifname) < IFNAMSIZ)) {
  506. /* Try to avoid going over the IFNAMSIZ length limit */
  507. res = os_snprintf(ifname, len, "mesh-%d", wpa_s->mesh_if_idx);
  508. if (os_snprintf_error(len, res))
  509. return -1;
  510. }
  511. wpa_s->mesh_if_idx++;
  512. return 0;
  513. }
  514. int wpas_mesh_add_interface(struct wpa_supplicant *wpa_s, char *ifname,
  515. size_t len)
  516. {
  517. struct wpa_interface iface;
  518. struct wpa_supplicant *mesh_wpa_s;
  519. u8 addr[ETH_ALEN];
  520. if (ifname[0] == '\0' && wpas_mesh_get_ifname(wpa_s, ifname, len) < 0)
  521. return -1;
  522. if (wpa_drv_if_add(wpa_s, WPA_IF_MESH, ifname, NULL, NULL, NULL, addr,
  523. NULL) < 0) {
  524. wpa_printf(MSG_ERROR,
  525. "mesh: Failed to create new mesh interface");
  526. return -1;
  527. }
  528. wpa_printf(MSG_INFO, "mesh: Created virtual interface %s addr "
  529. MACSTR, ifname, MAC2STR(addr));
  530. os_memset(&iface, 0, sizeof(iface));
  531. iface.ifname = ifname;
  532. iface.driver = wpa_s->driver->name;
  533. iface.driver_param = wpa_s->conf->driver_param;
  534. iface.ctrl_interface = wpa_s->conf->ctrl_interface;
  535. mesh_wpa_s = wpa_supplicant_add_iface(wpa_s->global, &iface, wpa_s);
  536. if (!mesh_wpa_s) {
  537. wpa_printf(MSG_ERROR,
  538. "mesh: Failed to create new wpa_supplicant interface");
  539. wpa_drv_if_remove(wpa_s, WPA_IF_MESH, ifname);
  540. return -1;
  541. }
  542. mesh_wpa_s->mesh_if_created = 1;
  543. return 0;
  544. }
  545. int wpas_mesh_peer_remove(struct wpa_supplicant *wpa_s, const u8 *addr)
  546. {
  547. return mesh_mpm_close_peer(wpa_s, addr);
  548. }
  549. int wpas_mesh_peer_add(struct wpa_supplicant *wpa_s, const u8 *addr,
  550. int duration)
  551. {
  552. return mesh_mpm_connect_peer(wpa_s, addr, duration);
  553. }