1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /*
3  * Copyright (C) 2012-2014, 2020 Intel Corporation
4  * Copyright (C) 2016 Intel Deutschland GmbH
5  * Copyright (C) 2022 Intel Corporation
6  */
7 #include <net/mac80211.h>
8 #include "fw-api.h"
9 #include "mvm.h"
10 
11 struct iwl_mvm_iface_iterator_data {
12 	struct ieee80211_vif *ignore_vif;
13 	int idx;
14 
15 	struct iwl_mvm_phy_ctxt *phyctxt;
16 
17 	u16 ids[MAX_MACS_IN_BINDING];
18 	u16 colors[MAX_MACS_IN_BINDING];
19 };
20 
21 static int iwl_mvm_binding_cmd(struct iwl_mvm *mvm, u32 action,
22 			       struct iwl_mvm_iface_iterator_data *data)
23 {
24 	struct iwl_binding_cmd cmd;
25 	struct iwl_mvm_phy_ctxt *phyctxt = data->phyctxt;
26 	int i, ret;
27 	u32 status;
28 	int size;
29 
30 	memset(&cmd, 0, sizeof(cmd));
31 
32 	if (fw_has_capa(&mvm->fw->ucode_capa,
33 			IWL_UCODE_TLV_CAPA_BINDING_CDB_SUPPORT)) {
34 		size = sizeof(cmd);
35 		cmd.lmac_id = cpu_to_le32(iwl_mvm_get_lmac_id(mvm->fw,
36 							      phyctxt->channel->band));
37 	} else {
38 		size = IWL_BINDING_CMD_SIZE_V1;
39 	}
40 
41 	cmd.id_and_color = cpu_to_le32(FW_CMD_ID_AND_COLOR(phyctxt->id,
42 							   phyctxt->color));
43 	cmd.action = cpu_to_le32(action);
44 	cmd.phy = cpu_to_le32(FW_CMD_ID_AND_COLOR(phyctxt->id,
45 						  phyctxt->color));
46 
47 	for (i = 0; i < MAX_MACS_IN_BINDING; i++)
48 		cmd.macs[i] = cpu_to_le32(FW_CTXT_INVALID);
49 	for (i = 0; i < data->idx; i++)
50 		cmd.macs[i] = cpu_to_le32(FW_CMD_ID_AND_COLOR(data->ids[i],
51 							      data->colors[i]));
52 
53 	status = 0;
54 	ret = iwl_mvm_send_cmd_pdu_status(mvm, BINDING_CONTEXT_CMD,
55 					  size, &cmd, &status);
56 	if (ret) {
57 		IWL_ERR(mvm, "Failed to send binding (action:%d): %d\n",
58 			action, ret);
59 		return ret;
60 	}
61 
62 	if (status) {
63 		IWL_ERR(mvm, "Binding command failed: %u\n", status);
64 		ret = -EIO;
65 	}
66 
67 	return ret;
68 }
69 
70 static void iwl_mvm_iface_iterator(void *_data, u8 *mac,
71 				   struct ieee80211_vif *vif)
72 {
73 	struct iwl_mvm_iface_iterator_data *data = _data;
74 	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
75 
76 	if (vif == data->ignore_vif)
77 		return;
78 
79 	if (mvmvif->deflink.phy_ctxt != data->phyctxt)
80 		return;
81 
82 	if (WARN_ON_ONCE(data->idx >= MAX_MACS_IN_BINDING))
83 		return;
84 
85 	data->ids[data->idx] = mvmvif->id;
86 	data->colors[data->idx] = mvmvif->color;
87 	data->idx++;
88 }
89 
90 static int iwl_mvm_binding_update(struct iwl_mvm *mvm,
91 				  struct ieee80211_vif *vif,
92 				  struct iwl_mvm_phy_ctxt *phyctxt,
93 				  bool add)
94 {
95 	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
96 	struct iwl_mvm_iface_iterator_data data = {
97 		.ignore_vif = vif,
98 		.phyctxt = phyctxt,
99 	};
100 	u32 action = FW_CTXT_ACTION_MODIFY;
101 
102 	lockdep_assert_held(&mvm->mutex);
103 
104 	ieee80211_iterate_active_interfaces_atomic(mvm->hw,
105 						   IEEE80211_IFACE_ITER_NORMAL,
106 						   iwl_mvm_iface_iterator,
107 						   &data);
108 
109 	/*
110 	 * If there are no other interfaces yet we
111 	 * need to create a new binding.
112 	 */
113 	if (data.idx == 0) {
114 		if (add)
115 			action = FW_CTXT_ACTION_ADD;
116 		else
117 			action = FW_CTXT_ACTION_REMOVE;
118 	}
119 
120 	if (add) {
121 		if (WARN_ON_ONCE(data.idx >= MAX_MACS_IN_BINDING))
122 			return -EINVAL;
123 
124 		data.ids[data.idx] = mvmvif->id;
125 		data.colors[data.idx] = mvmvif->color;
126 		data.idx++;
127 	}
128 
129 	return iwl_mvm_binding_cmd(mvm, action, &data);
130 }
131 
132 int iwl_mvm_binding_add_vif(struct iwl_mvm *mvm, struct ieee80211_vif *vif)
133 {
134 	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
135 
136 	if (WARN_ON_ONCE(!mvmvif->deflink.phy_ctxt))
137 		return -EINVAL;
138 
139 	/*
140 	 * Update SF - Disable if needed. if this fails, SF might still be on
141 	 * while many macs are bound, which is forbidden - so fail the binding.
142 	 */
143 	if (iwl_mvm_sf_update(mvm, vif, false))
144 		return -EINVAL;
145 
146 	return iwl_mvm_binding_update(mvm, vif, mvmvif->deflink.phy_ctxt,
147 				      true);
148 }
149 
150 int iwl_mvm_binding_remove_vif(struct iwl_mvm *mvm, struct ieee80211_vif *vif)
151 {
152 	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
153 	int ret;
154 
155 	if (WARN_ON_ONCE(!mvmvif->deflink.phy_ctxt))
156 		return -EINVAL;
157 
158 	ret = iwl_mvm_binding_update(mvm, vif, mvmvif->deflink.phy_ctxt,
159 				     false);
160 
161 	if (!ret)
162 		if (iwl_mvm_sf_update(mvm, vif, true))
163 			IWL_ERR(mvm, "Failed to update SF state\n");
164 
165 	return ret;
166 }
167