xref: /linux/drivers/net/wireless/intel/iwlwifi/mvm/link.c (revision 1f20a5769446a1acae67ac9e63d07a594829a789)
1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /*
3  * Copyright (C) 2022 - 2024 Intel Corporation
4  */
5 #include "mvm.h"
6 #include "time-event.h"
7 
8 static u32 iwl_mvm_get_free_fw_link_id(struct iwl_mvm *mvm,
9 				       struct iwl_mvm_vif *mvm_vif)
10 {
11 	u32 link_id;
12 
13 	lockdep_assert_held(&mvm->mutex);
14 
15 	link_id = ffz(mvm->fw_link_ids_map);
16 
17 	/* this case can happen if there're deactivated but not removed links */
18 	if (link_id > IWL_MVM_FW_MAX_LINK_ID)
19 		return IWL_MVM_FW_LINK_ID_INVALID;
20 
21 	mvm->fw_link_ids_map |= BIT(link_id);
22 	return link_id;
23 }
24 
25 static void iwl_mvm_release_fw_link_id(struct iwl_mvm *mvm, u32 link_id)
26 {
27 	lockdep_assert_held(&mvm->mutex);
28 
29 	if (!WARN_ON(link_id > IWL_MVM_FW_MAX_LINK_ID))
30 		mvm->fw_link_ids_map &= ~BIT(link_id);
31 }
32 
33 static int iwl_mvm_link_cmd_send(struct iwl_mvm *mvm,
34 				 struct iwl_link_config_cmd *cmd,
35 				 enum iwl_ctxt_action action)
36 {
37 	int ret;
38 
39 	cmd->action = cpu_to_le32(action);
40 	ret = iwl_mvm_send_cmd_pdu(mvm,
41 				   WIDE_ID(MAC_CONF_GROUP, LINK_CONFIG_CMD), 0,
42 				   sizeof(*cmd), cmd);
43 	if (ret)
44 		IWL_ERR(mvm, "Failed to send LINK_CONFIG_CMD (action:%d): %d\n",
45 			action, ret);
46 	return ret;
47 }
48 
49 int iwl_mvm_set_link_mapping(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
50 			     struct ieee80211_bss_conf *link_conf)
51 {
52 	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
53 	struct iwl_mvm_vif_link_info *link_info =
54 		mvmvif->link[link_conf->link_id];
55 
56 	if (link_info->fw_link_id == IWL_MVM_FW_LINK_ID_INVALID) {
57 		link_info->fw_link_id = iwl_mvm_get_free_fw_link_id(mvm,
58 								    mvmvif);
59 		if (link_info->fw_link_id >=
60 		    ARRAY_SIZE(mvm->link_id_to_link_conf))
61 			return -EINVAL;
62 
63 		rcu_assign_pointer(mvm->link_id_to_link_conf[link_info->fw_link_id],
64 				   link_conf);
65 	}
66 
67 	return 0;
68 }
69 
70 int iwl_mvm_add_link(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
71 		     struct ieee80211_bss_conf *link_conf)
72 {
73 	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
74 	unsigned int link_id = link_conf->link_id;
75 	struct iwl_mvm_vif_link_info *link_info = mvmvif->link[link_id];
76 	struct iwl_link_config_cmd cmd = {};
77 	unsigned int cmd_id = WIDE_ID(MAC_CONF_GROUP, LINK_CONFIG_CMD);
78 	u8 cmd_ver = iwl_fw_lookup_cmd_ver(mvm->fw, cmd_id, 1);
79 	int ret;
80 
81 	if (WARN_ON_ONCE(!link_info))
82 		return -EINVAL;
83 
84 	ret = iwl_mvm_set_link_mapping(mvm, vif, link_conf);
85 	if (ret)
86 		return ret;
87 
88 	/* Update SF - Disable if needed. if this fails, SF might still be on
89 	 * while many macs are bound, which is forbidden - so fail the binding.
90 	 */
91 	if (iwl_mvm_sf_update(mvm, vif, false))
92 		return -EINVAL;
93 
94 	cmd.link_id = cpu_to_le32(link_info->fw_link_id);
95 	cmd.mac_id = cpu_to_le32(mvmvif->id);
96 	cmd.spec_link_id = link_conf->link_id;
97 	WARN_ON_ONCE(link_info->phy_ctxt);
98 	cmd.phy_id = cpu_to_le32(FW_CTXT_INVALID);
99 
100 	memcpy(cmd.local_link_addr, link_conf->addr, ETH_ALEN);
101 
102 	if (vif->type == NL80211_IFTYPE_ADHOC && link_conf->bssid)
103 		memcpy(cmd.ibss_bssid_addr, link_conf->bssid, ETH_ALEN);
104 
105 	if (cmd_ver < 2)
106 		cmd.listen_lmac = cpu_to_le32(link_info->listen_lmac);
107 
108 	return iwl_mvm_link_cmd_send(mvm, &cmd, FW_CTXT_ACTION_ADD);
109 }
110 
111 int iwl_mvm_link_changed(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
112 			 struct ieee80211_bss_conf *link_conf,
113 			 u32 changes, bool active)
114 {
115 	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
116 	unsigned int link_id = link_conf->link_id;
117 	struct iwl_mvm_vif_link_info *link_info = mvmvif->link[link_id];
118 	struct iwl_mvm_phy_ctxt *phyctxt;
119 	struct iwl_link_config_cmd cmd = {};
120 	u32 ht_flag, flags = 0, flags_mask = 0;
121 	int ret;
122 	unsigned int cmd_id = WIDE_ID(MAC_CONF_GROUP, LINK_CONFIG_CMD);
123 	u8 cmd_ver = iwl_fw_lookup_cmd_ver(mvm->fw, cmd_id, 1);
124 
125 	if (WARN_ON_ONCE(!link_info ||
126 			 link_info->fw_link_id == IWL_MVM_FW_LINK_ID_INVALID))
127 		return -EINVAL;
128 
129 	if (changes & LINK_CONTEXT_MODIFY_ACTIVE) {
130 		/* When activating a link, phy context should be valid;
131 		 * when deactivating a link, it also should be valid since
132 		 * the link was active before. So, do nothing in this case.
133 		 * Since a link is added first with FW_CTXT_INVALID, then we
134 		 * can get here in case it's removed before it was activated.
135 		 */
136 		if (!link_info->phy_ctxt)
137 			return 0;
138 
139 		/* Catch early if driver tries to activate or deactivate a link
140 		 * twice.
141 		 */
142 		WARN_ON_ONCE(active == link_info->active);
143 
144 		/* When deactivating a link session protection should
145 		 * be stopped
146 		 */
147 		if (!active && vif->type == NL80211_IFTYPE_STATION)
148 			iwl_mvm_stop_session_protection(mvm, vif);
149 	}
150 
151 	cmd.link_id = cpu_to_le32(link_info->fw_link_id);
152 
153 	/* The phy_id, link address and listen_lmac can be modified only until
154 	 * the link becomes active, otherwise they will be ignored.
155 	 */
156 	phyctxt = link_info->phy_ctxt;
157 	if (phyctxt)
158 		cmd.phy_id = cpu_to_le32(phyctxt->id);
159 	else
160 		cmd.phy_id = cpu_to_le32(FW_CTXT_INVALID);
161 	cmd.mac_id = cpu_to_le32(mvmvif->id);
162 
163 	memcpy(cmd.local_link_addr, link_conf->addr, ETH_ALEN);
164 
165 	cmd.active = cpu_to_le32(active);
166 
167 	if (vif->type == NL80211_IFTYPE_ADHOC && link_conf->bssid)
168 		memcpy(cmd.ibss_bssid_addr, link_conf->bssid, ETH_ALEN);
169 
170 	iwl_mvm_set_fw_basic_rates(mvm, vif, link_conf,
171 				   &cmd.cck_rates, &cmd.ofdm_rates);
172 
173 	cmd.cck_short_preamble = cpu_to_le32(link_conf->use_short_preamble);
174 	cmd.short_slot = cpu_to_le32(link_conf->use_short_slot);
175 
176 	/* The fw does not distinguish between ht and fat */
177 	ht_flag = LINK_PROT_FLG_HT_PROT | LINK_PROT_FLG_FAT_PROT;
178 	iwl_mvm_set_fw_protection_flags(mvm, vif, link_conf,
179 					&cmd.protection_flags,
180 					ht_flag, LINK_PROT_FLG_TGG_PROTECT);
181 
182 	iwl_mvm_set_fw_qos_params(mvm, vif, link_conf, cmd.ac,
183 				  &cmd.qos_flags);
184 
185 
186 	cmd.bi = cpu_to_le32(link_conf->beacon_int);
187 	cmd.dtim_interval = cpu_to_le32(link_conf->beacon_int *
188 					link_conf->dtim_period);
189 
190 	if (!link_conf->he_support || iwlwifi_mod_params.disable_11ax ||
191 	    (vif->type == NL80211_IFTYPE_STATION && !vif->cfg.assoc)) {
192 		changes &= ~LINK_CONTEXT_MODIFY_HE_PARAMS;
193 		goto send_cmd;
194 	}
195 
196 	cmd.htc_trig_based_pkt_ext = link_conf->htc_trig_based_pkt_ext;
197 
198 	if (link_conf->uora_exists) {
199 		cmd.rand_alloc_ecwmin =
200 			link_conf->uora_ocw_range & 0x7;
201 		cmd.rand_alloc_ecwmax =
202 			(link_conf->uora_ocw_range >> 3) & 0x7;
203 	}
204 
205 	/* TODO  how to set ndp_fdbk_buff_th_exp? */
206 
207 	if (iwl_mvm_set_fw_mu_edca_params(mvm, mvmvif->link[link_id],
208 					  &cmd.trig_based_txf[0])) {
209 		flags |= LINK_FLG_MU_EDCA_CW;
210 		flags_mask |= LINK_FLG_MU_EDCA_CW;
211 	}
212 
213 	if (changes & LINK_CONTEXT_MODIFY_EHT_PARAMS) {
214 		struct ieee80211_chanctx_conf *ctx;
215 		struct cfg80211_chan_def *def = NULL;
216 
217 		rcu_read_lock();
218 		ctx = rcu_dereference(link_conf->chanctx_conf);
219 		if (ctx)
220 			def = iwl_mvm_chanctx_def(mvm, ctx);
221 
222 		if (iwlwifi_mod_params.disable_11be ||
223 		    !link_conf->eht_support || !def ||
224 		    iwl_fw_lookup_cmd_ver(mvm->fw, PHY_CONTEXT_CMD, 1) >= 6)
225 			changes &= ~LINK_CONTEXT_MODIFY_EHT_PARAMS;
226 		else
227 			cmd.puncture_mask = cpu_to_le16(def->punctured);
228 		rcu_read_unlock();
229 	}
230 
231 	cmd.bss_color = link_conf->he_bss_color.color;
232 
233 	if (!link_conf->he_bss_color.enabled) {
234 		flags |= LINK_FLG_BSS_COLOR_DIS;
235 		flags_mask |= LINK_FLG_BSS_COLOR_DIS;
236 	}
237 
238 	cmd.frame_time_rts_th = cpu_to_le16(link_conf->frame_time_rts_th);
239 
240 	/* Block 26-tone RU OFDMA transmissions */
241 	if (link_info->he_ru_2mhz_block) {
242 		flags |= LINK_FLG_RU_2MHZ_BLOCK;
243 		flags_mask |= LINK_FLG_RU_2MHZ_BLOCK;
244 	}
245 
246 	if (link_conf->nontransmitted) {
247 		ether_addr_copy(cmd.ref_bssid_addr,
248 				link_conf->transmitter_bssid);
249 		cmd.bssid_index = link_conf->bssid_index;
250 	}
251 
252 send_cmd:
253 	cmd.modify_mask = cpu_to_le32(changes);
254 	cmd.flags = cpu_to_le32(flags);
255 	cmd.flags_mask = cpu_to_le32(flags_mask);
256 	cmd.spec_link_id = link_conf->link_id;
257 	if (cmd_ver < 2)
258 		cmd.listen_lmac = cpu_to_le32(link_info->listen_lmac);
259 
260 	ret = iwl_mvm_link_cmd_send(mvm, &cmd, FW_CTXT_ACTION_MODIFY);
261 	if (!ret && (changes & LINK_CONTEXT_MODIFY_ACTIVE))
262 		link_info->active = active;
263 
264 	return ret;
265 }
266 
267 int iwl_mvm_unset_link_mapping(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
268 			       struct ieee80211_bss_conf *link_conf)
269 {
270 	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
271 	struct iwl_mvm_vif_link_info *link_info =
272 		mvmvif->link[link_conf->link_id];
273 
274 	/* mac80211 thought we have the link, but it was never configured */
275 	if (WARN_ON(!link_info ||
276 		    link_info->fw_link_id >=
277 		    ARRAY_SIZE(mvm->link_id_to_link_conf)))
278 		return -EINVAL;
279 
280 	RCU_INIT_POINTER(mvm->link_id_to_link_conf[link_info->fw_link_id],
281 			 NULL);
282 	iwl_mvm_release_fw_link_id(mvm, link_info->fw_link_id);
283 	return 0;
284 }
285 
286 int iwl_mvm_remove_link(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
287 			struct ieee80211_bss_conf *link_conf)
288 {
289 	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
290 	unsigned int link_id = link_conf->link_id;
291 	struct iwl_mvm_vif_link_info *link_info = mvmvif->link[link_id];
292 	struct iwl_link_config_cmd cmd = {};
293 	int ret;
294 
295 	ret = iwl_mvm_unset_link_mapping(mvm, vif, link_conf);
296 	if (ret)
297 		return 0;
298 
299 	cmd.link_id = cpu_to_le32(link_info->fw_link_id);
300 	link_info->fw_link_id = IWL_MVM_FW_LINK_ID_INVALID;
301 	cmd.spec_link_id = link_conf->link_id;
302 	cmd.phy_id = cpu_to_le32(FW_CTXT_INVALID);
303 
304 	ret = iwl_mvm_link_cmd_send(mvm, &cmd, FW_CTXT_ACTION_REMOVE);
305 
306 	if (!ret)
307 		if (iwl_mvm_sf_update(mvm, vif, true))
308 			IWL_ERR(mvm, "Failed to update SF state\n");
309 
310 	return ret;
311 }
312 
313 /* link should be deactivated before removal, so in most cases we need to
314  * perform these two operations together
315  */
316 int iwl_mvm_disable_link(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
317 			 struct ieee80211_bss_conf *link_conf)
318 {
319 	int ret;
320 
321 	ret = iwl_mvm_link_changed(mvm, vif, link_conf,
322 				   LINK_CONTEXT_MODIFY_ACTIVE, false);
323 	if (ret)
324 		return ret;
325 
326 	ret = iwl_mvm_remove_link(mvm, vif, link_conf);
327 	if (ret)
328 		return ret;
329 
330 	return ret;
331 }
332