1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /****************************************************************************** |
3 | * |
4 | * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. |
5 | * |
6 | ******************************************************************************/ |
7 | |
8 | #include "odm_precomp.h" |
9 | |
10 | void odm_DynamicBBPowerSavingInit(void *pDM_VOID) |
11 | { |
12 | struct dm_odm_t *pDM_Odm = (struct dm_odm_t *)pDM_VOID; |
13 | struct ps_t *pDM_PSTable = &pDM_Odm->DM_PSTable; |
14 | |
15 | pDM_PSTable->PreCCAState = CCA_MAX; |
16 | pDM_PSTable->CurCCAState = CCA_MAX; |
17 | pDM_PSTable->PreRFState = RF_MAX; |
18 | pDM_PSTable->CurRFState = RF_MAX; |
19 | pDM_PSTable->Rssi_val_min = 0; |
20 | pDM_PSTable->initialize = 0; |
21 | } |
22 | |
23 | void ODM_RF_Saving(void *pDM_VOID, u8 bForceInNormal) |
24 | { |
25 | struct dm_odm_t *pDM_Odm = (struct dm_odm_t *)pDM_VOID; |
26 | struct ps_t *pDM_PSTable = &pDM_Odm->DM_PSTable; |
27 | u8 = 30; |
28 | u8 = 25; |
29 | |
30 | if (pDM_Odm->PatchID == 40) { /* RT_CID_819x_FUNAI_TV */ |
31 | Rssi_Up_bound = 50; |
32 | Rssi_Low_bound = 45; |
33 | } |
34 | |
35 | if (pDM_PSTable->initialize == 0) { |
36 | |
37 | pDM_PSTable->Reg874 = (PHY_QueryBBReg(pDM_Odm->Adapter, 0x874, bMaskDWord)&0x1CC000)>>14; |
38 | pDM_PSTable->RegC70 = (PHY_QueryBBReg(pDM_Odm->Adapter, 0xc70, bMaskDWord)&BIT3)>>3; |
39 | pDM_PSTable->Reg85C = (PHY_QueryBBReg(pDM_Odm->Adapter, 0x85c, bMaskDWord)&0xFF000000)>>24; |
40 | pDM_PSTable->RegA74 = (PHY_QueryBBReg(pDM_Odm->Adapter, 0xa74, bMaskDWord)&0xF000)>>12; |
41 | /* Reg818 = PHY_QueryBBReg(padapter, 0x818, bMaskDWord); */ |
42 | pDM_PSTable->initialize = 1; |
43 | } |
44 | |
45 | if (!bForceInNormal) { |
46 | if (pDM_Odm->RSSI_Min != 0xFF) { |
47 | if (pDM_PSTable->PreRFState == RF_Normal) { |
48 | if (pDM_Odm->RSSI_Min >= Rssi_Up_bound) |
49 | pDM_PSTable->CurRFState = RF_Save; |
50 | else |
51 | pDM_PSTable->CurRFState = RF_Normal; |
52 | } else { |
53 | if (pDM_Odm->RSSI_Min <= Rssi_Low_bound) |
54 | pDM_PSTable->CurRFState = RF_Normal; |
55 | else |
56 | pDM_PSTable->CurRFState = RF_Save; |
57 | } |
58 | } else |
59 | pDM_PSTable->CurRFState = RF_MAX; |
60 | } else |
61 | pDM_PSTable->CurRFState = RF_Normal; |
62 | |
63 | if (pDM_PSTable->PreRFState != pDM_PSTable->CurRFState) { |
64 | if (pDM_PSTable->CurRFState == RF_Save) { |
65 | PHY_SetBBReg(pDM_Odm->Adapter, 0x874, 0x1C0000, 0x2); /* Reg874[20:18]=3'b010 */ |
66 | PHY_SetBBReg(pDM_Odm->Adapter, 0xc70, BIT3, 0); /* RegC70[3]= 1'b0 */ |
67 | PHY_SetBBReg(pDM_Odm->Adapter, 0x85c, 0xFF000000, 0x63); /* Reg85C[31:24]= 0x63 */ |
68 | PHY_SetBBReg(pDM_Odm->Adapter, 0x874, 0xC000, 0x2); /* Reg874[15:14]=2'b10 */ |
69 | PHY_SetBBReg(pDM_Odm->Adapter, 0xa74, 0xF000, 0x3); /* RegA75[7:4]= 0x3 */ |
70 | PHY_SetBBReg(pDM_Odm->Adapter, 0x818, BIT28, 0x0); /* Reg818[28]= 1'b0 */ |
71 | PHY_SetBBReg(pDM_Odm->Adapter, 0x818, BIT28, 0x1); /* Reg818[28]= 1'b1 */ |
72 | } else { |
73 | PHY_SetBBReg(pDM_Odm->Adapter, 0x874, 0x1CC000, pDM_PSTable->Reg874); |
74 | PHY_SetBBReg(pDM_Odm->Adapter, 0xc70, BIT3, pDM_PSTable->RegC70); |
75 | PHY_SetBBReg(pDM_Odm->Adapter, 0x85c, 0xFF000000, pDM_PSTable->Reg85C); |
76 | PHY_SetBBReg(pDM_Odm->Adapter, 0xa74, 0xF000, pDM_PSTable->RegA74); |
77 | PHY_SetBBReg(pDM_Odm->Adapter, 0x818, BIT28, 0x0); |
78 | } |
79 | pDM_PSTable->PreRFState = pDM_PSTable->CurRFState; |
80 | } |
81 | } |
82 | |