mirror of https://gitee.com/openkylin/linux.git
ath10k: move static HT/VHT capability setup functions
Move HT and VHT capabiltity setup static functions to avoid forward declaration. Signed-off-by: Rajkumar Manoharan <rmanohar@qti.qualcomm.com> Signed-off-by: Kalle Valo <kvalo@qca.qualcomm.com>
This commit is contained in:
Rajkumar Manoharan
Kalle Valo
parent
7a1d70ab05
commit
f58512f336
|
|
@ -3757,6 +3757,146 @@ static void ath10k_check_chain_mask(struct ath10k *ar, u32 cm, const char *dbg)
|
||||||
dbg, cm);
|
dbg, cm);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int ath10k_mac_get_vht_cap_bf_sts(struct ath10k *ar)
|
||||||
|
{
|
||||||
|
int nsts = ar->vht_cap_info;
|
||||||
|
|
||||||
|
nsts &= IEEE80211_VHT_CAP_BEAMFORMEE_STS_MASK;
|
||||||
|
nsts >>= IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT;
|
||||||
|
|
||||||
|
/* If firmware does not deliver to host number of space-time
|
||||||
|
* streams supported, assume it support up to 4 BF STS and return
|
||||||
|
* the value for VHT CAP: nsts-1)
|
||||||
|
*/
|
||||||
|
if (nsts == 0)
|
||||||
|
return 3;
|
||||||
|
|
||||||
|
return nsts;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ath10k_mac_get_vht_cap_bf_sound_dim(struct ath10k *ar)
|
||||||
|
{
|
||||||
|
int sound_dim = ar->vht_cap_info;
|
||||||
|
|
||||||
|
sound_dim &= IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_MASK;
|
||||||
|
sound_dim >>= IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_SHIFT;
|
||||||
|
|
||||||
|
/* If the sounding dimension is not advertised by the firmware,
|
||||||
|
* let's use a default value of 1
|
||||||
|
*/
|
||||||
|
if (sound_dim == 0)
|
||||||
|
return 1;
|
||||||
|
|
||||||
|
return sound_dim;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct ieee80211_sta_vht_cap ath10k_create_vht_cap(struct ath10k *ar)
|
||||||
|
{
|
||||||
|
struct ieee80211_sta_vht_cap vht_cap = {0};
|
||||||
|
u16 mcs_map;
|
||||||
|
u32 val;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
vht_cap.vht_supported = 1;
|
||||||
|
vht_cap.cap = ar->vht_cap_info;
|
||||||
|
|
||||||
|
if (ar->vht_cap_info & (IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE |
|
||||||
|
IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE)) {
|
||||||
|
val = ath10k_mac_get_vht_cap_bf_sts(ar);
|
||||||
|
val <<= IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT;
|
||||||
|
val &= IEEE80211_VHT_CAP_BEAMFORMEE_STS_MASK;
|
||||||
|
|
||||||
|
vht_cap.cap |= val;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ar->vht_cap_info & (IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE |
|
||||||
|
IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE)) {
|
||||||
|
val = ath10k_mac_get_vht_cap_bf_sound_dim(ar);
|
||||||
|
val <<= IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_SHIFT;
|
||||||
|
val &= IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_MASK;
|
||||||
|
|
||||||
|
vht_cap.cap |= val;
|
||||||
|
}
|
||||||
|
|
||||||
|
mcs_map = 0;
|
||||||
|
for (i = 0; i < 8; i++) {
|
||||||
|
if ((i < ar->num_rf_chains) && (ar->cfg_tx_chainmask & BIT(i)))
|
||||||
|
mcs_map |= IEEE80211_VHT_MCS_SUPPORT_0_9 << (i * 2);
|
||||||
|
else
|
||||||
|
mcs_map |= IEEE80211_VHT_MCS_NOT_SUPPORTED << (i * 2);
|
||||||
|
}
|
||||||
|
|
||||||
|
vht_cap.vht_mcs.rx_mcs_map = cpu_to_le16(mcs_map);
|
||||||
|
vht_cap.vht_mcs.tx_mcs_map = cpu_to_le16(mcs_map);
|
||||||
|
|
||||||
|
return vht_cap;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct ieee80211_sta_ht_cap ath10k_get_ht_cap(struct ath10k *ar)
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
struct ieee80211_sta_ht_cap ht_cap = {0};
|
||||||
|
|
||||||
|
if (!(ar->ht_cap_info & WMI_HT_CAP_ENABLED))
|
||||||
|
return ht_cap;
|
||||||
|
|
||||||
|
ht_cap.ht_supported = 1;
|
||||||
|
ht_cap.ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K;
|
||||||
|
ht_cap.ampdu_density = IEEE80211_HT_MPDU_DENSITY_8;
|
||||||
|
ht_cap.cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40;
|
||||||
|
ht_cap.cap |= IEEE80211_HT_CAP_DSSSCCK40;
|
||||||
|
ht_cap.cap |= WLAN_HT_CAP_SM_PS_STATIC << IEEE80211_HT_CAP_SM_PS_SHIFT;
|
||||||
|
|
||||||
|
if (ar->ht_cap_info & WMI_HT_CAP_HT20_SGI)
|
||||||
|
ht_cap.cap |= IEEE80211_HT_CAP_SGI_20;
|
||||||
|
|
||||||
|
if (ar->ht_cap_info & WMI_HT_CAP_HT40_SGI)
|
||||||
|
ht_cap.cap |= IEEE80211_HT_CAP_SGI_40;
|
||||||
|
|
||||||
|
if (ar->ht_cap_info & WMI_HT_CAP_DYNAMIC_SMPS) {
|
||||||
|
u32 smps;
|
||||||
|
|
||||||
|
smps = WLAN_HT_CAP_SM_PS_DYNAMIC;
|
||||||
|
smps <<= IEEE80211_HT_CAP_SM_PS_SHIFT;
|
||||||
|
|
||||||
|
ht_cap.cap |= smps;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ar->ht_cap_info & WMI_HT_CAP_TX_STBC)
|
||||||
|
ht_cap.cap |= IEEE80211_HT_CAP_TX_STBC;
|
||||||
|
|
||||||
|
if (ar->ht_cap_info & WMI_HT_CAP_RX_STBC) {
|
||||||
|
u32 stbc;
|
||||||
|
|
||||||
|
stbc = ar->ht_cap_info;
|
||||||
|
stbc &= WMI_HT_CAP_RX_STBC;
|
||||||
|
stbc >>= WMI_HT_CAP_RX_STBC_MASK_SHIFT;
|
||||||
|
stbc <<= IEEE80211_HT_CAP_RX_STBC_SHIFT;
|
||||||
|
stbc &= IEEE80211_HT_CAP_RX_STBC;
|
||||||
|
|
||||||
|
ht_cap.cap |= stbc;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ar->ht_cap_info & WMI_HT_CAP_LDPC)
|
||||||
|
ht_cap.cap |= IEEE80211_HT_CAP_LDPC_CODING;
|
||||||
|
|
||||||
|
if (ar->ht_cap_info & WMI_HT_CAP_L_SIG_TXOP_PROT)
|
||||||
|
ht_cap.cap |= IEEE80211_HT_CAP_LSIG_TXOP_PROT;
|
||||||
|
|
||||||
|
/* max AMSDU is implicitly taken from vht_cap_info */
|
||||||
|
if (ar->vht_cap_info & WMI_VHT_CAP_MAX_MPDU_LEN_MASK)
|
||||||
|
ht_cap.cap |= IEEE80211_HT_CAP_MAX_AMSDU;
|
||||||
|
|
||||||
|
for (i = 0; i < ar->num_rf_chains; i++) {
|
||||||
|
if (ar->cfg_rx_chainmask & BIT(i))
|
||||||
|
ht_cap.mcs.rx_mask[i] = 0xFF;
|
||||||
|
}
|
||||||
|
|
||||||
|
ht_cap.mcs.tx_params |= IEEE80211_HT_MCS_TX_DEFINED;
|
||||||
|
|
||||||
|
return ht_cap;
|
||||||
|
}
|
||||||
|
|
||||||
static int __ath10k_set_antenna(struct ath10k *ar, u32 tx_ant, u32 rx_ant)
|
static int __ath10k_set_antenna(struct ath10k *ar, u32 tx_ant, u32 rx_ant)
|
||||||
{
|
{
|
||||||
int ret;
|
int ret;
|
||||||
|
|
@ -4068,39 +4208,6 @@ static u32 get_nss_from_chainmask(u16 chain_mask)
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int ath10k_mac_get_vht_cap_bf_sts(struct ath10k *ar)
|
|
||||||
{
|
|
||||||
int nsts = ar->vht_cap_info;
|
|
||||||
|
|
||||||
nsts &= IEEE80211_VHT_CAP_BEAMFORMEE_STS_MASK;
|
|
||||||
nsts >>= IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT;
|
|
||||||
|
|
||||||
/* If firmware does not deliver to host number of space-time
|
|
||||||
* streams supported, assume it support up to 4 BF STS and return
|
|
||||||
* the value for VHT CAP: nsts-1)
|
|
||||||
* */
|
|
||||||
if (nsts == 0)
|
|
||||||
return 3;
|
|
||||||
|
|
||||||
return nsts;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int ath10k_mac_get_vht_cap_bf_sound_dim(struct ath10k *ar)
|
|
||||||
{
|
|
||||||
int sound_dim = ar->vht_cap_info;
|
|
||||||
|
|
||||||
sound_dim &= IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_MASK;
|
|
||||||
sound_dim >>= IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_SHIFT;
|
|
||||||
|
|
||||||
/* If the sounding dimension is not advertised by the firmware,
|
|
||||||
* let's use a default value of 1
|
|
||||||
*/
|
|
||||||
if (sound_dim == 0)
|
|
||||||
return 1;
|
|
||||||
|
|
||||||
return sound_dim;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int ath10k_mac_set_txbf_conf(struct ath10k_vif *arvif)
|
static int ath10k_mac_set_txbf_conf(struct ath10k_vif *arvif)
|
||||||
{
|
{
|
||||||
u32 value = 0;
|
u32 value = 0;
|
||||||
|
|
@ -6954,113 +7061,6 @@ static const struct ieee80211_iface_combination ath10k_10_4_if_comb[] = {
|
||||||
},
|
},
|
||||||
};
|
};
|
||||||
|
|
||||||
static struct ieee80211_sta_vht_cap ath10k_create_vht_cap(struct ath10k *ar)
|
|
||||||
{
|
|
||||||
struct ieee80211_sta_vht_cap vht_cap = {0};
|
|
||||||
u16 mcs_map;
|
|
||||||
u32 val;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
vht_cap.vht_supported = 1;
|
|
||||||
vht_cap.cap = ar->vht_cap_info;
|
|
||||||
|
|
||||||
if (ar->vht_cap_info & (IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE |
|
|
||||||
IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE)) {
|
|
||||||
val = ath10k_mac_get_vht_cap_bf_sts(ar);
|
|
||||||
val <<= IEEE80211_VHT_CAP_BEAMFORMEE_STS_SHIFT;
|
|
||||||
val &= IEEE80211_VHT_CAP_BEAMFORMEE_STS_MASK;
|
|
||||||
|
|
||||||
vht_cap.cap |= val;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (ar->vht_cap_info & (IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE |
|
|
||||||
IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE)) {
|
|
||||||
val = ath10k_mac_get_vht_cap_bf_sound_dim(ar);
|
|
||||||
val <<= IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_SHIFT;
|
|
||||||
val &= IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_MASK;
|
|
||||||
|
|
||||||
vht_cap.cap |= val;
|
|
||||||
}
|
|
||||||
|
|
||||||
mcs_map = 0;
|
|
||||||
for (i = 0; i < 8; i++) {
|
|
||||||
if ((i < ar->num_rf_chains) && (ar->cfg_tx_chainmask & BIT(i)))
|
|
||||||
mcs_map |= IEEE80211_VHT_MCS_SUPPORT_0_9 << (i*2);
|
|
||||||
else
|
|
||||||
mcs_map |= IEEE80211_VHT_MCS_NOT_SUPPORTED << (i*2);
|
|
||||||
}
|
|
||||||
|
|
||||||
vht_cap.vht_mcs.rx_mcs_map = cpu_to_le16(mcs_map);
|
|
||||||
vht_cap.vht_mcs.tx_mcs_map = cpu_to_le16(mcs_map);
|
|
||||||
|
|
||||||
return vht_cap;
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct ieee80211_sta_ht_cap ath10k_get_ht_cap(struct ath10k *ar)
|
|
||||||
{
|
|
||||||
int i;
|
|
||||||
struct ieee80211_sta_ht_cap ht_cap = {0};
|
|
||||||
|
|
||||||
if (!(ar->ht_cap_info & WMI_HT_CAP_ENABLED))
|
|
||||||
return ht_cap;
|
|
||||||
|
|
||||||
ht_cap.ht_supported = 1;
|
|
||||||
ht_cap.ampdu_factor = IEEE80211_HT_MAX_AMPDU_64K;
|
|
||||||
ht_cap.ampdu_density = IEEE80211_HT_MPDU_DENSITY_8;
|
|
||||||
ht_cap.cap |= IEEE80211_HT_CAP_SUP_WIDTH_20_40;
|
|
||||||
ht_cap.cap |= IEEE80211_HT_CAP_DSSSCCK40;
|
|
||||||
ht_cap.cap |= WLAN_HT_CAP_SM_PS_STATIC << IEEE80211_HT_CAP_SM_PS_SHIFT;
|
|
||||||
|
|
||||||
if (ar->ht_cap_info & WMI_HT_CAP_HT20_SGI)
|
|
||||||
ht_cap.cap |= IEEE80211_HT_CAP_SGI_20;
|
|
||||||
|
|
||||||
if (ar->ht_cap_info & WMI_HT_CAP_HT40_SGI)
|
|
||||||
ht_cap.cap |= IEEE80211_HT_CAP_SGI_40;
|
|
||||||
|
|
||||||
if (ar->ht_cap_info & WMI_HT_CAP_DYNAMIC_SMPS) {
|
|
||||||
u32 smps;
|
|
||||||
|
|
||||||
smps = WLAN_HT_CAP_SM_PS_DYNAMIC;
|
|
||||||
smps <<= IEEE80211_HT_CAP_SM_PS_SHIFT;
|
|
||||||
|
|
||||||
ht_cap.cap |= smps;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (ar->ht_cap_info & WMI_HT_CAP_TX_STBC)
|
|
||||||
ht_cap.cap |= IEEE80211_HT_CAP_TX_STBC;
|
|
||||||
|
|
||||||
if (ar->ht_cap_info & WMI_HT_CAP_RX_STBC) {
|
|
||||||
u32 stbc;
|
|
||||||
|
|
||||||
stbc = ar->ht_cap_info;
|
|
||||||
stbc &= WMI_HT_CAP_RX_STBC;
|
|
||||||
stbc >>= WMI_HT_CAP_RX_STBC_MASK_SHIFT;
|
|
||||||
stbc <<= IEEE80211_HT_CAP_RX_STBC_SHIFT;
|
|
||||||
stbc &= IEEE80211_HT_CAP_RX_STBC;
|
|
||||||
|
|
||||||
ht_cap.cap |= stbc;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (ar->ht_cap_info & WMI_HT_CAP_LDPC)
|
|
||||||
ht_cap.cap |= IEEE80211_HT_CAP_LDPC_CODING;
|
|
||||||
|
|
||||||
if (ar->ht_cap_info & WMI_HT_CAP_L_SIG_TXOP_PROT)
|
|
||||||
ht_cap.cap |= IEEE80211_HT_CAP_LSIG_TXOP_PROT;
|
|
||||||
|
|
||||||
/* max AMSDU is implicitly taken from vht_cap_info */
|
|
||||||
if (ar->vht_cap_info & WMI_VHT_CAP_MAX_MPDU_LEN_MASK)
|
|
||||||
ht_cap.cap |= IEEE80211_HT_CAP_MAX_AMSDU;
|
|
||||||
|
|
||||||
for (i = 0; i < ar->num_rf_chains; i++) {
|
|
||||||
if (ar->cfg_rx_chainmask & BIT(i))
|
|
||||||
ht_cap.mcs.rx_mask[i] = 0xFF;
|
|
||||||
}
|
|
||||||
|
|
||||||
ht_cap.mcs.tx_params |= IEEE80211_HT_MCS_TX_DEFINED;
|
|
||||||
|
|
||||||
return ht_cap;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void ath10k_get_arvif_iter(void *data, u8 *mac,
|
static void ath10k_get_arvif_iter(void *data, u8 *mac,
|
||||||
struct ieee80211_vif *vif)
|
struct ieee80211_vif *vif)
|
||||||
{
|
{
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue