mesh.c 17 KB

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