// SPDX-License-Identifier: GPL-2.0
/******************************************************************************
 *
 * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
 *
 ******************************************************************************/

#include "odm_precomp.h"

/*  Global var */

u32 OFDMSwingTable_New[OFDM_TABLE_SIZE] = {
        0x0b40002d, /*  0,  -15.0dB */
        0x0c000030, /*  1,  -14.5dB */
        0x0cc00033, /*  2,  -14.0dB */
        0x0d800036, /*  3,  -13.5dB */
        0x0e400039, /*  4,  -13.0dB */
        0x0f00003c, /*  5,  -12.5dB */
        0x10000040, /*  6,  -12.0dB */
        0x11000044, /*  7,  -11.5dB */
        0x12000048, /*  8,  -11.0dB */
        0x1300004c, /*  9,  -10.5dB */
        0x14400051, /*  10, -10.0dB */
        0x15800056, /*  11, -9.5dB */
        0x16c0005b, /*  12, -9.0dB */
        0x18000060, /*  13, -8.5dB */
        0x19800066, /*  14, -8.0dB */
        0x1b00006c, /*  15, -7.5dB */
        0x1c800072, /*  16, -7.0dB */
        0x1e400079, /*  17, -6.5dB */
        0x20000080, /*  18, -6.0dB */
        0x22000088, /*  19, -5.5dB */
        0x24000090, /*  20, -5.0dB */
        0x26000098, /*  21, -4.5dB */
        0x288000a2, /*  22, -4.0dB */
        0x2ac000ab, /*  23, -3.5dB */
        0x2d4000b5, /*  24, -3.0dB */
        0x300000c0, /*  25, -2.5dB */
        0x32c000cb, /*  26, -2.0dB */
        0x35c000d7, /*  27, -1.5dB */
        0x390000e4, /*  28, -1.0dB */
        0x3c8000f2, /*  29, -0.5dB */
        0x40000100, /*  30, +0dB */
        0x43c0010f, /*  31, +0.5dB */
        0x47c0011f, /*  32, +1.0dB */
        0x4c000130, /*  33, +1.5dB */
        0x50800142, /*  34, +2.0dB */
        0x55400155, /*  35, +2.5dB */
        0x5a400169, /*  36, +3.0dB */
        0x5fc0017f, /*  37, +3.5dB */
        0x65400195, /*  38, +4.0dB */
        0x6b8001ae, /*  39, +4.5dB */
        0x71c001c7, /*  40, +5.0dB */
        0x788001e2, /*  41, +5.5dB */
        0x7f8001fe  /*  42, +6.0dB */
};

