xref: /OK3568_Linux_fs/kernel/drivers/net/wireless/intel/iwlwifi/mvm/rs-fw.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /******************************************************************************
2*4882a593Smuzhiyun  *
3*4882a593Smuzhiyun  * This file is provided under a dual BSD/GPLv2 license.  When using or
4*4882a593Smuzhiyun  * redistributing this file, you may do so under either license.
5*4882a593Smuzhiyun  *
6*4882a593Smuzhiyun  * GPL LICENSE SUMMARY
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  * Copyright(c) 2017        Intel Deutschland GmbH
9*4882a593Smuzhiyun  * Copyright(c) 2018 - 2020 Intel Corporation
10*4882a593Smuzhiyun  *
11*4882a593Smuzhiyun  * This program is free software; you can redistribute it and/or modify
12*4882a593Smuzhiyun  * it under the terms of version 2 of the GNU General Public License as
13*4882a593Smuzhiyun  * published by the Free Software Foundation.
14*4882a593Smuzhiyun  *
15*4882a593Smuzhiyun  * This program is distributed in the hope that it will be useful, but
16*4882a593Smuzhiyun  * WITHOUT ANY WARRANTY; without even the implied warranty of
17*4882a593Smuzhiyun  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
18*4882a593Smuzhiyun  * General Public License for more details.
19*4882a593Smuzhiyun  *
20*4882a593Smuzhiyun  * The full GNU General Public License is included in this distribution
21*4882a593Smuzhiyun  * in the file called COPYING.
22*4882a593Smuzhiyun  *
23*4882a593Smuzhiyun  * Contact Information:
24*4882a593Smuzhiyun  *  Intel Linux Wireless <linuxwifi@intel.com>
25*4882a593Smuzhiyun  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
26*4882a593Smuzhiyun  *
27*4882a593Smuzhiyun  * BSD LICENSE
28*4882a593Smuzhiyun  *
29*4882a593Smuzhiyun  * Copyright(c) 2017        Intel Deutschland GmbH
30*4882a593Smuzhiyun  * Copyright(c) 2018 - 2020 Intel Corporation
31*4882a593Smuzhiyun  * All rights reserved.
32*4882a593Smuzhiyun  *
33*4882a593Smuzhiyun  * Redistribution and use in source and binary forms, with or without
34*4882a593Smuzhiyun  * modification, are permitted provided that the following conditions
35*4882a593Smuzhiyun  * are met:
36*4882a593Smuzhiyun  *
37*4882a593Smuzhiyun  *  * Redistributions of source code must retain the above copyright
38*4882a593Smuzhiyun  *    notice, this list of conditions and the following disclaimer.
39*4882a593Smuzhiyun  *  * Redistributions in binary form must reproduce the above copyright
40*4882a593Smuzhiyun  *    notice, this list of conditions and the following disclaimer in
41*4882a593Smuzhiyun  *    the documentation and/or other materials provided with the
42*4882a593Smuzhiyun  *    distribution.
43*4882a593Smuzhiyun  *  * Neither the name Intel Corporation nor the names of its
44*4882a593Smuzhiyun  *    contributors may be used to endorse or promote products derived
45*4882a593Smuzhiyun  *    from this software without specific prior written permission.
46*4882a593Smuzhiyun  *
47*4882a593Smuzhiyun  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
48*4882a593Smuzhiyun  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
49*4882a593Smuzhiyun  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
50*4882a593Smuzhiyun  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
51*4882a593Smuzhiyun  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
52*4882a593Smuzhiyun  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
53*4882a593Smuzhiyun  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
54*4882a593Smuzhiyun  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
55*4882a593Smuzhiyun  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
56*4882a593Smuzhiyun  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
57*4882a593Smuzhiyun  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
58*4882a593Smuzhiyun  *
59*4882a593Smuzhiyun  *****************************************************************************/
60*4882a593Smuzhiyun #include "rs.h"
61*4882a593Smuzhiyun #include "fw-api.h"
62*4882a593Smuzhiyun #include "sta.h"
63*4882a593Smuzhiyun #include "iwl-op-mode.h"
64*4882a593Smuzhiyun #include "mvm.h"
65*4882a593Smuzhiyun 
rs_fw_bw_from_sta_bw(struct ieee80211_sta * sta)66*4882a593Smuzhiyun static u8 rs_fw_bw_from_sta_bw(struct ieee80211_sta *sta)
67*4882a593Smuzhiyun {
68*4882a593Smuzhiyun 	switch (sta->bandwidth) {
69*4882a593Smuzhiyun 	case IEEE80211_STA_RX_BW_160:
70*4882a593Smuzhiyun 		return IWL_TLC_MNG_CH_WIDTH_160MHZ;
71*4882a593Smuzhiyun 	case IEEE80211_STA_RX_BW_80:
72*4882a593Smuzhiyun 		return IWL_TLC_MNG_CH_WIDTH_80MHZ;
73*4882a593Smuzhiyun 	case IEEE80211_STA_RX_BW_40:
74*4882a593Smuzhiyun 		return IWL_TLC_MNG_CH_WIDTH_40MHZ;
75*4882a593Smuzhiyun 	case IEEE80211_STA_RX_BW_20:
76*4882a593Smuzhiyun 	default:
77*4882a593Smuzhiyun 		return IWL_TLC_MNG_CH_WIDTH_20MHZ;
78*4882a593Smuzhiyun 	}
79*4882a593Smuzhiyun }
80*4882a593Smuzhiyun 
rs_fw_set_active_chains(u8 chains)81*4882a593Smuzhiyun static u8 rs_fw_set_active_chains(u8 chains)
82*4882a593Smuzhiyun {
83*4882a593Smuzhiyun 	u8 fw_chains = 0;
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun 	if (chains & ANT_A)
86*4882a593Smuzhiyun 		fw_chains |= IWL_TLC_MNG_CHAIN_A_MSK;
87*4882a593Smuzhiyun 	if (chains & ANT_B)
88*4882a593Smuzhiyun 		fw_chains |= IWL_TLC_MNG_CHAIN_B_MSK;
89*4882a593Smuzhiyun 	if (chains & ANT_C)
90*4882a593Smuzhiyun 		WARN(false,
91*4882a593Smuzhiyun 		     "tlc offload doesn't support antenna C. chains: 0x%x\n",
92*4882a593Smuzhiyun 		     chains);
93*4882a593Smuzhiyun 
94*4882a593Smuzhiyun 	return fw_chains;
95*4882a593Smuzhiyun }
96*4882a593Smuzhiyun 
rs_fw_sgi_cw_support(struct ieee80211_sta * sta)97*4882a593Smuzhiyun static u8 rs_fw_sgi_cw_support(struct ieee80211_sta *sta)
98*4882a593Smuzhiyun {
99*4882a593Smuzhiyun 	struct ieee80211_sta_ht_cap *ht_cap = &sta->ht_cap;
100*4882a593Smuzhiyun 	struct ieee80211_sta_vht_cap *vht_cap = &sta->vht_cap;
101*4882a593Smuzhiyun 	struct ieee80211_sta_he_cap *he_cap = &sta->he_cap;
102*4882a593Smuzhiyun 	u8 supp = 0;
103*4882a593Smuzhiyun 
104*4882a593Smuzhiyun 	if (he_cap->has_he)
105*4882a593Smuzhiyun 		return 0;
106*4882a593Smuzhiyun 
107*4882a593Smuzhiyun 	if (ht_cap->cap & IEEE80211_HT_CAP_SGI_20)
108*4882a593Smuzhiyun 		supp |= BIT(IWL_TLC_MNG_CH_WIDTH_20MHZ);
109*4882a593Smuzhiyun 	if (ht_cap->cap & IEEE80211_HT_CAP_SGI_40)
110*4882a593Smuzhiyun 		supp |= BIT(IWL_TLC_MNG_CH_WIDTH_40MHZ);
111*4882a593Smuzhiyun 	if (vht_cap->cap & IEEE80211_VHT_CAP_SHORT_GI_80)
112*4882a593Smuzhiyun 		supp |= BIT(IWL_TLC_MNG_CH_WIDTH_80MHZ);
113*4882a593Smuzhiyun 	if (vht_cap->cap & IEEE80211_VHT_CAP_SHORT_GI_160)
114*4882a593Smuzhiyun 		supp |= BIT(IWL_TLC_MNG_CH_WIDTH_160MHZ);
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun 	return supp;
117*4882a593Smuzhiyun }
118*4882a593Smuzhiyun 
rs_fw_get_config_flags(struct iwl_mvm * mvm,struct ieee80211_sta * sta,struct ieee80211_supported_band * sband)119*4882a593Smuzhiyun static u16 rs_fw_get_config_flags(struct iwl_mvm *mvm,
120*4882a593Smuzhiyun 				  struct ieee80211_sta *sta,
121*4882a593Smuzhiyun 				  struct ieee80211_supported_band *sband)
122*4882a593Smuzhiyun {
123*4882a593Smuzhiyun 	struct ieee80211_sta_ht_cap *ht_cap = &sta->ht_cap;
124*4882a593Smuzhiyun 	struct ieee80211_sta_vht_cap *vht_cap = &sta->vht_cap;
125*4882a593Smuzhiyun 	struct ieee80211_sta_he_cap *he_cap = &sta->he_cap;
126*4882a593Smuzhiyun 	bool vht_ena = vht_cap->vht_supported;
127*4882a593Smuzhiyun 	u16 flags = 0;
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun 	if (mvm->cfg->ht_params->stbc &&
130*4882a593Smuzhiyun 	    (num_of_ant(iwl_mvm_get_valid_tx_ant(mvm)) > 1)) {
131*4882a593Smuzhiyun 		if (he_cap->has_he) {
132*4882a593Smuzhiyun 			if (he_cap->he_cap_elem.phy_cap_info[2] &
133*4882a593Smuzhiyun 			    IEEE80211_HE_PHY_CAP2_STBC_RX_UNDER_80MHZ)
134*4882a593Smuzhiyun 				flags |= IWL_TLC_MNG_CFG_FLAGS_STBC_MSK;
135*4882a593Smuzhiyun 
136*4882a593Smuzhiyun 			if (he_cap->he_cap_elem.phy_cap_info[7] &
137*4882a593Smuzhiyun 			    IEEE80211_HE_PHY_CAP7_STBC_RX_ABOVE_80MHZ)
138*4882a593Smuzhiyun 				flags |= IWL_TLC_MNG_CFG_FLAGS_HE_STBC_160MHZ_MSK;
139*4882a593Smuzhiyun 		} else if ((ht_cap->cap & IEEE80211_HT_CAP_RX_STBC) ||
140*4882a593Smuzhiyun 			   (vht_ena &&
141*4882a593Smuzhiyun 			    (vht_cap->cap & IEEE80211_VHT_CAP_RXSTBC_MASK)))
142*4882a593Smuzhiyun 			flags |= IWL_TLC_MNG_CFG_FLAGS_STBC_MSK;
143*4882a593Smuzhiyun 	}
144*4882a593Smuzhiyun 
145*4882a593Smuzhiyun 	if (mvm->cfg->ht_params->ldpc &&
146*4882a593Smuzhiyun 	    ((ht_cap->cap & IEEE80211_HT_CAP_LDPC_CODING) ||
147*4882a593Smuzhiyun 	     (vht_ena && (vht_cap->cap & IEEE80211_VHT_CAP_RXLDPC))))
148*4882a593Smuzhiyun 		flags |= IWL_TLC_MNG_CFG_FLAGS_LDPC_MSK;
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun 	/* consider LDPC support in case of HE */
151*4882a593Smuzhiyun 	if (he_cap->has_he && (he_cap->he_cap_elem.phy_cap_info[1] &
152*4882a593Smuzhiyun 	    IEEE80211_HE_PHY_CAP1_LDPC_CODING_IN_PAYLOAD))
153*4882a593Smuzhiyun 		flags |= IWL_TLC_MNG_CFG_FLAGS_LDPC_MSK;
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun 	if (sband->iftype_data && sband->iftype_data->he_cap.has_he &&
156*4882a593Smuzhiyun 	    !(sband->iftype_data->he_cap.he_cap_elem.phy_cap_info[1] &
157*4882a593Smuzhiyun 	     IEEE80211_HE_PHY_CAP1_LDPC_CODING_IN_PAYLOAD))
158*4882a593Smuzhiyun 		flags &= ~IWL_TLC_MNG_CFG_FLAGS_LDPC_MSK;
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun 	if (he_cap->has_he &&
161*4882a593Smuzhiyun 	    (he_cap->he_cap_elem.phy_cap_info[3] &
162*4882a593Smuzhiyun 	     IEEE80211_HE_PHY_CAP3_DCM_MAX_CONST_RX_MASK))
163*4882a593Smuzhiyun 		flags |= IWL_TLC_MNG_CFG_FLAGS_HE_DCM_NSS_1_MSK;
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun 	return flags;
166*4882a593Smuzhiyun }
167*4882a593Smuzhiyun 
168*4882a593Smuzhiyun static
rs_fw_vht_highest_rx_mcs_index(const struct ieee80211_sta_vht_cap * vht_cap,int nss)169*4882a593Smuzhiyun int rs_fw_vht_highest_rx_mcs_index(const struct ieee80211_sta_vht_cap *vht_cap,
170*4882a593Smuzhiyun 				   int nss)
171*4882a593Smuzhiyun {
172*4882a593Smuzhiyun 	u16 rx_mcs = le16_to_cpu(vht_cap->vht_mcs.rx_mcs_map) &
173*4882a593Smuzhiyun 		(0x3 << (2 * (nss - 1)));
174*4882a593Smuzhiyun 	rx_mcs >>= (2 * (nss - 1));
175*4882a593Smuzhiyun 
176*4882a593Smuzhiyun 	switch (rx_mcs) {
177*4882a593Smuzhiyun 	case IEEE80211_VHT_MCS_SUPPORT_0_7:
178*4882a593Smuzhiyun 		return IWL_TLC_MNG_HT_RATE_MCS7;
179*4882a593Smuzhiyun 	case IEEE80211_VHT_MCS_SUPPORT_0_8:
180*4882a593Smuzhiyun 		return IWL_TLC_MNG_HT_RATE_MCS8;
181*4882a593Smuzhiyun 	case IEEE80211_VHT_MCS_SUPPORT_0_9:
182*4882a593Smuzhiyun 		return IWL_TLC_MNG_HT_RATE_MCS9;
183*4882a593Smuzhiyun 	default:
184*4882a593Smuzhiyun 		WARN_ON_ONCE(1);
185*4882a593Smuzhiyun 		break;
186*4882a593Smuzhiyun 	}
187*4882a593Smuzhiyun 
188*4882a593Smuzhiyun 	return 0;
189*4882a593Smuzhiyun }
190*4882a593Smuzhiyun 
191*4882a593Smuzhiyun static void
rs_fw_vht_set_enabled_rates(const struct ieee80211_sta * sta,const struct ieee80211_sta_vht_cap * vht_cap,struct iwl_tlc_config_cmd * cmd)192*4882a593Smuzhiyun rs_fw_vht_set_enabled_rates(const struct ieee80211_sta *sta,
193*4882a593Smuzhiyun 			    const struct ieee80211_sta_vht_cap *vht_cap,
194*4882a593Smuzhiyun 			    struct iwl_tlc_config_cmd *cmd)
195*4882a593Smuzhiyun {
196*4882a593Smuzhiyun 	u16 supp;
197*4882a593Smuzhiyun 	int i, highest_mcs;
198*4882a593Smuzhiyun 	u8 max_nss = sta->rx_nss;
199*4882a593Smuzhiyun 	struct ieee80211_vht_cap ieee_vht_cap = {
200*4882a593Smuzhiyun 		.vht_cap_info = cpu_to_le32(vht_cap->cap),
201*4882a593Smuzhiyun 		.supp_mcs = vht_cap->vht_mcs,
202*4882a593Smuzhiyun 	};
203*4882a593Smuzhiyun 
204*4882a593Smuzhiyun 	/* the station support only a single receive chain */
205*4882a593Smuzhiyun 	if (sta->smps_mode == IEEE80211_SMPS_STATIC)
206*4882a593Smuzhiyun 		max_nss = 1;
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun 	for (i = 0; i < max_nss && i < IWL_TLC_NSS_MAX; i++) {
209*4882a593Smuzhiyun 		int nss = i + 1;
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 		highest_mcs = rs_fw_vht_highest_rx_mcs_index(vht_cap, nss);
212*4882a593Smuzhiyun 		if (!highest_mcs)
213*4882a593Smuzhiyun 			continue;
214*4882a593Smuzhiyun 
215*4882a593Smuzhiyun 		supp = BIT(highest_mcs + 1) - 1;
216*4882a593Smuzhiyun 		if (sta->bandwidth == IEEE80211_STA_RX_BW_20)
217*4882a593Smuzhiyun 			supp &= ~BIT(IWL_TLC_MNG_HT_RATE_MCS9);
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 		cmd->ht_rates[i][IWL_TLC_HT_BW_NONE_160] = cpu_to_le16(supp);
220*4882a593Smuzhiyun 		/*
221*4882a593Smuzhiyun 		 * Check if VHT extended NSS indicates that the bandwidth/NSS
222*4882a593Smuzhiyun 		 * configuration is supported - only for MCS 0 since we already
223*4882a593Smuzhiyun 		 * decoded the MCS bits anyway ourselves.
224*4882a593Smuzhiyun 		 */
225*4882a593Smuzhiyun 		if (sta->bandwidth == IEEE80211_STA_RX_BW_160 &&
226*4882a593Smuzhiyun 		    ieee80211_get_vht_max_nss(&ieee_vht_cap,
227*4882a593Smuzhiyun 					      IEEE80211_VHT_CHANWIDTH_160MHZ,
228*4882a593Smuzhiyun 					      0, true, nss) >= nss)
229*4882a593Smuzhiyun 			cmd->ht_rates[i][IWL_TLC_HT_BW_160] =
230*4882a593Smuzhiyun 				cmd->ht_rates[i][IWL_TLC_HT_BW_NONE_160];
231*4882a593Smuzhiyun 	}
232*4882a593Smuzhiyun }
233*4882a593Smuzhiyun 
rs_fw_he_ieee80211_mcs_to_rs_mcs(u16 mcs)234*4882a593Smuzhiyun static u16 rs_fw_he_ieee80211_mcs_to_rs_mcs(u16 mcs)
235*4882a593Smuzhiyun {
236*4882a593Smuzhiyun 	switch (mcs) {
237*4882a593Smuzhiyun 	case IEEE80211_HE_MCS_SUPPORT_0_7:
238*4882a593Smuzhiyun 		return BIT(IWL_TLC_MNG_HT_RATE_MCS7 + 1) - 1;
239*4882a593Smuzhiyun 	case IEEE80211_HE_MCS_SUPPORT_0_9:
240*4882a593Smuzhiyun 		return BIT(IWL_TLC_MNG_HT_RATE_MCS9 + 1) - 1;
241*4882a593Smuzhiyun 	case IEEE80211_HE_MCS_SUPPORT_0_11:
242*4882a593Smuzhiyun 		return BIT(IWL_TLC_MNG_HT_RATE_MCS11 + 1) - 1;
243*4882a593Smuzhiyun 	case IEEE80211_HE_MCS_NOT_SUPPORTED:
244*4882a593Smuzhiyun 		return 0;
245*4882a593Smuzhiyun 	}
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 	WARN(1, "invalid HE MCS %d\n", mcs);
248*4882a593Smuzhiyun 	return 0;
249*4882a593Smuzhiyun }
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun static void
rs_fw_he_set_enabled_rates(const struct ieee80211_sta * sta,struct ieee80211_supported_band * sband,struct iwl_tlc_config_cmd * cmd)252*4882a593Smuzhiyun rs_fw_he_set_enabled_rates(const struct ieee80211_sta *sta,
253*4882a593Smuzhiyun 			   struct ieee80211_supported_band *sband,
254*4882a593Smuzhiyun 			   struct iwl_tlc_config_cmd *cmd)
255*4882a593Smuzhiyun {
256*4882a593Smuzhiyun 	const struct ieee80211_sta_he_cap *he_cap = &sta->he_cap;
257*4882a593Smuzhiyun 	u16 mcs_160 = le16_to_cpu(he_cap->he_mcs_nss_supp.rx_mcs_160);
258*4882a593Smuzhiyun 	u16 mcs_80 = le16_to_cpu(he_cap->he_mcs_nss_supp.rx_mcs_80);
259*4882a593Smuzhiyun 	u16 tx_mcs_80 =
260*4882a593Smuzhiyun 		le16_to_cpu(sband->iftype_data->he_cap.he_mcs_nss_supp.tx_mcs_80);
261*4882a593Smuzhiyun 	u16 tx_mcs_160 =
262*4882a593Smuzhiyun 		le16_to_cpu(sband->iftype_data->he_cap.he_mcs_nss_supp.tx_mcs_160);
263*4882a593Smuzhiyun 	int i;
264*4882a593Smuzhiyun 	u8 nss = sta->rx_nss;
265*4882a593Smuzhiyun 
266*4882a593Smuzhiyun 	/* the station support only a single receive chain */
267*4882a593Smuzhiyun 	if (sta->smps_mode == IEEE80211_SMPS_STATIC)
268*4882a593Smuzhiyun 		nss = 1;
269*4882a593Smuzhiyun 
270*4882a593Smuzhiyun 	for (i = 0; i < nss && i < IWL_TLC_NSS_MAX; i++) {
271*4882a593Smuzhiyun 		u16 _mcs_160 = (mcs_160 >> (2 * i)) & 0x3;
272*4882a593Smuzhiyun 		u16 _mcs_80 = (mcs_80 >> (2 * i)) & 0x3;
273*4882a593Smuzhiyun 		u16 _tx_mcs_160 = (tx_mcs_160 >> (2 * i)) & 0x3;
274*4882a593Smuzhiyun 		u16 _tx_mcs_80 = (tx_mcs_80 >> (2 * i)) & 0x3;
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 		/* If one side doesn't support - mark both as not supporting */
277*4882a593Smuzhiyun 		if (_mcs_80 == IEEE80211_HE_MCS_NOT_SUPPORTED ||
278*4882a593Smuzhiyun 		    _tx_mcs_80 == IEEE80211_HE_MCS_NOT_SUPPORTED) {
279*4882a593Smuzhiyun 			_mcs_80 = IEEE80211_HE_MCS_NOT_SUPPORTED;
280*4882a593Smuzhiyun 			_tx_mcs_80 = IEEE80211_HE_MCS_NOT_SUPPORTED;
281*4882a593Smuzhiyun 		}
282*4882a593Smuzhiyun 		if (_mcs_80 > _tx_mcs_80)
283*4882a593Smuzhiyun 			_mcs_80 = _tx_mcs_80;
284*4882a593Smuzhiyun 		cmd->ht_rates[i][IWL_TLC_HT_BW_NONE_160] =
285*4882a593Smuzhiyun 			cpu_to_le16(rs_fw_he_ieee80211_mcs_to_rs_mcs(_mcs_80));
286*4882a593Smuzhiyun 
287*4882a593Smuzhiyun 		/* If one side doesn't support - mark both as not supporting */
288*4882a593Smuzhiyun 		if (_mcs_160 == IEEE80211_HE_MCS_NOT_SUPPORTED ||
289*4882a593Smuzhiyun 		    _tx_mcs_160 == IEEE80211_HE_MCS_NOT_SUPPORTED) {
290*4882a593Smuzhiyun 			_mcs_160 = IEEE80211_HE_MCS_NOT_SUPPORTED;
291*4882a593Smuzhiyun 			_tx_mcs_160 = IEEE80211_HE_MCS_NOT_SUPPORTED;
292*4882a593Smuzhiyun 		}
293*4882a593Smuzhiyun 		if (_mcs_160 > _tx_mcs_160)
294*4882a593Smuzhiyun 			_mcs_160 = _tx_mcs_160;
295*4882a593Smuzhiyun 		cmd->ht_rates[i][IWL_TLC_HT_BW_160] =
296*4882a593Smuzhiyun 			cpu_to_le16(rs_fw_he_ieee80211_mcs_to_rs_mcs(_mcs_160));
297*4882a593Smuzhiyun 	}
298*4882a593Smuzhiyun }
299*4882a593Smuzhiyun 
rs_fw_set_supp_rates(struct ieee80211_sta * sta,struct ieee80211_supported_band * sband,struct iwl_tlc_config_cmd * cmd)300*4882a593Smuzhiyun static void rs_fw_set_supp_rates(struct ieee80211_sta *sta,
301*4882a593Smuzhiyun 				 struct ieee80211_supported_band *sband,
302*4882a593Smuzhiyun 				 struct iwl_tlc_config_cmd *cmd)
303*4882a593Smuzhiyun {
304*4882a593Smuzhiyun 	int i;
305*4882a593Smuzhiyun 	unsigned long tmp;
306*4882a593Smuzhiyun 	unsigned long supp; /* must be unsigned long for for_each_set_bit */
307*4882a593Smuzhiyun 	const struct ieee80211_sta_ht_cap *ht_cap = &sta->ht_cap;
308*4882a593Smuzhiyun 	const struct ieee80211_sta_vht_cap *vht_cap = &sta->vht_cap;
309*4882a593Smuzhiyun 	const struct ieee80211_sta_he_cap *he_cap = &sta->he_cap;
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun 	/* non HT rates */
312*4882a593Smuzhiyun 	supp = 0;
313*4882a593Smuzhiyun 	tmp = sta->supp_rates[sband->band];
314*4882a593Smuzhiyun 	for_each_set_bit(i, &tmp, BITS_PER_LONG)
315*4882a593Smuzhiyun 		supp |= BIT(sband->bitrates[i].hw_value);
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun 	cmd->non_ht_rates = cpu_to_le16(supp);
318*4882a593Smuzhiyun 	cmd->mode = IWL_TLC_MNG_MODE_NON_HT;
319*4882a593Smuzhiyun 
320*4882a593Smuzhiyun 	/* HT/VHT rates */
321*4882a593Smuzhiyun 	if (he_cap->has_he) {
322*4882a593Smuzhiyun 		cmd->mode = IWL_TLC_MNG_MODE_HE;
323*4882a593Smuzhiyun 		rs_fw_he_set_enabled_rates(sta, sband, cmd);
324*4882a593Smuzhiyun 	} else if (vht_cap->vht_supported) {
325*4882a593Smuzhiyun 		cmd->mode = IWL_TLC_MNG_MODE_VHT;
326*4882a593Smuzhiyun 		rs_fw_vht_set_enabled_rates(sta, vht_cap, cmd);
327*4882a593Smuzhiyun 	} else if (ht_cap->ht_supported) {
328*4882a593Smuzhiyun 		cmd->mode = IWL_TLC_MNG_MODE_HT;
329*4882a593Smuzhiyun 		cmd->ht_rates[IWL_TLC_NSS_1][IWL_TLC_HT_BW_NONE_160] =
330*4882a593Smuzhiyun 			cpu_to_le16(ht_cap->mcs.rx_mask[0]);
331*4882a593Smuzhiyun 
332*4882a593Smuzhiyun 		/* the station support only a single receive chain */
333*4882a593Smuzhiyun 		if (sta->smps_mode == IEEE80211_SMPS_STATIC)
334*4882a593Smuzhiyun 			cmd->ht_rates[IWL_TLC_NSS_2][IWL_TLC_HT_BW_NONE_160] =
335*4882a593Smuzhiyun 				0;
336*4882a593Smuzhiyun 		else
337*4882a593Smuzhiyun 			cmd->ht_rates[IWL_TLC_NSS_2][IWL_TLC_HT_BW_NONE_160] =
338*4882a593Smuzhiyun 				cpu_to_le16(ht_cap->mcs.rx_mask[1]);
339*4882a593Smuzhiyun 	}
340*4882a593Smuzhiyun }
341*4882a593Smuzhiyun 
iwl_mvm_tlc_update_notif(struct iwl_mvm * mvm,struct iwl_rx_cmd_buffer * rxb)342*4882a593Smuzhiyun void iwl_mvm_tlc_update_notif(struct iwl_mvm *mvm,
343*4882a593Smuzhiyun 			      struct iwl_rx_cmd_buffer *rxb)
344*4882a593Smuzhiyun {
345*4882a593Smuzhiyun 	struct iwl_rx_packet *pkt = rxb_addr(rxb);
346*4882a593Smuzhiyun 	struct iwl_tlc_update_notif *notif;
347*4882a593Smuzhiyun 	struct ieee80211_sta *sta;
348*4882a593Smuzhiyun 	struct iwl_mvm_sta *mvmsta;
349*4882a593Smuzhiyun 	struct iwl_lq_sta_rs_fw *lq_sta;
350*4882a593Smuzhiyun 	u32 flags;
351*4882a593Smuzhiyun 
352*4882a593Smuzhiyun 	rcu_read_lock();
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun 	notif = (void *)pkt->data;
355*4882a593Smuzhiyun 	sta = rcu_dereference(mvm->fw_id_to_mac_id[notif->sta_id]);
356*4882a593Smuzhiyun 	if (IS_ERR_OR_NULL(sta)) {
357*4882a593Smuzhiyun 		IWL_ERR(mvm, "Invalid sta id (%d) in FW TLC notification\n",
358*4882a593Smuzhiyun 			notif->sta_id);
359*4882a593Smuzhiyun 		goto out;
360*4882a593Smuzhiyun 	}
361*4882a593Smuzhiyun 
362*4882a593Smuzhiyun 	mvmsta = iwl_mvm_sta_from_mac80211(sta);
363*4882a593Smuzhiyun 
364*4882a593Smuzhiyun 	if (!mvmsta) {
365*4882a593Smuzhiyun 		IWL_ERR(mvm, "Invalid sta id (%d) in FW TLC notification\n",
366*4882a593Smuzhiyun 			notif->sta_id);
367*4882a593Smuzhiyun 		goto out;
368*4882a593Smuzhiyun 	}
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun 	flags = le32_to_cpu(notif->flags);
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun 	lq_sta = &mvmsta->lq_sta.rs_fw;
373*4882a593Smuzhiyun 
374*4882a593Smuzhiyun 	if (flags & IWL_TLC_NOTIF_FLAG_RATE) {
375*4882a593Smuzhiyun 		char pretty_rate[100];
376*4882a593Smuzhiyun 		lq_sta->last_rate_n_flags = le32_to_cpu(notif->rate);
377*4882a593Smuzhiyun 		rs_pretty_print_rate(pretty_rate, sizeof(pretty_rate),
378*4882a593Smuzhiyun 				     lq_sta->last_rate_n_flags);
379*4882a593Smuzhiyun 		IWL_DEBUG_RATE(mvm, "new rate: %s\n", pretty_rate);
380*4882a593Smuzhiyun 	}
381*4882a593Smuzhiyun 
382*4882a593Smuzhiyun 	if (flags & IWL_TLC_NOTIF_FLAG_AMSDU && !mvmsta->orig_amsdu_len) {
383*4882a593Smuzhiyun 		u16 size = le32_to_cpu(notif->amsdu_size);
384*4882a593Smuzhiyun 		int i;
385*4882a593Smuzhiyun 
386*4882a593Smuzhiyun 		if (sta->max_amsdu_len < size) {
387*4882a593Smuzhiyun 			/*
388*4882a593Smuzhiyun 			 * In debug sta->max_amsdu_len < size
389*4882a593Smuzhiyun 			 * so also check with orig_amsdu_len which holds the
390*4882a593Smuzhiyun 			 * original data before debugfs changed the value
391*4882a593Smuzhiyun 			 */
392*4882a593Smuzhiyun 			WARN_ON(mvmsta->orig_amsdu_len < size);
393*4882a593Smuzhiyun 			goto out;
394*4882a593Smuzhiyun 		}
395*4882a593Smuzhiyun 
396*4882a593Smuzhiyun 		mvmsta->amsdu_enabled = le32_to_cpu(notif->amsdu_enabled);
397*4882a593Smuzhiyun 		mvmsta->max_amsdu_len = size;
398*4882a593Smuzhiyun 		sta->max_rc_amsdu_len = mvmsta->max_amsdu_len;
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 		for (i = 0; i < IWL_MAX_TID_COUNT; i++) {
401*4882a593Smuzhiyun 			if (mvmsta->amsdu_enabled & BIT(i))
402*4882a593Smuzhiyun 				sta->max_tid_amsdu_len[i] =
403*4882a593Smuzhiyun 					iwl_mvm_max_amsdu_size(mvm, sta, i);
404*4882a593Smuzhiyun 			else
405*4882a593Smuzhiyun 				/*
406*4882a593Smuzhiyun 				 * Not so elegant, but this will effectively
407*4882a593Smuzhiyun 				 * prevent AMSDU on this TID
408*4882a593Smuzhiyun 				 */
409*4882a593Smuzhiyun 				sta->max_tid_amsdu_len[i] = 1;
410*4882a593Smuzhiyun 		}
411*4882a593Smuzhiyun 
412*4882a593Smuzhiyun 		IWL_DEBUG_RATE(mvm,
413*4882a593Smuzhiyun 			       "AMSDU update. AMSDU size: %d, AMSDU selected size: %d, AMSDU TID bitmap 0x%X\n",
414*4882a593Smuzhiyun 			       le32_to_cpu(notif->amsdu_size), size,
415*4882a593Smuzhiyun 			       mvmsta->amsdu_enabled);
416*4882a593Smuzhiyun 	}
417*4882a593Smuzhiyun out:
418*4882a593Smuzhiyun 	rcu_read_unlock();
419*4882a593Smuzhiyun }
420*4882a593Smuzhiyun 
rs_fw_get_max_amsdu_len(struct ieee80211_sta * sta)421*4882a593Smuzhiyun u16 rs_fw_get_max_amsdu_len(struct ieee80211_sta *sta)
422*4882a593Smuzhiyun {
423*4882a593Smuzhiyun 	const struct ieee80211_sta_vht_cap *vht_cap = &sta->vht_cap;
424*4882a593Smuzhiyun 	const struct ieee80211_sta_ht_cap *ht_cap = &sta->ht_cap;
425*4882a593Smuzhiyun 
426*4882a593Smuzhiyun 	if (vht_cap->vht_supported) {
427*4882a593Smuzhiyun 		switch (vht_cap->cap & IEEE80211_VHT_CAP_MAX_MPDU_MASK) {
428*4882a593Smuzhiyun 		case IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454:
429*4882a593Smuzhiyun 			return IEEE80211_MAX_MPDU_LEN_VHT_11454;
430*4882a593Smuzhiyun 		case IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991:
431*4882a593Smuzhiyun 			return IEEE80211_MAX_MPDU_LEN_VHT_7991;
432*4882a593Smuzhiyun 		default:
433*4882a593Smuzhiyun 			return IEEE80211_MAX_MPDU_LEN_VHT_3895;
434*4882a593Smuzhiyun 		}
435*4882a593Smuzhiyun 	} else if (ht_cap->ht_supported) {
436*4882a593Smuzhiyun 		if (ht_cap->cap & IEEE80211_HT_CAP_MAX_AMSDU)
437*4882a593Smuzhiyun 			/*
438*4882a593Smuzhiyun 			 * agg is offloaded so we need to assume that agg
439*4882a593Smuzhiyun 			 * are enabled and max mpdu in ampdu is 4095
440*4882a593Smuzhiyun 			 * (spec 802.11-2016 9.3.2.1)
441*4882a593Smuzhiyun 			 */
442*4882a593Smuzhiyun 			return IEEE80211_MAX_MPDU_LEN_HT_BA;
443*4882a593Smuzhiyun 		else
444*4882a593Smuzhiyun 			return IEEE80211_MAX_MPDU_LEN_HT_3839;
445*4882a593Smuzhiyun 	}
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun 	/* in legacy mode no amsdu is enabled so return zero */
448*4882a593Smuzhiyun 	return 0;
449*4882a593Smuzhiyun }
450*4882a593Smuzhiyun 
rs_fw_rate_init(struct iwl_mvm * mvm,struct ieee80211_sta * sta,enum nl80211_band band,bool update)451*4882a593Smuzhiyun void rs_fw_rate_init(struct iwl_mvm *mvm, struct ieee80211_sta *sta,
452*4882a593Smuzhiyun 		     enum nl80211_band band, bool update)
453*4882a593Smuzhiyun {
454*4882a593Smuzhiyun 	struct ieee80211_hw *hw = mvm->hw;
455*4882a593Smuzhiyun 	struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta);
456*4882a593Smuzhiyun 	struct iwl_lq_sta_rs_fw *lq_sta = &mvmsta->lq_sta.rs_fw;
457*4882a593Smuzhiyun 	u32 cmd_id = iwl_cmd_id(TLC_MNG_CONFIG_CMD, DATA_PATH_GROUP, 0);
458*4882a593Smuzhiyun 	struct ieee80211_supported_band *sband = hw->wiphy->bands[band];
459*4882a593Smuzhiyun 	u16 max_amsdu_len = rs_fw_get_max_amsdu_len(sta);
460*4882a593Smuzhiyun 	struct iwl_tlc_config_cmd cfg_cmd = {
461*4882a593Smuzhiyun 		.sta_id = mvmsta->sta_id,
462*4882a593Smuzhiyun 		.max_ch_width = update ?
463*4882a593Smuzhiyun 			rs_fw_bw_from_sta_bw(sta) : RATE_MCS_CHAN_WIDTH_20,
464*4882a593Smuzhiyun 		.flags = cpu_to_le16(rs_fw_get_config_flags(mvm, sta, sband)),
465*4882a593Smuzhiyun 		.chains = rs_fw_set_active_chains(iwl_mvm_get_valid_tx_ant(mvm)),
466*4882a593Smuzhiyun 		.sgi_ch_width_supp = rs_fw_sgi_cw_support(sta),
467*4882a593Smuzhiyun 		.max_mpdu_len = cpu_to_le16(max_amsdu_len),
468*4882a593Smuzhiyun 		.amsdu = iwl_mvm_is_csum_supported(mvm),
469*4882a593Smuzhiyun 	};
470*4882a593Smuzhiyun 	int ret;
471*4882a593Smuzhiyun 	u16 cmd_size = sizeof(cfg_cmd);
472*4882a593Smuzhiyun 
473*4882a593Smuzhiyun 	/* In old versions of the API the struct is 4 bytes smaller */
474*4882a593Smuzhiyun 	if (iwl_fw_lookup_cmd_ver(mvm->fw, DATA_PATH_GROUP,
475*4882a593Smuzhiyun 				  TLC_MNG_CONFIG_CMD, 0) < 3)
476*4882a593Smuzhiyun 		cmd_size -= 4;
477*4882a593Smuzhiyun 
478*4882a593Smuzhiyun 	memset(lq_sta, 0, offsetof(typeof(*lq_sta), pers));
479*4882a593Smuzhiyun 
480*4882a593Smuzhiyun #ifdef CONFIG_IWLWIFI_DEBUGFS
481*4882a593Smuzhiyun 	iwl_mvm_reset_frame_stats(mvm);
482*4882a593Smuzhiyun #endif
483*4882a593Smuzhiyun 	rs_fw_set_supp_rates(sta, sband, &cfg_cmd);
484*4882a593Smuzhiyun 
485*4882a593Smuzhiyun 	/*
486*4882a593Smuzhiyun 	 * since TLC offload works with one mode we can assume
487*4882a593Smuzhiyun 	 * that only vht/ht is used and also set it as station max amsdu
488*4882a593Smuzhiyun 	 */
489*4882a593Smuzhiyun 	sta->max_amsdu_len = max_amsdu_len;
490*4882a593Smuzhiyun 
491*4882a593Smuzhiyun 	ret = iwl_mvm_send_cmd_pdu(mvm, cmd_id, CMD_ASYNC, cmd_size,
492*4882a593Smuzhiyun 				   &cfg_cmd);
493*4882a593Smuzhiyun 	if (ret)
494*4882a593Smuzhiyun 		IWL_ERR(mvm, "Failed to send rate scale config (%d)\n", ret);
495*4882a593Smuzhiyun }
496*4882a593Smuzhiyun 
rs_fw_tx_protection(struct iwl_mvm * mvm,struct iwl_mvm_sta * mvmsta,bool enable)497*4882a593Smuzhiyun int rs_fw_tx_protection(struct iwl_mvm *mvm, struct iwl_mvm_sta *mvmsta,
498*4882a593Smuzhiyun 			bool enable)
499*4882a593Smuzhiyun {
500*4882a593Smuzhiyun 	/* TODO: need to introduce a new FW cmd since LQ cmd is not relevant */
501*4882a593Smuzhiyun 	IWL_DEBUG_RATE(mvm, "tx protection - not implemented yet.\n");
502*4882a593Smuzhiyun 	return 0;
503*4882a593Smuzhiyun }
504*4882a593Smuzhiyun 
iwl_mvm_rs_add_sta(struct iwl_mvm * mvm,struct iwl_mvm_sta * mvmsta)505*4882a593Smuzhiyun void iwl_mvm_rs_add_sta(struct iwl_mvm *mvm, struct iwl_mvm_sta *mvmsta)
506*4882a593Smuzhiyun {
507*4882a593Smuzhiyun 	struct iwl_lq_sta_rs_fw *lq_sta = &mvmsta->lq_sta.rs_fw;
508*4882a593Smuzhiyun 
509*4882a593Smuzhiyun 	IWL_DEBUG_RATE(mvm, "create station rate scale window\n");
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun 	lq_sta->pers.drv = mvm;
512*4882a593Smuzhiyun 	lq_sta->pers.sta_id = mvmsta->sta_id;
513*4882a593Smuzhiyun 	lq_sta->pers.chains = 0;
514*4882a593Smuzhiyun 	memset(lq_sta->pers.chain_signal, 0, sizeof(lq_sta->pers.chain_signal));
515*4882a593Smuzhiyun 	lq_sta->pers.last_rssi = S8_MIN;
516*4882a593Smuzhiyun 	lq_sta->last_rate_n_flags = 0;
517*4882a593Smuzhiyun 
518*4882a593Smuzhiyun #ifdef CONFIG_MAC80211_DEBUGFS
519*4882a593Smuzhiyun 	lq_sta->pers.dbg_fixed_rate = 0;
520*4882a593Smuzhiyun #endif
521*4882a593Smuzhiyun }
522