1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /*
3 * Copyright (C) 2022 - 2023 Intel Corporation
4 */
5 #include "mvm.h"
6 #include "time-event.h"
7
iwl_mvm_get_free_fw_link_id(struct iwl_mvm * mvm,struct iwl_mvm_vif * mvm_vif)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
iwl_mvm_release_fw_link_id(struct iwl_mvm * mvm,u32 link_id)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
iwl_mvm_link_cmd_send(struct iwl_mvm * mvm,struct iwl_link_config_cmd * cmd,enum iwl_ctxt_action action)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
iwl_mvm_add_link(struct iwl_mvm * mvm,struct ieee80211_vif * vif,struct ieee80211_bss_conf * link_conf)49 int iwl_mvm_add_link(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 unsigned int link_id = link_conf->link_id;
54 struct iwl_mvm_vif_link_info *link_info = mvmvif->link[link_id];
55 struct iwl_link_config_cmd cmd = {};
56 struct iwl_mvm_phy_ctxt *phyctxt;
57
58 if (WARN_ON_ONCE(!link_info))
59 return -EINVAL;
60
61 if (link_info->fw_link_id == IWL_MVM_FW_LINK_ID_INVALID) {
62 link_info->fw_link_id = iwl_mvm_get_free_fw_link_id(mvm,
63 mvmvif);
64 if (link_info->fw_link_id == IWL_MVM_FW_LINK_ID_INVALID)
65 return -EINVAL;
66
67 rcu_assign_pointer(mvm->link_id_to_link_conf[link_info->fw_link_id],
68 link_conf);
69 }
70
71 /* Update SF - Disable if needed. if this fails, SF might still be on
72 * while many macs are bound, which is forbidden - so fail the binding.
73 */
74 if (iwl_mvm_sf_update(mvm, vif, false))
75 return -EINVAL;
76
77 cmd.link_id = cpu_to_le32(link_info->fw_link_id);
78 cmd.mac_id = cpu_to_le32(mvmvif->id);
79 cmd.spec_link_id = link_conf->link_id;
80 /* P2P-Device already has a valid PHY context during add */
81 phyctxt = link_info->phy_ctxt;
82 if (phyctxt)
83 cmd.phy_id = cpu_to_le32(phyctxt->id);
84 else
85 cmd.phy_id = cpu_to_le32(FW_CTXT_INVALID);
86
87 memcpy(cmd.local_link_addr, link_conf->addr, ETH_ALEN);
88
89 if (vif->type == NL80211_IFTYPE_ADHOC && link_conf->bssid)
90 memcpy(cmd.ibss_bssid_addr, link_conf->bssid, ETH_ALEN);
91
92 cmd.listen_lmac = cpu_to_le32(link_info->listen_lmac);
93
94 return iwl_mvm_link_cmd_send(mvm, &cmd, FW_CTXT_ACTION_ADD);
95 }
96
iwl_mvm_link_changed(struct iwl_mvm * mvm,struct ieee80211_vif * vif,struct ieee80211_bss_conf * link_conf,u32 changes,bool active)97 int iwl_mvm_link_changed(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
98 struct ieee80211_bss_conf *link_conf,
99 u32 changes, bool active)
100 {
101 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
102 unsigned int link_id = link_conf->link_id;
103 struct iwl_mvm_vif_link_info *link_info = mvmvif->link[link_id];
104 struct iwl_mvm_phy_ctxt *phyctxt;
105 struct iwl_link_config_cmd cmd = {};
106 u32 ht_flag, flags = 0, flags_mask = 0;
107 int ret;
108
109 if (WARN_ON_ONCE(!link_info ||
110 link_info->fw_link_id == IWL_MVM_FW_LINK_ID_INVALID))
111 return -EINVAL;
112
113 if (changes & LINK_CONTEXT_MODIFY_ACTIVE) {
114 /* When activating a link, phy context should be valid;
115 * when deactivating a link, it also should be valid since
116 * the link was active before. So, do nothing in this case.
117 * Since a link is added first with FW_CTXT_INVALID, then we
118 * can get here in case it's removed before it was activated.
119 */
120 if (!link_info->phy_ctxt)
121 return 0;
122
123 /* Catch early if driver tries to activate or deactivate a link
124 * twice.
125 */
126 WARN_ON_ONCE(active == link_info->active);
127
128 /* When deactivating a link session protection should
129 * be stopped
130 */
131 if (!active && vif->type == NL80211_IFTYPE_STATION)
132 iwl_mvm_stop_session_protection(mvm, vif);
133 }
134
135 cmd.link_id = cpu_to_le32(link_info->fw_link_id);
136
137 /* The phy_id, link address and listen_lmac can be modified only until
138 * the link becomes active, otherwise they will be ignored.
139 */
140 phyctxt = link_info->phy_ctxt;
141 if (phyctxt)
142 cmd.phy_id = cpu_to_le32(phyctxt->id);
143 else
144 cmd.phy_id = cpu_to_le32(FW_CTXT_INVALID);
145 cmd.mac_id = cpu_to_le32(mvmvif->id);
146
147 memcpy(cmd.local_link_addr, link_conf->addr, ETH_ALEN);
148
149 cmd.active = cpu_to_le32(active);
150
151 if (vif->type == NL80211_IFTYPE_ADHOC && link_conf->bssid)
152 memcpy(cmd.ibss_bssid_addr, link_conf->bssid, ETH_ALEN);
153
154 iwl_mvm_set_fw_basic_rates(mvm, vif, link_conf,
155 &cmd.cck_rates, &cmd.ofdm_rates);
156
157 cmd.cck_short_preamble = cpu_to_le32(link_conf->use_short_preamble);
158 cmd.short_slot = cpu_to_le32(link_conf->use_short_slot);
159
160 /* The fw does not distinguish between ht and fat */
161 ht_flag = LINK_PROT_FLG_HT_PROT | LINK_PROT_FLG_FAT_PROT;
162 iwl_mvm_set_fw_protection_flags(mvm, vif, link_conf,
163 &cmd.protection_flags,
164 ht_flag, LINK_PROT_FLG_TGG_PROTECT);
165
166 iwl_mvm_set_fw_qos_params(mvm, vif, link_conf, cmd.ac,
167 &cmd.qos_flags);
168
169
170 cmd.bi = cpu_to_le32(link_conf->beacon_int);
171 cmd.dtim_interval = cpu_to_le32(link_conf->beacon_int *
172 link_conf->dtim_period);
173
174 if (!link_conf->he_support || iwlwifi_mod_params.disable_11ax ||
175 (vif->type == NL80211_IFTYPE_STATION && !vif->cfg.assoc)) {
176 changes &= ~LINK_CONTEXT_MODIFY_HE_PARAMS;
177 goto send_cmd;
178 }
179
180 cmd.htc_trig_based_pkt_ext = link_conf->htc_trig_based_pkt_ext;
181
182 if (link_conf->uora_exists) {
183 cmd.rand_alloc_ecwmin =
184 link_conf->uora_ocw_range & 0x7;
185 cmd.rand_alloc_ecwmax =
186 (link_conf->uora_ocw_range >> 3) & 0x7;
187 }
188
189 /* TODO how to set ndp_fdbk_buff_th_exp? */
190
191 if (iwl_mvm_set_fw_mu_edca_params(mvm, mvmvif->link[link_id],
192 &cmd.trig_based_txf[0])) {
193 flags |= LINK_FLG_MU_EDCA_CW;
194 flags_mask |= LINK_FLG_MU_EDCA_CW;
195 }
196
197 if (link_conf->eht_puncturing && !iwlwifi_mod_params.disable_11be)
198 cmd.puncture_mask = cpu_to_le16(link_conf->eht_puncturing);
199 else
200 /* This flag can be set only if the MAC has eht support */
201 changes &= ~LINK_CONTEXT_MODIFY_EHT_PARAMS;
202
203 cmd.bss_color = link_conf->he_bss_color.color;
204
205 if (!link_conf->he_bss_color.enabled) {
206 flags |= LINK_FLG_BSS_COLOR_DIS;
207 flags_mask |= LINK_FLG_BSS_COLOR_DIS;
208 }
209
210 cmd.frame_time_rts_th = cpu_to_le16(link_conf->frame_time_rts_th);
211
212 /* Block 26-tone RU OFDMA transmissions */
213 if (link_info->he_ru_2mhz_block) {
214 flags |= LINK_FLG_RU_2MHZ_BLOCK;
215 flags_mask |= LINK_FLG_RU_2MHZ_BLOCK;
216 }
217
218 if (link_conf->nontransmitted) {
219 ether_addr_copy(cmd.ref_bssid_addr,
220 link_conf->transmitter_bssid);
221 cmd.bssid_index = link_conf->bssid_index;
222 }
223
224 send_cmd:
225 cmd.modify_mask = cpu_to_le32(changes);
226 cmd.flags = cpu_to_le32(flags);
227 cmd.flags_mask = cpu_to_le32(flags_mask);
228 cmd.spec_link_id = link_conf->link_id;
229 cmd.listen_lmac = cpu_to_le32(link_info->listen_lmac);
230
231 ret = iwl_mvm_link_cmd_send(mvm, &cmd, FW_CTXT_ACTION_MODIFY);
232 if (!ret && (changes & LINK_CONTEXT_MODIFY_ACTIVE))
233 link_info->active = active;
234
235 return ret;
236 }
237
iwl_mvm_remove_link(struct iwl_mvm * mvm,struct ieee80211_vif * vif,struct ieee80211_bss_conf * link_conf)238 int iwl_mvm_remove_link(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
239 struct ieee80211_bss_conf *link_conf)
240 {
241 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
242 unsigned int link_id = link_conf->link_id;
243 struct iwl_mvm_vif_link_info *link_info = mvmvif->link[link_id];
244 struct iwl_link_config_cmd cmd = {};
245 int ret;
246
247 if (WARN_ON(!link_info ||
248 link_info->fw_link_id == IWL_MVM_FW_LINK_ID_INVALID))
249 return -EINVAL;
250
251 RCU_INIT_POINTER(mvm->link_id_to_link_conf[link_info->fw_link_id],
252 NULL);
253 cmd.link_id = cpu_to_le32(link_info->fw_link_id);
254 iwl_mvm_release_fw_link_id(mvm, link_info->fw_link_id);
255 link_info->fw_link_id = IWL_MVM_FW_LINK_ID_INVALID;
256 cmd.spec_link_id = link_conf->link_id;
257
258 ret = iwl_mvm_link_cmd_send(mvm, &cmd, FW_CTXT_ACTION_REMOVE);
259
260 if (!ret)
261 if (iwl_mvm_sf_update(mvm, vif, true))
262 IWL_ERR(mvm, "Failed to update SF state\n");
263
264 return ret;
265 }
266
267 /* link should be deactivated before removal, so in most cases we need to
268 * perform these two operations together
269 */
iwl_mvm_disable_link(struct iwl_mvm * mvm,struct ieee80211_vif * vif,struct ieee80211_bss_conf * link_conf)270 int iwl_mvm_disable_link(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
271 struct ieee80211_bss_conf *link_conf)
272 {
273 int ret;
274
275 ret = iwl_mvm_link_changed(mvm, vif, link_conf,
276 LINK_CONTEXT_MODIFY_ACTIVE, false);
277 if (ret)
278 return ret;
279
280 ret = iwl_mvm_remove_link(mvm, vif, link_conf);
281 if (ret)
282 return ret;
283
284 return ret;
285 }
286
