60 static bool rssi_threshold_check(struct ieee80211_sub_if_data *sdata,  in rssi_threshold_check()  argument
63 	s32 rssi_threshold = sdata->u.mesh.mshcfg.rssi_threshold;  in rssi_threshold_check()
95 static u32 mesh_set_short_slot_time(struct ieee80211_sub_if_data *sdata)  in mesh_set_short_slot_time()  argument
97 	struct ieee80211_local *local = sdata->local;  in mesh_set_short_slot_time()
104 	sband = ieee80211_get_sband(sdata);  in mesh_set_short_slot_time()
125 		if (sdata != sta->sdata ||  in mesh_set_short_slot_time()
138 	if (sdata->vif.bss_conf.use_short_slot != short_slot) {  in mesh_set_short_slot_time()
139 		sdata->vif.bss_conf.use_short_slot = short_slot;  in mesh_set_short_slot_time()
141 		mpl_dbg(sdata, "mesh_plink %pM: ERP short slot time %d\n",  in mesh_set_short_slot_time()
142 			sdata->vif.addr, short_slot);  in mesh_set_short_slot_time()
157 static u32 mesh_set_ht_prot_mode(struct ieee80211_sub_if_data *sdata)  in mesh_set_ht_prot_mode()  argument
159 	struct ieee80211_local *local = sdata->local;  in mesh_set_ht_prot_mode()
164 	switch (sdata->vif.bss_conf.chandef.width) {  in mesh_set_ht_prot_mode()
175 		if (sdata != sta->sdata ||  in mesh_set_ht_prot_mode()
183 			mpl_dbg(sdata, "nonHT sta (%pM) is present\n",  in mesh_set_ht_prot_mode()
189 		mpl_dbg(sdata, "HT20 sta (%pM) is present\n", sta->sta.addr);  in mesh_set_ht_prot_mode()
197 		 sdata->vif.bss_conf.chandef.width > NL80211_CHAN_WIDTH_20)  in mesh_set_ht_prot_mode()
202 	if (sdata->vif.bss_conf.ht_operation_mode == ht_opmode)  in mesh_set_ht_prot_mode()
205 	sdata->vif.bss_conf.ht_operation_mode = ht_opmode;  in mesh_set_ht_prot_mode()
206 	sdata->u.mesh.mshcfg.ht_opmode = ht_opmode;  in mesh_set_ht_prot_mode()
207 	mpl_dbg(sdata, "selected new HT protection mode %d\n", ht_opmode);  in mesh_set_ht_prot_mode()
211 static int mesh_plink_frame_tx(struct ieee80211_sub_if_data *sdata,  in mesh_plink_frame_tx()  argument
216 	struct ieee80211_local *local = sdata->local;  in mesh_plink_frame_tx()
232 			    2 + sdata->u.mesh.mesh_id_len +  in mesh_plink_frame_tx()
239 			    sdata->u.mesh.ie_len);  in mesh_plink_frame_tx()
248 	memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);  in mesh_plink_frame_tx()
249 	memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN);  in mesh_plink_frame_tx()
257 		sband = ieee80211_get_sband(sdata);  in mesh_plink_frame_tx()
271 		if (ieee80211_add_srates_ie(sdata, skb, true, band) ||  in mesh_plink_frame_tx()
272 		    ieee80211_add_ext_srates_ie(sdata, skb, true, band) ||  in mesh_plink_frame_tx()
273 		    mesh_add_rsn_ie(sdata, skb) ||  in mesh_plink_frame_tx()
274 		    mesh_add_meshid_ie(sdata, skb) ||  in mesh_plink_frame_tx()
275 		    mesh_add_meshconf_ie(sdata, skb))  in mesh_plink_frame_tx()
279 		if (mesh_add_meshid_ie(sdata, skb))  in mesh_plink_frame_tx()
323 		if (mesh_add_ht_cap_ie(sdata, skb) ||  in mesh_plink_frame_tx()
324 		    mesh_add_ht_oper_ie(sdata, skb) ||  in mesh_plink_frame_tx()
325 		    mesh_add_vht_cap_ie(sdata, skb) ||  in mesh_plink_frame_tx()
326 		    mesh_add_vht_oper_ie(sdata, skb))  in mesh_plink_frame_tx()
330 	if (mesh_add_vendor_ies(sdata, skb))  in mesh_plink_frame_tx()
333 	ieee80211_tx_skb(sdata, skb);  in mesh_plink_frame_tx()
354 	struct ieee80211_sub_if_data *sdata = sta->sdata;  in __mesh_plink_deactivate()  local
360 		changed = mesh_plink_dec_estab_count(sdata);  in __mesh_plink_deactivate()
379 	struct ieee80211_sub_if_data *sdata = sta->sdata;  in mesh_plink_deactivate()  local
385 	if (!sdata->u.mesh.user_mpm) {  in mesh_plink_deactivate()
387 		mesh_plink_frame_tx(sdata, sta, WLAN_SP_MESH_PEERING_CLOSE,  in mesh_plink_deactivate()
392 	if (!sdata->u.mesh.user_mpm)  in mesh_plink_deactivate()
402 static void mesh_sta_info_init(struct ieee80211_sub_if_data *sdata,  in mesh_sta_info_init()  argument
406 	struct ieee80211_local *local = sdata->local;  in mesh_sta_info_init()
411 	sband = ieee80211_get_sband(sdata);  in mesh_sta_info_init()
415 	rates = ieee80211_sta_get_rates(sdata, elems, sband->band,  in mesh_sta_info_init()
431 	if (ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,  in mesh_sta_info_init()
435 	ieee80211_vht_cap_ie_to_sta_vht_cap(sdata, sband,  in mesh_sta_info_init()
458 static int mesh_allocate_aid(struct ieee80211_sub_if_data *sdata)  in mesh_allocate_aid()  argument
473 	list_for_each_entry_rcu(sta, &sdata->local->sta_list, list)  in mesh_allocate_aid()
487 __mesh_sta_info_alloc(struct ieee80211_sub_if_data *sdata, u8 *hw_addr)  in __mesh_sta_info_alloc()  argument
492 	if (sdata->local->num_sta >= MESH_MAX_PLINKS)  in __mesh_sta_info_alloc()
495 	aid = mesh_allocate_aid(sdata);  in __mesh_sta_info_alloc()
499 	sta = sta_info_alloc(sdata, hw_addr, GFP_KERNEL);  in __mesh_sta_info_alloc()
515 mesh_sta_info_alloc(struct ieee80211_sub_if_data *sdata, u8 *addr,  in mesh_sta_info_alloc()  argument
521 	if (sdata->u.mesh.user_mpm ||  in mesh_sta_info_alloc()
522 	    sdata->u.mesh.security & IEEE80211_MESH_SEC_AUTHED) {  in mesh_sta_info_alloc()
524 		    mesh_plink_availables(sdata))  in mesh_sta_info_alloc()
525 			cfg80211_notify_new_peer_candidate(sdata->dev, addr,  in mesh_sta_info_alloc()
530 		sta = __mesh_sta_info_alloc(sdata, addr);  in mesh_sta_info_alloc()
546 mesh_sta_info_get(struct ieee80211_sub_if_data *sdata,  in mesh_sta_info_get()  argument
552 	sta = sta_info_get(sdata, addr);  in mesh_sta_info_get()
554 		mesh_sta_info_init(sdata, sta, elems);  in mesh_sta_info_get()
558 		sta = mesh_sta_info_alloc(sdata, addr, elems);  in mesh_sta_info_get()
564 		mesh_sta_info_init(sdata, sta, elems);  in mesh_sta_info_get()
582 void mesh_neighbour_update(struct ieee80211_sub_if_data *sdata,  in mesh_neighbour_update()  argument
589 	sta = mesh_sta_info_get(sdata, hw_addr, elems);  in mesh_neighbour_update()
595 	    sdata->u.mesh.accepting_plinks &&  in mesh_neighbour_update()
596 	    sdata->u.mesh.mshcfg.auto_open_plinks &&  in mesh_neighbour_update()
597 	    rssi_threshold_check(sdata, sta))  in mesh_neighbour_update()
603 	ieee80211_mbss_info_change_notify(sdata, changed);  in mesh_neighbour_update()
611 	struct ieee80211_sub_if_data *sdata;  in mesh_plink_timer()  local
622 	if (sta->sdata->local->quiescing)  in mesh_plink_timer()
633 		mpl_dbg(sta->sdata,  in mesh_plink_timer()
643 		mpl_dbg(sta->sdata,  in mesh_plink_timer()
650 	mpl_dbg(sta->sdata,  in mesh_plink_timer()
653 	sdata = sta->sdata;  in mesh_plink_timer()
654 	mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_timer()
662 			mpl_dbg(sta->sdata,  in mesh_plink_timer()
694 		mesh_plink_frame_tx(sdata, sta, action, sta->sta.addr,  in mesh_plink_timer()
704 static bool llid_in_use(struct ieee80211_sub_if_data *sdata,  in llid_in_use()  argument
707 	struct ieee80211_local *local = sdata->local;  in llid_in_use()
713 		if (sdata != sta->sdata)  in llid_in_use()
726 static u16 mesh_get_new_llid(struct ieee80211_sub_if_data *sdata)  in mesh_get_new_llid()  argument
732 	} while (llid_in_use(sdata, llid));  in mesh_get_new_llid()
739 	struct ieee80211_sub_if_data *sdata = sta->sdata;  in mesh_plink_open()  local
746 	sta->mesh->llid = mesh_get_new_llid(sdata);  in mesh_plink_open()
753 	mesh_plink_timer_set(sta, sdata->u.mesh.mshcfg.dot11MeshRetryTimeout);  in mesh_plink_open()
755 	mpl_dbg(sdata,  in mesh_plink_open()
760 	changed = ieee80211_mps_local_status_update(sdata);  in mesh_plink_open()
762 	mesh_plink_frame_tx(sdata, sta, WLAN_SP_MESH_PEERING_OPEN,  in mesh_plink_open()
780 static void mesh_plink_close(struct ieee80211_sub_if_data *sdata,  in mesh_plink_close()  argument
784 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_close()
793 static u32 mesh_plink_establish(struct ieee80211_sub_if_data *sdata,  in mesh_plink_establish()  argument
796 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_establish()
801 	changed |= mesh_plink_inc_estab_count(sdata);  in mesh_plink_establish()
802 	changed |= mesh_set_ht_prot_mode(sdata);  in mesh_plink_establish()
803 	changed |= mesh_set_short_slot_time(sdata);  in mesh_plink_establish()
804 	mpl_dbg(sdata, "Mesh plink with %pM ESTABLISHED\n", sta->sta.addr);  in mesh_plink_establish()
819 static u32 mesh_plink_fsm(struct ieee80211_sub_if_data *sdata,  in mesh_plink_fsm()  argument
822 	struct mesh_config *mshcfg = &sdata->u.mesh.mshcfg;  in mesh_plink_fsm()
827 	mpl_dbg(sdata, "peer %pM in state %s got event %s\n", sta->sta.addr,  in mesh_plink_fsm()
839 			sta->mesh->llid = mesh_get_new_llid(sdata);  in mesh_plink_fsm()
844 			changed |= ieee80211_mps_local_status_update(sdata);  in mesh_plink_fsm()
856 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
877 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
884 			changed |= mesh_plink_establish(sdata, sta);  in mesh_plink_fsm()
895 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
899 			changed |= mesh_plink_establish(sdata, sta);  in mesh_plink_fsm()
910 			changed |= mesh_set_ht_prot_mode(sdata);  in mesh_plink_fsm()
911 			changed |= mesh_set_short_slot_time(sdata);  in mesh_plink_fsm()
912 			mesh_plink_close(sdata, sta, event);  in mesh_plink_fsm()
949 		mesh_plink_frame_tx(sdata, sta, action, sta->sta.addr,  in mesh_plink_fsm()
955 			mesh_plink_frame_tx(sdata, sta,  in mesh_plink_fsm()
979 mesh_plink_get_event(struct ieee80211_sub_if_data *sdata,  in mesh_plink_get_event()  argument
990 			 mesh_matches_local(sdata, elems));  in mesh_plink_get_event()
1000 			mpl_dbg(sdata, "Mesh plink: cls or cnf from unknown peer\n");  in mesh_plink_get_event()
1004 		if (!mesh_plink_free_count(sdata)) {  in mesh_plink_get_event()
1005 			mpl_dbg(sdata, "Mesh plink error: no more free plinks\n");  in mesh_plink_get_event()
1014 			mpl_dbg(sdata, "Mesh plink: Action frame from non-authed peer\n");  in mesh_plink_get_event()
1025 		if (!mesh_plink_free_count(sdata) ||  in mesh_plink_get_event()
1034 		if (!mesh_plink_free_count(sdata) ||  in mesh_plink_get_event()
1061 		mpl_dbg(sdata, "Mesh plink: unknown frame subtype\n");  in mesh_plink_get_event()
1070 mesh_process_plink_frame(struct ieee80211_sub_if_data *sdata,  in mesh_process_plink_frame()  argument
1083 		mpl_dbg(sdata,  in mesh_process_plink_frame()
1089 	    sdata->u.mesh.security == IEEE80211_MESH_SEC_NONE) {  in mesh_process_plink_frame()
1090 		mpl_dbg(sdata,  in mesh_process_plink_frame()
1100 		mpl_dbg(sdata,  in mesh_process_plink_frame()
1108 		mpl_dbg(sdata, "Mesh plink: missing necessary ie\n");  in mesh_process_plink_frame()
1122 	sta = sta_info_get(sdata, mgmt->sa);  in mesh_process_plink_frame()
1125 	    !rssi_threshold_check(sdata, sta)) {  in mesh_process_plink_frame()
1126 		mpl_dbg(sdata, "Mesh plink: %pM does not meet rssi threshold\n",  in mesh_process_plink_frame()
1132 	event = mesh_plink_get_event(sdata, sta, elems, ftype, llid, plid);  in mesh_process_plink_frame()
1137 		sta = mesh_sta_info_get(sdata, mgmt->sa, elems);  in mesh_process_plink_frame()
1139 			mpl_dbg(sdata, "Mesh plink: failed to init peer!\n");  in mesh_process_plink_frame()
1144 		mesh_plink_frame_tx(sdata, NULL, WLAN_SP_MESH_PEERING_CLOSE,  in mesh_process_plink_frame()
1161 	changed |= mesh_plink_fsm(sdata, sta, event);  in mesh_process_plink_frame()
1167 		ieee80211_mbss_info_change_notify(sdata, changed);  in mesh_process_plink_frame()
1170 void mesh_rx_plink_frame(struct ieee80211_sub_if_data *sdata,  in mesh_rx_plink_frame()  argument
1182 	if (sdata->u.mesh.user_mpm)  in mesh_rx_plink_frame()
1187 		mpl_dbg(sdata,  in mesh_rx_plink_frame()
1203 	mesh_process_plink_frame(sdata, mgmt, &elems);  in mesh_rx_plink_frame()