158391efdSNathan Chancellor // SPDX-License-Identifier: GPL-2.0 2554c0a3aSHans de Goede /****************************************************************************** 3554c0a3aSHans de Goede * 4554c0a3aSHans de Goede * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. 5554c0a3aSHans de Goede * 6554c0a3aSHans de Goede ******************************************************************************/ 7554c0a3aSHans de Goede 8554c0a3aSHans de Goede #include "odm_precomp.h" 9554c0a3aSHans de Goede 10554c0a3aSHans de Goede void odm_DynamicBBPowerSavingInit(void *pDM_VOID) 11554c0a3aSHans de Goede { 12554c0a3aSHans de Goede PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; 13554c0a3aSHans de Goede pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; 14554c0a3aSHans de Goede 15554c0a3aSHans de Goede pDM_PSTable->PreCCAState = CCA_MAX; 16554c0a3aSHans de Goede pDM_PSTable->CurCCAState = CCA_MAX; 17554c0a3aSHans de Goede pDM_PSTable->PreRFState = RF_MAX; 18554c0a3aSHans de Goede pDM_PSTable->CurRFState = RF_MAX; 19554c0a3aSHans de Goede pDM_PSTable->Rssi_val_min = 0; 20554c0a3aSHans de Goede pDM_PSTable->initialize = 0; 21554c0a3aSHans de Goede } 22554c0a3aSHans de Goede 23554c0a3aSHans de Goede void ODM_RF_Saving(void *pDM_VOID, u8 bForceInNormal) 24554c0a3aSHans de Goede { 25554c0a3aSHans de Goede PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; 26554c0a3aSHans de Goede pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; 27554c0a3aSHans de Goede u8 Rssi_Up_bound = 30; 28554c0a3aSHans de Goede u8 Rssi_Low_bound = 25; 29554c0a3aSHans de Goede 30554c0a3aSHans de Goede if (pDM_Odm->PatchID == 40) { /* RT_CID_819x_FUNAI_TV */ 31554c0a3aSHans de Goede Rssi_Up_bound = 50; 32554c0a3aSHans de Goede Rssi_Low_bound = 45; 33554c0a3aSHans de Goede } 34554c0a3aSHans de Goede 35554c0a3aSHans de Goede if (pDM_PSTable->initialize == 0) { 36554c0a3aSHans de Goede 37554c0a3aSHans de Goede pDM_PSTable->Reg874 = (PHY_QueryBBReg(pDM_Odm->Adapter, 0x874, bMaskDWord)&0x1CC000)>>14; 38554c0a3aSHans de Goede pDM_PSTable->RegC70 = (PHY_QueryBBReg(pDM_Odm->Adapter, 0xc70, bMaskDWord)&BIT3)>>3; 39554c0a3aSHans de Goede pDM_PSTable->Reg85C = (PHY_QueryBBReg(pDM_Odm->Adapter, 0x85c, bMaskDWord)&0xFF000000)>>24; 40554c0a3aSHans de Goede pDM_PSTable->RegA74 = (PHY_QueryBBReg(pDM_Odm->Adapter, 0xa74, bMaskDWord)&0xF000)>>12; 41554c0a3aSHans de Goede /* Reg818 = PHY_QueryBBReg(padapter, 0x818, bMaskDWord); */ 42554c0a3aSHans de Goede pDM_PSTable->initialize = 1; 43554c0a3aSHans de Goede } 44554c0a3aSHans de Goede 45554c0a3aSHans de Goede if (!bForceInNormal) { 46554c0a3aSHans de Goede if (pDM_Odm->RSSI_Min != 0xFF) { 47554c0a3aSHans de Goede if (pDM_PSTable->PreRFState == RF_Normal) { 48554c0a3aSHans de Goede if (pDM_Odm->RSSI_Min >= Rssi_Up_bound) 49554c0a3aSHans de Goede pDM_PSTable->CurRFState = RF_Save; 50554c0a3aSHans de Goede else 51554c0a3aSHans de Goede pDM_PSTable->CurRFState = RF_Normal; 52554c0a3aSHans de Goede } else { 53554c0a3aSHans de Goede if (pDM_Odm->RSSI_Min <= Rssi_Low_bound) 54554c0a3aSHans de Goede pDM_PSTable->CurRFState = RF_Normal; 55554c0a3aSHans de Goede else 56554c0a3aSHans de Goede pDM_PSTable->CurRFState = RF_Save; 57554c0a3aSHans de Goede } 58554c0a3aSHans de Goede } else 59554c0a3aSHans de Goede pDM_PSTable->CurRFState = RF_MAX; 60554c0a3aSHans de Goede } else 61554c0a3aSHans de Goede pDM_PSTable->CurRFState = RF_Normal; 62554c0a3aSHans de Goede 63554c0a3aSHans de Goede if (pDM_PSTable->PreRFState != pDM_PSTable->CurRFState) { 64554c0a3aSHans de Goede if (pDM_PSTable->CurRFState == RF_Save) { 65554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0x874, 0x1C0000, 0x2); /* Reg874[20:18]=3'b010 */ 66554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0xc70, BIT3, 0); /* RegC70[3]= 1'b0 */ 67554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0x85c, 0xFF000000, 0x63); /* Reg85C[31:24]= 0x63 */ 68554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0x874, 0xC000, 0x2); /* Reg874[15:14]=2'b10 */ 69554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0xa74, 0xF000, 0x3); /* RegA75[7:4]= 0x3 */ 70554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0x818, BIT28, 0x0); /* Reg818[28]= 1'b0 */ 71554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0x818, BIT28, 0x1); /* Reg818[28]= 1'b1 */ 72554c0a3aSHans de Goede } else { 73554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0x874, 0x1CC000, pDM_PSTable->Reg874); 74554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0xc70, BIT3, pDM_PSTable->RegC70); 75554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0x85c, 0xFF000000, pDM_PSTable->Reg85C); 76554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0xa74, 0xF000, pDM_PSTable->RegA74); 77554c0a3aSHans de Goede PHY_SetBBReg(pDM_Odm->Adapter, 0x818, BIT28, 0x0); 78554c0a3aSHans de Goede } 79554c0a3aSHans de Goede pDM_PSTable->PreRFState = pDM_PSTable->CurRFState; 80554c0a3aSHans de Goede } 81554c0a3aSHans de Goede } 82