mesh.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656
  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_memdup(basic_rates_erp,
  228. sizeof(basic_rates_erp));
  229. if (!conf->basic_rates)
  230. goto out_free;
  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_memdup(default_groups,
  269. sizeof(default_groups));
  270. if (!bss->conf->sae_groups)
  271. goto out_free;
  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->mesh_rssi_threshold < DEFAULT_MESH_RSSI_THRESHOLD) {
  360. params.conf.rssi_threshold = ssid->mesh_rssi_threshold;
  361. params.conf.flags |= WPA_DRIVER_MESH_CONF_FLAG_RSSI_THRESHOLD;
  362. }
  363. if (ssid->key_mgmt & WPA_KEY_MGMT_SAE) {
  364. params.flags |= WPA_DRIVER_MESH_FLAG_SAE_AUTH;
  365. params.flags |= WPA_DRIVER_MESH_FLAG_AMPE;
  366. wpa_s->conf->user_mpm = 1;
  367. }
  368. if (wpa_s->conf->user_mpm) {
  369. params.flags |= WPA_DRIVER_MESH_FLAG_USER_MPM;
  370. params.conf.auto_plinks = 0;
  371. } else {
  372. params.flags |= WPA_DRIVER_MESH_FLAG_DRIVER_MPM;
  373. params.conf.auto_plinks = 1;
  374. }
  375. params.conf.peer_link_timeout = wpa_s->conf->mesh_max_inactivity;
  376. if (wpa_supplicant_mesh_init(wpa_s, ssid, &params.freq)) {
  377. wpa_msg(wpa_s, MSG_ERROR, "Failed to init mesh");
  378. wpa_drv_leave_mesh(wpa_s);
  379. ret = -1;
  380. goto out;
  381. }
  382. if (ssid->key_mgmt & WPA_KEY_MGMT_SAE) {
  383. wpa_s->pairwise_cipher = wpa_s->mesh_rsn->pairwise_cipher;
  384. wpa_s->group_cipher = wpa_s->mesh_rsn->group_cipher;
  385. wpa_s->mgmt_group_cipher = wpa_s->mesh_rsn->mgmt_group_cipher;
  386. }
  387. if (wpa_s->ifmsh) {
  388. params.ies = wpa_s->ifmsh->mconf->rsn_ie;
  389. params.ie_len = wpa_s->ifmsh->mconf->rsn_ie_len;
  390. params.basic_rates = wpa_s->ifmsh->basic_rates;
  391. params.conf.flags |= WPA_DRIVER_MESH_CONF_FLAG_HT_OP_MODE;
  392. params.conf.ht_opmode = wpa_s->ifmsh->bss[0]->iface->ht_op_mode;
  393. }
  394. wpa_msg(wpa_s, MSG_INFO, "joining mesh %s",
  395. wpa_ssid_txt(ssid->ssid, ssid->ssid_len));
  396. ret = wpa_drv_join_mesh(wpa_s, &params);
  397. if (ret)
  398. wpa_msg(wpa_s, MSG_ERROR, "mesh join error=%d", ret);
  399. /* hostapd sets the interface down until we associate */
  400. wpa_drv_set_operstate(wpa_s, 1);
  401. if (!ret)
  402. wpa_supplicant_set_state(wpa_s, WPA_COMPLETED);
  403. out:
  404. return ret;
  405. }
  406. int wpa_supplicant_leave_mesh(struct wpa_supplicant *wpa_s)
  407. {
  408. int ret = 0;
  409. wpa_msg(wpa_s, MSG_INFO, "leaving mesh");
  410. /* Need to send peering close messages first */
  411. wpa_supplicant_mesh_deinit(wpa_s);
  412. ret = wpa_drv_leave_mesh(wpa_s);
  413. if (ret)
  414. wpa_msg(wpa_s, MSG_ERROR, "mesh leave error=%d", ret);
  415. wpa_drv_set_operstate(wpa_s, 1);
  416. return ret;
  417. }
  418. static int mesh_attr_text(const u8 *ies, size_t ies_len, char *buf, char *end)
  419. {
  420. struct ieee802_11_elems elems;
  421. char *mesh_id, *pos = buf;
  422. u8 *bss_basic_rate_set;
  423. int bss_basic_rate_set_len, ret, i;
  424. if (ieee802_11_parse_elems(ies, ies_len, &elems, 0) == ParseFailed)
  425. return -1;
  426. if (elems.mesh_id_len < 1)
  427. return 0;
  428. mesh_id = os_malloc(elems.mesh_id_len + 1);
  429. if (mesh_id == NULL)
  430. return -1;
  431. os_memcpy(mesh_id, elems.mesh_id, elems.mesh_id_len);
  432. mesh_id[elems.mesh_id_len] = '\0';
  433. ret = os_snprintf(pos, end - pos, "mesh_id=%s\n", mesh_id);
  434. os_free(mesh_id);
  435. if (os_snprintf_error(end - pos, ret))
  436. return pos - buf;
  437. pos += ret;
  438. if (elems.mesh_config_len > 6) {
  439. ret = os_snprintf(pos, end - pos,
  440. "active_path_selection_protocol_id=0x%02x\n"
  441. "active_path_selection_metric_id=0x%02x\n"
  442. "congestion_control_mode_id=0x%02x\n"
  443. "synchronization_method_id=0x%02x\n"
  444. "authentication_protocol_id=0x%02x\n"
  445. "mesh_formation_info=0x%02x\n"
  446. "mesh_capability=0x%02x\n",
  447. elems.mesh_config[0], elems.mesh_config[1],
  448. elems.mesh_config[2], elems.mesh_config[3],
  449. elems.mesh_config[4], elems.mesh_config[5],
  450. elems.mesh_config[6]);
  451. if (os_snprintf_error(end - pos, ret))
  452. return pos - buf;
  453. pos += ret;
  454. }
  455. bss_basic_rate_set = os_malloc(elems.supp_rates_len +
  456. elems.ext_supp_rates_len);
  457. if (bss_basic_rate_set == NULL)
  458. return -1;
  459. bss_basic_rate_set_len = 0;
  460. for (i = 0; i < elems.supp_rates_len; i++) {
  461. if (elems.supp_rates[i] & 0x80) {
  462. bss_basic_rate_set[bss_basic_rate_set_len++] =
  463. (elems.supp_rates[i] & 0x7f) * 5;
  464. }
  465. }
  466. for (i = 0; i < elems.ext_supp_rates_len; i++) {
  467. if (elems.ext_supp_rates[i] & 0x80) {
  468. bss_basic_rate_set[bss_basic_rate_set_len++] =
  469. (elems.ext_supp_rates[i] & 0x7f) * 5;
  470. }
  471. }
  472. if (bss_basic_rate_set_len > 0) {
  473. ret = os_snprintf(pos, end - pos, "bss_basic_rate_set=%d",
  474. bss_basic_rate_set[0]);
  475. if (os_snprintf_error(end - pos, ret))
  476. goto fail;
  477. pos += ret;
  478. for (i = 1; i < bss_basic_rate_set_len; i++) {
  479. ret = os_snprintf(pos, end - pos, " %d",
  480. bss_basic_rate_set[i]);
  481. if (os_snprintf_error(end - pos, ret))
  482. goto fail;
  483. pos += ret;
  484. }
  485. ret = os_snprintf(pos, end - pos, "\n");
  486. if (os_snprintf_error(end - pos, ret))
  487. goto fail;
  488. pos += ret;
  489. }
  490. fail:
  491. os_free(bss_basic_rate_set);
  492. return pos - buf;
  493. }
  494. int wpas_mesh_scan_result_text(const u8 *ies, size_t ies_len, char *buf,
  495. char *end)
  496. {
  497. return mesh_attr_text(ies, ies_len, buf, end);
  498. }
  499. static int wpas_mesh_get_ifname(struct wpa_supplicant *wpa_s, char *ifname,
  500. size_t len)
  501. {
  502. char *ifname_ptr = wpa_s->ifname;
  503. int res;
  504. res = os_snprintf(ifname, len, "mesh-%s-%d", ifname_ptr,
  505. wpa_s->mesh_if_idx);
  506. if (os_snprintf_error(len, res) ||
  507. (os_strlen(ifname) >= IFNAMSIZ &&
  508. os_strlen(wpa_s->ifname) < IFNAMSIZ)) {
  509. /* Try to avoid going over the IFNAMSIZ length limit */
  510. res = os_snprintf(ifname, len, "mesh-%d", wpa_s->mesh_if_idx);
  511. if (os_snprintf_error(len, res))
  512. return -1;
  513. }
  514. wpa_s->mesh_if_idx++;
  515. return 0;
  516. }
  517. int wpas_mesh_add_interface(struct wpa_supplicant *wpa_s, char *ifname,
  518. size_t len)
  519. {
  520. struct wpa_interface iface;
  521. struct wpa_supplicant *mesh_wpa_s;
  522. u8 addr[ETH_ALEN];
  523. if (ifname[0] == '\0' && wpas_mesh_get_ifname(wpa_s, ifname, len) < 0)
  524. return -1;
  525. if (wpa_drv_if_add(wpa_s, WPA_IF_MESH, ifname, NULL, NULL, NULL, addr,
  526. NULL) < 0) {
  527. wpa_printf(MSG_ERROR,
  528. "mesh: Failed to create new mesh interface");
  529. return -1;
  530. }
  531. wpa_printf(MSG_INFO, "mesh: Created virtual interface %s addr "
  532. MACSTR, ifname, MAC2STR(addr));
  533. os_memset(&iface, 0, sizeof(iface));
  534. iface.ifname = ifname;
  535. iface.driver = wpa_s->driver->name;
  536. iface.driver_param = wpa_s->conf->driver_param;
  537. iface.ctrl_interface = wpa_s->conf->ctrl_interface;
  538. mesh_wpa_s = wpa_supplicant_add_iface(wpa_s->global, &iface, wpa_s);
  539. if (!mesh_wpa_s) {
  540. wpa_printf(MSG_ERROR,
  541. "mesh: Failed to create new wpa_supplicant interface");
  542. wpa_drv_if_remove(wpa_s, WPA_IF_MESH, ifname);
  543. return -1;
  544. }
  545. mesh_wpa_s->mesh_if_created = 1;
  546. return 0;
  547. }
  548. int wpas_mesh_peer_remove(struct wpa_supplicant *wpa_s, const u8 *addr)
  549. {
  550. return mesh_mpm_close_peer(wpa_s, addr);
  551. }
  552. int wpas_mesh_peer_add(struct wpa_supplicant *wpa_s, const u8 *addr,
  553. int duration)
  554. {
  555. return mesh_mpm_connect_peer(wpa_s, addr, duration);
  556. }