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