/****************************************************************************** * * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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. * *****************************************************************************/ #include #include u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); struct dm_struct *podmpriv = &pHalData->odmpriv; u32 result = 0; switch (ops) { case HAL_PHYDM_DIS_ALL_FUNC: podmpriv->support_ability = DYNAMIC_FUNC_DISABLE; halrf_cmn_info_set(podmpriv, HALRF_CMNINFO_ABILITY, DYNAMIC_FUNC_DISABLE); break; case HAL_PHYDM_FUNC_SET: podmpriv->support_ability |= ability; break; case HAL_PHYDM_FUNC_CLR: podmpriv->support_ability &= ~(ability); break; case HAL_PHYDM_ABILITY_BK: /* dm flag backup*/ podmpriv->bk_support_ability = podmpriv->support_ability; pHalData->bk_rf_ability = halrf_cmn_info_get(podmpriv, HALRF_CMNINFO_ABILITY); break; case HAL_PHYDM_ABILITY_RESTORE: /* restore dm flag */ podmpriv->support_ability = podmpriv->bk_support_ability; halrf_cmn_info_set(podmpriv, HALRF_CMNINFO_ABILITY, pHalData->bk_rf_ability); break; case HAL_PHYDM_ABILITY_SET: podmpriv->support_ability = ability; break; case HAL_PHYDM_ABILITY_GET: result = podmpriv->support_ability; break; } return result; } /* set ODM_CMNINFO_IC_TYPE based on chip_type */ void rtw_odm_init_ic_type(_adapter *adapter) { struct dm_struct *odm = adapter_to_phydm(adapter); u32 ic_type = chip_type_to_odm_ic_type(rtw_get_chip_type(adapter)); rtw_warn_on(!ic_type); odm_cmn_info_init(odm, ODM_CMNINFO_IC_TYPE, ic_type); } 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; 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"); } 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); } bool rtw_odm_adaptivity_needed(_adapter *adapter) { struct registry_priv *regsty = &adapter->registrypriv; 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) { struct dm_struct *odm = adapter_to_phydm(adapter); rtw_odm_adaptivity_config_msg(sel, adapter); RTW_PRINT_SEL(sel, "%10s %16s\n" , "th_l2h_ini", "th_edcca_hl_diff"); RTW_PRINT_SEL(sel, "0x%-8x %-16d\n" , (u8)odm->th_l2h_ini , odm->th_edcca_hl_diff ); } void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 th_l2h_ini, s8 th_edcca_hl_diff) { struct dm_struct *odm = adapter_to_phydm(adapter); odm->th_l2h_ini = th_l2h_ini; odm->th_edcca_hl_diff = th_edcca_hl_diff; } void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter) { struct dm_struct *odm = adapter_to_phydm(adapter); RTW_PRINT_SEL(sel, "rx_rate = %s, rssi_a = %d(%%), rssi_b = %d(%%)\n", HDATA_RATE(odm->rx_rate), odm->rssi_a, odm->rssi_b); } void rtw_odm_acquirespinlock(_adapter *adapter, enum 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, enum 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; } } inline u8 rtw_odm_get_dfs_domain(struct dvobj_priv *dvobj) { #ifdef CONFIG_DFS_MASTER struct dm_struct *pDM_Odm = dvobj_to_phydm(dvobj); return pDM_Odm->dfs_region_domain; #else return PHYDM_DFS_DOMAIN_UNKNOWN; #endif } inline u8 rtw_odm_dfs_domain_unknown(struct dvobj_priv *dvobj) { #ifdef CONFIG_DFS_MASTER return rtw_odm_get_dfs_domain(dvobj) == PHYDM_DFS_DOMAIN_UNKNOWN; #else return 1; #endif } #ifdef CONFIG_DFS_MASTER inline void rtw_odm_radar_detect_reset(_adapter *adapter) { phydm_radar_detect_reset(adapter_to_phydm(adapter)); } inline void rtw_odm_radar_detect_disable(_adapter *adapter) { phydm_radar_detect_disable(adapter_to_phydm(adapter)); } /* called after ch, bw is set */ inline void rtw_odm_radar_detect_enable(_adapter *adapter) { phydm_radar_detect_enable(adapter_to_phydm(adapter)); } inline BOOLEAN rtw_odm_radar_detect(_adapter *adapter) { return phydm_radar_detect(adapter_to_phydm(adapter)); } inline u8 rtw_odm_radar_detect_polling_int_ms(struct dvobj_priv *dvobj) { return phydm_dfs_polling_time(dvobj_to_phydm(dvobj)); } #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 dm_struct *phydm = adapter_to_phydm(adapter); struct rx_pkt_attrib *attrib = &rframe->u.hdr.attrib; u8 *wlanhdr = get_recvframe_data(rframe); if (phydm->support_ic_type & PHYSTS_2ND_TYPE_IC) { /* * 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_sts_rpt_jgr2_type0 *phys_t0 = (struct phy_sts_rpt_jgr2_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(get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(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_sts_rpt_jgr2_type1 *phys_t1 = (struct phy_sts_rpt_jgr2_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 (phydm->support_ic_type & 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 (phydm->support_ic_type & 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 == 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(get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(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_sts_rpt_jgr2_type2 *phys_t2 = (struct phy_sts_rpt_jgr2_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(get_ra(wlanhdr)) ? "BC" : is_multicast_mac_addr(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) */ } #if defined(CONFIG_RTL8822C) && defined(CONFIG_LPS_PG) void debug_DACK( struct dm_struct *dm ) { //P_PHYDM_FUNC dm; //dm = &(SysMib.ODM.Phydm); //PIQK_OFFLOAD_PARM pIQK_info; //pIQK_info= &(SysMib.ODM.IQKParm); u8 i; u32 temp1, temp2, temp3; temp1 = odm_get_bb_reg(dm, 0x1860, bMaskDWord); temp2 = odm_get_bb_reg(dm, 0x4160, bMaskDWord); temp3 = odm_get_bb_reg(dm, 0x9b4, bMaskDWord); odm_set_bb_reg(dm, 0x9b4, bMaskDWord, 0xdb66db00); //pathA odm_set_bb_reg(dm, 0x1830, BIT(30), 0x0); odm_set_bb_reg(dm, 0x1860, 0xfc000000, 0x3c); RTW_INFO("path A i\n"); //i for (i = 0; i < 0xf; i++) { odm_set_bb_reg(dm, 0x18b0, 0xf0000000, i); RTW_INFO("[0][0][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x2810,0x7fc0000)); //pIQK_info->msbk_d[0][0][i] = (u16)odm_get_bb_reg(dm,0x2810,0x7fc0000); } RTW_INFO("path A q\n"); //q for (i = 0; i < 0xf; i++) { odm_set_bb_reg(dm, 0x18cc, 0xf0000000, i); RTW_INFO("[0][1][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x283c,0x7fc0000)); //pIQK_info->msbk_d[0][1][i] = (u16)odm_get_bb_reg(dm,0x283c,0x7fc0000); } //pathB odm_set_bb_reg(dm, 0x4130, BIT(30), 0x0); odm_set_bb_reg(dm, 0x4160, 0xfc000000, 0x3c); RTW_INFO("\npath B i\n"); //i for (i = 0; i < 0xf; i++) { odm_set_bb_reg(dm, 0x41b0, 0xf0000000, i); RTW_INFO("[1][0][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x4510,0x7fc0000)); //pIQK_info->msbk_d[1][0][i] = (u16)odm_get_bb_reg(dm,0x2810,0x7fc0000); } RTW_INFO("path B q\n"); //q for (i = 0; i < 0xf; i++) { odm_set_bb_reg(dm, 0x41cc, 0xf0000000, i); RTW_INFO("[1][1][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x453c,0x7fc0000)); //pIQK_info->msbk_d[1][1][i] = (u16)odm_get_bb_reg(dm,0x283c,0x7fc0000); } //restore to normal odm_set_bb_reg(dm, 0x1830, BIT(30), 0x1); odm_set_bb_reg(dm, 0x4130, BIT(30), 0x1); odm_set_bb_reg(dm, 0x1860, bMaskDWord, temp1); odm_set_bb_reg(dm, 0x4160, bMaskDWord, temp2); odm_set_bb_reg(dm, 0x9b4, bMaskDWord, temp3); } void debug_IQK( struct dm_struct *dm, IN u8 idx, IN u8 path ) { u8 i, ch; u32 tmp; u32 bit_mask_20_16 = BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16); RTW_INFO("idx = %d, path = %d\n", idx, path); odm_set_bb_reg(dm, 0x1b00, MASKDWORD, 0x8 | path << 1); if (idx == TX_IQK) {//TXCFIR odm_set_bb_reg(dm, R_0x1b20, BIT(31) | BIT(30), 0x3); } else {//RXCFIR odm_set_bb_reg(dm, R_0x1b20, BIT(31) | BIT(30), 0x1); } odm_set_bb_reg(dm, R_0x1bd4, BIT(21), 0x1); odm_set_bb_reg(dm, R_0x1bd4, bit_mask_20_16, 0x10); for (i = 0; i <= 16; i++) { odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0xe0000001 | i << 2); tmp = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); RTW_INFO("iqk_cfir_real[%d][%d][%d] = 0x%x\n", path, idx, i, ((tmp & 0x0fff0000) >> 16)); //iqk_info->iqk_cfir_real[ch][path][idx][i] = // (tmp & 0x0fff0000) >> 16; RTW_INFO("iqk_cfir_imag[%d][%d][%d] = 0x%x\n", path, idx, i, (tmp & 0x0fff)); //iqk_info->iqk_cfir_imag[ch][path][idx][i] = tmp & 0x0fff; } odm_set_bb_reg(dm, R_0x1b20, BIT(31) | BIT(30), 0x0); //odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0x0); } __odm_func__ void debug_information_8822c( struct dm_struct *dm) { struct dm_dpk_info *dpk_info = &dm->dpk_info; u32 reg_rf18; if (odm_get_bb_reg(dm, R_0x1e7c, BIT(30))) dpk_info->is_tssi_mode = true; else dpk_info->is_tssi_mode = false; reg_rf18 = odm_get_rf_reg(dm, RF_PATH_A, RF_0x18, RFREG_MASK); dpk_info->dpk_band = (u8)((reg_rf18 & BIT(16)) >> 16); /*0/1:G/A*/ dpk_info->dpk_ch = (u8)reg_rf18 & 0xff; dpk_info->dpk_bw = (u8)((reg_rf18 & 0x3000) >> 12); /*3/2/1:20/40/80*/ RTW_INFO("[DPK] TSSI/ Band/ CH/ BW = %d / %s / %d / %s\n", dpk_info->is_tssi_mode, dpk_info->dpk_band == 0 ? "2G" : "5G", dpk_info->dpk_ch, dpk_info->dpk_bw == 3 ? "20M" : (dpk_info->dpk_bw == 2 ? "40M" : "80M")); } extern void _dpk_get_coef_8822c(void *dm_void, u8 path); __odm_func__ void debug_reload_data_8822c( void *dm_void) { struct dm_struct *dm = (struct dm_struct *)dm_void; struct dm_dpk_info *dpk_info = &dm->dpk_info; u8 path; u32 u32tmp; debug_information_8822c(dm); for (path = 0; path < DPK_RF_PATH_NUM_8822C; path++) { RTW_INFO("[DPK] Reload path: 0x%x\n", path); odm_set_bb_reg(dm, R_0x1b00, MASKDWORD, 0x8 | (path << 1)); /*txagc bnd*/ if (dpk_info->dpk_band == 0x0) u32tmp = odm_get_bb_reg(dm, R_0x1b60, MASKDWORD); else u32tmp = odm_get_bb_reg(dm, R_0x1b60, MASKDWORD); RTW_INFO("[DPK] txagc bnd = 0x%08x\n", u32tmp); u32tmp = odm_get_bb_reg(dm, R_0x1b64, MASKBYTE3); RTW_INFO("[DPK] dpk_txagc = 0x%08x\n", u32tmp); //debug_coef_write_8822c(dm, path, dpk_info->dpk_path_ok & BIT(path) >> path); _dpk_get_coef_8822c(dm, path); //debug_one_shot_8822c(dm, path, DPK_ON); odm_set_bb_reg(dm, R_0x1b00, 0x0000000f, 0xc); if (path == RF_PATH_A) u32tmp = odm_get_bb_reg(dm, R_0x1b04, 0x0fffffff); else u32tmp = odm_get_bb_reg(dm, R_0x1b5c, 0x0fffffff); RTW_INFO("[DPK] dpk_gs = 0x%08x\n", u32tmp); } } void odm_lps_pg_debug_8822c(void *dm_void) { struct dm_struct *dm = (struct dm_struct *)dm_void; debug_DACK(dm); debug_IQK(dm, TX_IQK, RF_PATH_A); debug_IQK(dm, RX_IQK, RF_PATH_A); debug_IQK(dm, TX_IQK, RF_PATH_B); debug_IQK(dm, RX_IQK, RF_PATH_B); debug_reload_data_8822c(dm); } #endif /* defined(CONFIG_RTL8822C) && defined(CONFIG_LPS_PG) */