// 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;
}