net/mac80211/mesh_plink.c

58 static bool rssi_threshold_check(struct ieee80211_sub_if_data *sdata,
61 	s32 rssi_threshold = sdata->u.mesh.mshcfg.rssi_threshold;
93 static u64 mesh_set_short_slot_time(struct ieee80211_sub_if_data *sdata)
95 	struct ieee80211_local *local = sdata->local;
103 	sband = ieee80211_get_sband(sdata);
124 		if (sdata != sta->sdata ||
137 	if (sdata->vif.bss_conf.use_short_slot != short_slot) {
138 		sdata->vif.bss_conf.use_short_slot = short_slot;
140 		mpl_dbg(sdata, "mesh_plink %pM: ERP short slot time %d\n",
141 			sdata->vif.addr, short_slot);
148  * @sdata: the (mesh) interface to handle
159 static u64 mesh_set_ht_prot_mode(struct ieee80211_sub_if_data *sdata)
161 	struct ieee80211_local *local = sdata->local;
166 	switch (sdata->vif.bss_conf.chanreq.oper.width) {
177 		if (sdata != sta->sdata ||
185 			mpl_dbg(sdata, "nonHT sta (%pM) is present\n",
191 		mpl_dbg(sdata, "HT20 sta (%pM) is present\n", sta->sta.addr);
199 		 sdata->vif.bss_conf.chanreq.oper.width > NL80211_CHAN_WIDTH_20)
204 	if (sdata->vif.bss_conf.ht_operation_mode == ht_opmode)
207 	sdata->vif.bss_conf.ht_operation_mode = ht_opmode;
208 	sdata->u.mesh.mshcfg.ht_opmode = ht_opmode;
209 	mpl_dbg(sdata, "selected new HT protection mode %d\n", ht_opmode);
213 static int mesh_plink_frame_tx(struct ieee80211_sub_if_data *sdata,
218 	struct ieee80211_local *local = sdata->local;
229 	ie_len_he_cap = ieee80211_ie_len_he_cap(sdata);
230 	ie_len_eht_cap = ieee80211_ie_len_eht_cap(sdata);
237 			    2 + sdata->u.mesh.mesh_id_len +
251 			    sdata->u.mesh.ie_len);
260 	memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
261 	memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN);
269 		sband = ieee80211_get_sband(sdata);
283 		basic_rates = sdata->vif.bss_conf.basic_rates;
289 		    mesh_add_rsn_ie(sdata, skb) ||
290 		    mesh_add_meshid_ie(sdata, skb) ||
291 		    mesh_add_meshconf_ie(sdata, skb))
295 		if (mesh_add_meshid_ie(sdata, skb))
339 		if (mesh_add_ht_cap_ie(sdata, skb) ||
340 		    mesh_add_ht_oper_ie(sdata, skb) ||
341 		    mesh_add_vht_cap_ie(sdata, skb) ||
342 		    mesh_add_vht_oper_ie(sdata, skb) ||
343 		    mesh_add_he_cap_ie(sdata, skb, ie_len_he_cap) ||
344 		    mesh_add_he_oper_ie(sdata, skb) ||
345 		    mesh_add_he_6ghz_cap_ie(sdata, skb) ||
346 		    mesh_add_eht_cap_ie(sdata, skb, ie_len_eht_cap) ||
347 		    mesh_add_eht_oper_ie(sdata, skb))
351 	if (mesh_add_vendor_ies(sdata, skb))
354 	ieee80211_tx_skb(sdata, skb);
375 	struct ieee80211_sub_if_data *sdata = sta->sdata;
381 		changed = mesh_plink_dec_estab_count(sdata);
402 	struct ieee80211_sub_if_data *sdata = sta->sdata;
408 	if (!sdata->u.mesh.user_mpm) {
410 		mesh_plink_frame_tx(sdata, sta, WLAN_SP_MESH_PEERING_CLOSE,
415 	if (!sdata->u.mesh.user_mpm)
425 static void mesh_sta_info_init(struct ieee80211_sub_if_data *sdata,
429 	struct ieee80211_local *local = sdata->local;
434 	sband = ieee80211_get_sband(sdata);
438 	rates = ieee80211_sta_get_rates(sdata, elems, sband->band, NULL);
453 	if (ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,
458 	ieee80211_vht_cap_ie_to_sta_vht_cap(sdata, sband,
462 	ieee80211_he_cap_ie_to_sta_he_cap(sdata, sband, elems->he_cap,
467 	ieee80211_eht_cap_ie_to_sta_eht_cap(sdata, sband, elems->he_cap,
493 static int mesh_allocate_aid(struct ieee80211_sub_if_data *sdata)
507 	list_for_each_entry_rcu(sta, &sdata->local->sta_list, list)
521 __mesh_sta_info_alloc(struct ieee80211_sub_if_data *sdata, u8 *hw_addr)
526 	if (sdata->local->num_sta >= MESH_MAX_PLINKS)
529 	aid = mesh_allocate_aid(sdata);
533 	sta = sta_info_alloc(sdata, hw_addr, GFP_KERNEL);
549 mesh_sta_info_alloc(struct ieee80211_sub_if_data *sdata, u8 *addr,
556 	if (sdata->u.mesh.user_mpm ||
557 	    sdata->u.mesh.security & IEEE80211_MESH_SEC_AUTHED) {
559 		    mesh_plink_availables(sdata)) {
562 			if (ieee80211_hw_check(&sdata->local->hw, SIGNAL_DBM))
565 			cfg80211_notify_new_peer_candidate(sdata->dev, addr,
571 		sta = __mesh_sta_info_alloc(sdata, addr);
579  * @sdata: local meshif
588 mesh_sta_info_get(struct ieee80211_sub_if_data *sdata,
595 	sta = sta_info_get(sdata, addr);
597 		mesh_sta_info_init(sdata, sta, elems);
601 		sta = mesh_sta_info_alloc(sdata, addr, elems, rx_status);
607 		mesh_sta_info_init(sdata, sta, elems);
619  * @sdata: local meshif
626 void mesh_neighbour_update(struct ieee80211_sub_if_data *sdata,
634 	sta = mesh_sta_info_get(sdata, hw_addr, elems, rx_status);
643 	    sdata->u.mesh.accepting_plinks &&
644 	    sdata->u.mesh.mshcfg.auto_open_plinks &&
645 	    rssi_threshold_check(sdata, sta))
651 	ieee80211_mbss_info_change_notify(sdata, changed);
659 	struct ieee80211_sub_if_data *sdata;
670 	if (sta->sdata->local->quiescing)
681 		mpl_dbg(sta->sdata,
691 		mpl_dbg(sta->sdata,
698 	mpl_dbg(sta->sdata,
701 	sdata = sta->sdata;
702 	mshcfg = &sdata->u.mesh.mshcfg;
710 			mpl_dbg(sta->sdata,
742 		mesh_plink_frame_tx(sdata, sta, action, sta->sta.addr,
752 static bool llid_in_use(struct ieee80211_sub_if_data *sdata,
755 	struct ieee80211_local *local = sdata->local;
761 		if (sdata != sta->sdata)
774 static u16 mesh_get_new_llid(struct ieee80211_sub_if_data *sdata)
780 	} while (llid_in_use(sdata, llid));
787 	struct ieee80211_sub_if_data *sdata = sta->sdata;
794 	sta->mesh->llid = mesh_get_new_llid(sdata);
801 	mesh_plink_timer_set(sta, sdata->u.mesh.mshcfg.dot11MeshRetryTimeout);
803 	mpl_dbg(sdata,
808 	changed = ieee80211_mps_local_status_update(sdata);
810 	mesh_plink_frame_tx(sdata, sta, WLAN_SP_MESH_PEERING_OPEN,
828 static void mesh_plink_close(struct ieee80211_sub_if_data *sdata,
832 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;
841 static u64 mesh_plink_establish(struct ieee80211_sub_if_data *sdata,
844 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;
849 	changed |= mesh_plink_inc_estab_count(sdata);
850 	changed |= mesh_set_ht_prot_mode(sdata);
851 	changed |= mesh_set_short_slot_time(sdata);
852 	mpl_dbg(sdata, "Mesh plink with %pM ESTABLISHED\n", sta->sta.addr);
861  * @sdata: interface
867 static u64 mesh_plink_fsm(struct ieee80211_sub_if_data *sdata,
870 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;
875 	mpl_dbg(sdata, "peer %pM in state %s got event %s\n", sta->sta.addr,
887 			sta->mesh->llid = mesh_get_new_llid(sdata);
892 			changed |= ieee80211_mps_local_status_update(sdata);
904 			mesh_plink_close(sdata, sta, event);
925 			mesh_plink_close(sdata, sta, event);
932 			changed |= mesh_plink_establish(sdata, sta);
943 			mesh_plink_close(sdata, sta, event);
947 			changed |= mesh_plink_establish(sdata, sta);
958 			changed |= mesh_set_ht_prot_mode(sdata);
959 			changed |= mesh_set_short_slot_time(sdata);
960 			mesh_plink_close(sdata, sta, event);
997 		mesh_plink_frame_tx(sdata, sta, action, sta->sta.addr,
1003 			mesh_plink_frame_tx(sdata, sta,
1016  * @sdata: interface
1027 mesh_plink_get_event(struct ieee80211_sub_if_data *sdata,
1038 			 mesh_matches_local(sdata, elems));
1048 			mpl_dbg(sdata, "Mesh plink: cls or cnf from unknown peer\n");
1052 		if (!mesh_plink_free_count(sdata)) {
1053 			mpl_dbg(sdata, "Mesh plink error: no more free plinks\n");
1062 			mpl_dbg(sdata, "Mesh plink: Action frame from non-authed peer\n");
1073 		else if (!mesh_plink_free_count(sdata) ||
1082 		else if (!mesh_plink_free_count(sdata) ||
1109 		mpl_dbg(sdata, "Mesh plink: unknown frame subtype\n");
1118 mesh_process_plink_frame(struct ieee80211_sub_if_data *sdata,
1132 		mpl_dbg(sdata,
1138 	    sdata->u.mesh.security == IEEE80211_MESH_SEC_NONE) {
1139 		mpl_dbg(sdata,
1149 		mpl_dbg(sdata,
1157 		mpl_dbg(sdata, "Mesh plink: missing necessary ie\n");
1171 	sta = sta_info_get(sdata, mgmt->sa);
1174 	    !rssi_threshold_check(sdata, sta)) {
1175 		mpl_dbg(sdata, "Mesh plink: %pM does not meet rssi threshold\n",
1181 	event = mesh_plink_get_event(sdata, sta, elems, ftype, llid, plid);
1186 		sta = mesh_sta_info_get(sdata, mgmt->sa, elems, rx_status);
1188 			mpl_dbg(sdata, "Mesh plink: failed to init peer!\n");
1193 		mesh_plink_frame_tx(sdata, NULL, WLAN_SP_MESH_PEERING_CLOSE,
1210 	changed |= mesh_plink_fsm(sdata, sta, event);
1216 		ieee80211_mbss_info_change_notify(sdata, changed);
1219 void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata,
1231 	if (sdata->u.mesh.user_mpm)
1236 		mpl_dbg(sdata,
1253 		mesh_process_plink_frame(sdata, mgmt, elems, rx_status);