Linux Audio

Check our new training course

Loading...
v4.17
  1/******************************************************************************
  2 *
  3 * This file is provided under a dual BSD/GPLv2 license.  When using or
  4 * redistributing this file, you may do so under either license.
  5 *
  6 * GPL LICENSE SUMMARY
  7 *
  8 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved.
  9 * Copyright(c) 2013 - 2014 Intel Mobile Communications GmbH
 10 * Copyright(c) 2017           Intel Deutschland GmbH
 11 * Copyright(c) 2018           Intel Corporation
 12 *
 13 * This program is free software; you can redistribute it and/or modify
 14 * it under the terms of version 2 of the GNU General Public License as
 15 * published by the Free Software Foundation.
 16 *
 17 * This program is distributed in the hope that it will be useful, but
 18 * WITHOUT ANY WARRANTY; without even the implied warranty of
 19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 20 * General Public License for more details.
 21 *
 
 
 
 
 
 22 * The full GNU General Public License is included in this distribution
 23 * in the file called COPYING.
 24 *
 25 * Contact Information:
 26 *  Intel Linux Wireless <linuxwifi@intel.com>
 27 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
 28 *
 29 * BSD LICENSE
 30 *
 31 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved.
 32 * Copyright(c) 2013 - 2014 Intel Mobile Communications GmbH
 33 * Copyright(c) 2018           Intel Corporation
 34 * All rights reserved.
 35 *
 36 * Redistribution and use in source and binary forms, with or without
 37 * modification, are permitted provided that the following conditions
 38 * are met:
 39 *
 40 *  * Redistributions of source code must retain the above copyright
 41 *    notice, this list of conditions and the following disclaimer.
 42 *  * Redistributions in binary form must reproduce the above copyright
 43 *    notice, this list of conditions and the following disclaimer in
 44 *    the documentation and/or other materials provided with the
 45 *    distribution.
 46 *  * Neither the name Intel Corporation nor the names of its
 47 *    contributors may be used to endorse or promote products derived
 48 *    from this software without specific prior written permission.
 49 *
 50 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 51 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 52 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 53 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 54 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 55 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 56 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 57 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 58 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 59 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 60 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 61 *
 62 *****************************************************************************/
 63
 64#include <net/mac80211.h>
 65#include "fw-api.h"
 66#include "mvm.h"
 67
 68/* Maps the driver specific channel width definition to the fw values */
 69u8 iwl_mvm_get_channel_width(struct cfg80211_chan_def *chandef)
 70{
 71	switch (chandef->width) {
 72	case NL80211_CHAN_WIDTH_20_NOHT:
 73	case NL80211_CHAN_WIDTH_20:
 74		return PHY_VHT_CHANNEL_MODE20;
 75	case NL80211_CHAN_WIDTH_40:
 76		return PHY_VHT_CHANNEL_MODE40;
 77	case NL80211_CHAN_WIDTH_80:
 78		return PHY_VHT_CHANNEL_MODE80;
 79	case NL80211_CHAN_WIDTH_160:
 80		return PHY_VHT_CHANNEL_MODE160;
 81	default:
 82		WARN(1, "Invalid channel width=%u", chandef->width);
 83		return PHY_VHT_CHANNEL_MODE20;
 84	}
 85}
 86
 87/*
 88 * Maps the driver specific control channel position (relative to the center
 89 * freq) definitions to the the fw values
 90 */
 91u8 iwl_mvm_get_ctrl_pos(struct cfg80211_chan_def *chandef)
 92{
 93	switch (chandef->chan->center_freq - chandef->center_freq1) {
 94	case -70:
 95		return PHY_VHT_CTRL_POS_4_BELOW;
 96	case -50:
 97		return PHY_VHT_CTRL_POS_3_BELOW;
 98	case -30:
 99		return PHY_VHT_CTRL_POS_2_BELOW;
100	case -10:
101		return PHY_VHT_CTRL_POS_1_BELOW;
102	case  10:
103		return PHY_VHT_CTRL_POS_1_ABOVE;
104	case  30:
105		return PHY_VHT_CTRL_POS_2_ABOVE;
106	case  50:
107		return PHY_VHT_CTRL_POS_3_ABOVE;
108	case  70:
109		return PHY_VHT_CTRL_POS_4_ABOVE;
110	default:
111		WARN(1, "Invalid channel definition");
112	case 0:
113		/*
114		 * The FW is expected to check the control channel position only
115		 * when in HT/VHT and the channel width is not 20MHz. Return
116		 * this value as the default one.
117		 */
118		return PHY_VHT_CTRL_POS_1_BELOW;
119	}
120}
121
122/*
123 * Construct the generic fields of the PHY context command
124 */
125static void iwl_mvm_phy_ctxt_cmd_hdr(struct iwl_mvm_phy_ctxt *ctxt,
126				     struct iwl_phy_context_cmd *cmd,
127				     u32 action, u32 apply_time)
128{
129	memset(cmd, 0, sizeof(struct iwl_phy_context_cmd));
130
131	cmd->id_and_color = cpu_to_le32(FW_CMD_ID_AND_COLOR(ctxt->id,
132							    ctxt->color));
133	cmd->action = cpu_to_le32(action);
134	cmd->apply_time = cpu_to_le32(apply_time);
135}
136
137/*
138 * Add the phy configuration to the PHY context command
139 */
140static void iwl_mvm_phy_ctxt_cmd_data(struct iwl_mvm *mvm,
141				      struct iwl_phy_context_cmd *cmd,
142				      struct cfg80211_chan_def *chandef,
143				      u8 chains_static, u8 chains_dynamic)
144{
145	u8 active_cnt, idle_cnt;
146
147	/* Set the channel info data */
148	cmd->ci.band = (chandef->chan->band == NL80211_BAND_2GHZ ?
149	      PHY_BAND_24 : PHY_BAND_5);
150
151	cmd->ci.channel = chandef->chan->hw_value;
152	cmd->ci.width = iwl_mvm_get_channel_width(chandef);
153	cmd->ci.ctrl_pos = iwl_mvm_get_ctrl_pos(chandef);
154
155	/* Set rx the chains */
156	idle_cnt = chains_static;
157	active_cnt = chains_dynamic;
158
159	/* In scenarios where we only ever use a single-stream rates,
160	 * i.e. legacy 11b/g/a associations, single-stream APs or even
161	 * static SMPS, enable both chains to get diversity, improving
162	 * the case where we're far enough from the AP that attenuation
163	 * between the two antennas is sufficiently different to impact
164	 * performance.
165	 */
166	if (active_cnt == 1 && iwl_mvm_rx_diversity_allowed(mvm)) {
167		idle_cnt = 2;
168		active_cnt = 2;
169	}
170
171	cmd->rxchain_info = cpu_to_le32(iwl_mvm_get_valid_rx_ant(mvm) <<
172					PHY_RX_CHAIN_VALID_POS);
173	cmd->rxchain_info |= cpu_to_le32(idle_cnt << PHY_RX_CHAIN_CNT_POS);
174	cmd->rxchain_info |= cpu_to_le32(active_cnt <<
175					 PHY_RX_CHAIN_MIMO_CNT_POS);
176#ifdef CONFIG_IWLWIFI_DEBUGFS
177	if (unlikely(mvm->dbgfs_rx_phyinfo))
178		cmd->rxchain_info = cpu_to_le32(mvm->dbgfs_rx_phyinfo);
179#endif
180
181	cmd->txchain_info = cpu_to_le32(iwl_mvm_get_valid_tx_ant(mvm));
182}
183
184/*
185 * Send a command to apply the current phy configuration. The command is send
186 * only if something in the configuration changed: in case that this is the
187 * first time that the phy configuration is applied or in case that the phy
188 * configuration changed from the previous apply.
189 */
190static int iwl_mvm_phy_ctxt_apply(struct iwl_mvm *mvm,
191				  struct iwl_mvm_phy_ctxt *ctxt,
192				  struct cfg80211_chan_def *chandef,
193				  u8 chains_static, u8 chains_dynamic,
194				  u32 action, u32 apply_time)
195{
196	struct iwl_phy_context_cmd cmd;
197	int ret;
198
199	/* Set the command header fields */
200	iwl_mvm_phy_ctxt_cmd_hdr(ctxt, &cmd, action, apply_time);
201
202	/* Set the command data */
203	iwl_mvm_phy_ctxt_cmd_data(mvm, &cmd, chandef,
204				  chains_static, chains_dynamic);
205
206	ret = iwl_mvm_send_cmd_pdu(mvm, PHY_CONTEXT_CMD, 0,
207				   sizeof(struct iwl_phy_context_cmd),
208				   &cmd);
209	if (ret)
210		IWL_ERR(mvm, "PHY ctxt cmd error. ret=%d\n", ret);
211	return ret;
212}
213
214/*
215 * Send a command to add a PHY context based on the current HW configuration.
216 */
217int iwl_mvm_phy_ctxt_add(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt,
218			 struct cfg80211_chan_def *chandef,
219			 u8 chains_static, u8 chains_dynamic)
220{
221	WARN_ON(!test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status) &&
222		ctxt->ref);
223	lockdep_assert_held(&mvm->mutex);
224
225	ctxt->channel = chandef->chan;
226
227	return iwl_mvm_phy_ctxt_apply(mvm, ctxt, chandef,
228				      chains_static, chains_dynamic,
229				      FW_CTXT_ACTION_ADD, 0);
230}
231
232/*
233 * Update the number of references to the given PHY context. This is valid only
234 * in case the PHY context was already created, i.e., its reference count > 0.
235 */
236void iwl_mvm_phy_ctxt_ref(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt)
237{
238	lockdep_assert_held(&mvm->mutex);
239	ctxt->ref++;
240}
241
242/*
243 * Send a command to modify the PHY context based on the current HW
244 * configuration. Note that the function does not check that the configuration
245 * changed.
246 */
247int iwl_mvm_phy_ctxt_changed(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt,
248			     struct cfg80211_chan_def *chandef,
249			     u8 chains_static, u8 chains_dynamic)
250{
251	enum iwl_ctxt_action action = FW_CTXT_ACTION_MODIFY;
252
253	lockdep_assert_held(&mvm->mutex);
254
255	if (fw_has_capa(&mvm->fw->ucode_capa,
256			IWL_UCODE_TLV_CAPA_BINDING_CDB_SUPPORT) &&
257	    ctxt->channel->band != chandef->chan->band) {
258		int ret;
259
260		/* ... remove it here ...*/
261		ret = iwl_mvm_phy_ctxt_apply(mvm, ctxt, chandef,
262					     chains_static, chains_dynamic,
263					     FW_CTXT_ACTION_REMOVE, 0);
264		if (ret)
265			return ret;
266
267		/* ... and proceed to add it again */
268		action = FW_CTXT_ACTION_ADD;
269	}
270
271	ctxt->channel = chandef->chan;
272	ctxt->width = chandef->width;
273	return iwl_mvm_phy_ctxt_apply(mvm, ctxt, chandef,
274				      chains_static, chains_dynamic,
275				      action, 0);
276}
277
278void iwl_mvm_phy_ctxt_unref(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt)
279{
280	lockdep_assert_held(&mvm->mutex);
281
282	if (WARN_ON_ONCE(!ctxt))
283		return;
284
285	ctxt->ref--;
286
287	/*
288	 * Move unused phy's to a default channel. When the phy is moved the,
289	 * fw will cleanup immediate quiet bit if it was previously set,
290	 * otherwise we might not be able to reuse this phy.
291	 */
292	if (ctxt->ref == 0) {
293		struct ieee80211_channel *chan;
294		struct cfg80211_chan_def chandef;
295
296		chan = &mvm->hw->wiphy->bands[NL80211_BAND_2GHZ]->channels[0];
297		cfg80211_chandef_create(&chandef, chan, NL80211_CHAN_NO_HT);
298		iwl_mvm_phy_ctxt_changed(mvm, ctxt, &chandef, 1, 1);
299	}
300}
301
302static void iwl_mvm_binding_iterator(void *_data, u8 *mac,
303				     struct ieee80211_vif *vif)
304{
305	unsigned long *data = _data;
306	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
307
308	if (!mvmvif->phy_ctxt)
309		return;
310
311	if (vif->type == NL80211_IFTYPE_STATION ||
312	    vif->type == NL80211_IFTYPE_AP)
313		__set_bit(mvmvif->phy_ctxt->id, data);
314}
315
316int iwl_mvm_phy_ctx_count(struct iwl_mvm *mvm)
317{
318	unsigned long phy_ctxt_counter = 0;
319
320	ieee80211_iterate_active_interfaces_atomic(mvm->hw,
321						   IEEE80211_IFACE_ITER_NORMAL,
322						   iwl_mvm_binding_iterator,
323						   &phy_ctxt_counter);
324
325	return hweight8(phy_ctxt_counter);
326}
v4.10.11
  1/******************************************************************************
  2 *
  3 * This file is provided under a dual BSD/GPLv2 license.  When using or
  4 * redistributing this file, you may do so under either license.
  5 *
  6 * GPL LICENSE SUMMARY
  7 *
  8 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved.
  9 * Copyright(c) 2013 - 2014 Intel Mobile Communications GmbH
 
 
 10 *
 11 * This program is free software; you can redistribute it and/or modify
 12 * it under the terms of version 2 of the GNU General Public License as
 13 * published by the Free Software Foundation.
 14 *
 15 * This program is distributed in the hope that it will be useful, but
 16 * WITHOUT ANY WARRANTY; without even the implied warranty of
 17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 18 * General Public License for more details.
 19 *
 20 * You should have received a copy of the GNU General Public License
 21 * along with this program; if not, write to the Free Software
 22 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
 23 * USA
 24 *
 25 * The full GNU General Public License is included in this distribution
 26 * in the file called COPYING.
 27 *
 28 * Contact Information:
 29 *  Intel Linux Wireless <linuxwifi@intel.com>
 30 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
 31 *
 32 * BSD LICENSE
 33 *
 34 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved.
 35 * Copyright(c) 2013 - 2014 Intel Mobile Communications GmbH
 
 36 * All rights reserved.
 37 *
 38 * Redistribution and use in source and binary forms, with or without
 39 * modification, are permitted provided that the following conditions
 40 * are met:
 41 *
 42 *  * Redistributions of source code must retain the above copyright
 43 *    notice, this list of conditions and the following disclaimer.
 44 *  * Redistributions in binary form must reproduce the above copyright
 45 *    notice, this list of conditions and the following disclaimer in
 46 *    the documentation and/or other materials provided with the
 47 *    distribution.
 48 *  * Neither the name Intel Corporation nor the names of its
 49 *    contributors may be used to endorse or promote products derived
 50 *    from this software without specific prior written permission.
 51 *
 52 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 53 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 54 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 55 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 56 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 57 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 58 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 59 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 60 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 61 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 62 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 63 *
 64 *****************************************************************************/
 65
 66#include <net/mac80211.h>
 67#include "fw-api.h"
 68#include "mvm.h"
 69
 70/* Maps the driver specific channel width definition to the fw values */
 71u8 iwl_mvm_get_channel_width(struct cfg80211_chan_def *chandef)
 72{
 73	switch (chandef->width) {
 74	case NL80211_CHAN_WIDTH_20_NOHT:
 75	case NL80211_CHAN_WIDTH_20:
 76		return PHY_VHT_CHANNEL_MODE20;
 77	case NL80211_CHAN_WIDTH_40:
 78		return PHY_VHT_CHANNEL_MODE40;
 79	case NL80211_CHAN_WIDTH_80:
 80		return PHY_VHT_CHANNEL_MODE80;
 81	case NL80211_CHAN_WIDTH_160:
 82		return PHY_VHT_CHANNEL_MODE160;
 83	default:
 84		WARN(1, "Invalid channel width=%u", chandef->width);
 85		return PHY_VHT_CHANNEL_MODE20;
 86	}
 87}
 88
 89/*
 90 * Maps the driver specific control channel position (relative to the center
 91 * freq) definitions to the the fw values
 92 */
 93u8 iwl_mvm_get_ctrl_pos(struct cfg80211_chan_def *chandef)
 94{
 95	switch (chandef->chan->center_freq - chandef->center_freq1) {
 96	case -70:
 97		return PHY_VHT_CTRL_POS_4_BELOW;
 98	case -50:
 99		return PHY_VHT_CTRL_POS_3_BELOW;
100	case -30:
101		return PHY_VHT_CTRL_POS_2_BELOW;
102	case -10:
103		return PHY_VHT_CTRL_POS_1_BELOW;
104	case  10:
105		return PHY_VHT_CTRL_POS_1_ABOVE;
106	case  30:
107		return PHY_VHT_CTRL_POS_2_ABOVE;
108	case  50:
109		return PHY_VHT_CTRL_POS_3_ABOVE;
110	case  70:
111		return PHY_VHT_CTRL_POS_4_ABOVE;
112	default:
113		WARN(1, "Invalid channel definition");
114	case 0:
115		/*
116		 * The FW is expected to check the control channel position only
117		 * when in HT/VHT and the channel width is not 20MHz. Return
118		 * this value as the default one.
119		 */
120		return PHY_VHT_CTRL_POS_1_BELOW;
121	}
122}
123
124/*
125 * Construct the generic fields of the PHY context command
126 */
127static void iwl_mvm_phy_ctxt_cmd_hdr(struct iwl_mvm_phy_ctxt *ctxt,
128				     struct iwl_phy_context_cmd *cmd,
129				     u32 action, u32 apply_time)
130{
131	memset(cmd, 0, sizeof(struct iwl_phy_context_cmd));
132
133	cmd->id_and_color = cpu_to_le32(FW_CMD_ID_AND_COLOR(ctxt->id,
134							    ctxt->color));
135	cmd->action = cpu_to_le32(action);
136	cmd->apply_time = cpu_to_le32(apply_time);
137}
138
139/*
140 * Add the phy configuration to the PHY context command
141 */
142static void iwl_mvm_phy_ctxt_cmd_data(struct iwl_mvm *mvm,
143				      struct iwl_phy_context_cmd *cmd,
144				      struct cfg80211_chan_def *chandef,
145				      u8 chains_static, u8 chains_dynamic)
146{
147	u8 active_cnt, idle_cnt;
148
149	/* Set the channel info data */
150	cmd->ci.band = (chandef->chan->band == NL80211_BAND_2GHZ ?
151	      PHY_BAND_24 : PHY_BAND_5);
152
153	cmd->ci.channel = chandef->chan->hw_value;
154	cmd->ci.width = iwl_mvm_get_channel_width(chandef);
155	cmd->ci.ctrl_pos = iwl_mvm_get_ctrl_pos(chandef);
156
157	/* Set rx the chains */
158	idle_cnt = chains_static;
159	active_cnt = chains_dynamic;
160
161	/* In scenarios where we only ever use a single-stream rates,
162	 * i.e. legacy 11b/g/a associations, single-stream APs or even
163	 * static SMPS, enable both chains to get diversity, improving
164	 * the case where we're far enough from the AP that attenuation
165	 * between the two antennas is sufficiently different to impact
166	 * performance.
167	 */
168	if (active_cnt == 1 && iwl_mvm_rx_diversity_allowed(mvm)) {
169		idle_cnt = 2;
170		active_cnt = 2;
171	}
172
173	cmd->rxchain_info = cpu_to_le32(iwl_mvm_get_valid_rx_ant(mvm) <<
174					PHY_RX_CHAIN_VALID_POS);
175	cmd->rxchain_info |= cpu_to_le32(idle_cnt << PHY_RX_CHAIN_CNT_POS);
176	cmd->rxchain_info |= cpu_to_le32(active_cnt <<
177					 PHY_RX_CHAIN_MIMO_CNT_POS);
178#ifdef CONFIG_IWLWIFI_DEBUGFS
179	if (unlikely(mvm->dbgfs_rx_phyinfo))
180		cmd->rxchain_info = cpu_to_le32(mvm->dbgfs_rx_phyinfo);
181#endif
182
183	cmd->txchain_info = cpu_to_le32(iwl_mvm_get_valid_tx_ant(mvm));
184}
185
186/*
187 * Send a command to apply the current phy configuration. The command is send
188 * only if something in the configuration changed: in case that this is the
189 * first time that the phy configuration is applied or in case that the phy
190 * configuration changed from the previous apply.
191 */
192static int iwl_mvm_phy_ctxt_apply(struct iwl_mvm *mvm,
193				  struct iwl_mvm_phy_ctxt *ctxt,
194				  struct cfg80211_chan_def *chandef,
195				  u8 chains_static, u8 chains_dynamic,
196				  u32 action, u32 apply_time)
197{
198	struct iwl_phy_context_cmd cmd;
199	int ret;
200
201	/* Set the command header fields */
202	iwl_mvm_phy_ctxt_cmd_hdr(ctxt, &cmd, action, apply_time);
203
204	/* Set the command data */
205	iwl_mvm_phy_ctxt_cmd_data(mvm, &cmd, chandef,
206				  chains_static, chains_dynamic);
207
208	ret = iwl_mvm_send_cmd_pdu(mvm, PHY_CONTEXT_CMD, 0,
209				   sizeof(struct iwl_phy_context_cmd),
210				   &cmd);
211	if (ret)
212		IWL_ERR(mvm, "PHY ctxt cmd error. ret=%d\n", ret);
213	return ret;
214}
215
216/*
217 * Send a command to add a PHY context based on the current HW configuration.
218 */
219int iwl_mvm_phy_ctxt_add(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt,
220			 struct cfg80211_chan_def *chandef,
221			 u8 chains_static, u8 chains_dynamic)
222{
223	WARN_ON(!test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status) &&
224		ctxt->ref);
225	lockdep_assert_held(&mvm->mutex);
226
227	ctxt->channel = chandef->chan;
228
229	return iwl_mvm_phy_ctxt_apply(mvm, ctxt, chandef,
230				      chains_static, chains_dynamic,
231				      FW_CTXT_ACTION_ADD, 0);
232}
233
234/*
235 * Update the number of references to the given PHY context. This is valid only
236 * in case the PHY context was already created, i.e., its reference count > 0.
237 */
238void iwl_mvm_phy_ctxt_ref(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt)
239{
240	lockdep_assert_held(&mvm->mutex);
241	ctxt->ref++;
242}
243
244/*
245 * Send a command to modify the PHY context based on the current HW
246 * configuration. Note that the function does not check that the configuration
247 * changed.
248 */
249int iwl_mvm_phy_ctxt_changed(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt,
250			     struct cfg80211_chan_def *chandef,
251			     u8 chains_static, u8 chains_dynamic)
252{
 
 
253	lockdep_assert_held(&mvm->mutex);
254
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
255	ctxt->channel = chandef->chan;
 
256	return iwl_mvm_phy_ctxt_apply(mvm, ctxt, chandef,
257				      chains_static, chains_dynamic,
258				      FW_CTXT_ACTION_MODIFY, 0);
259}
260
261void iwl_mvm_phy_ctxt_unref(struct iwl_mvm *mvm, struct iwl_mvm_phy_ctxt *ctxt)
262{
263	lockdep_assert_held(&mvm->mutex);
264
265	if (WARN_ON_ONCE(!ctxt))
266		return;
267
268	ctxt->ref--;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
269}
270
271static void iwl_mvm_binding_iterator(void *_data, u8 *mac,
272				     struct ieee80211_vif *vif)
273{
274	unsigned long *data = _data;
275	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
276
277	if (!mvmvif->phy_ctxt)
278		return;
279
280	if (vif->type == NL80211_IFTYPE_STATION ||
281	    vif->type == NL80211_IFTYPE_AP)
282		__set_bit(mvmvif->phy_ctxt->id, data);
283}
284
285int iwl_mvm_phy_ctx_count(struct iwl_mvm *mvm)
286{
287	unsigned long phy_ctxt_counter = 0;
288
289	ieee80211_iterate_active_interfaces_atomic(mvm->hw,
290						   IEEE80211_IFACE_ITER_NORMAL,
291						   iwl_mvm_binding_iterator,
292						   &phy_ctxt_counter);
293
294	return hweight8(phy_ctxt_counter);
295}