Debian Codegraph @

drivers/net/wireless/intel/iwlwifi/mvm/link.c

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