u8 CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = {
        {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, /*   0, -16.0dB */
        {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /*   1, -15.5dB */
        {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /*   2, -15.0dB */
        {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /*   3, -14.5dB */
        {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /*   4, -14.0dB */
        {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /*   5, -13.5dB */
        {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /*   6, -13.0dB */
        {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /*   7, -12.5dB */
        {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /*   8, -12.0dB */
        {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /*   9, -11.5dB */
        {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /*  10, -11.0dB */
        {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /*  11, -10.5dB */
        {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /*  12, -10.0dB */
        {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /*  13, -9.5dB */
        {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /*  14, -9.0dB */
        {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /*  15, -8.5dB */
        {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /*  16, -8.0dB */
        {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /*  17, -7.5dB */
        {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /*  18, -7.0dB */
        {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /*  19, -6.5dB */
        {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /*  20, -6.0dB */
        {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /*  21, -5.5dB */
        {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /*  22, -5.0dB */
        {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /*  23, -4.5dB */
        {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /*  24, -4.0dB */
        {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /*  25, -3.5dB */
        {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /*  26, -3.0dB */
        {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /*  27, -2.5dB */
        {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /*  28, -2.0dB */
        {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /*  29, -1.5dB */
        {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /*  30, -1.0dB */
        {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /*  31, -0.5dB */
        {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}        /*  32, +0dB */
};

u8 CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8] = {
        {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, /*   0, -16.0dB */
        {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /*   1, -15.5dB */
        {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /*   2, -15.0dB */
        {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /*   3, -14.5dB */
        {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /*   4, -14.0dB */
        {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /*   5, -13.5dB */
        {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /*   6, -13.0dB */
        {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /*   7, -12.5dB */
        {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /*   8, -12.0dB */
        {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /*   9, -11.5dB */
        {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /*  10, -11.0dB */
        {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /*  11, -10.5dB */
        {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /*  12, -10.0dB */
        {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /*  13, -9.5dB */
        {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /*  14, -9.0dB */
        {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /*  15, -8.5dB */
        {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /*  16, -8.0dB */
        {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /*  17, -7.5dB */
        {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /*  18, -7.0dB */
        {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /*  19, -6.5dB */
        {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /*  20, -6.0dB */
        {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /*  21, -5.5dB */
        {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /*  22, -5.0dB */
        {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /*  23, -4.5dB */
        {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /*  24, -4.0dB */
        {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /*  25, -3.5dB */
        {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /*  26, -3.0dB */
        {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /*  27, -2.5dB */
        {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /*  28, -2.0dB */
        {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /*  29, -1.5dB */
        {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /*  30, -1.0dB */
        {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /*  31, -0.5dB */
        {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}        /*  32, +0dB */
};

/* Remove Edca by Yu Chen */

static void odm_CommonInfoSelfInit(struct dm_odm_t *pDM_Odm)
{
        pDM_Odm->bCckHighPower = (bool) PHY_QueryBBReg(pDM_Odm->Adapter, ODM_REG(CCK_RPT_FORMAT, pDM_Odm), ODM_BIT(CCK_RPT_FORMAT, pDM_Odm));
        pDM_Odm->RFPathRxEnable = (u8) PHY_QueryBBReg(pDM_Odm->Adapter, ODM_REG(BB_RX_PATH, pDM_Odm), ODM_BIT(BB_RX_PATH, pDM_Odm));

        pDM_Odm->TxRate = 0xFF;
}

static void odm_CommonInfoSelfUpdate(struct dm_odm_t *pDM_Odm)
{
        u8 EntryCnt = 0;
        u8 i;
        PSTA_INFO_T     pEntry;

        if (*(pDM_Odm->pBandWidth) == ODM_BW40M) {
                if (*(pDM_Odm->pSecChOffset) == 1)
                        pDM_Odm->ControlChannel = *(pDM_Odm->pChannel)-2;
                else if (*(pDM_Odm->pSecChOffset) == 2)
                        pDM_Odm->ControlChannel = *(pDM_Odm->pChannel)+2;
        } else
                pDM_Odm->ControlChannel = *(pDM_Odm->pChannel);

        for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
                pEntry = pDM_Odm->pODM_StaInfo[i];
                if (IS_STA_VALID(pEntry))
                        EntryCnt++;
        }

        if (EntryCnt == 1)
                pDM_Odm->bOneEntryOnly = true;
        else
                pDM_Odm->bOneEntryOnly = false;
}

/* 3 ============================================================ */
/* 3 RATR MASK */
/* 3 ============================================================ */
/* 3 ============================================================ */
/* 3 Rate Adaptive */
/* 3 ============================================================ */

static void odm_RateAdaptiveMaskInit(struct dm_odm_t *pDM_Odm)
{
        struct odm_rate_adaptive *pOdmRA = &pDM_Odm->RateAdaptive;

        pOdmRA->Type = DM_Type_ByDriver;
        if (pOdmRA->Type == DM_Type_ByDriver)
                pDM_Odm->bUseRAMask = true;
        else
                pDM_Odm->bUseRAMask = false;

        pOdmRA->RATRState = DM_RATR_STA_INIT;
        pOdmRA->LdpcThres = 35;
        pOdmRA->bUseLdpc = false;
        pOdmRA->HighRSSIThresh = 50;
        pOdmRA->LowRSSIThresh = 20;
}

u32 ODM_Get_Rate_Bitmap(
        struct dm_odm_t *pDM_Odm,
        u32 macid,
        u32 ra_mask,
        u8 rssi_level
)
{
        PSTA_INFO_T     pEntry;
        u32 rate_bitmap = 0;
        u8 WirelessMode;

        pEntry = pDM_Odm->pODM_StaInfo[macid];
        if (!IS_STA_VALID(pEntry))
                return ra_mask;

        WirelessMode = pEntry->wireless_mode;

        switch (WirelessMode) {
        case ODM_WM_B:
                if (ra_mask & 0x0000000c)               /* 11M or 5.5M enable */
                        rate_bitmap = 0x0000000d;
                else
                        rate_bitmap = 0x0000000f;
                break;

        case (ODM_WM_G):
                if (rssi_level == DM_RATR_STA_HIGH)
                        rate_bitmap = 0x00000f00;
                else
                        rate_bitmap = 0x00000ff0;
                break;

        case (ODM_WM_B|ODM_WM_G):
                if (rssi_level == DM_RATR_STA_HIGH)
                        rate_bitmap = 0x00000f00;
                else if (rssi_level == DM_RATR_STA_MIDDLE)
                        rate_bitmap = 0x00000ff0;
                else
                        rate_bitmap = 0x00000ff5;
                break;

        case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G):
        case (ODM_WM_B|ODM_WM_N24G):
        case (ODM_WM_G|ODM_WM_N24G):
                if (rssi_level == DM_RATR_STA_HIGH)
                        rate_bitmap = 0x000f0000;
                else if (rssi_level == DM_RATR_STA_MIDDLE)
                        rate_bitmap = 0x000ff000;
                else {
                        if (*(pDM_Odm->pBandWidth) == ODM_BW40M)
                                rate_bitmap = 0x000ff015;
                        else
                                rate_bitmap = 0x000ff005;
                }
                break;

        default:
                rate_bitmap = 0x0fffffff;
                break;
        }

        return ra_mask & rate_bitmap;

}

static void odm_RefreshRateAdaptiveMaskCE(struct dm_odm_t *pDM_Odm)
{
        u8 i;
        struct adapter *padapter =  pDM_Odm->Adapter;

        if (padapter->bDriverStopped)
                return;

        if (!pDM_Odm->bUseRAMask)
                return;

        for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
                PSTA_INFO_T pstat = pDM_Odm->pODM_StaInfo[i];

                if (IS_STA_VALID(pstat)) {
                        if (is_multicast_ether_addr(pstat->hwaddr))  /* if (psta->mac_id == 1) */
                                continue;

                        if (true == ODM_RAStateCheck(pDM_Odm, pstat->rssi_stat.UndecoratedSmoothedPWDB, false, &pstat->rssi_level)) {
                                rtw_hal_update_ra_mask(pstat, pstat->rssi_level);
                        }

                }
        }
}

/*-----------------------------------------------------------------------------
* Function:     odm_RefreshRateAdaptiveMask()
*
* Overview:     Update rate table mask according to rssi
*
* Input:                NONE
*
* Output:               NONE
*
* Return:               NONE
*
* Revised History:
*When           Who             Remark
*05/27/2009     hpfan   Create Version 0.
*
* --------------------------------------------------------------------------
*/
static void odm_RefreshRateAdaptiveMask(struct dm_odm_t *pDM_Odm)
{

        if (!(pDM_Odm->SupportAbility & ODM_BB_RA_MASK))
                return;

        odm_RefreshRateAdaptiveMaskCE(pDM_Odm);
}

/*  Return Value: bool */
/*  - true: RATRState is changed. */
bool ODM_RAStateCheck(
        struct dm_odm_t *pDM_Odm,
        s32 RSSI,
        bool bForceUpdate,
        u8 *pRATRState
)
{
        struct odm_rate_adaptive *pRA = &pDM_Odm->RateAdaptive;
        const u8 GoUpGap = 5;
        u8 HighRSSIThreshForRA = pRA->HighRSSIThresh;
        u8 LowRSSIThreshForRA = pRA->LowRSSIThresh;
        u8 RATRState;

        /*  Threshold Adjustment: */
        /*  when RSSI state trends to go up one or two levels, make sure RSSI is high enough. */
        /*  Here GoUpGap is added to solve the boundary's level alternation issue. */
        switch (*pRATRState) {
        case DM_RATR_STA_INIT:
        case DM_RATR_STA_HIGH:
                break;

        case DM_RATR_STA_MIDDLE:
                HighRSSIThreshForRA += GoUpGap;
                break;

        case DM_RATR_STA_LOW:
                HighRSSIThreshForRA += GoUpGap;
                LowRSSIThreshForRA += GoUpGap;
                break;

        default:
                netdev_dbg(pDM_Odm->Adapter->pnetdev,
                           "wrong rssi level setting %d !", *pRATRState);
                break;
        }

        /*  Decide RATRState by RSSI. */
        if (RSSI > HighRSSIThreshForRA)
                RATRState = DM_RATR_STA_HIGH;
        else if (RSSI > LowRSSIThreshForRA)
                RATRState = DM_RATR_STA_MIDDLE;
        else
                RATRState = DM_RATR_STA_LOW;

        if (*pRATRState != RATRState || bForceUpdate) {
                *pRATRState = RATRState;
                return true;
        }

        return false;
}

/*  */

/* 3 ============================================================ */
/* 3 RSSI Monitor */
/* 3 ============================================================ */

static void odm_RSSIMonitorInit(struct dm_odm_t *pDM_Odm)
{
        struct ra_t *pRA_Table = &pDM_Odm->DM_RA_Table;

        pRA_Table->firstconnect = false;

}

static void FindMinimumRSSI(struct adapter *padapter)
{
        struct hal_com_data     *pHalData = GET_HAL_DATA(padapter);
        struct dm_priv *pdmpriv = &pHalData->dmpriv;
        struct dm_odm_t *pDM_Odm = &pHalData->odmpriv;

        /* 1 1.Determine the minimum RSSI */

        if (
                (pDM_Odm->bLinked != true) &&
                (pdmpriv->EntryMinUndecoratedSmoothedPWDB == 0)
        ) {
                pdmpriv->MinUndecoratedPWDBForDM = 0;
        } else
                pdmpriv->MinUndecoratedPWDBForDM = pdmpriv->EntryMinUndecoratedSmoothedPWDB;
}

static void odm_RSSIMonitorCheckCE(struct dm_odm_t *pDM_Odm)
{
        struct adapter *Adapter = pDM_Odm->Adapter;
        struct hal_com_data     *pHalData = GET_HAL_DATA(Adapter);
        struct dm_priv *pdmpriv = &pHalData->dmpriv;
        int i;
        int tmpEntryMaxPWDB = 0, tmpEntryMinPWDB = 0xff;
        u8 sta_cnt = 0;
        u32 PWDB_rssi[NUM_STA] = {0};/* 0~15]:MACID, [16~31]:PWDB_rssi */
        struct ra_t *pRA_Table = &pDM_Odm->DM_RA_Table;

        if (pDM_Odm->bLinked != true)
                return;

        pRA_Table->firstconnect = pDM_Odm->bLinked;

        /* if (check_fwstate(&Adapter->mlmepriv, WIFI_AP_STATE|WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE) == true) */
        {
                struct sta_info *psta;

                for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) {
                        psta = pDM_Odm->pODM_StaInfo[i];
                        if (IS_STA_VALID(psta)) {
                                if (is_multicast_ether_addr(psta->hwaddr))  /* if (psta->mac_id == 1) */
                                        continue;

                                if (psta->rssi_stat.UndecoratedSmoothedPWDB == (-1))
                                        continue;

                                if (psta->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB)
                                        tmpEntryMinPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB;

                                if (psta->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB)
                                        tmpEntryMaxPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB;

                                if (psta->rssi_stat.UndecoratedSmoothedPWDB != (-1))
                                        PWDB_rssi[sta_cnt++] = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB<<16));
                        }
                }

                for (i = 0; i < sta_cnt; i++) {
                        if (PWDB_rssi[i] != (0)) {
                                if (pHalData->fw_ractrl == true)/*  Report every sta's RSSI to FW */
                                        rtl8723b_set_rssi_cmd(Adapter, (u8 *)(&PWDB_rssi[i]));
                        }
                }
        }



        if (tmpEntryMaxPWDB != 0)       /*  If associated entry is found */
                pdmpriv->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB;
        else
                pdmpriv->EntryMaxUndecoratedSmoothedPWDB = 0;

        if (tmpEntryMinPWDB != 0xff) /*  If associated entry is found */
                pdmpriv->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB;
        else
                pdmpriv->EntryMinUndecoratedSmoothedPWDB = 0;

        FindMinimumRSSI(Adapter);/* get pdmpriv->MinUndecoratedPWDBForDM */

        pDM_Odm->RSSI_Min = pdmpriv->MinUndecoratedPWDBForDM;
        /* ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); */
}

static void odm_RSSIMonitorCheck(struct dm_odm_t *pDM_Odm)
{
        if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR))
                return;

        odm_RSSIMonitorCheckCE(pDM_Odm);

}       /*  odm_RSSIMonitorCheck */

/* 3 ============================================================ */
/* 3 SW Antenna Diversity */
/* 3 ============================================================ */
static void odm_SwAntDetectInit(struct dm_odm_t *pDM_Odm)
{
        struct swat_t *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;

        pDM_SWAT_Table->SWAS_NoLink_BK_Reg92c = rtw_read32(pDM_Odm->Adapter, rDPDT_control);
        pDM_SWAT_Table->PreAntenna = MAIN_ANT;
        pDM_SWAT_Table->CurAntenna = MAIN_ANT;
        pDM_SWAT_Table->SWAS_NoLink_State = 0;
}

/* 3 ============================================================ */
/* 3 Tx Power Tracking */
/* 3 ============================================================ */

static u8 getSwingIndex(struct dm_odm_t *pDM_Odm)
{
        struct adapter *Adapter = pDM_Odm->Adapter;
        u8 i = 0;
        u32 bbSwing;
        u32 swingTableSize;
        u32 *pSwingTable;

        bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000);

        pSwingTable = OFDMSwingTable_New;
        swingTableSize = OFDM_TABLE_SIZE;

        for (i = 0; i < swingTableSize; ++i) {
                u32 tableValue = pSwingTable[i];

                if (tableValue >= 0x100000)
                        tableValue >>= 22;
                if (bbSwing == tableValue)
                        break;
        }
        return i;
}

void odm_TXPowerTrackingInit(struct dm_odm_t *pDM_Odm)
{
        u8 defaultSwingIndex = getSwingIndex(pDM_Odm);
        u8 p = 0;
        struct adapter *Adapter = pDM_Odm->Adapter;
        struct hal_com_data *pHalData = GET_HAL_DATA(Adapter);


        struct dm_priv *pdmpriv = &pHalData->dmpriv;

        pdmpriv->bTXPowerTracking = true;
        pdmpriv->TXPowercount = 0;
        pdmpriv->bTXPowerTrackingInit = false;

        if (*(pDM_Odm->mp_mode) != 1)
                pdmpriv->TxPowerTrackControl = true;
        else
                pdmpriv->TxPowerTrackControl = false;

        /* pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = true; */
        pDM_Odm->RFCalibrateInfo.ThermalValue = pHalData->EEPROMThermalMeter;
        pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = pHalData->EEPROMThermalMeter;
        pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = pHalData->EEPROMThermalMeter;

        /*  The index of "0 dB" in SwingTable. */
        pDM_Odm->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex;
        pDM_Odm->DefaultCckIndex = 20;

        pDM_Odm->BbSwingIdxCckBase = pDM_Odm->DefaultCckIndex;
        pDM_Odm->RFCalibrateInfo.CCK_index = pDM_Odm->DefaultCckIndex;

        for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) {
                pDM_Odm->BbSwingIdxOfdmBase[p] = pDM_Odm->DefaultOfdmIndex;
                pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pDM_Odm->DefaultOfdmIndex;
                pDM_Odm->RFCalibrateInfo.DeltaPowerIndex[p] = 0;
                pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast[p] = 0;
                pDM_Odm->RFCalibrateInfo.PowerIndexOffset[p] = 0;
        }

}

void ODM_TXPowerTrackingCheck(struct dm_odm_t *pDM_Odm)
{
        struct adapter *Adapter = pDM_Odm->Adapter;

        if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK))
                return;

        if (!pDM_Odm->RFCalibrateInfo.TM_Trigger) { /* at least delay 1 sec */
                PHY_SetRFReg(pDM_Odm->Adapter, RF_PATH_A, RF_T_METER_NEW, (BIT17 | BIT16), 0x03);

                pDM_Odm->RFCalibrateInfo.TM_Trigger = 1;
                return;
        } else {
                ODM_TXPowerTrackingCallback_ThermalMeter(Adapter);
                pDM_Odm->RFCalibrateInfo.TM_Trigger = 0;
        }
}

/*  */
/* 3 Export Interface */
/*  */

/*  */
/*  2011/09/21 MH Add to describe different team necessary resource allocate?? */
/*  */
void ODM_DMInit(struct dm_odm_t *pDM_Odm)
{

        odm_CommonInfoSelfInit(pDM_Odm);
        odm_DIGInit(pDM_Odm);
        odm_NHMCounterStatisticsInit(pDM_Odm);
        odm_AdaptivityInit(pDM_Odm);
        odm_RateAdaptiveMaskInit(pDM_Odm);
        ODM_CfoTrackingInit(pDM_Odm);
        ODM_EdcaTurboInit(pDM_Odm);
        odm_RSSIMonitorInit(pDM_Odm);
        odm_TXPowerTrackingInit(pDM_Odm);

        ODM_ClearTxPowerTrackingState(pDM_Odm);

        odm_DynamicBBPowerSavingInit(pDM_Odm);
        odm_DynamicTxPowerInit(pDM_Odm);

        odm_SwAntDetectInit(pDM_Odm);
}

/*  */
/*  2011/09/20 MH This is the entry pointer for all team to execute HW out source DM. */
/*  You can not add any dummy function here, be care, you can only use DM structure */
/*  to perform any new ODM_DM. */
/*  */
void ODM_DMWatchdog(struct dm_odm_t *pDM_Odm)
{
        odm_CommonInfoSelfUpdate(pDM_Odm);
        odm_FalseAlarmCounterStatistics(pDM_Odm);
        odm_NHMCounterStatistics(pDM_Odm);

        odm_RSSIMonitorCheck(pDM_Odm);

        /* For CE Platform(SPRD or Tablet) */
        /* 8723A or 8189ES platform */
        /* NeilChen--2012--08--24-- */
        /* Fix Leave LPS issue */
        if (adapter_to_pwrctl(pDM_Odm->Adapter)->pwr_mode != PS_MODE_ACTIVE) {
                /* in LPS mode */
                odm_DIGbyRSSI_LPS(pDM_Odm);
        } else {
                odm_DIG(pDM_Odm);
        }

        {
                struct dig_t *pDM_DigTable = &pDM_Odm->DM_DigTable;

                odm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue);
        }
        odm_CCKPacketDetectionThresh(pDM_Odm);

        if (*(pDM_Odm->pbPowerSaving) == true)
                return;


        odm_RefreshRateAdaptiveMask(pDM_Odm);
        odm_EdcaTurboCheck(pDM_Odm);
        ODM_CfoTracking(pDM_Odm);

        ODM_TXPowerTrackingCheck(pDM_Odm);

        /* odm_EdcaTurboCheck(pDM_Odm); */

        /* 2010.05.30 LukeLee: For CE platform, files in IC subfolders may not be included to be compiled, */
        /*  so compile flags must be left here to prevent from compile errors */
        pDM_Odm->PhyDbgInfo.NumQryBeaconPkt = 0;
}


/*  */
/*  Init /.. Fixed HW value. Only init time. */
/*  */
void ODM_CmnInfoInit(struct dm_odm_t *pDM_Odm, enum odm_cmninfo_e CmnInfo, u32 Value)
{
        /*  */
        /*  This section is used for init value */
        /*  */
        switch (CmnInfo) {
        /*  */
        /*  Fixed ODM value. */
        /*  */
        case ODM_CMNINFO_ABILITY:
                pDM_Odm->SupportAbility = (u32)Value;
                break;

        case ODM_CMNINFO_PLATFORM:
                pDM_Odm->SupportPlatform = (u8)Value;
                break;

        case ODM_CMNINFO_INTERFACE:
                pDM_Odm->SupportInterface = (u8)Value;
                break;

        case ODM_CMNINFO_IC_TYPE:
                pDM_Odm->SupportICType = Value;
                break;

        case ODM_CMNINFO_CUT_VER:
                pDM_Odm->CutVersion = (u8)Value;
                break;

        case ODM_CMNINFO_FAB_VER:
                pDM_Odm->FabVersion = (u8)Value;
                break;

        case ODM_CMNINFO_RFE_TYPE:
                pDM_Odm->RFEType = (u8)Value;
                break;

        case    ODM_CMNINFO_RF_ANTENNA_TYPE:
                pDM_Odm->AntDivType = (u8)Value;
                break;

        case ODM_CMNINFO_PACKAGE_TYPE:
                pDM_Odm->PackageType = (u8)Value;
                break;

        case ODM_CMNINFO_EXT_LNA:
                pDM_Odm->ExtLNA = (u8)Value;
                break;

        case ODM_CMNINFO_EXT_PA:
                pDM_Odm->ExtPA = (u8)Value;
                break;

        case ODM_CMNINFO_GPA:
                pDM_Odm->TypeGPA = (enum odm_type_gpa_e)Value;
                break;
        case ODM_CMNINFO_APA:
                pDM_Odm->TypeAPA = (enum odm_type_apa_e)Value;
                break;
        case ODM_CMNINFO_GLNA:
                pDM_Odm->TypeGLNA = (enum odm_type_glna_e)Value;
                break;
        case ODM_CMNINFO_ALNA:
                pDM_Odm->TypeALNA = (enum odm_type_alna_e)Value;
                break;

        case ODM_CMNINFO_EXT_TRSW:
                pDM_Odm->ExtTRSW = (u8)Value;
                break;
        case ODM_CMNINFO_PATCH_ID:
                pDM_Odm->PatchID = (u8)Value;
                break;
        case ODM_CMNINFO_BINHCT_TEST:
                pDM_Odm->bInHctTest = (bool)Value;
                break;
        case ODM_CMNINFO_BWIFI_TEST:
                pDM_Odm->bWIFITest = (bool)Value;
                break;

        case ODM_CMNINFO_SMART_CONCURRENT:
                pDM_Odm->bDualMacSmartConcurrent = (bool)Value;
                break;

        /* To remove the compiler warning, must add an empty default statement to handle the other values. */
        default:
                /* do nothing */
                break;
        }

}


void ODM_CmnInfoHook(struct dm_odm_t *pDM_Odm, enum odm_cmninfo_e CmnInfo, void *pValue)
{
        /*  */
        /*  Hook call by reference pointer. */
        /*  */
        switch (CmnInfo) {
        /*  */
        /*  Dynamic call by reference pointer. */
        /*  */
        case ODM_CMNINFO_MAC_PHY_MODE:
                pDM_Odm->pMacPhyMode = pValue;
                break;

        case ODM_CMNINFO_TX_UNI:
                pDM_Odm->pNumTxBytesUnicast = pValue;
                break;

        case ODM_CMNINFO_RX_UNI:
                pDM_Odm->pNumRxBytesUnicast = pValue;
                break;

        case ODM_CMNINFO_WM_MODE:
                pDM_Odm->pwirelessmode = pValue;
                break;

        case ODM_CMNINFO_SEC_CHNL_OFFSET:
                pDM_Odm->pSecChOffset = pValue;
                break;

        case ODM_CMNINFO_SEC_MODE:
                pDM_Odm->pSecurity = pValue;
                break;

        case ODM_CMNINFO_BW:
                pDM_Odm->pBandWidth = pValue;
                break;

        case ODM_CMNINFO_CHNL:
                pDM_Odm->pChannel = pValue;
                break;

        case ODM_CMNINFO_DMSP_GET_VALUE:
                pDM_Odm->pbGetValueFromOtherMac = pValue;
                break;

        case ODM_CMNINFO_BUDDY_ADAPTOR:
                pDM_Odm->pBuddyAdapter = pValue;
                break;

        case ODM_CMNINFO_DMSP_IS_MASTER:
                pDM_Odm->pbMasterOfDMSP = pValue;
                break;

        case ODM_CMNINFO_SCAN:
                pDM_Odm->pbScanInProcess = pValue;
                break;

        case ODM_CMNINFO_POWER_SAVING:
                pDM_Odm->pbPowerSaving = pValue;
                break;

        case ODM_CMNINFO_ONE_PATH_CCA:
                pDM_Odm->pOnePathCCA = pValue;
                break;

        case ODM_CMNINFO_DRV_STOP:
                pDM_Odm->pbDriverStopped =  pValue;
                break;

        case ODM_CMNINFO_PNP_IN:
                pDM_Odm->pbDriverIsGoingToPnpSetPowerSleep =  pValue;
                break;

        case ODM_CMNINFO_INIT_ON:
                pDM_Odm->pinit_adpt_in_progress =  pValue;
                break;

        case ODM_CMNINFO_ANT_TEST:
                pDM_Odm->pAntennaTest =  pValue;
                break;

        case ODM_CMNINFO_NET_CLOSED:
                pDM_Odm->pbNet_closed = pValue;
                break;

        case ODM_CMNINFO_FORCED_RATE:
                pDM_Odm->pForcedDataRate = pValue;
                break;

        case ODM_CMNINFO_FORCED_IGI_LB:
                pDM_Odm->pu1ForcedIgiLb = pValue;
                break;

        case ODM_CMNINFO_MP_MODE:
                pDM_Odm->mp_mode = pValue;
                break;

        /* case ODM_CMNINFO_RTSTA_AID: */
        /* pDM_Odm->pAidMap =  (u8 *)pValue; */
        /* break; */

        /* case ODM_CMNINFO_BT_COEXIST: */
        /* pDM_Odm->BTCoexist = (bool *)pValue; */

        /* case ODM_CMNINFO_STA_STATUS: */
        /* pDM_Odm->pODM_StaInfo[] = (PSTA_INFO_T)pValue; */
        /* break; */

        /* case ODM_CMNINFO_PHY_STATUS: */
        /* pDM_Odm->pPhyInfo = (ODM_PHY_INFO *)pValue; */
        /* break; */

        /* case ODM_CMNINFO_MAC_STATUS: */
        /* pDM_Odm->pMacInfo = (struct odm_mac_status_info *)pValue; */
        /* break; */
        /* To remove the compiler warning, must add an empty default statement to handle the other values. */
        default:
                /* do nothing */
                break;
        }

}


void ODM_CmnInfoPtrArrayHook(
        struct dm_odm_t *pDM_Odm,
        enum odm_cmninfo_e CmnInfo,
        u16 Index,
        void *pValue
)
{
        /*  */
        /*  Hook call by reference pointer. */
        /*  */
        switch (CmnInfo) {
        /*  */
        /*  Dynamic call by reference pointer. */
        /*  */
        case ODM_CMNINFO_STA_STATUS:
                pDM_Odm->pODM_StaInfo[Index] = (PSTA_INFO_T)pValue;
                break;
        /* To remove the compiler warning, must add an empty default statement to handle the other values. */
        default:
                /* do nothing */
                break;
        }

}


/*  */
/*  Update Band/CHannel/.. The values are dynamic but non-per-packet. */
/*  */
void ODM_CmnInfoUpdate(struct dm_odm_t *pDM_Odm, u32 CmnInfo, u64 Value)
{
        /*  */
        /*  This init variable may be changed in run time. */
        /*  */
        switch (CmnInfo) {
        case ODM_CMNINFO_LINK_IN_PROGRESS:
                pDM_Odm->bLinkInProcess = (bool)Value;
                break;

        case ODM_CMNINFO_ABILITY:
                pDM_Odm->SupportAbility = (u32)Value;
                break;

        case ODM_CMNINFO_WIFI_DIRECT:
                pDM_Odm->bWIFI_Direct = (bool)Value;
                break;

        case ODM_CMNINFO_WIFI_DISPLAY:
                pDM_Odm->bWIFI_Display = (bool)Value;
                break;

        case ODM_CMNINFO_LINK:
                pDM_Odm->bLinked = (bool)Value;
                break;

        case ODM_CMNINFO_STATION_STATE:
                pDM_Odm->bsta_state = (bool)Value;
                break;

        case ODM_CMNINFO_RSSI_MIN:
                pDM_Odm->RSSI_Min = (u8)Value;
                break;

        case ODM_CMNINFO_RA_THRESHOLD_HIGH:
                pDM_Odm->RateAdaptive.HighRSSIThresh = (u8)Value;
                break;

        case ODM_CMNINFO_RA_THRESHOLD_LOW:
                pDM_Odm->RateAdaptive.LowRSSIThresh = (u8)Value;
                break;
        /*  The following is for BT HS mode and BT coexist mechanism. */
        case ODM_CMNINFO_BT_ENABLED:
                pDM_Odm->bBtEnabled = (bool)Value;
                break;

        case ODM_CMNINFO_BT_HS_CONNECT_PROCESS:
                pDM_Odm->bBtConnectProcess = (bool)Value;
                break;

        case ODM_CMNINFO_BT_HS_RSSI:
                pDM_Odm->btHsRssi = (u8)Value;
                break;

        case ODM_CMNINFO_BT_OPERATION:
                pDM_Odm->bBtHsOperation = (bool)Value;
                break;

        case ODM_CMNINFO_BT_LIMITED_DIG:
                pDM_Odm->bBtLimitedDig = (bool)Value;
                break;

        case ODM_CMNINFO_BT_DISABLE_EDCA:
                pDM_Odm->bBtDisableEdcaTurbo = (bool)Value;
                break;

/*
        case    ODM_CMNINFO_OP_MODE:
                pDM_Odm->OPMode = (u8)Value;
                break;

        case    ODM_CMNINFO_WM_MODE:
                pDM_Odm->WirelessMode = (u8)Value;
                break;

        case    ODM_CMNINFO_SEC_CHNL_OFFSET:
                pDM_Odm->SecChOffset = (u8)Value;
                break;

        case    ODM_CMNINFO_SEC_MODE:
                pDM_Odm->Security = (u8)Value;
                break;

        case    ODM_CMNINFO_BW:
                pDM_Odm->BandWidth = (u8)Value;
                break;

        case    ODM_CMNINFO_CHNL:
                pDM_Odm->Channel = (u8)Value;
                break;
*/
        default:
                /* do nothing */
                break;
        }


}

/* 3 ============================================================ */
/* 3 DIG */
/* 3 ============================================================ */
/*-----------------------------------------------------------------------------
 * Function:    odm_DIGInit()
 *
 * Overview:    Set DIG scheme init value.
 *
 * Input:               NONE
 *
 * Output:              NONE
 *
 * Return:              NONE
 *
 * Revised History:
 *When          Who             Remark
 *
 *---------------------------------------------------------------------------
 */

/* Remove DIG by yuchen */

/* Remove DIG and FA check by Yu Chen */

/* 3 ============================================================ */
/* 3 BB Power Save */
/* 3 ============================================================ */

/* Remove BB power saving by Yuchen */

/* 3 ============================================================ */
/* 3 Dynamic Tx Power */
/* 3 ============================================================ */

/* Remove BY YuChen */