| // SPDX-License-Identifier: GPL-2.0 |
| /****************************************************************************** |
| * |
| * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. |
| * |
| ******************************************************************************/ |
| |
| /* include "Mp_Precomp.h" */ |
| #include "odm_precomp.h" |
| |
| void ConfigureTxpowerTrack(struct dm_odm_t *pDM_Odm, struct txpwrtrack_cfg *pConfig) |
| { |
| ConfigureTxpowerTrack_8723B(pConfig); |
| } |
| |
| /* */ |
| /* <20121113, Kordan> This function should be called when TxAGC changed. */ |
| /* Otherwise the previous compensation is gone, because we record the */ |
| /* delta of temperature between two TxPowerTracking watch dogs. */ |
| /* */ |
| /* NOTE: If Tx BB swing or Tx scaling is varified during run-time, still */ |
| /* need to call this function. */ |
| /* */ |
| void ODM_ClearTxPowerTrackingState(struct dm_odm_t *pDM_Odm) |
| { |
| struct hal_com_data *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); |
| u8 p = 0; |
| |
| pDM_Odm->BbSwingIdxCckBase = pDM_Odm->DefaultCckIndex; |
| pDM_Odm->BbSwingIdxCck = pDM_Odm->DefaultCckIndex; |
| pDM_Odm->RFCalibrateInfo.CCK_index = 0; |
| |
| for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { |
| pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->DefaultOfdmIndex; |
| pDM_Odm->BbSwingIdxOfdm[p] = pDM_Odm->DefaultOfdmIndex; |
| pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pDM_Odm->DefaultOfdmIndex; |
| |
| pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = 0; |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] = 0; |
| pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; |
| |
| /* Initial Mix mode power tracking */ |
| pDM_Odm->Absolute_OFDMSwingIdx[p] = 0; |
| pDM_Odm->Remnant_OFDMSwingIdx[p] = 0; |
| } |
| |
| /* Initial at Modify Tx Scaling Mode */ |
| pDM_Odm->Modify_TxAGC_Flag_PathA = false; |
| /* Initial at Modify Tx Scaling Mode */ |
| pDM_Odm->Modify_TxAGC_Flag_PathB = false; |
| pDM_Odm->Remnant_CCKSwingIdx = 0; |
| pDM_Odm->RFCalibrateInfo.ThermalValue = pHalData->EEPROMThermalMeter; |
| pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = pHalData->EEPROMThermalMeter; |
| pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = pHalData->EEPROMThermalMeter; |
| } |
| |
| void ODM_TXPowerTrackingCallback_ThermalMeter(struct adapter *Adapter) |
| { |
| |
| struct hal_com_data *pHalData = GET_HAL_DATA(Adapter); |
| struct dm_odm_t *pDM_Odm = &pHalData->odmpriv; |
| |
| u8 ThermalValue = 0, delta, delta_LCK, p = 0, i = 0; |
| u8 ThermalValue_AVG_count = 0; |
| u32 ThermalValue_AVG = 0; |
| |
| u8 OFDM_min_index = 0; /* OFDM BB Swing should be less than +3.0dB, which is required by Arthur */ |
| u8 Indexforchannel = 0; /* GetRightChnlPlaceforIQK(pHalData->CurrentChannel) */ |
| |
| struct txpwrtrack_cfg c; |
| |
| |
| /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */ |
| u8 *deltaSwingTableIdx_TUP_A; |
| u8 *deltaSwingTableIdx_TDOWN_A; |
| u8 *deltaSwingTableIdx_TUP_B; |
| u8 *deltaSwingTableIdx_TDOWN_B; |
| |
| /* 4 2. Initialization (7 steps in total) */ |
| |
| ConfigureTxpowerTrack(pDM_Odm, &c); |
| |
| (*c.GetDeltaSwingTable)( |
| pDM_Odm, |
| (u8 **)&deltaSwingTableIdx_TUP_A, |
| (u8 **)&deltaSwingTableIdx_TDOWN_A, |
| (u8 **)&deltaSwingTableIdx_TUP_B, |
| (u8 **)&deltaSwingTableIdx_TDOWN_B |
| ); |
| |
| /* cosa add for debug */ |
| pDM_Odm->RFCalibrateInfo.TXPowerTrackingCallbackCnt++; |
| pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = true; |
| |
| ThermalValue = (u8)PHY_QueryRFReg(pDM_Odm->Adapter, RF_PATH_A, c.ThermalRegAddr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ |
| if ( |
| !pDM_Odm->RFCalibrateInfo.TxPowerTrackControl || |
| pHalData->EEPROMThermalMeter == 0 || |
| pHalData->EEPROMThermalMeter == 0xFF |
| ) |
| return; |
| |
| /* 4 3. Initialize ThermalValues of RFCalibrateInfo */ |
| |
| /* 4 4. Calculate average thermal meter */ |
| |
| pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; |
| pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; |
| if (pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) /* Average times = c.AverageThermalNum */ |
| pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; |
| |
| for (i = 0; i < c.AverageThermalNum; i++) { |
| if (pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) { |
| ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; |
| ThermalValue_AVG_count++; |
| } |
| } |
| |
| /* Calculate Average ThermalValue after average enough times */ |
| if (ThermalValue_AVG_count) { |
| ThermalValue = (u8)(ThermalValue_AVG / ThermalValue_AVG_count); |
| } |
| |
| /* 4 5. Calculate delta, delta_LCK */ |
| /* delta" here is used to determine whether thermal value changes or not. */ |
| delta = |
| (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue) ? |
| (ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue) : |
| (pDM_Odm->RFCalibrateInfo.ThermalValue - ThermalValue); |
| delta_LCK = |
| (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_LCK) ? |
| (ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK) : |
| (pDM_Odm->RFCalibrateInfo.ThermalValue_LCK - ThermalValue); |
| |
| /* 4 6. If necessary, do LCK. */ |
| /* Delta temperature is equal to or larger than 20 centigrade. */ |
| if (delta_LCK >= c.Threshold_IQK) { |
| pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; |
| if (c.PHY_LCCalibrate) |
| (*c.PHY_LCCalibrate)(pDM_Odm); |
| } |
| |
| /* 3 7. If necessary, move the index of swing table to adjust Tx power. */ |
| if (delta > 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) { |
| /* delta" here is used to record the absolute value of difference. */ |
| delta = |
| ThermalValue > pHalData->EEPROMThermalMeter ? |
| (ThermalValue - pHalData->EEPROMThermalMeter) : |
| (pHalData->EEPROMThermalMeter - ThermalValue); |
| |
| if (delta >= TXPWR_TRACK_TABLE_SIZE) |
| delta = TXPWR_TRACK_TABLE_SIZE - 1; |
| |
| /* 4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset */ |
| if (ThermalValue > pHalData->EEPROMThermalMeter) { |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[RF_PATH_A] = |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[RF_PATH_A]; |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[RF_PATH_A] = |
| deltaSwingTableIdx_TUP_A[delta]; |
| |
| /* Record delta swing for mix mode power tracking */ |
| pDM_Odm->Absolute_OFDMSwingIdx[RF_PATH_A] = |
| deltaSwingTableIdx_TUP_A[delta]; |
| |
| if (c.RfPathCount > 1) { |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[RF_PATH_B] = |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[RF_PATH_B]; |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[RF_PATH_B] = |
| deltaSwingTableIdx_TUP_B[delta]; |
| |
| /* Record delta swing for mix mode power tracking */ |
| pDM_Odm->Absolute_OFDMSwingIdx[RF_PATH_B] = |
| deltaSwingTableIdx_TUP_B[delta]; |
| } |
| |
| } else { |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[RF_PATH_A] = |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[RF_PATH_A]; |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[RF_PATH_A] = |
| -1 * deltaSwingTableIdx_TDOWN_A[delta]; |
| |
| /* Record delta swing for mix mode power tracking */ |
| pDM_Odm->Absolute_OFDMSwingIdx[RF_PATH_A] = |
| -1 * deltaSwingTableIdx_TDOWN_A[delta]; |
| |
| if (c.RfPathCount > 1) { |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[RF_PATH_B] = |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[RF_PATH_B]; |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[RF_PATH_B] = |
| -1 * deltaSwingTableIdx_TDOWN_B[delta]; |
| |
| /* Record delta swing for mix mode power tracking */ |
| pDM_Odm->Absolute_OFDMSwingIdx[RF_PATH_B] = |
| -1 * deltaSwingTableIdx_TDOWN_B[delta]; |
| } |
| } |
| |
| for (p = RF_PATH_A; p < c.RfPathCount; p++) { |
| if ( |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] == |
| pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] |
| ) /* If Thermal value changes but lookup table value still the same */ |
| pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; |
| else |
| pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p]; /* Power Index Diff between 2 times Power Tracking */ |
| |
| pDM_Odm->RFCalibrateInfo.OFDM_index[p] = |
| pDM_Odm->BbSwingIdxOfdmBase[p] + |
| pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p]; |
| |
| pDM_Odm->RFCalibrateInfo.CCK_index = |
| pDM_Odm->BbSwingIdxCckBase + |
| pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p]; |
| |
| pDM_Odm->BbSwingIdxCck = |
| pDM_Odm->RFCalibrateInfo.CCK_index; |
| |
| pDM_Odm->BbSwingIdxOfdm[p] = |
| pDM_Odm->RFCalibrateInfo.OFDM_index[p]; |
| |
| /* 4 7.1 Handle boundary conditions of index. */ |
| if (pDM_Odm->RFCalibrateInfo.OFDM_index[p] > c.SwingTableSize_OFDM-1) |
| pDM_Odm->RFCalibrateInfo.OFDM_index[p] = c.SwingTableSize_OFDM-1; |
| else if (pDM_Odm->RFCalibrateInfo.OFDM_index[p] < OFDM_min_index) |
| pDM_Odm->RFCalibrateInfo.OFDM_index[p] = OFDM_min_index; |
| } |
| if (pDM_Odm->RFCalibrateInfo.CCK_index > c.SwingTableSize_CCK-1) |
| pDM_Odm->RFCalibrateInfo.CCK_index = c.SwingTableSize_CCK-1; |
| /* else if (pDM_Odm->RFCalibrateInfo.CCK_index < 0) */ |
| /* pDM_Odm->RFCalibrateInfo.CCK_index = 0; */ |
| } else { |
| for (p = RF_PATH_A; p < c.RfPathCount; p++) |
| pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0; |
| } |
| |
| /* Print Swing base & current */ |
| for (p = RF_PATH_A; p < c.RfPathCount; p++) { |
| } |
| |
| if ( |
| (pDM_Odm->RFCalibrateInfo.PowerIndexOffset[RF_PATH_A] != 0 || |
| pDM_Odm->RFCalibrateInfo.PowerIndexOffset[RF_PATH_B] != 0) && |
| pDM_Odm->RFCalibrateInfo.TxPowerTrackControl |
| ) { |
| /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ |
| |
| pDM_Odm->RFCalibrateInfo.bTxPowerChanged = true; /* Always true after Tx Power is adjusted by power tracking. */ |
| /* */ |
| /* 2012/04/23 MH According to Luke's suggestion, we can not write BB digital */ |
| /* to increase TX power. Otherwise, EVM will be bad. */ |
| /* */ |
| /* 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. */ |
| |
| if (ThermalValue > pHalData->EEPROMThermalMeter) { |
| for (p = RF_PATH_A; p < c.RfPathCount; p++) |
| (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); |
| } else { |
| for (p = RF_PATH_A; p < c.RfPathCount; p++) |
| (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); |
| } |
| |
| /* Record last time Power Tracking result as base. */ |
| pDM_Odm->BbSwingIdxCckBase = pDM_Odm->BbSwingIdxCck; |
| for (p = RF_PATH_A; p < c.RfPathCount; p++) |
| pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->BbSwingIdxOfdm[p]; |
| |
| /* Record last Power Tracking Thermal Value */ |
| pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; |
| } |
| |
| pDM_Odm->RFCalibrateInfo.TXPowercount = 0; |
| } |