Merge branch 'develop-3.10' of ssh://10.10.10.29/rk/kernel into xxh_develop
[firefly-linux-kernel-4.4.55.git] / drivers / net / wireless / rockchip_wlan / rtl8723bu / hal / OUTSRC / odm_DynamicBBPowerSaving.c
1 /******************************************************************************\r
2  *\r
3  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.\r
4  *                                        \r
5  * This program is free software; you can redistribute it and/or modify it\r
6  * under the terms of version 2 of the GNU General Public License as\r
7  * published by the Free Software Foundation.\r
8  *\r
9  * This program is distributed in the hope that it will be useful, but WITHOUT\r
10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or\r
11  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for\r
12  * more details.\r
13  *\r
14  * You should have received a copy of the GNU General Public License along with\r
15  * this program; if not, write to the Free Software Foundation, Inc.,\r
16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA\r
17  *\r
18  *\r
19  ******************************************************************************/\r
20 \r
21 //============================================================\r
22 // include files\r
23 //============================================================\r
24 \r
25 #include "odm_precomp.h"\r
26 \r
27 VOID \r
28 odm_DynamicBBPowerSavingInit(
29         IN              PVOID                                   pDM_VOID\r
30         )
31 {
32         PDM_ODM_T               pDM_Odm = (PDM_ODM_T)pDM_VOID;\r
33         pPS_T   pDM_PSTable = &pDM_Odm->DM_PSTable;\r
34
35         pDM_PSTable->PreCCAState = CCA_MAX;
36         pDM_PSTable->CurCCAState = CCA_MAX;
37         pDM_PSTable->PreRFState = RF_MAX;
38         pDM_PSTable->CurRFState = RF_MAX;
39         pDM_PSTable->Rssi_val_min = 0;
40         pDM_PSTable->initialize = 0;
41 }
42
43
44 VOID
45 odm_DynamicBBPowerSaving(
46         IN              PVOID                                   pDM_VOID\r
47         )
48 {       
49         PDM_ODM_T               pDM_Odm = (PDM_ODM_T)pDM_VOID;\r
50 #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE))\r
51
52         if (pDM_Odm->SupportICType != ODM_RTL8723A)
53                 return;
54         if(!(pDM_Odm->SupportAbility & ODM_BB_PWR_SAVE))
55                 return;
56         if(!(pDM_Odm->SupportPlatform & (ODM_WIN|ODM_CE)))
57                 return;
58         
59         //1 2.Power Saving for 92C
60         if((pDM_Odm->SupportICType == ODM_RTL8192C) &&(pDM_Odm->RFType == ODM_2T2R))
61         {
62                 odm_1R_CCA(pDM_Odm);
63         }
64         
65         // 20100628 Joseph: Turn off BB power save for 88CE because it makesthroughput unstable.
66         // 20100831 Joseph: Turn ON BB power save again after modifying AGC delay from 900ns ot 600ns.
67         //1 3.Power Saving for 88C
68         else
69         {
70                 ODM_RF_Saving(pDM_Odm, FALSE);
71         }
72 #endif  // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
73         
74 }
75
76 VOID
77 odm_1R_CCA(
78         IN              PVOID                                   pDM_VOID\r
79         )
80 {
81         PDM_ODM_T               pDM_Odm = (PDM_ODM_T)pDM_VOID;\r
82         pPS_T   pDM_PSTable = &pDM_Odm->DM_PSTable;\r
83
84         if(pDM_Odm->RSSI_Min!= 0xFF)
85         {
86                  
87                 if(pDM_PSTable->PreCCAState == CCA_2R)
88                 {
89                         if(pDM_Odm->RSSI_Min >= 35)
90                                 pDM_PSTable->CurCCAState = CCA_1R;
91                         else
92                                 pDM_PSTable->CurCCAState = CCA_2R;
93                         
94                 }
95                 else{
96                         if(pDM_Odm->RSSI_Min <= 30)
97                                 pDM_PSTable->CurCCAState = CCA_2R;
98                         else
99                                 pDM_PSTable->CurCCAState = CCA_1R;
100                 }
101         }
102         else{
103                 pDM_PSTable->CurCCAState=CCA_MAX;
104         }
105         
106         if(pDM_PSTable->PreCCAState != pDM_PSTable->CurCCAState)
107         {
108                 if(pDM_PSTable->CurCCAState == CCA_1R)
109                 {
110                         if(  pDM_Odm->RFType ==ODM_2T2R )
111                         {
112                                 ODM_SetBBReg(pDM_Odm, 0xc04  , bMaskByte0, 0x13);
113                                 //PHY_SetBBReg(pAdapter, 0xe70, bMaskByte3, 0x20);
114                         }
115                         else
116                         {
117                                 ODM_SetBBReg(pDM_Odm, 0xc04  , bMaskByte0, 0x23);
118                                 //PHY_SetBBReg(pAdapter, 0xe70, 0x7fc00000, 0x10c); // Set RegE70[30:22] = 9b'100001100
119                         }
120                 }
121                 else
122                 {
123                         ODM_SetBBReg(pDM_Odm, 0xc04  , bMaskByte0, 0x33);
124                         //PHY_SetBBReg(pAdapter,0xe70, bMaskByte3, 0x63);
125                 }
126                 pDM_PSTable->PreCCAState = pDM_PSTable->CurCCAState;
127         }
128 }
129
130 void
131 ODM_RF_Saving(
132         IN              PVOID                                   pDM_VOID,\r
133         IN      u1Byte          bForceInNormal 
134         )
135 {
136         PDM_ODM_T               pDM_Odm = (PDM_ODM_T)pDM_VOID;\r
137 #if (DM_ODM_SUPPORT_TYPE != ODM_AP)\r
138         pPS_T   pDM_PSTable = &pDM_Odm->DM_PSTable;
139         u1Byte  Rssi_Up_bound = 30 ;
140         u1Byte  Rssi_Low_bound = 25;
141 #if (DM_ODM_SUPPORT_TYPE == ODM_CE)\r
142         if(pDM_Odm->PatchID == 40 ) //RT_CID_819x_FUNAI_TV
143         {
144                 Rssi_Up_bound = 50 ;
145                 Rssi_Low_bound = 45;
146         }
147 #endif\r
148         if(pDM_PSTable->initialize == 0){
149                 
150                 pDM_PSTable->Reg874 = (ODM_GetBBReg(pDM_Odm, 0x874, bMaskDWord)&0x1CC000)>>14;
151                 pDM_PSTable->RegC70 = (ODM_GetBBReg(pDM_Odm, 0xc70, bMaskDWord)&BIT3)>>3;
152                 pDM_PSTable->Reg85C = (ODM_GetBBReg(pDM_Odm, 0x85c, bMaskDWord)&0xFF000000)>>24;
153                 pDM_PSTable->RegA74 = (ODM_GetBBReg(pDM_Odm, 0xa74, bMaskDWord)&0xF000)>>12;
154                 //Reg818 = PHY_QueryBBReg(pAdapter, 0x818, bMaskDWord);
155                 pDM_PSTable->initialize = 1;
156         }
157
158         if(!bForceInNormal)
159         {
160                 if(pDM_Odm->RSSI_Min != 0xFF)
161                 {                        
162                         if(pDM_PSTable->PreRFState == RF_Normal)
163                         {
164                                 if(pDM_Odm->RSSI_Min >= Rssi_Up_bound)
165                                         pDM_PSTable->CurRFState = RF_Save;
166                                 else
167                                         pDM_PSTable->CurRFState = RF_Normal;
168                         }
169                         else{
170                                 if(pDM_Odm->RSSI_Min <= Rssi_Low_bound)
171                                         pDM_PSTable->CurRFState = RF_Normal;
172                                 else
173                                         pDM_PSTable->CurRFState = RF_Save;
174                         }
175                 }
176                 else
177                         pDM_PSTable->CurRFState=RF_MAX;
178         }
179         else
180         {
181                 pDM_PSTable->CurRFState = RF_Normal;
182         }
183         
184         if(pDM_PSTable->PreRFState != pDM_PSTable->CurRFState)
185         {
186                 if(pDM_PSTable->CurRFState == RF_Save)
187                 {
188                         // <tynli_note> 8723 RSSI report will be wrong. Set 0x874[5]=1 when enter BB power saving mode.
189                         // Suggested by SD3 Yu-Nan. 2011.01.20.
190                         if(pDM_Odm->SupportICType == ODM_RTL8723A)
191                         {
192                                 ODM_SetBBReg(pDM_Odm, 0x874  , BIT5, 0x1); //Reg874[5]=1b'1
193                         }
194                         ODM_SetBBReg(pDM_Odm, 0x874  , 0x1C0000, 0x2); //Reg874[20:18]=3'b010
195                         ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, 0); //RegC70[3]=1'b0
196                         ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, 0x63); //Reg85C[31:24]=0x63
197                         ODM_SetBBReg(pDM_Odm, 0x874, 0xC000, 0x2); //Reg874[15:14]=2'b10
198                         ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, 0x3); //RegA75[7:4]=0x3
199                         ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x0); //Reg818[28]=1'b0
200                         ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x1); //Reg818[28]=1'b1
201                 }
202                 else
203                 {
204                         ODM_SetBBReg(pDM_Odm, 0x874  , 0x1CC000, pDM_PSTable->Reg874); 
205                         ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, pDM_PSTable->RegC70); 
206                         ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, pDM_PSTable->Reg85C);
207                         ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, pDM_PSTable->RegA74); 
208                         ODM_SetBBReg(pDM_Odm,0x818, BIT28, 0x0);  
209
210                         if(pDM_Odm->SupportICType == ODM_RTL8723A)
211                         {
212                                 ODM_SetBBReg(pDM_Odm,0x874  , BIT5, 0x0); //Reg874[5]=1b'0
213                         }
214                 }
215                 pDM_PSTable->PreRFState =pDM_PSTable->CurRFState;
216         }
217 #endif  
218 }