58 static bool rssi_threshold_check(struct ieee80211_sub_if_data *sdata,  in rssi_threshold_check()  argument
61 	s32 rssi_threshold = sdata->u.mesh.mshcfg.rssi_threshold;  in rssi_threshold_check()
93 static u32 mesh_set_short_slot_time(struct ieee80211_sub_if_data *sdata)  in mesh_set_short_slot_time()  argument
95 	struct ieee80211_local *local = sdata->local;  in mesh_set_short_slot_time()
102 	sband = ieee80211_get_sband(sdata);  in mesh_set_short_slot_time()
123 		if (sdata != sta->sdata ||  in mesh_set_short_slot_time()
136 	if (sdata->vif.bss_conf.use_short_slot != short_slot) {  in mesh_set_short_slot_time()
137 		sdata->vif.bss_conf.use_short_slot = short_slot;  in mesh_set_short_slot_time()
139 		mpl_dbg(sdata, "mesh_plink %pM: ERP short slot time %d\n",  in mesh_set_short_slot_time()
140 			sdata->vif.addr, short_slot);  in mesh_set_short_slot_time()
156 static u32 mesh_set_ht_prot_mode(struct ieee80211_sub_if_data *sdata)  in mesh_set_ht_prot_mode()  argument
158 	struct ieee80211_local *local = sdata->local;  in mesh_set_ht_prot_mode()
163 	switch (sdata->vif.bss_conf.chandef.width) {  in mesh_set_ht_prot_mode()
174 		if (sdata != sta->sdata ||  in mesh_set_ht_prot_mode()
182 			mpl_dbg(sdata, "nonHT sta (%pM) is present\n",  in mesh_set_ht_prot_mode()
188 		mpl_dbg(sdata, "HT20 sta (%pM) is present\n", sta->sta.addr);  in mesh_set_ht_prot_mode()
196 		 sdata->vif.bss_conf.chandef.width > NL80211_CHAN_WIDTH_20)  in mesh_set_ht_prot_mode()
201 	if (sdata->vif.bss_conf.ht_operation_mode == ht_opmode)  in mesh_set_ht_prot_mode()
204 	sdata->vif.bss_conf.ht_operation_mode = ht_opmode;  in mesh_set_ht_prot_mode()
205 	sdata->u.mesh.mshcfg.ht_opmode = ht_opmode;  in mesh_set_ht_prot_mode()
206 	mpl_dbg(sdata, "selected new HT protection mode %d\n", ht_opmode);  in mesh_set_ht_prot_mode()
210 static int mesh_plink_frame_tx(struct ieee80211_sub_if_data *sdata,  in mesh_plink_frame_tx()  argument
215 	struct ieee80211_local *local = sdata->local;  in mesh_plink_frame_tx()
226 	ie_len_he_cap = ieee80211_ie_len_he_cap(sdata,  in mesh_plink_frame_tx()
234 			    2 + sdata->u.mesh.mesh_id_len +  in mesh_plink_frame_tx()
245 			    sdata->u.mesh.ie_len);  in mesh_plink_frame_tx()
254 	memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);  in mesh_plink_frame_tx()
255 	memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN);  in mesh_plink_frame_tx()
263 		sband = ieee80211_get_sband(sdata);  in mesh_plink_frame_tx()
277 		if (ieee80211_add_srates_ie(sdata, skb, true, band) ||  in mesh_plink_frame_tx()
278 		    ieee80211_add_ext_srates_ie(sdata, skb, true, band) ||  in mesh_plink_frame_tx()
279 		    mesh_add_rsn_ie(sdata, skb) ||  in mesh_plink_frame_tx()
280 		    mesh_add_meshid_ie(sdata, skb) ||  in mesh_plink_frame_tx()
281 		    mesh_add_meshconf_ie(sdata, skb))  in mesh_plink_frame_tx()
285 		if (mesh_add_meshid_ie(sdata, skb))  in mesh_plink_frame_tx()
329 		if (mesh_add_ht_cap_ie(sdata, skb) ||  in mesh_plink_frame_tx()
330 		    mesh_add_ht_oper_ie(sdata, skb) ||  in mesh_plink_frame_tx()
331 		    mesh_add_vht_cap_ie(sdata, skb) ||  in mesh_plink_frame_tx()
332 		    mesh_add_vht_oper_ie(sdata, skb) ||  in mesh_plink_frame_tx()
333 		    mesh_add_he_cap_ie(sdata, skb, ie_len_he_cap) ||  in mesh_plink_frame_tx()
334 		    mesh_add_he_oper_ie(sdata, skb) ||  in mesh_plink_frame_tx()
335 		    mesh_add_he_6ghz_cap_ie(sdata, skb))  in mesh_plink_frame_tx()
339 	if (mesh_add_vendor_ies(sdata, skb))  in mesh_plink_frame_tx()
342 	ieee80211_tx_skb(sdata, skb);  in mesh_plink_frame_tx()
363 	struct ieee80211_sub_if_data *sdata = sta->sdata;  in __mesh_plink_deactivate()  local
369 		changed = mesh_plink_dec_estab_count(sdata);  in __mesh_plink_deactivate()
388 	struct ieee80211_sub_if_data *sdata = sta->sdata;  in mesh_plink_deactivate()  local
394 	if (!sdata->u.mesh.user_mpm) {  in mesh_plink_deactivate()
396 		mesh_plink_frame_tx(sdata, sta, WLAN_SP_MESH_PEERING_CLOSE,  in mesh_plink_deactivate()
401 	if (!sdata->u.mesh.user_mpm)  in mesh_plink_deactivate()
411 static void mesh_sta_info_init(struct ieee80211_sub_if_data *sdata,  in mesh_sta_info_init()  argument
415 	struct ieee80211_local *local = sdata->local;  in mesh_sta_info_init()
420 	sband = ieee80211_get_sband(sdata);  in mesh_sta_info_init()
424 	rates = ieee80211_sta_get_rates(sdata, elems, sband->band,  in mesh_sta_info_init()
440 	if (ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,  in mesh_sta_info_init()
445 	ieee80211_vht_cap_ie_to_sta_vht_cap(sdata, sband,  in mesh_sta_info_init()
449 	ieee80211_he_cap_ie_to_sta_he_cap(sdata, sband, elems->he_cap,  in mesh_sta_info_init()
474 static int mesh_allocate_aid(struct ieee80211_sub_if_data *sdata)  in mesh_allocate_aid()  argument
488 	list_for_each_entry_rcu(sta, &sdata->local->sta_list, list)  in mesh_allocate_aid()
502 __mesh_sta_info_alloc(struct ieee80211_sub_if_data *sdata, u8 *hw_addr)  in __mesh_sta_info_alloc()  argument
507 	if (sdata->local->num_sta >= MESH_MAX_PLINKS)  in __mesh_sta_info_alloc()
510 	aid = mesh_allocate_aid(sdata);  in __mesh_sta_info_alloc()
514 	sta = sta_info_alloc(sdata, hw_addr, GFP_KERNEL);  in __mesh_sta_info_alloc()
530 mesh_sta_info_alloc(struct ieee80211_sub_if_data *sdata, u8 *addr,  in mesh_sta_info_alloc()  argument
537 	if (sdata->u.mesh.user_mpm ||  in mesh_sta_info_alloc()
538 	    sdata->u.mesh.security & IEEE80211_MESH_SEC_AUTHED) {  in mesh_sta_info_alloc()
540 		    mesh_plink_availables(sdata)) {  in mesh_sta_info_alloc()
543 			if (ieee80211_hw_check(&sdata->local->hw, SIGNAL_DBM))  in mesh_sta_info_alloc()
546 			cfg80211_notify_new_peer_candidate(sdata->dev, addr,  in mesh_sta_info_alloc()
552 		sta = __mesh_sta_info_alloc(sdata, addr);  in mesh_sta_info_alloc()
569 mesh_sta_info_get(struct ieee80211_sub_if_data *sdata,  in mesh_sta_info_get()  argument
576 	sta = sta_info_get(sdata, addr);  in mesh_sta_info_get()
578 		mesh_sta_info_init(sdata, sta, elems);  in mesh_sta_info_get()
582 		sta = mesh_sta_info_alloc(sdata, addr, elems, rx_status);  in mesh_sta_info_get()
588 		mesh_sta_info_init(sdata, sta, elems);  in mesh_sta_info_get()
607 void mesh_neighbour_update(struct ieee80211_sub_if_data *sdata,  in mesh_neighbour_update()  argument
615 	sta = mesh_sta_info_get(sdata, hw_addr, elems, rx_status);  in mesh_neighbour_update()
624 	    sdata->u.mesh.accepting_plinks &&  in mesh_neighbour_update()
625 	    sdata->u.mesh.mshcfg.auto_open_plinks &&  in mesh_neighbour_update()
626 	    rssi_threshold_check(sdata, sta))  in mesh_neighbour_update()
632 	ieee80211_mbss_info_change_notify(sdata, changed);  in mesh_neighbour_update()
640 	struct ieee80211_sub_if_data *sdata;  in mesh_plink_timer()  local
651 	if (sta->sdata->local->quiescing)  in mesh_plink_timer()
662 		mpl_dbg(sta->sdata,  in mesh_plink_timer()
672 		mpl_dbg(sta->sdata,  in mesh_plink_timer()
679 	mpl_dbg(sta->sdata,  in mesh_plink_timer()
682 	sdata = sta->sdata;  in mesh_plink_timer()
683 	mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_timer()
691 			mpl_dbg(sta->sdata,  in mesh_plink_timer()
723 		mesh_plink_frame_tx(sdata, sta, action, sta->sta.addr,  in mesh_plink_timer()
733 static bool llid_in_use(struct ieee80211_sub_if_data *sdata,  in llid_in_use()  argument
736 	struct ieee80211_local *local = sdata->local;  in llid_in_use()
742 		if (sdata != sta->sdata)  in llid_in_use()
755 static u16 mesh_get_new_llid(struct ieee80211_sub_if_data *sdata)  in mesh_get_new_llid()  argument
761 	} while (llid_in_use(sdata, llid));  in mesh_get_new_llid()
768 	struct ieee80211_sub_if_data *sdata = sta->sdata;  in mesh_plink_open()  local
775 	sta->mesh->llid = mesh_get_new_llid(sdata);  in mesh_plink_open()
782 	mesh_plink_timer_set(sta, sdata->u.mesh.mshcfg.dot11MeshRetryTimeout);  in mesh_plink_open()
784 	mpl_dbg(sdata,  in mesh_plink_open()
789 	changed = ieee80211_mps_local_status_update(sdata);  in mesh_plink_open()
791 	mesh_plink_frame_tx(sdata, sta, WLAN_SP_MESH_PEERING_OPEN,  in mesh_plink_open()
809 static void mesh_plink_close(struct ieee80211_sub_if_data *sdata,  in mesh_plink_close()  argument
813 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_close()
822 static u32 mesh_plink_establish(struct ieee80211_sub_if_data *sdata,  in mesh_plink_establish()  argument
825 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_establish()
830 	changed |= mesh_plink_inc_estab_count(sdata);  in mesh_plink_establish()
831 	changed |= mesh_set_ht_prot_mode(sdata);  in mesh_plink_establish()
832 	changed |= mesh_set_short_slot_time(sdata);  in mesh_plink_establish()
833 	mpl_dbg(sdata, "Mesh plink with %pM ESTABLISHED\n", sta->sta.addr);  in mesh_plink_establish()
848 static u32 mesh_plink_fsm(struct ieee80211_sub_if_data *sdata,  in mesh_plink_fsm()  argument
851 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_fsm()
856 	mpl_dbg(sdata, "peer %pM in state %s got event %s\n", sta->sta.addr,  in mesh_plink_fsm()
868 			sta->mesh->llid = mesh_get_new_llid(sdata);  in mesh_plink_fsm()
873 			changed |= ieee80211_mps_local_status_update(sdata);  in mesh_plink_fsm()
885 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
906 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
913 			changed |= mesh_plink_establish(sdata, sta);  in mesh_plink_fsm()
924 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
928 			changed |= mesh_plink_establish(sdata, sta);  in mesh_plink_fsm()
939 			changed |= mesh_set_ht_prot_mode(sdata);  in mesh_plink_fsm()
940 			changed |= mesh_set_short_slot_time(sdata);  in mesh_plink_fsm()
941 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
978 		mesh_plink_frame_tx(sdata, sta, action, sta->sta.addr,  in mesh_plink_fsm()
984 			mesh_plink_frame_tx(sdata, sta,  in mesh_plink_fsm()
1008 mesh_plink_get_event(struct ieee80211_sub_if_data *sdata,  in mesh_plink_get_event()  argument
1019 			 mesh_matches_local(sdata, elems));  in mesh_plink_get_event()
1029 			mpl_dbg(sdata, "Mesh plink: cls or cnf from unknown peer\n");  in mesh_plink_get_event()
1033 		if (!mesh_plink_free_count(sdata)) {  in mesh_plink_get_event()
1034 			mpl_dbg(sdata, "Mesh plink error: no more free plinks\n");  in mesh_plink_get_event()
1043 			mpl_dbg(sdata, "Mesh plink: Action frame from non-authed peer\n");  in mesh_plink_get_event()
1054 		if (!mesh_plink_free_count(sdata) ||  in mesh_plink_get_event()
1063 		if (!mesh_plink_free_count(sdata) ||  in mesh_plink_get_event()
1090 		mpl_dbg(sdata, "Mesh plink: unknown frame subtype\n");  in mesh_plink_get_event()
1099 mesh_process_plink_frame(struct ieee80211_sub_if_data *sdata,  in mesh_process_plink_frame()  argument
1113 		mpl_dbg(sdata,  in mesh_process_plink_frame()
1119 	    sdata->u.mesh.security == IEEE80211_MESH_SEC_NONE) {  in mesh_process_plink_frame()
1120 		mpl_dbg(sdata,  in mesh_process_plink_frame()
1130 		mpl_dbg(sdata,  in mesh_process_plink_frame()
1138 		mpl_dbg(sdata, "Mesh plink: missing necessary ie\n");  in mesh_process_plink_frame()
1152 	sta = sta_info_get(sdata, mgmt->sa);  in mesh_process_plink_frame()
1155 	    !rssi_threshold_check(sdata, sta)) {  in mesh_process_plink_frame()
1156 		mpl_dbg(sdata, "Mesh plink: %pM does not meet rssi threshold\n",  in mesh_process_plink_frame()
1162 	event = mesh_plink_get_event(sdata, sta, elems, ftype, llid, plid);  in mesh_process_plink_frame()
1167 		sta = mesh_sta_info_get(sdata, mgmt->sa, elems, rx_status);  in mesh_process_plink_frame()
1169 			mpl_dbg(sdata, "Mesh plink: failed to init peer!\n");  in mesh_process_plink_frame()
1174 		mesh_plink_frame_tx(sdata, NULL, WLAN_SP_MESH_PEERING_CLOSE,  in mesh_process_plink_frame()
1191 	changed |= mesh_plink_fsm(sdata, sta, event);  in mesh_process_plink_frame()
1197 		ieee80211_mbss_info_change_notify(sdata, changed);  in mesh_process_plink_frame()
1200 void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata,  in mesh_rx_plink_frame()  argument
1212 	if (sdata->u.mesh.user_mpm)  in mesh_rx_plink_frame()
1217 		mpl_dbg(sdata,  in mesh_rx_plink_frame()
1233 	mesh_process_plink_frame(sdata, mgmt, elems, rx_status);  in mesh_rx_plink_frame()