OSDN Git Service

rtl8723au: Replace u1Byte with u8
[android-x86/external-modules-rtl8723au.git] / hal / odm.c
index acc27e0..8a34305 100644 (file)
--- a/hal/odm.c
+++ b/hal/odm.c
@@ -37,27 +37,9 @@ const u2Byte dB_Invert_Table[8][12] = {
        {       17783,  19953,  22387,  25119,  28184,  31623,  35481,  39811,  44668,  50119,  56234,  65535}};
 
 // 20100515 Joseph: Add global variable to keep temporary scan list for antenna switching test.
-//u1Byte                       tmpNumBssDesc;
+//u8                   tmpNumBssDesc;
 //RT_WLAN_BSS  tmpbssDesc[MAX_BSS_DESC];
 
-#if (DM_ODM_SUPPORT_TYPE==ODM_MP)
-static u4Byte edca_setting_UL[HT_IOT_PEER_MAX] =
-// UNKNOWN             REALTEK_90      REALTEK_92SE    BROADCOM                RALINK          ATHEROS         CISCO           MARVELL         92U_AP          SELF_AP(DownLink/Tx)
-{ 0x5e4322,            0xa44f,                 0x5e4322,               0x5ea32b,               0x5ea422,       0x5ea322,       0x3ea430,       0x5ea44f,       0x5e4322,       0x5e4322};
-
-
-static u4Byte edca_setting_DL[HT_IOT_PEER_MAX] =
-// UNKNOWN             REALTEK_90      REALTEK_92SE    BROADCOM                RALINK          ATHEROS         CISCO           MARVELL         92U_AP          SELF_AP(UpLink/Rx)
-{ 0xa44f,              0x5ea44f,       0x5e4322,               0x5ea42b,               0xa44f,                 0xa630,                 0x5ea630,       0xa44f,         0xa42b,         0xa42b};
-
-static u4Byte edca_setting_DL_GMode[HT_IOT_PEER_MAX] =
-// UNKNOWN             REALTEK_90      REALTEK_92SE    BROADCOM                RALINK          ATHEROS         CISCO           MARVELL         92U_AP          SELF_AP
-{ 0x4322,              0xa44f,                 0x5e4322,               0xa42b,                         0x5e4322,       0x4322,                 0xa42b,         0xa44f,         0x5e4322,       0x5ea42b};
-
-
-//============================================================
-#elif(DM_ODM_SUPPORT_TYPE==ODM_CE)
-
 
 //avoid to warn in FreeBSD ==> To DO modify
 u4Byte EDCAParam[HT_IOT_PEER_MAX][3] =
@@ -80,31 +62,6 @@ u4Byte EDCAParam[HT_IOT_PEER_MAX][3] =
 //============================================================
 // EDCA Paramter for AP/ADSL   by Mingzhi 2011-11-22
 //============================================================
-#elif (DM_ODM_SUPPORT_TYPE &ODM_ADSL)
-enum qos_prio { BK, BE, VI, VO, VI_AG, VO_AG };
-
-static const struct ParaRecord rtl_ap_EDCA[] =
-{
-//ACM,AIFSN, ECWmin, ECWmax, TXOplimit
-     {0,     7,      4,      10,     0},            //BK
-     {0,     3,      4,      6,      0},             //BE
-     {0,     1,      3,      4,      188},         //VI
-     {0,     1,      2,      3,      102},         //VO
-     {0,     1,      3,      4,      94},          //VI_AG
-     {0,     1,      2,      3,      47},          //VO_AG
-};
-
-static const struct ParaRecord rtl_sta_EDCA[] =
-{
-//ACM,AIFSN, ECWmin, ECWmax, TXOplimit
-     {0,     7,      4,      10,     0},
-     {0,     3,      4,      10,     0},
-     {0,     2,      3,      4,      188},
-     {0,     2,      2,      3,      102},
-     {0,     2,      3,      4,      94},
-     {0,     2,      2,      3,      47},
-};
-#endif
 
 //============================================================
 // Global var
@@ -156,7 +113,7 @@ u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D] = {
 };
 
 
-u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = {
+u8 CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = {
        {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04},       // 0, +0dB
        {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04},       // 1, -0.5dB
        {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03},       // 2, -1.0dB
@@ -193,7 +150,7 @@ u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = {
 };
 
 
-u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]= {
+u8 CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]= {
        {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00},       // 0, +0dB
        {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00},       // 1, -0.5dB
        {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00},       // 2, -1.0dB
@@ -278,287 +235,212 @@ unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = {
 //============================================================
 
 //START------------COMMON INFO RELATED---------------//
-VOID
+void
 odm_CommonInfoSelfInit(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_CommonInfoSelfUpdate(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_CmnInfoInit_Debug(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_CmnInfoHook_Debug(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_CmnInfoUpdate_Debug(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 /*
-VOID
+void
 odm_FindMinimumRSSI(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_IsLinked(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 */
 //END------------COMMON INFO RELATED---------------//
 
 //START---------------DIG---------------------------//
-VOID
+void
 odm_FalseAlarmCounterStatistics(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_DIGInit(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_DIG(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_CCKPacketDetectionThresh(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 //END---------------DIG---------------------------//
 
 //START-------BB POWER SAVE-----------------------//
-VOID
+void
 odm_DynamicBBPowerSavingInit(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_DynamicBBPowerSaving(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_1R_CCA(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 //END---------BB POWER SAVE-----------------------//
 
-//START-----------------PSD-----------------------//
-#if(DM_ODM_SUPPORT_TYPE & (ODM_MP))
-//============================================================
-// Function predefine.
-//============================================================
-VOID   odm_PathDiversityInit_92C(      IN      PADAPTER        Adapter);
-VOID   odm_2TPathDiversityInit_92C(    IN      PADAPTER        Adapter);
-VOID   odm_1TPathDiversityInit_92C(    IN      PADAPTER        Adapter);
-bool   odm_IsConnected_92C(IN  PADAPTER        Adapter);
-VOID   odm_PathDiversityAfterLink_92C( IN      PADAPTER        Adapter);
-
-VOID
-odm_CCKTXPathDiversityCallback(
-       PRT_TIMER               pTimer
-       );
-
-VOID
-odm_CCKTXPathDiversityWorkItemCallback(
-    IN PVOID            pContext
-    );
 
-VOID
-odm_PathDivChkAntSwitchCallback(
-       PRT_TIMER               pTimer
-       );
-
-VOID
-odm_PathDivChkAntSwitchWorkitemCallback(
-    IN PVOID            pContext
-    );
-
-VOID   odm_SetRespPath_92C(            IN      PADAPTER        Adapter,        IN      u1Byte  DefaultRespPath);
-VOID   odm_OFDMTXPathDiversity_92C(    IN      PADAPTER        Adapter);
-VOID   odm_CCKTXPathDiversity_92C(     IN      PADAPTER        Adapter);
-VOID   odm_ResetPathDiversity_92C(             IN      PADAPTER        Adapter);
-
-//Start-------------------- RX High Power------------------------//
-VOID   odm_RXHPInit(   IN              PDM_ODM_T               pDM_Odm);
-VOID   odm_RXHP(       IN              PDM_ODM_T               pDM_Odm);
-VOID   odm_Write_RXHP( IN      PDM_ODM_T       pDM_Odm);
-
-VOID   odm_PSD_RXHP(           IN      PDM_ODM_T       pDM_Odm);
-VOID   odm_PSD_RXHPCallback(   PRT_TIMER               pTimer);
-VOID   odm_PSD_RXHPWorkitemCallback(   IN PVOID            pContext);
-//End--------------------- RX High Power -----------------------//
-
-VOID
-odm_PathDivInit(       IN      PDM_ODM_T       pDM_Odm);
-
-VOID
-odm_SetRespPath_92C(
-       IN      PADAPTER        Adapter,
-       IN      u1Byte  DefaultRespPath
-       );
-
-#endif
-//END-------------------PSD-----------------------//
-
-VOID
+void
 odm_RefreshRateAdaptiveMaskMP(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_RefreshRateAdaptiveMaskCE(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_RefreshRateAdaptiveMaskAPADSL(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_DynamicTxPowerInit(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_DynamicTxPowerRestorePowerIndex(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        );
 
-VOID
+void
 odm_DynamicTxPowerNIC(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        );
 
-#if(DM_ODM_SUPPORT_TYPE & (ODM_MP|ODM_CE))
-VOID
+void
 odm_DynamicTxPowerSavePowerIndex(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_DynamicTxPowerWritePowerIndex(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      u1Byte          Value);
+       PDM_ODM_T       pDM_Odm,
+       u8              Value);
 
-VOID
+void
 odm_DynamicTxPower_92C(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        );
 
-VOID
+void
 odm_DynamicTxPower_92D(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        );
-#endif
 
-
-VOID
+void
 odm_RSSIMonitorInit(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        );
 
-VOID
+void
 odm_RSSIMonitorCheckMP(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        );
 
-VOID
+void
 odm_RSSIMonitorCheckCE(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
-VOID
+void
 odm_RSSIMonitorCheckAP(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
 
 
-VOID
+void
 odm_RSSIMonitorCheck(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
-VOID
+void
 odm_DynamicTxPower(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_DynamicTxPowerAP(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
 
-VOID
+void
 odm_SwAntDivInit(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_SwAntDivInit_NIC(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_SwAntDivChkAntSwitch(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              u1Byte                  Step
+               PDM_ODM_T               pDM_Odm,
+               u8                      Step
        );
 
-VOID
+void
 odm_SwAntDivChkAntSwitchNIC(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              u1Byte          Step
+               PDM_ODM_T               pDM_Odm,
+               u8              Step
        );
 
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-VOID
-odm_SwAntDivChkAntSwitchCallback(
-       PRT_TIMER               pTimer
-);
-VOID
-odm_SwAntDivChkAntSwitchWorkitemCallback(
-    IN PVOID            pContext
-    );
-#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
-VOID odm_SwAntDivChkAntSwitchCallback(void *FunctionContext);
-#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL))
-VOID odm_SwAntDivChkAntSwitchCallback(void *FunctionContext);
-#endif
-
-
+void odm_SwAntDivChkAntSwitchCallback(void *FunctionContext);
 
-VOID
+void
 odm_GlobalAdapterCheck(
-       IN              VOID
+               void
        );
 
-VOID
+void
 odm_RefreshRateAdaptiveMask(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 ODM_TXPowerTrackingCheck(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
-VOID
+void
 odm_TXPowerTrackingCheckAP(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
 
 
@@ -567,190 +449,78 @@ odm_TXPowerTrackingCheckAP(
 
 
 
-VOID
+void
 odm_RateAdaptiveMaskInit(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        );
 
-VOID
+void
 odm_TXPowerTrackingThermalMeterInit(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        );
 
 
-VOID
+void
 odm_TXPowerTrackingInit(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        );
 
-VOID
+void
 odm_TXPowerTrackingCheckMP(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        );
 
 
-VOID
+void
 odm_TXPowerTrackingCheckCE(
-       IN      PDM_ODM_T       pDM_Odm
-       );
-
-#if(DM_ODM_SUPPORT_TYPE & (ODM_MP))
-
-VOID
-ODM_RateAdaptiveStateApInit(
-       IN      PADAPTER        Adapter ,
-       IN      PRT_WLAN_STA  pEntry
-       );
-
-VOID
-odm_TXPowerTrackingCallbackThermalMeter92C(
-            IN PADAPTER        Adapter
-            );
-
-VOID
-odm_TXPowerTrackingCallbackRXGainThermalMeter92D(
-       IN PADAPTER     Adapter
-       );
-
-VOID
-odm_TXPowerTrackingCallbackThermalMeter92D(
-            IN PADAPTER        Adapter
-            );
-
-VOID
-odm_TXPowerTrackingDirectCall92C(
-            IN PADAPTER                Adapter
-            );
-
-VOID
-odm_TXPowerTrackingThermalMeterCheck(
-       IN      PADAPTER                Adapter
+       PDM_ODM_T       pDM_Odm
        );
 
-#endif
-
-VOID
+void
 odm_EdcaTurboCheck(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
-VOID
+void
 ODM_EdcaTurboInit(
-       IN      PDM_ODM_T               pDM_Odm
-);
-
-#if(DM_ODM_SUPPORT_TYPE==ODM_MP)
-VOID
-odm_EdcaTurboCheckMP(
-       IN              PDM_ODM_T               pDM_Odm
-       );
-
-//check if edca turbo is disabled
-bool
-odm_IsEdcaTurboDisable(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T               pDM_Odm
 );
-//choose edca paramter for special IOT case
-VOID
-ODM_EdcaParaSelByIot(
-       IN      PDM_ODM_T       pDM_Odm,
-       OUT     u4Byte          *EDCA_BE_UL,
-       OUT u4Byte              *EDCA_BE_DL
-       );
-//check if it is UL or DL
-VOID
-odm_EdcaChooseTrafficIdx(
-       IN      PDM_ODM_T               pDM_Odm,
-       IN      u8Byte                          cur_tx_bytes,
-       IN      u8Byte                          cur_rx_bytes,
-       IN      bool                    bBiasOnRx,
-       OUT bool                *pbIsCurRDLState
-       );
 
-#elif (DM_ODM_SUPPORT_TYPE==ODM_CE)
-VOID
+void
 odm_EdcaTurboCheckCE(
-       IN              PDM_ODM_T               pDM_Odm
-       );
-#else
-VOID
-odm_IotEngine(
-       IN      PDM_ODM_T       pDM_Odm
-       );
-
-VOID
-odm_EdcaParaInit(
-       IN      PDM_ODM_T       pDM_Odm
+               PDM_ODM_T               pDM_Odm
        );
-#endif
-
-
 
 #define                RxDefaultAnt1           0x65a9
 #define        RxDefaultAnt2           0x569a
 
-VOID
+void
 odm_InitHybridAntDiv(
      IN PDM_ODM_T    pDM_Odm
PDM_ODM_T     pDM_Odm
        );
 
 bool
 odm_StaDefAntSel(
      IN PDM_ODM_T    pDM_Odm,
      IN u4Byte               OFDM_Ant1_Cnt,
      IN u4Byte               OFDM_Ant2_Cnt,
      IN u4Byte               CCK_Ant1_Cnt,
      IN u4Byte               CCK_Ant2_Cnt,
      OUT u1Byte              *pDefAnt
PDM_ODM_T     pDM_Odm,
u4Byte                OFDM_Ant1_Cnt,
u4Byte                OFDM_Ant2_Cnt,
u4Byte                CCK_Ant1_Cnt,
u4Byte                CCK_Ant2_Cnt,
u8            *pDefAnt
        );
 
-VOID
+void
 odm_SetRxIdleAnt(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      u1Byte  Ant,
-       IN   bool   bDualPath
+       PDM_ODM_T       pDM_Odm,
+       u8      Ant,
+   bool   bDualPath
 );
 
 
 
-VOID
+void
 odm_HwAntDiv(
-       IN      PDM_ODM_T       pDM_Odm
-);
-
-
-
-
-
-#if 0
-//#if ((DM_ODM_SUPPORT_TYPE==ODM_AP)&&defined(HW_ANT_SWITCH))
-VOID
-odm_HW_AntennaSwitchInit(
-       IN      PDM_ODM_T       pDM_Odm
-);
-
-VOID
-odm_SetRxIdleAnt(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      u1Byte          Ant
-);
-
-VOID
-odm_StaAntSelect(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      struct stat_info *pstat
-);
-
-VOID
-odm_HW_IdleAntennaSelect(
-       IN      PDM_ODM_T       pDM_Odm
-);
-
-u1Byte
-ODM_Diversity_AntennaSelect(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      u1Byte  *data
+       PDM_ODM_T       pDM_Odm
 );
-#endif
 
 
 //============================================================
@@ -760,9 +530,9 @@ ODM_Diversity_AntennaSelect(
 //
 // 2011/09/21 MH Add to describe different team necessary resource allocate??
 //
-VOID
+void
 ODM_DMInit(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
 
@@ -789,16 +559,11 @@ ODM_DMInit(
                odm_DynamicBBPowerSavingInit(pDM_Odm);
                odm_DynamicTxPowerInit(pDM_Odm);
                odm_TXPowerTrackingInit(pDM_Odm);
-               #if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-             odm_PSDMonitorInit(pDM_Odm);
-               odm_RXHPInit(pDM_Odm);
-               odm_PathDivInit(pDM_Odm); //92D Path Div Init   //Neil Chen
-               #endif
                ODM_EdcaTurboInit(pDM_Odm);
                #if (RTL8188E_SUPPORT == 1)
                ODM_RAInfo_Init_all(pDM_Odm);
                #endif
-               if(     ( pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV )     ||
+               if(( pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV )  ||
                        ( pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV )    ||
                        ( pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV ))
                {
@@ -816,9 +581,9 @@ ODM_DMInit(
 // You can not add any dummy function here, be care, you can only use DM structure
 // to perform any new ODM_DM.
 //
-VOID
+void
 ODM_DMWatchdog(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        //2012.05.03 Luke: For all IC series
@@ -829,13 +594,11 @@ ODM_DMWatchdog(
        odm_FalseAlarmCounterStatistics(pDM_Odm);
        odm_RSSIMonitorCheck(pDM_Odm);
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_CE)
-//#ifdef CONFIG_PLATFORM_SPRD
        //For CE Platform(SPRD or Tablet)
        //8723A or 8189ES platform
        //NeilChen--2012--08--24--
        //Fix Leave LPS issue
-       if(     (pDM_Odm->Adapter->pwrctrlpriv.pwr_mode != PS_MODE_ACTIVE) &&// in LPS mode
+       if((pDM_Odm->Adapter->pwrctrlpriv.pwr_mode != PS_MODE_ACTIVE) &&// in LPS mode
                (
                        (pDM_Odm->SupportICType & (ODM_RTL8723A ) )||
                        (pDM_Odm->SupportICType & (ODM_RTL8188E) &&((pDM_Odm->SupportInterface  == ODM_ITRF_SDIO)) )
@@ -849,8 +612,6 @@ ODM_DMWatchdog(
                        odm_DIGbyRSSI_LPS(pDM_Odm);
        }
        else
-//#endif
-#endif
        {
                odm_DIG(pDM_Odm);
        }
@@ -870,7 +631,7 @@ ODM_DMWatchdog(
        #if (RTL8188E_SUPPORT == 1)
        odm_DynamicPrimaryCCA(pDM_Odm);
        #endif
-       if(     ( pDM_Odm->AntDivType ==  CG_TRX_HW_ANTDIV )    ||
+       if(( pDM_Odm->AntDivType ==  CG_TRX_HW_ANTDIV ) ||
                ( pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV )    ||
                ( pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV ))
        {
@@ -890,25 +651,20 @@ ODM_DMWatchdog(
                ODM_TXPowerTrackingCheck(pDM_Odm);
              odm_EdcaTurboCheck(pDM_Odm);
                odm_DynamicTxPower(pDM_Odm);
-               #if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-               odm_RXHP(pDM_Odm);
-               #endif
        }
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_CE)
        odm_dtc(pDM_Odm);
-#endif
 }
 
 
 //
 // Init /.. Fixed HW value. Only init time.
 //
-VOID
+void
 ODM_CmnInfoInit(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              ODM_CMNINFO_E   CmnInfo,
-       IN              u4Byte                  Value
+               PDM_ODM_T               pDM_Odm,
+               ODM_CMNINFO_E   CmnInfo,
+               u4Byte                  Value
        )
 {
        //ODM_RT_TRACE(pDM_Odm,);
@@ -925,15 +681,15 @@ ODM_CmnInfoInit(
                        pDM_Odm->SupportAbility = (u4Byte)Value;
                        break;
                case    ODM_CMNINFO_PLATFORM:
-                       pDM_Odm->SupportPlatform = (u1Byte)Value;
+                       pDM_Odm->SupportPlatform = (u8)Value;
                        break;
 
                case    ODM_CMNINFO_INTERFACE:
-                       pDM_Odm->SupportInterface = (u1Byte)Value;
+                       pDM_Odm->SupportInterface = (u8)Value;
                        break;
 
                case    ODM_CMNINFO_MP_TEST_CHIP:
-                       pDM_Odm->bIsMPChip= (u1Byte)Value;
+                       pDM_Odm->bIsMPChip= (u8)Value;
                        break;
 
                case    ODM_CMNINFO_IC_TYPE:
@@ -941,38 +697,38 @@ ODM_CmnInfoInit(
                        break;
 
                case    ODM_CMNINFO_CUT_VER:
-                       pDM_Odm->CutVersion = (u1Byte)Value;
+                       pDM_Odm->CutVersion = (u8)Value;
                        break;
 
                case    ODM_CMNINFO_FAB_VER:
-                       pDM_Odm->FabVersion = (u1Byte)Value;
+                       pDM_Odm->FabVersion = (u8)Value;
                        break;
 
                case    ODM_CMNINFO_RF_TYPE:
-                       pDM_Odm->RFType = (u1Byte)Value;
+                       pDM_Odm->RFType = (u8)Value;
                        break;
 
                case    ODM_CMNINFO_RF_ANTENNA_TYPE:
-                       pDM_Odm->AntDivType= (u1Byte)Value;
+                       pDM_Odm->AntDivType= (u8)Value;
                        break;
 
                case    ODM_CMNINFO_BOARD_TYPE:
-                       pDM_Odm->BoardType = (u1Byte)Value;
+                       pDM_Odm->BoardType = (u8)Value;
                        break;
 
                case    ODM_CMNINFO_EXT_LNA:
-                       pDM_Odm->ExtLNA = (u1Byte)Value;
+                       pDM_Odm->ExtLNA = (u8)Value;
                        break;
 
                case    ODM_CMNINFO_EXT_PA:
-                       pDM_Odm->ExtPA = (u1Byte)Value;
+                       pDM_Odm->ExtPA = (u8)Value;
                        break;
 
                case    ODM_CMNINFO_EXT_TRSW:
-                       pDM_Odm->ExtTRSW = (u1Byte)Value;
+                       pDM_Odm->ExtTRSW = (u8)Value;
                        break;
                case    ODM_CMNINFO_PATCH_ID:
-                       pDM_Odm->PatchID = (u1Byte)Value;
+                       pDM_Odm->PatchID = (u8)Value;
                        break;
                case    ODM_CMNINFO_BINHCT_TEST:
                        pDM_Odm->bInHctTest = (bool)Value;
@@ -1003,11 +759,11 @@ ODM_CmnInfoInit(
 }
 
 
-VOID
+void
 ODM_CmnInfoHook(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              ODM_CMNINFO_E   CmnInfo,
-       IN              PVOID                   pValue
+               PDM_ODM_T               pDM_Odm,
+               ODM_CMNINFO_E   CmnInfo,
+               void *                  pValue
        )
 {
        //
@@ -1019,7 +775,7 @@ ODM_CmnInfoHook(
                // Dynamic call by reference pointer.
                //
                case    ODM_CMNINFO_MAC_PHY_MODE:
-                       pDM_Odm->pMacPhyMode = (u1Byte *)pValue;
+                       pDM_Odm->pMacPhyMode = (u8 *)pValue;
                        break;
 
                case    ODM_CMNINFO_TX_UNI:
@@ -1031,27 +787,27 @@ ODM_CmnInfoHook(
                        break;
 
                case    ODM_CMNINFO_WM_MODE:
-                       pDM_Odm->pWirelessMode = (u1Byte *)pValue;
+                       pDM_Odm->pWirelessMode = (u8 *)pValue;
                        break;
 
                case    ODM_CMNINFO_BAND:
-                       pDM_Odm->pBandType = (u1Byte *)pValue;
+                       pDM_Odm->pBandType = (u8 *)pValue;
                        break;
 
                case    ODM_CMNINFO_SEC_CHNL_OFFSET:
-                       pDM_Odm->pSecChOffset = (u1Byte *)pValue;
+                       pDM_Odm->pSecChOffset = (u8 *)pValue;
                        break;
 
                case    ODM_CMNINFO_SEC_MODE:
-                       pDM_Odm->pSecurity = (u1Byte *)pValue;
+                       pDM_Odm->pSecurity = (u8 *)pValue;
                        break;
 
                case    ODM_CMNINFO_BW:
-                       pDM_Odm->pBandWidth = (u1Byte *)pValue;
+                       pDM_Odm->pBandWidth = (u8 *)pValue;
                        break;
 
                case    ODM_CMNINFO_CHNL:
-                       pDM_Odm->pChannel = (u1Byte *)pValue;
+                       pDM_Odm->pChannel = (u8 *)pValue;
                        break;
 
                case    ODM_CMNINFO_DMSP_GET_VALUE:
@@ -1075,7 +831,7 @@ ODM_CmnInfoHook(
                        break;
 
                case    ODM_CMNINFO_ONE_PATH_CCA:
-                       pDM_Odm->pOnePathCCA = (u1Byte *)pValue;
+                       pDM_Odm->pOnePathCCA = (u8 *)pValue;
                        break;
 
                case    ODM_CMNINFO_DRV_STOP:
@@ -1091,7 +847,7 @@ ODM_CmnInfoHook(
                        break;
 
                case    ODM_CMNINFO_ANT_TEST:
-                       pDM_Odm->pAntennaTest =  (u1Byte *)pValue;
+                       pDM_Odm->pAntennaTest =  (u8 *)pValue;
                        break;
 
                case    ODM_CMNINFO_NET_CLOSED:
@@ -1122,12 +878,12 @@ ODM_CmnInfoHook(
 }
 
 
-VOID
+void
 ODM_CmnInfoPtrArrayHook(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              ODM_CMNINFO_E   CmnInfo,
-       IN              u2Byte                  Index,
-       IN              PVOID                   pValue
+               PDM_ODM_T               pDM_Odm,
+               ODM_CMNINFO_E   CmnInfo,
+               u2Byte                  Index,
+               void *                  pValue
        )
 {
        //
@@ -1153,11 +909,11 @@ ODM_CmnInfoPtrArrayHook(
 //
 // Update Band/CHannel/.. The values are dynamic but non-per-packet.
 //
-VOID
+void
 ODM_CmnInfoUpdate(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              u4Byte                  CmnInfo,
-       IN              u8Byte                  Value
+               PDM_ODM_T               pDM_Odm,
+               u4Byte                  CmnInfo,
+               u8Byte                  Value
        )
 {
        //
@@ -1170,7 +926,7 @@ ODM_CmnInfoUpdate(
                        break;
 
                case    ODM_CMNINFO_RF_TYPE:
-                       pDM_Odm->RFType = (u1Byte)Value;
+                       pDM_Odm->RFType = (u8)Value;
                        break;
 
                case    ODM_CMNINFO_WIFI_DIRECT:
@@ -1186,7 +942,7 @@ ODM_CmnInfoUpdate(
                        break;
 
                case    ODM_CMNINFO_RSSI_MIN:
-                       pDM_Odm->RSSI_Min= (u1Byte)Value;
+                       pDM_Odm->RSSI_Min= (u8)Value;
                        break;
 
                case    ODM_CMNINFO_DBG_COMP:
@@ -1197,11 +953,11 @@ ODM_CmnInfoUpdate(
                        pDM_Odm->DebugLevel = (u4Byte)Value;
                        break;
                case    ODM_CMNINFO_RA_THRESHOLD_HIGH:
-                       pDM_Odm->RateAdaptive.HighRSSIThresh = (u1Byte)Value;
+                       pDM_Odm->RateAdaptive.HighRSSIThresh = (u8)Value;
                        break;
 
                case    ODM_CMNINFO_RA_THRESHOLD_LOW:
-                       pDM_Odm->RateAdaptive.LowRSSIThresh = (u1Byte)Value;
+                       pDM_Odm->RateAdaptive.LowRSSIThresh = (u8)Value;
                        break;
 #if(BT_30_SUPPORT == 1)
                // The following is for BT HS mode and BT coexist mechanism.
@@ -1214,7 +970,7 @@ ODM_CmnInfoUpdate(
                        break;
 
                case ODM_CMNINFO_BT_DIG:
-                       pDM_Odm->btHsDigVal = (u1Byte)Value;
+                       pDM_Odm->btHsDigVal = (u8)Value;
                        break;
 
                case    ODM_CMNINFO_BT_BUSY:
@@ -1231,16 +987,13 @@ ODM_CmnInfoUpdate(
 
 }
 
-VOID
+void
 odm_CommonInfoSelfInit(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        pDM_Odm->bCckHighPower = (bool) ODM_GetBBReg(pDM_Odm, 0x824, BIT9);
-       pDM_Odm->RFPathRxEnable = (u1Byte) ODM_GetBBReg(pDM_Odm, 0xc04, 0x0F);
-#if (DM_ODM_SUPPORT_TYPE != ODM_CE)
-       pDM_Odm->pbNet_closed = &pDM_Odm->bool_temp;
-#endif
+       pDM_Odm->RFPathRxEnable = (u8) ODM_GetBBReg(pDM_Odm, 0xc04, 0x0F);
        if(pDM_Odm->SupportICType & (ODM_RTL8192C|ODM_RTL8192D))
        {
 #if(defined(CONFIG_HW_ANTENNA_DIVERSITY))
@@ -1255,36 +1008,15 @@ odm_CommonInfoSelfInit(
        ODM_InitDebugSetting(pDM_Odm);
 }
 
-VOID
+void
 odm_CommonInfoSelfUpdate(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-       u1Byte  EntryCnt=0;
-       u1Byte  i;
+       u8      EntryCnt=0;
+       u8      i;
        PSTA_INFO_T     pEntry;
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
-       PADAPTER        Adapter =  pDM_Odm->Adapter;
-       PMGNT_INFO      pMgntInfo = &Adapter->MgntInfo;
-
-       pEntry = pDM_Odm->pODM_StaInfo[0];
-       if(pMgntInfo->mAssoc)
-       {
-               pEntry->bUsed=TRUE;
-               for (i=0; i<6; i++)
-                       pEntry->MacAddr[i] = pMgntInfo->Bssid[i];
-       }
-       else
-       {
-               pEntry->bUsed=FALSE;
-               for (i=0; i<6; i++)
-                       pEntry->MacAddr[i] = 0;
-       }
-#endif
-
-
        if(*(pDM_Odm->pBandWidth) == ODM_BW40M)
        {
                if(*(pDM_Odm->pSecChOffset) == 1)
@@ -1307,9 +1039,9 @@ odm_CommonInfoSelfUpdate(
                pDM_Odm->bOneEntryOnly = FALSE;
 }
 
-VOID
+void
 odm_CmnInfoInit_Debug(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_CmnInfoInit_Debug==>\n"));
@@ -1331,9 +1063,9 @@ odm_CmnInfoInit_Debug(
 
 }
 
-VOID
+void
 odm_CmnInfoHook_Debug(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_CmnInfoHook_Debug==>\n"));
@@ -1364,9 +1096,9 @@ odm_CmnInfoHook_Debug(
                ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("pOnePathCCA=%d\n",*(pDM_Odm->pOnePathCCA)) );
 }
 
-VOID
+void
 odm_CmnInfoUpdate_Debug(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_CmnInfoUpdate_Debug==>\n"));
@@ -1376,78 +1108,15 @@ odm_CmnInfoUpdate_Debug(
        ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RSSI_Min=%d\n",pDM_Odm->RSSI_Min) );
 }
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-VOID
-ODM_InitAllWorkItems(IN PDM_ODM_T      pDM_Odm )
-{
-#if USE_WORKITEM
-       PADAPTER                pAdapter = pDM_Odm->Adapter;
-
-       ODM_InitializeWorkItem( pDM_Odm,
-                                                       &pDM_Odm->DM_SWAT_Table.SwAntennaSwitchWorkitem,
-                                                       (RT_WORKITEM_CALL_BACK)odm_SwAntDivChkAntSwitchWorkitemCallback,
-                                                       (PVOID)pAdapter,
-                                                       "AntennaSwitchWorkitem"
-       );
-
-       ODM_InitializeWorkItem(
-               pDM_Odm,
-               &(pDM_Odm->PathDivSwitchWorkitem),
-               (RT_WORKITEM_CALL_BACK)odm_PathDivChkAntSwitchWorkitemCallback,
-               (PVOID)pAdapter,
-               "SWAS_WorkItem");
-
-       ODM_InitializeWorkItem(
-               pDM_Odm,
-               &(pDM_Odm->CCKPathDiversityWorkitem),
-               (RT_WORKITEM_CALL_BACK)odm_CCKTXPathDiversityWorkItemCallback,
-               (PVOID)pAdapter,
-               "CCKTXPathDiversityWorkItem");
-#if(defined(CONFIG_HW_ANTENNA_DIVERSITY))
-#if (RTL8188E_SUPPORT == 1)
-       ODM_InitializeWorkItem(
-               pDM_Odm,
-               &(pDM_Odm->FastAntTrainingWorkitem),
-               (RT_WORKITEM_CALL_BACK)odm_FastAntTrainingWorkItemCallback,
-               (PVOID)pAdapter,
-               "FastAntTrainingWorkitem");
-#endif
-#endif
-       ODM_InitializeWorkItem(
-               pDM_Odm,
-               &(pDM_Odm->DM_RXHP_Table.PSDTimeWorkitem),
-               (RT_WORKITEM_CALL_BACK)odm_PSD_RXHPWorkitemCallback,
-               (PVOID)pAdapter,
-               "PSDRXHP_WorkItem");
-#endif
-}
-
-VOID
-ODM_FreeAllWorkItems(IN PDM_ODM_T      pDM_Odm )
-{
-#if USE_WORKITEM
-       ODM_FreeWorkItem(       &(pDM_Odm->DM_SWAT_Table.SwAntennaSwitchWorkitem));
-
-       ODM_FreeWorkItem(&(pDM_Odm->PathDivSwitchWorkitem));
-
-       ODM_FreeWorkItem(&(pDM_Odm->CCKPathDiversityWorkitem));
-
-       ODM_FreeWorkItem(&(pDM_Odm->FastAntTrainingWorkitem));
-
-       ODM_FreeWorkItem((&pDM_Odm->DM_RXHP_Table.PSDTimeWorkitem));
-#endif
-
-}
-#endif
 
 /*
-VOID
+void
 odm_FindMinimumRSSI(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        u4Byte  i;
-       u1Byte  RSSI_Min = 0xFF;
+       u8      RSSI_Min = 0xFF;
 
        for(i=0; i<ODM_ASSOCIATE_ENTRY_NUM; i++)
        {
@@ -1465,9 +1134,9 @@ odm_FindMinimumRSSI(
 
 }
 
-VOID
+void
 odm_IsLinked(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        u4Byte i;
@@ -1506,11 +1175,11 @@ odm_IsLinked(
  *     When            Who             Remark
  *
  *---------------------------------------------------------------------------*/
-VOID
+void
 ODM_ChangeDynamicInitGainThresh(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      u4Byte          DM_Type,
-       IN      u4Byte          DM_Value
+       PDM_ODM_T       pDM_Odm,
+       u4Byte          DM_Type,
+       u4Byte          DM_Value
        )
 {
        pDIG_T  pDM_DigTable = &pDM_Odm->DM_DigTable;
@@ -1535,19 +1204,19 @@ ODM_ChangeDynamicInitGainThresh(
        {
                if(DM_Value > 30)
                        DM_Value = 30;
-               pDM_DigTable->BackoffVal = (u1Byte)DM_Value;
+               pDM_DigTable->BackoffVal = (u8)DM_Value;
        }
        else if(DM_Type == DIG_TYPE_RX_GAIN_MIN)
        {
                if(DM_Value == 0)
                        DM_Value = 0x1;
-               pDM_DigTable->rx_gain_range_min = (u1Byte)DM_Value;
+               pDM_DigTable->rx_gain_range_min = (u8)DM_Value;
        }
        else if(DM_Type == DIG_TYPE_RX_GAIN_MAX)
        {
                if(DM_Value > 0x50)
                        DM_Value = 0x50;
-               pDM_DigTable->rx_gain_range_max = (u1Byte)DM_Value;
+               pDM_DigTable->rx_gain_range_max = (u8)DM_Value;
        }
 }      /* DM_ChangeDynamicInitGainThresh */
 
@@ -1567,96 +1236,10 @@ int getIGIForDiff(int value_IGI)
 }
 
 
-// Add by Neil Chen to enable edcca to MP Platform
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
-VOID
-odm_EnableEDCCA(
-       IN              PDM_ODM_T               pDM_Odm
-)
-{
-
-       // This should be moved out of OUTSRC
-       PADAPTER                pAdapter        = pDM_Odm->Adapter;
-       // Enable EDCCA. The value is suggested by SD3 Wilson.
-
-       //
-       // Revised for ASUS 11b/g performance issues, suggested by BB Neil, 2012.04.13.
-       //
-       if((pDM_Odm->SupportICType == ODM_RTL8723A)&&(IS_WIRELESS_MODE_G(pAdapter)))
-       {
-               //PlatformEFIOWrite1Byte(Adapter, rOFDM0_ECCAThreshold, 0x00);
-               ODM_Write1Byte(pDM_Odm,rOFDM0_ECCAThreshold,0x00);
-               ODM_Write1Byte(pDM_Odm,rOFDM0_ECCAThreshold+2,0xFD);
-
-       }
-       else
-       {
-               //PlatformEFIOWrite1Byte(Adapter, rOFDM0_ECCAThreshold, 0x03);
-               ODM_Write1Byte(pDM_Odm,rOFDM0_ECCAThreshold,0x03);
-               ODM_Write1Byte(pDM_Odm,rOFDM0_ECCAThreshold+2,0x00);
-       }
-
-       //PlatformEFIOWrite1Byte(Adapter, rOFDM0_ECCAThreshold+2, 0x00);
-}
-
-VOID
-odm_DisableEDCCA(
-       IN              PDM_ODM_T               pDM_Odm
-)
-{
-       // Disable EDCCA..
-       ODM_Write1Byte(pDM_Odm, rOFDM0_ECCAThreshold, 0x7f);
-       ODM_Write1Byte(pDM_Odm, rOFDM0_ECCAThreshold+2, 0x7f);
-}
-
-//
-// Description: According to initial gain value to determine to enable or disable EDCCA.
-//
-// Suggested by SD3 Wilson. Added by tynli. 2011.11.25.
-//
-VOID
-odm_DynamicEDCCA(
-       IN              PDM_ODM_T               pDM_Odm
-)
-{
-       PADAPTER                pAdapter        = pDM_Odm->Adapter;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(pAdapter);
-       u1Byte  RegC50, RegC58;
-       bool    bEDCCAenable = FALSE;
-
-       RegC50 = (u1Byte)ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0);
-       RegC58 = (u1Byte)ODM_GetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0);
-
-
-       if((RegC50 > 0x28 && RegC58 > 0x28) ||
-               ((pDM_Odm->SupportICType == ODM_RTL8723A && IS_WIRELESS_MODE_G(pAdapter) && RegC50>0x26)) ||
-               (pDM_Odm->SupportICType == ODM_RTL8188E && RegC50 > 0x28))
-       {
-               if(!pHalData->bPreEdccaEnable)
-               {
-                       odm_EnableEDCCA(pDM_Odm);
-                       pHalData->bPreEdccaEnable = TRUE;
-               }
-
-       }
-       else if((RegC50 < 0x25 && RegC58 < 0x25) || (pDM_Odm->SupportICType == ODM_RTL8188E && RegC50 < 0x25))
-       {
-               if(pHalData->bPreEdccaEnable)
-               {
-                       odm_DisableEDCCA(pDM_Odm);
-                       pHalData->bPreEdccaEnable = FALSE;
-               }
-       }
-}
-
-
-#endif    // end MP platform support
-
-VOID
+void
 ODM_Write_DIG(
-       IN      PDM_ODM_T               pDM_Odm,
-       IN      u1Byte                  CurrentIGI
+       PDM_ODM_T               pDM_Odm,
+       u8                      CurrentIGI
        )
 {
        pDIG_T  pDM_DigTable = &pDM_Odm->DM_DigTable;
@@ -1698,40 +1281,22 @@ ODM_Write_DIG(
                pDM_DigTable->CurIGValue = CurrentIGI;
        }
        ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_Write_DIG():CurrentIGI=0x%x \n",CurrentIGI));
-
-// Add by Neil Chen to enable edcca to MP Platform
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       // Adjust EDCCA.
-       if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES)
-               odm_DynamicEDCCA(pDM_Odm);
-#endif
-
-
 }
 
 
 //Need LPS mode for CE platform --2012--08--24---
 //8723AS/8189ES
-#if (DM_ODM_SUPPORT_TYPE == ODM_CE)
-
-VOID
+void
 odm_DIGbyRSSI_LPS(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        PADAPTER                                        pAdapter =pDM_Odm->Adapter;
        pDIG_T                                          pDM_DigTable = &pDM_Odm->DM_DigTable;
        PFALSE_ALARM_STATISTICS         pFalseAlmCnt = &pDM_Odm->FalseAlmCnt;
-
-#if 0          //and 2.3.5 coding rule
-       struct mlme_priv        *pmlmepriv = &(pAdapter->mlmepriv);
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(pAdapter);
-       struct dm_priv  *pdmpriv = &pHalData->dmpriv;
-#endif
-
-       u1Byte  RSSI_Lower=DM_DIG_MIN_NIC;   //0x1E or 0x1C
-       u1Byte  bFwCurrentInPSMode = FALSE;
-       u1Byte  CurrentIGI=pDM_Odm->RSSI_Min;
+       u8      RSSI_Lower=DM_DIG_MIN_NIC;   //0x1E or 0x1C
+       u8      bFwCurrentInPSMode = FALSE;
+       u8      CurrentIGI=pDM_Odm->RSSI_Min;
 
        if(! (pDM_Odm->SupportICType & (ODM_RTL8723A |ODM_RTL8188E)))
                return;
@@ -1780,19 +1345,18 @@ odm_DIGbyRSSI_LPS(
        ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue);
 
 }
-#endif
 
 
-VOID
+void
 odm_DIGInit(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        pDIG_T  pDM_DigTable = &pDM_Odm->DM_DigTable;
 
        //pDM_DigTable->Dig_Enable_Flag = TRUE;
        //pDM_DigTable->Dig_Ext_Port_Stage = DIG_EXT_PORT_STAGE_MAX;
-       pDM_DigTable->CurIGValue = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm));
+       pDM_DigTable->CurIGValue = (u8) ODM_GetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm));
        //pDM_DigTable->PreIGValue = 0x0;
        //pDM_DigTable->CurSTAConnectState = pDM_DigTable->PreSTAConnectState = DIG_STA_DISCONNECT;
        //pDM_DigTable->CurMultiSTAConnectState = DIG_MultiSTA_DISCONNECT;
@@ -1829,84 +1393,31 @@ odm_DIGInit(
 }
 
 
-VOID
+void
 odm_DIG(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
 
        pDIG_T                                          pDM_DigTable = &pDM_Odm->DM_DigTable;
        PFALSE_ALARM_STATISTICS         pFalseAlmCnt = &pDM_Odm->FalseAlmCnt;
        pRXHP_T                                         pRX_HP_Table  = &pDM_Odm->DM_RXHP_Table;
-       u1Byte                                          DIG_Dynamic_MIN;
-       u1Byte                                          DIG_MaxOfMin;
+       u8                                              DIG_Dynamic_MIN;
+       u8                                              DIG_MaxOfMin;
        bool                                            FirstConnect, FirstDisConnect;
-       u1Byte                                          dm_dig_max, dm_dig_min;
-       u1Byte                                          CurrentIGI = pDM_DigTable->CurIGValue;
+       u8                                              dm_dig_max, dm_dig_min;
+       u8                                              CurrentIGI = pDM_DigTable->CurIGValue;
+
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-// This should be moved out of OUTSRC
-       PADAPTER                pAdapter        = pDM_Odm->Adapter;
-#if OS_WIN_FROM_WIN7(OS_VERSION)
-       if(IsAPModeExist( pAdapter) && pAdapter->bInHctTest)
+       ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG()==>\n"));
+       //if(!(pDM_Odm->SupportAbility & (ODM_BB_DIG|ODM_BB_FA_CNT)))
+       if((!(pDM_Odm->SupportAbility&ODM_BB_DIG)) ||(!(pDM_Odm->SupportAbility&ODM_BB_FA_CNT)))
        {
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: Is AP mode or In HCT Test \n"));
+               ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: SupportAbility ODM_BB_DIG or ODM_BB_FA_CNT is disabled\n"));
                return;
        }
-#endif
-#if(BT_30_SUPPORT == 1)
-       if(pDM_Odm->bBtHsOperation)
-       {
-               odm_DigForBtHsMode(pDM_Odm);
-               return;
-       }
-#endif
-
-       if(pRX_HP_Table->RXHP_flag == 1)
-       {
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: In RXHP Operation \n"));
-               return;
-       }
-#endif  //end ODM_MP type
-
-#if (DM_ODM_SUPPORT_TYPE == ODM_CE)
-#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV
-       if((pDM_Odm->bLinked) && (pDM_Odm->Adapter->registrypriv.force_igi !=0))
-       {
-               printk("pDM_Odm->RSSI_Min=%d \n",pDM_Odm->RSSI_Min);
-               ODM_Write_DIG(pDM_Odm,pDM_Odm->Adapter->registrypriv.force_igi);
-               return;
-       }
-#endif
-#endif
-#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL))
-       prtl8192cd_priv priv                    = pDM_Odm->priv;
-       if (!((priv->up_time > 5) && (priv->up_time % 2)) )
-       {
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: Not In DIG Operation Period \n"));
-               return;
-       }
-#endif
-
-       ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG()==>\n"));
-       //if(!(pDM_Odm->SupportAbility & (ODM_BB_DIG|ODM_BB_FA_CNT)))
-       if((!(pDM_Odm->SupportAbility&ODM_BB_DIG)) ||(!(pDM_Odm->SupportAbility&ODM_BB_FA_CNT)))
-       {
-#if 0
-               if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL))
-               {
-                       if ((pDM_Odm->SupportICType == ODM_RTL8192C) && (pDM_Odm->ExtLNA == 1))
-                               CurrentIGI = 0x30; //pDM_DigTable->CurIGValue  = 0x30;
-                       else
-                               CurrentIGI = 0x20; //pDM_DigTable->CurIGValue  = 0x20;
-                       ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue);
-               }
-#endif
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: SupportAbility ODM_BB_DIG or ODM_BB_FA_CNT is disabled\n"));
-               return;
-       }
-
-       if(*(pDM_Odm->pbScanInProcess))
+
+       if(*(pDM_Odm->pbScanInProcess))
        {
                ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG() Return: In Scan Progress \n"));
                return;
@@ -1980,25 +1491,6 @@ odm_DIG(
        {
                if(pDM_Odm->SupportPlatform & (ODM_AP|ODM_ADSL))
                {
-#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL))
-#ifdef DFS
-                       if (!priv->pmib->dot11DFSEntry.disable_DFS &&
-                               (OPMODE & WIFI_AP_STATE) &&
-                               (((pDM_Odm->ControlChannel >= 52) &&
-                               (pDM_Odm->ControlChannel <= 64)) ||
-                               ((pDM_Odm->ControlChannel >= 100) &&
-                               (pDM_Odm->ControlChannel <= 140))))
-                               dm_dig_max = 0x24;
-                       else
-#endif
-                       if (priv->pmib->dot11RFEntry.tx2path) {
-                               if (*(pDM_Odm->pWirelessMode) == ODM_WM_B)//(priv->pmib->dot11BssType.net_work_type == WIRELESS_11B)
-                                       dm_dig_max = 0x2A;
-                               else
-                                       dm_dig_max = 0x32;
-                       }
-                       else
-#endif
                        dm_dig_max = DM_DIG_MAX_AP;
                        dm_dig_min = DM_DIG_MIN_AP;
                        DIG_MaxOfMin = dm_dig_max;
@@ -2083,7 +1575,7 @@ odm_DIG(
                        {
                                if(pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV)
                                {
-                                       DIG_Dynamic_MIN = (u1Byte) pDM_DigTable->AntDiv_RSSI_max;
+                                       DIG_Dynamic_MIN = (u8) pDM_DigTable->AntDiv_RSSI_max;
                                        ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_DIG(): pDM_DigTable->AntDiv_RSSI_max=%d \n",pDM_DigTable->AntDiv_RSSI_max));
                                }
                        }
@@ -2241,47 +1733,6 @@ odm_DIG(
        ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): CurIGValue=0x%x\n", CurrentIGI));
 
        //2 High power RSSI threshold
-#if (DM_ODM_SUPPORT_TYPE & ODM_MP)
-{
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(pDM_Odm->Adapter);
-
-       // for LC issue to dymanic modify DIG lower bound----------LC Mocca Issue
-       u8Byte                  curTxOkCnt=0, curRxOkCnt=0;
-       static u8Byte           lastTxOkCnt=0, lastRxOkCnt=0;
-
-       u8Byte                  OKCntAll=0;
-       //static u8Byte         TXByteCnt_A=0, TXByteCnt_B=0, RXByteCnt_A=0, RXByteCnt_B=0;
-       //u8Byte                        CurByteCnt=0, PreByteCnt=0;
-
-       curTxOkCnt = pAdapter->TxStats.NumTxBytesUnicast - lastTxOkCnt;
-       curRxOkCnt =pAdapter->RxStats.NumRxBytesUnicast - lastRxOkCnt;
-       lastTxOkCnt = pAdapter->TxStats.NumTxBytesUnicast;
-       lastRxOkCnt = pAdapter->RxStats.NumRxBytesUnicast;
-       //----------------------------------------------------------end for LC Mocca issue
-       if((pDM_Odm->SupportICType == ODM_RTL8723A)&& (pHalData->UndecoratedSmoothedPWDB > DM_DIG_HIGH_PWR_THRESHOLD))
-       {
-               // High power IGI lower bound
-               ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): UndecoratedSmoothedPWDB(%#x)\n", pHalData->UndecoratedSmoothedPWDB));
-               if(CurrentIGI < DM_DIG_HIGH_PWR_IGI_LOWER_BOUND)
-               {
-                       ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): CurIGValue(%#x)\n", pDM_DigTable->CurIGValue));
-                       //pDM_DigTable->CurIGValue = DM_DIG_HIGH_PWR_IGI_LOWER_BOUND;
-                       CurrentIGI=DM_DIG_HIGH_PWR_IGI_LOWER_BOUND;
-               }
-       }
-       if((pDM_Odm->SupportICType & ODM_RTL8723A) && IS_WIRELESS_MODE_G(pAdapter))
-               {
-                       if(pHalData->UndecoratedSmoothedPWDB > 0x28)
-                       {
-                               if(CurrentIGI < DM_DIG_Gmode_HIGH_PWR_IGI_LOWER_BOUND)
-                               {
-                                       //pDM_DigTable->CurIGValue = DM_DIG_Gmode_HIGH_PWR_IGI_LOWER_BOUND;
-                                       CurrentIGI = DM_DIG_Gmode_HIGH_PWR_IGI_LOWER_BOUND;
-                               }
-               }
-       }
-}
-#endif
 
 #if (RTL8192D_SUPPORT==1)
        if(pDM_Odm->SupportICType == ODM_RTL8192D)
@@ -2330,30 +1781,14 @@ odm_DIG(
 //3 FASLE ALARM CHECK
 //3============================================================
 
-VOID
+void
 odm_FalseAlarmCounterStatistics(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        u4Byte ret_value;
        PFALSE_ALARM_STATISTICS FalseAlmCnt = &(pDM_Odm->FalseAlmCnt);
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_AP)
-       prtl8192cd_priv priv            = pDM_Odm->priv;
-       if( (priv->auto_channel != 0) && (priv->auto_channel != 2) )
-               return;
-#endif
-
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       if((pDM_Odm->SupportICType == ODM_RTL8192D) &&
-               (*(pDM_Odm->pMacPhyMode)==ODM_DMSP)&&    ////modify by Guo.Mingzhi 2011-12-29
-               (!(*(pDM_Odm->pbMasterOfDMSP))))
-       {
-               odm_FalseAlarmCounterStatistics_ForSlaveOfDMSP(pDM_Odm);
-               return;
-       }
-#endif
-
        if(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))
                return;
 
@@ -2411,7 +1846,7 @@ odm_FalseAlarmCounterStatistics(
                FalseAlmCnt->Cnt_CCK_CCA = ((ret_value&0xFF)<<8) |((ret_value&0xFF00)>>8);
        }
 
-       FalseAlmCnt->Cnt_all = (        FalseAlmCnt->Cnt_Fast_Fsync +
+       FalseAlmCnt->Cnt_all = (FalseAlmCnt->Cnt_Fast_Fsync +
                                                FalseAlmCnt->Cnt_SB_Search_fail +
                                                FalseAlmCnt->Cnt_Parity_Fail +
                                                FalseAlmCnt->Cnt_Rate_Illegal +
@@ -2481,31 +1916,16 @@ odm_FalseAlarmCounterStatistics(
 //3 CCK Packet Detect Threshold
 //3============================================================
 
-VOID
+void
 odm_CCKPacketDetectionThresh(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
 
        pDIG_T  pDM_DigTable = &pDM_Odm->DM_DigTable;
-       u1Byte  CurCCK_CCAThres;
+       u8      CurCCK_CCAThres;
        PFALSE_ALARM_STATISTICS FalseAlmCnt = &(pDM_Odm->FalseAlmCnt);
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-//modify by Guo.Mingzhi 2011-12-29
-       if (pDM_Odm->bDualMacSmartConcurrent == TRUE)
-//     if (pDM_Odm->bDualMacSmartConcurrent == FALSE)
-               return;
-#if(BT_30_SUPPORT == 1)
-       if(pDM_Odm->bBtHsOperation)
-       {
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() write 0xcd for BT HS mode!!\n"));
-               ODM_Write_CCK_CCA_Thres(pDM_Odm, 0xcd);
-               return;
-       }
-#endif
-#endif
-
        if(!(pDM_Odm->SupportAbility & (ODM_BB_CCK_PD|ODM_BB_FA_CNT)))
                return;
 
@@ -2542,10 +1962,10 @@ odm_CCKPacketDetectionThresh(
                ODM_Write_CCK_CCA_Thres(pDM_Odm, CurCCK_CCAThres);
 }
 
-VOID
+void
 ODM_Write_CCK_CCA_Thres(
-       IN      PDM_ODM_T               pDM_Odm,
-       IN      u1Byte                  CurCCK_CCAThres
+       PDM_ODM_T               pDM_Odm,
+       u8                      CurCCK_CCAThres
        )
 {
        pDIG_T  pDM_DigTable = &pDM_Odm->DM_DigTable;
@@ -2562,9 +1982,9 @@ ODM_Write_CCK_CCA_Thres(
 //3============================================================
 //3 BB Power Save
 //3============================================================
-VOID
+void
 odm_DynamicBBPowerSavingInit(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        pPS_T   pDM_PSTable = &pDM_Odm->DM_PSTable;
@@ -2578,13 +1998,11 @@ odm_DynamicBBPowerSavingInit(
 }
 
 
-VOID
+void
 odm_DynamicBBPowerSaving(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE & (ODM_MP|ODM_CE))
-
        if ((pDM_Odm->SupportICType != ODM_RTL8192C) && (pDM_Odm->SupportICType != ODM_RTL8723A))
                return;
        if(!(pDM_Odm->SupportAbility & ODM_BB_PWR_SAVE))
@@ -2605,13 +2023,11 @@ odm_DynamicBBPowerSaving(
        {
                ODM_RF_Saving(pDM_Odm, FALSE);
        }
-#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
 }
 
-VOID
+void
 odm_1R_CCA(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        )
 {
        pPS_T   pDM_PSTable = &pDM_Odm->DM_PSTable;
@@ -2665,21 +2081,18 @@ odm_1R_CCA(
 
 void
 ODM_RF_Saving(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      u1Byte          bForceInNormal
+       PDM_ODM_T       pDM_Odm,
+       u8              bForceInNormal
        )
 {
-#if (DM_ODM_SUPPORT_TYPE != ODM_AP)
        pPS_T   pDM_PSTable = &pDM_Odm->DM_PSTable;
-       u1Byte  Rssi_Up_bound = 30 ;
-       u1Byte  Rssi_Low_bound = 25;
-       #if (DM_ODM_SUPPORT_TYPE == ODM_CE)
+       u8      Rssi_Up_bound = 30 ;
+       u8      Rssi_Low_bound = 25;
        if(pDM_Odm->PatchID == 40 ) //RT_CID_819x_FUNAI_TV
        {
                Rssi_Up_bound = 50 ;
                Rssi_Low_bound = 45;
        }
-       #endif
        if(pDM_PSTable->initialize == 0){
 
                pDM_PSTable->Reg874 = (ODM_GetBBReg(pDM_Odm, 0x874, bMaskDWord)&0x1CC000)>>14;
@@ -2751,7 +2164,6 @@ ODM_RF_Saving(
                }
                pDM_PSTable->PreRFState =pDM_PSTable->CurRFState;
        }
-#endif
 }
 
 
@@ -2762,60 +2174,34 @@ ODM_RF_Saving(
 //3 Rate Adaptive
 //3============================================================
 
-VOID
+void
 odm_RateAdaptiveMaskInit(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        )
 {
        PODM_RATE_ADAPTIVE      pOdmRA = &pDM_Odm->RateAdaptive;
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       PMGNT_INFO                              pMgntInfo = &pDM_Odm->Adapter->MgntInfo;
-       PRATE_ADAPTIVE                  pRA = (PRATE_ADAPTIVE)&pMgntInfo->RateAdaptive;
-
-       pRA->RATRState = DM_RATR_STA_INIT;
-       if (pMgntInfo->DM_Type == DM_Type_ByDriver)
-               pMgntInfo->bUseRAMask = TRUE;
-       else
-               pMgntInfo->bUseRAMask = FALSE;
-
-#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
        pOdmRA->Type = DM_Type_ByDriver;
        if (pOdmRA->Type == DM_Type_ByDriver)
                pDM_Odm->bUseRAMask = _TRUE;
        else
                pDM_Odm->bUseRAMask = _FALSE;
 
-#endif
-
        pOdmRA->RATRState = DM_RATR_STA_INIT;
        pOdmRA->HighRSSIThresh = 50;
        pOdmRA->LowRSSIThresh = 20;
 }
 
-#if (DM_ODM_SUPPORT_TYPE & ODM_MP)
-VOID
-ODM_RateAdaptiveStateApInit(
-       IN      PADAPTER        Adapter ,
-       IN      PRT_WLAN_STA  pEntry
-       )
-{
-       PRATE_ADAPTIVE  pRA = (PRATE_ADAPTIVE)&pEntry->RateAdaptive;
-       pRA->RATRState = DM_RATR_STA_INIT;
-}
-#endif
-
-#if (DM_ODM_SUPPORT_TYPE == ODM_CE)
 u4Byte ODM_Get_Rate_Bitmap(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      u4Byte          macid,
-       IN      u4Byte          ra_mask,
-       IN      u1Byte          rssi_level)
+       PDM_ODM_T       pDM_Odm,
+       u4Byte          macid,
+       u4Byte          ra_mask,
+       u8              rssi_level)
 {
        PSTA_INFO_T     pEntry;
        u4Byte  rate_bitmap = 0x0fffffff;
-       u1Byte  WirelessMode;
-       //u1Byte        WirelessMode =*(pDM_Odm->pWirelessMode);
+       u8      WirelessMode;
+       //u8    WirelessMode =*(pDM_Odm->pWirelessMode);
 
 
        pEntry = pDM_Odm->pODM_StaInfo[macid];
@@ -2852,7 +2238,7 @@ u4Byte ODM_Get_Rate_Bitmap(
                case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G)    :
                case (ODM_WM_A|ODM_WM_B|ODM_WM_G|ODM_WM_N24G)   :
                        {
-                               if (    pDM_Odm->RFType == ODM_1T2R ||pDM_Odm->RFType == ODM_1T1R)
+                               if (pDM_Odm->RFType == ODM_1T2R ||pDM_Odm->RFType == ODM_1T1R)
                                {
                                        if(rssi_level == DM_RATR_STA_HIGH)
                                        {
@@ -2906,7 +2292,6 @@ u4Byte ODM_Get_Rate_Bitmap(
        return rate_bitmap;
 
 }
-#endif
 
 /*-----------------------------------------------------------------------------
  * Function:   odm_RefreshRateAdaptiveMask()
@@ -2924,9 +2309,9 @@ u4Byte ODM_Get_Rate_Bitmap(
  *     05/27/2009      hpfan   Create Version 0.
  *
  *---------------------------------------------------------------------------*/
-VOID
+void
 odm_RefreshRateAdaptiveMask(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        if (!(pDM_Odm->SupportAbility & ODM_BB_RA_MASK))
@@ -2954,130 +2339,20 @@ odm_RefreshRateAdaptiveMask(
 
 }
 
-VOID
+void
 odm_RefreshRateAdaptiveMaskMP(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       PADAPTER        pAdapter         =  pDM_Odm->Adapter;
-       PADAPTER                                pTargetAdapter = NULL;
-       HAL_DATA_TYPE                   *pHalData = GET_HAL_DATA(pAdapter);
-       PMGNT_INFO                              pMgntInfo = GetDefaultMgntInfo(pAdapter);
-       //PRATE_ADAPTIVE                        pRA = (PRATE_ADAPTIVE)&pMgntInfo->RateAdaptive;
-       PODM_RATE_ADAPTIVE              pRA = &pDM_Odm->RateAdaptive;
-
-       if(pAdapter->bDriverStopped)
-       {
-               ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n"));
-               return;
-       }
-
-       if(!pMgntInfo->bUseRAMask)
-       {
-               ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n"));
-               return;
-       }
-
-       // if default port is connected, update RA table for default port (infrastructure mode only)
-       if(pAdapter->MgntInfo.mAssoc && (!ACTING_AS_AP(pAdapter)))
-       {
-               if( ODM_RAStateCheck(pDM_Odm, pHalData->UndecoratedSmoothedPWDB, pMgntInfo->bSetTXPowerTrainingByOid, &pRA->RATRState) )
-               {
-                       ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr : "), pMgntInfo->Bssid);
-                       ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pHalData->UndecoratedSmoothedPWDB, pRA->RATRState));
-                       pAdapter->HalFunc.UpdateHalRAMaskHandler(
-                                                                       pAdapter,
-                                                                       FALSE,
-                                                                       0,
-                                                                       NULL,
-                                                                       NULL,
-                                                                       pRA->RATRState,
-                                                                       RAMask_Normal);
-               }
-       }
-
-       //
-       // The following part configure AP/VWifi/IBSS rate adaptive mask.
-       //
-
-       if(pMgntInfo->mIbss)
-       {
-               // Target: AP/IBSS peer.
-               pTargetAdapter = GetDefaultAdapter(pAdapter);
-       }
-       else
-       {
-               pTargetAdapter = GetFirstAPAdapter(pAdapter);
-       }
-
-       // if extension port (softap) is started, updaet RA table for more than one clients associate
-       if(pTargetAdapter != NULL)
-       {
-               int     i;
-               PRT_WLAN_STA    pEntry;
-               PRATE_ADAPTIVE     pEntryRA;
-
-               for(i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++)
-               {
-#if 0  //By YJ,120208
-                       if(     pTargetAdapter->MgntInfo.AsocEntry[i].bUsed && pTargetAdapter->MgntInfo.AsocEntry[i].bAssociated)
-                       {
-                               pEntry = pTargetAdapter->MgntInfo.AsocEntry+i;
-                               pEntryRA = &pEntry->RateAdaptive;
-                               if( ODM_RAStateCheck(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pMgntInfo->bSetTXPowerTrainingByOid, &pEntryRA->RATRState) )
-                               {
-                                       ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), pEntry->MacAddr);
-                                       ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntryRA->RATRState));
-                                       pAdapter->HalFunc.UpdateHalRAMaskHandler(
-                                                                                       pTargetAdapter,
-                                                                                       FALSE,
-                                                                                       pEntry->AID+1,
-                                                                                       pEntry->MacAddr,
-                                                                                       pEntry,
-                                                                                       pEntryRA->RATRState,
-                                                                                       RAMask_Normal);
-                               }
-                       }
-#else
-                       pEntry = AsocEntry_EnumStation(pTargetAdapter, i);
-                       if(NULL != pEntry)
-                       {
-                               if(pEntry->bAssociated)
-                               {
-                                       pEntryRA = &pEntry->RateAdaptive;
-                                       if( ODM_RAStateCheck(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pMgntInfo->bSetTXPowerTrainingByOid, &pEntryRA->RATRState) )
-                                       {
-                                               ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), pEntry->MacAddr);
-                                               ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntryRA->RATRState));
-                                               pAdapter->HalFunc.UpdateHalRAMaskHandler(
-                                                                                       pTargetAdapter,
-                                                                                       FALSE,
-                                                                                       pEntry->AID+1,
-                                                                                       pEntry->MacAddr,
-                                                                                       pEntry,
-                                                                                       pEntryRA->RATRState,
-                                                                                       RAMask_Normal);
-                                       }
-                               }
-                       }
-#endif
-               }
-       }
-
-       if(pMgntInfo->bSetTXPowerTrainingByOid)
-               pMgntInfo->bSetTXPowerTrainingByOid = FALSE;
-#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_MP)
 }
 
 
-VOID
+void
 odm_RefreshRateAdaptiveMaskCE(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_CE)
-       u1Byte  i;
+       u8      i;
        PADAPTER        pAdapter         =  pDM_Odm->Adapter;
 
        if(pAdapter->bDriverStopped)
@@ -3107,61 +2382,30 @@ odm_RefreshRateAdaptiveMaskCE(
                }
        }
 
-#endif
 }
 
-VOID
+void
 odm_RefreshRateAdaptiveMaskAPADSL(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL))
-       struct rtl8192cd_priv *priv = pDM_Odm->priv;
-       struct stat_info        *pstat;
-
-       if (!priv->pmib->dot11StationConfigEntry.autoRate)
-               return;
-
-       if (list_empty(&priv->asoc_list))
-               return;
-
-       list_for_each_entry(pstat, &priv->asoc_list, asoc_list) {
-               if(ODM_RAStateCheck(pDM_Odm, (s4Byte)pstat->rssi, FALSE, &pstat->rssi_level) ) {
-                       ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), pstat->hwaddr);
-                       ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi, pstat->rssi_level));
-
-#ifdef CONFIG_RTL_88E_SUPPORT
-                       if (GET_CHIP_VER(priv)==VERSION_8188E) {
-#ifdef TXREPORT
-                               add_RATid(priv, pstat);
-#endif
-                       } else
-#endif
-                       {
-#if defined(CONFIG_RTL_92D_SUPPORT) || defined(CONFIG_RTL_92C_SUPPORT)
-                       add_update_RATid(priv, pstat);
-#endif
-                       }
-               }
-       }
-#endif
 }
 
 // Return Value: bool
 // - TRUE: RATRState is changed.
 bool
 ODM_RAStateCheck(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              s4Byte                  RSSI,
-       IN              bool                    bForceUpdate,
-       OUT             pu1Byte                 pRATRState
+               PDM_ODM_T               pDM_Odm,
+               s4Byte                  RSSI,
+               bool                    bForceUpdate,
+               u8 *                    pRATRState
        )
 {
        PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive;
-       const u1Byte GoUpGap = 5;
-       u1Byte HighRSSIThreshForRA = pRA->HighRSSIThresh;
-       u1Byte LowRSSIThreshForRA = pRA->LowRSSIThresh;
-       u1Byte RATRState;
+       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.
@@ -3212,42 +2456,17 @@ ODM_RAStateCheck(
 //3 Dynamic Tx Power
 //3============================================================
 
-VOID
+void
 odm_DynamicTxPowerInit(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       PADAPTER        Adapter = pDM_Odm->Adapter;
-       PMGNT_INFO                      pMgntInfo = &Adapter->MgntInfo;
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-
-       #if DEV_BUS_TYPE==RT_USB_INTERFACE
-       if(RT_GetInterfaceSelection(Adapter) == INTF_SEL1_USB_High_Power)
-       {
-               odm_DynamicTxPowerSavePowerIndex(pDM_Odm);
-               pMgntInfo->bDynamicTxPowerEnable = TRUE;
-       }
-       else
-       #else
-       //so 92c pci do not need dynamic tx power? vivi check it later
-       if(IS_HARDWARE_TYPE_8192D(Adapter))
-               pMgntInfo->bDynamicTxPowerEnable = TRUE;
-       else
-               pMgntInfo->bDynamicTxPowerEnable = FALSE;
-       #endif
-
-
-       pHalData->LastDTPLvl = TxHighPwrLevel_Normal;
-       pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal;
-#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
        PADAPTER        Adapter = pDM_Odm->Adapter;
        HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
        struct dm_priv  *pdmpriv = &pHalData->dmpriv;
        pdmpriv->bDynamicTxPowerEnable = _FALSE;
 
        #if (RTL8192C_SUPPORT==1)
-       #ifdef CONFIG_USB_HCI
 
        #ifdef CONFIG_INTEL_PROXIM
        if((pHalData->BoardType == BOARD_USB_High_PA)||(Adapter->proximity.proxim_support==_TRUE))
@@ -3261,69 +2480,49 @@ odm_DynamicTxPowerInit(
                pdmpriv->bDynamicTxPowerEnable = _TRUE;
        }
        else
-       #else
-               pdmpriv->bDynamicTxPowerEnable = _FALSE;
-       #endif
        #endif
 
        pdmpriv->LastDTPLvl = TxHighPwrLevel_Normal;
        pdmpriv->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal;
-
-#endif
-
 }
 
-VOID
+void
 odm_DynamicTxPowerSavePowerIndex(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-       u1Byte          index;
+       u8              index;
        u4Byte          Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a};
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       PADAPTER        Adapter = pDM_Odm->Adapter;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       for(index = 0; index< 6; index++)
-               pHalData->PowerIndex_backup[index] = PlatformEFIORead1Byte(Adapter, Power_Index_REG[index]);
-#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
        PADAPTER        Adapter = pDM_Odm->Adapter;
        HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
        struct dm_priv  *pdmpriv = &pHalData->dmpriv;
        for(index = 0; index< 6; index++)
                pdmpriv->PowerIndex_backup[index] = rtw_read8(Adapter, Power_Index_REG[index]);
-#endif
 }
 
-VOID
+void
 odm_DynamicTxPowerRestorePowerIndex(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-       u1Byte                  index;
+       u8                      index;
        PADAPTER                Adapter = pDM_Odm->Adapter;
 
-#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_MP))
        HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
        u4Byte                  Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a};
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       for(index = 0; index< 6; index++)
-               PlatformEFIOWrite1Byte(Adapter, Power_Index_REG[index], pHalData->PowerIndex_backup[index]);
-#elif(DM_ODM_SUPPORT_TYPE == ODM_CE)
        struct dm_priv  *pdmpriv = &pHalData->dmpriv;
        for(index = 0; index< 6; index++)
                rtw_write8(Adapter, Power_Index_REG[index], pdmpriv->PowerIndex_backup[index]);
-#endif
-#endif
 }
 
-VOID
+void
 odm_DynamicTxPowerWritePowerIndex(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      u1Byte          Value)
+       PDM_ODM_T       pDM_Odm,
+       u8              Value)
 {
 
-       u1Byte                  index;
+       u8                      index;
        u4Byte                  Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a};
 
        for(index = 0; index< 6; index++)
@@ -3333,9 +2532,9 @@ odm_DynamicTxPowerWritePowerIndex(
 }
 
 
-VOID
+void
 odm_DynamicTxPower(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        //
@@ -3377,16 +2576,14 @@ odm_DynamicTxPower(
 }
 
 
-VOID
+void
 odm_DynamicTxPowerNIC(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR))
                return;
 
-#if (DM_ODM_SUPPORT_TYPE & (ODM_MP|ODM_CE))
-
        if(pDM_Odm->SupportICType == ODM_RTL8192C)
        {
                odm_DynamicTxPower_92C(pDM_Odm);
@@ -3404,189 +2601,42 @@ odm_DynamicTxPowerNIC(
                // ???
                // This part need to be redefined.
        }
-#endif
 }
 
-VOID
+void
 odm_DynamicTxPowerAP(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
 
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_AP)
-       prtl8192cd_priv priv            = pDM_Odm->priv;
-       s4Byte i;
-
-       if(!priv->pshare->rf_ft_var.tx_pwr_ctrl)
-               return;
-
-#ifdef HIGH_POWER_EXT_PA
-       if(pDM_Odm->ExtPA)
-               tx_power_control(priv);
-#endif
-
-       /*
-        *      Check if station is near by to use lower tx power
-        */
-
-       if ((priv->up_time % 3) == 0 )  {
-               for(i=0; i<ODM_ASSOCIATE_ENTRY_NUM; i++){
-                       PSTA_INFO_T pstat = pDM_Odm->pODM_StaInfo[i];
-                       if(IS_STA_VALID(pstat) ) {
-                               if ((pstat->hp_level == 0) && (pstat->rssi > TX_POWER_NEAR_FIELD_THRESH_AP+4))
-                                       pstat->hp_level = 1;
-                               else if ((pstat->hp_level == 1) && (pstat->rssi < TX_POWER_NEAR_FIELD_THRESH_AP))
-                                       pstat->hp_level = 0;
-                       }
-               }
-       }
-
-#endif
 }
 
 
-VOID
+void
 odm_DynamicTxPower_92C(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
+       #if (RTL8192C_SUPPORT==1)
        PADAPTER Adapter = pDM_Odm->Adapter;
-       PMGNT_INFO                      pMgntInfo = &Adapter->MgntInfo;
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-       s4Byte                          UndecoratedSmoothedPWDB;
-
-
-       // STA not connected and AP not connected
-       if((!pMgntInfo->bMediaConnect) &&
-               (pHalData->EntryMinUndecoratedSmoothedPWDB == 0))
-       {
-               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("Not connected to any \n"));
-               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal;
+       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
+       struct dm_priv  *pdmpriv = &pHalData->dmpriv;
+       struct mlme_priv        *pmlmepriv = &(Adapter->mlmepriv);
+       struct mlme_ext_priv    *pmlmeext = &Adapter->mlmeextpriv;
+       int     UndecoratedSmoothedPWDB;
 
-               //the LastDTPlvl should reset when disconnect,
-               //otherwise the tx power level wouldn't change when disconnect and connect again.
-               // Maddest 20091220.
-                pHalData->LastDTPLvl=TxHighPwrLevel_Normal;
+       if(!pdmpriv->bDynamicTxPowerEnable)
                return;
-       }
 
-#if (INTEL_PROXIMITY_SUPPORT == 1)
-       // Intel set fixed tx power
-       if(pMgntInfo->IntelProximityModeInfo.PowerOutput > 0)
-       {
-               switch(pMgntInfo->IntelProximityModeInfo.PowerOutput){
-                       case 1:
-                               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_100;
-                               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_100\n"));
-                               break;
-                       case 2:
-                               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_70;
-                               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_70\n"));
-                               break;
-                       case 3:
-                               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_50;
-                               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_50\n"));
-                               break;
-                       case 4:
-                               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_35;
-                               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_35\n"));
-                               break;
-                       case 5:
-                               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_15;
-                               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_15\n"));
-                               break;
-                       default:
-                               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_100;
-                               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_100\n"));
-                               break;
-               }
-       }
-       else
-#endif
-       {
-               if(     (pMgntInfo->bDynamicTxPowerEnable != TRUE) ||
-                       (pHalData->DMFlag & HAL_DM_HIPWR_DISABLE) ||
-                       pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_HIGH_POWER)
-               {
-                       pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal;
-               }
-               else
-               {
-                       if(pMgntInfo->bMediaConnect)    // Default port
+#ifdef CONFIG_INTEL_PROXIM
+       if(Adapter->proximity.proxim_on== _TRUE){
+               struct proximity_priv *prox_priv=Adapter->proximity.proximity_priv;
+               // Intel set fixed tx power
+               printk("\n %s  Adapter->proximity.proxim_on=%d prox_priv->proxim_modeinfo->power_output=%d \n",__FUNCTION__,Adapter->proximity.proxim_on,prox_priv->proxim_modeinfo->power_output);
+               if(prox_priv!=NULL){
+                       if(prox_priv->proxim_modeinfo->power_output> 0)
                        {
-                               if(ACTING_AS_AP(Adapter) || ACTING_AS_IBSS(Adapter))
-                               {
-                                       UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB;
-                                       ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("AP Client PWDB = 0x%x \n", UndecoratedSmoothedPWDB));
-                               }
-                               else
-                               {
-                                       UndecoratedSmoothedPWDB = pHalData->UndecoratedSmoothedPWDB;
-                                       ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("STA Default Port PWDB = 0x%x \n", UndecoratedSmoothedPWDB));
-                               }
-                       }
-                       else // associated entry pwdb
-                       {
-                               UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB;
-                               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("AP Ext Port PWDB = 0x%x \n", UndecoratedSmoothedPWDB));
-                       }
-
-                       if(UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL2)
-                       {
-                               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level2;
-                               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x0)\n"));
-                       }
-                       else if((UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL2-3)) &&
-                               (UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL1) )
-                       {
-                               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1;
-                               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x10)\n"));
-                       }
-                       else if(UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL1-5))
-                       {
-                               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal;
-                               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_Normal\n"));
-                       }
-               }
-       }
-       if( pHalData->DynamicTxHighPowerLvl != pHalData->LastDTPLvl )
-       {
-               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("PHY_SetTxPowerLevel8192C() Channel = %d \n" , pHalData->CurrentChannel));
-               PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel);
-               if(     (pHalData->DynamicTxHighPowerLvl == TxHighPwrLevel_Normal) &&
-                       (pHalData->LastDTPLvl == TxHighPwrLevel_Level1 || pHalData->LastDTPLvl == TxHighPwrLevel_Level2)) //TxHighPwrLevel_Normal
-                       odm_DynamicTxPowerRestorePowerIndex(pDM_Odm);
-               else if(pHalData->DynamicTxHighPowerLvl == TxHighPwrLevel_Level1)
-                       odm_DynamicTxPowerWritePowerIndex(pDM_Odm, 0x14);
-               else if(pHalData->DynamicTxHighPowerLvl == TxHighPwrLevel_Level2)
-                       odm_DynamicTxPowerWritePowerIndex(pDM_Odm, 0x10);
-       }
-       pHalData->LastDTPLvl = pHalData->DynamicTxHighPowerLvl;
-
-
-#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
-
-       #if (RTL8192C_SUPPORT==1)
-       PADAPTER Adapter = pDM_Odm->Adapter;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       struct dm_priv  *pdmpriv = &pHalData->dmpriv;
-       struct mlme_priv        *pmlmepriv = &(Adapter->mlmepriv);
-       struct mlme_ext_priv    *pmlmeext = &Adapter->mlmeextpriv;
-       int     UndecoratedSmoothedPWDB;
-
-       if(!pdmpriv->bDynamicTxPowerEnable)
-               return;
-
-#ifdef CONFIG_INTEL_PROXIM
-       if(Adapter->proximity.proxim_on== _TRUE){
-               struct proximity_priv *prox_priv=Adapter->proximity.proximity_priv;
-               // Intel set fixed tx power
-               printk("\n %s  Adapter->proximity.proxim_on=%d prox_priv->proxim_modeinfo->power_output=%d \n",__FUNCTION__,Adapter->proximity.proxim_on,prox_priv->proxim_modeinfo->power_output);
-               if(prox_priv!=NULL){
-                       if(prox_priv->proxim_modeinfo->power_output> 0)
-                       {
-                               switch(prox_priv->proxim_modeinfo->power_output)
+                               switch(prox_priv->proxim_modeinfo->power_output)
                                {
                                        case 1:
                                                pdmpriv->DynamicTxHighPowerLvl  = TxHighPwrLevel_100;
@@ -3635,22 +2685,7 @@ odm_DynamicTxPower_92C(
 
                if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)       // Default port
                {
-               #if 0
-                       //todo: AP Mode
-                       if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) ||
-                              (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE))
-                       {
-                               UndecoratedSmoothedPWDB = pdmpriv->EntryMinUndecoratedSmoothedPWDB;
-                               //ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("AP Client PWDB = 0x%x \n", UndecoratedSmoothedPWDB));
-                       }
-                       else
-                       {
-                               UndecoratedSmoothedPWDB = pdmpriv->UndecoratedSmoothedPWDB;
-                               //ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("STA Default Port PWDB = 0x%x \n", UndecoratedSmoothedPWDB));
-                       }
-               #else
-               UndecoratedSmoothedPWDB = pdmpriv->EntryMinUndecoratedSmoothedPWDB;
-               #endif
+                       UndecoratedSmoothedPWDB = pdmpriv->EntryMinUndecoratedSmoothedPWDB;
                }
                else // associated entry pwdb
                {
@@ -3687,174 +2722,14 @@ odm_DynamicTxPower_92C(
        }
        pdmpriv->LastDTPLvl = pdmpriv->DynamicTxHighPowerLvl;
        #endif
-#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
 }
 
 
-VOID
+void
 odm_DynamicTxPower_92D(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       PADAPTER Adapter = pDM_Odm->Adapter;
-       PMGNT_INFO                      pMgntInfo = &Adapter->MgntInfo;
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-       s4Byte                          UndecoratedSmoothedPWDB;
-
-       PADAPTER        BuddyAdapter = Adapter->BuddyAdapter;
-       bool            bGetValueFromBuddyAdapter = dm_DualMacGetParameterFromBuddyAdapter(Adapter);
-       u1Byte          HighPowerLvlBackForMac0 = TxHighPwrLevel_Level1;
-
-
-       // If dynamic high power is disabled.
-       if( (pMgntInfo->bDynamicTxPowerEnable != TRUE) ||
-               (pHalData->DMFlag & HAL_DM_HIPWR_DISABLE) ||
-               pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_HIGH_POWER)
-       {
-               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal;
-               return;
-       }
-
-       // STA not connected and AP not connected
-       if((!pMgntInfo->bMediaConnect) &&
-               (pHalData->EntryMinUndecoratedSmoothedPWDB == 0))
-       {
-               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("Not connected to any \n"));
-               pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal;
-
-               //the LastDTPlvl should reset when disconnect,
-               //otherwise the tx power level wouldn't change when disconnect and connect again.
-               // Maddest 20091220.
-                pHalData->LastDTPLvl=TxHighPwrLevel_Normal;
-               return;
-       }
-
-       if(pMgntInfo->bMediaConnect)    // Default port
-       {
-               if(ACTING_AS_AP(Adapter) || pMgntInfo->mIbss)
-               {
-                       UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB;
-                       ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("AP Client PWDB = 0x%x \n", UndecoratedSmoothedPWDB));
-               }
-               else
-               {
-                       UndecoratedSmoothedPWDB = pHalData->UndecoratedSmoothedPWDB;
-                       ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("STA Default Port PWDB = 0x%x \n", UndecoratedSmoothedPWDB));
-               }
-       }
-       else // associated entry pwdb
-       {
-               UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB;
-               ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("AP Ext Port PWDB = 0x%x \n", UndecoratedSmoothedPWDB));
-       }
-
-       if(IS_HARDWARE_TYPE_8192D(Adapter) && GET_HAL_DATA(Adapter)->CurrentBandType92D == 1){
-               if(UndecoratedSmoothedPWDB >= 0x33)
-               {
-                       pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level2;
-                       ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("5G:TxHighPwrLevel_Level2 (TxPwr=0x0)\n"));
-               }
-               else if((UndecoratedSmoothedPWDB <0x33) &&
-                       (UndecoratedSmoothedPWDB >= 0x2b) )
-               {
-                       pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1;
-                       ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("5G:TxHighPwrLevel_Level1 (TxPwr=0x10)\n"));
-               }
-               else if(UndecoratedSmoothedPWDB < 0x2b)
-               {
-                       pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal;
-                       ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("5G:TxHighPwrLevel_Normal\n"));
-               }
-
-       }
-       else
-
-       {
-               if(UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL2)
-               {
-                       pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1;
-                       ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x0)\n"));
-               }
-               else if((UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL2-3)) &&
-                       (UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL1) )
-               {
-                       pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1;
-                       ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x10)\n"));
-               }
-               else if(UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL1-5))
-               {
-                       pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal;
-                       ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("TxHighPwrLevel_Normal\n"));
-               }
-
-       }
-
-//sherry  delete flag 20110517
-       if(bGetValueFromBuddyAdapter)
-       {
-               ODM_RT_TRACE(pDM_Odm,COMP_MLME,DBG_LOUD,("dm_DynamicTxPower() mac 0 for mac 1 \n"));
-               if(Adapter->DualMacDMSPControl.bChangeTxHighPowerLvlForAnotherMacOfDMSP)
-               {
-                       ODM_RT_TRACE(pDM_Odm,COMP_MLME,DBG_LOUD,("dm_DynamicTxPower() change value \n"));
-                       HighPowerLvlBackForMac0 = pHalData->DynamicTxHighPowerLvl;
-                       pHalData->DynamicTxHighPowerLvl = Adapter->DualMacDMSPControl.CurTxHighLvlForAnotherMacOfDMSP;
-                       PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel);
-                       pHalData->DynamicTxHighPowerLvl = HighPowerLvlBackForMac0;
-                       Adapter->DualMacDMSPControl.bChangeTxHighPowerLvlForAnotherMacOfDMSP = FALSE;
-               }
-       }
-
-       if( (pHalData->DynamicTxHighPowerLvl != pHalData->LastDTPLvl) )
-       {
-                       ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("PHY_SetTxPowerLevel8192S() Channel = %d \n" , pHalData->CurrentChannel));
-                       if(Adapter->DualMacSmartConcurrent == TRUE)
-                       {
-                               if(BuddyAdapter == NULL)
-                               {
-                                       ODM_RT_TRACE(pDM_Odm,COMP_MLME,DBG_LOUD,("dm_DynamicTxPower() BuddyAdapter == NULL case \n"));
-                                       if(!Adapter->bSlaveOfDMSP)
-                                       {
-                                               PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel);
-                                       }
-                               }
-                               else
-                               {
-                                       if(pHalData->MacPhyMode92D == DUALMAC_SINGLEPHY)
-                                       {
-                                               ODM_RT_TRACE(pDM_Odm,COMP_MLME,DBG_LOUD,("dm_DynamicTxPower() BuddyAdapter DMSP \n"));
-                                               if(Adapter->bSlaveOfDMSP)
-                                               {
-                                                       ODM_RT_TRACE(pDM_Odm,COMP_MLME,DBG_LOUD,("dm_DynamicTxPower() bslave case  \n"));
-                                                       BuddyAdapter->DualMacDMSPControl.bChangeTxHighPowerLvlForAnotherMacOfDMSP = TRUE;
-                                                       BuddyAdapter->DualMacDMSPControl.CurTxHighLvlForAnotherMacOfDMSP = pHalData->DynamicTxHighPowerLvl;
-                                               }
-                                               else
-                                               {
-                                                       ODM_RT_TRACE(pDM_Odm,COMP_MLME,DBG_LOUD,("dm_DynamicTxPower() master case  \n"));
-                                                       if(!bGetValueFromBuddyAdapter)
-                                                       {
-                                                               ODM_RT_TRACE(pDM_Odm,COMP_MLME,DBG_LOUD,("dm_DynamicTxPower() mac 0 for mac 0 \n"));
-                                                               PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel);
-                                                       }
-                                               }
-                                       }
-                                       else
-                                       {
-                                               ODM_RT_TRACE(pDM_Odm,COMP_MLME,DBG_LOUD,("dm_DynamicTxPower() BuddyAdapter DMDP\n"));
-                                               PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel);
-                                       }
-                               }
-                       }
-                       else
-                       {
-                               PHY_SetTxPowerLevel8192C(Adapter, pHalData->CurrentChannel);
-                       }
-
-               }
-       pHalData->LastDTPLvl = pHalData->DynamicTxHighPowerLvl;
-#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
 #if (RTL8192D_SUPPORT==1)
        PADAPTER Adapter = pDM_Odm->Adapter;
        HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
@@ -3892,22 +2767,7 @@ odm_DynamicTxPower_92D(
 
        if(check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)       // Default port
        {
-       #if 0
-               //todo: AP Mode
-               if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) ||
-              (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE))
-               {
-                       UndecoratedSmoothedPWDB = pdmpriv->EntryMinUndecoratedSmoothedPWDB;
-                       //ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("AP Client PWDB = 0x%x \n", UndecoratedSmoothedPWDB));
-               }
-               else
-               {
-                       UndecoratedSmoothedPWDB = pdmpriv->UndecoratedSmoothedPWDB;
-                       //ODM_RT_TRACE(pDM_Odm,COMP_HIPWR, DBG_LOUD, ("STA Default Port PWDB = 0x%x \n", UndecoratedSmoothedPWDB));
-               }
-       #else
-       UndecoratedSmoothedPWDB = pdmpriv->EntryMinUndecoratedSmoothedPWDB;
-       #endif
+               UndecoratedSmoothedPWDB = pdmpriv->EntryMinUndecoratedSmoothedPWDB;
        }
        else // associated entry pwdb
        {
@@ -4014,8 +2874,6 @@ odm_DynamicTxPower_92D(
        }
        pdmpriv->LastDTPLvl = pdmpriv->DynamicTxHighPowerLvl;
 #endif
-#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
 }
 
 
@@ -4023,16 +2881,16 @@ odm_DynamicTxPower_92D(
 //3 RSSI Monitor
 //3============================================================
 
-VOID
+void
 odm_RSSIMonitorInit(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        )
 {
 }
 
-VOID
+void
 odm_RSSIMonitorCheck(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        //
@@ -4072,143 +2930,26 @@ odm_RSSIMonitorCheck(
 }      // odm_RSSIMonitorCheck
 
 
-VOID
+void
 odm_RSSIMonitorCheckMP(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       PADAPTER        Adapter = pDM_Odm->Adapter;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       PRT_WLAN_STA    pEntry;
-       u1Byte                  i;
-       s4Byte                  tmpEntryMaxPWDB=0, tmpEntryMinPWDB=0xff;
-
-       RTPRINT(FDM, DM_PWDB, ("pHalData->UndecoratedSmoothedPWDB = 0x%x( %d)\n",
-               pHalData->UndecoratedSmoothedPWDB,
-               pHalData->UndecoratedSmoothedPWDB));
-
-       for(i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++)
-       {
-               if(IsAPModeExist(Adapter)  && GetFirstExtAdapter(Adapter) != NULL)
-               {
-                       pEntry = AsocEntry_EnumStation(GetFirstExtAdapter(Adapter), i);
-               }
-               else
-               {
-                       pEntry = AsocEntry_EnumStation(GetDefaultAdapter(Adapter), i);
-               }
-
-               if(pEntry!=NULL)
-               {
-                       if(pEntry->bAssociated)
-                       {
-                               RTPRINT_ADDR(FDM, DM_PWDB, ("pEntry->MacAddr ="), pEntry->MacAddr);
-                               RTPRINT(FDM, DM_PWDB, ("pEntry->rssi = 0x%x(%d)\n",
-                                       pEntry->rssi_stat.UndecoratedSmoothedPWDB,
-                                       pEntry->rssi_stat.UndecoratedSmoothedPWDB));
-                               if(pEntry->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB)
-                                       tmpEntryMinPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB;
-                               if(pEntry->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB)
-                                       tmpEntryMaxPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB;
-                       }
-               }
-               else
-               {
-                       break;
-               }
-       }
-
-       if(tmpEntryMaxPWDB != 0)        // If associated entry is found
-       {
-               pHalData->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB;
-               RTPRINT(FDM, DM_PWDB, ("EntryMaxPWDB = 0x%x(%d)\n",
-                       tmpEntryMaxPWDB, tmpEntryMaxPWDB));
-       }
-       else
-       {
-               pHalData->EntryMaxUndecoratedSmoothedPWDB = 0;
-       }
-       if(tmpEntryMinPWDB != 0xff) // If associated entry is found
-       {
-               pHalData->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB;
-               RTPRINT(FDM, DM_PWDB, ("EntryMinPWDB = 0x%x(%d)\n",
-                                       tmpEntryMinPWDB, tmpEntryMinPWDB));
-       }
-       else
-       {
-               pHalData->EntryMinUndecoratedSmoothedPWDB = 0;
-       }
-
-       // Indicate Rx signal strength to FW.
-       if(Adapter->MgntInfo.bUseRAMask)
-       {
-               u1Byte  H2C_Parameter[3] ={0};
-       //      DbgPrint("RxSS: %lx =%ld\n", pHalData->UndecoratedSmoothedPWDB, pHalData->UndecoratedSmoothedPWDB);
-               H2C_Parameter[2] = (u1Byte)(pHalData->UndecoratedSmoothedPWDB & 0xFF);
-               H2C_Parameter[1] = 0x20;   // fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1
-
-               ODM_FillH2CCmd(Adapter, ODM_H2C_RSSI_REPORT, 3, H2C_Parameter);
-       }
-       else
-       {
-               PlatformEFIOWrite1Byte(Adapter, 0x4fe, (u1Byte)pHalData->UndecoratedSmoothedPWDB);
-               //DbgPrint("0x4fe write %x %d\n", pHalData->UndecoratedSmoothedPWDB, pHalData->UndecoratedSmoothedPWDB);
-       }
-#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_MP)
 }
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_CE)
 //
 //sherry move from DUSC to here 20110517
 //
-static VOID
+static void
 FindMinimumRSSI_Dmsp(
-       IN      PADAPTER        pAdapter
+       PADAPTER        pAdapter
 )
 {
-#if 0
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(pAdapter);
-       struct dm_priv  *pdmpriv = &pHalData->dmpriv;
-       s32     Rssi_val_min_back_for_mac0;
-       bool            bGetValueFromBuddyAdapter = dm_DualMacGetParameterFromBuddyAdapter(pAdapter);
-       bool            bRestoreRssi = _FALSE;
-       PADAPTER        BuddyAdapter = pAdapter->BuddyAdapter;
-
-       if(pHalData->MacPhyMode92D == DUALMAC_SINGLEPHY)
-       {
-               if(BuddyAdapter!= NULL)
-               {
-                       if(pHalData->bSlaveOfDMSP)
-                       {
-                               //ODM_RT_TRACE(pDM_Odm,COMP_EASY_CONCURRENT,DBG_LOUD,("bSlavecase of dmsp\n"));
-                               BuddyAdapter->DualMacDMSPControl.RssiValMinForAnotherMacOfDMSP = pdmpriv->MinUndecoratedPWDBForDM;
-                       }
-                       else
-                       {
-                               if(bGetValueFromBuddyAdapter)
-                               {
-                                       //ODM_RT_TRACE(pDM_Odm,COMP_EASY_CONCURRENT,DBG_LOUD,("get new RSSI\n"));
-                                       bRestoreRssi = _TRUE;
-                                       Rssi_val_min_back_for_mac0 = pdmpriv->MinUndecoratedPWDBForDM;
-                                       pdmpriv->MinUndecoratedPWDBForDM = pAdapter->DualMacDMSPControl.RssiValMinForAnotherMacOfDMSP;
-                               }
-                       }
-               }
-
-       }
-
-       if(bRestoreRssi)
-       {
-               bRestoreRssi = _FALSE;
-               pdmpriv->MinUndecoratedPWDBForDM = Rssi_val_min_back_for_mac0;
-       }
-#endif
 }
 
 static void
 FindMinimumRSSI(
-IN     PADAPTER        pAdapter
+       PADAPTER        pAdapter
        )
 {
        HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(pAdapter);
@@ -4231,14 +2972,12 @@ IN      PADAPTER        pAdapter
        //DBG_8723A("%s=>MinUndecoratedPWDBForDM(%d)\n",__FUNCTION__,pdmpriv->MinUndecoratedPWDBForDM);
        //ODM_RT_TRACE(pDM_Odm,COMP_DIG, DBG_LOUD, ("MinUndecoratedPWDBForDM =%d\n",pHalData->MinUndecoratedPWDBForDM));
 }
-#endif
 
-VOID
+void
 odm_RSSIMonitorCheckCE(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_CE)
        PADAPTER        Adapter = pDM_Odm->Adapter;
        HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
        struct dm_priv  *pdmpriv = &pHalData->dmpriv;
@@ -4264,11 +3003,6 @@ odm_RSSIMonitorCheckCE(
                                        if(psta->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB)
                                                tmpEntryMaxPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB;
 
-                                       #if 0
-                                       DBG_8723A("%s mac_id:%u, mac:"MAC_FMT", rssi:%d\n", __func__,
-                                               psta->mac_id, MAC_ARG(psta->hwaddr), psta->rssi_stat.UndecoratedSmoothedPWDB);
-                                       #endif
-
                                        if(psta->rssi_stat.UndecoratedSmoothedPWDB != (-1)) {
                                                #if(RTL8192D_SUPPORT==1)
                                                PWDB_rssi[sta_cnt++] = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB<<16) | ((Adapter->stapriv.asoc_sta_count+1) << 8));
@@ -4290,16 +3024,16 @@ odm_RSSIMonitorCheckCE(
                for(i=0; i< NUM_STA; i++)
                {
                        phead = &(pstapriv->sta_hash[i]);
-                       plist = get_next(phead);
+                       plist = phead->next;
 
                        while ((rtw_end_of_queue_search(phead, plist)) == _FALSE)
                        {
-                               psta = LIST_CONTAINOR(plist, struct sta_info, hash_list);
+                               psta = container_of(plist, struct sta_info, hash_list);
 
-                               plist = get_next(plist);
+                               plist = plist->next;
 
-                               if(_rtw_memcmp(psta->hwaddr, bcast_addr, ETH_ALEN) ||
-                                       _rtw_memcmp(psta->hwaddr, myid(&Adapter->eeprompriv), ETH_ALEN))
+                               if (!memcmp(psta->hwaddr, bcast_addr, ETH_ALEN) ||
+                                   !memcmp(psta->hwaddr, myid(&Adapter->eeprompriv), ETH_ALEN))
                                        continue;
 
                                if(psta->state & WIFI_ASOC_STATE)
@@ -4376,110 +3110,36 @@ odm_RSSIMonitorCheckCE(
        #endif
 
        ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM);
-#endif//if (DM_ODM_SUPPORT_TYPE == ODM_CE)
 }
-VOID
+void
 odm_RSSIMonitorCheckAP(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_AP)
-#ifdef CONFIG_RTL_92C_SUPPORT || defined(CONFIG_RTL_92D_SUPPORT)
-
-       u4Byte i;
-       PSTA_INFO_T pstat;
-
-       for(i=0; i<ODM_ASSOCIATE_ENTRY_NUM; i++)
-       {
-               pstat = pDM_Odm->pODM_StaInfo[i];
-               if(IS_STA_VALID(pstat) )
-               {
-#ifdef STA_EXT
-                       if (REMAP_AID(pstat) < (FW_NUM_STAT - 1))
-#endif
-                               add_update_rssi(pDM_Odm->priv, pstat);
-
-               }
-       }
-#endif
-#endif
-
 }
 
 
-
-VOID
+void
 ODM_InitAllTimers(
      IN PDM_ODM_T    pDM_Odm
PDM_ODM_T     pDM_Odm
        )
 {
        ODM_InitializeTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer,
                (RT_TIMER_CALL_BACK)odm_SwAntDivChkAntSwitchCallback, NULL, "SwAntennaSwitchTimer");
-
-#if (!(DM_ODM_SUPPORT_TYPE == ODM_CE))
-#if(defined(CONFIG_HW_ANTENNA_DIVERSITY))
-#if (RTL8188E_SUPPORT == 1)
-       ODM_InitializeTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer,
-               (RT_TIMER_CALL_BACK)odm_FastAntTrainingCallback, NULL, "FastAntTrainingTimer");
-#endif
-#endif
-#endif
-
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       ODM_InitializeTimer(pDM_Odm, &pDM_Odm->PSDTimer,
-               (RT_TIMER_CALL_BACK)dm_PSDMonitorCallback, NULL, "PSDTimer");
-       //
-       //Path Diversity
-       //Neil Chen--2011--06--16--  / 2012/02/23 MH Revise Arch.
-       //
-       ODM_InitializeTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer,
-               (RT_TIMER_CALL_BACK)odm_PathDivChkAntSwitchCallback, NULL, "PathDivTimer");
-
-       ODM_InitializeTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer,
-               (RT_TIMER_CALL_BACK)odm_CCKTXPathDiversityCallback, NULL, "CCKPathDiversityTimer");
-
-       ODM_InitializeTimer(pDM_Odm, &pDM_Odm->DM_RXHP_Table.PSDTimer,
-               (RT_TIMER_CALL_BACK)odm_PSD_RXHPCallback, NULL, "PSDRXHPTimer");
-#endif
 }
 
-VOID
+void
 ODM_CancelAllTimers(
      IN PDM_ODM_T    pDM_Odm
PDM_ODM_T     pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       //
-       // 2012/01/12 MH Temp BSOD fix. We need to find NIC allocate mem fail reason in
-       // win7 platform.
-       //
-       HAL_ADAPTER_STS_CHK(pDM_Odm)
-#endif
-
        ODM_CancelTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer);
+}
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
 
-#if (RTL8188E_SUPPORT == 1)
-       ODM_CancelTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer);
-#endif
-       ODM_CancelTimer(pDM_Odm, &pDM_Odm->PSDTimer);
-       //
-       //Path Diversity
-       //Neil Chen--2011--06--16--  / 2012/02/23 MH Revise Arch.
-       //
-       ODM_CancelTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer);
-
-       ODM_CancelTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer);
-
-       ODM_CancelTimer(pDM_Odm, &pDM_Odm->DM_RXHP_Table.PSDTimer);
-#endif
-}
-
-
-VOID
+void
 ODM_ReleaseAllTimers(
      IN PDM_ODM_T    pDM_Odm
PDM_ODM_T     pDM_Odm
        )
 {
        ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->DM_SWAT_Table.SwAntennaSwitchTimer);
@@ -4488,19 +3148,6 @@ ODM_ReleaseAllTimers(
        ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer);
 #endif
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
-       ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->PSDTimer);
-       //
-       //Path Diversity
-       //Neil Chen--2011--06--16--  / 2012/02/23 MH Revise Arch.
-       //
-       ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer);
-
-       ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer);
-
-       ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->DM_RXHP_Table.PSDTimer);
-#endif
 }
 
 
@@ -4510,31 +3157,20 @@ ODM_ReleaseAllTimers(
 //3 Tx Power Tracking
 //3============================================================
 
-VOID
+void
 odm_TXPowerTrackingInit(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        )
 {
        odm_TXPowerTrackingThermalMeterInit(pDM_Odm);
 }
 
 
-VOID
+void
 odm_TXPowerTrackingThermalMeterInit(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       PADAPTER                Adapter = pDM_Odm->Adapter;
-       PMGNT_INFO              pMgntInfo = &Adapter->MgntInfo;
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-
-       pMgntInfo->bTXPowerTracking = TRUE;
-       pHalData->TXPowercount       = 0;
-       pHalData->bTXPowerTrackingInit = FALSE;
-       pHalData->TxPowerTrackControl = TRUE;
-       ODM_RT_TRACE(pDM_Odm,COMP_POWER_TRACKING, DBG_LOUD, ("pMgntInfo->bTXPowerTracking = %d\n", pMgntInfo->bTXPowerTracking));
-#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
        #ifdef CONFIG_RTL8188E
        {
                pDM_Odm->RFCalibrateInfo.bTXPowerTracking = _TRUE;
@@ -4549,35 +3185,22 @@ odm_TXPowerTrackingThermalMeterInit(
                HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
                struct dm_priv  *pdmpriv = &pHalData->dmpriv;
 
-               //if(IS_HARDWARE_TYPE_8192C(pHalData))
-               {
-                       pdmpriv->bTXPowerTracking = _TRUE;
-                       pdmpriv->TXPowercount = 0;
-                       pdmpriv->bTXPowerTrackingInit = _FALSE;
-                       pdmpriv->TxPowerTrackControl = _TRUE;
-               }
+               pdmpriv->bTXPowerTracking = _TRUE;
+               pdmpriv->TXPowercount = 0;
+               pdmpriv->bTXPowerTrackingInit = _FALSE;
+               pdmpriv->TxPowerTrackControl = _TRUE;
                MSG_8723A("pdmpriv->TxPowerTrackControl = %d\n", pdmpriv->TxPowerTrackControl);
 
        }
        #endif//endif (CONFIG_RTL8188E==1)
-#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL))
-       #ifdef RTL8188E_SUPPORT
-       {
-               pDM_Odm->RFCalibrateInfo.bTXPowerTracking = _TRUE;
-               pDM_Odm->RFCalibrateInfo.TXPowercount = 0;
-               pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = _FALSE;
-               pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE;
-       }
-       #endif
-#endif
 
     pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = TRUE;
 }
 
 
-VOID
+void
 ODM_TXPowerTrackingCheck(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        //
@@ -4616,12 +3239,11 @@ ODM_TXPowerTrackingCheck(
 
 }
 
-VOID
+void
 odm_TXPowerTrackingCheckCE(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_CE)
        PADAPTER        Adapter = pDM_Odm->Adapter;
        #if( (RTL8192C_SUPPORT==1) ||  (RTL8723A_SUPPORT==1) )
        rtl8192c_odm_CheckTXPowerTracking(Adapter);
@@ -4659,53 +3281,20 @@ odm_TXPowerTrackingCheckCE(
                pDM_Odm->RFCalibrateInfo.TM_Trigger = 0;
        }
        #endif
-
-#endif
 }
 
-VOID
+void
 odm_TXPowerTrackingCheckMP(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-       PADAPTER        Adapter = pDM_Odm->Adapter;
-
-       if (ODM_CheckPowerStatus(Adapter) == FALSE)
-               return;
-
-       if(IS_HARDWARE_TYPE_8723A(Adapter))
-               return;
-
-       if(!Adapter->bSlaveOfDMSP || Adapter->DualMacSmartConcurrent == FALSE)
-               odm_TXPowerTrackingThermalMeterCheck(Adapter);
-#endif
-
 }
 
-
-VOID
+void
 odm_TXPowerTrackingCheckAP(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE == ODM_AP)
-       prtl8192cd_priv priv            = pDM_Odm->priv;
-
-       if ( (priv->pmib->dot11RFEntry.ther) && ((priv->up_time % priv->pshare->rf_ft_var.tpt_period) == 0)){
-#ifdef CONFIG_RTL_92D_SUPPORT
-               if (GET_CHIP_VER(priv)==VERSION_8192D){
-                       tx_power_tracking_92D(priv);
-               } else
-#endif
-               {
-#ifdef CONFIG_RTL_92C_SUPPORT
-                       tx_power_tracking(priv);
-#endif
-               }
-       }
-#endif
-
 }
 
 
@@ -4718,96 +3307,43 @@ odm_TXPowerTrackingCheckAP(
 // We select left antenna as default antenna in initial process, modify it as needed
 //
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
-VOID
-odm_TXPowerTrackingThermalMeterCheck(
-       IN      PADAPTER                Adapter
-       )
-{
-#ifndef AP_BUILD_WORKAROUND
-#if (HAL_CODE_BASE==RTL8192_C)
-       PMGNT_INFO                      pMgntInfo = &Adapter->MgntInfo;
-       //HAL_DATA_TYPE                 *pHalData = GET_HAL_DATA(Adapter);
-       static u1Byte                   TM_Trigger = 0;
-       //u1Byte                                        TxPowerCheckCnt = 5;    //10 sec
-
-       if(!pMgntInfo->bTXPowerTracking /*|| (!pHalData->TxPowerTrackControl && pHalData->bAPKdone)*/)
-       {
-               return;
-       }
-
-       if(!TM_Trigger)         //at least delay 1 sec
-       {
-               if(IS_HARDWARE_TYPE_8192D(Adapter))
-                       PHY_SetRFReg(Adapter, RF_PATH_A, RF_T_METER_92D, BIT17 | BIT16, 0x03);
-               else if(IS_HARDWARE_TYPE_8188E(Adapter))
-                       PHY_SetRFReg(Adapter, RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03);
-               else
-                       PHY_SetRFReg(Adapter, RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60);
-               RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger 92C Thermal Meter!!\n"));
-
-               TM_Trigger = 1;
-               return;
-       }
-       else
-       {
-               RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n"));
-               odm_TXPowerTrackingDirectCall(Adapter); //Using direct call is instead, added by Roger, 2009.06.18.
-               TM_Trigger = 0;
-       }
-#endif
-#endif
-}
-
-#endif
-
-
 
 //3============================================================
 //3 SW Antenna Diversity
 //3============================================================
 #if(defined(CONFIG_SW_ANTENNA_DIVERSITY))
-VOID
+void
 odm_SwAntDivInit(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-#if (DM_ODM_SUPPORT_TYPE & (ODM_MP|ODM_CE))
        odm_SwAntDivInit_NIC(pDM_Odm);
-#elif(DM_ODM_SUPPORT_TYPE == ODM_AP)
-       dm_SW_AntennaSwitchInit(pDM_Odm->priv);
-#endif
 }
 #if (RTL8723A_SUPPORT==1)
 // Only for 8723A SW ANT DIV INIT--2012--07--17
-VOID
+void
 odm_SwAntDivInit_NIC_8723A(
-       IN      PDM_ODM_T               pDM_Odm)
+       PDM_ODM_T               pDM_Odm)
 {
        pSWAT_T         pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
        PADAPTER                Adapter = pDM_Odm->Adapter;
-       u1Byte                  btAntNum=BT_GetPGAntNum(Adapter);
+       u8                      btAntNum=BT_GetPGAntNum(Adapter);
 
 
-       if(IS_HARDWARE_TYPE_8723A(Adapter))
-       {
-               pDM_SWAT_Table->ANTA_ON =TRUE;
-
-               // Set default antenna B status by PG
-               if(btAntNum == Ant_x2)
-                       pDM_SWAT_Table->ANTB_ON = TRUE;
-               else if(btAntNum ==Ant_x1)
-                       pDM_SWAT_Table->ANTB_ON = FALSE;
-               else
-                       pDM_SWAT_Table->ANTB_ON = TRUE;
-       }
+       pDM_SWAT_Table->ANTA_ON =TRUE;
 
+       // Set default antenna B status by PG
+       if(btAntNum == Ant_x2)
+               pDM_SWAT_Table->ANTB_ON = TRUE;
+       else if(btAntNum ==Ant_x1)
+               pDM_SWAT_Table->ANTB_ON = FALSE;
+       else
+               pDM_SWAT_Table->ANTB_ON = TRUE;
 }
 #endif
-VOID
+void
 odm_SwAntDivInit_NIC(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        pSWAT_T         pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
@@ -4846,9 +3382,9 @@ odm_SwAntDivInit_NIC(
 // 20100514 Joseph:
 // Add new function to reset the state of antenna diversity before link.
 //
-VOID
+void
 ODM_SwAntDivResetBeforeLink(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
 
@@ -4862,9 +3398,9 @@ ODM_SwAntDivResetBeforeLink(
 // 20100514 Luke/Joseph:
 // Add new function to reset antenna diversity state after link.
 //
-VOID
+void
 ODM_SwAntDivRestAfterLink(
      IN PDM_ODM_T    pDM_Odm
PDM_ODM_T     pDM_Odm
        )
 {
        pSWAT_T         pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
@@ -4877,11 +3413,11 @@ ODM_SwAntDivRestAfterLink(
        pDM_SWAT_Table->SelectAntennaMap=0xAA;
 }
 
-VOID
+void
 ODM_SwAntDivChkPerPktRssi(
      IN PDM_ODM_T    pDM_Odm,
      IN u1Byte               StationID,
      IN PODM_PHY_INFO_T pPhyInfo
PDM_ODM_T     pDM_Odm,
u8            StationID,
+ PODM_PHY_INFO_T pPhyInfo
        )
 {
        SWAT_T          *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
@@ -4908,10 +3444,10 @@ ODM_SwAntDivChkPerPktRssi(
 }
 
 //
-VOID
+void
 odm_SwAntDivChkAntSwitch(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              u1Byte                  Step
+               PDM_ODM_T               pDM_Odm,
+               u8                      Step
        )
 {
        //
@@ -4935,10 +3471,6 @@ odm_SwAntDivChkAntSwitch(
 
                case    ODM_AP:
                case    ODM_ADSL:
-#if (DM_ODM_SUPPORT_TYPE & (ODM_AP |ODM_ADSL))
-                       if (priv->pshare->rf_ft_var.antSw_enable && (priv->up_time % 4==1))
-                               dm_SW_AntennaSwitch(priv, SWAW_STEP_PEAK);
-#endif
                        break;
        }
 
@@ -4958,10 +3490,10 @@ odm_SwAntDivChkAntSwitch(
 // penalty to get next try.
 
 
-VOID
+void
 ODM_SetAntenna(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      u1Byte          Antenna)
+       PDM_ODM_T       pDM_Odm,
+       u8              Antenna)
 {
        ODM_SetBBReg(pDM_Odm, 0x860, BIT8|BIT9, Antenna);
 }
@@ -4969,10 +3501,10 @@ ODM_SetAntenna(
 //Note: Antenna_Main--> Antenna_A
 //        Antenna_Aux---> Antenna_B
 //----------------------------------
-VOID
+void
 odm_SwAntDivChkAntSwitchNIC(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              u1Byte          Step
+               PDM_ODM_T               pDM_Odm,
+               u8              Step
        )
 {
 #if ((RTL8192C_SUPPORT==1)||(RTL8723A_SUPPORT==1))
@@ -4980,14 +3512,14 @@ odm_SwAntDivChkAntSwitchNIC(
        //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
        pSWAT_T         pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
        s4Byte                  curRSSI=100, RSSI_A, RSSI_B;
-       u1Byte                  nextAntenna=Antenna_B;
+       u8                      nextAntenna=Antenna_B;
        //static u8Byte         lastTxOkCnt=0, lastRxOkCnt=0;
        u8Byte                  curTxOkCnt, curRxOkCnt;
        //static u8Byte         TXByteCnt_A=0, TXByteCnt_B=0, RXByteCnt_A=0, RXByteCnt_B=0;
        u8Byte                  CurByteCnt=0, PreByteCnt=0;
-       //static u1Byte         TrafficLoad = TRAFFIC_LOW;
-       u1Byte                  Score_A=0, Score_B=0;
-       u1Byte                  i;
+       //static u8             TrafficLoad = TRAFFIC_LOW;
+       u8                      Score_A=0, Score_B=0;
+       u8                      i;
 
        if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV))
                return;
@@ -5026,15 +3558,12 @@ odm_SwAntDivChkAntSwitchNIC(
                ODM_SwAntDivRestAfterLink(pDM_Odm);
        }
 
-#if  (DM_ODM_SUPPORT_TYPE &( ODM_MP| ODM_CE ))
-
        if(pDM_SWAT_Table->try_flag == 0xff)
        {
                pDM_SWAT_Table->RSSI_target = 0xff;
 
-               #if(DM_ODM_SUPPORT_TYPE & ODM_CE)
                {
-                       u1Byte                  index = 0;
+                       u8                      index = 0;
                        PSTA_INFO_T             pEntry = NULL;
 
 
@@ -5057,66 +3586,6 @@ odm_SwAntDivChkAntSwitchNIC(
                                ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_SwAntDivChkAntSwitch(): RSSI_target is PEER STA\n"));
                        }
                 }
-               #elif (DM_ODM_SUPPORT_TYPE & ODM_MP)
-               {
-                       PADAPTER        pAdapter         =  pDM_Odm->Adapter;
-                       PMGNT_INFO      pMgntInfo=&pAdapter->MgntInfo;
-
-                       // Select RSSI checking target
-                       if(pMgntInfo->mAssoc && !ACTING_AS_AP(pAdapter))
-                       {
-                               // Target: Infrastructure mode AP.
-                               //pDM_SWAT_Table->RSSI_target = NULL;
-                               ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("odm_SwAntDivChkAntSwitch(): RSSI_target is DEF AP!\n"));
-                       }
-                       else
-                       {
-                               u1Byte                  index = 0;
-                               PSTA_INFO_T             pEntry = NULL;
-                               PADAPTER                pTargetAdapter = NULL;
-
-                               if(pMgntInfo->mIbss )
-                               {
-                                       // Target: AP/IBSS peer.
-                                       pTargetAdapter = pAdapter;
-                               }
-                               else
-                               {
-                                       pTargetAdapter = GetFirstAPAdapter(pAdapter);
-                               }
-
-                               if(pTargetAdapter != NULL)
-                               {
-                                       for(index=0; index<ODM_ASSOCIATE_ENTRY_NUM; index++)
-                                       {
-
-                                               pEntry = AsocEntry_EnumStation(pTargetAdapter, index);
-                                               if(pEntry != NULL)
-                                               {
-                                                       if(pEntry->bAssociated)
-                                                               break;
-                                               }
-
-                                       }
-
-                               }
-
-                               if(pEntry == NULL)
-                               {
-                                       ODM_SwAntDivRestAfterLink(pDM_Odm);
-                                       ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_SwAntDivChkAntSwitch(): No Link.\n"));
-                                       return;
-                               }
-                               else
-                               {
-                                       //pDM_SWAT_Table->RSSI_target = pEntry;
-                                       pDM_SWAT_Table->RSSI_target = index;
-                                       ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_SwAntDivChkAntSwitch(): RSSI_target is PEER STA\n"));
-                               }
-                       }//end if(pMgntInfo->mAssoc && !ACTING_AS_AP(Adapter))
-
-               }
-               #endif
 
                pDM_SWAT_Table->RSSI_cnt_A = 0;
                pDM_SWAT_Table->RSSI_cnt_B = 0;
@@ -5126,18 +3595,10 @@ odm_SwAntDivChkAntSwitchNIC(
        }
        else
        {
-#if (DM_ODM_SUPPORT_TYPE &( ODM_MP))
-               //PADAPTER      Adapter = pDM_Odm->Adapter;
-               curTxOkCnt = pAdapter->TxStats.NumTxBytesUnicast - pDM_SWAT_Table->lastTxOkCnt;
-               curRxOkCnt =pAdapter->RxStats.NumRxBytesUnicast - pDM_SWAT_Table->lastRxOkCnt;
-               pDM_SWAT_Table->lastTxOkCnt = pAdapter->TxStats.NumTxBytesUnicast;
-               pDM_SWAT_Table->lastRxOkCnt = pAdapter->RxStats.NumRxBytesUnicast;
-#else
                curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast) - pDM_SWAT_Table->lastTxOkCnt;
                curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast) - pDM_SWAT_Table->lastRxOkCnt;
                pDM_SWAT_Table->lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast);
                pDM_SWAT_Table->lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast);
-#endif
              ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("curTxOkCnt = %lld\n",curTxOkCnt));
                ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("curRxOkCnt = %lld\n",curRxOkCnt));
                ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("lastTxOkCnt = %lld\n",pDM_SWAT_Table->lastTxOkCnt));
@@ -5346,16 +3807,11 @@ odm_SwAntDivChkAntSwitchNIC(
        {
                ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("SWAS: Change TX Antenna!\n "));
                //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, nextAntenna);
-               #if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-               ODM_SetAntenna(pDM_Odm,nextAntenna);
-               #elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
                {
                        bool bEnqueue;
                        bEnqueue = (pDM_Odm->SupportInterface ==  ODM_ITRF_PCIE)?FALSE :TRUE;
                        rtw_antenna_select_cmd(pDM_Odm->Adapter, nextAntenna, bEnqueue);
                }
-               #endif
-
        }
 
        //1 5.Reset Statistics
@@ -5413,136 +3869,15 @@ odm_SwAntDivChkAntSwitchNIC(
                        ODM_SetTimer(pDM_Odm,&pDM_SWAT_Table->SwAntennaSwitchTimer, 500 ); //ms
        }
        }
-#endif // #if (DM_ODM_SUPPORT_TYPE  & (ODM_MP|ODM_CE))
 #endif // #if (RTL8192C_SUPPORT==1)
 }
 
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
-u1Byte
-odm_SwAntDivSelectChkChnl(
-       IN      PADAPTER        Adapter
-       )
-{
-#if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM)
-       u1Byte  index, target_chnl=0;
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-       PDM_ODM_T                       pDM_Odm = &pHalData->DM_OutSrc;
-       u1Byte  chnl_peer_cnt[14] = {0};
-
-       if(Adapter->MgntInfo.tmpNumBssDesc==0)
-       {
-               return 0;
-       }
-       else
-       {
-               // 20100519 Joseph: Select checking channel from current scan list.
-               // We just choose the channel with most APs to be the test scan channel.
-               for(index=0; index<Adapter->MgntInfo.tmpNumBssDesc; index++)
-               {
-                       // Add by hpfan: prevent access invalid channel number
-                       // TODO: Verify channel number by channel plan
-                       if(Adapter->MgntInfo.tmpbssDesc[index].ChannelNumber == 0 ||
-                               Adapter->MgntInfo.tmpbssDesc[index].ChannelNumber > 13)
-                               continue;
-
-                       chnl_peer_cnt[Adapter->MgntInfo.tmpbssDesc[index].ChannelNumber-1]++;
-               }
-               for(index=0; index<14; index++)
-               {
-                       if(chnl_peer_cnt[index]>chnl_peer_cnt[target_chnl])
-                               target_chnl = index;
-               }
-               target_chnl+=1;
-               ODM_RT_TRACE(pDM_Odm,COMP_SWAS, DBG_LOUD,
-                       ("odm_SwAntDivSelectChkChnl(): Channel %d is select as test channel.\n", target_chnl));
-
-               return target_chnl;
-       }
-#else
-       return  0;
-#endif
-}
-
-
-VOID
-odm_SwAntDivConsructChkScanChnl(
-       IN      PADAPTER        Adapter,
-       IN      u1Byte          ChkChnl
-       )
-{
-
-       PMGNT_INFO                      pMgntInfo = &Adapter->MgntInfo;
-       PRT_CHANNEL_LIST        pChannelList = GET_RT_CHANNEL_LIST(pMgntInfo);
-       u1Byte                          index;
-
-       if(ChkChnl==0)
-       {
-               // 20100519 Joseph: Original antenna scanned nothing.
-               // Test antenna shall scan all channel with half period in this condition.
-               RtActChannelList(Adapter, RT_CHNL_LIST_ACTION_CONSTRUCT_SCAN_LIST, NULL, NULL);
-               for(index=0; index<pChannelList->ChannelLen; index++)
-                       pChannelList->ChannelInfo[index].ScanPeriod /= 2;
-       }
-       else
-       {
-               // The using of this CustomizedScanRequest is a trick to rescan the two channels
-               //      under the NORMAL scanning process. It will not affect MGNT_INFO.CustomizedScanRequest.
-               CUSTOMIZED_SCAN_REQUEST CustomScanReq;
-
-               CustomScanReq.bEnabled = TRUE;
-               CustomScanReq.Channels[0] = ChkChnl;
-               CustomScanReq.Channels[1] = pMgntInfo->dot11CurrentChannelNumber;
-               CustomScanReq.nChannels = 2;
-               CustomScanReq.ScanType = SCAN_ACTIVE;
-               CustomScanReq.Duration = DEFAULT_ACTIVE_SCAN_PERIOD;
-
-               RtActChannelList(Adapter, RT_CHNL_LIST_ACTION_CONSTRUCT_SCAN_LIST, &CustomScanReq, NULL);
-       }
-
-}
-#endif //#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
 //
 // 20100514 Luke/Joseph:
 // Callback function for 500ms antenna test trying.
 //
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-VOID
-odm_SwAntDivChkAntSwitchCallback(
-       PRT_TIMER               pTimer
-)
-{
-       PADAPTER                Adapter = (PADAPTER)pTimer->Adapter;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       pSWAT_T         pDM_SWAT_Table = &pHalData->DM_OutSrc.DM_SWAT_Table;
-
-       #if DEV_BUS_TYPE==RT_PCI_INTERFACE
-       #if USE_WORKITEM
-       ODM_ScheduleWorkItem(&pDM_SWAT_Table->SwAntennaSwitchWorkitem);
-       #else
-       odm_SwAntDivChkAntSwitch(&pHalData->DM_OutSrc, SWAW_STEP_DETERMINE);
-       #endif
-#else
-       ODM_ScheduleWorkItem(&pDM_SWAT_Table->SwAntennaSwitchWorkitem);
-       #endif
-
-}
-VOID
-odm_SwAntDivChkAntSwitchWorkitemCallback(
-    IN PVOID            pContext
-    )
-{
-
-       PADAPTER                pAdapter = (PADAPTER)pContext;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(pAdapter);
-
-       odm_SwAntDivChkAntSwitch(&pHalData->DM_OutSrc, SWAW_STEP_DETERMINE);
-
-}
-#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
-VOID odm_SwAntDivChkAntSwitchCallback(void *FunctionContext)
+void odm_SwAntDivChkAntSwitchCallback(void *FunctionContext)
 {
        PDM_ODM_T       pDM_Odm= (PDM_ODM_T)FunctionContext;
        PADAPTER        padapter = pDM_Odm->Adapter;
@@ -5550,361 +3885,101 @@ VOID odm_SwAntDivChkAntSwitchCallback(void *FunctionContext)
            return;
        odm_SwAntDivChkAntSwitch(pDM_Odm, SWAW_STEP_DETERMINE);
 }
-#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL))
-VOID odm_SwAntDivChkAntSwitchCallback(void *FunctionContext)
-{
-       PDM_ODM_T       pDM_Odm= (PDM_ODM_T)FunctionContext;
-       odm_SwAntDivChkAntSwitch(pDM_Odm, SWAW_STEP_DETERMINE);
-}
-#endif
 
 #else //#if(defined(CONFIG_SW_ANTENNA_DIVERSITY))
 
-VOID odm_SwAntDivInit( IN              PDM_ODM_T               pDM_Odm ) {}
-VOID ODM_SwAntDivChkPerPktRssi(
      IN PDM_ODM_T    pDM_Odm,
      IN u1Byte               StationID,
      IN PODM_PHY_INFO_T pPhyInfo
+void odm_SwAntDivInit(         PDM_ODM_T               pDM_Odm ) {}
+void ODM_SwAntDivChkPerPktRssi(
PDM_ODM_T     pDM_Odm,
u8            StationID,
+ PODM_PHY_INFO_T pPhyInfo
        ) {}
-VOID odm_SwAntDivChkAntSwitch(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              u1Byte                  Step
+void odm_SwAntDivChkAntSwitch(
+               PDM_ODM_T               pDM_Odm,
+               u8                      Step
        ) {}
-VOID ODM_SwAntDivResetBeforeLink(      IN              PDM_ODM_T               pDM_Odm ){}
-VOID ODM_SwAntDivRestAfterLink(        IN              PDM_ODM_T               pDM_Odm ){}
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-u1Byte odm_SwAntDivSelectChkChnl(      IN      PADAPTER        Adapter ){      return 0;}
-VOID
-odm_SwAntDivConsructChkScanChnl(
-       IN      PADAPTER        Adapter,
-       IN      u1Byte          ChkChnl
-       ){}
-#endif
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-VOID odm_SwAntDivChkAntSwitchCallback( PRT_TIMER               pTimer){}
-VOID odm_SwAntDivChkAntSwitchWorkitemCallback(    IN PVOID            pContext    ){}
-#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
-VOID odm_SwAntDivChkAntSwitchCallback(void *FunctionContext){}
-#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL))
-VOID odm_SwAntDivChkAntSwitchCallback(void *FunctionContext){}
-#endif
+void ODM_SwAntDivResetBeforeLink(              PDM_ODM_T               pDM_Odm ){}
+void ODM_SwAntDivRestAfterLink(                PDM_ODM_T               pDM_Odm ){}
+void odm_SwAntDivChkAntSwitchCallback(void *FunctionContext){}
 
 #endif //#if(defined(CONFIG_SW_ANTENNA_DIVERSITY))
 
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-#if((defined(CONFIG_SW_ANTENNA_DIVERSITY))||(defined(CONFIG_HW_ANTENNA_DIVERSITY)))
-bool
-ODM_SwAntDivCheckBeforeLink8192C(
-       IN              PDM_ODM_T               pDM_Odm
+//3============================================================
+//3 SW Antenna Diversity
+//3============================================================
+
+#if(defined(CONFIG_HW_ANTENNA_DIVERSITY))
+void
+odm_InitHybridAntDiv_88C_92D(
+ PDM_ODM_T     pDM_Odm
        )
 {
 
-#if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM)
-       PADAPTER Adapter = pDM_Odm->Adapter;
-       HAL_DATA_TYPE   *pHalData=NULL;
-       PMGNT_INFO              pMgntInfo = NULL;
-       //pSWAT_T                       pDM_SWAT_Table = &Adapter->DM_SWAT_Table;
-       pSWAT_T                 pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
-       pFAT_T  pDM_FatTable = &pDM_Odm->DM_FatTable;
+       SWAT_T                  *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
+       u8                  bTxPathSel=0;               //0:Path-A   1:Path-B
+       u8                      i;
 
-       s1Byte                  Score = 0;
-       PRT_WLAN_BSS    pTmpBssDesc;
-       PRT_WLAN_BSS    pTestBssDesc;
+       ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_InitHybridAntDiv==============>\n"));
 
-       u1Byte                  target_chnl = 0;
-       u1Byte                  index;
+       if((pDM_Odm->SupportICType != ODM_RTL8192C) && (pDM_Odm->SupportICType != ODM_RTL8192D))
+               return;
 
-return FALSE;
-       if (pDM_Odm->Adapter == NULL)  //For BSOD when plug/unplug fast.  //By YJ,120413
-       {       // The ODM structure is not initialized.
-               return FALSE;
-       }
-       // 2012/04/26 MH Prevent no-checked IC to execute antenna diversity.
-       if(pDM_Odm->SupportICType == ODM_RTL8188E && pDM_Odm->SupportInterface != ODM_ITRF_PCIE)
-               return FALSE;
-       pHalData = GET_HAL_DATA(Adapter);
-       pMgntInfo = &Adapter->MgntInfo;
 
-       // Condition that does not need to use antenna diversity.
-       if(IS_8723_SERIES(pHalData->VersionID) ||
-               IS_92C_SERIAL(pHalData->VersionID) ||
-               (pHalData->AntDivCfg==0) ||
-               pMgntInfo->AntennaTest ||
-               Adapter->bInHctTest)
-       {
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,
-                               ("ODM_SwAntDivCheckBeforeLink8192C(): No AntDiv Mechanism.\n"));
-               return FALSE;
-       }
+       bTxPathSel=(pDM_Odm->RFType==ODM_1T1R)?FALSE:TRUE;
 
-       if(IS_8723_SERIES(pHalData->VersionID) || IS_92C_SERIAL(pHalData->VersionID) )
-       {
-               if((pDM_SWAT_Table->ANTA_ON == FALSE) ||(pDM_SWAT_Table->ANTB_ON == FALSE))
-               {
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,
-                                       ("ODM_SwAntDivCheckBeforeLink8192C(): No AntDiv Mechanism, Antenna A or B is off\n"));
-                       return FALSE;
-               }
+       ODM_SetBBReg(pDM_Odm,ODM_REG_BB_PWR_SAV1_11N, BIT23, 0); //No update ANTSEL during GNT_BT=1
+       ODM_SetBBReg(pDM_Odm,ODM_REG_TX_ANT_CTRL_11N, BIT21, 1); //TX atenna selection from tx_info
+       ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PIN_11N, BIT23, 1); //enable LED[1:0] pin as ANTSEL
+       ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_CTRL_11N, BIT8|BIT9, 0x01); // 0x01: left antenna, 0x02: right antenna
+       // check HW setting: ANTSEL pin connection
+
+       // only AP support different path selection temperarly
+       if(!bTxPathSel){                 //PATH-A
+               ODM_SetBBReg(pDM_Odm,ODM_REG_PIN_CTRL_11N, BIT8|BIT9, 0 ); // ANTSEL as HW control
+               ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PATH_11N, BIT13, 1);         //select TX ANTESEL from path A
+       }
+       else    {
+               ODM_SetBBReg(pDM_Odm,ODM_REG_PIN_CTRL_11N, BIT24|BIT25, 0 ); // ANTSEL as HW control
+               ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PATH_11N, BIT13, 0);                 //select ANTESEL from path B
        }
 
-       // Since driver is going to set BB register, it shall check if there is another thread controlling BB/RF.
-       PlatformAcquireSpinLock(Adapter, RT_RF_STATE_SPINLOCK);
-       if(pHalData->eRFPowerState!=eRfOn || pMgntInfo->RFChangeInProgress || pMgntInfo->bMediaConnect)
-       {
-               PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK);
+       //Set OFDM HW RX Antenna Diversity
+       ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA1_11N, 0x7FF, 0x0c0); //Pwdb threshold=8dB
+       ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA1_11N, BIT11, 0); //Switch to another antenna by checking pwdb threshold
+       ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA3_11N, BIT23, 1);       // Decide final antenna by comparing 2 antennas' pwdb
 
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,
-                               ("ODM_SwAntDivCheckBeforeLink8192C(): RFChangeInProgress(%x), eRFPowerState(%x)\n",
-                               pMgntInfo->RFChangeInProgress,
-                               pHalData->eRFPowerState));
+       //Set CCK HW RX Antenna Diversity
+       ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA2_11N, BIT4, 0); //Antenna diversity decision period = 32 sample
+       ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA2_11N, 0xf, 0xf); //Threshold for antenna diversity. Check another antenna power if input power < ANT_lim*4
+       ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA3_11N, BIT13, 1); //polarity ana_A=1 and ana_B=0
+       ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA4_11N, 0x1f, 0x8); //default antenna power = inpwr*(0.5 + r_ant_step/16)
 
-               pDM_SWAT_Table->SWAS_NoLink_State = 0;
 
-               return FALSE;
-       }
+       //Enable HW Antenna Diversity
+       if(!bTxPathSel)                 //PATH-A
+               ODM_SetBBReg(pDM_Odm,ODM_REG_IGI_A_11N, BIT7,1);        // Enable Hardware antenna switch
        else
-       {
-               PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK);
-       }
+               ODM_SetBBReg(pDM_Odm,ODM_REG_IGI_B_11N, BIT7,1);        // Enable Hardware antenna switch
+       ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA1_11N, BIT15, 1);//Enable antenna diversity
 
-       //1 Run AntDiv mechanism "Before Link" part.
-       if(pDM_SWAT_Table->SWAS_NoLink_State == 0)
+       pDM_SWAT_Table->CurAntenna=0;                   //choose left antenna as default antenna
+       pDM_SWAT_Table->PreAntenna=0;
+       for(i=0; i<ASSOCIATE_ENTRY_NUM ; i++)
        {
-               //1 Prepare to do Scan again to check current antenna state.
-
-               // Set check state to next step.
-               pDM_SWAT_Table->SWAS_NoLink_State = 1;
-
-               // Copy Current Scan list.
-               Adapter->MgntInfo.tmpNumBssDesc = pMgntInfo->NumBssDesc;
-               PlatformMoveMemory((PVOID)Adapter->MgntInfo.tmpbssDesc, (PVOID)pMgntInfo->bssDesc, sizeof(RT_WLAN_BSS)*MAX_BSS_DESC);
+               pDM_SWAT_Table->CCK_Ant1_Cnt[i] = 0;
+               pDM_SWAT_Table->CCK_Ant2_Cnt[i] = 0;
+               pDM_SWAT_Table->OFDM_Ant1_Cnt[i] = 0;
+               pDM_SWAT_Table->OFDM_Ant2_Cnt[i] = 0;
+               pDM_SWAT_Table->RSSI_Ant1_Sum[i] = 0;
+               pDM_SWAT_Table->RSSI_Ant2_Sum[i] = 0;
+       }
+       ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("<==============odm_InitHybridAntDiv\n"));
+}
 
-               if(pDM_Odm->SupportICType == ODM_RTL8188E)
-               {
-                       if(pDM_FatTable->RxIdleAnt == MAIN_ANT)
-                               ODM_UpdateRxIdleAnt_88E(pDM_Odm, AUX_ANT);
-                       else
-                               ODM_UpdateRxIdleAnt_88E(pDM_Odm, MAIN_ANT);
 
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,
-                               ("ODM_SwAntDivCheckBeforeLink8192C: Change to %s for testing.\n", ((pDM_FatTable->RxIdleAnt == MAIN_ANT)?"MAIN_ANT":"AUX_ANT")));
-               }
-               if(pDM_Odm->SupportICType != ODM_RTL8188E)
-               {
-               // Switch Antenna to another one.
-               pDM_SWAT_Table->PreAntenna = pDM_SWAT_Table->CurAntenna;
-               pDM_SWAT_Table->CurAntenna = (pDM_SWAT_Table->CurAntenna==Antenna_A)?Antenna_B:Antenna_A;
-
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,
-                       ("ODM_SwAntDivCheckBeforeLink8192C: Change to Ant(%s) for testing.\n", (pDM_SWAT_Table->CurAntenna==Antenna_A)?"A":"B"));
-               //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, DM_SWAT_Table.CurAntenna);
-               pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 = ((pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 & 0xfffffcff) | (pDM_SWAT_Table->CurAntenna<<8));
-                       ODM_SetBBReg(pDM_Odm,  rFPGA0_XA_RFInterfaceOE, bMaskDWord, pDM_SWAT_Table->SWAS_NoLink_BK_Reg860);
-               }
-               // Go back to scan function again.
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink8192C: Scan one more time\n"));
-               pMgntInfo->ScanStep=0;
-               target_chnl = odm_SwAntDivSelectChkChnl(Adapter);
-               odm_SwAntDivConsructChkScanChnl(Adapter, target_chnl);
-               HTReleaseChnlOpLock(Adapter);
-               PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5);
-
-               return TRUE;
-       }
-       else
-       {
-               //1 ScanComple() is called after antenna swiched.
-               //1 Check scan result and determine which antenna is going
-               //1 to be used.
-
-               for(index=0; index<Adapter->MgntInfo.tmpNumBssDesc; index++)
-               {
-                       pTmpBssDesc = &(Adapter->MgntInfo.tmpbssDesc[index]);
-                       pTestBssDesc = &(pMgntInfo->bssDesc[index]);
-
-                       if(PlatformCompareMemory(pTestBssDesc->bdBssIdBuf, pTmpBssDesc->bdBssIdBuf, 6)!=0)
-                       {
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink8192C(): ERROR!! This shall not happen.\n"));
-                               continue;
-                       }
-
-                       if(pTmpBssDesc->RecvSignalPower > pTestBssDesc->RecvSignalPower)
-                       {
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink8192C: Compare scan entry: Score++\n"));
-                               RT_PRINT_STR(ODM_COMP_ANT_DIV, ODM_DBG_LOUD, "SSID: ", pTestBssDesc->bdSsIdBuf, pTestBssDesc->bdSsIdLen);
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower));
-
-                               Score++;
-                               PlatformMoveMemory(pTestBssDesc, pTmpBssDesc, sizeof(RT_WLAN_BSS));
-                       }
-                       else if(pTmpBssDesc->RecvSignalPower < pTestBssDesc->RecvSignalPower)
-                       {
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink8192C: Compare scan entry: Score--\n"));
-                               RT_PRINT_STR(ODM_COMP_ANT_DIV, ODM_DBG_LOUD, "SSID: ", pTestBssDesc->bdSsIdBuf, pTestBssDesc->bdSsIdLen);
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower));
-                               Score--;
-                       }
-
-               }
-
-               if(pDM_Odm->SupportICType == ODM_RTL8188E)
-               {
-               if(pMgntInfo->NumBssDesc!=0 && Score<=0)
-               {
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,
-                                       ("ODM_SwAntDivCheckBeforeLink8192C(): Using Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT"));
-               }
-               else
-               {
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,
-                                       ("ODM_SwAntDivCheckBeforeLink8192C(): Remain Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"AUX_ANT":"MAIN_ANT"));
-
-                               if(pDM_FatTable->RxIdleAnt == MAIN_ANT)
-                                       ODM_UpdateRxIdleAnt_88E(pDM_Odm, AUX_ANT);
-                               else
-                                       ODM_UpdateRxIdleAnt_88E(pDM_Odm, MAIN_ANT);
-                       }
-               }
-
-               if(pDM_Odm->SupportICType != ODM_RTL8188E)
-                               {
-                       if(pMgntInfo->NumBssDesc!=0 && Score<=0)
-                               {
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,
-                                       ("ODM_SwAntDivCheckBeforeLink8192C(): Using Ant(%s)\n", (pDM_SWAT_Table->CurAntenna==Antenna_A)?"Antenna_A":"Antenna_B"));
-
-                               pDM_SWAT_Table->PreAntenna = pDM_SWAT_Table->CurAntenna;
-                       }
-                       else
-                       {
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,
-                                       ("ODM_SwAntDivCheckBeforeLink8192C(): Remain Ant(%s)\n", (pDM_SWAT_Table->CurAntenna==Antenna_A)?"Antenna_B":"Antenna_A"));
-
-                               pDM_SWAT_Table->CurAntenna = pDM_SWAT_Table->PreAntenna;
-
-                               //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, DM_SWAT_Table.CurAntenna);
-                       pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 = ((pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 & 0xfffffcff) | (pDM_SWAT_Table->CurAntenna<<8));
-                       PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, bMaskDWord, pDM_SWAT_Table->SWAS_NoLink_BK_Reg860);
-               }
-               }
-               // Check state reset to default and wait for next time.
-               pDM_SWAT_Table->SWAS_NoLink_State = 0;
-
-               return FALSE;
-       }
-#else
-               return  FALSE;
-#endif
-
-return FALSE;
-}
-#else
-bool
-ODM_SwAntDivCheckBeforeLink8192C(
-       IN              PDM_ODM_T               pDM_Odm
-       )
-{
-
-       return FALSE;
-
-}
-#endif //#if((defined(CONFIG_SW_ANTENNA_DIVERSITY))||(defined(CONFIG_HW_ANTENNA_DIVERSITY)))
-#endif //#if(DM_ODM_SUPPORT_TYPE==ODM_MP)
-
-
-//3============================================================
-//3 SW Antenna Diversity
-//3============================================================
-
-#if(defined(CONFIG_HW_ANTENNA_DIVERSITY))
-VOID
-odm_InitHybridAntDiv_88C_92D(
-       IN PDM_ODM_T    pDM_Odm
-       )
-{
-
-#if((DM_ODM_SUPPORT_TYPE==ODM_AP)||(DM_ODM_SUPPORT_TYPE==ODM_ADSL))
-       struct rtl8192cd_priv *priv=pDM_Odm->priv;
-#endif
-       SWAT_T                  *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
-       u1Byte                  bTxPathSel=0;           //0:Path-A   1:Path-B
-       u1Byte                  i;
-
-       ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_InitHybridAntDiv==============>\n"));
-
-       //whether to do antenna diversity or not
-#if(DM_ODM_SUPPORT_TYPE==ODM_AP)
-       if(priv==NULL)  return;
-       if(!priv->pshare->rf_ft_var.antHw_enable)
-               return;
-
-       #ifdef SW_ANT_SWITCH
-       priv->pshare->rf_ft_var.antSw_enable =0;
-       #endif
-#endif
-
-       if((pDM_Odm->SupportICType != ODM_RTL8192C) && (pDM_Odm->SupportICType != ODM_RTL8192D))
-               return;
-
-
-       bTxPathSel=(pDM_Odm->RFType==ODM_1T1R)?FALSE:TRUE;
-
-       ODM_SetBBReg(pDM_Odm,ODM_REG_BB_PWR_SAV1_11N, BIT23, 0); //No update ANTSEL during GNT_BT=1
-       ODM_SetBBReg(pDM_Odm,ODM_REG_TX_ANT_CTRL_11N, BIT21, 1); //TX atenna selection from tx_info
-       ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PIN_11N, BIT23, 1); //enable LED[1:0] pin as ANTSEL
-       ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_CTRL_11N, BIT8|BIT9, 0x01); // 0x01: left antenna, 0x02: right antenna
-       // check HW setting: ANTSEL pin connection
-       #if(DM_ODM_SUPPORT_TYPE==ODM_AP)
-       ODM_Write2Byte(pDM_Odm,ODM_REG_RF_PIN_11N, (ODM_Read2Byte(pDM_Odm,0x804)&0xf0ff )| BIT(8) );    // b11-b8=0001,update RFPin setting
-       #endif
-
-       // only AP support different path selection temperarly
-       if(!bTxPathSel){                 //PATH-A
-               ODM_SetBBReg(pDM_Odm,ODM_REG_PIN_CTRL_11N, BIT8|BIT9, 0 ); // ANTSEL as HW control
-               ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PATH_11N, BIT13, 1);         //select TX ANTESEL from path A
-       }
-       else    {
-               ODM_SetBBReg(pDM_Odm,ODM_REG_PIN_CTRL_11N, BIT24|BIT25, 0 ); // ANTSEL as HW control
-               ODM_SetBBReg(pDM_Odm,ODM_REG_ANTSEL_PATH_11N, BIT13, 0);                 //select ANTESEL from path B
-       }
-
-       //Set OFDM HW RX Antenna Diversity
-       ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA1_11N, 0x7FF, 0x0c0); //Pwdb threshold=8dB
-       ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA1_11N, BIT11, 0); //Switch to another antenna by checking pwdb threshold
-       ODM_SetBBReg(pDM_Odm,ODM_REG_ANTDIV_PARA3_11N, BIT23, 1);       // Decide final antenna by comparing 2 antennas' pwdb
-
-       //Set CCK HW RX Antenna Diversity
-       ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA2_11N, BIT4, 0); //Antenna diversity decision period = 32 sample
-       ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA2_11N, 0xf, 0xf); //Threshold for antenna diversity. Check another antenna power if input power < ANT_lim*4
-       ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA3_11N, BIT13, 1); //polarity ana_A=1 and ana_B=0
-       ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA4_11N, 0x1f, 0x8); //default antenna power = inpwr*(0.5 + r_ant_step/16)
-
-
-       //Enable HW Antenna Diversity
-       if(!bTxPathSel)                 //PATH-A
-               ODM_SetBBReg(pDM_Odm,ODM_REG_IGI_A_11N, BIT7,1);        // Enable Hardware antenna switch
-       else
-               ODM_SetBBReg(pDM_Odm,ODM_REG_IGI_B_11N, BIT7,1);        // Enable Hardware antenna switch
-       ODM_SetBBReg(pDM_Odm,ODM_REG_CCK_ANTDIV_PARA1_11N, BIT15, 1);//Enable antenna diversity
-
-       pDM_SWAT_Table->CurAntenna=0;                   //choose left antenna as default antenna
-       pDM_SWAT_Table->PreAntenna=0;
-       for(i=0; i<ASSOCIATE_ENTRY_NUM ; i++)
-       {
-               pDM_SWAT_Table->CCK_Ant1_Cnt[i] = 0;
-               pDM_SWAT_Table->CCK_Ant2_Cnt[i] = 0;
-               pDM_SWAT_Table->OFDM_Ant1_Cnt[i] = 0;
-               pDM_SWAT_Table->OFDM_Ant2_Cnt[i] = 0;
-               pDM_SWAT_Table->RSSI_Ant1_Sum[i] = 0;
-               pDM_SWAT_Table->RSSI_Ant2_Sum[i] = 0;
-       }
-       ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("<==============odm_InitHybridAntDiv\n"));
-}
-
-
-VOID
+void
 odm_InitHybridAntDiv(
      IN PDM_ODM_T    pDM_Odm
PDM_ODM_T     pDM_Odm
        )
 {
        if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV))
@@ -5931,12 +4006,12 @@ odm_InitHybridAntDiv(
 
 bool
 odm_StaDefAntSel(
      IN PDM_ODM_T    pDM_Odm,
      IN u4Byte               OFDM_Ant1_Cnt,
      IN u4Byte               OFDM_Ant2_Cnt,
      IN u4Byte               CCK_Ant1_Cnt,
      IN u4Byte               CCK_Ant2_Cnt,
      OUT u1Byte              *pDefAnt
PDM_ODM_T     pDM_Odm,
u4Byte                OFDM_Ant1_Cnt,
u4Byte                OFDM_Ant2_Cnt,
u4Byte                CCK_Ant1_Cnt,
u4Byte                CCK_Ant2_Cnt,
u8            *pDefAnt
 
        )
 {
@@ -5977,7 +4052,7 @@ odm_StaDefAntSel(
 
 #endif
        //u4Byte antsel = ODM_GetBBReg(pDM_Odm, 0xc88, bMaskByte0);
-       //(*pDefAnt)= (u1Byte) antsel;
+       //(*pDefAnt)= (u8) antsel;
 
 
 
@@ -5990,11 +4065,11 @@ odm_StaDefAntSel(
 }
 
 
-VOID
+void
 odm_SetRxIdleAnt(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      u1Byte  Ant,
-       IN   bool   bDualPath
+       PDM_ODM_T       pDM_Odm,
+       u8      Ant,
+   bool   bDualPath
 )
 {
        SWAT_T                  *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
@@ -6024,12 +4099,12 @@ odm_SetRxIdleAnt(
 
        }
 
-VOID
+void
 ODM_AntselStatistics_88C(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              u1Byte                  MacId,
-       IN              u4Byte                  PWDBAll,
-       IN              bool                    isCCKrate
+               PDM_ODM_T               pDM_Odm,
+               u8                      MacId,
+               u4Byte                  PWDBAll,
+               bool                    isCCKrate
 )
 {
        SWAT_T                  *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
@@ -6058,67 +4133,25 @@ ODM_AntselStatistics_88C(
 }
 
 
-
-
-#if(DM_ODM_SUPPORT_TYPE==ODM_MP)
-VOID
-ODM_SetTxAntByTxInfo_88C_92D(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              pu1Byte                 pDesc,
-       IN              u1Byte                  macId
-)
-{
-       SWAT_T                  *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
-       u1Byte                  antsel;
-
-       if(!(pDM_Odm->SupportAbility&ODM_BB_ANT_DIV))
-               return;
-
-       if(pDM_SWAT_Table->RxIdleAnt == 1)
-               antsel=(pDM_SWAT_Table->TxAnt[macId] == 1)?0:1;
-       else
-               antsel=(pDM_SWAT_Table->TxAnt[macId] == 1)?1:0;
-
-       SET_TX_DESC_ANTSEL_A_92C(pDesc, antsel);
-       //SET_TX_DESC_ANTSEL_B_92C(pDesc, antsel);
-       //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("SET_TX_DESC_ANTSEL_A_92C=%d\n", pDM_SWAT_Table->TxAnt[macId]));
-}
-#elif(DM_ODM_SUPPORT_TYPE==ODM_CE)
-VOID
-ODM_SetTxAntByTxInfo_88C_92D(
-       IN              PDM_ODM_T               pDM_Odm
-)
-{
-
-}
-#elif(DM_ODM_SUPPORT_TYPE==ODM_AP)
-VOID
+void
 ODM_SetTxAntByTxInfo_88C_92D(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
 )
 {
 
 }
-#endif
 
-VOID
+void
 odm_HwAntDiv_92C_92D(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
 )
 {
        SWAT_T                  *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
        u4Byte                  RSSI_Min=0xFF, RSSI, RSSI_Ant1, RSSI_Ant2;
-       u1Byte                  RxIdleAnt, i;
+       u8                      RxIdleAnt, i;
        bool            bRet=FALSE;
        PSTA_INFO_T     pEntry;
 
-#if (DM_ODM_SUPPORT_TYPE==ODM_AP)
-       struct rtl8192cd_priv *priv=pDM_Odm->priv;
-       //if test, return
-       if(priv->pshare->rf_ft_var.CurAntenna & 0x80)
-               return;
-#endif
-
        ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_HwAntDiv==============>\n"));
 
        if(!(pDM_Odm->SupportAbility&ODM_BB_ANT_DIV))                                    //if don't support antenna diveristy
@@ -6133,13 +4166,11 @@ odm_HwAntDiv_92C_92D(
                return;
        }
 
-#if (DM_ODM_SUPPORT_TYPE&(ODM_MP|ODM_CE))
        if(!pDM_Odm->bLinked)
        {
                ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("Return: bLinked is FALSE\n"));
                return;
        }
-#endif
 
        for (i=0; i<ODM_ASSOCIATE_ENTRY_NUM; i++)
        {
@@ -6154,17 +4185,12 @@ odm_HwAntDiv_92C_92D(
 
                        if(RSSI_Ant1 ||RSSI_Ant2)
                        {
-#if (DM_ODM_SUPPORT_TYPE==ODM_AP)
-                               if(pDM_Odm->pODM_StaInfo[i]->expire_to)
-#endif
-                               {
-                                       RSSI = (RSSI_Ant1 < RSSI_Ant2) ? RSSI_Ant1 : RSSI_Ant2;
-                                       if((!RSSI) || ( RSSI < RSSI_Min) ) {
-                                               pDM_SWAT_Table->TargetSTA = i;
-                                               RSSI_Min = RSSI;
-                                       }
+                               RSSI = (RSSI_Ant1 < RSSI_Ant2) ? RSSI_Ant1 : RSSI_Ant2;
+                               if((!RSSI) || ( RSSI < RSSI_Min) ) {
+                                       pDM_SWAT_Table->TargetSTA = i;
+                                       RSSI_Min = RSSI;
                                }
-       }
+                       }
                        ///STA: found out default antenna
                        bRet=odm_StaDefAntSel(pDM_Odm,
                                                 pDM_SWAT_Table->OFDM_Ant1_Cnt[i],
@@ -6189,40 +4215,12 @@ odm_HwAntDiv_92C_92D(
        RxIdleAnt = pDM_SWAT_Table->TxAnt[pDM_SWAT_Table->TargetSTA];
        odm_SetRxIdleAnt(pDM_Odm, RxIdleAnt, FALSE);
 
-#if (DM_ODM_SUPPORT_TYPE==ODM_AP)
-#ifdef TX_SHORTCUT
-       if (!priv->pmib->dot11OperationEntry.disable_txsc) {
-               plist = phead->next;
-               while(plist != phead)   {
-                       pstat = list_entry(plist, struct stat_info, asoc_list);
-                       if(pstat->expire_to) {
-                               for (i=0; i<TX_SC_ENTRY_NUM; i++) {
-                                       struct tx_desc *pdesc= &(pstat->tx_sc_ent[i].hwdesc1);
-                                       pdesc->Dword2 &= set_desc(~ (BIT(24)|BIT(25)));
-                                       if((pstat->CurAntenna^priv->pshare->rf_ft_var.CurAntenna)&1)
-                                               pdesc->Dword2 |= set_desc(BIT(24)|BIT(25));
-                                       pdesc= &(pstat->tx_sc_ent[i].hwdesc2);
-                                       pdesc->Dword2 &= set_desc(~ (BIT(24)|BIT(25)));
-                                       if((pstat->CurAntenna^priv->pshare->rf_ft_var.CurAntenna)&1)
-                                               pdesc->Dword2 |= set_desc(BIT(24)|BIT(25));
-                               }
-                       }
-
-                       if (plist == plist->next)
-                               break;
-                       plist = plist->next;
-               };
-       }
-#endif
-#endif
-
        ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("<==============odm_HwAntDiv\n"));
-
 }
 
-VOID
+void
 odm_HwAntDiv(
-       IN      PDM_ODM_T       pDM_Odm
+       PDM_ODM_T       pDM_Odm
 )
 {
        if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV))
@@ -6247,214 +4245,12 @@ odm_HwAntDiv(
 }
 
 
-#if(DM_ODM_SUPPORT_TYPE==ODM_AP)
-#if 0
-VOID
-odm_HwAntDiv(
-       IN      PDM_ODM_T       pDM_Odm
-)
-{
-       struct rtl8192cd_priv *priv=pDM_Odm->priv;
-       struct stat_info        *pstat, *pstat_min=NULL;
-       struct list_head        *phead, *plist;
-       int rssi_min= 0xff, i;
-       u1Byte  idleAnt=priv->pshare->rf_ft_var.CurAntenna;
-       u1Byte  nextAnt;
-       bool            bRet=FALSE;
-
-       ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("odm_HwAntDiv==============>\n"));
-
-       if((!priv->pshare->rf_ft_var.antHw_enable) ||(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)))
-               return;
-
-       //if test, return
-       if(priv->pshare->rf_ft_var.CurAntenna & 0x80)
-               return;
-
-       phead = &priv->asoc_list;
-       plist = phead->next;
-       ////=========================
-       //find mimum rssi sta
-       ////=========================
-       while(plist != phead)   {
-               pstat = list_entry(plist, struct stat_info, asoc_list);
-               if((pstat->expire_to) && (pstat->AntRSSI[0] || pstat->AntRSSI[1])) {
-                       int rssi = (pstat->AntRSSI[0] < pstat->AntRSSI[1]) ? pstat->AntRSSI[0] : pstat->AntRSSI[1];
-                       if((!pstat_min) || ( rssi < rssi_min) ) {
-                               pstat_min = pstat;
-                               rssi_min = rssi;
-                       }
-               }
-               ///STA: found out default antenna
-               bRet=odm_StaDefAntSel(pDM_Odm,
-                                               pstat->hwRxAntSel[1],
-                                               pstat->hwRxAntSel[0],
-                                               pstat->cckPktCount[1],
-                                               pstat->cckPktCount[0],
-                                               &nextAnt
-                                               );
-
-               //if default antenna selection: successful
-               if(bRet){
-                       pstat->CurAntenna = nextAnt;
-                       //update rssi
-                       for(i=0; i<2; i++) {
-                               if(pstat->cckPktCount[i]==0 && pstat->hwRxAntSel[i]==0)
-                                       pstat->AntRSSI[i] = 0;
-                       }
-                       if(pstat->AntRSSI[idleAnt]==0)
-                               pstat->AntRSSI[idleAnt] = pstat->AntRSSI[idleAnt^1];
-                       // reset variables
-                       pstat->hwRxAntSel[1] = pstat->hwRxAntSel[0] =0;
-                       pstat->cckPktCount[1]= pstat->cckPktCount[0] =0;
-               }
-
-               if (plist == plist->next)
-                       break;
-               plist = plist->next;
-
-       };
-       ////=========================
-       //Choose  RX Idle antenna according to minmum rssi
-       ////=========================
-       if(pstat_min)   {
-               if(priv->pshare->rf_ft_var.CurAntenna!=pstat_min->CurAntenna)
-                       odm_SetRxIdleAnt(pDM_Odm,pstat_min->CurAntenna,TRUE);
-               priv->pshare->rf_ft_var.CurAntenna = pstat_min->CurAntenna;
-       }
-
-
-#ifdef TX_SHORTCUT
-       if (!priv->pmib->dot11OperationEntry.disable_txsc) {
-               plist = phead->next;
-               while(plist != phead)   {
-                       pstat = list_entry(plist, struct stat_info, asoc_list);
-                       if(pstat->expire_to) {
-                               for (i=0; i<TX_SC_ENTRY_NUM; i++) {
-                                       struct tx_desc *pdesc= &(pstat->tx_sc_ent[i].hwdesc1);
-                                       pdesc->Dword2 &= set_desc(~ (BIT(24)|BIT(25)));
-                                       if((pstat->CurAntenna^priv->pshare->rf_ft_var.CurAntenna)&1)
-                                               pdesc->Dword2 |= set_desc(BIT(24)|BIT(25));
-                                       pdesc= &(pstat->tx_sc_ent[i].hwdesc2);
-                                       pdesc->Dword2 &= set_desc(~ (BIT(24)|BIT(25)));
-                                       if((pstat->CurAntenna^priv->pshare->rf_ft_var.CurAntenna)&1)
-                                               pdesc->Dword2 |= set_desc(BIT(24)|BIT(25));
-                               }
-                       }
-
-                       if (plist == plist->next)
-                               break;
-                       plist = plist->next;
-               };
-       }
-#endif
-       ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,"<==============odm_HwAntDiv\n");
-}
-#endif
-
-u1Byte
-ODM_Diversity_AntennaSelect(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      u1Byte  *data
-)
-{
-       struct rtl8192cd_priv *priv=pDM_Odm->priv;
-
-       int ant = _atoi(data, 16);
-
-       ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("ODM_Diversity_AntennaSelect==============>\n"));
-
-       #ifdef PCIE_POWER_SAVING
-       PCIeWakeUp(priv, POWER_DOWN_T0);
-       #endif
-
-       if (ant==Antenna_B || ant==Antenna_A)
-       {
-               if ( !priv->pshare->rf_ft_var.antSw_select) {
-                       ODM_Write4Byte(pDM_Odm,0x870, ODM_Read4Byte(pDM_Odm,0x870) | BIT(8)| BIT(9) );  //  ANTSEL A as SW control
-                       ODM_Write1Byte(pDM_Odm,0xc50, ODM_Read1Byte(pDM_Odm,0xc50) & (~ BIT(7)));       // rx OFDM SW control
-                       PHY_SetBBReg(priv, 0x860, 0x300, ant);
-               } else {
-                       ODM_Write4Byte(pDM_Odm,0x870, ODM_Read4Byte(pDM_Odm,0x870) | BIT(24)| BIT(25) ); // ANTSEL B as HW control
-                       PHY_SetBBReg(priv, 0x864, 0x300, ant);
-                       ODM_Write1Byte(pDM_Odm,0xc58, ODM_Read1Byte(pDM_Odm,0xc58) & (~ BIT(7)));               // rx OFDM SW control
-               }
-
-               ODM_Write1Byte(pDM_Odm,0xa01, ODM_Read1Byte(pDM_Odm,0xa01) & (~ BIT(7)));       // rx CCK SW control
-               ODM_Write4Byte(pDM_Odm,0x80c, ODM_Read4Byte(pDM_Odm,0x80c) & (~ BIT(21))); // select ant by tx desc
-               ODM_Write4Byte(pDM_Odm,0x858, 0x569a569a);
-
-               priv->pshare->rf_ft_var.antHw_enable = 0;
-               priv->pshare->rf_ft_var.CurAntenna  = (ant%2);
-
-               #ifdef SW_ANT_SWITCH
-               priv->pshare->rf_ft_var.antSw_enable = 0;
-               priv->pshare->DM_SWAT_Table.CurAntenna = ant;
-               priv->pshare->RSSI_test =0;
-               #endif
-       }
-       else if(ant==0){
-
-               if ( !priv->pshare->rf_ft_var.antSw_select)  {
-                       ODM_Write4Byte(pDM_Odm,0x870, ODM_Read4Byte(pDM_Odm,0x870) & ~(BIT(8)| BIT(9)) );
-                       ODM_Write1Byte(pDM_Odm,0xc50, ODM_Read1Byte(pDM_Odm,0xc50) | BIT(7));   // OFDM HW control
-               } else {
-                       ODM_Write4Byte(pDM_Odm,0x870, ODM_Read4Byte(pDM_Odm,0x870) & ~(BIT(24)| BIT(25)) );
-                       ODM_Write1Byte(pDM_Odm,0xc58, ODM_Read1Byte(pDM_Odm,0xc58) | BIT(7));   // OFDM HW control
-               }
-
-               ODM_Write1Byte(pDM_Odm,0xa01, ODM_Read1Byte(pDM_Odm,0xa01) | BIT(7));   // CCK HW control
-               ODM_Write4Byte(pDM_Odm,0x80c, ODM_Read4Byte(pDM_Odm,0x80c) | BIT(21) ); // by tx desc
-               priv->pshare->rf_ft_var.CurAntenna = 0;
-               ODM_Write4Byte(pDM_Odm,0x858, 0x569a569a);
-               priv->pshare->rf_ft_var.antHw_enable = 1;
-#ifdef SW_ANT_SWITCH
-               priv->pshare->rf_ft_var.antSw_enable = 0;
-               priv->pshare->RSSI_test =0;
-#endif
-       }
-#ifdef SW_ANT_SWITCH
-       else if(ant==3) {
-               if(!priv->pshare->rf_ft_var.antSw_enable) {
-
-                       dm_SW_AntennaSwitchInit(priv);
-                       ODM_Write4Byte(pDM_Odm,0x858, 0x569a569a);
-                       priv->pshare->lastTxOkCnt = priv->net_stats.tx_bytes;
-                       priv->pshare->lastRxOkCnt = priv->net_stats.rx_bytes;
-               }
-               if ( !priv->pshare->rf_ft_var.antSw_select)
-                       ODM_Write1Byte(pDM_Odm,0xc50, ODM_Read1Byte(pDM_Odm,0xc50) & (~ BIT(7)));       // rx OFDM SW control
-               else
-                       ODM_Write1Byte(pDM_Odm,0xc58, ODM_Read1Byte(pDM_Odm,0xc58) & (~ BIT(7)));       // rx OFDM SW control
-
-               ODM_Write1Byte(pDM_Odm,0xa01, ODM_Read1Byte(pDM_Odm,0xa01) & (~ BIT(7)));               // rx CCK SW control
-               ODM_Write4Byte(pDM_Odm,0x80c, ODM_Read4Byte(pDM_Odm,0x80c) & (~ BIT(21)));      // select ant by tx desc
-               priv->pshare->rf_ft_var.antHw_enable = 0;
-               priv->pshare->rf_ft_var.antSw_enable = 1;
-
-       }
-#endif
-       ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("<==============ODM_Diversity_AntennaSelect\n"));
-
-       return 1;
-}
-#endif
 
 #else //#if(defined(CONFIG_HW_ANTENNA_DIVERSITY))
 
-VOID odm_InitHybridAntDiv(     IN PDM_ODM_T    pDM_Odm         ){}
-VOID odm_HwAntDiv(     IN      PDM_ODM_T       pDM_Odm){}
-#if(DM_ODM_SUPPORT_TYPE==ODM_MP)
-VOID ODM_SetTxAntByTxInfo_88C_92D(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              pu1Byte                 pDesc,
-       IN              u1Byte                  macId
-){}
-#elif(DM_ODM_SUPPORT_TYPE==ODM_CE)
-VOID ODM_SetTxAntByTxInfo_88C_92D(     IN              PDM_ODM_T               pDM_Odm){ }
-#elif(DM_ODM_SUPPORT_TYPE==ODM_AP)
-VOID ODM_SetTxAntByTxInfo_88C_92D(     IN              PDM_ODM_T               pDM_Odm){ }
-#endif
+void odm_InitHybridAntDiv( PDM_ODM_T   pDM_Odm         ){}
+void odm_HwAntDiv(     PDM_ODM_T       pDM_Odm){}
+void ODM_SetTxAntByTxInfo_88C_92D(             PDM_ODM_T               pDM_Odm){ }
 
 #endif //#if(defined(CONFIG_HW_ANTENNA_DIVERSITY))
 
@@ -6463,36 +4259,16 @@ VOID ODM_SetTxAntByTxInfo_88C_92D(      IN              PDM_ODM_T               pDM_Odm){ }
 //============================================================
 //EDCA Turbo
 //============================================================
-VOID
+void
 ODM_EdcaTurboInit(
-       IN    PDM_ODM_T         pDM_Odm)
+    PDM_ODM_T          pDM_Odm)
 {
 
-#if ((DM_ODM_SUPPORT_TYPE == ODM_AP)||(DM_ODM_SUPPORT_TYPE==ODM_ADSL))
-       odm_EdcaParaInit(pDM_Odm);
-#elif (DM_ODM_SUPPORT_TYPE==ODM_MP)
-       PADAPTER        Adapter = NULL;
-       HAL_DATA_TYPE   *pHalData = NULL;
-
-       if(pDM_Odm->Adapter==NULL)      {
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EdcaTurboInit fail!!!\n"));
-               return;
-       }
-
-       Adapter=pDM_Odm->Adapter;
-       pHalData=GET_HAL_DATA(Adapter);
-
-       pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE;
-       pDM_Odm->DM_EDCA_Table.bIsCurRDLState = FALSE;
-       pHalData->bIsAnyNonBEPkts = FALSE;
-
-#elif(DM_ODM_SUPPORT_TYPE==ODM_CE)
        PADAPTER        Adapter = pDM_Odm->Adapter;
        pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE;
        pDM_Odm->DM_EDCA_Table.bIsCurRDLState = FALSE;
        Adapter->recvpriv.bIsAnyNonBEPkts =FALSE;
 
-#endif
        ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VO PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VO_PARAM)));
        ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VI PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VI_PARAM)));
        ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM)));
@@ -6501,9 +4277,9 @@ ODM_EdcaTurboInit(
 
 }      // ODM_InitEdcaTurbo
 
-VOID
+void
 odm_EdcaTurboCheck(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        //
@@ -6526,4697 +4302,214 @@ odm_EdcaTurboCheck(
        switch  (pDM_Odm->SupportPlatform)
        {
                case    ODM_MP:
-
-#if(DM_ODM_SUPPORT_TYPE==ODM_MP)
-                       odm_EdcaTurboCheckMP(pDM_Odm);
-#endif
                        break;
 
                case    ODM_CE:
-#if(DM_ODM_SUPPORT_TYPE==ODM_CE)
                        odm_EdcaTurboCheckCE(pDM_Odm);
-#endif
                        break;
 
                case    ODM_AP:
                case    ODM_ADSL:
-
-#if ((DM_ODM_SUPPORT_TYPE == ODM_AP)||(DM_ODM_SUPPORT_TYPE==ODM_ADSL))
-               odm_IotEngine(pDM_Odm);
-#endif
                        break;
        }
        ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("<========================odm_EdcaTurboCheck\n"));
 
 }      // odm_CheckEdcaTurbo
 
-#if(DM_ODM_SUPPORT_TYPE==ODM_CE)
-
-
-VOID
+void
 odm_EdcaTurboCheckCE(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
-
-#if(DM_ODM_SUPPORT_TYPE==ODM_CE)
-
        PADAPTER                       Adapter = pDM_Odm->Adapter;
 
        u32     trafficIndex;
        u32     edca_param;
        u64     cur_tx_bytes = 0;
        u64     cur_rx_bytes = 0;
-       u8      bbtchange = _FALSE;
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-       struct xmit_priv                *pxmitpriv = &(Adapter->xmitpriv);
-       struct recv_priv                *precvpriv = &(Adapter->recvpriv);
-       struct registry_priv    *pregpriv = &Adapter->registrypriv;
-       struct mlme_ext_priv    *pmlmeext = &(Adapter->mlmeextpriv);
-       struct mlme_ext_info    *pmlmeinfo = &(pmlmeext->mlmext_info);
-
-
-       if ((pregpriv->wifi_spec == 1) )//|| (pmlmeinfo->HT_enable == 0))
-       {
-               goto dm_CheckEdcaTurbo_EXIT;
-       }
-
-       if (pmlmeinfo->assoc_AP_vendor >=  HT_IOT_PEER_MAX)
-       {
-               goto dm_CheckEdcaTurbo_EXIT;
-       }
-
-#ifdef CONFIG_BT_COEXIST
-       if (BT_DisableEDCATurbo(Adapter))
-       {
-               goto dm_CheckEdcaTurbo_EXIT;
-       }
-#endif
-
-       // Check if the status needs to be changed.
-       if((bbtchange) || (!precvpriv->bIsAnyNonBEPkts) )
-       {
-               cur_tx_bytes = pxmitpriv->tx_bytes - pxmitpriv->last_tx_bytes;
-               cur_rx_bytes = precvpriv->rx_bytes - precvpriv->last_rx_bytes;
-
-               //traffic, TX or RX
-               if((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_RALINK)||(pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_ATHEROS))
-               {
-                       if (cur_tx_bytes > (cur_rx_bytes << 2))
-                       { // Uplink TP is present.
-                               trafficIndex = UP_LINK;
-                       }
-                       else
-                       { // Balance TP is present.
-                               trafficIndex = DOWN_LINK;
-                       }
-               }
-               else
-               {
-                       if (cur_rx_bytes > (cur_tx_bytes << 2))
-                       { // Downlink TP is present.
-                               trafficIndex = DOWN_LINK;
-                       }
-                       else
-                       { // Balance TP is present.
-                               trafficIndex = UP_LINK;
-                       }
-               }
-
-               if ((pDM_Odm->DM_EDCA_Table.prv_traffic_idx != trafficIndex) || (!pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA))
-               {
-
-#if 0
-                       //adjust EDCA parameter for BE queue
-                       edca_param = EDCAParam[pmlmeinfo->assoc_AP_vendor][trafficIndex];
-#else
-
-                       if((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_CISCO) && (pmlmeext->cur_wireless_mode & WIRELESS_11_24N))
-                       {
-                               edca_param = EDCAParam[pmlmeinfo->assoc_AP_vendor][trafficIndex];
-                       }
-                       else
-                       {
-                               edca_param = EDCAParam[HT_IOT_PEER_UNKNOWN][trafficIndex];
-                       }
-#endif
-
-#ifdef CONFIG_PCI_HCI
-                       if(IS_92C_SERIAL(pHalData->VersionID))
-                       {
-                               edca_param = 0x60a42b;
-                       }
-                       else
-                       {
-                               edca_param = 0x6ea42b;
-                       }
-#endif
-                       rtw_write32(Adapter, REG_EDCA_BE_PARAM, edca_param);
-
-                       pDM_Odm->DM_EDCA_Table.prv_traffic_idx = trafficIndex;
-               }
-
-               pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _TRUE;
-       }
-       else
-       {
-               //
-               // Turn Off EDCA turbo here.
-               // Restore original EDCA according to the declaration of AP.
-               //
-                if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA)
-               {
-                       rtw_write32(Adapter, REG_EDCA_BE_PARAM, pHalData->AcParam_BE);
-                       pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _FALSE;
-               }
-       }
-
-dm_CheckEdcaTurbo_EXIT:
-       // Set variables for next time.
-       precvpriv->bIsAnyNonBEPkts = _FALSE;
-       pxmitpriv->last_tx_bytes = pxmitpriv->tx_bytes;
-       precvpriv->last_rx_bytes = precvpriv->rx_bytes;
-#endif
-}
-
-
-#elif(DM_ODM_SUPPORT_TYPE==ODM_MP)
-VOID
-odm_EdcaTurboCheckMP(
-       IN              PDM_ODM_T               pDM_Odm
-       )
-{
-
-
-       PADAPTER                       Adapter = pDM_Odm->Adapter;
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-
-#if(DM_ODM_SUPPORT_TYPE==ODM_MP)
-       PADAPTER                        pDefaultAdapter = GetDefaultAdapter(Adapter);
-       PADAPTER                        pExtAdapter = GetFirstExtAdapter(Adapter);//NULL;
-       PMGNT_INFO                      pMgntInfo = &Adapter->MgntInfo;
-       PSTA_QOS                        pStaQos = Adapter->MgntInfo.pStaQos;
-       //[Win7 Count Tx/Rx statistic for Extension Port] odm_CheckEdcaTurbo's Adapter is always Default. 2009.08.20, by Bohn
-       u8Byte                          Ext_curTxOkCnt = 0;
-       u8Byte                          Ext_curRxOkCnt = 0;
-       static u8Byte                   Ext_lastTxOkCnt = 0;
-       static u8Byte                   Ext_lastRxOkCnt = 0;
-       //For future Win7  Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn.
-       u1Byte TwoPortStatus = (u1Byte)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE;
-
-#elif (DM_ODM_SUPPORT_TYPE==ODM_CE)
-       struct dm_priv          *pdmpriv = &pHalData->dmpriv;
-       struct xmit_priv                *pxmitpriv = &(Adapter->xmitpriv);
-       struct recv_priv                *precvpriv = &(Adapter->recvpriv);
-       struct registry_priv    *pregpriv = &Adapter->registrypriv;
-       struct mlme_ext_priv    *pmlmeext = &(Adapter->mlmeextpriv);
-       struct mlme_ext_info    *pmlmeinfo = &(pmlmeext->mlmext_info);
-       #ifdef CONFIG_BT_COEXIST
-       struct btcoexist_priv   *pbtpriv = &(pHalData->bt_coexist);
-       #endif
-       u1Byte bbtchange =FALSE;
-#endif
-       // Keep past Tx/Rx packet count for RT-to-RT EDCA turbo.
-       u8Byte                          curTxOkCnt = 0;
-       u8Byte                          curRxOkCnt = 0;
-       u8Byte                  lastTxOkCnt = 0;
-       u8Byte                  lastRxOkCnt = 0;
-       u4Byte                          EDCA_BE_UL = 0x5ea42b;//Parameter suggested by Scott  //edca_setting_UL[pMgntInfo->IOTPeer];
-       u4Byte                          EDCA_BE_DL = 0x5ea42b;//Parameter suggested by Scott  //edca_setting_DL[pMgntInfo->IOTPeer];
-       u4Byte                         EDCA_BE = 0x5ea42b;
-       u4Byte                         IOTPeer=0;
-       bool                      *pbIsCurRDLState=NULL;
-       bool                      bLastIsCurRDLState=FALSE;
-       bool                             bBiasOnRx=FALSE;
-       bool                            bEdcaTurboOn=FALSE;
-
-
-       ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("odm_EdcaTurboCheckMP========================>"));
-       ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM)));
-
-////===============================
-////list paramter for different platform
-////===============================
-       bLastIsCurRDLState=pDM_Odm->DM_EDCA_Table.bIsCurRDLState;
-       pbIsCurRDLState=&(pDM_Odm->DM_EDCA_Table.bIsCurRDLState);
-#if (DM_ODM_SUPPORT_TYPE==ODM_MP)
-       // Caculate TX/RX TP:
-       curTxOkCnt = Adapter->TxStats.NumTxBytesUnicast - pMgntInfo->lastTxOkCnt;
-       curRxOkCnt = Adapter->RxStats.NumRxBytesUnicast - pMgntInfo->lastRxOkCnt;
-       if(pExtAdapter == NULL)
-               pExtAdapter = pDefaultAdapter;
-
-       Ext_curTxOkCnt = pExtAdapter->TxStats.NumTxBytesUnicast - pMgntInfo->Ext_lastTxOkCnt;
-       Ext_curRxOkCnt = pExtAdapter->RxStats.NumRxBytesUnicast - pMgntInfo->Ext_lastRxOkCnt;
-       GetTwoPortSharedResource(Adapter,TWO_PORT_SHARED_OBJECT__STATUS,NULL,&TwoPortStatus);
-       //For future Win7  Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn.
-       if(TwoPortStatus == TWO_PORT_STATUS__EXTENSION_ONLY)
-       {
-               curTxOkCnt = Ext_curTxOkCnt ;
-               curRxOkCnt = Ext_curRxOkCnt ;
-       }
-       //
-       IOTPeer=pMgntInfo->IOTPeer;
-       bBiasOnRx=(pMgntInfo->IOTAction & HT_IOT_ACT_EDCA_BIAS_ON_RX)?TRUE:FALSE;
-       bEdcaTurboOn=((!pHalData->bIsAnyNonBEPkts) && (!pMgntInfo->bDisableFrameBursting))?TRUE:FALSE;
-       ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("bIsAnyNonBEPkts : 0x%lx  bDisableFrameBursting : 0x%lx  \n",pHalData->bIsAnyNonBEPkts,pMgntInfo->bDisableFrameBursting));
-
-#elif(DM_ODM_SUPPORT_TYPE==ODM_CE)
-       // Caculate TX/RX TP:
-       curTxOkCnt = pxmitpriv->tx_bytes - pxmitpriv->last_tx_bytes;
-       curRxOkCnt = precvpriv->rx_bytes - precvpriv->last_rx_bytes;
-       #ifdef CONFIG_BT_COEXIST
-       if(pbtpriv->BT_Coexist)
-       {
-               if( (pbtpriv->BT_EDCA[UP_LINK]!=0) ||  (pbtpriv->BT_EDCA[DOWN_LINK]!=0))
-                       bbtchange = TRUE;
-       }
-       #endif
-       IOTPeer=pmlmeinfo->assoc_AP_vendor;
-       bBiasOnRx=((IOTPeer == HT_IOT_PEER_RALINK)||(IOTPeer == HT_IOT_PEER_ATHEROS))?TRUE:FALSE;
-       bEdcaTurboOn=(bbtchange || (!precvpriv->bIsAnyNonBEPkts))?TRUE:FALSE;
-       ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("bbtchange : 0x%lx  bIsAnyNonBEPkts : 0x%lx  \n",bbtchange,precvpriv->bIsAnyNonBEPkts));
-#endif
-
-
-////===============================
-////check if edca turbo is disabled
-////===============================
-       if(odm_IsEdcaTurboDisable(pDM_Odm))
-               goto dm_CheckEdcaTurbo_EXIT;
-
-
-////===============================
-////remove iot case out
-////===============================
-       ODM_EdcaParaSelByIot(pDM_Odm, &EDCA_BE_UL, &EDCA_BE_DL);
-
-
-////===============================
-////Check if the status needs to be changed.
-////===============================
-       if(bEdcaTurboOn)
-       {
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("bEdcaTurboOn : 0x%x bBiasOnRx : 0x%x\n",bEdcaTurboOn,bBiasOnRx));
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("curTxOkCnt : 0x%lx \n",curTxOkCnt));
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("curRxOkCnt : 0x%lx \n",curRxOkCnt));
-               if(bBiasOnRx)
-                       odm_EdcaChooseTrafficIdx(pDM_Odm,curTxOkCnt, curRxOkCnt,   TRUE,  pbIsCurRDLState);
-               else
-                       odm_EdcaChooseTrafficIdx(pDM_Odm,curTxOkCnt, curRxOkCnt,   FALSE,  pbIsCurRDLState);
-
-//modify by Guo.Mingzhi 2011-12-29
-                       EDCA_BE=((*pbIsCurRDLState)==TRUE)?EDCA_BE_DL:EDCA_BE_UL;
-                       ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE);
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EDCA Turbo on: EDCA_BE:0x%lx\n",EDCA_BE));
-
-//             if(((*pbIsCurRDLState)!=bLastIsCurRDLState)||(!pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA))
-//             {
-//                     EDCA_BE=((*pbIsCurRDLState)==TRUE)?EDCA_BE_DL:EDCA_BE_UL;
-//                     ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE);
- //             }
-               pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = TRUE;
-
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EDCA_BE_DL : 0x%lx  EDCA_BE_UL : 0x%lx  EDCA_BE : 0x%lx  \n",EDCA_BE_DL,EDCA_BE_UL,EDCA_BE));
-
-       }
-       else
-       {
-               // Turn Off EDCA turbo here.
-               // Restore original EDCA according to the declaration of AP.
-                if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA)
-               {
-#if (DM_ODM_SUPPORT_TYPE==ODM_MP)
-                       Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_AC_PARAM, GET_WMM_PARAM_ELE_SINGLE_AC_PARAM(pStaQos->WMMParamEle, AC0_BE) );
-#elif(DM_ODM_SUPPORT_TYPE==ODM_CE)
-                       ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM, pHalData->AcParam_BE);
-#endif
-
-                       pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE;
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Restore EDCA BE: 0x%lx  \n",pDM_Odm->WMMEDCA_BE));
-
-               }
-       }
-
-////===============================
-////Set variables for next time.
-////===============================
-dm_CheckEdcaTurbo_EXIT:
-#if (DM_ODM_SUPPORT_TYPE==ODM_MP)
-       pHalData->bIsAnyNonBEPkts = FALSE;
-       pMgntInfo->lastTxOkCnt = Adapter->TxStats.NumTxBytesUnicast;
-       pMgntInfo->lastRxOkCnt = Adapter->RxStats.NumRxBytesUnicast;
-       pMgntInfo->Ext_lastTxOkCnt = pExtAdapter->TxStats.NumTxBytesUnicast;
-       pMgntInfo->Ext_lastRxOkCnt = pExtAdapter->RxStats.NumRxBytesUnicast;
-#elif (DM_ODM_SUPPORT_TYPE==ODM_CE)
-       precvpriv->bIsAnyNonBEPkts = FALSE;
-       pxmitpriv->last_tx_bytes = pxmitpriv->tx_bytes;
-       precvpriv->last_rx_bytes = precvpriv->rx_bytes;
-#endif
-
-}
-
-
-//check if edca turbo is disabled
-bool
-odm_IsEdcaTurboDisable(
-       IN      PDM_ODM_T       pDM_Odm
-)
-{
-       PADAPTER                       Adapter = pDM_Odm->Adapter;
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-
-#if(DM_ODM_SUPPORT_TYPE==ODM_MP)
-       PMGNT_INFO                      pMgntInfo = &Adapter->MgntInfo;
-       u4Byte                         IOTPeer=pMgntInfo->IOTPeer;
-#elif (DM_ODM_SUPPORT_TYPE==ODM_CE)
-       struct registry_priv    *pregpriv = &Adapter->registrypriv;
-       struct mlme_ext_priv    *pmlmeext = &(Adapter->mlmeextpriv);
-       struct mlme_ext_info    *pmlmeinfo = &(pmlmeext->mlmext_info);
-       u4Byte                         IOTPeer=pmlmeinfo->assoc_AP_vendor;
-       u1Byte                         WirelessMode=0xFF;                   //invalid value
-
-       if(pDM_Odm->pWirelessMode!=NULL)
-               WirelessMode=*(pDM_Odm->pWirelessMode);
-
-#endif
-
-#if(BT_30_SUPPORT == 1)
-       if(pDM_Odm->bBtDisableEdcaTurbo)
-       {
-               ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("EdcaTurboDisable for BT!!\n"));
-               return TRUE;
-       }
-#endif
-
-       if((!(pDM_Odm->SupportAbility& ODM_MAC_EDCA_TURBO ))||
-               (pDM_Odm->bWIFITest)||
-               (IOTPeer>= HT_IOT_PEER_MAX))
-       {
-               ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("EdcaTurboDisable\n"));
-               return TRUE;
-       }
-
-
-#if (DM_ODM_SUPPORT_TYPE ==ODM_MP)
-       // 1. We do not turn on EDCA turbo mode for some AP that has IOT issue
-       // 2. User may disable EDCA Turbo mode with OID settings.
-       if((pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_EDCA_TURBO) ||pHalData->bForcedDisableTurboEDCA){
-               ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("IOTAction:EdcaTurboDisable\n"));
-               return  TRUE;
-               }
-
-#elif(DM_ODM_SUPPORT_TYPE==ODM_CE)
-       //suggested by Jr.Luke: open TXOP for B/G/BG/A mode 2012-0215
-       if((WirelessMode==ODM_WM_B)||(WirelessMode==(ODM_WM_B|ODM_WM_G)||(WirelessMode==ODM_WM_G)||(WirelessMode=ODM_WM_A))
-               ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM, ODM_Read4Byte(pDM_Odm, ODM_EDCA_BE_PARAM)|0x5E0000);
-
-       if(pDM_Odm->SupportICType==ODM_RTL8192D)                {
-               if ((pregpriv->wifi_spec == 1)  || (pmlmeext->cur_wireless_mode == WIRELESS_11B)) {
-                       ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("92D:EdcaTurboDisable\n"));
-                       return TRUE;
-               }
-       }
-       else
-       {
-               if((pregpriv->wifi_spec == 1) || (pmlmeinfo->HT_enable == 0)){
-                       ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("Others:EdcaTurboDisable\n"));
-                       return TRUE;
-               }
-       }
-#ifdef CONFIG_BT_COEXIST
-       if (BT_DisableEDCATurbo(Adapter))
-       {
-               goto dm_CheckEdcaTurbo_EXIT;
-       }
-#endif
-
-#endif
-
-       return  FALSE;
-
-
-}
-
-//add iot case here: for MP/CE
-VOID
-ODM_EdcaParaSelByIot(
-       IN      PDM_ODM_T       pDM_Odm,
-       OUT     u4Byte          *EDCA_BE_UL,
-       OUT u4Byte              *EDCA_BE_DL
-       )
-{
-
-       PADAPTER                       Adapter = pDM_Odm->Adapter;
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-       u4Byte                         IOTPeer=0;
-       u4Byte                         ICType=pDM_Odm->SupportICType;
-       u1Byte                         WirelessMode=0xFF;                   //invalid value
-       u4Byte                          RFType=pDM_Odm->RFType;
-
-#if(DM_ODM_SUPPORT_TYPE==ODM_MP)
-       PADAPTER                        pDefaultAdapter = GetDefaultAdapter(Adapter);
-       PADAPTER                        pExtAdapter = GetFirstExtAdapter(Adapter);//NULL;
-       PMGNT_INFO                      pMgntInfo = &Adapter->MgntInfo;
-       u1Byte                          TwoPortStatus = (u1Byte)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE;
-
-#elif(DM_ODM_SUPPORT_TYPE==ODM_CE)
-       struct mlme_ext_info    *pmlmeinfo = &(pmlmeext->mlmext_info);
-       #ifdef CONFIG_BT_COEXIST
-       struct btcoexist_priv   *pbtpriv = &(pHalData->bt_coexist);
-       #endif
-       u1Byte bbtchange =FALSE;
-#endif
-
-       if(pDM_Odm->pWirelessMode!=NULL)
-               WirelessMode=*(pDM_Odm->pWirelessMode);
-
-///////////////////////////////////////////////////////////
-////list paramter for different platform
-#if (DM_ODM_SUPPORT_TYPE==ODM_MP)
-       IOTPeer=pMgntInfo->IOTPeer;
-       GetTwoPortSharedResource(Adapter,TWO_PORT_SHARED_OBJECT__STATUS,NULL,&TwoPortStatus);
-
-#elif(DM_ODM_SUPPORT_TYPE==ODM_CE)
-       IOTPeer=pmlmeinfo->assoc_AP_vendor;
-       #ifdef CONFIG_BT_COEXIST
-       if(pbtpriv->BT_Coexist)
-       {
-               if( (pbtpriv->BT_EDCA[UP_LINK]!=0) ||  (pbtpriv->BT_EDCA[DOWN_LINK]!=0))
-                       bbtchange = TRUE;
-       }
-       #endif
-
-#endif
-
-       if(ICType==ODM_RTL8192D)
-       {
-               // Single PHY
-               if(pDM_Odm->RFType==ODM_2T2R)
-               {
-                       (*EDCA_BE_UL) = 0x60a42b;    //0x5ea42b;
-                       (*EDCA_BE_DL) = 0x60a42b;    //0x5ea42b;
-
-               }
-               else
-               {
-                       (*EDCA_BE_UL) = 0x6ea42b;
-                       (*EDCA_BE_DL) = 0x6ea42b;
-               }
-
-       }
-////============================
-/// IOT case for MP
-////============================
-#if (DM_ODM_SUPPORT_TYPE==ODM_MP)
-       else
-       {
-
-               if(pDM_Odm->SupportInterface==ODM_ITRF_PCIE){
-                       if((ICType==ODM_RTL8192C)&&(pDM_Odm->RFType==ODM_2T2R))                 {
-                               (*EDCA_BE_UL) = 0x60a42b;
-                               (*EDCA_BE_DL) = 0x60a42b;
-                       }
-                       else
-                       {
-                               (*EDCA_BE_UL) = 0x6ea42b;
-                               (*EDCA_BE_DL) = 0x6ea42b;
-                       }
-               }
-       }
-
-       if(TwoPortStatus == TWO_PORT_STATUS__EXTENSION_ONLY)
-       {
-               (*EDCA_BE_UL) = 0x5ea42b;//Parameter suggested by Scott  //edca_setting_UL[ExtAdapter->MgntInfo.IOTPeer];
-               (*EDCA_BE_DL) = 0x5ea42b;//Parameter suggested by Scott  //edca_setting_DL[ExtAdapter->MgntInfo.IOTPeer];
-       }
-
-       #if (INTEL_PROXIMITY_SUPPORT == 1)
-       if(pMgntInfo->IntelClassModeInfo.bEnableCA == TRUE)
-       {
-               (*EDCA_BE_UL) = (*EDCA_BE_DL) = 0xa44f;
-       }
-       else
-       #endif
-       {
-               if((!pMgntInfo->bDisableFrameBursting) &&
-                       (pMgntInfo->IOTAction & (HT_IOT_ACT_FORCED_ENABLE_BE_TXOP|HT_IOT_ACT_AMSDU_ENABLE)))
-               {// To check whether we shall force turn on TXOP configuration.
-                       if(!((*EDCA_BE_UL) & 0xffff0000))
-                               (*EDCA_BE_UL) |= 0x005e0000; // Force TxOP limit to 0x005e for UL.
-                       if(!((*EDCA_BE_DL) & 0xffff0000))
-                               (*EDCA_BE_DL) |= 0x005e0000; // Force TxOP limit to 0x005e for DL.
-               }
-
-               //92D txop can't be set to 0x3e for cisco1250
-               if((ICType!=ODM_RTL8192D) && (IOTPeer== HT_IOT_PEER_CISCO) &&(WirelessMode==ODM_WM_N24G))
-               {
-                       (*EDCA_BE_DL) = edca_setting_DL[IOTPeer];
-                       (*EDCA_BE_UL) = edca_setting_UL[IOTPeer];
-               }
-               //merge from 92s_92c_merge temp brunch v2445    20120215
-               else if((IOTPeer == HT_IOT_PEER_CISCO) &&((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A)||(WirelessMode==ODM_WM_B)))
-               {
-                       (*EDCA_BE_DL) = edca_setting_DL_GMode[IOTPeer];
-               }
-               else if((IOTPeer== HT_IOT_PEER_AIRGO )&& ((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A)))
-               {
-                       (*EDCA_BE_DL) = 0xa630;
-               }
-
-               else if(IOTPeer == HT_IOT_PEER_MARVELL)
-               {
-                       (*EDCA_BE_DL) = edca_setting_DL[IOTPeer];
-                       (*EDCA_BE_UL) = edca_setting_UL[IOTPeer];
-               }
-               else if(IOTPeer == HT_IOT_PEER_ATHEROS)
-               {
-                       // Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue.
-                       (*EDCA_BE_DL) = edca_setting_DL[IOTPeer];
-               }
-       }
-////============================
-/// IOT case for CE
-////============================
-#elif (DM_ODM_SUPPORT_TYPE==ODM_CE)
-
-       if(RFType==ODM_RTL8192D)
-       {
-               if((IOTPeer == HT_IOT_PEER_CISCO) &&(WirelessMode==ODM_WM_N24G))
-               {
-                       (*EDCA_BE_UL) = EDCAParam[IOTPeer][UP_LINK];
-                       (*EDCA_BE_DL)=EDCAParam[IOTPeer][DOWN_LINK];
-               }
-               else if((IOTPeer == HT_IOT_PEER_AIRGO) &&
-                       ((WirelessMode==ODM_WM_B)||(WirelessMode==(ODM_WM_B|ODM_WM_G))))
-                       (*EDCA_BE_DL)=0x00a630;
-
-               else if((IOTPeer== HT_IOT_PEER_ATHEROS) &&
-                                       (WirelessMode&ODM_WM_N5G) &&
-                                       (Adapter->securitypriv.dot11PrivacyAlgrthm == _AES_ ))
-                       (*EDCA_BE_DL)=0xa42b;
-
-       }
-       //92C IOT case:
-       else
-       {
-               #ifdef CONFIG_BT_COEXIST
-               if(bbtchange)
-               {
-                       (*EDCA_BE_UL) = pbtpriv->BT_EDCA[UP_LINK];
-                       (*EDCA_BE_DL) = pbtpriv->BT_EDCA[DOWN_LINK];
-               }
-               else
-               #endif
-               {
-                       if((IOTPeer == HT_IOT_PEER_CISCO) &&(WirelessMode==ODM_WM_N24G))
-                       {
-                               (*EDCA_BE_UL) = EDCAParam[IOTPeer][UP_LINK];
-                               (*EDCA_BE_DL)=EDCAParam[IOTPeer][DOWN_LINK];
-                       }
-                       else
-                       {
-                               (*EDCA_BE_UL)=EDCAParam[HT_IOT_PEER_UNKNOWN][UP_LINK];
-                               (*EDCA_BE_DL)=EDCAParam[HT_IOT_PEER_UNKNOWN][DOWN_LINK];
-                       }
-               }
-               if(pDM_Odm->SupportInterface==ODM_ITRF_PCIE){
-                       if((ICType==ODM_RTL8192C)&&(pDM_Odm->RFType==ODM_2T2R))
-                       {
-                               (*EDCA_BE_UL) = 0x60a42b;
-                               (*EDCA_BE_DL) = 0x60a42b;
-                       }
-                       else
-                       {
-                               (*EDCA_BE_UL) = 0x6ea42b;
-                               (*EDCA_BE_DL) = 0x6ea42b;
-                       }
-               }
-
-       }
-#endif
-
-       ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Special: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx",(*EDCA_BE_UL),(*EDCA_BE_DL)));
-
-}
-
-
-VOID
-odm_EdcaChooseTrafficIdx(
-       IN      PDM_ODM_T               pDM_Odm,
-       IN      u8Byte                          cur_tx_bytes,
-       IN      u8Byte                          cur_rx_bytes,
-       IN      bool                    bBiasOnRx,
-       OUT bool                *pbIsCurRDLState
-       )
-{
-
-
-       if(bBiasOnRx)
-       {
-
-               if(cur_tx_bytes>(cur_rx_bytes*4))
-               {
-                       *pbIsCurRDLState=FALSE;
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Uplink Traffic\n "));
-
-               }
-               else
-               {
-                       *pbIsCurRDLState=TRUE;
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Balance Traffic\n"));
-
-               }
-       }
-       else
-       {
-               if(cur_rx_bytes>(cur_tx_bytes*4))
-               {
-                       *pbIsCurRDLState=TRUE;
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Downlink        Traffic\n"));
-
-               }
-               else
-               {
-                       *pbIsCurRDLState=FALSE;
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Balance Traffic\n"));
-               }
-       }
-
-       return ;
-}
-
-#endif
-
-#if((DM_ODM_SUPPORT_TYPE==ODM_AP)||(DM_ODM_SUPPORT_TYPE==ODM_ADSL))
-
-void odm_EdcaParaInit(
-       IN      PDM_ODM_T       pDM_Odm
-       )
-{
-       prtl8192cd_priv priv            = pDM_Odm->priv;
-       int   mode=priv->pmib->dot11BssType.net_work_type;
-
-       static unsigned int slot_time, VO_TXOP, VI_TXOP, sifs_time;
-       struct ParaRecord EDCA[4];
-
-        memset(EDCA, 0, 4*sizeof(struct ParaRecord));
-
-       sifs_time = 10;
-       slot_time = 20;
-
-       if (mode & (ODM_WM_N24G|ODM_WM_N5G))
-               sifs_time = 16;
-
-       if (mode & (ODM_WM_N24G|ODM_WM_N5G| ODM_WM_G|ODM_WM_A))
-               slot_time = 9;
-
-
-#if((defined(RTL_MANUAL_EDCA))&&(DM_ODM_SUPPORT_TYPE==ODM_AP))
-        if( priv->pmib->dot11QosEntry.ManualEDCA ) {
-                if( OPMODE & WIFI_AP_STATE )
-                        memcpy(EDCA, priv->pmib->dot11QosEntry.AP_manualEDCA, 4*sizeof(struct ParaRecord));
-                else
-                        memcpy(EDCA, priv->pmib->dot11QosEntry.STA_manualEDCA, 4*sizeof(struct ParaRecord));
-
-               #ifdef WIFI_WMM
-               if (QOS_ENABLE)
-                       ODM_Write4Byte(pDM_Odm, ODM_EDCA_VI_PARAM, (EDCA[VI].TXOPlimit<< 16) | (EDCA[VI].ECWmax<< 12) | (EDCA[VI].ECWmin<< 8) | (sifs_time + EDCA[VI].AIFSN* slot_time));
-               else
-               #endif
-                       ODM_Write4Byte(pDM_Odm, ODM_EDCA_VI_PARAM, (EDCA[BE].TXOPlimit<< 16) | (EDCA[BE].ECWmax<< 12) | (EDCA[BE].ECWmin<< 8) | (sifs_time + EDCA[VI].AIFSN* slot_time));
-
-       }else
-       #endif //RTL_MANUAL_EDCA
-       {
-
-                if(OPMODE & WIFI_AP_STATE)
-                {
-                       memcpy(EDCA, rtl_ap_EDCA, 2*sizeof(struct ParaRecord));
-
-                       if(mode & (ODM_WM_A|ODM_WM_G|ODM_WM_N24G|ODM_WM_N5G))
-                               memcpy(&EDCA[VI], &rtl_ap_EDCA[VI_AG], 2*sizeof(struct ParaRecord));
-                       else
-                               memcpy(&EDCA[VI], &rtl_ap_EDCA[VI], 2*sizeof(struct ParaRecord));
-                }
-                else
-                {
-                       memcpy(EDCA, rtl_sta_EDCA, 2*sizeof(struct ParaRecord));
-
-                       if(mode & (ODM_WM_A|ODM_WM_G|ODM_WM_N24G|ODM_WM_N5G))
-                               memcpy(&EDCA[VI], &rtl_sta_EDCA[VI_AG], 2*sizeof(struct ParaRecord));
-                       else
-                               memcpy(&EDCA[VI], &rtl_sta_EDCA[VI], 2*sizeof(struct ParaRecord));
-                }
-
-       #ifdef WIFI_WMM
-               if (QOS_ENABLE)
-                       ODM_Write4Byte(pDM_Odm, ODM_EDCA_VI_PARAM, (EDCA[VI].TXOPlimit<< 16) | (EDCA[VI].ECWmax<< 12) | (EDCA[VI].ECWmin<< 8) | (sifs_time + EDCA[VI].AIFSN* slot_time));
-               else
-       #endif
-
-#if (DM_ODM_SUPPORT_TYPE==ODM_AP)
-                       ODM_Write4Byte(pDM_Odm, ODM_EDCA_VI_PARAM,  (EDCA[BK].ECWmax<< 12) | (EDCA[BK].ECWmin<< 8) | (sifs_time + EDCA[VI].AIFSN* slot_time));
-#elif(DM_ODM_SUPPORT_TYPE==ODM_ADSL)
-                       ODM_Write4Byte(pDM_Odm, ODM_EDCA_VI_PARAM,  (EDCA[BK].ECWmax<< 12) | (EDCA[BK].ECWmin<< 8) | (sifs_time + 2* slot_time));
-#endif
-
-
-       }
-
-       ODM_Write4Byte(pDM_Odm, ODM_EDCA_VO_PARAM, (EDCA[VO].TXOPlimit<< 16) | (EDCA[VO].ECWmax<< 12) | (EDCA[VO].ECWmin<< 8) | (sifs_time + EDCA[VO].AIFSN* slot_time));
-       ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM,  (EDCA[BE].TXOPlimit<< 16) | (EDCA[BE].ECWmax<< 12) | (EDCA[BE].ECWmin<< 8) | (sifs_time + EDCA[BE].AIFSN* slot_time));
-       ODM_Write4Byte(pDM_Odm, ODM_EDCA_BK_PARAM, (EDCA[BK].TXOPlimit<< 16) | (EDCA[BK].ECWmax<< 12) | (EDCA[BK].ECWmin<< 8) | (sifs_time + EDCA[BK].AIFSN* slot_time));
-//     ODM_Write1Byte(pDM_Odm,ACMHWCTRL, 0x00);
-
-       priv->pshare->iot_mode_enable = 0;
-#if(DM_ODM_SUPPORT_TYPE==ODM_AP)
-       if (priv->pshare->rf_ft_var.wifi_beq_iot)
-               priv->pshare->iot_mode_VI_exist = 0;
-
-       #ifdef WMM_VIBE_PRI
-       priv->pshare->iot_mode_BE_exist = 0;
-       #endif
-
-       #ifdef LOW_TP_TXOP
-       priv->pshare->BE_cwmax_enhance = 0;
-       #endif
-
-#elif (DM_ODM_SUPPORT_TYPE==ODM_ADSL)
-      priv->pshare->iot_mode_BE_exist = 0;
-#endif
-       priv->pshare->iot_mode_VO_exist = 0;
-}
-
-bool
-ODM_ChooseIotMainSTA(
-       IN      PDM_ODM_T               pDM_Odm,
-       IN      PSTA_INFO_T             pstat
-       )
-{
-       prtl8192cd_priv priv = pDM_Odm->priv;
-       bool            bhighTP_found_pstat=FALSE;
-
-       if ((GET_ROOT(priv)->up_time % 2) == 0) {
-               unsigned int tx_2s_avg = 0;
-               unsigned int rx_2s_avg = 0;
-               int i=0, aggReady=0;
-               unsigned long total_sum = (priv->pshare->current_tx_bytes+priv->pshare->current_rx_bytes);
-
-               pstat->current_tx_bytes += pstat->tx_byte_cnt;
-               pstat->current_rx_bytes += pstat->rx_byte_cnt;
-
-               if (total_sum != 0) {
-                       if (total_sum <= 100) {
-                       tx_2s_avg = (unsigned int)((pstat->current_tx_bytes*100) / total_sum);
-                       rx_2s_avg = (unsigned int)((pstat->current_rx_bytes*100) / total_sum);
-                       } else {
-                               tx_2s_avg = (unsigned int)(pstat->current_tx_bytes / (total_sum / 100));
-                               rx_2s_avg = (unsigned int)(pstat->current_rx_bytes / (total_sum / 100));
-                       }
-
-               }
-
-#if(DM_ODM_SUPPORT_TYPE==ODM_ADSL)
-               if (pstat->ht_cap_len) {
-                       if ((tx_2s_avg + rx_2s_avg) >=25 /*50*/) {
-
-                                       priv->pshare->highTP_found_pstat = pstat;
-                                       bhighTP_found_pstat=TRUE;
-                               }
-                       }
-#elif(DM_ODM_SUPPORT_TYPE==ODM_AP)
-               for(i=0; i<8; i++)
-                       aggReady += (pstat->ADDBA_ready[i]);
-               if (pstat->ht_cap_len && aggReady)
-               {
-                       if ((tx_2s_avg + rx_2s_avg >= 25)) {
-                               priv->pshare->highTP_found_pstat = pstat;
-                       }
-
-               #ifdef CLIENT_MODE
-                       if (OPMODE & WIFI_STATION_STATE) {
-#if (DM_ODM_SUPPORT_TYPE &ODM_AP) && defined(USE_OUT_SRC)
-                               if ((pstat->IOTPeer==HT_IOT_PEER_RALINK) && ((tx_2s_avg + rx_2s_avg) >= 45))
-#else
-                               if(pstat->is_ralink_sta && ((tx_2s_avg + rx_2s_avg) >= 45))
-#endif
-                                       priv->pshare->highTP_found_pstat = pstat;
-               }
-               #endif
-       }
-#endif
-       } else {
-               pstat->current_tx_bytes = pstat->tx_byte_cnt;
-               pstat->current_rx_bytes = pstat->rx_byte_cnt;
-       }
-
-       return bhighTP_found_pstat;
-}
-
-
-#ifdef WIFI_WMM
-VOID
-ODM_IotEdcaSwitch(
-       IN      PDM_ODM_T               pDM_Odm,
-       IN      unsigned char           enable
-       )
-{
-       prtl8192cd_priv priv    = pDM_Odm->priv;
-       int   mode=priv->pmib->dot11BssType.net_work_type;
-       unsigned int slot_time = 20, sifs_time = 10, BE_TXOP = 47, VI_TXOP = 94;
-       unsigned int vi_cw_max = 4, vi_cw_min = 3, vi_aifs;
-
-#if (DM_ODM_SUPPORT_TYPE==ODM_AP)
-       if (!(!priv->pmib->dot11OperationEntry.wifi_specific ||
-               ((OPMODE & WIFI_AP_STATE) && (priv->pmib->dot11OperationEntry.wifi_specific == 2))
-       #ifdef CLIENT_MODE
-               || ((OPMODE & WIFI_STATION_STATE) && (priv->pmib->dot11OperationEntry.wifi_specific == 2))
-       #endif
-               ))
-               return;
-#endif
-
-       if ((mode & (ODM_WM_N24G|ODM_WM_N5G)) && (priv->pshare->ht_sta_num
-       #ifdef WDS
-               || ((OPMODE & WIFI_AP_STATE) && priv->pmib->dot11WdsInfo.wdsEnabled && priv->pmib->dot11WdsInfo.wdsNum)
-       #endif
-               ))
-               sifs_time = 16;
-
-       if (mode & (ODM_WM_N24G|ODM_WM_N5G|ODM_WM_G|ODM_WM_A)) {
-               slot_time = 9;
-       }
-       else
-       {
-               BE_TXOP = 94;
-               VI_TXOP = 188;
-       }
-
-#if (DM_ODM_SUPPORT_TYPE==ODM_ADSL)
-       if (priv->pshare->iot_mode_VO_exist) {
-               // to separate AC_VI and AC_BE to avoid using the same EDCA settings
-               if (priv->pshare->iot_mode_BE_exist) {
-                       vi_cw_max = 5;
-                       vi_cw_min = 3;
-               } else {
-                       vi_cw_max = 6;
-                       vi_cw_min = 4;
-               }
-       }
-       vi_aifs = (sifs_time + ((OPMODE & WIFI_AP_STATE)?1:2) * slot_time);
-
-       ODM_Write4Byte(pDM_Odm, ODM_EDCA_VI_PARAM, ((VI_TXOP*(1-priv->pshare->iot_mode_VO_exist)) << 16)| (vi_cw_max << 12) | (vi_cw_min << 8) | vi_aifs);
-
-
-#elif (DM_ODM_SUPPORT_TYPE==ODM_AP)
-       if ((OPMODE & WIFI_AP_STATE) && priv->pmib->dot11OperationEntry.wifi_specific) {
-               if (priv->pshare->iot_mode_VO_exist) {
-       #ifdef WMM_VIBE_PRI
-                       if (priv->pshare->iot_mode_BE_exist)
-                       {
-                               vi_cw_max = 5;
-                               vi_cw_min = 3;
-                               vi_aifs = (sifs_time + ((OPMODE & WIFI_AP_STATE)?1:2) * slot_time);
-                       }
-                       else
-       #endif
-                       {
-                       vi_cw_max = 6;
-                       vi_cw_min = 4;
-                       vi_aifs = 0x2b;
-                       }
-               }
-               else {
-                       vi_aifs = (sifs_time + ((OPMODE & WIFI_AP_STATE)?1:2) * slot_time);
-               }
-
-               ODM_Write4Byte(pDM_Odm, ODM_EDCA_VI_PARAM, ((VI_TXOP*(1-priv->pshare->iot_mode_VO_exist)) << 16)
-                       | (vi_cw_max << 12) | (vi_cw_min << 8) | vi_aifs);
-       }
-#endif
-
-
-
-#if (DM_ODM_SUPPORT_TYPE==ODM_AP)
-       if (priv->pshare->rf_ft_var.wifi_beq_iot && priv->pshare->iot_mode_VI_exist)
-               ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM, (10 << 12) | (4 << 8) | 0x4f);
-       else if(!enable)
-#elif(DM_ODM_SUPPORT_TYPE==ODM_ADSL)
-       if(!enable)                                 //if iot is disable ,maintain original BEQ PARAM
-#endif
-               ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM, (((OPMODE & WIFI_AP_STATE)?6:10) << 12) | (4 << 8)
-                       | (sifs_time + 3 * slot_time));
-       else
-       {
-               int txop_enlarge;
-               int txop;
-               unsigned int cw_max;
-               unsigned int txop_close;
-
-       #if((DM_ODM_SUPPORT_TYPE==ODM_AP)&&(defined LOW_TP_TXOP))
-                       cw_max = ((priv->pshare->BE_cwmax_enhance) ? 10 : 6);
-                       txop_close = ((priv->pshare->rf_ft_var.low_tp_txop && priv->pshare->rf_ft_var.low_tp_txop_close) ? 1 : 0);
-
-                       if(priv->pshare->txop_enlarge == 0xe)   //if intel case
-                               txop = (txop_close ? 0 : (BE_TXOP*2));
-                       else                                                        //if other case
-                               txop = (txop_close ? 0: (BE_TXOP*priv->pshare->txop_enlarge));
-       #else
-                       cw_max=6;
-                       if((priv->pshare->txop_enlarge==0xe)||(priv->pshare->txop_enlarge==0xd))
-                               txop=BE_TXOP*2;
-                       else
-                               txop=BE_TXOP*priv->pshare->txop_enlarge;
-
-       #endif
-
-               if (priv->pshare->ht_sta_num
-       #ifdef WDS
-                       || ((OPMODE & WIFI_AP_STATE) && (mode & (ODM_WM_N24G|ODM_WM_N5G)) &&
-                       priv->pmib->dot11WdsInfo.wdsEnabled && priv->pmib->dot11WdsInfo.wdsNum)
-       #endif
-                       )
-                       {
-
-                       if (priv->pshare->txop_enlarge == 0xe) {
-                               // is intel client, use a different edca value
-                               ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM, (txop<< 16) | (cw_max<< 12) | (4 << 8) | 0x1f);
-                               priv->pshare->txop_enlarge = 2;
-                       }
-#if(DM_ODM_SUPPORT_TYPE==ODM_AP)
-       #ifndef LOW_TP_TXOP
-                        else if (priv->pshare->txop_enlarge == 0xd) {
-                               // is intel ralink, use a different edca value
-                               ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM, (txop << 16) | (4 << 12) | (3 << 8) | 0x19);
-                               priv->pshare->txop_enlarge = 2;
-                       }
-       #endif
-#endif
-                       else
-                       {
-                               if (pDM_Odm->RFType==ODM_2T2R)
-                                       ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM, (txop << 16) |
-                                               (cw_max << 12) | (4 << 8) | (sifs_time + 3 * slot_time));
-                               else
-                               #if(DM_ODM_SUPPORT_TYPE==ODM_AP)&&(defined LOW_TP_TXOP)
-                                       ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM, (txop << 16) |
-                                               (((priv->pshare->BE_cwmax_enhance) ? 10 : 5) << 12) | (3 << 8) | (sifs_time + 2 * slot_time));
-                               #else
-                                       ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM, (txop << 16) |
-                                               (5 << 12) | (3 << 8) | (sifs_time + 2 * slot_time));
-
-                               #endif
-                       }
-               }
-              else
-              {
- #if((DM_ODM_SUPPORT_TYPE==ODM_AP)&&(defined LOW_TP_TXOP))
-                        ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM, (BE_TXOP << 16) | (cw_max << 12) | (4 << 8) | (sifs_time + 3 * slot_time));
- #else
-               #if defined(CONFIG_RTL_8196D) || defined(CONFIG_RTL_8196E) || (defined(CONFIG_RTL_8197D) && !defined(CONFIG_PORT0_EXT_GIGA))
-                       ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM,  (BE_TXOP*2 << 16) | (cw_max << 12) | (5 << 8) | (sifs_time + 3 * slot_time));
-               #else
-                       ODM_Write4Byte(pDM_Odm, ODM_EDCA_BE_PARAM,  (BE_TXOP*2 << 16) | (cw_max << 12) | (4 << 8) | (sifs_time + 3 * slot_time));
-               #endif
-
- #endif
-              }
-
-       }
-}
-#endif
-
-VOID
-odm_IotEngine(
-       IN      PDM_ODM_T       pDM_Odm
-       )
-{
-
-       struct rtl8192cd_priv *priv=pDM_Odm->priv;
-       PSTA_INFO_T pstat = NULL;
-       u4Byte i;
-
-#ifdef WIFI_WMM
-       unsigned int switch_turbo = 0;
-#endif
-////////////////////////////////////////////////////////
-//  if EDCA Turbo function is not supported or Manual EDCA Setting
-//  then return
-////////////////////////////////////////////////////////
-       if(!(pDM_Odm->SupportAbility&ODM_MAC_EDCA_TURBO)){
-               ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("ODM_MAC_EDCA_TURBO NOT SUPPORTED\n"));
-               return;
-       }
-
-#if((DM_ODM_SUPPORT_TYPE==ODM_AP)&& defined(RTL_MANUAL_EDCA) && defined(WIFI_WMM))
-       if(priv->pmib->dot11QosEntry.ManualEDCA){
-               ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("ODM_MAC_EDCA_TURBO OFF: MANUAL SETTING\n"));
-               return ;
-       }
-#endif
-
-#if !(DM_ODM_SUPPORT_TYPE &ODM_AP)
- //////////////////////////////////////////////////////
- //find high TP STA every 2s
-//////////////////////////////////////////////////////
-       if ((GET_ROOT(priv)->up_time % 2) == 0)
-               priv->pshare->highTP_found_pstat==NULL;
-
-#if 0
-       phead = &priv->asoc_list;
-       plist = phead->next;
-       while(plist != phead)   {
-               pstat = list_entry(plist, struct stat_info, asoc_list);
-
-               if(ODM_ChooseIotMainSTA(pDM_Odm, pstat));              //find the correct station
-                       break;
-               if (plist == plist->next)                                          //the last plist
-                       break;
-               plist = plist->next;
-       };
-#endif
-
-       //find highTP STA
-       for(i=0; i<ODM_ASSOCIATE_ENTRY_NUM; i++) {
-               pstat = pDM_Odm->pODM_StaInfo[i];
-               if(IS_STA_VALID(pstat) && (ODM_ChooseIotMainSTA(pDM_Odm, pstat)))        //find the correct station
-                               break;
-       }
-
- //////////////////////////////////////////////////////
- //if highTP STA is not found, then return
- //////////////////////////////////////////////////////
-       if(priv->pshare->highTP_found_pstat==NULL)      {
-               ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("ODM_MAC_EDCA_TURBO OFF: NO HT STA FOUND\n"));
-               return;
-       }
-#endif
-
-       pstat=priv->pshare->highTP_found_pstat;
-
-
-#ifdef WIFI_WMM
-       if (QOS_ENABLE) {
-               if (!priv->pmib->dot11OperationEntry.wifi_specific
-               #if(DM_ODM_SUPPORT_TYPE==ODM_AP)
-                       ||((OPMODE & WIFI_AP_STATE) && (priv->pmib->dot11OperationEntry.wifi_specific == 2))
-               #elif(DM_ODM_SUPPORT_TYPE==ODM_ADSL)
-                       || (priv->pmib->dot11OperationEntry.wifi_specific == 2)
-               #endif
-                       ) {
-                       if (priv->pshare->iot_mode_enable &&
-                               ((priv->pshare->phw->VO_pkt_count > 50) ||
-                                (priv->pshare->phw->VI_pkt_count > 50) ||
-                                (priv->pshare->phw->BK_pkt_count > 50))) {
-                               priv->pshare->iot_mode_enable = 0;
-                               switch_turbo++;
-                       } else if ((!priv->pshare->iot_mode_enable) &&
-                               ((priv->pshare->phw->VO_pkt_count < 50) &&
-                                (priv->pshare->phw->VI_pkt_count < 50) &&
-                                (priv->pshare->phw->BK_pkt_count < 50))) {
-                               priv->pshare->iot_mode_enable++;
-                               switch_turbo++;
-                       }
-               }
-
-
-               #if(DM_ODM_SUPPORT_TYPE==ODM_AP)
-               if ((OPMODE & WIFI_AP_STATE) && priv->pmib->dot11OperationEntry.wifi_specific)
-               #elif (DM_ODM_SUPPORT_TYPE==ODM_ADSL)
-               if (priv->pmib->dot11OperationEntry.wifi_specific)
-               #endif
-               {
-                       if (!priv->pshare->iot_mode_VO_exist && (priv->pshare->phw->VO_pkt_count > 50)) {
-                               priv->pshare->iot_mode_VO_exist++;
-                               switch_turbo++;
-                       } else if (priv->pshare->iot_mode_VO_exist && (priv->pshare->phw->VO_pkt_count < 50)) {
-                               priv->pshare->iot_mode_VO_exist = 0;
-                               switch_turbo++;
-                       }
-#if((DM_ODM_SUPPORT_TYPE==ODM_ADSL)||((DM_ODM_SUPPORT_TYPE==ODM_AP)&&(defined WMM_VIBE_PRI)))
-                       if (priv->pshare->iot_mode_VO_exist) {
-                               //printk("[%s %d] BE_pkt_count=%d\n", __FUNCTION__, __LINE__, priv->pshare->phw->BE_pkt_count);
-                               if (!priv->pshare->iot_mode_BE_exist && (priv->pshare->phw->BE_pkt_count > 250)) {
-                                       priv->pshare->iot_mode_BE_exist++;
-                                       switch_turbo++;
-                               } else if (priv->pshare->iot_mode_BE_exist && (priv->pshare->phw->BE_pkt_count < 250)) {
-                                       priv->pshare->iot_mode_BE_exist = 0;
-                                       switch_turbo++;
-                               }
-                       }
-#endif
-
-#if (DM_ODM_SUPPORT_TYPE==ODM_AP)
-                       if (priv->pshare->rf_ft_var.wifi_beq_iot)
-                       {
-                               if (!priv->pshare->iot_mode_VI_exist && (priv->pshare->phw->VI_rx_pkt_count > 50)) {
-                                       priv->pshare->iot_mode_VI_exist++;
-                                       switch_turbo++;
-                               } else if (priv->pshare->iot_mode_VI_exist && (priv->pshare->phw->VI_rx_pkt_count < 50)) {
-                                       priv->pshare->iot_mode_VI_exist = 0;
-                                       switch_turbo++;
-                               }
-                       }
-#endif
-
-               }
-               else if (!pstat || pstat->rssi < priv->pshare->rf_ft_var.txop_enlarge_lower) {
-                  if (priv->pshare->txop_enlarge) {
-                          priv->pshare->txop_enlarge = 0;
-                          if (priv->pshare->iot_mode_enable)
-                                       switch_turbo++;
-                               }
-               }
-
-#if(defined(CLIENT_MODE) && (DM_ODM_SUPPORT_TYPE==ODM_AP))
-        if ((OPMODE & WIFI_STATION_STATE) && (priv->pmib->dot11OperationEntry.wifi_specific == 2))
-        {
-            if (priv->pshare->iot_mode_enable &&
-                (((priv->pshare->phw->VO_pkt_count > 50) ||
-                 (priv->pshare->phw->VI_pkt_count > 50) ||
-                 (priv->pshare->phw->BK_pkt_count > 50)) ||
-                 (pstat && (!pstat->ADDBA_ready[0]) & (!pstat->ADDBA_ready[3]))))
-            {
-                priv->pshare->iot_mode_enable = 0;
-                switch_turbo++;
-            }
-            else if ((!priv->pshare->iot_mode_enable) &&
-                (((priv->pshare->phw->VO_pkt_count < 50) &&
-                 (priv->pshare->phw->VI_pkt_count < 50) &&
-                 (priv->pshare->phw->BK_pkt_count < 50)) &&
-                 (pstat && (pstat->ADDBA_ready[0] | pstat->ADDBA_ready[3]))))
-            {
-                priv->pshare->iot_mode_enable++;
-                switch_turbo++;
-            }
-        }
-#endif
-
-               priv->pshare->phw->VO_pkt_count = 0;
-               priv->pshare->phw->VI_pkt_count = 0;
-               priv->pshare->phw->BK_pkt_count = 0;
-
-       #if((DM_ODM_SUPPORT_TYPE==ODM_ADSL)||((DM_ODM_SUPPORT_TYPE==ODM_AP)&&(defined WMM_VIBE_PRI)))
-               priv->pshare->phw->BE_pkt_count = 0;
-       #endif
-
-       #if(DM_ODM_SUPPORT_TYPE==ODM_AP)
-               if (priv->pshare->rf_ft_var.wifi_beq_iot)
-                       priv->pshare->phw->VI_rx_pkt_count = 0;
-               #endif
-
-       }
-#endif
-
-       if ((priv->up_time % 2) == 0) {
-               /*
-                * decide EDCA content for different chip vendor
-                */
-#ifdef WIFI_WMM
-       #if(DM_ODM_SUPPORT_TYPE==ODM_ADSL)
-               if (QOS_ENABLE && (!priv->pmib->dot11OperationEntry.wifi_specific || (priv->pmib->dot11OperationEntry.wifi_specific == 2)
-
-       #elif(DM_ODM_SUPPORT_TYPE==ODM_AP)
-               if (QOS_ENABLE && (!priv->pmib->dot11OperationEntry.wifi_specific ||
-                       ((OPMODE & WIFI_AP_STATE) && (priv->pmib->dot11OperationEntry.wifi_specific == 2))
-               #ifdef CLIENT_MODE
-            || ((OPMODE & WIFI_STATION_STATE) && (priv->pmib->dot11OperationEntry.wifi_specific == 2))
-               #endif
-       #endif
-               ))
-
-               {
-
-                       if (pstat && pstat->rssi >= priv->pshare->rf_ft_var.txop_enlarge_upper) {
-#ifdef LOW_TP_TXOP
-#if (DM_ODM_SUPPORT_TYPE &ODM_AP) && defined(USE_OUT_SRC)
-                               if (pstat->IOTPeer==HT_IOT_PEER_INTEL)
-#else
-                               if (pstat->is_intel_sta)
-#endif
-                               {
-                                       if (priv->pshare->txop_enlarge != 0xe)
-                                       {
-                                               priv->pshare->txop_enlarge = 0xe;
-
-                                               if (priv->pshare->iot_mode_enable)
-                                                       switch_turbo++;
-                                       }
-                               }
-                               else if (priv->pshare->txop_enlarge != 2)
-                               {
-                                       priv->pshare->txop_enlarge = 2;
-                                       if (priv->pshare->iot_mode_enable)
-                                               switch_turbo++;
-                               }
-#else
-                               if (priv->pshare->txop_enlarge != 2)
-                               {
-#if (DM_ODM_SUPPORT_TYPE &ODM_AP) && defined(USE_OUT_SRC)
-                                       if (pstat->IOTPeer==HT_IOT_PEER_INTEL)
-#else
-                                       if (pstat->is_intel_sta)
-#endif
-                                               priv->pshare->txop_enlarge = 0xe;
-#if (DM_ODM_SUPPORT_TYPE &ODM_AP) && defined(USE_OUT_SRC)
-                                       else if (pstat->IOTPeer==HT_IOT_PEER_RALINK)
-#else
-                                       else if (pstat->is_ralink_sta)
-#endif
-                                               priv->pshare->txop_enlarge = 0xd;
-                                       else
-                                               priv->pshare->txop_enlarge = 2;
-
-                                       if (priv->pshare->iot_mode_enable)
-                                               switch_turbo++;
-                               }
-#endif
-#if 0
-                               if (priv->pshare->txop_enlarge != 2)
-                               {
-                               #if(DM_ODM_SUPPORT_TYPE==ODM_AP)
-                                       if (pstat->IOTPeer==HT_IOT_PEER_INTEL)
-                               #else
-                                       if (pstat->is_intel_sta)
-                               #endif
-                                               priv->pshare->txop_enlarge = 0xe;
-                               #if(DM_ODM_SUPPORT_TYPE==ODM_AP)
-                                       else if (pstat->IOTPeer==HT_IOT_PEER_RALINK)
-                                               priv->pshare->txop_enlarge = 0xd;
-                               #endif
-                                       else
-                                               priv->pshare->txop_enlarge = 2;
-                                       if (priv->pshare->iot_mode_enable)
-                                               switch_turbo++;
-                               }
-#endif
-                       }
-                       else if (!pstat || pstat->rssi < priv->pshare->rf_ft_var.txop_enlarge_lower)
-                       {
-                               if (priv->pshare->txop_enlarge) {
-                                       priv->pshare->txop_enlarge = 0;
-                                       if (priv->pshare->iot_mode_enable)
-                                               switch_turbo++;
-                               }
-                       }
-
-#if((DM_ODM_SUPPORT_TYPE==ODM_AP)&&( defined LOW_TP_TXOP))
-                       // for Intel IOT, need to enlarge CW MAX from 6 to 10
-                       if (pstat && pstat->is_intel_sta && (((pstat->tx_avarage+pstat->rx_avarage)>>10) <
-                                       priv->pshare->rf_ft_var.cwmax_enhance_thd))
-                       {
-                               if (!priv->pshare->BE_cwmax_enhance && priv->pshare->iot_mode_enable)
-                               {
-                                       priv->pshare->BE_cwmax_enhance = 1;
-                                       switch_turbo++;
-                               }
-                       } else {
-                               if (priv->pshare->BE_cwmax_enhance) {
-                                       priv->pshare->BE_cwmax_enhance = 0;
-                                       switch_turbo++;
-                               }
-                       }
-#endif
-               }
-#endif
-               priv->pshare->current_tx_bytes = 0;
-               priv->pshare->current_rx_bytes = 0;
-       }
-
-#if((DM_ODM_SUPPORT_TYPE==ODM_AP)&& defined( SW_TX_QUEUE))
-       if ((priv->assoc_num > 1) && (AMPDU_ENABLE))
-       {
-       if (priv->swq_txmac_chg >= priv->pshare->rf_ft_var.swq_en_highthd){
-                       if ((priv->swq_en == 0)){
-                               switch_turbo++;
-                               if (priv->pshare->txop_enlarge == 0)
-                                       priv->pshare->txop_enlarge = 2;
-                               priv->swq_en = 1;
-                               }
-                       else
-                       {
-                               if ((switch_turbo > 0) && (priv->pshare->txop_enlarge == 0) && (priv->pshare->iot_mode_enable != 0))
-                               {
-                                       priv->pshare->txop_enlarge = 2;
-                                       switch_turbo--;
-                               }
-                       }
-               }
-               else if(priv->swq_txmac_chg <= priv->pshare->rf_ft_var.swq_dis_lowthd){
-                       priv->swq_en = 0;
-               }
-               else if ((priv->swq_en == 1) && (switch_turbo > 0) && (priv->pshare->txop_enlarge == 0) && (priv->pshare->iot_mode_enable != 0))        {
-                       priv->pshare->txop_enlarge = 2;
-               switch_turbo--;
-       }
-    }
-#if ((DM_ODM_SUPPORT_TYPE==ODM_AP)&&(defined CONFIG_RTL_819XD))
-    else if( (priv->assoc_num == 1) && (AMPDU_ENABLE)) {
-        if (pstat) {
-                       int en_thd = 14417920>>(priv->up_time % 2);
-            if ((priv->swq_en == 0) && (pstat->current_tx_bytes > en_thd) && (pstat->current_rx_bytes > en_thd) )  { //50Mbps
-                priv->swq_en = 1;
-                               priv->swqen_keeptime = priv->up_time;
-            }
-            else if ((priv->swq_en == 1) && ((pstat->tx_avarage < 4587520) || (pstat->rx_avarage < 4587520))) { //35Mbps
-                priv->swq_en = 0;
-                               priv->swqen_keeptime = 0;
-            }
-        }
-        else {
-            priv->swq_en = 0;
-                       priv->swqen_keeptime = 0;
-        }
-    }
-#endif
-#endif
-
-#ifdef WIFI_WMM
-#ifdef LOW_TP_TXOP
-       if ((!priv->pmib->dot11OperationEntry.wifi_specific || (priv->pmib->dot11OperationEntry.wifi_specific == 2))
-               && QOS_ENABLE) {
-               if (switch_turbo || priv->pshare->rf_ft_var.low_tp_txop) {
-                       unsigned int thd_tp;
-                       unsigned char under_thd;
-                       unsigned int curr_tp;
-
-                       if (priv->pmib->dot11BssType.net_work_type & (ODM_WM_N24G|ODM_WM_N5G| ODM_WM_G))
-                       {
-                               // Determine the upper bound throughput threshold.
-                               if (priv->pmib->dot11BssType.net_work_type & (ODM_WM_N24G|ODM_WM_N5G)) {
-                                       if (priv->assoc_num && priv->assoc_num != priv->pshare->ht_sta_num)
-                                               thd_tp = priv->pshare->rf_ft_var.low_tp_txop_thd_g;
-                                       else
-                                               thd_tp = priv->pshare->rf_ft_var.low_tp_txop_thd_n;
-                               }
-                               else
-                                       thd_tp = priv->pshare->rf_ft_var.low_tp_txop_thd_g;
-
-                               // Determine to close txop.
-                               curr_tp = (unsigned int)(priv->ext_stats.tx_avarage>>17) + (unsigned int)(priv->ext_stats.rx_avarage>>17);
-                               if (curr_tp <= thd_tp && curr_tp >= priv->pshare->rf_ft_var.low_tp_txop_thd_low)
-                                       under_thd = 1;
-                               else
-                                       under_thd = 0;
-                       }
-                       else
-                       {
-                               under_thd = 0;
-                       }
-
-                       if (switch_turbo)
-                       {
-                               priv->pshare->rf_ft_var.low_tp_txop_close = under_thd;
-                               priv->pshare->rf_ft_var.low_tp_txop_count = 0;
-                       }
-                       else if (priv->pshare->iot_mode_enable && (priv->pshare->rf_ft_var.low_tp_txop_close != under_thd)) {
-                               priv->pshare->rf_ft_var.low_tp_txop_count++;
-                               if (priv->pshare->rf_ft_var.low_tp_txop_close) {
-                                       priv->pshare->rf_ft_var.low_tp_txop_count = priv->pshare->rf_ft_var.low_tp_txop_delay;;
-                               }
-                               if (priv->pshare->rf_ft_var.low_tp_txop_count ==priv->pshare->rf_ft_var.low_tp_txop_delay)
-
-                               {
-                                       priv->pshare->rf_ft_var.low_tp_txop_count = 0;
-                                       priv->pshare->rf_ft_var.low_tp_txop_close = under_thd;
-                                       switch_turbo++;
-                               }
-                       }
-                       else
-                       {
-                               priv->pshare->rf_ft_var.low_tp_txop_count = 0;
-                       }
-               }
-       }
-#endif
-
-       if (switch_turbo)
-               ODM_IotEdcaSwitch( pDM_Odm, priv->pshare->iot_mode_enable );
-#endif
-}
-#endif
-
-
-#if( DM_ODM_SUPPORT_TYPE == ODM_MP)
-//
-// 2011/07/26 MH Add an API for testing IQK fail case.
-//
-bool
-ODM_CheckPowerStatus(
-       IN      PADAPTER                Adapter)
-{
-
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-       PDM_ODM_T                       pDM_Odm = &pHalData->DM_OutSrc;
-       RT_RF_POWER_STATE       rtState;
-       PMGNT_INFO                      pMgntInfo       = &(Adapter->MgntInfo);
-
-       // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence.
-       if (pMgntInfo->init_adpt_in_progress == TRUE)
-       {
-               ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter"));
-               return  TRUE;
-       }
-
-       //
-       //      2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK.
-       //
-       Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState));
-       if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff)
-       {
-               ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n",
-               Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState));
-               return  FALSE;
-       }
-       return  TRUE;
-}
-#endif
-
-// need to ODM CE Platform
-//move to here for ANT detection mechanism using
-
-#if ((DM_ODM_SUPPORT_TYPE == ODM_MP)||(DM_ODM_SUPPORT_TYPE == ODM_CE))
-u4Byte
-GetPSDData(
-       IN PDM_ODM_T    pDM_Odm,
-       unsigned int    point,
-       u1Byte initial_gain_psd)
-{
-       //unsigned int  val, rfval;
-       //int   psd_report;
-       u4Byte  psd_report;
-
-       //HAL_DATA_TYPE         *pHalData = GET_HAL_DATA(Adapter);
-       //Debug Message
-       //val = PHY_QueryBBReg(Adapter,0x908, bMaskDWord);
-       //DbgPrint("Reg908 = 0x%x\n",val);
-       //val = PHY_QueryBBReg(Adapter,0xDF4, bMaskDWord);
-       //rfval = PHY_QueryRFReg(Adapter, RF_PATH_A, 0x00, bRFRegOffsetMask);
-       //DbgPrint("RegDF4 = 0x%x, RFReg00 = 0x%x\n",val, rfval);
-       //DbgPrint("PHYTXON = %x, OFDMCCA_PP = %x, CCKCCA_PP = %x, RFReg00 = %x\n",
-               //(val&BIT25)>>25, (val&BIT14)>>14, (val&BIT15)>>15, rfval);
-
-       //Set DCO frequency index, offset=(40MHz/SamplePts)*point
-       ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point);
-
-       //Start PSD calculation, Reg808[22]=0->1
-       ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1);
-       //Need to wait for HW PSD report
-       ODM_StallExecution(30);
-       ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0);
-       //Read PSD report, Reg8B4[15:0]
-       psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF;
-
-#if 1//(DEV_BUS_TYPE == RT_PCI_INTERFACE) && ( (RT_PLATFORM == PLATFORM_LINUX) || (RT_PLATFORM == PLATFORM_MACOSX))
-       psd_report = (u4Byte) (ConvertTo_dB(psd_report))+(u4Byte)(initial_gain_psd-0x1c);
-#else
-       psd_report = (int) (20*log10((double)psd_report))+(int)(initial_gain_psd-0x1c);
-#endif
-
-       return psd_report;
-
-}
-
-u4Byte
-ConvertTo_dB(
-       u4Byte  Value)
-{
-       u1Byte i;
-       u1Byte j;
-       u4Byte dB;
-
-       Value = Value & 0xFFFF;
-
-       for (i=0;i<8;i++)
-       {
-               if (Value <= dB_Invert_Table[i][11])
-               {
-                       break;
-               }
-       }
-
-       if (i >= 8)
-       {
-               return (96);    // maximum 96 dB
-       }
-
-       for (j=0;j<12;j++)
-       {
-               if (Value <= dB_Invert_Table[i][j])
-               {
-                       break;
-               }
-       }
-
-       dB = i*12 + j + 1;
-
-       return (dB);
-}
-
-#endif
-
-//
-// LukeLee:
-// PSD function will be moved to FW in future IC, but now is only implemented in MP platform
-// So PSD function will not be incorporated to common ODM
-//
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
-#define        AFH_PSD         1       //0:normal PSD scan, 1: only do 20 pts PSD
-#define        MODE_40M                0       //0:20M, 1:40M
-#define        PSD_TH2         3
-#define        PSD_CHMIN               20   // Minimum channel number for BT AFH
-#define        SIR_STEP_SIZE   3
-#define   Smooth_Size_1                5
-#define        Smooth_TH_1     3
-#define   Smooth_Size_2                10
-#define        Smooth_TH_2     4
-#define   Smooth_Size_3                20
-#define        Smooth_TH_3     4
-#define   Smooth_Step_Size 5
-#define        Adaptive_SIR    1
-//#if(RTL8723_FPGA_VERIFICATION == 1)
-//#define      PSD_RESCAN              1
-//#else
-//#define      PSD_RESCAN              4
-//#endif
-#define        SCAN_INTERVAL   700 //ms
-#define        SYN_Length              5    // for 92D
-
-#define        LNA_Low_Gain_1                      0x64
-#define        LNA_Low_Gain_2                      0x5A
-#define        LNA_Low_Gain_3                      0x58
-
-#define        pw_th_10dB                                      0x0
-#define        pw_th_16dB                                      0x3
-
-#define        FA_RXHP_TH1                           5000
-#define        FA_RXHP_TH2                           1500
-#define        FA_RXHP_TH3                             800
-#define        FA_RXHP_TH4                             600
-#define        FA_RXHP_TH5                             500
-
-#define        Idle_Mode                                       0
-#define        High_TP_Mode                            1
-#define        Low_TP_Mode                             2
-
-
-VOID
-odm_PSDMonitorInit(
-       IN PDM_ODM_T    pDM_Odm)
-{
-#if (DEV_BUS_TYPE == RT_PCI_INTERFACE)|(DEV_BUS_TYPE == RT_USB_INTERFACE)
-       //HAL_DATA_TYPE         *pHalData = GET_HAL_DATA(Adapter);
-       //PSD Monitor Setting
-       //Which path in ADC/DAC is turnned on for PSD: both I/Q
-       ODM_SetBBReg(pDM_Odm, ODM_PSDREG, BIT10|BIT11, 0x3);
-       //Ageraged number: 8
-       ODM_SetBBReg(pDM_Odm, ODM_PSDREG, BIT12|BIT13, 0x1);
-       pDM_Odm->bPSDinProcess = FALSE;
-       pDM_Odm->bUserAssignLevel = FALSE;
-
-       //pDM_Odm->bDMInitialGainEnable=TRUE;           //change the initialization to DIGinit
-       //Set Debug Port
-       //PHY_SetBBReg(Adapter, 0x908, bMaskDWord, 0x803);
-       //PHY_SetBBReg(Adapter, 0xB34, bMaskByte0, 0x00); // pause PSD
-       //PHY_SetBBReg(Adapter, 0xB38, bMaskByte0, 10); //rescan
-       //PHY_SetBBReg(Adapter, 0xB38, bMaskByte1, 0x32); // PSDDelay
-       //PHY_SetBBReg(Adapter, 0xB38, bMaskByte2|bMaskByte3, 100); //interval
-
-       //PlatformSetTimer( Adapter, &pHalData->PSDTriggerTimer, 0); //ms
-#endif
-}
-
-VOID
-PatchDCTone(
-       IN      PDM_ODM_T       pDM_Odm,
-       pu4Byte         PSD_report,
-       u1Byte          initial_gain_psd
-)
-{
-       //HAL_DATA_TYPE         *pHalData = GET_HAL_DATA(Adapter);
-       //PADAPTER      pAdapter;
-
-       u4Byte  psd_report;
-
-       //2 Switch to CH11 to patch CH9 and CH13 DC tone
-       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, 0x3FF, 11);
-
-       if(pDM_Odm->SupportICType== ODM_RTL8192D)
-       {
-               if((*(pDM_Odm->pMacPhyMode) == ODM_SMSP)||(*(pDM_Odm->pMacPhyMode) == ODM_DMSP))
-               {
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, RF_CHNLBW, 0x3FF, 11);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x25, 0xfffff, 0x643BC);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x26, 0xfffff, 0xFC038);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x27, 0xfffff, 0x77C1A);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x2B, 0xfffff, 0x41289);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x2C, 0xfffff, 0x01840);
-               }
-               else
-               {
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x25, 0xfffff, 0x643BC);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x26, 0xfffff, 0xFC038);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x27, 0xfffff, 0x77C1A);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x2B, 0xfffff, 0x41289);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x2C, 0xfffff, 0x01840);
-               }
-       }
-
-       //Ch9 DC tone patch
-       psd_report = GetPSDData(pDM_Odm, 96, initial_gain_psd);
-       PSD_report[50] = psd_report;
-       //Ch13 DC tone patch
-       psd_report = GetPSDData(pDM_Odm, 32, initial_gain_psd);
-       PSD_report[70] = psd_report;
-
-       //2 Switch to CH3 to patch CH1 and CH5 DC tone
-       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, 0x3FF, 3);
-
-
-       if(pDM_Odm->SupportICType==ODM_RTL8192D)
-       {
-               if((*(pDM_Odm->pMacPhyMode) == ODM_SMSP)||(*(pDM_Odm->pMacPhyMode) == ODM_DMSP))
-               {
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, RF_CHNLBW, 0x3FF, 3);
-                       //PHY_SetRFReg(Adapter, RF_PATH_B, 0x25, 0xfffff, 0x643BC);
-                       //PHY_SetRFReg(Adapter, RF_PATH_B, 0x26, 0xfffff, 0xFC038);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x27, 0xfffff, 0x07C1A);
-                       //PHY_SetRFReg(Adapter, RF_PATH_B, 0x2B, 0xfffff, 0x61289);
-                       //PHY_SetRFReg(Adapter, RF_PATH_B, 0x2C, 0xfffff, 0x01C41);
-               }
-               else
-               {
-                       //PHY_SetRFReg(Adapter, RF_PATH_A, 0x25, 0xfffff, 0x643BC);
-                       //PHY_SetRFReg(Adapter, RF_PATH_A, 0x26, 0xfffff, 0xFC038);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x27, 0xfffff, 0x07C1A);
-                       //PHY_SetRFReg(Adapter, RF_PATH_A, 0x2B, 0xfffff, 0x61289);
-                       //PHY_SetRFReg(Adapter, RF_PATH_A, 0x2C, 0xfffff, 0x01C41);
-               }
-       }
-
-       //Ch1 DC tone patch
-       psd_report = GetPSDData(pDM_Odm, 96, initial_gain_psd);
-       PSD_report[10] = psd_report;
-       //Ch5 DC tone patch
-       psd_report = GetPSDData(pDM_Odm, 32, initial_gain_psd);
-       PSD_report[30] = psd_report;
-
-}
-
-
-VOID
-GoodChannelDecision(
-       PDM_ODM_T       pDM_Odm,
-       ps4Byte         PSD_report,
-       pu1Byte         PSD_bitmap,
-       u1Byte          RSSI_BT,
-       pu1Byte         PSD_bitmap_memory)
-{
-       pRXHP_T                 pRX_HP_Table = &pDM_Odm->DM_RXHP_Table;
-       //s4Byte        TH1 =  SSBT-0x15;    // modify TH by Neil Chen
-       s4Byte  TH1= RSSI_BT+0x14;
-       s4Byte  TH2 = RSSI_BT+85;
-       //u2Byte    TH3;
-//     s4Byte  RegB34;
-       u1Byte  bitmap, Smooth_size[3], Smooth_TH[3];
-       //u1Byte        psd_bit;
-       u4Byte  i,n,j, byte_idx, bit_idx, good_cnt, good_cnt_smoothing, Smooth_Interval[3];
-       int             start_byte_idx,start_bit_idx,cur_byte_idx, cur_bit_idx,NOW_byte_idx ;
-
-//     RegB34 = PHY_QueryBBReg(Adapter,0xB34, bMaskDWord)&0xFF;
-
-       if((pDM_Odm->SupportICType == ODM_RTL8192C)||(pDM_Odm->SupportICType == ODM_RTL8192D))
-       {
-            TH1 = RSSI_BT + 0x14;
-       }
-
-       Smooth_size[0]=Smooth_Size_1;
-       Smooth_size[1]=Smooth_Size_2;
-       Smooth_size[2]=Smooth_Size_3;
-       Smooth_TH[0]=Smooth_TH_1;
-       Smooth_TH[1]=Smooth_TH_2;
-       Smooth_TH[2]=Smooth_TH_3;
-       Smooth_Interval[0]=16;
-       Smooth_Interval[1]=15;
-       Smooth_Interval[2]=13;
-       good_cnt = 0;
-       if(pDM_Odm->SupportICType==ODM_RTL8723A)
-       {
-               //2 Threshold
-
-               if(RSSI_BT >=41)
-                       TH1 = 113;
-               else if(RSSI_BT >=38)   // >= -15dBm
-                       TH1 = 105;                              //0x69
-               else if((RSSI_BT >=33)&(RSSI_BT <38))
-                       TH1 = 99+(RSSI_BT-33);         //0x63
-               else if((RSSI_BT >=26)&(RSSI_BT<33))
-                       TH1 = 99-(33-RSSI_BT)+2;     //0x5e
-               else if((RSSI_BT >=24)&(RSSI_BT<26))
-                       TH1 = 88-((RSSI_BT-24)*3);   //0x58
-               else if((RSSI_BT >=18)&(RSSI_BT<24))
-                       TH1 = 77+((RSSI_BT-18)*2);
-               else if((RSSI_BT >=14)&(RSSI_BT<18))
-                       TH1 = 63+((RSSI_BT-14)*2);
-               else if((RSSI_BT >=8)&(RSSI_BT<14))
-                       TH1 = 58+((RSSI_BT-8)*2);
-               else if((RSSI_BT >=3)&(RSSI_BT<8))
-                       TH1 = 52+(RSSI_BT-3);
-               else
-                       TH1 = 51;
-       }
-
-       for (i = 0; i< 10; i++)
-               PSD_bitmap[i] = 0;
-
-
-        // Add By Gary
-       for (i=0; i<80; i++)
-               pRX_HP_Table->PSD_bitmap_RXHP[i] = 0;
-       // End
-
-
-
-       if(pDM_Odm->SupportICType==ODM_RTL8723A)
-       {
-               TH1 =TH1-SIR_STEP_SIZE;
-       }
-       while (good_cnt < PSD_CHMIN)
-       {
-               good_cnt = 0;
-               if(pDM_Odm->SupportICType==ODM_RTL8723A)
-               {
-               if(TH1 ==TH2)
-                       break;
-               if((TH1+SIR_STEP_SIZE) < TH2)
-                       TH1 += SIR_STEP_SIZE;
-               else
-                       TH1 = TH2;
-               }
-               else
-               {
-                       if(TH1==(RSSI_BT+0x1E))
-                            break;
-                       if((TH1+2) < (RSSI_BT+0x1E))
-                               TH1+=3;
-                       else
-                               TH1 = RSSI_BT+0x1E;
-
-               }
-               ODM_RT_TRACE(pDM_Odm,COMP_PSD,DBG_LOUD,("PSD: decision threshold is: %d", TH1));
-
-               for (i = 0; i< 80; i++)
-               {
-                       if(PSD_report[i] < TH1)
-                       {
-                               byte_idx = i / 8;
-                               bit_idx = i -8*byte_idx;
-                               bitmap = PSD_bitmap[byte_idx];
-                               PSD_bitmap[byte_idx] = bitmap | (u1Byte) (1 << bit_idx);
-                       }
-               }
-
-#if DBG
-               ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("PSD: before smoothing\n"));
-               for(n=0;n<10;n++)
-               {
-                       //DbgPrint("PSD_bitmap[%u]=%x\n", n, PSD_bitmap[n]);
-                       for (i = 0; i<8; i++)
-                               ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("PSD_bitmap[%u] =   %d\n", 2402+n*8+i, (PSD_bitmap[n]&BIT(i))>>i));
-               }
-#endif
-
-               //1 Start of smoothing function
-
-               for (j=0;j<3;j++)
-               {
-                       start_byte_idx=0;
-                       start_bit_idx=0;
-                       for(n=0; n<Smooth_Interval[j]; n++)
-                       {
-                               good_cnt_smoothing = 0;
-                               cur_bit_idx = start_bit_idx;
-                               cur_byte_idx = start_byte_idx;
-                               for ( i=0; i < Smooth_size[j]; i++)
-                               {
-                                       NOW_byte_idx = cur_byte_idx + (i+cur_bit_idx)/8;
-                                       if ( (PSD_bitmap[NOW_byte_idx]& BIT( (cur_bit_idx + i)%8)) != 0)
-                                               good_cnt_smoothing++;
-
-                               }
-
-                               if( good_cnt_smoothing < Smooth_TH[j] )
-                               {
-                                       cur_bit_idx = start_bit_idx;
-                                       cur_byte_idx = start_byte_idx;
-                                       for ( i=0; i< Smooth_size[j] ; i++)
-                                       {
-                                               NOW_byte_idx = cur_byte_idx + (i+cur_bit_idx)/8;
-                                               PSD_bitmap[NOW_byte_idx] = PSD_bitmap[NOW_byte_idx] & (~BIT( (cur_bit_idx + i)%8));
-                                       }
-                               }
-                               start_bit_idx =  start_bit_idx + Smooth_Step_Size;
-                               while ( (start_bit_idx)  > 7 )
-                               {
-                                       start_byte_idx= start_byte_idx+start_bit_idx/8;
-                                       start_bit_idx = start_bit_idx%8;
-                               }
-                       }
-
-                       ODM_RT_TRACE(   pDM_Odm,COMP_PSD, DBG_LOUD,("PSD: after %u smoothing", j+1));
-                       for(n=0;n<10;n++)
-                       {
-                               for (i = 0; i<8; i++)
-                               {
-                                       ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("PSD_bitmap[%u] =   %d\n", 2402+n*8+i, (PSD_bitmap[n]&BIT(i))>>i));
-
-                                       if ( ((PSD_bitmap[n]&BIT(i))>>i) ==1)  //----- Add By Gary
-                                       {
-                                          pRX_HP_Table->PSD_bitmap_RXHP[8*n+i] = 1;
-                                       }                                                  // ------end by Gary
-                               }
-                       }
-
-               }
-
-
-               good_cnt = 0;
-               for ( i = 0; i < 10; i++)
-               {
-                       for (n = 0; n < 8; n++)
-                               if((PSD_bitmap[i]& BIT(n)) != 0)
-                                       good_cnt++;
-               }
-               ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("PSD: good channel cnt = %u",good_cnt));
-       }
-
-       //RT_TRACE(COMP_PSD, DBG_LOUD,("PSD: SSBT=%d, TH2=%d, TH1=%d",SSBT,TH2,TH1));
-       for (i = 0; i <10; i++)
-               ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("PSD: PSD_bitmap[%u]=%x",i,PSD_bitmap[i]));
-/*
-       //Update bitmap memory
-       for(i = 0; i < 80; i++)
-       {
-               byte_idx = i / 8;
-               bit_idx = i -8*byte_idx;
-               psd_bit = (PSD_bitmap[byte_idx] & BIT(bit_idx)) >> bit_idx;
-               bitmap = PSD_bitmap_memory[i];
-               PSD_bitmap_memory[i] = (bitmap << 1) |psd_bit;
-       }
-*/
-}
-
-
-
-VOID
-odm_PSD_Monitor(
-       PDM_ODM_T       pDM_Odm
-)
-{
-       //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
-       //PDM_ODM_T             pDM_Odm = &pHalData->DM_OutSrc;
-
-
-       unsigned int            pts, start_point, stop_point, initial_gain ;
-       static u1Byte           PSD_bitmap_memory[80], init_memory = 0;
-       static u1Byte           psd_cnt=0;
-       static u4Byte           PSD_report[80], PSD_report_tmp;
-       static u8Byte           lastTxOkCnt=0, lastRxOkCnt=0;
-       u1Byte                  H2C_PSD_DATA[5]={0,0,0,0,0};
-       static u1Byte           H2C_PSD_DATA_last[5] ={0,0,0,0,0};
-       u1Byte                  idx[20]={96,99,102,106,109,112,115,118,122,125,
-                                       0,3,6,10,13,16,19,22,26,29};
-       u1Byte                  n, i, channel, BBReset,tone_idx;
-       u1Byte                  PSD_bitmap[10], SSBT=0,initial_gain_psd=0, RSSI_BT=0, initialGainUpper;
-       s4Byte                          PSD_skip_start, PSD_skip_stop;
-       u4Byte                  CurrentChannel, RXIQI, RxIdleLowPwr, wlan_channel;
-       u4Byte                  ReScan, Interval, Is40MHz;
-       u8Byte                  curTxOkCnt, curRxOkCnt;
-       int                             cur_byte_idx, cur_bit_idx;
-       PADAPTER                Adapter = pDM_Odm->Adapter;
-       PMGNT_INFO              pMgntInfo = &Adapter->MgntInfo;
-       //--------------2G band synthesizer for 92D switch RF channel using-----------------
-       u1Byte                  group_idx=0;
-       u4Byte                  SYN_RF25=0, SYN_RF26=0, SYN_RF27=0, SYN_RF2B=0, SYN_RF2C=0;
-       u4Byte                  SYN[5] = {0x25, 0x26, 0x27, 0x2B, 0x2C};    // synthesizer RF register for 2G channel
-       u4Byte                  SYN_group[3][5] = {{0x643BC, 0xFC038, 0x77C1A, 0x41289, 0x01840},     // For CH1,2,4,9,10.11.12   {0x643BC, 0xFC038, 0x77C1A, 0x41289, 0x01840}
-                                                                           {0x643BC, 0xFC038, 0x07C1A, 0x41289, 0x01840},     // For CH3,13,14
-                                                                           {0x243BC, 0xFC438, 0x07C1A, 0x4128B, 0x0FC41}};   // For Ch5,6,7,8
-       //--------------------- Add by Gary for Debug setting ----------------------
-       s4Byte                 psd_result = 0;
-       u1Byte                 RSSI_BT_new = (u1Byte) ODM_GetBBReg(pDM_Odm, 0xB9C, 0xFF);
-       u1Byte                 rssi_ctrl = (u1Byte) ODM_GetBBReg(pDM_Odm, 0xB38, 0xFF);
-       //---------------------------------------------------------------------
-
-       if(*(pDM_Odm->pbScanInProcess))
-       {
-               if((pDM_Odm->SupportICType==ODM_RTL8723A)&(pDM_Odm->SupportInterface==ODM_ITRF_PCIE))
-       {
-                       //pHalData->bPSDactive=FALSE;
-                       //ODM_SetTimer(pDM_Odm,&pDM_SWAT_Table->SwAntennaSwitchTimer, 100 )
-                       ODM_SetTimer( pDM_Odm, &pDM_Odm->PSDTimer, 900); //ms
-                       //psd_cnt=0;
-               }
-               return;
-       }
-
-       ReScan = PSD_RESCAN;
-       Interval = SCAN_INTERVAL;
-
-
-       //1 Initialization
-       if(init_memory == 0)
-       {
-               ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("Init memory\n"));
-               for(i = 0; i < 80; i++)
-                       PSD_bitmap_memory[i] = 0xFF; // channel is always good
-               init_memory = 1;
-       }
-       if(psd_cnt == 0)
-       {
-               ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("Enter dm_PSD_Monitor\n"));
-               for(i = 0; i < 80; i++)
-                       PSD_report[i] = 0;
-       }
-#if 0  //for test only
-       DbgPrint("cosa odm_PSD_Monitor call()\n");
-       DbgPrint("cosa pHalData->RSSI_BT = %d\n", pHalData->RSSI_BT);
-       DbgPrint("cosa pHalData->bUserAssignLevel = %d\n", pHalData->bUserAssignLevel);
-#if 0
-       psd_cnt++;
-       if (psd_cnt < ReScan)
-               PlatformSetTimer( Adapter, &pHalData->PSDTimer, Interval); //ms
-       else
-               psd_cnt = 0;
-       return;
-#endif
-#endif
-       //1 Backup Current Settings
-       CurrentChannel = ODM_GetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask);
-/*
-       if(pDM_Odm->SupportICType==ODM_RTL8192D)
-       {
-               //2 Record Current synthesizer parameters based on current channel
-               if((*pDM_Odm->MacPhyMode92D == SINGLEMAC_SINGLEPHY)||(*pDM_Odm->MacPhyMode92D == DUALMAC_SINGLEPHY))
-               {
-                       SYN_RF25 = ODM_GetRFReg(Adapter, RF_PATH_B, 0x25, bMaskDWord);
-                       SYN_RF26 = ODM_GetRFReg(Adapter, RF_PATH_B, 0x26, bMaskDWord);
-                       SYN_RF27 = ODM_GetRFReg(Adapter, RF_PATH_B, 0x27, bMaskDWord);
-                       SYN_RF2B = ODM_GetRFReg(Adapter, RF_PATH_B, 0x2B, bMaskDWord);
-                       SYN_RF2C = ODM_GetRFReg(Adapter, RF_PATH_B, 0x2C, bMaskDWord);
-       }
-               else     // DualMAC_DualPHY 2G
-               {
-                       SYN_RF25 = ODM_GetRFReg(Adapter, RF_PATH_A, 0x25, bMaskDWord);
-                       SYN_RF26 = ODM_GetRFReg(Adapter, RF_PATH_A, 0x26, bMaskDWord);
-                       SYN_RF27 = ODM_GetRFReg(Adapter, RF_PATH_A, 0x27, bMaskDWord);
-                       SYN_RF2B = ODM_GetRFReg(Adapter, RF_PATH_A, 0x2B, bMaskDWord);
-                       SYN_RF2C = ODM_GetRFReg(Adapter, RF_PATH_A, 0x2C, bMaskDWord);
-               }
-       }
-*/
-       //RXIQI = PHY_QueryBBReg(Adapter, 0xC14, bMaskDWord);
-       RXIQI = ODM_GetBBReg(pDM_Odm, 0xC14, bMaskDWord);
-
-       //RxIdleLowPwr = (PHY_QueryBBReg(Adapter, 0x818, bMaskDWord)&BIT28)>>28;
-       RxIdleLowPwr = (ODM_GetBBReg(pDM_Odm, 0x818, bMaskDWord)&BIT28)>>28;
-
-       //2???
-       Is40MHz = pMgntInfo->pHTInfo->bCurBW40MHz;
-
-       ODM_RT_TRACE(pDM_Odm,   COMP_PSD, DBG_LOUD,("PSD Scan Start\n"));
-       //1 Turn off CCK
-       //PHY_SetBBReg(Adapter, rFPGA0_RFMOD, BIT24, 0);
-       ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 0);
-       //1 Turn off TX
-       //Pause TX Queue
-       //PlatformEFIOWrite1Byte(Adapter, REG_TXPAUSE, 0xFF);
-       ODM_Write1Byte(pDM_Odm,REG_TXPAUSE, 0xFF);
-
-       //Force RX to stop TX immediately
-       //PHY_SetRFReg(Adapter, RF_PATH_A, RF_AC, bRFRegOffsetMask, 0x32E13);
-
-       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_AC, bRFRegOffsetMask, 0x32E13);
-       //1 Turn off RX
-       //Rx AGC off  RegC70[0]=0, RegC7C[20]=0
-       //PHY_SetBBReg(Adapter, 0xC70, BIT0, 0);
-       //PHY_SetBBReg(Adapter, 0xC7C, BIT20, 0);
-
-       ODM_SetBBReg(pDM_Odm, 0xC70, BIT0, 0);
-       ODM_SetBBReg(pDM_Odm, 0xC7C, BIT20, 0);
-
-
-       //Turn off CCA
-       //PHY_SetBBReg(Adapter, 0xC14, bMaskDWord, 0x0);
-       ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, 0x0);
-
-       //BB Reset
-       //BBReset = PlatformEFIORead1Byte(Adapter, 0x02);
-       BBReset = ODM_Read1Byte(pDM_Odm, 0x02);
-
-       //PlatformEFIOWrite1Byte(Adapter, 0x02, BBReset&(~BIT0));
-       //PlatformEFIOWrite1Byte(Adapter, 0x02, BBReset|BIT0);
-
-       ODM_Write1Byte(pDM_Odm,  0x02, BBReset&(~BIT0));
-       ODM_Write1Byte(pDM_Odm,  0x02, BBReset|BIT0);
-
-       //1 Leave RX idle low power
-       //PHY_SetBBReg(Adapter, 0x818, BIT28, 0x0);
-
-       ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x0);
-       //1 Fix initial gain
-       //if (IS_HARDWARE_TYPE_8723AE(Adapter))
-       //RSSI_BT = pHalData->RSSI_BT;
-       //else if((IS_HARDWARE_TYPE_8192C(Adapter))||(IS_HARDWARE_TYPE_8192D(Adapter)))      // Add by Gary
-       //    RSSI_BT = RSSI_BT_new;
-
-       if((pDM_Odm->SupportICType==ODM_RTL8723A)&(pDM_Odm->SupportInterface==ODM_ITRF_PCIE))
-               RSSI_BT=pDM_Odm->RSSI_BT;               //need to check C2H to pDM_Odm RSSI BT
-
-       else if((pDM_Odm->SupportICType==ODM_RTL8192C)||(pDM_Odm->SupportICType==ODM_RTL8192D))
-           RSSI_BT = RSSI_BT_new;
-
-
-
-       ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("PSD: RSSI_BT= %d\n", RSSI_BT));
-
-       if(pDM_Odm->SupportICType==ODM_RTL8723A)
-       {
-              //Neil add--2011--10--12
-               //2 Initial Gain index
-               if(RSSI_BT >=35)   // >= -15dBm
-                       initial_gain_psd = RSSI_BT*2;
-               else if((RSSI_BT >=33)&(RSSI_BT<35))
-                       initial_gain_psd = RSSI_BT*2+6;
-               else if((RSSI_BT >=24)&(RSSI_BT<33))
-                       initial_gain_psd = 70-(31-RSSI_BT);
-               else if((RSSI_BT >=19)&(RSSI_BT<24))
-                       initial_gain_psd = 64-((24-RSSI_BT)*4);
-               else if((RSSI_BT >=14)&(RSSI_BT<19))
-                       initial_gain_psd = 44-((18-RSSI_BT)*2);
-               else if((RSSI_BT >=8)&(RSSI_BT<14))
-                       initial_gain_psd = 35-(14-RSSI_BT);
-               else
-                       initial_gain_psd = 0x1B;
-       }
-       else
-       {
-               if(rssi_ctrl == 1)        // just for debug!!
-                       initial_gain_psd = RSSI_BT_new ;
-               else
-               {
-                       //need to do
-                       initial_gain_psd = pDM_Odm->RSSI_Min;    // PSD report based on RSSI
-               }
-       }
-       //if(RSSI_BT<0x17)
-       //      RSSI_BT +=3;
-       //DbgPrint("PSD: RSSI_BT= %d\n", RSSI_BT);
-       ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("PSD: RSSI_BT= %d\n", RSSI_BT));
-
-       //initialGainUpper = 0x5E;  //Modify by neil chen
-
-       if(pDM_Odm->bUserAssignLevel)
-       {
-               pDM_Odm->bUserAssignLevel = FALSE;
-               initialGainUpper = 0x7f;
-       }
-       else
-       {
-               initialGainUpper = 0x5E;
-       }
-
-       /*
-       if (initial_gain_psd < 0x1a)
-               initial_gain_psd = 0x1a;
-       if (initial_gain_psd > initialGainUpper)
-               initial_gain_psd = initialGainUpper;
-       */
-
-       if(pDM_Odm->SupportICType==ODM_RTL8723A)
-               SSBT = RSSI_BT  * 2 +0x3E;
-       else if((pDM_Odm->SupportICType==ODM_RTL8192C)||(pDM_Odm->SupportICType==ODM_RTL8192D))
-       {
-               RSSI_BT = initial_gain_psd;
-               SSBT = RSSI_BT;
-       }
-
-       //if(IS_HARDWARE_TYPE_8723AE(Adapter))
-       //      SSBT = RSSI_BT  * 2 +0x3E;
-       //else if((IS_HARDWARE_TYPE_8192C(Adapter))||(IS_HARDWARE_TYPE_8192D(Adapter)))   // Add by Gary
-       //{
-       //      RSSI_BT = initial_gain_psd;
-       //      SSBT = RSSI_BT;
-       //}
-       ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("PSD: SSBT= %d\n", SSBT));
-       ODM_RT_TRACE(   pDM_Odm,COMP_PSD, DBG_LOUD,("PSD: initial gain= 0x%x\n", initial_gain_psd));
-       //DbgPrint("PSD: SSBT= %d", SSBT);
-       //need to do
-       //pMgntInfo->bDMInitialGainEnable = FALSE;
-       pDM_Odm->bDMInitialGainEnable = FALSE;
-       initial_gain = ODM_GetBBReg(pDM_Odm, 0xc50, bMaskDWord) & 0x7F;
-       ODM_SetBBReg(pDM_Odm, 0xc50, 0x7F, initial_gain_psd);
-       //1 Turn off 3-wire
-       ODM_SetBBReg(pDM_Odm, 0x88c, BIT20|BIT21|BIT22|BIT23, 0xF);
-
-       //pts value = 128, 256, 512, 1024
-       pts = 128;
-
-       if(pts == 128)
-       {
-               ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x0);
-               start_point = 64;
-               stop_point = 192;
-       }
-       else if(pts == 256)
-       {
-               ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x1);
-               start_point = 128;
-               stop_point = 384;
-       }
-       else if(pts == 512)
-       {
-               ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x2);
-               start_point = 256;
-               stop_point = 768;
-       }
-       else
-       {
-               ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x3);
-               start_point = 512;
-               stop_point = 1536;
-       }
-
-
-//3 Skip WLAN channels if WLAN busy
-
-       curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast) - lastTxOkCnt;
-       curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast) - lastRxOkCnt;
-       lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast);
-       lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast);
-
-       PSD_skip_start=80;
-       PSD_skip_stop = 0;
-       wlan_channel = CurrentChannel & 0x0f;
-
-       ODM_RT_TRACE(pDM_Odm,COMP_PSD,DBG_LOUD,("PSD: current channel: %x, BW:%d \n", wlan_channel, Is40MHz));
-       if(pDM_Odm->SupportICType==ODM_RTL8723A)
-       {
-#if(BT_30_SUPPORT == 1)
-               if(pDM_Odm->bBtHsOperation)
-               {
-                       if(pDM_Odm->bLinked)
-                       {
-                               if(Is40MHz)
-                               {
-                                       PSD_skip_start = ((wlan_channel-1)*5 -Is40MHz*10)-2;  // Modify by Neil to add 10 chs to mask
-                                       PSD_skip_stop = (PSD_skip_start + (1+Is40MHz)*20)+4;
-                               }
-                               else
-                               {
-                                       PSD_skip_start = ((wlan_channel-1)*5 -Is40MHz*10)-10;  // Modify by Neil to add 10 chs to mask
-                                       PSD_skip_stop = (PSD_skip_start + (1+Is40MHz)*20)+18;
-                               }
-                       }
-                       else
-                       {
-                               // mask for 40MHz
-                               PSD_skip_start = ((wlan_channel-1)*5 -Is40MHz*10)-2;  // Modify by Neil to add 10 chs to mask
-                               PSD_skip_stop = (PSD_skip_start + (1+Is40MHz)*20)+4;
-                       }
-                       if(PSD_skip_start < 0)
-                               PSD_skip_start = 0;
-                       if(PSD_skip_stop >80)
-                               PSD_skip_stop = 80;
-               }
-               else
-#endif
-               {
-               if((curRxOkCnt+curTxOkCnt) > 5)
-               {
-                       if(Is40MHz)
-                       {
-                               PSD_skip_start = ((wlan_channel-1)*5 -Is40MHz*10)-2;  // Modify by Neil to add 10 chs to mask
-                               PSD_skip_stop = (PSD_skip_start + (1+Is40MHz)*20)+4;
-                       }
-                       else
-                       {
-                               PSD_skip_start = ((wlan_channel-1)*5 -Is40MHz*10)-10;  // Modify by Neil to add 10 chs to mask
-                               PSD_skip_stop = (PSD_skip_start + (1+Is40MHz)*20)+18;
-                       }
-
-                       if(PSD_skip_start < 0)
-                               PSD_skip_start = 0;
-                       if(PSD_skip_stop >80)
-                               PSD_skip_stop = 80;
-               }
-       }
-       }
-       else
-       {
-               if((curRxOkCnt+curTxOkCnt) > 1000)
-               {
-                       PSD_skip_start = (wlan_channel-1)*5 -Is40MHz*10;
-                       PSD_skip_stop = PSD_skip_start + (1+Is40MHz)*20;
-               }
-       }
-
-       ODM_RT_TRACE(pDM_Odm,COMP_PSD,DBG_LOUD,("PSD: Skip tone from %d to %d \n", PSD_skip_start, PSD_skip_stop));
-
-       for (n=0;n<80;n++)
-       {
-               if((n%20)==0)
-               {
-                       channel = (n/20)*4 + 1;
-                       /*
-                       if(pDM_Odm->SupportICType==ODM_RTL8192D)
-                       {
-                               switch(channel)
-                               {
-                                       case 1:
-                                       case 9:
-                                               group_idx = 0;
-                                               break;
-                                       case 5:
-                                               group_idx = 2;
-                                               break;
-                                       case 13:
-                                               group_idx = 1;
-                                               break;
-                               }
-
-                               if((pHalData->MacPhyMode92D == SINGLEMAC_SINGLEPHY)||(pHalData->MacPhyMode92D == DUALMAC_SINGLEPHY))
-                               {
-                                       for(i = 0; i < SYN_Length; i++)
-                                               ODM_SetRFReg(pDM_Odm, RF_PATH_B, SYN[i], bMaskDWord, SYN_group[group_idx][i]);
-
-                                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, 0x3FF, channel);
-                                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, RF_CHNLBW, 0x3FF, channel);
-                               }
-                               else  // DualMAC_DualPHY 2G
-                               {
-                                       for(i = 0; i < SYN_Length; i++)
-                                               ODM_SetRFReg(pDM_Odm, RF_PATH_A, SYN[i], bMaskDWord, SYN_group[group_idx][i]);
-
-                                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, 0x3FF, channel);
-                               }
-                       }
-                       else */
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, 0x3FF, channel);
-               }
-               tone_idx = n%20;
-               if ((n>=PSD_skip_start) && (n<PSD_skip_stop))
-               {
-                       PSD_report[n] = SSBT;
-                       ODM_RT_TRACE(pDM_Odm,COMP_PSD,DBG_LOUD,("PSD:Tone %d skipped \n", n));
-               }
-               else
-               {
-                       PSD_report_tmp =  GetPSDData(pDM_Odm, idx[tone_idx], initial_gain_psd);
-
-                       if ( PSD_report_tmp > PSD_report[n])
-                               PSD_report[n] = PSD_report_tmp;
-
-               }
-       }
-
-       PatchDCTone(pDM_Odm, PSD_report, initial_gain_psd);
-
-       //----end
-       //1 Turn on RX
-       //Rx AGC on
-       ODM_SetBBReg(pDM_Odm, 0xC70, BIT0, 1);
-       ODM_SetBBReg(pDM_Odm, 0xC7C, BIT20, 1);
-       //CCK on
-       ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 1);
-       //1 Turn on TX
-       //Resume TX Queue
-
-       ODM_Write1Byte(pDM_Odm,REG_TXPAUSE, 0x00);
-       //Turn on 3-wire
-       ODM_SetBBReg(pDM_Odm, 0x88c, BIT20|BIT21|BIT22|BIT23, 0x0);
-       //1 Restore Current Settings
-       //Resume DIG
-       pDM_Odm->bDMInitialGainEnable = TRUE;
-       ODM_SetBBReg(pDM_Odm, 0xc50, 0x7F, initial_gain);
-       // restore originl center frequency
-       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, CurrentChannel);
-
-       /*
-       if(pDM_Odm->SupportICType==ODM_RTL8192D)
-       {
-               if((pHalData->MacPhyMode92D == SINGLEMAC_SINGLEPHY)||(pHalData->MacPhyMode92D == DUALMAC_SINGLEPHY))
-               {
-                       PHY_SetRFReg(Adapter, RF_PATH_B, RF_CHNLBW, bMaskDWord, CurrentChannel);
-                       PHY_SetRFReg(Adapter, RF_PATH_B, 0x25, bMaskDWord, SYN_RF25);
-                       PHY_SetRFReg(Adapter, RF_PATH_B, 0x26, bMaskDWord, SYN_RF26);
-                       PHY_SetRFReg(Adapter, RF_PATH_B, 0x27, bMaskDWord, SYN_RF27);
-                       PHY_SetRFReg(Adapter, RF_PATH_B, 0x2B, bMaskDWord, SYN_RF2B);
-                       PHY_SetRFReg(Adapter, RF_PATH_B, 0x2C, bMaskDWord, SYN_RF2C);
-               }
-               else     // DualMAC_DualPHY
-               {
-                       PHY_SetRFReg(Adapter, RF_PATH_A, 0x25, bMaskDWord, SYN_RF25);
-                       PHY_SetRFReg(Adapter, RF_PATH_A, 0x26, bMaskDWord, SYN_RF26);
-                       PHY_SetRFReg(Adapter, RF_PATH_A, 0x27, bMaskDWord, SYN_RF27);
-                       PHY_SetRFReg(Adapter, RF_PATH_A, 0x2B, bMaskDWord, SYN_RF2B);
-                       PHY_SetRFReg(Adapter, RF_PATH_A, 0x2C, bMaskDWord, SYN_RF2C);
-               }
-       }*/
-       //Turn on CCA
-       ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, RXIQI);
-       //Restore RX idle low power
-       if(RxIdleLowPwr == TRUE)
-               ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 1);
-
-       psd_cnt++;
-       ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("PSD:psd_cnt = %d \n",psd_cnt));
-       if (psd_cnt < ReScan)
-               ODM_SetTimer(pDM_Odm, &pDM_Odm->PSDTimer, Interval);
-       else
-       {
-               psd_cnt = 0;
-               for(i=0;i<80;i++)
-                       //DbgPrint("psd_report[%d]=     %d \n", 2402+i, PSD_report[i]);
-                       RT_TRACE(       COMP_PSD, DBG_LOUD,("psd_report[%d]=     %d \n", 2402+i, PSD_report[i]));
-
-
-               GoodChannelDecision(pDM_Odm, PSD_report, PSD_bitmap,RSSI_BT, PSD_bitmap_memory);
-
-               if(pDM_Odm->SupportICType==ODM_RTL8723A)
-               {
-                       cur_byte_idx=0;
-                       cur_bit_idx=0;
-
-                       //2 Restore H2C PSD Data to Last Data
-                       H2C_PSD_DATA_last[0] = H2C_PSD_DATA[0];
-                       H2C_PSD_DATA_last[1] = H2C_PSD_DATA[1];
-                       H2C_PSD_DATA_last[2] = H2C_PSD_DATA[2];
-                       H2C_PSD_DATA_last[3] = H2C_PSD_DATA[3];
-                       H2C_PSD_DATA_last[4] = H2C_PSD_DATA[4];
-
-
-                       //2 Translate 80bit channel map to 40bit channel
-                       for ( i=0;i<5;i++)
-                       {
-                               for(n=0;n<8;n++)
-                               {
-                                       cur_byte_idx = i*2 + n/4;
-                                       cur_bit_idx = (n%4)*2;
-                                       if ( ((PSD_bitmap[cur_byte_idx]& BIT(cur_bit_idx)) != 0) && ((PSD_bitmap[cur_byte_idx]& BIT(cur_bit_idx+1)) != 0))
-                                               H2C_PSD_DATA[i] = H2C_PSD_DATA[i] | (u1Byte) (1 << n);
-                               }
-                               ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("H2C_PSD_DATA[%d]=0x%x\n" ,i, H2C_PSD_DATA[i]));
-                       }
-
-                       //3 To Compare the difference
-                       for ( i=0;i<5;i++)
-                       {
-                               if(H2C_PSD_DATA[i] !=H2C_PSD_DATA_last[i])
-                               {
-                                       FillH2CCmd(Adapter, H2C_92C_PSD_RESULT, 5, H2C_PSD_DATA);
-                                       ODM_RT_TRACE(pDM_Odm, COMP_PSD, DBG_LOUD,("Need to Update the AFH Map \n"));
-                                       break;
-                               }
-                               else
-                               {
-                                       if(i==5)
-                                               ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("Not need to Update\n"));
-                               }
-                       }
-                       //pHalData->bPSDactive=FALSE;
-                       ODM_SetTimer(pDM_Odm, &pDM_Odm->PSDTimer, 900);
-                       ODM_RT_TRACE(   pDM_Odm,COMP_PSD, DBG_LOUD,("Leave dm_PSD_Monitor\n"));
-               }
-       }
-}
-/*
-//Neil for Get BT RSSI
-// Be Triggered by BT C2H CMD
-VOID
-ODM_PSDGetRSSI(
-       IN      u1Byte  RSSI_BT)
-{
-
-
-}
-
-*/
-
-VOID
-ODM_PSDMonitor(
-       IN      PDM_ODM_T       pDM_Odm
-       )
-{
-       //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter);
-
-       //if(IS_HARDWARE_TYPE_8723AE(Adapter))
-
-       if(pDM_Odm->SupportICType == ODM_RTL8723A)   //may need to add other IC type
-       {
-               if(pDM_Odm->SupportInterface==ODM_ITRF_PCIE)
-               {
-#if(BT_30_SUPPORT == 1)
-                       if(pDM_Odm->bBtDisabled) //need to check upper layer connection
-               {
-                               ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD, ("odm_PSDMonitor, return for BT is disabled!!!\n"));
-                  return;
-               }
-#endif
-                       ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD, ("odm_PSDMonitor\n"));
-               //if(pHalData->bPSDactive ==FALSE)
-               //{
-                       pDM_Odm->bPSDinProcess = TRUE;
-                       //pHalData->bPSDactive=TRUE;
-                       odm_PSD_Monitor(pDM_Odm);
-                       pDM_Odm->bPSDinProcess = FALSE;
-               }
-       }
-
-}
-VOID
-odm_PSDMonitorCallback(
-       PRT_TIMER               pTimer
-)
-{
-       PADAPTER                Adapter = (PADAPTER)pTimer->Adapter;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       PDM_ODM_T               pDM_Odm = &pHalData->DM_OutSrc;
-
-
-#if USE_WORKITEM
-       PlatformScheduleWorkItem(&pHalData->PSDMonitorWorkitem);
-#else
-       ODM_PSDMonitor(pDM_Odm);
-#endif
-}
-
-VOID
-odm_PSDMonitorWorkItemCallback(
-    IN PVOID            pContext
-    )
-{
-       PADAPTER        Adapter = (PADAPTER)pContext;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       PDM_ODM_T               pDM_Odm = &pHalData->DM_OutSrc;
-
-
-       ODM_PSDMonitor(pDM_Odm);
-}
-
-
-
- //cosa debug tool need to modify
-
-VOID
-ODM_PSDDbgControl(
-       IN      PADAPTER        Adapter,
-       IN      u4Byte          mode,
-       IN      u4Byte          btRssi
-       )
-{
-#if (DEV_BUS_TYPE == RT_PCI_INTERFACE)
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       PDM_ODM_T               pDM_Odm = &pHalData->DM_OutSrc;
-
-       ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD, (" Monitor mode=%d, btRssi=%d\n", mode, btRssi));
-       if(mode)
-       {
-               pDM_Odm->RSSI_BT = (u1Byte)btRssi;
-               pDM_Odm->bUserAssignLevel = TRUE;
-               ODM_SetTimer( pDM_Odm, &pDM_Odm->PSDTimer, 0); //ms
-       }
-       else
-       {
-               ODM_CancelTimer(pDM_Odm, &pDM_Odm->PSDTimer);
-       }
-#endif
-}
-
-
-//#if(DEV_BUS_TYPE == RT_PCI_INTERFACE)|(DEV_BUS_TYPE == RT_USB_INTERFACE)
-
-void   odm_RXHPInit(
-       IN              PDM_ODM_T               pDM_Odm)
-{
-#if (DEV_BUS_TYPE == RT_PCI_INTERFACE)|(DEV_BUS_TYPE == RT_USB_INTERFACE)
-       pRXHP_T                 pRX_HP_Table  = &pDM_Odm->DM_RXHP_Table;
-       u1Byte                  index;
-
-       pRX_HP_Table->RXHP_enable = TRUE;
-       pRX_HP_Table->RXHP_flag = 0;
-       pRX_HP_Table->PSD_func_trigger = 0;
-       pRX_HP_Table->Pre_IGI = 0x20;
-       pRX_HP_Table->Cur_IGI = 0x20;
-       pRX_HP_Table->Cur_pw_th = pw_th_10dB;
-       pRX_HP_Table->Pre_pw_th = pw_th_10dB;
-       for(index=0; index<80; index++)
-               pRX_HP_Table->PSD_bitmap_RXHP[index] = 1;
-
-#if(DEV_BUS_TYPE == RT_USB_INTERFACE)
-       pRX_HP_Table->TP_Mode = Idle_Mode;
-#endif
-#endif
-}
-
-void odm_RXHP(
-       IN              PDM_ODM_T               pDM_Odm)
-{
-#if( DM_ODM_SUPPORT_TYPE & (ODM_MP))
-#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) | (DEV_BUS_TYPE == RT_USB_INTERFACE)
-       PADAPTER        Adapter =  pDM_Odm->Adapter;
-       PMGNT_INFO      pMgntInfo = &(Adapter->MgntInfo);
-       pDIG_T          pDM_DigTable = &pDM_Odm->DM_DigTable;
-       pRXHP_T         pRX_HP_Table  = &pDM_Odm->DM_RXHP_Table;
-       PFALSE_ALARM_STATISTICS         FalseAlmCnt = &(pDM_Odm->FalseAlmCnt);
-
-       u1Byte                  i, j, sum;
-       u1Byte                  Is40MHz;
-       s1Byte                  Intf_diff_idx, MIN_Intf_diff_idx = 16;
-       s4Byte                  cur_channel;
-       u1Byte                  ch_map_intf_5M[17] = {0};
-       static u4Byte           FA_TH = 0;
-       static u1Byte           psd_intf_flag = 0;
-       static s4Byte           curRssi = 0;
-       static s4Byte           preRssi = 0;
-       static u1Byte           PSDTriggerCnt = 1;
-
-       u1Byte                  RX_HP_enable = (u1Byte)(ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore2, bMaskDWord)>>31);   // for debug!!
-
-#if(DEV_BUS_TYPE == RT_USB_INTERFACE)
-       static s8Byte           lastTxOkCnt = 0, lastRxOkCnt = 0;
-       s8Byte                  curTxOkCnt, curRxOkCnt;
-       s8Byte                  curTPOkCnt;
-       s8Byte                  TP_Acc3, TP_Acc5;
-       static s8Byte           TP_Buff[5] = {0};
-       static u1Byte           pre_state = 0, pre_state_flag = 0;
-       static u1Byte           Intf_HighTP_flag = 0, De_counter = 16;
-       static u1Byte           TP_Degrade_flag = 0;
-#endif
-       static u1Byte           LatchCnt = 0;
-
-       if((pDM_Odm->SupportICType == ODM_RTL8723A)||(pDM_Odm->SupportICType == ODM_RTL8188E))
-               return;
-       //AGC RX High Power Mode is only applied on 2G band in 92D!!!
-       if(pDM_Odm->SupportICType == ODM_RTL8192D)
-       {
-               if(*(pDM_Odm->pBandType) != ODM_BAND_2_4G)
-                       return;
-       }
-
-       if(!(pDM_Odm->SupportAbility==ODM_BB_RXHP))
-               return;
-
-
-       //RX HP ON/OFF
-       if(RX_HP_enable == 1)
-               pRX_HP_Table->RXHP_enable = FALSE;
-       else
-               pRX_HP_Table->RXHP_enable = TRUE;
-
-       if(pRX_HP_Table->RXHP_enable == FALSE)
-       {
-               if(pRX_HP_Table->RXHP_flag == 1)
-               {
-                       pRX_HP_Table->RXHP_flag = 0;
-                       psd_intf_flag = 0;
-               }
-               return;
-       }
-
-#if(DEV_BUS_TYPE == RT_USB_INTERFACE)
-       //2 Record current TP for USB interface
-       curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast)-lastTxOkCnt;
-       curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast)-lastRxOkCnt;
-       lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast);
-       lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast);
-
-       curTPOkCnt = curTxOkCnt+curRxOkCnt;
-       TP_Buff[0] = curTPOkCnt;    // current TP
-       TP_Acc3 = PlatformDivision64((TP_Buff[1]+TP_Buff[2]+TP_Buff[3]), 3);
-       TP_Acc5 = PlatformDivision64((TP_Buff[0]+TP_Buff[1]+TP_Buff[2]+TP_Buff[3]+TP_Buff[4]), 5);
-
-       if(TP_Acc5 < 1000)
-               pRX_HP_Table->TP_Mode = Idle_Mode;
-       else if((1000 < TP_Acc5)&&(TP_Acc5 < 3750000))
-               pRX_HP_Table->TP_Mode = Low_TP_Mode;
-       else
-               pRX_HP_Table->TP_Mode = High_TP_Mode;
-
-       ODM_RT_TRACE(pDM_Odm,   ODM_COMP_RXHP, ODM_DBG_LOUD, ("RX HP TP Mode = %d\n", pRX_HP_Table->TP_Mode));
-       // Since TP result would be sampled every 2 sec, it needs to delay 4sec to wait PSD processing.
-       // When LatchCnt = 0, we would Get PSD result.
-       if(TP_Degrade_flag == 1)
-       {
-               LatchCnt--;
-               if(LatchCnt == 0)
-               {
-                       TP_Degrade_flag = 0;
-               }
-       }
-       // When PSD function triggered by TP degrade 20%, and Interference Flag = 1
-       // Set a De_counter to wait IGI = upper bound. If time is UP, the Interference flag will be pull down.
-       if(Intf_HighTP_flag == 1)
-       {
-               De_counter--;
-               if(De_counter == 0)
-               {
-                       Intf_HighTP_flag = 0;
-                       psd_intf_flag = 0;
-               }
-       }
-#endif
-
-       //2 AGC RX High Power Mode by PSD only applied to STA Mode
-       //3 NOT applied 1. Ad Hoc Mode.
-       //3 NOT applied 2. AP Mode
-       if ((pMgntInfo->mAssoc) && (!pMgntInfo->mIbss) && (!ACTING_AS_AP(Adapter)))
-       {
-               Is40MHz = *(pDM_Odm->pBandWidth);
-               curRssi = pDM_Odm->RSSI_Min;
-               cur_channel = ODM_GetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, 0x0fff) & 0x0f;
-               ODM_RT_TRACE(pDM_Odm,   ODM_COMP_RXHP, ODM_DBG_LOUD, ("RXHP RX HP flag = %d\n", pRX_HP_Table->RXHP_flag));
-               ODM_RT_TRACE(pDM_Odm,   ODM_COMP_RXHP, ODM_DBG_LOUD, ("RXHP FA = %d\n", FalseAlmCnt->Cnt_all));
-               ODM_RT_TRACE(pDM_Odm,   ODM_COMP_RXHP, ODM_DBG_LOUD, ("RXHP cur RSSI = %d, pre RSSI=%d\n", curRssi, preRssi));
-               ODM_RT_TRACE(pDM_Odm,   ODM_COMP_RXHP, ODM_DBG_LOUD, ("RXHP current CH = %d\n", cur_channel));
-               ODM_RT_TRACE(pDM_Odm,   ODM_COMP_RXHP, ODM_DBG_LOUD, ("RXHP Is 40MHz = %d\n", Is40MHz));
-       //2 PSD function would be triggered
-       //3 1. Every 4 sec for PCIE
-       //3 2. Before TP Mode (Idle TP<4kbps) for USB
-       //3 3. After TP Mode (High TP) for USB
-               if((curRssi > 68) && (pRX_HP_Table->RXHP_flag == 0))    // Only RSSI>TH and RX_HP_flag=0 will Do PSD process
-               {
-#if (DEV_BUS_TYPE == RT_USB_INTERFACE)
-                       //2 Before TP Mode ==> PSD would be trigger every 4 sec
-                       if(pRX_HP_Table->TP_Mode == Idle_Mode)          //2.1 less wlan traffic <4kbps
-                       {
-#endif
-                               if(PSDTriggerCnt == 1)
-                               {
-                                       odm_PSD_RXHP(pDM_Odm);
-                                       pRX_HP_Table->PSD_func_trigger = 1;
-                                       PSDTriggerCnt = 0;
-                               }
-                               else
-                               {
-                                       PSDTriggerCnt++;
-                               }
-#if(DEV_BUS_TYPE == RT_USB_INTERFACE)
-                       }
-                       //2 After TP Mode ==> Check if TP degrade larger than 20% would trigger PSD function
-                       if(pRX_HP_Table->TP_Mode == High_TP_Mode)
-                       {
-                               if((pre_state_flag == 0)&&(LatchCnt == 0))
-                               {
-                                       // TP var < 5%
-                                       if((((curTPOkCnt-TP_Acc3)*20)<(TP_Acc3))&&(((curTPOkCnt-TP_Acc3)*20)>(-TP_Acc3)))
-                                       {
-                                               pre_state++;
-                                               if(pre_state == 3)      // hit pre_state condition => consecutive 3 times
-                                               {
-                                                       pre_state_flag = 1;
-                                                       pre_state = 0;
-                                               }
-
-                                       }
-                                       else
-                                       {
-                                               pre_state = 0;
-                                       }
-                               }
-                               //3 If pre_state_flag=1 ==> start to monitor TP degrade 20%
-                               if(pre_state_flag == 1)
-                               {
-                                       if(((TP_Acc3-curTPOkCnt)*5)>(TP_Acc3))      // degrade 20%
-                                       {
-                                               odm_PSD_RXHP(pDM_Odm);
-                                               pRX_HP_Table->PSD_func_trigger = 1;
-                                               TP_Degrade_flag = 1;
-                                               LatchCnt = 2;
-                                               pre_state_flag = 0;
-                                       }
-                                       else if(((TP_Buff[2]-curTPOkCnt)*5)>TP_Buff[2])
-                                       {
-                                               odm_PSD_RXHP(pDM_Odm);
-                                               pRX_HP_Table->PSD_func_trigger = 1;
-                                               TP_Degrade_flag = 1;
-                                               LatchCnt = 2;
-                                               pre_state_flag = 0;
-                                       }
-                                       else if(((TP_Buff[3]-curTPOkCnt)*5)>TP_Buff[3])
-                                       {
-                                               odm_PSD_RXHP(pDM_Odm);
-                                               pRX_HP_Table->PSD_func_trigger = 1;
-                                               TP_Degrade_flag = 1;
-                                               LatchCnt = 2;
-                                               pre_state_flag = 0;
-                                       }
-                               }
-                       }
-#endif
-}
-
-#if (DEV_BUS_TYPE == RT_USB_INTERFACE)
-               for (i=0;i<4;i++)
-               {
-                       TP_Buff[4-i] = TP_Buff[3-i];
-               }
-#endif
-               //2 Update PSD bitmap according to PSD report
-               if((pRX_HP_Table->PSD_func_trigger == 1)&&(LatchCnt == 0))
-               {
-                       //2 Separate 80M bandwidth into 16 group with smaller 5M BW.
-                       for (i = 0 ; i < 16 ; i++)
-                       {
-                               sum = 0;
-                               for(j = 0; j < 5 ; j++)
-                                       sum += pRX_HP_Table->PSD_bitmap_RXHP[5*i + j];
-
-                               if(sum < 5)
-                               {
-                                       ch_map_intf_5M[i] = 1;  // interference flag
-                               }
-                       }
-                       //=============just for debug=========================
-                       //for(i=0;i<16;i++)
-                               //DbgPrint("RX HP: ch_map_intf_5M[%d] = %d\n", i, ch_map_intf_5M[i]);
-                       //===============================================
-                       //2 Mask target channel 5M index
-                       for(i = 0; i < (4+4*Is40MHz) ; i++)
-                       {
-                               ch_map_intf_5M[cur_channel - (1+2*Is40MHz) + i] = 0;
-                       }
-
-                       psd_intf_flag = 0;
-                       for(i = 0; i < 16; i++)
-                       {
-                               if(ch_map_intf_5M[i] == 1)
-                       {
-                               psd_intf_flag = 1;            // interference is detected!!!
-                               break;
-                               }
-                       }
-
-#if (DEV_BUS_TYPE == RT_USB_INTERFACE)
-                       if(pRX_HP_Table->TP_Mode!=Idle_Mode)
-                       {
-                               if(psd_intf_flag == 1)     // to avoid psd_intf_flag always 1
-                               {
-                                       Intf_HighTP_flag = 1;
-                                       De_counter = 32;     // 0x1E -> 0x3E needs 32 times by each IGI step =1
-                               }
-                       }
-#endif
-                       ODM_RT_TRACE(pDM_Odm,   ODM_COMP_RXHP, ODM_DBG_LOUD, ("RX HP psd_intf_flag = %d\n", psd_intf_flag));
-                       //2 Distance between target channel and interference
-                       for(i = 0; i < 16; i++)
-                       {
-                               if(ch_map_intf_5M[i] == 1)
-                               {
-                                       Intf_diff_idx = ((cur_channel+Is40MHz-(i+1))>0) ? (s1Byte)(cur_channel-2*Is40MHz-(i-2)) : (s1Byte)((i+1)-(cur_channel+2*Is40MHz));
-                               if(Intf_diff_idx < MIN_Intf_diff_idx)
-                                               MIN_Intf_diff_idx = Intf_diff_idx;    // the min difference index between interference and target
-                               }
-                       }
-                       ODM_RT_TRACE(pDM_Odm,   ODM_COMP_RXHP, ODM_DBG_LOUD, ("RX HP MIN_Intf_diff_idx = %d\n", MIN_Intf_diff_idx));
-                       //2 Choose False Alarm Threshold
-                       switch (MIN_Intf_diff_idx){
-                               case 0:
-                               case 1:
-                               case 2:
-                               case 3:
-                                       FA_TH = FA_RXHP_TH1;
-                               break;
-                               case 4:                         // CH5
-                               case 5:                         // CH6
-                                       FA_TH = FA_RXHP_TH2;
-                               break;
-                               case 6:                         // CH7
-                               case 7:                         // CH8
-                                       FA_TH = FA_RXHP_TH3;
-                                       break;
-                       case 8:                         // CH9
-                               case 9:                         //CH10
-                                       FA_TH = FA_RXHP_TH4;
-                                       break;
-                               case 10:
-                               case 11:
-                               case 12:
-                               case 13:
-                               case 14:
-                               case 15:
-                                       FA_TH = FA_RXHP_TH5;
-                                       break;
-               }
-                       ODM_RT_TRACE(pDM_Odm,   ODM_COMP_RXHP, ODM_DBG_LOUD, ("RX HP FA_TH = %d\n", FA_TH));
-                       pRX_HP_Table->PSD_func_trigger = 0;
-               }
-               //1 Monitor RSSI variation to choose the suitable IGI or Exit AGC RX High Power Mode
-               if(pRX_HP_Table->RXHP_flag == 1)
-               {
-               if ((curRssi > 80)&&(preRssi < 80))
-               {
-                               pRX_HP_Table->Cur_IGI = LNA_Low_Gain_1;
-               }
-               else if ((curRssi < 80)&&(preRssi > 80))
-               {
-                               pRX_HP_Table->Cur_IGI = LNA_Low_Gain_2;
-                       }
-               else if ((curRssi > 72)&&(preRssi < 72))
-                       {
-                               pRX_HP_Table->Cur_IGI = LNA_Low_Gain_2;
-               }
-               else if ((curRssi < 72)&&( preRssi > 72))
-                       {
-                               pRX_HP_Table->Cur_IGI = LNA_Low_Gain_3;
-               }
-               else if (curRssi < 68)           //RSSI is NOT large enough!!==> Exit AGC RX High Power Mode
-               {
-                               pRX_HP_Table->Cur_pw_th = pw_th_10dB;
-                               pRX_HP_Table->RXHP_flag = 0;    // Back to Normal DIG Mode
-                               psd_intf_flag = 0;
-                       }
-               }
-               else    // pRX_HP_Table->RXHP_flag == 0
-               {
-                       //1 Decide whether to enter AGC RX High Power Mode
-                       if ((curRssi > 70) && (psd_intf_flag == 1) && (FalseAlmCnt->Cnt_all > FA_TH) &&
-                               (pDM_DigTable->CurIGValue == pDM_DigTable->rx_gain_range_max))
-                       {
-                               if (curRssi > 80)
-                               {
-                                       pRX_HP_Table->Cur_IGI = LNA_Low_Gain_1;
-                               }
-                               else if (curRssi > 72)
-                       {
-                               pRX_HP_Table->Cur_IGI = LNA_Low_Gain_2;
-                               }
-                               else
-                               {
-                                       pRX_HP_Table->Cur_IGI = LNA_Low_Gain_3;
-                               }
-                               pRX_HP_Table->Cur_pw_th = pw_th_16dB;           //RegC54[9:8]=2'b11: to enter AGC Flow 3
-                               pRX_HP_Table->First_time_enter = TRUE;
-                               pRX_HP_Table->RXHP_flag = 1;    //      RXHP_flag=1: AGC RX High Power Mode, RXHP_flag=0: Normal DIG Mode
-                       }
-               }
-               preRssi = curRssi;
-               odm_Write_RXHP(pDM_Odm);
-       }
-#endif //#if( DM_ODM_SUPPORT_TYPE & (ODM_MP))
-#endif //#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) | (DEV_BUS_TYPE == RT_USB_INTERFACE)
-}
-
-void odm_Write_RXHP(
-       IN      PDM_ODM_T       pDM_Odm)
-{
-       pRXHP_T         pRX_HP_Table = &pDM_Odm->DM_RXHP_Table;
-       u4Byte          currentIGI;
-
-       if(pRX_HP_Table->Cur_IGI != pRX_HP_Table->Pre_IGI)
-       {
-               ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0, pRX_HP_Table->Cur_IGI);
-               ODM_SetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0, pRX_HP_Table->Cur_IGI);
-       }
-
-       if(pRX_HP_Table->Cur_pw_th != pRX_HP_Table->Pre_pw_th)
-{
-               ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore2, BIT8|BIT9, pRX_HP_Table->Cur_pw_th);  // RegC54[9:8]=2'b11:  AGC Flow 3
-       }
-
-       if(pRX_HP_Table->RXHP_flag == 0)
-       {
-               pRX_HP_Table->Cur_IGI = 0x20;
-       }
-       else
-       {
-               currentIGI = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0);
-               if(currentIGI<0x50)
-               {
-                       ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0, pRX_HP_Table->Cur_IGI);
-                       ODM_SetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0, pRX_HP_Table->Cur_IGI);
-               }
-       }
-       pRX_HP_Table->Pre_IGI = pRX_HP_Table->Cur_IGI;
-       pRX_HP_Table->Pre_pw_th = pRX_HP_Table->Cur_pw_th;
-
-}
-
-VOID
-odm_PSD_RXHP(
-       IN      PDM_ODM_T       pDM_Odm
-)
-{
-       pRXHP_T                 pRX_HP_Table  = &pDM_Odm->DM_RXHP_Table;
-       PADAPTER                Adapter =  pDM_Odm->Adapter;
-       PMGNT_INFO              pMgntInfo = &(Adapter->MgntInfo);
-       unsigned int            pts, start_point, stop_point, initial_gain ;
-       static u1Byte           PSD_bitmap_memory[80], init_memory = 0;
-       static u1Byte           psd_cnt=0;
-       static u4Byte           PSD_report[80], PSD_report_tmp;
-       static u8Byte           lastTxOkCnt=0, lastRxOkCnt=0;
-       u1Byte                  idx[20]={96,99,102,106,109,112,115,118,122,125,
-                                       0,3,6,10,13,16,19,22,26,29};
-       u1Byte                  n, i, channel, BBReset,tone_idx;
-       u1Byte                  PSD_bitmap[10], SSBT=0,initial_gain_psd=0, RSSI_BT=0, initialGainUpper;
-       s4Byte                          PSD_skip_start, PSD_skip_stop;
-       u4Byte                  CurrentChannel, RXIQI, RxIdleLowPwr, wlan_channel;
-       u4Byte                  ReScan, Interval, Is40MHz;
-       u8Byte                  curTxOkCnt, curRxOkCnt;
-       //--------------2G band synthesizer for 92D switch RF channel using-----------------
-       u1Byte                  group_idx=0;
-       u4Byte                  SYN_RF25=0, SYN_RF26=0, SYN_RF27=0, SYN_RF2B=0, SYN_RF2C=0;
-       u4Byte                  SYN[5] = {0x25, 0x26, 0x27, 0x2B, 0x2C};    // synthesizer RF register for 2G channel
-       u4Byte                  SYN_group[3][5] = {{0x643BC, 0xFC038, 0x77C1A, 0x41289, 0x01840},     // For CH1,2,4,9,10.11.12   {0x643BC, 0xFC038, 0x77C1A, 0x41289, 0x01840}
-                                                                           {0x643BC, 0xFC038, 0x07C1A, 0x41289, 0x01840},     // For CH3,13,14
-                                                                           {0x243BC, 0xFC438, 0x07C1A, 0x4128B, 0x0FC41}};   // For Ch5,6,7,8
-       //--------------------- Add by Gary for Debug setting ----------------------
-       s4Byte                 psd_result = 0;
-       u1Byte                 RSSI_BT_new = (u1Byte) ODM_GetBBReg(pDM_Odm, 0xB9C, 0xFF);
-       u1Byte                 rssi_ctrl = (u1Byte) ODM_GetBBReg(pDM_Odm, 0xB38, 0xFF);
-       //---------------------------------------------------------------------
-
-       if(pMgntInfo->bScanInProgress)
-       {
-               return;
-       }
-
-       ReScan = PSD_RESCAN;
-       Interval = SCAN_INTERVAL;
-
-
-       //1 Initialization
-       if(init_memory == 0)
-       {
-               RT_TRACE(       COMP_PSD, DBG_LOUD,("Init memory\n"));
-               for(i = 0; i < 80; i++)
-                       PSD_bitmap_memory[i] = 0xFF; // channel is always good
-               init_memory = 1;
-       }
-       if(psd_cnt == 0)
-       {
-               RT_TRACE(COMP_PSD, DBG_LOUD,("Enter dm_PSD_Monitor\n"));
-               for(i = 0; i < 80; i++)
-                       PSD_report[i] = 0;
-       }
-
-       //1 Backup Current Settings
-       CurrentChannel = ODM_GetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask);
-       if(pDM_Odm->SupportICType == ODM_RTL8192D)
-       {
-               //2 Record Current synthesizer parameters based on current channel
-               if((*(pDM_Odm->pMacPhyMode)==ODM_SMSP)||(*(pDM_Odm->pMacPhyMode)==ODM_DMSP))
-               {
-                       SYN_RF25 = ODM_GetRFReg(pDM_Odm, RF_PATH_B, 0x25, bMaskDWord);
-                       SYN_RF26 = ODM_GetRFReg(pDM_Odm, RF_PATH_B, 0x26, bMaskDWord);
-                       SYN_RF27 = ODM_GetRFReg(pDM_Odm, RF_PATH_B, 0x27, bMaskDWord);
-                       SYN_RF2B = ODM_GetRFReg(pDM_Odm, RF_PATH_B, 0x2B, bMaskDWord);
-                       SYN_RF2C = ODM_GetRFReg(pDM_Odm, RF_PATH_B, 0x2C, bMaskDWord);
-       }
-               else     // DualMAC_DualPHY 2G
-               {
-                       SYN_RF25 = ODM_GetRFReg(pDM_Odm, RF_PATH_A, 0x25, bMaskDWord);
-                       SYN_RF26 = ODM_GetRFReg(pDM_Odm, RF_PATH_A, 0x26, bMaskDWord);
-                       SYN_RF27 = ODM_GetRFReg(pDM_Odm, RF_PATH_A, 0x27, bMaskDWord);
-                       SYN_RF2B = ODM_GetRFReg(pDM_Odm, RF_PATH_A, 0x2B, bMaskDWord);
-                       SYN_RF2C = ODM_GetRFReg(pDM_Odm, RF_PATH_A, 0x2C, bMaskDWord);
-               }
-       }
-       RXIQI = ODM_GetBBReg(pDM_Odm, 0xC14, bMaskDWord);
-       RxIdleLowPwr = (ODM_GetBBReg(pDM_Odm, 0x818, bMaskDWord)&BIT28)>>28;
-       Is40MHz = *(pDM_Odm->pBandWidth);
-       ODM_RT_TRACE(pDM_Odm,   COMP_PSD, DBG_LOUD,("PSD Scan Start\n"));
-       //1 Turn off CCK
-       ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 0);
-       //1 Turn off TX
-       //Pause TX Queue
-       ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF);
-       //Force RX to stop TX immediately
-       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_AC, bRFRegOffsetMask, 0x32E13);
-       //1 Turn off RX
-       //Rx AGC off  RegC70[0]=0, RegC7C[20]=0
-       ODM_SetBBReg(pDM_Odm, 0xC70, BIT0, 0);
-       ODM_SetBBReg(pDM_Odm, 0xC7C, BIT20, 0);
-       //Turn off CCA
-       ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, 0x0);
-       //BB Reset
-       BBReset = ODM_Read1Byte(pDM_Odm, 0x02);
-       ODM_Write1Byte(pDM_Odm, 0x02, BBReset&(~BIT0));
-       ODM_Write1Byte(pDM_Odm, 0x02, BBReset|BIT0);
-       //1 Leave RX idle low power
-       ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x0);
-       //1 Fix initial gain
-       RSSI_BT = RSSI_BT_new;
-       RT_TRACE(COMP_PSD, DBG_LOUD,("PSD: RSSI_BT= %d\n", RSSI_BT));
-
-       if(rssi_ctrl == 1)        // just for debug!!
-               initial_gain_psd = RSSI_BT_new;
-       else
-               initial_gain_psd = pDM_Odm->RSSI_Min;    // PSD report based on RSSI
-
-       RT_TRACE(COMP_PSD, DBG_LOUD,("PSD: RSSI_BT= %d\n", RSSI_BT));
-
-       initialGainUpper = 0x54;
-
-       RSSI_BT = initial_gain_psd;
-       //SSBT = RSSI_BT;
-
-       //RT_TRACE(     COMP_PSD, DBG_LOUD,("PSD: SSBT= %d\n", SSBT));
-       RT_TRACE(       COMP_PSD, DBG_LOUD,("PSD: initial gain= 0x%x\n", initial_gain_psd));
-
-       pDM_Odm->bDMInitialGainEnable = FALSE;
-       initial_gain = ODM_GetBBReg(pDM_Odm, 0xc50, bMaskDWord) & 0x7F;
-       ODM_SetBBReg(pDM_Odm, 0xc50, 0x7F, initial_gain_psd);
-       //1 Turn off 3-wire
-       ODM_SetBBReg(pDM_Odm, 0x88c, BIT20|BIT21|BIT22|BIT23, 0xF);
-
-       //pts value = 128, 256, 512, 1024
-       pts = 128;
-
-       if(pts == 128)
-       {
-               ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x0);
-               start_point = 64;
-               stop_point = 192;
-       }
-       else if(pts == 256)
-       {
-               ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x1);
-               start_point = 128;
-               stop_point = 384;
-       }
-       else if(pts == 512)
-       {
-               ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x2);
-               start_point = 256;
-               stop_point = 768;
-       }
-       else
-       {
-               ODM_SetBBReg(pDM_Odm, 0x808, BIT14|BIT15, 0x3);
-               start_point = 512;
-               stop_point = 1536;
-       }
-
-
-//3 Skip WLAN channels if WLAN busy
-       curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast) - lastTxOkCnt;
-       curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast) - lastRxOkCnt;
-       lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast);
-       lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast);
-
-       PSD_skip_start=80;
-       PSD_skip_stop = 0;
-       wlan_channel = CurrentChannel & 0x0f;
-
-       RT_TRACE(COMP_PSD,DBG_LOUD,("PSD: current channel: %x, BW:%d \n", wlan_channel, Is40MHz));
-
-       if((curRxOkCnt+curTxOkCnt) > 1000)
-       {
-               PSD_skip_start = (wlan_channel-1)*5 -Is40MHz*10;
-               PSD_skip_stop = PSD_skip_start + (1+Is40MHz)*20;
-       }
-
-       RT_TRACE(COMP_PSD,DBG_LOUD,("PSD: Skip tone from %d to %d \n", PSD_skip_start, PSD_skip_stop));
-
-       for (n=0;n<80;n++)
-       {
-               if((n%20)==0)
-               {
-                       channel = (n/20)*4 + 1;
-                       if(pDM_Odm->SupportICType == ODM_RTL8192D)
-                       {
-                               switch(channel)
-                               {
-                                       case 1:
-                                       case 9:
-                                               group_idx = 0;
-                                               break;
-                                       case 5:
-                                               group_idx = 2;
-                                               break;
-                                       case 13:
-                                               group_idx = 1;
-                                               break;
-                               }
-                               if((*(pDM_Odm->pMacPhyMode)==ODM_SMSP)||(*(pDM_Odm->pMacPhyMode)==ODM_DMSP))
-               {
-                                       for(i = 0; i < SYN_Length; i++)
-                                               ODM_SetRFReg(pDM_Odm, RF_PATH_B, SYN[i], bMaskDWord, SYN_group[group_idx][i]);
-
-                                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, 0x3FF, channel);
-                                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, RF_CHNLBW, 0x3FF, channel);
-                               }
-                               else  // DualMAC_DualPHY 2G
-                       {
-                                       for(i = 0; i < SYN_Length; i++)
-                                               ODM_SetRFReg(pDM_Odm, RF_PATH_A, SYN[i], bMaskDWord, SYN_group[group_idx][i]);
-
-                                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, 0x3FF, channel);
-                               }
-                       }
-                       else
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, 0x3FF, channel);
-                       }
-               tone_idx = n%20;
-               if ((n>=PSD_skip_start) && (n<PSD_skip_stop))
-               {
-                       PSD_report[n] = initial_gain_psd;//SSBT;
-                       ODM_RT_TRACE(pDM_Odm,COMP_PSD,DBG_LOUD,("PSD:Tone %d skipped \n", n));
-               }
-               else
-               {
-                       PSD_report_tmp =  GetPSDData(pDM_Odm, idx[tone_idx], initial_gain_psd);
-
-                       if ( PSD_report_tmp > PSD_report[n])
-                               PSD_report[n] = PSD_report_tmp;
-
-               }
-       }
-
-       PatchDCTone(pDM_Odm, PSD_report, initial_gain_psd);
-
-       //----end
-       //1 Turn on RX
-       //Rx AGC on
-       ODM_SetBBReg(pDM_Odm, 0xC70, BIT0, 1);
-       ODM_SetBBReg(pDM_Odm, 0xC7C, BIT20, 1);
-       //CCK on
-       ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 1);
-       //1 Turn on TX
-       //Resume TX Queue
-       ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x00);
-       //Turn on 3-wire
-       ODM_SetBBReg(pDM_Odm, 0x88c, BIT20|BIT21|BIT22|BIT23, 0x0);
-       //1 Restore Current Settings
-       //Resume DIG
-       pDM_Odm->bDMInitialGainEnable= TRUE;
-       ODM_SetBBReg(pDM_Odm, 0xc50, 0x7F, initial_gain);
-       // restore originl center frequency
-       ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, CurrentChannel);
-       if(pDM_Odm->SupportICType == ODM_RTL8192D)
-       {
-               if((*(pDM_Odm->pMacPhyMode)==ODM_SMSP)||(*(pDM_Odm->pMacPhyMode)==ODM_DMSP))
-               {
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, RF_CHNLBW, bMaskDWord, CurrentChannel);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x25, bMaskDWord, SYN_RF25);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x26, bMaskDWord, SYN_RF26);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x27, bMaskDWord, SYN_RF27);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x2B, bMaskDWord, SYN_RF2B);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_B, 0x2C, bMaskDWord, SYN_RF2C);
-               }
-               else     // DualMAC_DualPHY
-               {
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x25, bMaskDWord, SYN_RF25);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x26, bMaskDWord, SYN_RF26);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x27, bMaskDWord, SYN_RF27);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x2B, bMaskDWord, SYN_RF2B);
-                       ODM_SetRFReg(pDM_Odm, RF_PATH_A, 0x2C, bMaskDWord, SYN_RF2C);
-               }
-       }
-       //Turn on CCA
-       ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, RXIQI);
-       //Restore RX idle low power
-       if(RxIdleLowPwr == TRUE)
-               ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 1);
-
-       psd_cnt++;
-       //gPrint("psd cnt=%d\n", psd_cnt);
-       ODM_RT_TRACE(pDM_Odm,COMP_PSD, DBG_LOUD,("PSD:psd_cnt = %d \n",psd_cnt));
-       if (psd_cnt < ReScan)
-       {
-               ODM_SetTimer(pDM_Odm, &pRX_HP_Table->PSDTimer, Interval);  //ms
-       }
-       else
-                       {
-               psd_cnt = 0;
-               for(i=0;i<80;i++)
-                       RT_TRACE(       COMP_PSD, DBG_LOUD,("psd_report[%d]=     %d \n", 2402+i, PSD_report[i]));
-                       //DbgPrint("psd_report[%d]=     %d \n", 2402+i, PSD_report[i]);
-
-               GoodChannelDecision(pDM_Odm, PSD_report, PSD_bitmap,RSSI_BT, PSD_bitmap_memory);
-
-                       }
-               }
-
-VOID
-odm_PSD_RXHPCallback(
-       PRT_TIMER               pTimer
-)
-{
-       PADAPTER                Adapter = (PADAPTER)pTimer->Adapter;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       PDM_ODM_T               pDM_Odm = &pHalData->DM_OutSrc;
-       pRXHP_T                 pRX_HP_Table  = &pDM_Odm->DM_RXHP_Table;
-
-#if DEV_BUS_TYPE==RT_PCI_INTERFACE
-       #if USE_WORKITEM
-       ODM_ScheduleWorkItem(&pRX_HP_Table->PSDTimeWorkitem);
-       #else
-       odm_PSD_RXHP(pDM_Odm);
-       #endif
-#else
-       ODM_ScheduleWorkItem(&pRX_HP_Table->PSDTimeWorkitem);
-#endif
-
-       }
-
-VOID
-odm_PSD_RXHPWorkitemCallback(
-    IN PVOID            pContext
-    )
-{
-       PADAPTER        pAdapter = (PADAPTER)pContext;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(pAdapter);
-       PDM_ODM_T               pDM_Odm = &pHalData->DM_OutSrc;
-
-       odm_PSD_RXHP(pDM_Odm);
-}
-
-#endif //#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
-//
-// 2011/09/22 MH Add for 92D global spin lock utilization.
-//
-VOID
-odm_GlobalAdapterCheck(
-       IN              VOID
-       )
-{
-
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-
-       //sherry delete flag 20110517
-#if (DEV_BUS_TYPE == RT_PCI_INTERFACE)
-                       ACQUIRE_GLOBAL_SPINLOCK(&GlobalSpinlockForGlobalAdapterList);
-#else
-                       ACQUIRE_GLOBAL_MUTEX(GlobalMutexForGlobalAdapterList);
-#endif
-
-#if (DEV_BUS_TYPE == RT_PCI_INTERFACE)
-                       RELEASE_GLOBAL_SPINLOCK(&GlobalSpinlockForGlobalAdapterList);
-#else
-                       RELEASE_GLOBAL_MUTEX(GlobalMutexForGlobalAdapterList);
-#endif
-
-#endif
-
-}      // odm_GlobalAdapterCheck
-
-
-
-//
-// 2011/12/02 MH Copy from MP oursrc for temporarily test.
-//
-#if (DM_ODM_SUPPORT_TYPE == ODM_MP)
-VOID
-odm_OFDMTXPathDiversity_92C(
-       IN      PADAPTER        Adapter)
-{
-//     HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-       PMGNT_INFO              pMgntInfo = &(Adapter->MgntInfo);
-       PRT_WLAN_STA    pEntry;
-       u1Byte  i, DefaultRespPath = 0;
-       s4Byte  MinRSSI = 0xFF;
-       pPD_T   pDM_PDTable = &Adapter->DM_PDTable;
-       pDM_PDTable->OFDMTXPath = 0;
-
-       //1 Default Port
-       if(pMgntInfo->mAssoc)
-       {
-               RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: Default port RSSI[0]=%d, RSSI[1]=%d\n",
-                       Adapter->RxStats.RxRSSIPercentage[0], Adapter->RxStats.RxRSSIPercentage[1]));
-               if(Adapter->RxStats.RxRSSIPercentage[0] > Adapter->RxStats.RxRSSIPercentage[1])
-               {
-                       pDM_PDTable->OFDMTXPath = pDM_PDTable->OFDMTXPath & (~BIT0);
-                       MinRSSI =  Adapter->RxStats.RxRSSIPercentage[1];
-                       DefaultRespPath = 0;
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: Default port Select Path-0\n"));
-               }
-               else
-               {
-                       pDM_PDTable->OFDMTXPath =  pDM_PDTable->OFDMTXPath | BIT0;
-                       MinRSSI =  Adapter->RxStats.RxRSSIPercentage[0];
-                       DefaultRespPath = 1;
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: Default port Select Path-1\n"));
-               }
-               //RT_TRACE(     COMP_SWAS, DBG_LOUD, ("pDM_PDTable->OFDMTXPath =0x%x\n",pDM_PDTable->OFDMTXPath));
-       }
-       //1 Extension Port
-       for(i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++)
-       {
-               if(IsAPModeExist(Adapter)  && GetFirstExtAdapter(Adapter) != NULL)
-                       pEntry = AsocEntry_EnumStation(GetFirstExtAdapter(Adapter), i);
-               else
-                       pEntry = AsocEntry_EnumStation(GetDefaultAdapter(Adapter), i);
-
-               if(pEntry!=NULL)
-               {
-                       if(pEntry->bAssociated)
-                       {
-                               RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: MACID=%d, RSSI_0=%d, RSSI_1=%d\n",
-                                       pEntry->AID+1, pEntry->rssi_stat.RxRSSIPercentage[0], pEntry->rssi_stat.RxRSSIPercentage[1]));
-
-                               if(pEntry->rssi_stat.RxRSSIPercentage[0] > pEntry->rssi_stat.RxRSSIPercentage[1])
-                               {
-                                       pDM_PDTable->OFDMTXPath = pDM_PDTable->OFDMTXPath & ~(BIT(pEntry->AID+1));
-                                       //pHalData->TXPath = pHalData->TXPath & ~(1<<(pEntry->AID+1));
-                                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: MACID=%d Select Path-0\n", pEntry->AID+1));
-                                       if(pEntry->rssi_stat.RxRSSIPercentage[1] < MinRSSI)
-                                       {
-                                               MinRSSI = pEntry->rssi_stat.RxRSSIPercentage[1];
-                                               DefaultRespPath = 0;
-                                       }
-                               }
-                               else
-                               {
-                                       pDM_PDTable->OFDMTXPath = pDM_PDTable->OFDMTXPath | BIT(pEntry->AID+1);
-                                       //pHalData->TXPath = pHalData->TXPath | (1 << (pEntry->AID+1));
-                                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_OFDMTXPathDiversity_92C: MACID=%d Select Path-1\n", pEntry->AID+1));
-                                       if(pEntry->rssi_stat.RxRSSIPercentage[0] < MinRSSI)
-                                       {
-                                               MinRSSI = pEntry->rssi_stat.RxRSSIPercentage[0];
-                                               DefaultRespPath = 1;
-                                       }
-                               }
-                       }
-               }
-               else
-               {
-                       break;
-               }
-       }
-
-       pDM_PDTable->OFDMDefaultRespPath = DefaultRespPath;
-}
-
-
-bool
-odm_IsConnected_92C(
-       IN      PADAPTER        Adapter
-)
-{
-       PRT_WLAN_STA    pEntry;
-       PMGNT_INFO              pMgntInfo = &(Adapter->MgntInfo);
-       u4Byte          i;
-       bool            bConnected=FALSE;
-
-       if(pMgntInfo->mAssoc)
-       {
-               bConnected = TRUE;
-       }
-       else
-       {
-               for(i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++)
-               {
-                       if(IsAPModeExist(Adapter)  && GetFirstExtAdapter(Adapter) != NULL)
-                               pEntry = AsocEntry_EnumStation(GetFirstExtAdapter(Adapter), i);
-                       else
-                               pEntry = AsocEntry_EnumStation(GetDefaultAdapter(Adapter), i);
-
-                       if(pEntry!=NULL)
-                       {
-                               if(pEntry->bAssociated)
-                               {
-                                       bConnected = TRUE;
-                                       break;
-                               }
-                       }
-                       else
-                       {
-                               break;
-                       }
-               }
-       }
-       return  bConnected;
-}
-
-
-VOID
-odm_ResetPathDiversity_92C(
-               IN      PADAPTER        Adapter
-)
-{
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       pPD_T   pDM_PDTable = &Adapter->DM_PDTable;
-       PRT_WLAN_STA    pEntry;
-       u4Byte  i;
-
-       pHalData->RSSI_test = FALSE;
-       pDM_PDTable->CCK_Pkt_Cnt = 0;
-       pDM_PDTable->OFDM_Pkt_Cnt = 0;
-       pHalData->CCK_Pkt_Cnt =0;
-       pHalData->OFDM_Pkt_Cnt =0;
-
-       if(pDM_PDTable->CCKPathDivEnable == TRUE)
-               PHY_SetBBReg(Adapter, rCCK0_AFESetting  , 0x0F000000, 0x01); //RX path = PathAB
-
-       for(i=0; i<2; i++)
-       {
-               pDM_PDTable->RSSI_CCK_Path_cnt[i]=0;
-               pDM_PDTable->RSSI_CCK_Path[i] = 0;
-       }
-       for(i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++)
-       {
-               if(IsAPModeExist(Adapter)  && GetFirstExtAdapter(Adapter) != NULL)
-                       pEntry = AsocEntry_EnumStation(GetFirstExtAdapter(Adapter), i);
-               else
-                       pEntry = AsocEntry_EnumStation(GetDefaultAdapter(Adapter), i);
-
-               if(pEntry!=NULL)
-               {
-                       pEntry->rssi_stat.CCK_Pkt_Cnt = 0;
-                       pEntry->rssi_stat.OFDM_Pkt_Cnt = 0;
-                       for(i=0; i<2; i++)
-                       {
-                               pEntry->rssi_stat.RSSI_CCK_Path_cnt[i] = 0;
-                               pEntry->rssi_stat.RSSI_CCK_Path[i] = 0;
-                       }
-               }
-               else
-                       break;
-       }
-}
-
-
-VOID
-odm_CCKTXPathDiversity_92C(
-       IN      PADAPTER        Adapter
-)
-{
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-       PMGNT_INFO              pMgntInfo = &(Adapter->MgntInfo);
-       PRT_WLAN_STA    pEntry;
-       s4Byte  MinRSSI = 0xFF;
-       u1Byte  i, DefaultRespPath = 0;
-//     bool    bBModePathDiv = FALSE;
-       pPD_T   pDM_PDTable = &Adapter->DM_PDTable;
-
-       //1 Default Port
-       if(pMgntInfo->mAssoc)
-       {
-               if(pHalData->OFDM_Pkt_Cnt == 0)
-               {
-                       for(i=0; i<2; i++)
-                       {
-                               if(pDM_PDTable->RSSI_CCK_Path_cnt[i] > 1) //Because the first packet is discarded
-                                       pDM_PDTable->RSSI_CCK_Path[i] = pDM_PDTable->RSSI_CCK_Path[i] / (pDM_PDTable->RSSI_CCK_Path_cnt[i]-1);
-                               else
-                                       pDM_PDTable->RSSI_CCK_Path[i] = 0;
-                       }
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: pDM_PDTable->RSSI_CCK_Path[0]=%d, pDM_PDTable->RSSI_CCK_Path[1]=%d\n",
-                               pDM_PDTable->RSSI_CCK_Path[0], pDM_PDTable->RSSI_CCK_Path[1]));
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: pDM_PDTable->RSSI_CCK_Path_cnt[0]=%d, pDM_PDTable->RSSI_CCK_Path_cnt[1]=%d\n",
-                               pDM_PDTable->RSSI_CCK_Path_cnt[0], pDM_PDTable->RSSI_CCK_Path_cnt[1]));
-
-                       if(pDM_PDTable->RSSI_CCK_Path[0] > pDM_PDTable->RSSI_CCK_Path[1])
-                       {
-                               pDM_PDTable->CCKTXPath = pDM_PDTable->CCKTXPath & (~BIT0);
-                               MinRSSI =  pDM_PDTable->RSSI_CCK_Path[1];
-                               DefaultRespPath = 0;
-                               RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Default port Select CCK Path-0\n"));
-                       }
-                       else if(pDM_PDTable->RSSI_CCK_Path[0] < pDM_PDTable->RSSI_CCK_Path[1])
-                       {
-                               pDM_PDTable->CCKTXPath =  pDM_PDTable->CCKTXPath | BIT0;
-                               MinRSSI =  pDM_PDTable->RSSI_CCK_Path[0];
-                               DefaultRespPath = 1;
-                               RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Default port Select CCK Path-1\n"));
-                       }
-                       else
-                       {
-                               if((pDM_PDTable->RSSI_CCK_Path[0] != 0) && (pDM_PDTable->RSSI_CCK_Path[0] < MinRSSI))
-                               {
-                                       pDM_PDTable->CCKTXPath = pDM_PDTable->CCKTXPath & (~BIT0);
-                                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Default port Select CCK Path-0\n"));
-                                       MinRSSI =  pDM_PDTable->RSSI_CCK_Path[1];
-                                       DefaultRespPath = 0;
-                               }
-                               else
-                               {
-                                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Default port unchange CCK Path\n"));
-                               }
-                       }
-               }
-               else //Follow OFDM decision
-               {
-                       pDM_PDTable->CCKTXPath = (pDM_PDTable->CCKTXPath & (~BIT0)) | (pDM_PDTable->OFDMTXPath &BIT0);
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Follow OFDM decision, Default port Select CCK Path-%d\n",
-                               pDM_PDTable->CCKTXPath &BIT0));
-               }
-       }
-       //1 Extension Port
-       for(i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++)
-       {
-               if(IsAPModeExist(Adapter)  && GetFirstExtAdapter(Adapter) != NULL)
-                       pEntry = AsocEntry_EnumStation(GetFirstExtAdapter(Adapter), i);
-               else
-                       pEntry = AsocEntry_EnumStation(GetDefaultAdapter(Adapter), i);
-
-               if(pEntry!=NULL)
-               {
-                       if(pEntry->bAssociated)
-                       {
-                               if(pEntry->rssi_stat.OFDM_Pkt_Cnt == 0)
-                               {
-                                       for(i=0; i<2; i++)
-                                       {
-                                               if(pEntry->rssi_stat.RSSI_CCK_Path_cnt[i] > 1)
-                                                       pEntry->rssi_stat.RSSI_CCK_Path[i] = pEntry->rssi_stat.RSSI_CCK_Path[i] / (pEntry->rssi_stat.RSSI_CCK_Path_cnt[i]-1);
-                                               else
-                                                       pEntry->rssi_stat.RSSI_CCK_Path[i] = 0;
-                                       }
-                                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: MACID=%d, RSSI_CCK0=%d, RSSI_CCK1=%d\n",
-                                               pEntry->AID+1, pEntry->rssi_stat.RSSI_CCK_Path[0], pEntry->rssi_stat.RSSI_CCK_Path[1]));
-
-                                       if(pEntry->rssi_stat.RSSI_CCK_Path[0] >pEntry->rssi_stat.RSSI_CCK_Path[1])
-                                       {
-                                               pDM_PDTable->CCKTXPath = pDM_PDTable->CCKTXPath & ~(BIT(pEntry->AID+1));
-                                               RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: MACID=%d Select CCK Path-0\n", pEntry->AID+1));
-                                               if(pEntry->rssi_stat.RSSI_CCK_Path[1] < MinRSSI)
-                                               {
-                                                       MinRSSI = pEntry->rssi_stat.RSSI_CCK_Path[1];
-                                                       DefaultRespPath = 0;
-                                               }
-                                       }
-                                       else if(pEntry->rssi_stat.RSSI_CCK_Path[0] <pEntry->rssi_stat.RSSI_CCK_Path[1])
-                                       {
-                                               pDM_PDTable->CCKTXPath = pDM_PDTable->CCKTXPath | BIT(pEntry->AID+1);
-                                               RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: MACID=%d Select CCK Path-1\n", pEntry->AID+1));
-                                               if(pEntry->rssi_stat.RSSI_CCK_Path[0] < MinRSSI)
-                                               {
-                                                       MinRSSI = pEntry->rssi_stat.RSSI_CCK_Path[0];
-                                                       DefaultRespPath = 1;
-                                               }
-                                       }
-                                       else
-                                       {
-                                               if((pEntry->rssi_stat.RSSI_CCK_Path[0] != 0) && (pEntry->rssi_stat.RSSI_CCK_Path[0] < MinRSSI))
-                                               {
-                                                       pDM_PDTable->CCKTXPath = pDM_PDTable->CCKTXPath & ~(BIT(pEntry->AID+1));
-                                                       MinRSSI = pEntry->rssi_stat.RSSI_CCK_Path[1];
-                                                       DefaultRespPath = 0;
-                                                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: MACID=%d Select CCK Path-0\n", pEntry->AID+1));
-                                               }
-                                               else
-                                               {
-                                                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: MACID=%d unchange CCK Path\n", pEntry->AID+1));
-                                               }
-                                       }
-                               }
-                               else //Follow OFDM decision
-                               {
-                                       pDM_PDTable->CCKTXPath = (pDM_PDTable->CCKTXPath & (~(BIT(pEntry->AID+1)))) | (pDM_PDTable->OFDMTXPath & BIT(pEntry->AID+1));
-                                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: Follow OFDM decision, MACID=%d Select CCK Path-%d\n",
-                                               pEntry->AID+1, (pDM_PDTable->CCKTXPath & BIT(pEntry->AID+1))>>(pEntry->AID+1)));
-                               }
-                       }
-               }
-               else
-               {
-                       break;
-               }
-       }
-
-       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C:MinRSSI=%d\n",MinRSSI));
-
-       if(MinRSSI == 0xFF)
-               DefaultRespPath = pDM_PDTable->CCKDefaultRespPath;
-
-       pDM_PDTable->CCKDefaultRespPath = DefaultRespPath;
-}
-
-
-
-VOID
-odm_PathDiversityAfterLink_92C(
-       IN      PADAPTER        Adapter
-)
-{
-       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
-       PDM_ODM_T               pDM_Odm = &pHalData->DM_OutSrc;
-       pPD_T           pDM_PDTable = &Adapter->DM_PDTable;
-       u1Byte          DefaultRespPath=0;
-
-       if((!IS_92C_SERIAL(pHalData->VersionID)) || (pHalData->PathDivCfg != 1) || (pHalData->eRFPowerState == eRfOff))
-       {
-               if(pHalData->PathDivCfg == 0)
-               {
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("No ODM_TXPathDiversity()\n"));
-               }
-               else
-               {
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("2T ODM_TXPathDiversity()\n"));
-               }
-               return;
-       }
-       if(!odm_IsConnected_92C(Adapter))
-       {
-               RT_TRACE(       COMP_SWAS, DBG_LOUD, ("ODM_TXPathDiversity(): No Connections\n"));
-               return;
-       }
-
-
-       if(pDM_PDTable->TrainingState == 0)
-       {
-               RT_TRACE(       COMP_SWAS, DBG_LOUD, ("ODM_TXPathDiversity() ==>\n"));
-               odm_OFDMTXPathDiversity_92C(Adapter);
-
-               if((pDM_PDTable->CCKPathDivEnable == TRUE) && (pDM_PDTable->OFDM_Pkt_Cnt < 100))
-               {
-                       //RT_TRACE(     COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: TrainingState=0\n"));
-
-                       if(pDM_PDTable->CCK_Pkt_Cnt > 300)
-                               pDM_PDTable->Timer = 20;
-                       else if(pDM_PDTable->CCK_Pkt_Cnt > 100)
-                               pDM_PDTable->Timer = 60;
-                       else
-                               pDM_PDTable->Timer = 250;
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: timer=%d\n",pDM_PDTable->Timer));
-
-                       PHY_SetBBReg(Adapter, rCCK0_AFESetting  , 0x0F000000, 0x00); // RX path = PathA
-                       pDM_PDTable->TrainingState = 1;
-                       pHalData->RSSI_test = TRUE;
-                       ODM_SetTimer( pDM_Odm, &pDM_Odm->CCKPathDiversityTimer, pDM_PDTable->Timer); //ms
-               }
-               else
-               {
-                       pDM_PDTable->CCKTXPath = pDM_PDTable->OFDMTXPath;
-                       DefaultRespPath = pDM_PDTable->OFDMDefaultRespPath;
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_SetRespPath_92C: Skip odm_CCKTXPathDiversity_92C, DefaultRespPath is OFDM\n"));
-                       odm_SetRespPath_92C(Adapter, DefaultRespPath);
-                       odm_ResetPathDiversity_92C(Adapter);
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("ODM_TXPathDiversity() <==\n"));
-               }
-       }
-       else if(pDM_PDTable->TrainingState == 1)
-       {
-               //RT_TRACE(     COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: TrainingState=1\n"));
-               PHY_SetBBReg(Adapter, rCCK0_AFESetting  , 0x0F000000, 0x05); // RX path = PathB
-               pDM_PDTable->TrainingState = 2;
-               ODM_SetTimer( pDM_Odm, &pDM_Odm->CCKPathDiversityTimer, pDM_PDTable->Timer); //ms
-       }
-       else
-       {
-               //RT_TRACE(     COMP_SWAS, DBG_LOUD, ("odm_CCKTXPathDiversity_92C: TrainingState=2\n"));
-               pDM_PDTable->TrainingState = 0;
-               odm_CCKTXPathDiversity_92C(Adapter);
-               if(pDM_PDTable->OFDM_Pkt_Cnt != 0)
-               {
-                       DefaultRespPath = pDM_PDTable->OFDMDefaultRespPath;
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_SetRespPath_92C: DefaultRespPath is OFDM\n"));
-               }
-               else
-               {
-                       DefaultRespPath = pDM_PDTable->CCKDefaultRespPath;
-                       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_SetRespPath_92C: DefaultRespPath is CCK\n"));
-               }
-               odm_SetRespPath_92C(Adapter, DefaultRespPath);
-               odm_ResetPathDiversity_92C(Adapter);
-               RT_TRACE(       COMP_SWAS, DBG_LOUD, ("ODM_TXPathDiversity() <==\n"));
-       }
-
-}
-
-
-
-VOID
-odm_CCKTXPathDiversityCallback(
-       PRT_TIMER               pTimer
-)
-{
-#if USE_WORKITEM
-       PADAPTER        Adapter = (PADAPTER)pTimer->Adapter;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-          PDM_ODM_T            pDM_Odm = &pHalData->DM_OutSrc;
-#else
-       PADAPTER        Adapter = (PADAPTER)pTimer->Adapter;
-#endif
-
-#if DEV_BUS_TYPE==RT_PCI_INTERFACE
-#if USE_WORKITEM
-       PlatformScheduleWorkItem(&pDM_Odm->CCKPathDiversityWorkitem);
-#else
-       odm_PathDiversityAfterLink_92C(Adapter);
-#endif
-#else
-       PlatformScheduleWorkItem(&pDM_Odm->CCKPathDiversityWorkitem);
-#endif
-
-}
-
-
-VOID
-odm_CCKTXPathDiversityWorkItemCallback(
-    IN PVOID            pContext
-    )
-{
-       PADAPTER        Adapter = (PADAPTER)pContext;
-
-       odm_CCKTXPathDiversity_92C(Adapter);
-}
-
-
-VOID
-ODM_CCKPathDiversityChkPerPktRssi(
-       PADAPTER                Adapter,
-       bool                    bIsDefPort,
-       bool                    bMatchBSSID,
-       PRT_WLAN_STA    pEntry,
-       PRT_RFD                 pRfd,
-       pu1Byte                 pDesc
-       )
-{
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       bool                    bCount = FALSE;
-       pPD_T   pDM_PDTable = &Adapter->DM_PDTable;
-       //bool  isCCKrate = RX_HAL_IS_CCK_RATE_92C(pDesc);
-#if DEV_BUS_TYPE != RT_SDIO_INTERFACE
-       bool    isCCKrate = RX_HAL_IS_CCK_RATE(Adapter, pDesc);
-#else  //below code would be removed if we have verified SDIO
-       bool    isCCKrate = IS_HARDWARE_TYPE_8188E(Adapter) ? RX_HAL_IS_CCK_RATE_88E(pDesc) : RX_HAL_IS_CCK_RATE_92C(pDesc);
-#endif
-
-       if((pHalData->PathDivCfg != 1) || (pHalData->RSSI_test == FALSE))
-               return;
-
-       if(pHalData->RSSI_target==NULL && bIsDefPort && bMatchBSSID)
-               bCount = TRUE;
-       else if(pHalData->RSSI_target!=NULL && pEntry!=NULL && pHalData->RSSI_target==pEntry)
-               bCount = TRUE;
-
-       if(bCount && isCCKrate)
-       {
-               if(pDM_PDTable->TrainingState == 1 )
-               {
-                       if(pEntry)
-                       {
-                               if(pEntry->rssi_stat.RSSI_CCK_Path_cnt[0] != 0)
-                                       pEntry->rssi_stat.RSSI_CCK_Path[0] += pRfd->Status.RxPWDBAll;
-                               pEntry->rssi_stat.RSSI_CCK_Path_cnt[0]++;
-                       }
-                       else
-                       {
-                               if(pDM_PDTable->RSSI_CCK_Path_cnt[0] != 0)
-                                       pDM_PDTable->RSSI_CCK_Path[0] += pRfd->Status.RxPWDBAll;
-                               pDM_PDTable->RSSI_CCK_Path_cnt[0]++;
-                       }
-               }
-               else if(pDM_PDTable->TrainingState == 2 )
-               {
-                       if(pEntry)
-                       {
-                               if(pEntry->rssi_stat.RSSI_CCK_Path_cnt[1] != 0)
-                                       pEntry->rssi_stat.RSSI_CCK_Path[1] += pRfd->Status.RxPWDBAll;
-                               pEntry->rssi_stat.RSSI_CCK_Path_cnt[1]++;
-                       }
-                       else
-                       {
-                               if(pDM_PDTable->RSSI_CCK_Path_cnt[1] != 0)
-                                       pDM_PDTable->RSSI_CCK_Path[1] += pRfd->Status.RxPWDBAll;
-                               pDM_PDTable->RSSI_CCK_Path_cnt[1]++;
-                       }
-               }
-       }
-}
-
-
-bool
-ODM_PathDiversityBeforeLink92C(
-       //IN    PADAPTER        Adapter
-       IN              PDM_ODM_T               pDM_Odm
-       )
-{
-#if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM)
-       PADAPTER                Adapter = pDM_Odm->Adapter;
-       HAL_DATA_TYPE*  pHalData = NULL;
-       PMGNT_INFO              pMgntInfo = NULL;
-       //pSWAT_T               pDM_SWAT_Table = &Adapter->DM_SWAT_Table;
-       pPD_T                   pDM_PDTable = NULL;
-
-       s1Byte                  Score = 0;
-       PRT_WLAN_BSS    pTmpBssDesc;
-       PRT_WLAN_BSS    pTestBssDesc;
-
-       u1Byte                  target_chnl = 0;
-       u1Byte                  index;
-
-       if (pDM_Odm->Adapter == NULL)  //For BSOD when plug/unplug fast.  //By YJ,120413
-       {       // The ODM structure is not initialized.
-               return FALSE;
-       }
-       pHalData = GET_HAL_DATA(Adapter);
-       pMgntInfo = &Adapter->MgntInfo;
-       pDM_PDTable = &Adapter->DM_PDTable;
-
-       // Condition that does not need to use path diversity.
-       if((!IS_92C_SERIAL(pHalData->VersionID)) || (pHalData->PathDivCfg!=1) || pMgntInfo->AntennaTest )
-       {
-               RT_TRACE(COMP_SWAS, DBG_LOUD,
-                               ("ODM_PathDiversityBeforeLink92C(): No PathDiv Mechanism before link.\n"));
-               return FALSE;
-       }
-
-       // Since driver is going to set BB register, it shall check if there is another thread controlling BB/RF.
-       PlatformAcquireSpinLock(Adapter, RT_RF_STATE_SPINLOCK);
-       if(pHalData->eRFPowerState!=eRfOn || pMgntInfo->RFChangeInProgress || pMgntInfo->bMediaConnect)
-       {
-               PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK);
-
-               RT_TRACE(COMP_SWAS, DBG_LOUD,
-                               ("ODM_PathDiversityBeforeLink92C(): RFChangeInProgress(%x), eRFPowerState(%x)\n",
-                               pMgntInfo->RFChangeInProgress,
-                               pHalData->eRFPowerState));
-
-               //pDM_SWAT_Table->SWAS_NoLink_State = 0;
-               pDM_PDTable->PathDiv_NoLink_State = 0;
-
-               return FALSE;
-       }
-       else
-       {
-               PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK);
-       }
-
-       //1 Run AntDiv mechanism "Before Link" part.
-       //if(pDM_SWAT_Table->SWAS_NoLink_State == 0)
-       if(pDM_PDTable->PathDiv_NoLink_State == 0)
-       {
-               //1 Prepare to do Scan again to check current antenna state.
-
-               // Set check state to next step.
-               //pDM_SWAT_Table->SWAS_NoLink_State = 1;
-               pDM_PDTable->PathDiv_NoLink_State = 1;
-
-               // Copy Current Scan list.
-               Adapter->MgntInfo.tmpNumBssDesc = pMgntInfo->NumBssDesc;
-               PlatformMoveMemory((PVOID)Adapter->MgntInfo.tmpbssDesc, (PVOID)pMgntInfo->bssDesc, sizeof(RT_WLAN_BSS)*MAX_BSS_DESC);
-
-               // Switch Antenna to another one.
-               if(pDM_PDTable->DefaultRespPath == 0)
-               {
-                       PHY_SetBBReg(Adapter, rCCK0_AFESetting  , 0x0F000000, 0x05); // TRX path = PathB
-                       odm_SetRespPath_92C(Adapter, 1);
-                       pDM_PDTable->OFDMTXPath = 0xFFFFFFFF;
-                       pDM_PDTable->CCKTXPath = 0xFFFFFFFF;
-               }
-               else
-               {
-                       PHY_SetBBReg(Adapter, rCCK0_AFESetting  , 0x0F000000, 0x00); // TRX path = PathA
-                       odm_SetRespPath_92C(Adapter, 0);
-                       pDM_PDTable->OFDMTXPath = 0x0;
-                       pDM_PDTable->CCKTXPath = 0x0;
-               }
-#if 0
-
-               pDM_SWAT_Table->PreAntenna = pDM_SWAT_Table->CurAntenna;
-               pDM_SWAT_Table->CurAntenna = (pDM_SWAT_Table->CurAntenna==Antenna_A)?Antenna_B:Antenna_A;
-
-               RT_TRACE(COMP_SWAS, DBG_LOUD,
-                       ("ODM_SwAntDivCheckBeforeLink8192C: Change to Ant(%s) for testing.\n", (pDM_SWAT_Table->CurAntenna==Antenna_A)?"A":"B"));
-               //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, DM_SWAT_Table.CurAntenna);
-               pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 = ((pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 & 0xfffffcff) | (pDM_SWAT_Table->CurAntenna<<8));
-               PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, bMaskDWord, pDM_SWAT_Table->SWAS_NoLink_BK_Reg860);
-#endif
-
-               // Go back to scan function again.
-               RT_TRACE(COMP_SWAS, DBG_LOUD, ("ODM_PathDiversityBeforeLink92C: Scan one more time\n"));
-               pMgntInfo->ScanStep=0;
-               target_chnl = odm_SwAntDivSelectChkChnl(Adapter);
-               odm_SwAntDivConsructChkScanChnl(Adapter, target_chnl);
-               HTReleaseChnlOpLock(Adapter);
-               PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5);
-
-               return TRUE;
-       }
-       else
-       {
-               //1 ScanComple() is called after antenna swiched.
-               //1 Check scan result and determine which antenna is going
-               //1 to be used.
-
-               for(index=0; index<Adapter->MgntInfo.tmpNumBssDesc; index++)
-               {
-                       pTmpBssDesc = &(Adapter->MgntInfo.tmpbssDesc[index]);
-                       pTestBssDesc = &(pMgntInfo->bssDesc[index]);
-
-                       if(PlatformCompareMemory(pTestBssDesc->bdBssIdBuf, pTmpBssDesc->bdBssIdBuf, 6)!=0)
-                       {
-                               RT_TRACE(COMP_SWAS, DBG_LOUD, ("ODM_PathDiversityBeforeLink92C(): ERROR!! This shall not happen.\n"));
-                               continue;
-                       }
-
-                       if(pTmpBssDesc->RecvSignalPower > pTestBssDesc->RecvSignalPower)
-                       {
-                               RT_TRACE(COMP_SWAS, DBG_LOUD, ("ODM_PathDiversityBeforeLink92C: Compare scan entry: Score++\n"));
-                               RT_PRINT_STR(COMP_SWAS, DBG_LOUD, "SSID: ", pTestBssDesc->bdSsIdBuf, pTestBssDesc->bdSsIdLen);
-                               RT_TRACE(COMP_SWAS, DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower));
-
-                               Score++;
-                               PlatformMoveMemory(pTestBssDesc, pTmpBssDesc, sizeof(RT_WLAN_BSS));
-                       }
-                       else if(pTmpBssDesc->RecvSignalPower < pTestBssDesc->RecvSignalPower)
-                       {
-                               RT_TRACE(COMP_SWAS, DBG_LOUD, ("ODM_PathDiversityBeforeLink92C: Compare scan entry: Score--\n"));
-                               RT_PRINT_STR(COMP_SWAS, DBG_LOUD, "SSID: ", pTestBssDesc->bdSsIdBuf, pTestBssDesc->bdSsIdLen);
-                               RT_TRACE(COMP_SWAS, DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower));
-                               Score--;
-                       }
-
-               }
-
-               if(pMgntInfo->NumBssDesc!=0 && Score<=0)
-               {
-                       RT_TRACE(COMP_SWAS, DBG_LOUD,
-                               ("ODM_PathDiversityBeforeLink92C(): DefaultRespPath=%d\n", pDM_PDTable->DefaultRespPath));
-
-                       //pDM_SWAT_Table->PreAntenna = pDM_SWAT_Table->CurAntenna;
-               }
-               else
-               {
-                       RT_TRACE(COMP_SWAS, DBG_LOUD,
-                               ("ODM_PathDiversityBeforeLink92C(): DefaultRespPath=%d\n", pDM_PDTable->DefaultRespPath));
-
-                       if(pDM_PDTable->DefaultRespPath == 0)
-                       {
-                               pDM_PDTable->OFDMTXPath = 0xFFFFFFFF;
-                               pDM_PDTable->CCKTXPath = 0xFFFFFFFF;
-                               odm_SetRespPath_92C(Adapter, 1);
-                       }
-                       else
-                       {
-                               pDM_PDTable->OFDMTXPath = 0x0;
-                               pDM_PDTable->CCKTXPath = 0x0;
-                               odm_SetRespPath_92C(Adapter, 0);
-                       }
-                       PHY_SetBBReg(Adapter, rCCK0_AFESetting  , 0x0F000000, 0x01); // RX path = PathAB
-
-                       //pDM_SWAT_Table->CurAntenna = pDM_SWAT_Table->PreAntenna;
-
-                       //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, DM_SWAT_Table.CurAntenna);
-                       //pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 = ((pDM_SWAT_Table->SWAS_NoLink_BK_Reg860 & 0xfffffcff) | (pDM_SWAT_Table->CurAntenna<<8));
-                       //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, bMaskDWord, pDM_SWAT_Table->SWAS_NoLink_BK_Reg860);
-               }
-
-               // Check state reset to default and wait for next time.
-               //pDM_SWAT_Table->SWAS_NoLink_State = 0;
-               pDM_PDTable->PathDiv_NoLink_State = 0;
-
-               return FALSE;
-       }
-#else
-               return  FALSE;
-#endif
-
-}
-
-
-//Neil Chen---2011--06--22
-//----92D Path Diversity----//
-//#ifdef PathDiv92D
-//==================================
-//3 Path Diversity
-//==================================
-//
-// 20100514 Luke/Joseph:
-// Add new function for antenna diversity after link.
-// This is the main function of antenna diversity after link.
-// This function is called in HalDmWatchDog() and ODM_SwAntDivChkAntSwitchCallback().
-// HalDmWatchDog() calls this function with SWAW_STEP_PEAK to initialize the antenna test.
-// In SWAW_STEP_PEAK, another antenna and a 500ms timer will be set for testing.
-// After 500ms, ODM_SwAntDivChkAntSwitchCallback() calls this function to compare the signal just
-// listened on the air with the RSSI of original antenna.
-// It chooses the antenna with better RSSI.
-// There is also a aged policy for error trying. Each error trying will cost more 5 seconds waiting
-// penalty to get next try.
-//
-//
-// 20100503 Joseph:
-// Add new function SwAntDivCheck8192C().
-// This is the main function of Antenna diversity function before link.
-// Mainly, it just retains last scan result and scan again.
-// After that, it compares the scan result to see which one gets better RSSI.
-// It selects antenna with better receiving power and returns better scan result.
-//
-
-
-//
-// 20100514 Luke/Joseph:
-// This function is used to gather the RSSI information for antenna testing.
-// It selects the RSSI of the peer STA that we want to know.
-//
-VOID
-ODM_PathDivChkPerPktRssi(
-       PADAPTER                Adapter,
-       bool                    bIsDefPort,
-       bool                    bMatchBSSID,
-       PRT_WLAN_STA    pEntry,
-       PRT_RFD                 pRfd
-       )
-{
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       bool                    bCount = FALSE;
-       PDM_ODM_T               pDM_Odm = &pHalData->DM_OutSrc;
-       pSWAT_T                 pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
-
-       if(pHalData->RSSI_target==NULL && bIsDefPort && bMatchBSSID)
-               bCount = TRUE;
-       else if(pHalData->RSSI_target!=NULL && pEntry!=NULL && pHalData->RSSI_target==pEntry)
-               bCount = TRUE;
-
-       if(bCount)
-       {
-               //1 RSSI for SW Antenna Switch
-               if(pDM_SWAT_Table->CurAntenna == Antenna_A)
-               {
-                       pHalData->RSSI_sum_A += pRfd->Status.RxPWDBAll;
-                       pHalData->RSSI_cnt_A++;
-               }
-               else
-               {
-                       pHalData->RSSI_sum_B += pRfd->Status.RxPWDBAll;
-                       pHalData->RSSI_cnt_B++;
-
-               }
-       }
-}
-
-
-
-//
-// 20100514 Luke/Joseph:
-// Add new function to reset antenna diversity state after link.
-//
-VOID
-ODM_PathDivRestAfterLink(
-       IN      PDM_ODM_T               pDM_Odm
-       )
-{
-       PADAPTER                Adapter=pDM_Odm->Adapter;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       pSWAT_T                 pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
-
-       pHalData->RSSI_cnt_A = 0;
-       pHalData->RSSI_cnt_B = 0;
-       pHalData->RSSI_test = FALSE;
-       pDM_SWAT_Table->try_flag = 0x0;       // NOT 0xff
-       pDM_SWAT_Table->RSSI_Trying = 0;
-       pDM_SWAT_Table->SelectAntennaMap=0xAA;
-       pDM_SWAT_Table->CurAntenna = Antenna_A;
-}
-
-
-//
-// 20100514 Luke/Joseph:
-// Callback function for 500ms antenna test trying.
-//
-VOID
-odm_PathDivChkAntSwitchCallback(
-       PRT_TIMER               pTimer
-)
-{
-       PADAPTER                Adapter = (PADAPTER)pTimer->Adapter;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       PDM_ODM_T               pDM_Odm = &pHalData->DM_OutSrc;
-
-#if DEV_BUS_TYPE==RT_PCI_INTERFACE
-
-#if USE_WORKITEM
-       PlatformScheduleWorkItem(&pDM_Odm->PathDivSwitchWorkitem);
-#else
-       odm_PathDivChkAntSwitch(pDM_Odm);
-#endif
-#else
-       PlatformScheduleWorkItem(&pDM_Odm->PathDivSwitchWorkitem);
-#endif
-
-//odm_SwAntDivChkAntSwitch(Adapter, SWAW_STEP_DETERMINE);
-
-}
-
-
-VOID
-odm_PathDivChkAntSwitchWorkitemCallback(
-    IN PVOID            pContext
-    )
-{
-       PADAPTER        pAdapter = (PADAPTER)pContext;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(pAdapter);
-       PDM_ODM_T               pDM_Odm = &pHalData->DM_OutSrc;
-
-       odm_PathDivChkAntSwitch(pDM_Odm);
-}
-
-
- //MAC0_ACCESS_PHY1
-
-// 2011-06-22 Neil Chen & Gary Hsin
-// Refer to Jr.Luke's SW ANT DIV
-// 92D Path Diversity Main function
-// refer to 88C software antenna diversity
-//
-VOID
-odm_PathDivChkAntSwitch(
-       PDM_ODM_T               pDM_Odm
-       //PADAPTER              Adapter,
-       //u1Byte                        Step
-)
-{
-       PADAPTER                Adapter = pDM_Odm->Adapter;
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       PMGNT_INFO              pMgntInfo = &Adapter->MgntInfo;
-
-
-       pSWAT_T                 pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
-       s4Byte                  curRSSI=100, RSSI_A, RSSI_B;
-       u1Byte                  nextAntenna=Antenna_B;
-       static u8Byte           lastTxOkCnt=0, lastRxOkCnt=0;
-       u8Byte                  curTxOkCnt, curRxOkCnt;
-       static u8Byte           TXByteCnt_A=0, TXByteCnt_B=0, RXByteCnt_A=0, RXByteCnt_B=0;
-       u8Byte                  CurByteCnt=0, PreByteCnt=0;
-       static u1Byte           TrafficLoad = TRAFFIC_LOW;
-       u1Byte                  Score_A=0, Score_B=0;
-       u1Byte                  i=0x0;
-       // Neil Chen
-       static u1Byte        pathdiv_para=0x0;
-       static u1Byte        switchfirsttime=0x00;
-       // u1Byte                 regB33 = (u1Byte) PHY_QueryBBReg(Adapter, 0xB30,BIT27);
-       u1Byte                  regB33 = (u1Byte)ODM_GetBBReg(pDM_Odm, PATHDIV_REG, BIT27);
-
-
-       //u1Byte                 reg637 =0x0;
-       static u1Byte        fw_value=0x0;
-       u1Byte                 n=0;
-       static u8Byte           lastTxOkCnt_tmp=0, lastRxOkCnt_tmp=0;
-       //u8Byte                        curTxOkCnt_tmp, curRxOkCnt_tmp;
-       PADAPTER            BuddyAdapter = Adapter->BuddyAdapter;     // another adapter MAC
-        // Path Diversity   //Neil Chen--2011--06--22
-
-       //u1Byte                 PathDiv_Trigger = (u1Byte) PHY_QueryBBReg(Adapter, 0xBA0,BIT31);
-       u1Byte                 PathDiv_Trigger = (u1Byte) ODM_GetBBReg(pDM_Odm, PATHDIV_TRI,BIT31);
-       u1Byte                 PathDiv_Enable = pHalData->bPathDiv_Enable;
-
-
-       //DbgPrint("Path Div PG Value:%x \n",PathDiv_Enable);
-       if((BuddyAdapter==NULL)||(!PathDiv_Enable)||(PathDiv_Trigger)||(pHalData->CurrentBandType92D == BAND_ON_2_4G))
-       {
-           return;
-       }
-       ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD,("===================>odm_PathDivChkAntSwitch()\n"));
-
-       // The first time to switch path excluding 2nd, 3rd, ....etc....
-       if(switchfirsttime==0)
-       {
-           if(regB33==0)
-           {
-              pDM_SWAT_Table->CurAntenna = Antenna_A;    // Default MAC0_5G-->Path A (current antenna)
-           }
-       }
-
-       // Condition that does not need to use antenna diversity.
-       if(pDM_Odm->SupportICType != ODM_RTL8192D)
-       {
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("odm_PathDiversityMechanims(): No PathDiv Mechanism.\n"));
-               return;
-       }
-
-       // Radio off: Status reset to default and return.
-       if(pHalData->eRFPowerState==eRfOff)
-       {
-               //ODM_SwAntDivRestAfterLink(Adapter);
-               return;
-       }
-
-       /*
-       // Handling step mismatch condition.
-       // Peak step is not finished at last time. Recover the variable and check again.
-       if(     Step != pDM_SWAT_Table->try_flag        )
-       {
-               ODM_SwAntDivRestAfterLink(Adapter);
-       } */
-
-       if(pDM_SWAT_Table->try_flag == 0xff)
-       {
-               // Select RSSI checking target
-               if(pMgntInfo->mAssoc && !ACTING_AS_AP(Adapter))
-               {
-                       // Target: Infrastructure mode AP.
-                       pHalData->RSSI_target = NULL;
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("odm_PathDivMechanism(): RSSI_target is DEF AP!\n"));
-               }
-               else
-               {
-                       u1Byte                  index = 0;
-                       PRT_WLAN_STA    pEntry = NULL;
-                       PADAPTER                pTargetAdapter = NULL;
-
-                       if(     pMgntInfo->mIbss || ACTING_AS_AP(Adapter) )
-                       {
-                               // Target: AP/IBSS peer.
-                               pTargetAdapter = Adapter;
-                       }
-                       else if(IsAPModeExist(Adapter)  && GetFirstExtAdapter(Adapter) != NULL)
-                       {
-                               // Target: VWIFI peer.
-                               pTargetAdapter = GetFirstExtAdapter(Adapter);
-                       }
-
-                       if(pTargetAdapter != NULL)
-                       {
-                               for(index=0; index<ODM_ASSOCIATE_ENTRY_NUM; index++)
-                               {
-                                       pEntry = AsocEntry_EnumStation(pTargetAdapter, index);
-                                       if(pEntry != NULL)
-                                       {
-                                               if(pEntry->bAssociated)
-                                                       break;
-                                       }
-                               }
-                       }
-
-                       if(pEntry == NULL)
-                       {
-                               ODM_PathDivRestAfterLink(pDM_Odm);
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("odm_SwAntDivChkAntSwitch(): No Link.\n"));
-                               return;
-                       }
-                       else
-                       {
-                               pHalData->RSSI_target = pEntry;
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("odm_SwAntDivChkAntSwitch(): RSSI_target is PEER STA\n"));
-                       }
-               }
-
-               pHalData->RSSI_cnt_A = 0;
-               pHalData->RSSI_cnt_B = 0;
-               pDM_SWAT_Table->try_flag = 0;
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("odm_SwAntDivChkAntSwitch(): Set try_flag to 0 prepare for peak!\n"));
-               return;
-       }
-       else
-       {
-              // 1st step
-               curTxOkCnt = Adapter->TxStats.NumTxBytesUnicast - lastTxOkCnt;
-               curRxOkCnt = Adapter->RxStats.NumRxBytesUnicast - lastRxOkCnt;
-               lastTxOkCnt = Adapter->TxStats.NumTxBytesUnicast;
-               lastRxOkCnt = Adapter->RxStats.NumRxBytesUnicast;
-
-               if(pDM_SWAT_Table->try_flag == 1)   // Training State
-               {
-                       if(pDM_SWAT_Table->CurAntenna == Antenna_A)
-                       {
-                               TXByteCnt_A += curTxOkCnt;
-                               RXByteCnt_A += curRxOkCnt;
-                       }
-                       else
-                       {
-                               TXByteCnt_B += curTxOkCnt;
-                               RXByteCnt_B += curRxOkCnt;
-                       }
-
-                       nextAntenna = (pDM_SWAT_Table->CurAntenna == Antenna_A)? Antenna_B : Antenna_A;
-                       pDM_SWAT_Table->RSSI_Trying--;
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: RSSI_Trying = %d\n",pDM_SWAT_Table->RSSI_Trying));
-                       if(pDM_SWAT_Table->RSSI_Trying == 0)
-                       {
-                               CurByteCnt = (pDM_SWAT_Table->CurAntenna == Antenna_A)? (TXByteCnt_A+RXByteCnt_A) : (TXByteCnt_B+RXByteCnt_B);
-                               PreByteCnt = (pDM_SWAT_Table->CurAntenna == Antenna_A)? (TXByteCnt_B+RXByteCnt_B) : (TXByteCnt_A+RXByteCnt_A);
-
-                               if(TrafficLoad == TRAFFIC_HIGH)
-                               {
-                                       //CurByteCnt = PlatformDivision64(CurByteCnt, 9);
-                                       PreByteCnt =PreByteCnt*9;
-                               }
-                               else if(TrafficLoad == TRAFFIC_LOW)
-                               {
-                                       //CurByteCnt = PlatformDivision64(CurByteCnt, 2);
-                                       PreByteCnt =PreByteCnt*2;
-                               }
-                               if(pHalData->RSSI_cnt_A > 0)
-                                       RSSI_A = pHalData->RSSI_sum_A/pHalData->RSSI_cnt_A;
-                               else
-                                       RSSI_A = 0;
-                               if(pHalData->RSSI_cnt_B > 0)
-                                       RSSI_B = pHalData->RSSI_sum_B/pHalData->RSSI_cnt_B;
-                            else
-                                       RSSI_B = 0;
-                               curRSSI = (pDM_SWAT_Table->CurAntenna == Antenna_A)? RSSI_A : RSSI_B;
-                               pDM_SWAT_Table->PreRSSI =  (pDM_SWAT_Table->CurAntenna == Antenna_A)? RSSI_B : RSSI_A;
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: PreRSSI = %d, CurRSSI = %d\n",pDM_SWAT_Table->PreRSSI, curRSSI));
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: preAntenna= %s, curAntenna= %s \n",
-                               (pDM_SWAT_Table->PreAntenna == Antenna_A?"A":"B"), (pDM_SWAT_Table->CurAntenna == Antenna_A?"A":"B")));
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: RSSI_A= %d, RSSI_cnt_A = %d, RSSI_B= %d, RSSI_cnt_B = %d\n",
-                                       RSSI_A, pHalData->RSSI_cnt_A, RSSI_B, pHalData->RSSI_cnt_B));
-                       }
-
-               }
-               else   // try_flag=0
-               {
-
-                       if(pHalData->RSSI_cnt_A > 0)
-                               RSSI_A = pHalData->RSSI_sum_A/pHalData->RSSI_cnt_A;
-                       else
-                               RSSI_A = 0;
-                       if(pHalData->RSSI_cnt_B > 0)
-                               RSSI_B = pHalData->RSSI_sum_B/pHalData->RSSI_cnt_B;
-                       else
-                               RSSI_B = 0;
-                       curRSSI = (pDM_SWAT_Table->CurAntenna == Antenna_A)? RSSI_A : RSSI_B;
-                       pDM_SWAT_Table->PreRSSI =  (pDM_SWAT_Table->PreAntenna == Antenna_A)? RSSI_A : RSSI_B;
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: PreRSSI = %d, CurRSSI = %d\n", pDM_SWAT_Table->PreRSSI, curRSSI));
-                      ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: preAntenna= %s, curAntenna= %s \n",
-                       (pDM_SWAT_Table->PreAntenna == Antenna_A?"A":"B"), (pDM_SWAT_Table->CurAntenna == Antenna_A?"A":"B")));
-
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH DIV=: RSSI_A= %d, RSSI_cnt_A = %d, RSSI_B= %d, RSSI_cnt_B = %d\n",
-                               RSSI_A, pHalData->RSSI_cnt_A, RSSI_B, pHalData->RSSI_cnt_B));
-                       //RT_TRACE(COMP_SWAS, DBG_LOUD, ("Ekul:curTxOkCnt = %d\n", curTxOkCnt));
-                       //RT_TRACE(COMP_SWAS, DBG_LOUD, ("Ekul:curRxOkCnt = %d\n", curRxOkCnt));
-               }
-
-               //1 Trying State
-               if((pDM_SWAT_Table->try_flag == 1)&&(pDM_SWAT_Table->RSSI_Trying == 0))
-               {
-
-                       if(pDM_SWAT_Table->TestMode == TP_MODE)
-                       {
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: TestMode = TP_MODE"));
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH= TRY:CurByteCnt = %"i64fmt"d,", CurByteCnt));
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH= TRY:PreByteCnt = %"i64fmt"d\n",PreByteCnt));
-                               if(CurByteCnt < PreByteCnt)
-                               {
-                                       if(pDM_SWAT_Table->CurAntenna == Antenna_A)
-                                               pDM_SWAT_Table->SelectAntennaMap=pDM_SWAT_Table->SelectAntennaMap<<1;
-                                       else
-                                               pDM_SWAT_Table->SelectAntennaMap=(pDM_SWAT_Table->SelectAntennaMap<<1)+1;
-                               }
-                               else
-                               {
-                                       if(pDM_SWAT_Table->CurAntenna == Antenna_A)
-                                               pDM_SWAT_Table->SelectAntennaMap=(pDM_SWAT_Table->SelectAntennaMap<<1)+1;
-                                       else
-                                               pDM_SWAT_Table->SelectAntennaMap=pDM_SWAT_Table->SelectAntennaMap<<1;
-                               }
-                               for (i= 0; i<8; i++)
-                               {
-                                       if(((pDM_SWAT_Table->SelectAntennaMap>>i)&BIT0) == 1)
-                                               Score_A++;
-                                       else
-                                               Score_B++;
-                               }
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("SelectAntennaMap=%x\n ",pDM_SWAT_Table->SelectAntennaMap));
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Score_A=%d, Score_B=%d\n", Score_A, Score_B));
+       u8      bbtchange = _FALSE;
+       HAL_DATA_TYPE           *pHalData = GET_HAL_DATA(Adapter);
+       struct xmit_priv                *pxmitpriv = &(Adapter->xmitpriv);
+       struct recv_priv                *precvpriv = &(Adapter->recvpriv);
+       struct registry_priv    *pregpriv = &Adapter->registrypriv;
+       struct mlme_ext_priv    *pmlmeext = &(Adapter->mlmeextpriv);
+       struct mlme_ext_info    *pmlmeinfo = &(pmlmeext->mlmext_info);
 
-                               if(pDM_SWAT_Table->CurAntenna == Antenna_A)
-                               {
-                                       nextAntenna = (Score_A >= Score_B)?Antenna_A:Antenna_B;
-                               }
-                               else
-                               {
-                                       nextAntenna = (Score_B >= Score_A)?Antenna_B:Antenna_A;
-                               }
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: nextAntenna=%s\n",(nextAntenna==Antenna_A)?"A":"B"));
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: preAntenna= %s, curAntenna= %s \n",
-                               (pDM_SWAT_Table->PreAntenna == Antenna_A?"A":"B"), (pDM_SWAT_Table->CurAntenna == Antenna_A?"A":"B")));
 
-                               if(nextAntenna != pDM_SWAT_Table->CurAntenna)
-                               {
-                                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Switch back to another antenna"));
-                               }
-                               else
-                               {
-                                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: current anntena is good\n"));
-                               }
-                       }
+       if ((pregpriv->wifi_spec == 1) )//|| (pmlmeinfo->HT_enable == 0))
+       {
+               goto dm_CheckEdcaTurbo_EXIT;
+       }
 
+       if (pmlmeinfo->assoc_AP_vendor >=  HT_IOT_PEER_MAX)
+       {
+               goto dm_CheckEdcaTurbo_EXIT;
+       }
 
-                       if(pDM_SWAT_Table->TestMode == RSSI_MODE)
-                       {
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: TestMode = RSSI_MODE"));
-                               pDM_SWAT_Table->SelectAntennaMap=0xAA;
-                               if(curRSSI < pDM_SWAT_Table->PreRSSI) //Current antenna is worse than previous antenna
-                               {
-                                       //RT_TRACE(COMP_SWAS, DBG_LOUD, ("SWAS: Switch back to another antenna"));
-                                       nextAntenna = (pDM_SWAT_Table->CurAntenna == Antenna_A)? Antenna_B : Antenna_A;
-                               }
-                               else // current anntena is good
-                               {
-                                       nextAntenna =pDM_SWAT_Table->CurAntenna;
-                                       //RT_TRACE(COMP_SWAS, DBG_LOUD, ("SWAS: current anntena is good\n"));
-                               }
-                       }
+#ifdef CONFIG_BT_COEXIST
+       if (BT_DisableEDCATurbo(Adapter))
+       {
+               goto dm_CheckEdcaTurbo_EXIT;
+       }
+#endif
 
-                       pDM_SWAT_Table->try_flag = 0;
-                       pHalData->RSSI_test = FALSE;
-                       pHalData->RSSI_sum_A = 0;
-                       pHalData->RSSI_cnt_A = 0;
-                       pHalData->RSSI_sum_B = 0;
-                       pHalData->RSSI_cnt_B = 0;
-                       TXByteCnt_A = 0;
-                       TXByteCnt_B = 0;
-                       RXByteCnt_A = 0;
-                       RXByteCnt_B = 0;
+       // Check if the status needs to be changed.
+       if((bbtchange) || (!precvpriv->bIsAnyNonBEPkts) )
+       {
+               cur_tx_bytes = pxmitpriv->tx_bytes - pxmitpriv->last_tx_bytes;
+               cur_rx_bytes = precvpriv->rx_bytes - precvpriv->last_rx_bytes;
 
+               //traffic, TX or RX
+               if((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_RALINK)||(pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_ATHEROS))
+               {
+                       if (cur_tx_bytes > (cur_rx_bytes << 2))
+                       { // Uplink TP is present.
+                               trafficIndex = UP_LINK;
+                       }
+                       else
+                       { // Balance TP is present.
+                               trafficIndex = DOWN_LINK;
+                       }
                }
-
-               //1 Normal State
-               else if(pDM_SWAT_Table->try_flag == 0)
+               else
                {
-                       if(TrafficLoad == TRAFFIC_HIGH)
-                       {
-                               if ((curTxOkCnt+curRxOkCnt) > 3750000)//if(PlatformDivision64(curTxOkCnt+curRxOkCnt, 2) > 1875000)
-                                       TrafficLoad = TRAFFIC_HIGH;
-                               else
-                                       TrafficLoad = TRAFFIC_LOW;
+                       if (cur_rx_bytes > (cur_tx_bytes << 2))
+                       { // Downlink TP is present.
+                               trafficIndex = DOWN_LINK;
                        }
-                       else if(TrafficLoad == TRAFFIC_LOW)
-                               {
-                               if ((curTxOkCnt+curRxOkCnt) > 3750000)//if(PlatformDivision64(curTxOkCnt+curRxOkCnt, 2) > 1875000)
-                                       TrafficLoad = TRAFFIC_HIGH;
-                               else
-                                       TrafficLoad = TRAFFIC_LOW;
+                       else
+                       { // Balance TP is present.
+                               trafficIndex = UP_LINK;
                        }
-                       if(TrafficLoad == TRAFFIC_HIGH)
-                               pDM_SWAT_Table->bTriggerAntennaSwitch = 0;
-                       //RT_TRACE(COMP_SWAS, DBG_LOUD, ("Normal:TrafficLoad = %llu\n", curTxOkCnt+curRxOkCnt));
+               }
 
-                       //Prepare To Try Antenna
-                               nextAntenna = (pDM_SWAT_Table->CurAntenna == Antenna_A)? Antenna_B : Antenna_A;
-                               pDM_SWAT_Table->try_flag = 1;
-                               pHalData->RSSI_test = TRUE;
-                       if((curRxOkCnt+curTxOkCnt) > 1000)
+               if ((pDM_Odm->DM_EDCA_Table.prv_traffic_idx != trafficIndex) || (!pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA))
+               {
+                       if((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_CISCO) && (pmlmeext->cur_wireless_mode & WIRELESS_11_24N))
                        {
-#if DEV_BUS_TYPE==RT_PCI_INTERFACE
-                           pDM_SWAT_Table->RSSI_Trying = 4;
-#else
-                           pDM_SWAT_Table->RSSI_Trying = 2;
-#endif
-                               pDM_SWAT_Table->TestMode = TP_MODE;
+                               edca_param = EDCAParam[pmlmeinfo->assoc_AP_vendor][trafficIndex];
                        }
                        else
                        {
-                               pDM_SWAT_Table->RSSI_Trying = 2;
-                               pDM_SWAT_Table->TestMode = RSSI_MODE;
-
+                               edca_param = EDCAParam[HT_IOT_PEER_UNKNOWN][trafficIndex];
                        }
+                       rtw_write32(Adapter, REG_EDCA_BE_PARAM, edca_param);
 
-                       //RT_TRACE(COMP_SWAS, DBG_LOUD, ("SWAS: Normal State -> Begin Trying!\n"));
-                       pHalData->RSSI_sum_A = 0;
-                       pHalData->RSSI_cnt_A = 0;
-                       pHalData->RSSI_sum_B = 0;
-                       pHalData->RSSI_cnt_B = 0;
-               } // end of try_flag=0
-       }
+                       pDM_Odm->DM_EDCA_Table.prv_traffic_idx = trafficIndex;
+               }
 
-       //1 4.Change TRX antenna
-       if(nextAntenna != pDM_SWAT_Table->CurAntenna)
+               pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _TRUE;
+       }
+       else
        {
-
-               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Change TX Antenna!\n "));
-               //PHY_SetBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300, nextAntenna); for 88C
-               if(nextAntenna==Antenna_A)
+               //
+               // Turn Off EDCA turbo here.
+               // Restore original EDCA according to the declaration of AP.
+               //
+                if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA)
                {
-                   ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Next Antenna is RF PATH A\n "));
-                   pathdiv_para = 0x02;   //02 to switchback to RF path A
-                   fw_value = 0x03;
-#if DEV_BUS_TYPE==RT_PCI_INTERFACE
-                 odm_PathDiversity_8192D(pDM_Odm, pathdiv_para);
-#else
-                 ODM_FillH2CCmd(Adapter, ODM_H2C_PathDiv,1,(pu1Byte)(&fw_value));
-#endif
+                       rtw_write32(Adapter, REG_EDCA_BE_PARAM, pHalData->AcParam_BE);
+                       pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _FALSE;
                }
-              else if(nextAntenna==Antenna_B)
-              {
-                  ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Next Antenna is RF PATH B\n "));
-                  if(switchfirsttime==0)  // First Time To Enter Path Diversity
-                  {
-                      switchfirsttime=0x01;
-                      pathdiv_para = 0x00;
-                         fw_value=0x00;    // to backup RF Path A Releated Registers
-
-#if DEV_BUS_TYPE==RT_PCI_INTERFACE
-                     odm_PathDiversity_8192D(pDM_Odm, pathdiv_para);
-#else
-                     ODM_FillH2CCmd(Adapter, ODM_H2C_PathDiv,1,(pu1Byte)(&fw_value));
-                     //for(u1Byte n=0; n<80,n++)
-                     //{
-                     //delay_us(500);
-                         ODM_delay_ms(500);
-                     odm_PathDiversity_8192D(pDM_Odm, pathdiv_para);
-
-                        fw_value=0x01;         // to backup RF Path A Releated Registers
-                     ODM_FillH2CCmd(Adapter, ODM_H2C_PathDiv,1,(pu1Byte)(&fw_value));
-#endif
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: FIRST TIME To DO PATH SWITCH!\n "));
-                  }
-                   else
-                   {
-                       pathdiv_para = 0x01;
-                        fw_value = 0x02;
-#if DEV_BUS_TYPE==RT_PCI_INTERFACE
-                     odm_PathDiversity_8192D(pDM_Odm, pathdiv_para);
-#else
-                     ODM_FillH2CCmd(Adapter, ODM_H2C_PathDiv,1,(pu1Byte)(&fw_value));
-#endif
-                   }
-              }
-           //   odm_PathDiversity_8192D(Adapter, pathdiv_para);
        }
 
-       //1 5.Reset Statistics
-       pDM_SWAT_Table->PreAntenna = pDM_SWAT_Table->CurAntenna;
-       pDM_SWAT_Table->CurAntenna = nextAntenna;
-       pDM_SWAT_Table->PreRSSI = curRSSI;
-       //lastTxOkCnt = Adapter->TxStats.NumTxBytesUnicast;
-       //lastRxOkCnt = Adapter->RxStats.NumRxBytesUnicast;
+dm_CheckEdcaTurbo_EXIT:
+       // Set variables for next time.
+       precvpriv->bIsAnyNonBEPkts = _FALSE;
+       pxmitpriv->last_tx_bytes = pxmitpriv->tx_bytes;
+       precvpriv->last_rx_bytes = precvpriv->rx_bytes;
+}
 
-       //1 6.Set next timer
 
-       if(pDM_SWAT_Table->RSSI_Trying == 0)
-               return;
+// need to ODM CE Platform
+//move to here for ANT detection mechanism using
 
-       if(pDM_SWAT_Table->RSSI_Trying%2 == 0)
-       {
-               if(pDM_SWAT_Table->TestMode == TP_MODE)
-               {
-                       if(TrafficLoad == TRAFFIC_HIGH)
-                       {
-#if DEV_BUS_TYPE==RT_PCI_INTERFACE
-                               ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 10 ); //ms
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Test another antenna for 10 ms\n"));
-#else
-                               ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 20 ); //ms
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Test another antenna for 20 ms\n"));
-#endif
-                       }
-                       else if(TrafficLoad == TRAFFIC_LOW)
-                       {
-                               ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 50 ); //ms
-                               ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Test another antenna for 50 ms\n"));
-                       }
-               }
-               else   // TestMode == RSSI_MODE
-               {
-                       ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 500 ); //ms
-                       ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Test another antenna for 500 ms\n"));
-               }
-       }
-       else
-       {
-               if(pDM_SWAT_Table->TestMode == TP_MODE)
-               {
-                       if(TrafficLoad == TRAFFIC_HIGH)
+u4Byte
+GetPSDData(
+ PDM_ODM_T     pDM_Odm,
+       unsigned int    point,
+       u8 initial_gain_psd)
+{
+       //unsigned int  val, rfval;
+       //int   psd_report;
+       u4Byte  psd_report;
+
+       //HAL_DATA_TYPE         *pHalData = GET_HAL_DATA(Adapter);
+       //Debug Message
+       //val = PHY_QueryBBReg(Adapter,0x908, bMaskDWord);
+       //DbgPrint("Reg908 = 0x%x\n",val);
+       //val = PHY_QueryBBReg(Adapter,0xDF4, bMaskDWord);
+       //rfval = PHY_QueryRFReg(Adapter, RF_PATH_A, 0x00, bRFRegOffsetMask);
+       //DbgPrint("RegDF4 = 0x%x, RFReg00 = 0x%x\n",val, rfval);
+       //DbgPrint("PHYTXON = %x, OFDMCCA_PP = %x, CCKCCA_PP = %x, RFReg00 = %x\n",
+               //(val&BIT25)>>25, (val&BIT14)>>14, (val&BIT15)>>15, rfval);
+
+       //Set DCO frequency index, offset=(40MHz/SamplePts)*point
+       ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point);
+
+       //Start PSD calculation, Reg808[22]=0->1
+       ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1);
+       //Need to wait for HW PSD report
+       ODM_StallExecution(30);
+       ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0);
+       //Read PSD report, Reg8B4[15:0]
+       psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF;
 
-#if DEV_BUS_TYPE==RT_PCI_INTERFACE
-                               ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 90 ); //ms
-                               //ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("=PATH=: Test another antenna for 90 ms\n"));
+#if 1//(DEV_BUS_TYPE == RT_PCI_INTERFACE) && ( (RT_PLATFORM == PLATFORM_LINUX) || (RT_PLATFORM == PLATFORM_MACOSX))
+       psd_report = (u4Byte) (ConvertTo_dB(psd_report))+(u4Byte)(initial_gain_psd-0x1c);
 #else
-                               ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 180); //ms
+       psd_report = (int) (20*log10((double)psd_report))+(int)(initial_gain_psd-0x1c);
 #endif
-                       else if(TrafficLoad == TRAFFIC_LOW)
-                               ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 100 ); //ms
-               }
-               else
-                       ODM_SetTimer( pDM_Odm, &pDM_Odm->PathDivSwitchTimer, 500 ); //ms
-       }
-}
 
-//==================================================
-//3 PathDiv End
-//==================================================
+       return psd_report;
+
+}
 
-VOID
-odm_SetRespPath_92C(
-       IN      PADAPTER        Adapter,
-       IN      u1Byte  DefaultRespPath
-       )
+u4Byte
+ConvertTo_dB(
+       u4Byte  Value)
 {
-       pPD_T   pDM_PDTable = &Adapter->DM_PDTable;
+       u8 i;
+       u8 j;
+       u4Byte dB;
 
-       RT_TRACE(       COMP_SWAS, DBG_LOUD, ("odm_SetRespPath_92C: Select Response Path=%d\n",DefaultRespPath));
-       if(DefaultRespPath != pDM_PDTable->DefaultRespPath)
+       Value = Value & 0xFFFF;
+
+       for (i=0;i<8;i++)
        {
-               if(DefaultRespPath == 0)
-               {
-                       PlatformEFIOWrite1Byte(Adapter, 0x6D8, (PlatformEFIORead1Byte(Adapter, 0x6D8)&0xc0)|0x15);
-               }
-               else
+               if (Value <= dB_Invert_Table[i][11])
                {
-                       PlatformEFIOWrite1Byte(Adapter, 0x6D8, (PlatformEFIORead1Byte(Adapter, 0x6D8)&0xc0)|0x2A);
+                       break;
                }
        }
-       pDM_PDTable->DefaultRespPath = DefaultRespPath;
-}
-
 
-VOID
-ODM_FillTXPathInTXDESC(
-               IN      PADAPTER        Adapter,
-               IN      PRT_TCB         pTcb,
-               IN      pu1Byte         pDesc
-)
-{
-       HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
-       u4Byte  TXPath;
-       pPD_T   pDM_PDTable = &Adapter->DM_PDTable;
+       if (i >= 8)
+       {
+               return (96);    // maximum 96 dB
+       }
 
-       //2011.09.05  Add by Luke Lee for path diversity
-       if(pHalData->PathDivCfg == 1)
+       for (j=0;j<12;j++)
        {
-               TXPath = (pDM_PDTable->OFDMTXPath >> pTcb->macId) & BIT0;
-               //RT_TRACE(     COMP_SWAS, DBG_LOUD, ("Fill TXDESC: macID=%d, TXPath=%d\n", pTcb->macId, TXPath));
-               //SET_TX_DESC_TX_ANT_CCK(pDesc,TXPath);
-               if(TXPath == 0)
-               {
-                       SET_TX_DESC_TX_ANTL_92C(pDesc,1);
-                       SET_TX_DESC_TX_ANT_HT_92C(pDesc,1);
-               }
-               else
-               {
-                       SET_TX_DESC_TX_ANTL_92C(pDesc,2);
-                       SET_TX_DESC_TX_ANT_HT_92C(pDesc,2);
-               }
-               TXPath = (pDM_PDTable->CCKTXPath >> pTcb->macId) & BIT0;
-               if(TXPath == 0)
-               {
-                       SET_TX_DESC_TX_ANT_CCK_92C(pDesc,1);
-               }
-               else
+               if (Value <= dB_Invert_Table[i][j])
                {
-                       SET_TX_DESC_TX_ANT_CCK_92C(pDesc,2);
+                       break;
                }
        }
-}
 
-//Only for MP //Neil Chen--2012--0502--
-VOID
-odm_PathDivInit(
-IN     PDM_ODM_T       pDM_Odm)
-{
-       pPATHDIV_PARA   pathIQK = &pDM_Odm->pathIQK;
-
-       pathIQK->org_2g_RegC14=0x0;
-       pathIQK->org_2g_RegC4C=0x0;
-       pathIQK->org_2g_RegC80=0x0;
-       pathIQK->org_2g_RegC94=0x0;
-       pathIQK->org_2g_RegCA0=0x0;
-       pathIQK->org_5g_RegC14=0x0;
-       pathIQK->org_5g_RegCA0=0x0;
-       pathIQK->org_5g_RegE30=0x0;
-       pathIQK->swt_2g_RegC14=0x0;
-       pathIQK->swt_2g_RegC4C=0x0;
-       pathIQK->swt_2g_RegC80=0x0;
-       pathIQK->swt_2g_RegC94=0x0;
-       pathIQK->swt_2g_RegCA0=0x0;
-       pathIQK->swt_5g_RegC14=0x0;
-       pathIQK->swt_5g_RegCA0=0x0;
-       pathIQK->swt_5g_RegE30=0x0;
+       dB = i*12 + j + 1;
 
+       return (dB);
 }
-#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_MP)
 
-#if ((DM_ODM_SUPPORT_TYPE == ODM_MP)||(DM_ODM_SUPPORT_TYPE == ODM_CE))
+//
+// 2011/09/22 MH Add for 92D global spin lock utilization.
+//
+void
+odm_GlobalAdapterCheck(
+               void
+       )
+{
+}      // odm_GlobalAdapterCheck
 
 
 //
@@ -11225,9 +4518,9 @@ IN       PDM_ODM_T       pDM_Odm)
 //
 // Added by Joseph, 2012.03.22
 //
-VOID
+void
 ODM_SingleDualAntennaDefaultSetting(
-       IN              PDM_ODM_T               pDM_Odm
+               PDM_ODM_T               pDM_Odm
        )
 {
        pSWAT_T         pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
@@ -11239,12 +4532,12 @@ ODM_SingleDualAntennaDefaultSetting(
 //2 8723A ANT DETECT
 
 
-VOID
+void
 odm_PHY_SaveAFERegisters(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      pu4Byte         AFEReg,
-       IN      pu4Byte         AFEBackup,
-       IN      u4Byte          RegisterNum
+       PDM_ODM_T       pDM_Odm,
+       pu4Byte         AFEReg,
+       pu4Byte         AFEBackup,
+       u4Byte          RegisterNum
        )
 {
        u4Byte  i;
@@ -11255,12 +4548,12 @@ odm_PHY_SaveAFERegisters(
        }
 }
 
-VOID
+void
 odm_PHY_ReloadAFERegisters(
-       IN      PDM_ODM_T       pDM_Odm,
-       IN      pu4Byte         AFEReg,
-       IN      pu4Byte         AFEBackup,
-       IN      u4Byte          RegiesterNum
+       PDM_ODM_T       pDM_Odm,
+       pu4Byte         AFEReg,
+       pu4Byte         AFEBackup,
+       u4Byte          RegiesterNum
        )
 {
        u4Byte  i;
@@ -11283,8 +4576,8 @@ odm_PHY_ReloadAFERegisters(
 //
 bool
 ODM_SingleDualAntennaDetection(
-       IN              PDM_ODM_T               pDM_Odm,
-       IN              u1Byte                  mode
+               PDM_ODM_T               pDM_Odm,
+               u8                      mode
        )
 {
 
@@ -11292,9 +4585,9 @@ ODM_SingleDualAntennaDetection(
        //PDM_ODM_T             pDM_Odm = &pHalData->DM_OutSrc;
        pSWAT_T         pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table;
        u4Byte          CurrentChannel,RfLoopReg;
-       u1Byte          n;
+       u8              n;
        u4Byte          Reg88c, Regc08, Reg874, Regc50;
-       u1Byte          initial_gain = 0x5a;
+       u8              initial_gain = 0x5a;
        u4Byte          PSD_report_tmp;
        u4Byte          AntA_report = 0x0, AntB_report = 0x0,AntO_report=0x0;
        bool            bResult = TRUE;
@@ -11545,10 +4838,6 @@ ODM_SingleDualAntennaDetection(
 
 }
 
-
-#endif   // end odm_CE
-
-#if (DM_ODM_SUPPORT_TYPE == ODM_CE)
 /* Justin: According to the current RRSI to adjust Response Frame TX power, 2012/11/05 */
 void odm_dtc(PDM_ODM_T pDM_Odm)
 {
@@ -11586,12 +4875,6 @@ void odm_dtc(PDM_ODM_T pDM_Odm)
        u8 sign;
        u8 resp_txagc=0;
 
-       #if 0
-       /* As DIG is disabled, DTC is also disable */
-       if(!(pDM_Odm->SupportAbility & ODM_XXXXXX))
-               return;
-       #endif
-
        if (DTC_BASE < pDM_Odm->RSSI_Min) {
                /* need to decade the CTS TX power */
                sign = 1;
@@ -11603,21 +4886,6 @@ void odm_dtc(PDM_ODM_T pDM_Odm)
                                dtc_steps++;
                }
        }
-#if 0
-       else if (DTC_DWN_BASE > pDM_Odm->RSSI_Min)
-       {
-               /* needs to increase the CTS TX power */
-               sign = 0;
-               dtc_steps = 1;
-               for (i=0;i<ARRAY_SIZE(dtc_table_up);i++)
-               {
-                       if ((dtc_table_up[i] <= pDM_Odm->RSSI_Min) || (dtc_steps>=10))
-                               break;
-                       else
-                               dtc_steps++;
-               }
-       }
-#endif
        else
        {
                sign = 0;
@@ -11632,5 +4900,3 @@ void odm_dtc(PDM_ODM_T pDM_Odm)
                __func__, pDM_Odm->RSSI_Min, sign?"minus":"plus", dtc_steps);
 #endif /* CONFIG_RESP_TXAGC_ADJUST */
 }
-
-#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */