/****************************************************************************** * * Copyright(c) 2013 Realtek Corporation. All rights reserved. * * This program is free software; you can redistribute it and/or modify it * under the terms of version 2 of the GNU General Public License as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * * You should have received a copy of the GNU General Public License along with * this program; if not, write to the Free Software Foundation, Inc., * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA * * ******************************************************************************/ #include #include const char *odm_comp_str[] = { /* BIT0 */"ODM_COMP_DIG", /* BIT1 */"ODM_COMP_RA_MASK", /* BIT2 */"ODM_COMP_DYNAMIC_TXPWR", /* BIT3 */"ODM_COMP_FA_CNT", /* BIT4 */"ODM_COMP_RSSI_MONITOR", /* BIT5 */"ODM_COMP_SNIFFER", /* BIT6 */"ODM_COMP_ANT_DIV", /* BIT7 */"ODM_COMP_DFS", /* BIT8 */"ODM_COMP_NOISY_DETECT", /* BIT9 */"ODM_COMP_RATE_ADAPTIVE", /* BIT10 */"ODM_COMP_PATH_DIV", /* BIT11 */"ODM_COMP_CCX", /* BIT12 */"ODM_COMP_DYNAMIC_PRICCA", /* BIT13 */NULL, /* BIT14 */"ODM_COMP_MP", /* BIT15 */"ODM_COMP_CFO_TRACKING", /* BIT16 */"ODM_COMP_ACS", /* BIT17 */"PHYDM_COMP_ADAPTIVITY", /* BIT18 */"PHYDM_COMP_RA_DBG", /* BIT19 */"PHYDM_COMP_TXBF", /* BIT20 */"ODM_COMP_EDCA_TURBO", /* BIT21 */"ODM_COMP_EARLY_MODE", /* BIT22 */"ODM_FW_DEBUG_TRACE", /* BIT23 */NULL, /* BIT24 */"ODM_COMP_TX_PWR_TRACK", /* BIT25 */"ODM_COMP_RX_GAIN_TRACK", /* BIT26 */"ODM_COMP_CALIBRATION", /* BIT27 */NULL, /* BIT28 */"ODM_PHY_CONFIG", /* BIT29 */"ODM_COMP_INIT", /* BIT30 */"ODM_COMP_COMMON", }; #define RTW_ODM_COMP_MAX 31 const char *odm_ability_str[] = { /* BIT0 */"ODM_BB_DIG", /* BIT1 */"ODM_BB_RA_MASK", /* BIT2 */"ODM_BB_DYNAMIC_TXPWR", /* BIT3 */"ODM_BB_FA_CNT", /* BIT4 */"ODM_BB_RSSI_MONITOR", /* BIT5 */"ODM_BB_CCK_PD", /* BIT6 */"ODM_BB_ANT_DIV", /* BIT7 */NULL, /* BIT8 */"ODM_BB_PWR_TRAIN", /* BIT9 */"ODM_BB_RATE_ADAPTIVE", /* BIT10 */"ODM_BB_PATH_DIV", /* BIT11 */NULL, /* BIT12 */NULL, /* BIT13 */"ODM_BB_ADAPTIVITY", /* BIT14 */"ODM_BB_CFO_TRACKING", /* BIT15 */"ODM_BB_NHM_CNT", /* BIT16 */"ODM_BB_PRIMARY_CCA", /* BIT17 */"ODM_BB_TXBF", /* BIT18 */"ODM_BB_DYNAMIC_ARFR", /* BIT19 */NULL, /* BIT20 */"ODM_MAC_EDCA_TURBO", /* BIT21 */"ODM_MAC_EARLY_MODE", /* BIT22 */NULL, /* BIT23 */NULL, /* BIT24 */"ODM_RF_TX_PWR_TRACK", /* BIT25 */"ODM_RF_RX_GAIN_TRACK", /* BIT26 */"ODM_RF_CALIBRATION", }; #define RTW_ODM_ABILITY_MAX 27 const char *odm_dbg_level_str[] = { NULL, "ODM_DBG_OFF", "ODM_DBG_SERIOUS", "ODM_DBG_WARNING", "ODM_DBG_LOUD", "ODM_DBG_TRACE", }; #define RTW_ODM_DBG_LEVEL_NUM 6 void rtw_odm_dbg_comp_msg(void *sel, _adapter *adapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); DM_ODM_T *odm = &pHalData->odmpriv; int cnt = 0; u64 dbg_comp = 0; int i; rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_FLAG, &dbg_comp, NULL); RTW_PRINT_SEL(sel, "odm.DebugComponents = 0x%016llx\n", dbg_comp); for (i = 0; i < RTW_ODM_COMP_MAX; i++) { if (odm_comp_str[i]) RTW_PRINT_SEL(sel, "%cBIT%-2d %s\n", (BIT0 & (dbg_comp >> i)) ? '+' : ' ', i, odm_comp_str[i]); } } inline void rtw_odm_dbg_comp_set(_adapter *adapter, u64 comps) { rtw_hal_set_odm_var(adapter, HAL_ODM_DBG_FLAG, &comps, _FALSE); } void rtw_odm_dbg_level_msg(void *sel, _adapter *adapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); DM_ODM_T *odm = &pHalData->odmpriv; int cnt = 0; u32 dbg_level = 0; int i; rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_LEVEL, &dbg_level, NULL); RTW_PRINT_SEL(sel, "odm.DebugLevel = %u\n", dbg_level); for (i = 0; i < RTW_ODM_DBG_LEVEL_NUM; i++) { if (odm_dbg_level_str[i]) RTW_PRINT_SEL(sel, "%u %s\n", i, odm_dbg_level_str[i]); } } inline void rtw_odm_dbg_level_set(_adapter *adapter, u32 level) { rtw_hal_set_odm_var(adapter, HAL_ODM_DBG_LEVEL, &level, _FALSE); } void rtw_odm_ability_msg(void *sel, _adapter *adapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); DM_ODM_T *odm = &pHalData->odmpriv; int cnt = 0; u32 ability = 0; int i; ability = rtw_phydm_ability_get(adapter); RTW_PRINT_SEL(sel, "odm.SupportAbility = 0x%08x\n", ability); for (i = 0; i < RTW_ODM_ABILITY_MAX; i++) { if (odm_ability_str[i]) RTW_PRINT_SEL(sel, "%cBIT%-2d %s\n", (BIT0 << i) & ability ? '+' : ' ', i, odm_ability_str[i]); } } inline void rtw_odm_ability_set(_adapter *adapter, u32 ability) { rtw_phydm_ability_set(adapter, ability); } /* set ODM_CMNINFO_IC_TYPE based on chip_type */ void rtw_odm_init_ic_type(_adapter *adapter) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); DM_ODM_T *odm = &hal_data->odmpriv; u4Byte ic_type = chip_type_to_odm_ic_type(rtw_get_chip_type(adapter)); rtw_warn_on(!ic_type); ODM_CmnInfoInit(odm, ODM_CMNINFO_IC_TYPE, ic_type); } inline void rtw_odm_set_force_igi_lb(_adapter *adapter, u8 lb) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); hal_data->u1ForcedIgiLb = lb; } inline u8 rtw_odm_get_force_igi_lb(_adapter *adapter) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); return hal_data->u1ForcedIgiLb; } void rtw_odm_adaptivity_ver_msg(void *sel, _adapter *adapter) { RTW_PRINT_SEL(sel, "ADAPTIVITY_VERSION "ADAPTIVITY_VERSION"\n"); } #define RTW_ADAPTIVITY_EN_DISABLE 0 #define RTW_ADAPTIVITY_EN_ENABLE 1 void rtw_odm_adaptivity_en_msg(void *sel, _adapter *adapter) { struct registry_priv *regsty = &adapter->registrypriv; struct mlme_priv *mlme = &adapter->mlmepriv; HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); DM_ODM_T *odm = &hal_data->odmpriv; RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_EN_"); if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_DISABLE) _RTW_PRINT_SEL(sel, "DISABLE\n"); else if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE) _RTW_PRINT_SEL(sel, "ENABLE\n"); else _RTW_PRINT_SEL(sel, "INVALID\n"); } #define RTW_ADAPTIVITY_MODE_NORMAL 0 #define RTW_ADAPTIVITY_MODE_CARRIER_SENSE 1 void rtw_odm_adaptivity_mode_msg(void *sel, _adapter *adapter) { struct registry_priv *regsty = &adapter->registrypriv; RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_MODE_"); if (regsty->adaptivity_mode == RTW_ADAPTIVITY_MODE_NORMAL) _RTW_PRINT_SEL(sel, "NORMAL\n"); else if (regsty->adaptivity_mode == RTW_ADAPTIVITY_MODE_CARRIER_SENSE) _RTW_PRINT_SEL(sel, "CARRIER_SENSE\n"); else _RTW_PRINT_SEL(sel, "INVALID\n"); } #define RTW_ADAPTIVITY_DML_DISABLE 0 #define RTW_ADAPTIVITY_DML_ENABLE 1 void rtw_odm_adaptivity_dml_msg(void *sel, _adapter *adapter) { struct registry_priv *regsty = &adapter->registrypriv; RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_DML_"); if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_DISABLE) _RTW_PRINT_SEL(sel, "DISABLE\n"); else if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_ENABLE) _RTW_PRINT_SEL(sel, "ENABLE\n"); else _RTW_PRINT_SEL(sel, "INVALID\n"); } void rtw_odm_adaptivity_dc_backoff_msg(void *sel, _adapter *adapter) { struct registry_priv *regsty = &adapter->registrypriv; RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_DC_BACKOFF:%u\n", regsty->adaptivity_dc_backoff); } void rtw_odm_adaptivity_config_msg(void *sel, _adapter *adapter) { rtw_odm_adaptivity_ver_msg(sel, adapter); rtw_odm_adaptivity_en_msg(sel, adapter); rtw_odm_adaptivity_mode_msg(sel, adapter); rtw_odm_adaptivity_dml_msg(sel, adapter); rtw_odm_adaptivity_dc_backoff_msg(sel, adapter); } bool rtw_odm_adaptivity_needed(_adapter *adapter) { struct registry_priv *regsty = &adapter->registrypriv; struct mlme_priv *mlme = &adapter->mlmepriv; bool ret = _FALSE; if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE) ret = _TRUE; return ret; } void rtw_odm_adaptivity_parm_msg(void *sel, _adapter *adapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); DM_ODM_T *odm = &pHalData->odmpriv; rtw_odm_adaptivity_config_msg(sel, adapter); RTW_PRINT_SEL(sel, "%10s %16s %16s %22s %12s\n" , "TH_L2H_ini", "TH_EDCCA_HL_diff", "TH_L2H_ini_mode2", "TH_EDCCA_HL_diff_mode2", "EDCCA_enable"); RTW_PRINT_SEL(sel, "0x%-8x %-16d 0x%-14x %-22d %-12d\n" , (u8)odm->TH_L2H_ini , odm->TH_EDCCA_HL_diff , (u8)odm->TH_L2H_ini_mode2 , odm->TH_EDCCA_HL_diff_mode2 , odm->EDCCA_enable ); RTW_PRINT_SEL(sel, "%15s %9s\n", "AdapEnableState", "Adap_Flag"); RTW_PRINT_SEL(sel, "%-15x %-9x\n" , odm->Adaptivity_enable , odm->adaptivity_flag ); } void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, s8 TH_L2H_ini_mode2, s8 TH_EDCCA_HL_diff_mode2, u8 EDCCA_enable) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); DM_ODM_T *odm = &pHalData->odmpriv; odm->TH_L2H_ini = TH_L2H_ini; odm->TH_EDCCA_HL_diff = TH_EDCCA_HL_diff; odm->TH_L2H_ini_mode2 = TH_L2H_ini_mode2; odm->TH_EDCCA_HL_diff_mode2 = TH_EDCCA_HL_diff_mode2; odm->EDCCA_enable = EDCCA_enable; } void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); DM_ODM_T *odm = &(hal_data->odmpriv); RTW_PRINT_SEL(sel, "RxRate = %s, RSSI_A = %d(%%), RSSI_B = %d(%%)\n", HDATA_RATE(odm->RxRate), odm->RSSI_A, odm->RSSI_B); } void rtw_odm_acquirespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); _irqL irqL; switch (type) { case RT_IQK_SPINLOCK: _enter_critical_bh(&pHalData->IQKSpinLock, &irqL); default: break; } } void rtw_odm_releasespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); _irqL irqL; switch (type) { case RT_IQK_SPINLOCK: _exit_critical_bh(&pHalData->IQKSpinLock, &irqL); default: break; } } #ifdef CONFIG_DFS_MASTER inline u8 rtw_odm_get_dfs_domain(_adapter *adapter) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); PDM_ODM_T pDM_Odm = &(hal_data->odmpriv); return pDM_Odm->DFS_RegionDomain; } inline VOID rtw_odm_radar_detect_reset(_adapter *adapter) { phydm_radar_detect_reset(GET_ODM(adapter)); } inline VOID rtw_odm_radar_detect_disable(_adapter *adapter) { phydm_radar_detect_disable(GET_ODM(adapter)); } /* called after ch, bw is set */ inline VOID rtw_odm_radar_detect_enable(_adapter *adapter) { phydm_radar_detect_enable(GET_ODM(adapter)); } inline BOOLEAN rtw_odm_radar_detect(_adapter *adapter) { return phydm_radar_detect(GET_ODM(adapter)); } #endif /* CONFIG_DFS_MASTER */ void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys) { #ifndef DBG_RX_PHYSTATUS_CHINFO #define DBG_RX_PHYSTATUS_CHINFO 0 #endif #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) _adapter *adapter = rframe->u.hdr.adapter; struct rx_pkt_attrib *attrib = &rframe->u.hdr.attrib; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); PDM_ODM_T pDM_Odm = &pHalData->odmpriv; u8 *wlanhdr = get_recvframe_data(rframe); if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) { /* * 8723D: * type_0(CCK) * l_rxsc * is filled with primary channel SC, not real rxsc. * 0:LSC, 1:USC * type_1(OFDM) * rf_mode * RF bandwidth when RX * l_rxsc(legacy), ht_rxsc * see below RXSC N-series * type_2(Not used) */ /* * 8821C, 8822B: * type_0(CCK) * l_rxsc * is filled with primary channel SC, not real rxsc. * 0:LSC, 1:USC * type_1(OFDM) * rf_mode * RF bandwidth when RX * l_rxsc(legacy), ht_rxsc * see below RXSC AC-series * type_2(Not used) */ if ((*phys & 0xf) == 0) { struct _Phy_Status_Rpt_Jaguar2_Type0 *phys_t0 = (struct _Phy_Status_Rpt_Jaguar2_Type0 *)phys; if (DBG_RX_PHYSTATUS_CHINFO) { RTW_PRINT("phys_t%u ta="MAC_FMT" %s, %s(band:%u, ch:%u, l_rxsc:%u)\n" , *phys & 0xf , MAC_ARG(get_ta(wlanhdr)) , is_broadcast_mac_addr(wifi_get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(wifi_get_ra(wlanhdr)) ? "MC" : "UC" , HDATA_RATE(attrib->data_rate) , phys_t0->band, phys_t0->channel, phys_t0->rxsc ); } } else if ((*phys & 0xf) == 1) { struct _Phy_Status_Rpt_Jaguar2_Type1 *phys_t1 = (struct _Phy_Status_Rpt_Jaguar2_Type1 *)phys; u8 rxsc = (attrib->data_rate > DESC_RATE11M && attrib->data_rate < DESC_RATEMCS0) ? phys_t1->l_rxsc : phys_t1->ht_rxsc; u8 pkt_cch = 0; u8 pkt_bw = CHANNEL_WIDTH_20; #if ODM_IC_11N_SERIES_SUPPORT if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { /* RXSC N-series */ #define RXSC_DUP 0 #define RXSC_LSC 1 #define RXSC_USC 2 #define RXSC_40M 3 static const s8 cch_offset_by_rxsc[4] = {0, -2, 2, 0}; if (phys_t1->rf_mode == 0) { pkt_cch = phys_t1->channel; pkt_bw = CHANNEL_WIDTH_20; } else if (phys_t1->rf_mode == 1) { if (rxsc == RXSC_LSC || rxsc == RXSC_USC) { pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; pkt_bw = CHANNEL_WIDTH_20; } else if (rxsc == RXSC_40M) { pkt_cch = phys_t1->channel; pkt_bw = CHANNEL_WIDTH_40; } } else rtw_warn_on(1); goto type1_end; } #endif /* ODM_IC_11N_SERIES_SUPPORT */ #if ODM_IC_11AC_SERIES_SUPPORT if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { /* RXSC AC-series */ #define RXSC_DUP 0 /* 0: RX from all SC of current rf_mode */ #define RXSC_LL20M_OF_160M 8 /* 1~8: RX from 20MHz SC */ #define RXSC_L20M_OF_160M 6 #define RXSC_L20M_OF_80M 4 #define RXSC_L20M_OF_40M 2 #define RXSC_U20M_OF_40M 1 #define RXSC_U20M_OF_80M 3 #define RXSC_U20M_OF_160M 5 #define RXSC_UU20M_OF_160M 7 #define RXSC_L40M_OF_160M 12 /* 9~12: RX from 40MHz SC */ #define RXSC_L40M_OF_80M 10 #define RXSC_U40M_OF_80M 9 #define RXSC_U40M_OF_160M 11 #define RXSC_L80M_OF_160M 14 /* 13~14: RX from 80MHz SC */ #define RXSC_U80M_OF_160M 13 static const s8 cch_offset_by_rxsc[15] = {0, 2, -2, 6, -6, 10, -10, 14, -14, 4, -4, 12, -12, 8, -8}; if (phys_t1->rf_mode > 3) { /* invalid rf_mode */ rtw_warn_on(1); goto type1_end; } if (phys_t1->rf_mode == 0) { /* RF 20MHz */ pkt_cch = phys_t1->channel; pkt_bw = CHANNEL_WIDTH_20; goto type1_end; } if (rxsc == 0) { /* RF and RX with same BW */ if (attrib->data_rate >= DESC_RATEMCS0) { pkt_cch = phys_t1->channel; pkt_bw = phys_t1->rf_mode; } goto type1_end; } if ((phys_t1->rf_mode == 1 && rxsc >= 1 && rxsc <= 2) /* RF 40MHz, RX 20MHz */ || (phys_t1->rf_mode == 2 && rxsc >= 1 && rxsc <= 4) /* RF 80MHz, RX 20MHz */ || (phys_t1->rf_mode == 3 && rxsc >= 1 && rxsc <= 8) /* RF 160MHz, RX 20MHz */ ) { pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; pkt_bw = CHANNEL_WIDTH_20; } else if ((phys_t1->rf_mode == 2 && rxsc >= 9 && rxsc <= 10) /* RF 80MHz, RX 40MHz */ || (phys_t1->rf_mode == 3 && rxsc >= 9 && rxsc <= 12) /* RF 160MHz, RX 40MHz */ ) { if (attrib->data_rate >= DESC_RATEMCS0) { pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; pkt_bw = CHANNEL_WIDTH_40; } } else if ((phys_t1->rf_mode == 3 && rxsc >= 13 && rxsc <= 14) /* RF 160MHz, RX 80MHz */ ) { if (attrib->data_rate >= DESC_RATEMCS0) { pkt_cch = phys_t1->channel + cch_offset_by_rxsc[rxsc]; pkt_bw = CHANNEL_WIDTH_80; } } else rtw_warn_on(1); } #endif /* ODM_IC_11AC_SERIES_SUPPORT */ type1_end: if (DBG_RX_PHYSTATUS_CHINFO) { RTW_PRINT("phys_t%u ta="MAC_FMT" %s, %s(band:%u, ch:%u, rf_mode:%u, l_rxsc:%u, ht_rxsc:%u) => %u,%u\n" , *phys & 0xf , MAC_ARG(get_ta(wlanhdr)) , is_broadcast_mac_addr(wifi_get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(wifi_get_ra(wlanhdr)) ? "MC" : "UC" , HDATA_RATE(attrib->data_rate) , phys_t1->band, phys_t1->channel, phys_t1->rf_mode, phys_t1->l_rxsc, phys_t1->ht_rxsc , pkt_cch, pkt_bw ); } /* for now, only return cneter channel of 20MHz packet */ if (pkt_cch && pkt_bw == CHANNEL_WIDTH_20) attrib->ch = pkt_cch; } else { struct _Phy_Status_Rpt_Jaguar2_Type2 *phys_t2 = (struct _Phy_Status_Rpt_Jaguar2_Type2 *)phys; if (DBG_RX_PHYSTATUS_CHINFO) { RTW_PRINT("phys_t%u ta="MAC_FMT" %s, %s(band:%u, ch:%u, l_rxsc:%u, ht_rxsc:%u)\n" , *phys & 0xf , MAC_ARG(get_ta(wlanhdr)) , is_broadcast_mac_addr(wifi_get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(wifi_get_ra(wlanhdr)) ? "MC" : "UC" , HDATA_RATE(attrib->data_rate) , phys_t2->band, phys_t2->channel, phys_t2->l_rxsc, phys_t2->ht_rxsc ); } } } #endif /* (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) */ }