M7350/wlan/8192es/DriverSrcPkg/Driver/rtl8192cd_92es/8812_vht_gen.c
2024-09-09 08:59:52 +00:00

618 lines
19 KiB
C
Executable File

#include "8192cd.h"
#include "8192cd_cfg.h"
#include "8192cd_util.h"
#include "8192cd_headers.h"
#include "8812_vht_gen.h"
#ifdef RTK_AC_SUPPORT
void input_value_32(unsigned long *p, unsigned char start, unsigned char end, unsigned int value)
{
unsigned int bit_mask = 0;
if(value > 0) //only none-zero value needs to be assigned
{
if(start == end) //1-bit value
{
*p |= BIT(start);
}
else
{
unsigned char x = 0;
for(x = 0; x<=(end-start); x ++)
bit_mask |= BIT(x);
*p |= ((value&bit_mask) << start);
}
}
}
// 20/40/80, ShortGI, MCS Rate
const u2Byte VHT_MCS_DATA_RATE[3][2][30] =
{ { {13, 26, 39, 52, 78, 104, 117, 130, 156, 156,
26, 52, 78, 104, 156, 208, 234, 260, 312, 312,
39, 78, 117, 156, 234, 312, 351, 390, 468, 520}, // Long GI, 20MHz
{14, 29, 43, 58, 87, 116, 130, 144, 173, 173,
29, 58, 87, 116, 173, 231, 260, 289, 347, 347,
43, 86, 130, 173, 260, 347, 390, 433, 520, 578} }, // Short GI, 20MHz
{ {27, 54, 81, 108, 162, 216, 243, 270, 324, 360,
54, 108, 162, 216, 324, 432, 486, 540, 648, 720,
81, 162, 243, 342, 486, 648, 729, 810, 972, 1080}, // Long GI, 40MHz
{30, 60, 90, 120, 180, 240, 270, 300,360, 400,
60, 120, 180, 240, 360, 480, 540, 600, 720, 800,
90, 180, 270, 360, 540, 720, 810, 900, 1080, 1200} }, // Short GI, 40MHz
{ {59, 117, 176, 234, 351, 468, 527, 585, 702, 780,
117, 234, 351, 468, 702, 936, 1053, 1170, 1404, 1560,
176, 351, 527, 702, 1053, 1408, 1408, 1745, 2106, 2340}, // Long GI, 80MHz
{65, 130, 195, 260, 390, 520, 585, 650, 780, 867,
130, 260, 390, 520, 780, 1040, 1170, 1300, 1560, 1733,
195, 390, 585, 780, 1170, 1560, 1560, 1950, 2340, 2600} } // Short GI, 80MHz
};
enum _VHT_SUPPORT_RATE_MAP_ {
SUPPORT_MCS_0_7_RATES = 0,
SUPPORT_MCS_0_8_RATES = 1,
SUPPORT_MCS_0_9_RATES = 2,
NOT_SUPPORT_VHT_RATES = 3
};
/*
* Description:
* This function will get the highest speed rate in input MCS set.
*
* /param Adapter Pionter to Adapter entity
* pMCSRateSet Pointer to MCS rate bitmap
* pMCSFilter Pointer to MCS rate filter
*
* /return Highest MCS rate included in pMCSRateSet and filtered by pMCSFilter.
*
*/
u1Byte
VHTGetHighestMCSRate(
struct rtl8192cd_priv *priv,
IN pu1Byte pVHTMCSRateSet
)
{
u1Byte i, j;
u1Byte bitMap;
u1Byte VHTMcsRate = 0;
for(i = 0; i < 2; i++)
{
if(pVHTMCSRateSet[i] != 0xff)
{
for(j = 0; j < 8; j += 2)
{
bitMap = (pVHTMCSRateSet[i] >> j) & 3;
if(bitMap != 3)
VHTMcsRate = _NSS1_MCS7_RATE_ + 5*j + i*40 + bitMap; //VHT rate indications begin from 0x90
}
}
}
return VHTMcsRate;
}
u2Byte
VHTMcsToDataRate(
struct rtl8192cd_priv *priv
)
{
BOOLEAN isShortGI = FALSE;
u2Byte VHTMcsRate;
#if 1
if(priv->pshare->rf_ft_var.lgirate == 0)
return 0;
isShortGI = 0;
if((priv->pmib->dot11acConfigEntry.dot11SupportedVHT & 0x30) != 0x30)
VHTMcsRate = _NSS3_MCS7_RATE_ +((priv->pmib->dot11acConfigEntry.dot11SupportedVHT>>4) &3);
else if((priv->pmib->dot11acConfigEntry.dot11SupportedVHT & 0x000c) != 0x0c)
VHTMcsRate = _NSS2_MCS7_RATE_ +((priv->pmib->dot11acConfigEntry.dot11SupportedVHT>>2) &3);
else
VHTMcsRate = _NSS1_MCS7_RATE_ +((priv->pmib->dot11acConfigEntry.dot11SupportedVHT) &3); ;
#else
switch(priv->pshare->CurrentChannelBW){
case HT_CHANNEL_WIDTH_20:
isShortGI = priv->pmib->dot11nConfigEntry.dot11nShortGIfor20M?1:0;
break;
case HT_CHANNEL_WIDTH_20_40:
isShortGI = priv->pmib->dot11nConfigEntry.dot11nShortGIfor40M?1:0;
break;
case HT_CHANNEL_WIDTH_80:
isShortGI = priv->pmib->dot11nConfigEntry.dot11nShortGIfor40M?1:0; // ??
break;
}
#endif
VHTMcsRate -=_NSS1_MCS0_RATE_;
if( ((VHTMcsRate>20)&&get_rf_mimo_mode(priv)==MIMO_2T2R)|| (priv->pshare->is_40m_bw > 2))
return 600;
else
return VHT_MCS_DATA_RATE[priv->pshare->is_40m_bw][isShortGI][(VHTMcsRate&0x3f)];
}
unsigned int filter_mcs_9(unsigned int supported_vht, int num_ss)
{
int tmp = 0;
//panic_printk(" +++ supported_vht = 0x%x \n", supported_vht);
for(tmp = 1; tmp <= num_ss; tmp++)
{
int bit_shift = ((tmp-1)*2);
if(tmp > 8)
break;
if((tmp==3) || (tmp==6)) //3SS & 6SS support 20M + MCS9
continue;
if(( supported_vht & (3 << bit_shift)) == (SUPPORT_MCS_0_9_RATES << bit_shift))
{
supported_vht &= ~(3 << bit_shift);
supported_vht |= (SUPPORT_MCS_0_8_RATES << bit_shift);
}
}
//panic_printk(" --- supported_vht = 0x%x \n", supported_vht);
return supported_vht;
}
#ifdef MCR_WIRELESS_EXTEND
void construct_vht_ie_mcr(struct rtl8192cd_priv *priv, unsigned char channel_center, struct stat_info *pstat)
{
struct vht_cap_elmt *vht_cap;
struct vht_oper_elmt *vht_oper;
unsigned int value;
unsigned char txbf_max_ant, txbf_sounding_dim;
unsigned int supported_vht = priv->pmib->dot11acConfigEntry.dot11SupportedVHT;
//// ===== VHT CAPABILITIES ELEMENT ===== /////
//VHT CAPABILITIES INFO field
priv->vht_cap_len = sizeof(struct vht_cap_elmt);
vht_cap = &priv->vht_cap_buf;
memset(vht_cap, 0, sizeof(struct vht_cap_elmt));
switch(get_rf_mimo_mode(priv)) {
case MIMO_1T1R:
supported_vht |= 0xfffe;
break;
case MIMO_3T3R:
case MIMO_4T4R:
supported_vht |= 0xffea;
break;
default: //2T2R
supported_vht |= 0xfffa;
break;
}
// TODO: MAX_MPDU_LENGTH_E in 11AC
if(priv->pmib->dot11nConfigEntry.dot11nAMSDURecvMax)
input_value_32(&vht_cap->vht_cap_info, MAX_MPDU_LENGTH_S, MAX_MPDU_LENGTH_E, (priv->pmib->dot11nConfigEntry.dot11nAMSDURecvMax & 0x3));
else
input_value_32(&vht_cap->vht_cap_info, MAX_MPDU_LENGTH_S, MAX_MPDU_LENGTH_E, 0);
//0 - not support 160/80+80; 1 - support 160; 2 - support 80+80
if(priv->pshare->CurrentChannelBW == HT_CHANNEL_WIDTH_AC_160)
value = 1;
else
value = 0;
input_value_32(&vht_cap->vht_cap_info, CHL_WIDTH_S, CHL_WIDTH_E, value);
if((GET_CHIP_VER(priv) == VERSION_8814A) && (priv->pshare->is_40m_bw == HT_CHANNEL_WIDTH_AC_80))
input_value_32(&vht_cap->vht_cap_info, SHORT_GI80M_S, SHORT_GI80M_E, (priv->pmib->dot11nConfigEntry.dot11nShortGIfor40M ? 1 : 0));
input_value_32(&vht_cap->vht_cap_info, SHORT_GI160M_S, SHORT_GI160M_E, 0);
if( (priv->pmib->dot11nConfigEntry.dot11nLDPC&1)
#if defined(CONFIG_WLAN_HAL_8881A)
&& (GET_CHIP_VER(priv) != VERSION_8881A)
#endif
)
input_value_32(&vht_cap->vht_cap_info, RX_LDPC_S, RX_LDPC_E, 1);
else
input_value_32(&vht_cap->vht_cap_info, RX_LDPC_S, RX_LDPC_E, 0);
#if 1
if (priv->pmib->dot11nConfigEntry.dot11nSTBC)
{
if ((get_rf_mimo_mode(priv) == MIMO_2T2R) || (get_rf_mimo_mode(priv) == MIMO_3T3R)) //eric_8814
input_value_32(&vht_cap->vht_cap_info, TX_STBC_S, TX_STBC_E, 1);
input_value_32(&vht_cap->vht_cap_info, RX_STBC_S, RX_STBC_E, 1);
}
else
#endif
{
input_value_32(&vht_cap->vht_cap_info, TX_STBC_S, TX_STBC_E, 0);
input_value_32(&vht_cap->vht_cap_info, RX_STBC_S, RX_STBC_E, 0);
}
#ifdef BEAMFORMING_SUPPORT
if (priv->pmib->dot11RFEntry.txbf == 1) {
if(priv->pmib->dot11RFEntry.txbfer == 1)
input_value_32(&vht_cap->vht_cap_info, SU_BFER_S, SU_BFER_E, 1);
if(priv->pmib->dot11RFEntry.txbfee == 1)
input_value_32(&vht_cap->vht_cap_info, SU_BFEE_S, SU_BFEE_E, 1);
} else
#endif
{
input_value_32(&vht_cap->vht_cap_info, SU_BFER_S, SU_BFER_E, 0);
input_value_32(&vht_cap->vht_cap_info, SU_BFEE_S, SU_BFEE_E, 0);
}
#ifdef CONFIG_WLAN_HAL_8814AE
if(priv->pshare->rf_ft_var.bf_sup_val != 0){
input_value_32(&vht_cap->vht_cap_info, MAX_ANT_SUPP_S, MAX_ANT_SUPP_E, priv->pshare->rf_ft_var.bf_sup_val);
input_value_32(&vht_cap->vht_cap_info, SOUNDING_DIMENSIONS_S, SOUNDING_DIMENSIONS_E, priv->pshare->rf_ft_var.bf_sup_val);
}else
#endif
{
#ifdef CONFIG_WLAN_HAL_8814AE
if(GET_CHIP_VER(priv)==VERSION_8814A) {
if(get_rf_mimo_mode(priv) == MIMO_4T4R) {
txbf_max_ant = 3;
txbf_sounding_dim = 3;
} else if(get_rf_mimo_mode(priv) == MIMO_3T3R) {
txbf_max_ant = 2;
txbf_sounding_dim = 3;
} else if(get_rf_mimo_mode(priv) == MIMO_2T4R) {
txbf_max_ant = 2;
txbf_sounding_dim = 1;
} else if(get_rf_mimo_mode(priv) == MIMO_2T2R) {
txbf_max_ant = 2;
txbf_sounding_dim = 1;
} else {
txbf_max_ant = 1;
txbf_sounding_dim = 1;
}
input_value_32(&vht_cap->vht_cap_info, MAX_ANT_SUPP_S, MAX_ANT_SUPP_E, txbf_max_ant);
input_value_32(&vht_cap->vht_cap_info, SOUNDING_DIMENSIONS_S, SOUNDING_DIMENSIONS_E, txbf_sounding_dim);
}
else
#endif
{
input_value_32(&vht_cap->vht_cap_info, MAX_ANT_SUPP_S, MAX_ANT_SUPP_E, BEAMFORM_MAX_ANT_SUPP);
input_value_32(&vht_cap->vht_cap_info, SOUNDING_DIMENSIONS_S, SOUNDING_DIMENSIONS_E, BEAMFORM_SOUNDING_DIMENSIONS);
}
}
input_value_32(&vht_cap->vht_cap_info, MU_BFER_S, MU_BFER_E, 0);
input_value_32(&vht_cap->vht_cap_info, MU_BFEE_S, MU_BFEE_E, 0);
input_value_32(&vht_cap->vht_cap_info, TXOP_PS_S, TXOP_PS_E, 0);
input_value_32(&vht_cap->vht_cap_info, HTC_VHT_S, HTC_VHT_E, 1);
#ifdef MCR_WIRELESS_EXTEND
input_value_32(&vht_cap->vht_cap_info, MAX_RXAMPDU_FACTOR_S, MAX_RXAMPDU_FACTOR_E, priv->pshare->rf_ft_var.ampdu_den_vht);
#else
input_value_32(&vht_cap->vht_cap_info, MAX_RXAMPDU_FACTOR_S, MAX_RXAMPDU_FACTOR_E, 7);
#endif
input_value_32(&vht_cap->vht_cap_info, LINK_ADAPTION_S, LINK_ADAPTION_E, 0);
input_value_32(&vht_cap->vht_cap_info, RX_ANT_PC_S, RX_ANT_PC_E, 0);
input_value_32(&vht_cap->vht_cap_info, TX_ANT_PC_S, TX_ANT_PC_E, 0);
//printk("vht_cap->vht_cap_info 0x%08X ", vht_cap->vht_cap_info);
vht_cap->vht_cap_info = cpu_to_le32(vht_cap->vht_cap_info);
//printk("0x%08X\n", vht_cap->vht_cap_info);
#if defined(AC2G_256QAM) || defined(WLAN_HAL_8814AE)
if(is_ac2g(priv) && ((priv->pshare->CurrentChannelBW == HT_CHANNEL_WIDTH_AC_20)||(GET_CHIP_VER(priv)==VERSION_8814A))) //if bw = 20M, not support MCS9
{
if(get_rf_mimo_mode(priv) == MIMO_1T1R)
{
supported_vht = 0xfffd;
}
else if(get_rf_mimo_mode(priv) == MIMO_2T2R)
{
supported_vht = 0xfff5;
}
else if(get_rf_mimo_mode(priv) == MIMO_3T3R || get_rf_mimo_mode(priv) == MIMO_4T4R)
{
supported_vht = 0xffd5;
}
else
supported_vht = 0xfff5; //2ss as default
}
#endif
if(priv->pshare->CurrentChannelBW == HT_CHANNEL_WIDTH_AC_20)
{
// 1SS & 2SS do NOT support MCS9 in BW 20m
if(get_rf_mimo_mode(priv) == MIMO_1T1R)
supported_vht = filter_mcs_9(supported_vht, 1);
else if(get_rf_mimo_mode(priv) == MIMO_2T2R)
supported_vht = filter_mcs_9(supported_vht, 2);
}
if (GET_CHIP_VER(priv)==VERSION_8814A && get_rf_mimo_mode(priv) == MIMO_2T2R) {
if (pstat->IOTPeer == HT_IOT_PEER_REALTEK_8812) {
supported_vht = 0xfff5;
}
}
{
input_value_32(&vht_cap->vht_support_mcs[0], MCS_RX_MAP_S, MCS_RX_MAP_E, supported_vht);
value = (VHTMcsToDataRate(priv)+1)>>1;
input_value_32(&vht_cap->vht_support_mcs[0], MCS_RX_HIGHEST_RATE_S, MCS_RX_HIGHEST_RATE_E, value);
vht_cap->vht_support_mcs[0] = cpu_to_le32(vht_cap->vht_support_mcs[0]);
input_value_32(&vht_cap->vht_support_mcs[1], MCS_TX_MAP_S, MCS_TX_MAP_E, supported_vht);
value = (VHTMcsToDataRate(priv)+1)>>1;
input_value_32(&vht_cap->vht_support_mcs[1], MCS_TX_HIGHEST_RATE_S, MCS_TX_HIGHEST_RATE_E, value);
vht_cap->vht_support_mcs[1] = cpu_to_le32(vht_cap->vht_support_mcs[1]);
}
//// ===== VHT CAPABILITIES ELEMENT ===== /////
priv->vht_oper_len = sizeof(struct vht_oper_elmt);
vht_oper = &priv->vht_oper_buf;
memset(vht_oper, 0, sizeof(struct vht_oper_elmt));
if((priv->pshare->is_40m_bw == HT_CHANNEL_WIDTH_AC_80) || (GET_CHIP_VER(priv)==VERSION_8814A))
{
vht_oper->vht_oper_info[0] = (priv->pshare->is_40m_bw ==2) ? 1 : 0;
if(OPMODE & (WIFI_STATION_STATE))
vht_oper->vht_oper_info[0] = 1; //8812_client
if(priv->pshare->is_40m_bw ==2) {
int channel = priv->pmib->dot11RFEntry.dot11channel;
if (channel <= 48)
channel_center = 42;
else if (channel <= 64)
channel_center = 58;
else if (channel <= 112)
channel_center = 106;
else if (channel <= 128)
channel_center = 122;
else if (channel <= 144)
channel_center = 138;
else if (channel <= 161)
channel_center = 155;
else if (channel <= 177)
channel_center = 171;
}
vht_oper->vht_oper_info[1] = channel_center;
vht_oper->vht_oper_info[2] = 0;
}
if(get_rf_mimo_mode(priv) == MIMO_1T1R)
value = 0xfffc;
else if(get_rf_mimo_mode(priv) == MIMO_2T2R)
value = 0xfff0;
else if(get_rf_mimo_mode(priv) == MIMO_3T3R || get_rf_mimo_mode(priv) == MIMO_4T4R)
value = 0xffea;
else
value = 0xfff0; //2ss as default
vht_oper->vht_basic_msc = value;
vht_oper->vht_basic_msc = cpu_to_le16(vht_oper->vht_basic_msc);
}
#endif
void construct_vht_ie(struct rtl8192cd_priv *priv, unsigned char channel_center)
{
struct vht_cap_elmt *vht_cap;
struct vht_oper_elmt *vht_oper;
unsigned int value;
unsigned int supported_vht = priv->pmib->dot11acConfigEntry.dot11SupportedVHT;
//// ===== VHT CAPABILITIES ELEMENT ===== /////
//VHT CAPABILITIES INFO field
priv->vht_cap_len = sizeof(struct vht_cap_elmt);
vht_cap = &priv->vht_cap_buf;
memset(vht_cap, 0, sizeof(struct vht_cap_elmt));
switch(get_rf_mimo_mode(priv)) {
case MIMO_1T1R:
supported_vht |= 0xfffe;
break;
case MIMO_3T3R:
case MIMO_4T4R:
supported_vht |= 0xffea;
break;
default: //2T2R
supported_vht |= 0xfffa;
break;
}
// TODO: MAX_MPDU_LENGTH_E in 11AC
if(priv->pmib->dot11nConfigEntry.dot11nAMSDURecvMax)
input_value_32(&vht_cap->vht_cap_info, MAX_MPDU_LENGTH_S, MAX_MPDU_LENGTH_E, (priv->pmib->dot11nConfigEntry.dot11nAMSDURecvMax & 0x3));
else
input_value_32(&vht_cap->vht_cap_info, MAX_MPDU_LENGTH_S, MAX_MPDU_LENGTH_E, 0);
//0 - not support 160/80+80; 1 - support 160; 2 - support 80+80
if(priv->pshare->CurrentChannelBW == HT_CHANNEL_WIDTH_AC_160)
value = 1;
else
value = 0;
input_value_32(&vht_cap->vht_cap_info, CHL_WIDTH_S, CHL_WIDTH_E, value);
if(priv->pshare->CurrentChannelBW == HT_CHANNEL_WIDTH_AC_80)
input_value_32(&vht_cap->vht_cap_info, SHORT_GI80M_S, SHORT_GI80M_E, (priv->pmib->dot11nConfigEntry.dot11nShortGIfor80M ? 1 : 0));
input_value_32(&vht_cap->vht_cap_info, SHORT_GI160M_S, SHORT_GI160M_E, 0);
if( (priv->pmib->dot11nConfigEntry.dot11nLDPC&1) && (can_enable_rx_ldpc(priv)) )
input_value_32(&vht_cap->vht_cap_info, RX_LDPC_S, RX_LDPC_E, 1);
else
input_value_32(&vht_cap->vht_cap_info, RX_LDPC_S, RX_LDPC_E, 0);
#if 1
if (priv->pmib->dot11nConfigEntry.dot11nSTBC)
{
if ((get_rf_mimo_mode(priv) == MIMO_2T2R) || (get_rf_mimo_mode(priv) == MIMO_3T3R)) //eric_8814
input_value_32(&vht_cap->vht_cap_info, TX_STBC_S, TX_STBC_E, 1);
input_value_32(&vht_cap->vht_cap_info, RX_STBC_S, RX_STBC_E, 1);
}
else
#endif
{
input_value_32(&vht_cap->vht_cap_info, TX_STBC_S, TX_STBC_E, 0);
input_value_32(&vht_cap->vht_cap_info, RX_STBC_S, RX_STBC_E, 0);
}
#ifdef BEAMFORMING_SUPPORT
if (priv->pmib->dot11RFEntry.txbf == 1) {
if(priv->pmib->dot11RFEntry.txbfer == 1)
input_value_32(&vht_cap->vht_cap_info, SU_BFER_S, SU_BFER_E, 1);
if(priv->pmib->dot11RFEntry.txbfee == 1)
input_value_32(&vht_cap->vht_cap_info, SU_BFEE_S, SU_BFEE_E, 1);
} else
#endif
{
input_value_32(&vht_cap->vht_cap_info, SU_BFER_S, SU_BFER_E, 0);
input_value_32(&vht_cap->vht_cap_info, SU_BFEE_S, SU_BFEE_E, 0);
}
input_value_32(&vht_cap->vht_cap_info, MAX_ANT_SUPP_S, MAX_ANT_SUPP_E, BEAMFORM_SUPPORT_VALUE);
input_value_32(&vht_cap->vht_cap_info, SOUNDING_DIMENSIONS_S, SOUNDING_DIMENSIONS_E, BEAMFORM_SUPPORT_VALUE);
input_value_32(&vht_cap->vht_cap_info, MU_BFER_S, MU_BFER_E, 0);
input_value_32(&vht_cap->vht_cap_info, MU_BFEE_S, MU_BFEE_E, 0);
input_value_32(&vht_cap->vht_cap_info, TXOP_PS_S, TXOP_PS_E, 0);
input_value_32(&vht_cap->vht_cap_info, HTC_VHT_S, HTC_VHT_E, 1);
input_value_32(&vht_cap->vht_cap_info, MAX_RXAMPDU_FACTOR_S, MAX_RXAMPDU_FACTOR_E, 7);
input_value_32(&vht_cap->vht_cap_info, LINK_ADAPTION_S, LINK_ADAPTION_E, 0);
input_value_32(&vht_cap->vht_cap_info, RX_ANT_PC_S, RX_ANT_PC_E, 0);
input_value_32(&vht_cap->vht_cap_info, TX_ANT_PC_S, TX_ANT_PC_E, 0);
//printk("vht_cap->vht_cap_info 0x%08X ", vht_cap->vht_cap_info);
vht_cap->vht_cap_info = cpu_to_le32(vht_cap->vht_cap_info);
//printk("0x%08X\n", vht_cap->vht_cap_info);
#if defined(AC2G_256QAM) || defined(WLAN_HAL_8814AE)
if(is_ac2g(priv) && ((priv->pshare->CurrentChannelBW == HT_CHANNEL_WIDTH_AC_20)||(GET_CHIP_VER(priv)==VERSION_8814A))) //if bw = 20M, not support MCS9
{
if(get_rf_mimo_mode(priv) == MIMO_1T1R)
{
supported_vht = 0xfffd;
}
else if(get_rf_mimo_mode(priv) == MIMO_2T2R)
{
supported_vht = 0xfff5;
}
else if(get_rf_mimo_mode(priv) == MIMO_3T3R || get_rf_mimo_mode(priv) == MIMO_4T4R)
{
supported_vht = 0xffd5;
}
else
supported_vht = 0xfff5; //2ss as default
}
#endif
if(priv->pshare->CurrentChannelBW == HT_CHANNEL_WIDTH_AC_20)
{
// 1SS & 2SS do NOT support MCS9 in BW 20m
if(get_rf_mimo_mode(priv) == MIMO_1T1R)
supported_vht = filter_mcs_9(supported_vht, 1);
else if(get_rf_mimo_mode(priv) == MIMO_2T2R)
supported_vht = filter_mcs_9(supported_vht, 2);
}
{
input_value_32(&vht_cap->vht_support_mcs[0], MCS_RX_MAP_S, MCS_RX_MAP_E, supported_vht);
value = (VHTMcsToDataRate(priv)+1)>>1;
input_value_32(&vht_cap->vht_support_mcs[0], MCS_RX_HIGHEST_RATE_S, MCS_RX_HIGHEST_RATE_E, value);
vht_cap->vht_support_mcs[0] = cpu_to_le32(vht_cap->vht_support_mcs[0]);
input_value_32(&vht_cap->vht_support_mcs[1], MCS_TX_MAP_S, MCS_TX_MAP_E, supported_vht);
value = (VHTMcsToDataRate(priv)+1)>>1;
input_value_32(&vht_cap->vht_support_mcs[1], MCS_TX_HIGHEST_RATE_S, MCS_TX_HIGHEST_RATE_E, value);
vht_cap->vht_support_mcs[1] = cpu_to_le32(vht_cap->vht_support_mcs[1]);
}
//// ===== VHT CAPABILITIES ELEMENT ===== /////
priv->vht_oper_len = sizeof(struct vht_oper_elmt);
vht_oper = &priv->vht_oper_buf;
memset(vht_oper, 0, sizeof(struct vht_oper_elmt));
if((priv->pshare->is_40m_bw == HT_CHANNEL_WIDTH_AC_80) || (GET_CHIP_VER(priv)==VERSION_8814A))
{
vht_oper->vht_oper_info[0] = (priv->pshare->is_40m_bw ==2) ? 1 : 0;
if(OPMODE & (WIFI_STATION_STATE))
vht_oper->vht_oper_info[0] = 1; //8812_client
if(priv->pshare->is_40m_bw ==2) {
int channel = priv->pmib->dot11RFEntry.dot11channel;
if (channel <= 48)
channel_center = 42;
else if (channel <= 64)
channel_center = 58;
else if (channel <= 112)
channel_center = 106;
else if (channel <= 128)
channel_center = 122;
else if (channel <= 144)
channel_center = 138;
else if (channel <= 161)
channel_center = 155;
else if (channel <= 177)
channel_center = 171;
}
vht_oper->vht_oper_info[1] = channel_center;
vht_oper->vht_oper_info[2] = 0;
}
if(get_rf_mimo_mode(priv) == MIMO_1T1R)
value = 0xfffc;
else if(get_rf_mimo_mode(priv) == MIMO_2T2R)
value = 0xfff0;
else if(get_rf_mimo_mode(priv) == MIMO_3T3R || get_rf_mimo_mode(priv) == MIMO_4T4R)
value = 0xffea;
else
value = 0xfff0; //2ss as default
vht_oper->vht_basic_msc = value;
vht_oper->vht_basic_msc = cpu_to_le16(vht_oper->vht_basic_msc);
}
#endif //CONFIG_RTL_8812_SUPPORT