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()
96 	enum ieee80211_band band = ieee80211_get_sdata_band(sdata);  in mesh_set_short_slot_time()
119 		if (sdata != sta->sdata ||  in mesh_set_short_slot_time()
132 	if (sdata->vif.bss_conf.use_short_slot != short_slot) {  in mesh_set_short_slot_time()
133 		sdata->vif.bss_conf.use_short_slot = short_slot;  in mesh_set_short_slot_time()
135 		mpl_dbg(sdata, "mesh_plink %pM: ERP short slot time %d\n",  in mesh_set_short_slot_time()
136 			sdata->vif.addr, short_slot);  in mesh_set_short_slot_time()
151 static u32 mesh_set_ht_prot_mode(struct ieee80211_sub_if_data *sdata)  in mesh_set_ht_prot_mode()  argument
153 	struct ieee80211_local *local = sdata->local;  in mesh_set_ht_prot_mode()
158 	switch (sdata->vif.bss_conf.chandef.width) {  in mesh_set_ht_prot_mode()
169 		if (sdata != sta->sdata ||  in mesh_set_ht_prot_mode()
177 			mpl_dbg(sdata, "nonHT sta (%pM) is present\n",  in mesh_set_ht_prot_mode()
183 		mpl_dbg(sdata, "HT20 sta (%pM) is present\n", sta->sta.addr);  in mesh_set_ht_prot_mode()
191 		 sdata->vif.bss_conf.chandef.width > NL80211_CHAN_WIDTH_20)  in mesh_set_ht_prot_mode()
196 	if (sdata->vif.bss_conf.ht_operation_mode == ht_opmode)  in mesh_set_ht_prot_mode()
199 	sdata->vif.bss_conf.ht_operation_mode = ht_opmode;  in mesh_set_ht_prot_mode()
200 	sdata->u.mesh.mshcfg.ht_opmode = ht_opmode;  in mesh_set_ht_prot_mode()
201 	mpl_dbg(sdata, "selected new HT protection mode %d\n", ht_opmode);  in mesh_set_ht_prot_mode()
205 static int mesh_plink_frame_tx(struct ieee80211_sub_if_data *sdata,  in mesh_plink_frame_tx()  argument
210 	struct ieee80211_local *local = sdata->local;  in mesh_plink_frame_tx()
227 			    2 + sdata->u.mesh.mesh_id_len +  in mesh_plink_frame_tx()
234 			    sdata->u.mesh.ie_len);  in mesh_plink_frame_tx()
244 	memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);  in mesh_plink_frame_tx()
245 	memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN);  in mesh_plink_frame_tx()
250 		enum ieee80211_band band = ieee80211_get_sdata_band(sdata);  in mesh_plink_frame_tx()
260 		if (ieee80211_add_srates_ie(sdata, skb, true, band) ||  in mesh_plink_frame_tx()
261 		    ieee80211_add_ext_srates_ie(sdata, skb, true, band) ||  in mesh_plink_frame_tx()
262 		    mesh_add_rsn_ie(sdata, skb) ||  in mesh_plink_frame_tx()
263 		    mesh_add_meshid_ie(sdata, skb) ||  in mesh_plink_frame_tx()
264 		    mesh_add_meshconf_ie(sdata, skb))  in mesh_plink_frame_tx()
268 		if (mesh_add_meshid_ie(sdata, skb))  in mesh_plink_frame_tx()
312 		if (mesh_add_ht_cap_ie(sdata, skb) ||  in mesh_plink_frame_tx()
313 		    mesh_add_ht_oper_ie(sdata, skb) ||  in mesh_plink_frame_tx()
314 		    mesh_add_vht_cap_ie(sdata, skb) ||  in mesh_plink_frame_tx()
315 		    mesh_add_vht_oper_ie(sdata, skb))  in mesh_plink_frame_tx()
319 	if (mesh_add_vendor_ies(sdata, skb))  in mesh_plink_frame_tx()
322 	ieee80211_tx_skb(sdata, skb);  in mesh_plink_frame_tx()
341 	struct ieee80211_sub_if_data *sdata = sta->sdata;  in __mesh_plink_deactivate()  local
347 		changed = mesh_plink_dec_estab_count(sdata);  in __mesh_plink_deactivate()
367 	struct ieee80211_sub_if_data *sdata = sta->sdata;  in mesh_plink_deactivate()  local
373 	mesh_plink_frame_tx(sdata, sta, WLAN_SP_MESH_PEERING_CLOSE,  in mesh_plink_deactivate()
381 static void mesh_sta_info_init(struct ieee80211_sub_if_data *sdata,  in mesh_sta_info_init()  argument
385 	struct ieee80211_local *local = sdata->local;  in mesh_sta_info_init()
386 	enum ieee80211_band band = ieee80211_get_sdata_band(sdata);  in mesh_sta_info_init()
392 	rates = ieee80211_sta_get_rates(sdata, elems, band, &basic_rates);  in mesh_sta_info_init()
407 	if (ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,  in mesh_sta_info_init()
411 	ieee80211_vht_cap_ie_to_sta_vht_cap(sdata, sband,  in mesh_sta_info_init()
434 static int mesh_allocate_aid(struct ieee80211_sub_if_data *sdata)  in mesh_allocate_aid()  argument
449 	list_for_each_entry_rcu(sta, &sdata->local->sta_list, list)  in mesh_allocate_aid()
463 __mesh_sta_info_alloc(struct ieee80211_sub_if_data *sdata, u8 *hw_addr)  in __mesh_sta_info_alloc()  argument
468 	if (sdata->local->num_sta >= MESH_MAX_PLINKS)  in __mesh_sta_info_alloc()
471 	aid = mesh_allocate_aid(sdata);  in __mesh_sta_info_alloc()
475 	sta = sta_info_alloc(sdata, hw_addr, GFP_KERNEL);  in __mesh_sta_info_alloc()
491 mesh_sta_info_alloc(struct ieee80211_sub_if_data *sdata, u8 *addr,  in mesh_sta_info_alloc()  argument
497 	if (sdata->u.mesh.user_mpm ||  in mesh_sta_info_alloc()
498 	    sdata->u.mesh.security & IEEE80211_MESH_SEC_AUTHED)  in mesh_sta_info_alloc()
499 		cfg80211_notify_new_peer_candidate(sdata->dev, addr,  in mesh_sta_info_alloc()
504 		sta = __mesh_sta_info_alloc(sdata, addr);  in mesh_sta_info_alloc()
520 mesh_sta_info_get(struct ieee80211_sub_if_data *sdata,  in mesh_sta_info_get()  argument
526 	sta = sta_info_get(sdata, addr);  in mesh_sta_info_get()
528 		mesh_sta_info_init(sdata, sta, elems, false);  in mesh_sta_info_get()
532 		sta = mesh_sta_info_alloc(sdata, addr, elems);  in mesh_sta_info_get()
538 		mesh_sta_info_init(sdata, sta, elems, true);  in mesh_sta_info_get()
556 void mesh_neighbour_update(struct ieee80211_sub_if_data *sdata,  in mesh_neighbour_update()  argument
563 	sta = mesh_sta_info_get(sdata, hw_addr, elems);  in mesh_neighbour_update()
569 	    sdata->u.mesh.accepting_plinks &&  in mesh_neighbour_update()
570 	    sdata->u.mesh.mshcfg.auto_open_plinks &&  in mesh_neighbour_update()
571 	    rssi_threshold_check(sdata, sta))  in mesh_neighbour_update()
577 	ieee80211_mbss_info_change_notify(sdata, changed);  in mesh_neighbour_update()
584 	struct ieee80211_sub_if_data *sdata;  in mesh_plink_timer()  local
595 	if (sta->sdata->local->quiescing)  in mesh_plink_timer()
606 		mpl_dbg(sta->sdata,  in mesh_plink_timer()
616 		mpl_dbg(sta->sdata,  in mesh_plink_timer()
623 	mpl_dbg(sta->sdata,  in mesh_plink_timer()
626 	sdata = sta->sdata;  in mesh_plink_timer()
627 	mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_timer()
635 			mpl_dbg(sta->sdata,  in mesh_plink_timer()
667 		mesh_plink_frame_tx(sdata, sta, action, sta->sta.addr,  in mesh_plink_timer()
680 static bool llid_in_use(struct ieee80211_sub_if_data *sdata,  in llid_in_use()  argument
683 	struct ieee80211_local *local = sdata->local;  in llid_in_use()
689 		if (sdata != sta->sdata)  in llid_in_use()
702 static u16 mesh_get_new_llid(struct ieee80211_sub_if_data *sdata)  in mesh_get_new_llid()  argument
708 	} while (llid_in_use(sdata, llid));  in mesh_get_new_llid()
715 	struct ieee80211_sub_if_data *sdata = sta->sdata;  in mesh_plink_open()  local
722 	sta->mesh->llid = mesh_get_new_llid(sdata);  in mesh_plink_open()
729 	mesh_plink_timer_set(sta, sdata->u.mesh.mshcfg.dot11MeshRetryTimeout);  in mesh_plink_open()
731 	mpl_dbg(sdata,  in mesh_plink_open()
736 	changed = ieee80211_mps_local_status_update(sdata);  in mesh_plink_open()
738 	mesh_plink_frame_tx(sdata, sta, WLAN_SP_MESH_PEERING_OPEN,  in mesh_plink_open()
755 static void mesh_plink_close(struct ieee80211_sub_if_data *sdata,  in mesh_plink_close()  argument
759 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_close()
768 static u32 mesh_plink_establish(struct ieee80211_sub_if_data *sdata,  in mesh_plink_establish()  argument
771 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_establish()
776 	changed |= mesh_plink_inc_estab_count(sdata);  in mesh_plink_establish()
777 	changed |= mesh_set_ht_prot_mode(sdata);  in mesh_plink_establish()
778 	changed |= mesh_set_short_slot_time(sdata);  in mesh_plink_establish()
779 	mpl_dbg(sdata, "Mesh plink with %pM ESTABLISHED\n", sta->sta.addr);  in mesh_plink_establish()
794 static u32 mesh_plink_fsm(struct ieee80211_sub_if_data *sdata,  in mesh_plink_fsm()  argument
797 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_fsm()
801 	mpl_dbg(sdata, "peer %pM in state %s got event %s\n", sta->sta.addr,  in mesh_plink_fsm()
813 			sta->mesh->llid = mesh_get_new_llid(sdata);  in mesh_plink_fsm()
818 			changed |= ieee80211_mps_local_status_update(sdata);  in mesh_plink_fsm()
830 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
851 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
858 			changed |= mesh_plink_establish(sdata, sta);  in mesh_plink_fsm()
869 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
873 			changed |= mesh_plink_establish(sdata, sta);  in mesh_plink_fsm()
884 			changed |= mesh_set_ht_prot_mode(sdata);  in mesh_plink_fsm()
885 			changed |= mesh_set_short_slot_time(sdata);  in mesh_plink_fsm()
886 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
920 		mesh_plink_frame_tx(sdata, sta, action, sta->sta.addr,  in mesh_plink_fsm()
926 			mesh_plink_frame_tx(sdata, sta,  in mesh_plink_fsm()
950 mesh_plink_get_event(struct ieee80211_sub_if_data *sdata,  in mesh_plink_get_event()  argument
961 			 mesh_matches_local(sdata, elems));  in mesh_plink_get_event()
971 			mpl_dbg(sdata, "Mesh plink: cls or cnf from unknown peer\n");  in mesh_plink_get_event()
975 		if (!mesh_plink_free_count(sdata)) {  in mesh_plink_get_event()
976 			mpl_dbg(sdata, "Mesh plink error: no more free plinks\n");  in mesh_plink_get_event()
981 			mpl_dbg(sdata, "Mesh plink: Action frame from non-authed peer\n");  in mesh_plink_get_event()
998 		if (!mesh_plink_free_count(sdata) ||  in mesh_plink_get_event()
1007 		if (!mesh_plink_free_count(sdata) ||  in mesh_plink_get_event()
1034 		mpl_dbg(sdata, "Mesh plink: unknown frame subtype\n");  in mesh_plink_get_event()
1043 mesh_process_plink_frame(struct ieee80211_sub_if_data *sdata,  in mesh_process_plink_frame()  argument
1056 		mpl_dbg(sdata,  in mesh_process_plink_frame()
1062 	    sdata->u.mesh.security == IEEE80211_MESH_SEC_NONE) {  in mesh_process_plink_frame()
1063 		mpl_dbg(sdata,  in mesh_process_plink_frame()
1073 		mpl_dbg(sdata,  in mesh_process_plink_frame()
1081 		mpl_dbg(sdata, "Mesh plink: missing necessary ie\n");  in mesh_process_plink_frame()
1095 	sta = sta_info_get(sdata, mgmt->sa);  in mesh_process_plink_frame()
1098 	    !rssi_threshold_check(sdata, sta)) {  in mesh_process_plink_frame()
1099 		mpl_dbg(sdata, "Mesh plink: %pM does not meet rssi threshold\n",  in mesh_process_plink_frame()
1105 	event = mesh_plink_get_event(sdata, sta, elems, ftype, llid, plid);  in mesh_process_plink_frame()
1110 		sta = mesh_sta_info_get(sdata, mgmt->sa, elems);  in mesh_process_plink_frame()
1112 			mpl_dbg(sdata, "Mesh plink: failed to init peer!\n");  in mesh_process_plink_frame()
1117 		mesh_plink_frame_tx(sdata, NULL, WLAN_SP_MESH_PEERING_CLOSE,  in mesh_process_plink_frame()
1134 	changed |= mesh_plink_fsm(sdata, sta, event);  in mesh_process_plink_frame()
1140 		ieee80211_mbss_info_change_notify(sdata, changed);  in mesh_process_plink_frame()
1143 void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata,  in mesh_rx_plink_frame()  argument
1155 	if (sdata->u.mesh.user_mpm)  in mesh_rx_plink_frame()
1160 		mpl_dbg(sdata,  in mesh_rx_plink_frame()
1176 	mesh_process_plink_frame(sdata, mgmt, &elems);  in mesh_rx_plink_frame()