mesh.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652
  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 = hostapd_alloc_bss_data(NULL, NULL, NULL);
  153. if (!bss)
  154. goto out_free;
  155. os_memcpy(bss->own_addr, wpa_s->own_addr, ETH_ALEN);
  156. bss->driver = wpa_s->driver;
  157. bss->drv_priv = wpa_s->drv_priv;
  158. bss->iface = ifmsh;
  159. bss->mesh_sta_free_cb = mesh_mpm_free_sta;
  160. frequency = ssid->frequency;
  161. if (frequency != freq->freq &&
  162. frequency == freq->freq + freq->sec_channel_offset * 20) {
  163. wpa_printf(MSG_DEBUG, "mesh: pri/sec channels switched");
  164. frequency = freq->freq;
  165. }
  166. wpa_s->assoc_freq = frequency;
  167. wpa_s->current_ssid = ssid;
  168. /* setup an AP config for auth processing */
  169. conf = hostapd_config_defaults();
  170. if (!conf)
  171. goto out_free;
  172. bss->conf = *conf->bss;
  173. bss->conf->start_disabled = 1;
  174. bss->conf->mesh = MESH_ENABLED;
  175. bss->conf->ap_max_inactivity = wpa_s->conf->mesh_max_inactivity;
  176. bss->iconf = conf;
  177. ifmsh->conf = conf;
  178. ifmsh->bss[0]->max_plinks = wpa_s->conf->max_peer_links;
  179. ifmsh->bss[0]->dot11RSNASAERetransPeriod =
  180. wpa_s->conf->dot11RSNASAERetransPeriod;
  181. os_strlcpy(bss->conf->iface, wpa_s->ifname, sizeof(bss->conf->iface));
  182. mconf = mesh_config_create(wpa_s, ssid);
  183. if (!mconf)
  184. goto out_free;
  185. ifmsh->mconf = mconf;
  186. /* need conf->hw_mode for supported rates. */
  187. conf->hw_mode = ieee80211_freq_to_chan(frequency, &conf->channel);
  188. if (conf->hw_mode == NUM_HOSTAPD_MODES) {
  189. wpa_printf(MSG_ERROR, "Unsupported mesh mode frequency: %d MHz",
  190. frequency);
  191. goto out_free;
  192. }
  193. if (ssid->ht40)
  194. conf->secondary_channel = ssid->ht40;
  195. if (conf->hw_mode == HOSTAPD_MODE_IEEE80211A && ssid->vht) {
  196. conf->vht_oper_chwidth = ssid->max_oper_chwidth;
  197. switch (conf->vht_oper_chwidth) {
  198. case VHT_CHANWIDTH_80MHZ:
  199. case VHT_CHANWIDTH_80P80MHZ:
  200. ieee80211_freq_to_chan(
  201. frequency,
  202. &conf->vht_oper_centr_freq_seg0_idx);
  203. conf->vht_oper_centr_freq_seg0_idx += ssid->ht40 * 2;
  204. break;
  205. case VHT_CHANWIDTH_160MHZ:
  206. ieee80211_freq_to_chan(
  207. frequency,
  208. &conf->vht_oper_centr_freq_seg0_idx);
  209. conf->vht_oper_centr_freq_seg0_idx += ssid->ht40 * 2;
  210. conf->vht_oper_centr_freq_seg0_idx += 40 / 5;
  211. break;
  212. }
  213. ieee80211_freq_to_chan(ssid->vht_center_freq2,
  214. &conf->vht_oper_centr_freq_seg1_idx);
  215. }
  216. if (ssid->mesh_basic_rates == NULL) {
  217. /*
  218. * XXX: Hack! This is so an MPM which correctly sets the ERP
  219. * mandatory rates as BSSBasicRateSet doesn't reject us. We
  220. * could add a new hw_mode HOSTAPD_MODE_IEEE80211G_ERP, but
  221. * this is way easier. This also makes our BSSBasicRateSet
  222. * advertised in beacons match the one in peering frames, sigh.
  223. */
  224. if (conf->hw_mode == HOSTAPD_MODE_IEEE80211G) {
  225. conf->basic_rates = os_malloc(sizeof(basic_rates_erp));
  226. if (!conf->basic_rates)
  227. goto out_free;
  228. os_memcpy(conf->basic_rates, basic_rates_erp,
  229. sizeof(basic_rates_erp));
  230. }
  231. } else {
  232. rate_len = 0;
  233. while (1) {
  234. if (ssid->mesh_basic_rates[rate_len] < 1)
  235. break;
  236. rate_len++;
  237. }
  238. conf->basic_rates = os_calloc(rate_len + 1, sizeof(int));
  239. if (conf->basic_rates == NULL)
  240. goto out_free;
  241. os_memcpy(conf->basic_rates, ssid->mesh_basic_rates,
  242. rate_len * sizeof(int));
  243. conf->basic_rates[rate_len] = -1;
  244. }
  245. if (hostapd_setup_interface(ifmsh)) {
  246. wpa_printf(MSG_ERROR,
  247. "Failed to initialize hostapd interface for mesh");
  248. return -1;
  249. }
  250. if (wpa_drv_init_mesh(wpa_s)) {
  251. wpa_msg(wpa_s, MSG_ERROR, "Failed to init mesh in driver");
  252. return -1;
  253. }
  254. if (mconf->security != MESH_CONF_SEC_NONE) {
  255. if (ssid->passphrase == NULL) {
  256. wpa_printf(MSG_ERROR,
  257. "mesh: Passphrase for SAE not configured");
  258. goto out_free;
  259. }
  260. bss->conf->wpa = ssid->proto;
  261. bss->conf->wpa_key_mgmt = ssid->key_mgmt;
  262. if (wpa_s->conf->sae_groups &&
  263. wpa_s->conf->sae_groups[0] > 0) {
  264. wpas_mesh_copy_groups(bss, wpa_s);
  265. } else {
  266. bss->conf->sae_groups =
  267. os_malloc(sizeof(default_groups));
  268. if (!bss->conf->sae_groups)
  269. goto out_free;
  270. os_memcpy(bss->conf->sae_groups, default_groups,
  271. sizeof(default_groups));
  272. }
  273. len = os_strlen(ssid->passphrase);
  274. bss->conf->ssid.wpa_passphrase =
  275. dup_binstr(ssid->passphrase, len);
  276. wpa_s->mesh_rsn = mesh_rsn_auth_init(wpa_s, mconf);
  277. if (!wpa_s->mesh_rsn)
  278. goto out_free;
  279. }
  280. wpa_supplicant_conf_ap_ht(wpa_s, ssid, conf);
  281. return 0;
  282. out_free:
  283. wpa_supplicant_mesh_deinit(wpa_s);
  284. return -ENOMEM;
  285. }
  286. void wpa_mesh_notify_peer(struct wpa_supplicant *wpa_s, const u8 *addr,
  287. const u8 *ies, size_t ie_len)
  288. {
  289. struct ieee802_11_elems elems;
  290. wpa_msg(wpa_s, MSG_INFO,
  291. "new peer notification for " MACSTR, MAC2STR(addr));
  292. if (ieee802_11_parse_elems(ies, ie_len, &elems, 0) == ParseFailed) {
  293. wpa_msg(wpa_s, MSG_INFO, "Could not parse beacon from " MACSTR,
  294. MAC2STR(addr));
  295. return;
  296. }
  297. wpa_mesh_new_mesh_peer(wpa_s, addr, &elems);
  298. }
  299. void wpa_supplicant_mesh_add_scan_ie(struct wpa_supplicant *wpa_s,
  300. struct wpabuf **extra_ie)
  301. {
  302. /* EID + 0-length (wildcard) mesh-id */
  303. size_t ielen = 2;
  304. if (wpabuf_resize(extra_ie, ielen) == 0) {
  305. wpabuf_put_u8(*extra_ie, WLAN_EID_MESH_ID);
  306. wpabuf_put_u8(*extra_ie, 0);
  307. }
  308. }
  309. int wpa_supplicant_join_mesh(struct wpa_supplicant *wpa_s,
  310. struct wpa_ssid *ssid)
  311. {
  312. struct wpa_driver_mesh_join_params params;
  313. int ret = 0;
  314. if (!ssid || !ssid->ssid || !ssid->ssid_len || !ssid->frequency) {
  315. ret = -ENOENT;
  316. goto out;
  317. }
  318. wpa_supplicant_mesh_deinit(wpa_s);
  319. wpa_s->pairwise_cipher = WPA_CIPHER_NONE;
  320. wpa_s->group_cipher = WPA_CIPHER_NONE;
  321. wpa_s->mgmt_group_cipher = 0;
  322. os_memset(&params, 0, sizeof(params));
  323. params.meshid = ssid->ssid;
  324. params.meshid_len = ssid->ssid_len;
  325. ibss_mesh_setup_freq(wpa_s, ssid, &params.freq);
  326. wpa_s->mesh_ht_enabled = !!params.freq.ht_enabled;
  327. wpa_s->mesh_vht_enabled = !!params.freq.vht_enabled;
  328. if (params.freq.ht_enabled && params.freq.sec_channel_offset)
  329. ssid->ht40 = params.freq.sec_channel_offset;
  330. if (wpa_s->mesh_vht_enabled) {
  331. ssid->vht = 1;
  332. switch (params.freq.bandwidth) {
  333. case 80:
  334. if (params.freq.center_freq2) {
  335. ssid->max_oper_chwidth = VHT_CHANWIDTH_80P80MHZ;
  336. ssid->vht_center_freq2 =
  337. params.freq.center_freq2;
  338. } else {
  339. ssid->max_oper_chwidth = VHT_CHANWIDTH_80MHZ;
  340. }
  341. break;
  342. case 160:
  343. ssid->max_oper_chwidth = VHT_CHANWIDTH_160MHZ;
  344. break;
  345. default:
  346. ssid->max_oper_chwidth = VHT_CHANWIDTH_USE_HT;
  347. break;
  348. }
  349. }
  350. if (ssid->beacon_int > 0)
  351. params.beacon_int = ssid->beacon_int;
  352. else if (wpa_s->conf->beacon_int > 0)
  353. params.beacon_int = wpa_s->conf->beacon_int;
  354. if (ssid->dtim_period > 0)
  355. params.dtim_period = ssid->dtim_period;
  356. else if (wpa_s->conf->dtim_period > 0)
  357. params.dtim_period = wpa_s->conf->dtim_period;
  358. params.conf.max_peer_links = wpa_s->conf->max_peer_links;
  359. if (ssid->key_mgmt & WPA_KEY_MGMT_SAE) {
  360. params.flags |= WPA_DRIVER_MESH_FLAG_SAE_AUTH;
  361. params.flags |= WPA_DRIVER_MESH_FLAG_AMPE;
  362. wpa_s->conf->user_mpm = 1;
  363. }
  364. if (wpa_s->conf->user_mpm) {
  365. params.flags |= WPA_DRIVER_MESH_FLAG_USER_MPM;
  366. params.conf.auto_plinks = 0;
  367. } else {
  368. params.flags |= WPA_DRIVER_MESH_FLAG_DRIVER_MPM;
  369. params.conf.auto_plinks = 1;
  370. }
  371. params.conf.peer_link_timeout = wpa_s->conf->mesh_max_inactivity;
  372. if (wpa_supplicant_mesh_init(wpa_s, ssid, &params.freq)) {
  373. wpa_msg(wpa_s, MSG_ERROR, "Failed to init mesh");
  374. wpa_drv_leave_mesh(wpa_s);
  375. ret = -1;
  376. goto out;
  377. }
  378. if (ssid->key_mgmt & WPA_KEY_MGMT_SAE) {
  379. wpa_s->pairwise_cipher = wpa_s->mesh_rsn->pairwise_cipher;
  380. wpa_s->group_cipher = wpa_s->mesh_rsn->group_cipher;
  381. wpa_s->mgmt_group_cipher = wpa_s->mesh_rsn->mgmt_group_cipher;
  382. }
  383. if (wpa_s->ifmsh) {
  384. params.ies = wpa_s->ifmsh->mconf->rsn_ie;
  385. params.ie_len = wpa_s->ifmsh->mconf->rsn_ie_len;
  386. params.basic_rates = wpa_s->ifmsh->basic_rates;
  387. params.conf.flags |= WPA_DRIVER_MESH_CONF_FLAG_HT_OP_MODE;
  388. params.conf.ht_opmode = wpa_s->ifmsh->bss[0]->iface->ht_op_mode;
  389. }
  390. wpa_msg(wpa_s, MSG_INFO, "joining mesh %s",
  391. wpa_ssid_txt(ssid->ssid, ssid->ssid_len));
  392. ret = wpa_drv_join_mesh(wpa_s, &params);
  393. if (ret)
  394. wpa_msg(wpa_s, MSG_ERROR, "mesh join error=%d", ret);
  395. /* hostapd sets the interface down until we associate */
  396. wpa_drv_set_operstate(wpa_s, 1);
  397. if (!ret)
  398. wpa_supplicant_set_state(wpa_s, WPA_COMPLETED);
  399. out:
  400. return ret;
  401. }
  402. int wpa_supplicant_leave_mesh(struct wpa_supplicant *wpa_s)
  403. {
  404. int ret = 0;
  405. wpa_msg(wpa_s, MSG_INFO, "leaving mesh");
  406. /* Need to send peering close messages first */
  407. wpa_supplicant_mesh_deinit(wpa_s);
  408. ret = wpa_drv_leave_mesh(wpa_s);
  409. if (ret)
  410. wpa_msg(wpa_s, MSG_ERROR, "mesh leave error=%d", ret);
  411. wpa_drv_set_operstate(wpa_s, 1);
  412. return ret;
  413. }
  414. static int mesh_attr_text(const u8 *ies, size_t ies_len, char *buf, char *end)
  415. {
  416. struct ieee802_11_elems elems;
  417. char *mesh_id, *pos = buf;
  418. u8 *bss_basic_rate_set;
  419. int bss_basic_rate_set_len, ret, i;
  420. if (ieee802_11_parse_elems(ies, ies_len, &elems, 0) == ParseFailed)
  421. return -1;
  422. if (elems.mesh_id_len < 1)
  423. return 0;
  424. mesh_id = os_malloc(elems.mesh_id_len + 1);
  425. if (mesh_id == NULL)
  426. return -1;
  427. os_memcpy(mesh_id, elems.mesh_id, elems.mesh_id_len);
  428. mesh_id[elems.mesh_id_len] = '\0';
  429. ret = os_snprintf(pos, end - pos, "mesh_id=%s\n", mesh_id);
  430. os_free(mesh_id);
  431. if (os_snprintf_error(end - pos, ret))
  432. return pos - buf;
  433. pos += ret;
  434. if (elems.mesh_config_len > 6) {
  435. ret = os_snprintf(pos, end - pos,
  436. "active_path_selection_protocol_id=0x%02x\n"
  437. "active_path_selection_metric_id=0x%02x\n"
  438. "congestion_control_mode_id=0x%02x\n"
  439. "synchronization_method_id=0x%02x\n"
  440. "authentication_protocol_id=0x%02x\n"
  441. "mesh_formation_info=0x%02x\n"
  442. "mesh_capability=0x%02x\n",
  443. elems.mesh_config[0], elems.mesh_config[1],
  444. elems.mesh_config[2], elems.mesh_config[3],
  445. elems.mesh_config[4], elems.mesh_config[5],
  446. elems.mesh_config[6]);
  447. if (os_snprintf_error(end - pos, ret))
  448. return pos - buf;
  449. pos += ret;
  450. }
  451. bss_basic_rate_set = os_malloc(elems.supp_rates_len +
  452. elems.ext_supp_rates_len);
  453. if (bss_basic_rate_set == NULL)
  454. return -1;
  455. bss_basic_rate_set_len = 0;
  456. for (i = 0; i < elems.supp_rates_len; i++) {
  457. if (elems.supp_rates[i] & 0x80) {
  458. bss_basic_rate_set[bss_basic_rate_set_len++] =
  459. (elems.supp_rates[i] & 0x7f) * 5;
  460. }
  461. }
  462. for (i = 0; i < elems.ext_supp_rates_len; i++) {
  463. if (elems.ext_supp_rates[i] & 0x80) {
  464. bss_basic_rate_set[bss_basic_rate_set_len++] =
  465. (elems.ext_supp_rates[i] & 0x7f) * 5;
  466. }
  467. }
  468. if (bss_basic_rate_set_len > 0) {
  469. ret = os_snprintf(pos, end - pos, "bss_basic_rate_set=%d",
  470. bss_basic_rate_set[0]);
  471. if (os_snprintf_error(end - pos, ret))
  472. goto fail;
  473. pos += ret;
  474. for (i = 1; i < bss_basic_rate_set_len; i++) {
  475. ret = os_snprintf(pos, end - pos, " %d",
  476. bss_basic_rate_set[i]);
  477. if (os_snprintf_error(end - pos, ret))
  478. goto fail;
  479. pos += ret;
  480. }
  481. ret = os_snprintf(pos, end - pos, "\n");
  482. if (os_snprintf_error(end - pos, ret))
  483. goto fail;
  484. pos += ret;
  485. }
  486. fail:
  487. os_free(bss_basic_rate_set);
  488. return pos - buf;
  489. }
  490. int wpas_mesh_scan_result_text(const u8 *ies, size_t ies_len, char *buf,
  491. char *end)
  492. {
  493. return mesh_attr_text(ies, ies_len, buf, end);
  494. }
  495. static int wpas_mesh_get_ifname(struct wpa_supplicant *wpa_s, char *ifname,
  496. size_t len)
  497. {
  498. char *ifname_ptr = wpa_s->ifname;
  499. int res;
  500. res = os_snprintf(ifname, len, "mesh-%s-%d", ifname_ptr,
  501. wpa_s->mesh_if_idx);
  502. if (os_snprintf_error(len, res) ||
  503. (os_strlen(ifname) >= IFNAMSIZ &&
  504. os_strlen(wpa_s->ifname) < IFNAMSIZ)) {
  505. /* Try to avoid going over the IFNAMSIZ length limit */
  506. res = os_snprintf(ifname, len, "mesh-%d", wpa_s->mesh_if_idx);
  507. if (os_snprintf_error(len, res))
  508. return -1;
  509. }
  510. wpa_s->mesh_if_idx++;
  511. return 0;
  512. }
  513. int wpas_mesh_add_interface(struct wpa_supplicant *wpa_s, char *ifname,
  514. size_t len)
  515. {
  516. struct wpa_interface iface;
  517. struct wpa_supplicant *mesh_wpa_s;
  518. u8 addr[ETH_ALEN];
  519. if (ifname[0] == '\0' && wpas_mesh_get_ifname(wpa_s, ifname, len) < 0)
  520. return -1;
  521. if (wpa_drv_if_add(wpa_s, WPA_IF_MESH, ifname, NULL, NULL, NULL, addr,
  522. NULL) < 0) {
  523. wpa_printf(MSG_ERROR,
  524. "mesh: Failed to create new mesh interface");
  525. return -1;
  526. }
  527. wpa_printf(MSG_INFO, "mesh: Created virtual interface %s addr "
  528. MACSTR, ifname, MAC2STR(addr));
  529. os_memset(&iface, 0, sizeof(iface));
  530. iface.ifname = ifname;
  531. iface.driver = wpa_s->driver->name;
  532. iface.driver_param = wpa_s->conf->driver_param;
  533. iface.ctrl_interface = wpa_s->conf->ctrl_interface;
  534. mesh_wpa_s = wpa_supplicant_add_iface(wpa_s->global, &iface, wpa_s);
  535. if (!mesh_wpa_s) {
  536. wpa_printf(MSG_ERROR,
  537. "mesh: Failed to create new wpa_supplicant interface");
  538. wpa_drv_if_remove(wpa_s, WPA_IF_MESH, ifname);
  539. return -1;
  540. }
  541. mesh_wpa_s->mesh_if_created = 1;
  542. return 0;
  543. }
  544. int wpas_mesh_peer_remove(struct wpa_supplicant *wpa_s, const u8 *addr)
  545. {
  546. return mesh_mpm_close_peer(wpa_s, addr);
  547. }
  548. int wpas_mesh_peer_add(struct wpa_supplicant *wpa_s, const u8 *addr,
  549. int duration)
  550. {
  551. return mesh_mpm_connect_peer(wpa_s, addr, duration);
  552. }