8723BU: Update 8723BU wifi driver to version v4.3.16_14189.20150519_BTCOEX2015119...
[firefly-linux-kernel-4.4.55.git] / drivers / net / wireless / rockchip_wlan / rtl8723bu / hal / OUTSRC / phydm_PowerTracking.c
1 /******************************************************************************
2  *
3  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
4  *                                        
5  * This program is free software; you can redistribute it and/or modify it
6  * under the terms of version 2 of the GNU General Public License as
7  * published by the Free Software Foundation.
8  *
9  * This program is distributed in the hope that it will be useful, but WITHOUT
10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12  * more details.
13  *
14  * You should have received a copy of the GNU General Public License along with
15  * this program; if not, write to the Free Software Foundation, Inc.,
16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
17  *
18  *
19  ******************************************************************************/
20
21 /*============================================================  */
22 /* include files                                                                                                */
23 /*============================================================  */
24 #include "Mp_Precomp.h"
25 #include "phydm_precomp.h"
26
27 //============================================================
28 // Global var
29 //============================================================
30
31 u4Byte  OFDMSwingTable[OFDM_TABLE_SIZE] = {
32         0x7f8001fe,     // 0, +6.0dB
33         0x788001e2,     // 1, +5.5dB
34         0x71c001c7,     // 2, +5.0dB
35         0x6b8001ae,     // 3, +4.5dB
36         0x65400195,     // 4, +4.0dB
37         0x5fc0017f,     // 5, +3.5dB
38         0x5a400169,     // 6, +3.0dB
39         0x55400155,     // 7, +2.5dB
40         0x50800142,     // 8, +2.0dB
41         0x4c000130,     // 9, +1.5dB
42         0x47c0011f,     // 10, +1.0dB
43         0x43c0010f,     // 11, +0.5dB
44         0x40000100,     // 12, +0dB
45         0x3c8000f2,     // 13, -0.5dB
46         0x390000e4,     // 14, -1.0dB
47         0x35c000d7,     // 15, -1.5dB
48         0x32c000cb,     // 16, -2.0dB
49         0x300000c0,     // 17, -2.5dB
50         0x2d4000b5,     // 18, -3.0dB
51         0x2ac000ab,     // 19, -3.5dB
52         0x288000a2,     // 20, -4.0dB
53         0x26000098,     // 21, -4.5dB
54         0x24000090,     // 22, -5.0dB
55         0x22000088,     // 23, -5.5dB
56         0x20000080,     // 24, -6.0dB
57         0x1e400079,     // 25, -6.5dB
58         0x1c800072,     // 26, -7.0dB
59         0x1b00006c,     // 27. -7.5dB
60         0x19800066,     // 28, -8.0dB
61         0x18000060,     // 29, -8.5dB
62         0x16c0005b,     // 30, -9.0dB
63         0x15800056,     // 31, -9.5dB
64         0x14400051,     // 32, -10.0dB
65         0x1300004c,     // 33, -10.5dB
66         0x12000048,     // 34, -11.0dB
67         0x11000044,     // 35, -11.5dB
68         0x10000040,     // 36, -12.0dB
69 };
70
71 u1Byte  CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = {
72         {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04},       // 0, +0dB
73         {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04},       // 1, -0.5dB
74         {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03},       // 2, -1.0dB
75         {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03},       // 3, -1.5dB
76         {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03},       // 4, -2.0dB 
77         {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03},       // 5, -2.5dB
78         {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03},       // 6, -3.0dB
79         {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03},       // 7, -3.5dB
80         {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02},       // 8, -4.0dB 
81         {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02},       // 9, -4.5dB
82         {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02},       // 10, -5.0dB 
83         {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02},       // 11, -5.5dB
84         {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02},       // 12, -6.0dB <== default
85         {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02},       // 13, -6.5dB
86         {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02},       // 14, -7.0dB 
87         {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02},       // 15, -7.5dB
88         {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01},       // 16, -8.0dB 
89         {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02},       // 17, -8.5dB
90         {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01},       // 18, -9.0dB 
91         {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01},       // 19, -9.5dB
92         {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01},       // 20, -10.0dB
93         {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01},       // 21, -10.5dB
94         {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01},       // 22, -11.0dB
95         {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01},       // 23, -11.5dB
96         {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01},       // 24, -12.0dB
97         {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01},       // 25, -12.5dB
98         {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01},       // 26, -13.0dB
99         {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01},       // 27, -13.5dB
100         {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01},       // 28, -14.0dB
101         {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01},       // 29, -14.5dB
102         {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01},       // 30, -15.0dB
103         {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01},       // 31, -15.5dB
104         {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}        // 32, -16.0dB
105 };
106
107
108 u1Byte  CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = {
109         {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00},       // 0, +0dB  
110         {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00},       // 1, -0.5dB 
111         {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00},       // 2, -1.0dB  
112         {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00},       // 3, -1.5dB
113         {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00},       // 4, -2.0dB  
114         {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00},       // 5, -2.5dB
115         {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00},       // 6, -3.0dB  
116         {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00},       // 7, -3.5dB  
117         {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00},       // 8, -4.0dB  
118         {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00},       // 9, -4.5dB
119         {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00},       // 10, -5.0dB  
120         {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00},       // 11, -5.5dB
121         {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00},       // 12, -6.0dB  <== default
122         {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00},       // 13, -6.5dB 
123         {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00},       // 14, -7.0dB  
124         {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00},       // 15, -7.5dB
125         {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00},       // 16, -8.0dB  
126         {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00},       // 17, -8.5dB
127         {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00},       // 18, -9.0dB  
128         {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00},       // 19, -9.5dB
129         {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00},       // 20, -10.0dB
130         {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00},       // 21, -10.5dB
131         {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00},       // 22, -11.0dB
132         {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00},       // 23, -11.5dB
133         {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00},       // 24, -12.0dB
134         {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00},       // 25, -12.5dB
135         {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00},       // 26, -13.0dB
136         {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00},       // 27, -13.5dB
137         {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00},       // 28, -14.0dB
138         {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00},       // 29, -14.5dB
139         {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00},       // 30, -15.0dB
140         {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00},       // 31, -15.5dB
141         {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}        // 32, -16.0dB
142 };
143
144
145 u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE] = {
146         0x0b40002d, // 0,  -15.0dB      
147         0x0c000030, // 1,  -14.5dB
148         0x0cc00033, // 2,  -14.0dB
149         0x0d800036, // 3,  -13.5dB
150         0x0e400039, // 4,  -13.0dB    
151         0x0f00003c, // 5,  -12.5dB
152         0x10000040, // 6,  -12.0dB
153         0x11000044, // 7,  -11.5dB
154         0x12000048, // 8,  -11.0dB
155         0x1300004c, // 9,  -10.5dB
156         0x14400051, // 10, -10.0dB
157         0x15800056, // 11, -9.5dB
158         0x16c0005b, // 12, -9.0dB
159         0x18000060, // 13, -8.5dB
160         0x19800066, // 14, -8.0dB
161         0x1b00006c, // 15, -7.5dB
162         0x1c800072, // 16, -7.0dB
163         0x1e400079, // 17, -6.5dB
164         0x20000080, // 18, -6.0dB
165         0x22000088, // 19, -5.5dB
166         0x24000090, // 20, -5.0dB
167         0x26000098, // 21, -4.5dB
168         0x288000a2, // 22, -4.0dB
169         0x2ac000ab, // 23, -3.5dB
170         0x2d4000b5, // 24, -3.0dB
171         0x300000c0, // 25, -2.5dB
172         0x32c000cb, // 26, -2.0dB
173         0x35c000d7, // 27, -1.5dB
174         0x390000e4, // 28, -1.0dB
175         0x3c8000f2, // 29, -0.5dB
176         0x40000100, // 30, +0dB
177         0x43c0010f, // 31, +0.5dB
178         0x47c0011f, // 32, +1.0dB
179         0x4c000130, // 33, +1.5dB
180         0x50800142, // 34, +2.0dB
181         0x55400155, // 35, +2.5dB
182         0x5a400169, // 36, +3.0dB
183         0x5fc0017f, // 37, +3.5dB
184         0x65400195, // 38, +4.0dB
185         0x6b8001ae, // 39, +4.5dB
186         0x71c001c7, // 40, +5.0dB
187         0x788001e2, // 41, +5.5dB
188         0x7f8001fe  // 42, +6.0dB
189 };               
190
191
192 u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = {
193         {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01},       //  0, -16.0dB
194         {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01},       //  1, -15.5dB
195         {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01},       //  2, -15.0dB
196         {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01},       //  3, -14.5dB
197         {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01},       //  4, -14.0dB
198         {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01},       //  5, -13.5dB
199         {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01},       //  6, -13.0dB
200         {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01},       //  7, -12.5dB
201         {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01},       //  8, -12.0dB
202         {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01},       //  9, -11.5dB
203         {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01},       // 10, -11.0dB
204         {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01},       // 11, -10.5dB
205         {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01},       // 12, -10.0dB
206         {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01},       // 13, -9.5dB
207         {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01},       // 14, -9.0dB 
208         {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02},       // 15, -8.5dB
209         {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01},       // 16, -8.0dB 
210         {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02},       // 17, -7.5dB
211         {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02},       // 18, -7.0dB 
212         {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02},       // 19, -6.5dB
213     {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02},   // 20, -6.0dB 
214         {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02},       // 21, -5.5dB
215         {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02},       // 22, -5.0dB 
216         {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02},       // 23, -4.5dB
217         {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02},       // 24, -4.0dB 
218         {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03},       // 25, -3.5dB
219         {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03},       // 26, -3.0dB
220         {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03},       // 27, -2.5dB
221         {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03},       // 28, -2.0dB 
222         {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03},       // 29, -1.5dB
223         {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03},       // 30, -1.0dB
224         {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04},       // 31, -0.5dB
225         {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}        // 32, +0dB
226 };                                                                  
227
228
229 u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= {
230         {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00},       //  0, -16.0dB
231         {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00},       //  1, -15.5dB
232         {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00},       //  2, -15.0dB
233         {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00},       //  3, -14.5dB
234         {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00},       //  4, -14.0dB
235         {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00},       //  5, -13.5dB
236         {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00},       //  6, -13.0dB
237         {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00},       //  7, -12.5dB
238         {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00},       //  8, -12.0dB
239         {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00},       //  9, -11.5dB
240         {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00},       // 10, -11.0dB
241         {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00},       // 11, -10.5dB
242         {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00},       // 12, -10.0dB
243         {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00},       // 13, -9.5dB
244         {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00},       // 14, -9.0dB  
245         {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00},       // 15, -8.5dB
246         {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00},       // 16, -8.0dB  
247         {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00},       // 17, -7.5dB
248         {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00},       // 18, -7.0dB  
249         {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00},       // 19, -6.5dB 
250         {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00},       // 20, -6.0dB  
251         {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00},       // 21, -5.5dB
252         {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00},       // 22, -5.0dB  
253         {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00},       // 23, -4.5dB
254         {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00},       // 24, -4.0dB  
255         {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00},       // 25, -3.5dB  
256         {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00},       // 26, -3.0dB  
257         {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00},       // 27, -2.5dB
258         {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00},       // 28, -2.0dB  
259         {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00},       // 29, -1.5dB
260         {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00},       // 30, -1.0dB  
261         {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00},       // 31, -0.5dB 
262         {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}        // 32, +0dB     
263 };
264
265 u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] =
266 {
267         0x081, // 0,  -12.0dB
268         0x088, // 1,  -11.5dB
269         0x090, // 2,  -11.0dB
270         0x099, // 3,  -10.5dB
271         0x0A2, // 4,  -10.0dB
272         0x0AC, // 5,  -9.5dB
273         0x0B6, // 6,  -9.0dB
274         0x0C0, // 7,  -8.5dB
275         0x0CC, // 8,  -8.0dB
276         0x0D8, // 9,  -7.5dB
277         0x0E5, // 10, -7.0dB
278         0x0F2, // 11, -6.5dB
279         0x101, // 12, -6.0dB
280         0x110, // 13, -5.5dB
281         0x120, // 14, -5.0dB
282         0x131, // 15, -4.5dB
283         0x143, // 16, -4.0dB
284         0x156, // 17, -3.5dB
285         0x16A, // 18, -3.0dB
286         0x180, // 19, -2.5dB
287         0x197, // 20, -2.0dB
288         0x1AF, // 21, -1.5dB
289         0x1C8, // 22, -1.0dB
290         0x1E3, // 23, -0.5dB
291         0x200, // 24, +0  dB
292         0x21E, // 25, +0.5dB
293         0x23E, // 26, +1.0dB
294         0x261, // 27, +1.5dB
295         0x285, // 28, +2.0dB
296         0x2AB, // 29, +2.5dB
297         0x2D3, // 30, +3.0dB
298         0x2FE, // 31, +3.5dB
299         0x32B, // 32, +4.0dB
300         0x35C, // 33, +4.5dB
301         0x38E, // 34, +5.0dB
302         0x3C4, // 35, +5.5dB
303         0x3FE  // 36, +6.0dB    
304 };
305
306 #ifdef AP_BUILD_WORKAROUND
307
308 unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = {
309         /*  +6.0dB */ 0x7f8001fe,
310         /*  +5.5dB */ 0x788001e2,
311         /*  +5.0dB */ 0x71c001c7,
312         /*  +4.5dB */ 0x6b8001ae,
313         /*  +4.0dB */ 0x65400195,
314         /*  +3.5dB */ 0x5fc0017f,
315         /*  +3.0dB */ 0x5a400169,
316         /*  +2.5dB */ 0x55400155,
317         /*  +2.0dB */ 0x50800142,
318         /*  +1.5dB */ 0x4c000130,
319         /*  +1.0dB */ 0x47c0011f,
320         /*  +0.5dB */ 0x43c0010f,
321         /*   0.0dB */ 0x40000100,
322         /*  -0.5dB */ 0x3c8000f2,
323         /*  -1.0dB */ 0x390000e4,
324         /*  -1.5dB */ 0x35c000d7,
325         /*  -2.0dB */ 0x32c000cb,
326         /*  -2.5dB */ 0x300000c0,
327         /*  -3.0dB */ 0x2d4000b5,
328         /*  -3.5dB */ 0x2ac000ab,
329         /*  -4.0dB */ 0x288000a2,
330         /*  -4.5dB */ 0x26000098,
331         /*  -5.0dB */ 0x24000090,
332         /*  -5.5dB */ 0x22000088,
333         /*  -6.0dB */ 0x20000080,
334         /*  -6.5dB */ 0x1a00006c,
335         /*  -7.0dB */ 0x1c800072,
336         /*  -7.5dB */ 0x18000060,
337         /*  -8.0dB */ 0x19800066,
338         /*  -8.5dB */ 0x15800056,
339         /*  -9.0dB */ 0x26c0005b,
340         /*  -9.5dB */ 0x14400051,
341         /* -10.0dB */ 0x24400051,
342         /* -10.5dB */ 0x1300004c,
343         /* -11.0dB */ 0x12000048,
344         /* -11.5dB */ 0x11000044,
345         /* -12.0dB */ 0x10000040
346 };
347 #endif
348
349
350
351 VOID
352 odm_TXPowerTrackingInit(
353         IN      PVOID   pDM_VOID 
354         )
355 {
356         PDM_ODM_T               pDM_Odm = (PDM_ODM_T)pDM_VOID;
357 #if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL))
358         if(!(pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_IC_11N_SERIES)))
359                 return;
360 #endif
361
362         odm_TXPowerTrackingThermalMeterInit(pDM_Odm);
363 }       
364
365 u1Byte 
366 getSwingIndex(
367         IN      PVOID   pDM_VOID 
368         )
369 {
370         PDM_ODM_T               pDM_Odm = (PDM_ODM_T)pDM_VOID;
371         PADAPTER                Adapter = pDM_Odm->Adapter;
372         HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
373         u1Byte                  i = 0;
374         u4Byte                  bbSwing;
375         u4Byte                  swingTableSize;
376         pu4Byte                         pSwingTable;
377
378         if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B ||
379                 pDM_Odm->SupportICType == ODM_RTL8192E) 
380         {
381                 bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000);
382
383                 pSwingTable = OFDMSwingTable_New;
384                 swingTableSize = OFDM_TABLE_SIZE;
385         } else {
386 #if ((RTL8812A_SUPPORT==1)||(RTL8821A_SUPPORT==1))
387                 if (pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8821)
388                 {
389                         bbSwing = PHY_GetTxBBSwing_8812A(Adapter, pHalData->CurrentBandType, ODM_RF_PATH_A);
390                         pSwingTable = TxScalingTable_Jaguar;
391                         swingTableSize = TXSCALE_TABLE_SIZE;
392                 }
393                 else
394 #endif
395                 {
396                         bbSwing = 0;
397                         pSwingTable = OFDMSwingTable;
398                         swingTableSize = OFDM_TABLE_SIZE;
399                 }
400         }
401
402         for (i = 0; i < swingTableSize; ++i) {
403                 u4Byte tableValue = pSwingTable[i];
404                 
405                 if (tableValue >= 0x100000 )
406                         tableValue >>= 22;
407                 if (bbSwing == tableValue)
408                         break;
409         }
410         return i;
411 }
412
413 VOID
414 odm_TXPowerTrackingThermalMeterInit(
415         IN      PVOID   pDM_VOID
416         )
417 {
418         PDM_ODM_T               pDM_Odm = (PDM_ODM_T)pDM_VOID;
419         u1Byte defaultSwingIndex = getSwingIndex(pDM_Odm);
420         u1Byte                  p = 0;
421         PODM_RF_CAL_T   pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo);
422 #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
423         PADAPTER                Adapter = pDM_Odm->Adapter;
424         HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
425
426         if(pDM_Odm->mp_mode == FALSE)
427                 pHalData->TxPowerTrackControl = TRUE;
428 #elif (DM_ODM_SUPPORT_TYPE == ODM_CE)
429         PADAPTER                Adapter = pDM_Odm->Adapter;
430         HAL_DATA_TYPE   *pHalData = GET_HAL_DATA(Adapter);
431
432         pRFCalibrateInfo->bTXPowerTracking = _TRUE;
433         pRFCalibrateInfo->TXPowercount = 0;
434         pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE;
435
436         if(pDM_Odm->mp_mode == FALSE)
437                 pRFCalibrateInfo->TxPowerTrackControl = _TRUE;
438         else
439                 pRFCalibrateInfo->TxPowerTrackControl = _FALSE; 
440
441         if(pDM_Odm->mp_mode == FALSE)
442                 pRFCalibrateInfo->TxPowerTrackControl = _TRUE;
443
444
445         MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pRFCalibrateInfo->TxPowerTrackControl);
446         
447 #elif (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL))
448         #ifdef RTL8188E_SUPPORT
449         {
450                 pRFCalibrateInfo->bTXPowerTracking = _TRUE;
451                 pRFCalibrateInfo->TXPowercount = 0;
452                 pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE;
453                 pRFCalibrateInfo->TxPowerTrackControl = _TRUE;
454         }
455         #endif
456 #endif
457
458         //pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = TRUE;
459         pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter;
460         pRFCalibrateInfo->ThermalValue_IQK = pHalData->EEPROMThermalMeter;
461         pRFCalibrateInfo->ThermalValue_LCK = pHalData->EEPROMThermalMeter;      
462
463         // The index of "0 dB" in SwingTable.
464         if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B ||
465                 pDM_Odm->SupportICType == ODM_RTL8192E) 
466         {
467                 pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex;
468                 pRFCalibrateInfo->DefaultCckIndex = 20; 
469         }
470         else
471         {
472                 pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= TXSCALE_TABLE_SIZE) ? 24 : defaultSwingIndex;
473                 pRFCalibrateInfo->DefaultCckIndex = 24; 
474         }
475
476         pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex;
477         pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->DefaultCckIndex;
478         
479         for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p)
480         {
481                 pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex;           
482                 pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex;           
483                 pRFCalibrateInfo->DeltaPowerIndex[p] = 0;
484                 pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0;
485                 pRFCalibrateInfo->PowerIndexOffset[p] = 0;
486         }
487
488 }
489
490
491 VOID
492 ODM_TXPowerTrackingCheck(
493         IN      PVOID   pDM_VOID
494         )
495 {
496         /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate
497         at the same time. In the stage2/3, we need to prive universal interface and merge all
498         HW dynamic mechanism. */
499         PDM_ODM_T               pDM_Odm = (PDM_ODM_T)pDM_VOID;
500         switch  (pDM_Odm->SupportPlatform)
501         {
502                 case    ODM_WIN:
503                         odm_TXPowerTrackingCheckMP(pDM_Odm);
504                         break;
505
506                 case    ODM_CE:
507                         odm_TXPowerTrackingCheckCE(pDM_Odm);
508                         break;
509
510                 case    ODM_AP:
511                         odm_TXPowerTrackingCheckAP(pDM_Odm);            
512                         break;          
513
514                 case    ODM_ADSL:
515                         //odm_DIGAP(pDM_Odm);
516                         break;  
517         }
518
519 }
520
521 VOID
522 odm_TXPowerTrackingCheckCE(
523         IN      PVOID   pDM_VOID
524         )
525 {
526         PDM_ODM_T               pDM_Odm = (PDM_ODM_T)pDM_VOID;
527 #if (DM_ODM_SUPPORT_TYPE == ODM_CE)
528         PADAPTER        Adapter = pDM_Odm->Adapter;
529         #if( (RTL8192C_SUPPORT==1) ||  (RTL8723A_SUPPORT==1) )
530         if(IS_HARDWARE_TYPE_8192C(Adapter)){
531                 rtl8192c_odm_CheckTXPowerTracking(Adapter);
532                 return;
533         }
534         #endif
535
536         #if (RTL8192D_SUPPORT==1) 
537         if(IS_HARDWARE_TYPE_8192D(Adapter)){    
538                 #if (RTL8192D_EASY_SMART_CONCURRENT == 1)
539                 if(!Adapter->bSlaveOfDMSP)
540                 #endif
541                         rtl8192d_odm_CheckTXPowerTracking(Adapter);
542                 return; 
543         }
544         #endif
545
546         #if (((RTL8188E_SUPPORT == 1) ||  (RTL8812A_SUPPORT == 1) ||  (RTL8821A_SUPPORT == 1) ||  (RTL8192E_SUPPORT == 1)  ||  (RTL8723B_SUPPORT == 1)  ||  (RTL8814A_SUPPORT == 1)))
547         if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK))
548                 return;
549
550         if(!pDM_Odm->RFCalibrateInfo.TM_Trigger)                //at least delay 1 sec
551         {
552                 //pHalData->TxPowerCheckCnt++;  //cosa add for debug
553                 if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) || IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter))
554                         ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_NEW, (BIT17 | BIT16), 0x03);
555                 else
556                         ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_OLD, bRFRegOffsetMask, 0x60);
557                 
558                 //DBG_871X("Trigger Thermal Meter!!\n");
559                 
560                 pDM_Odm->RFCalibrateInfo.TM_Trigger = 1;
561                 return;
562         }
563         else
564         {
565                 //DBG_871X("Schedule TxPowerTracking direct call!!\n");
566                 ODM_TXPowerTrackingCallback_ThermalMeter(Adapter);
567                 pDM_Odm->RFCalibrateInfo.TM_Trigger = 0;
568         }
569         #endif
570 #endif  
571 }
572
573 VOID
574 odm_TXPowerTrackingCheckMP(
575         IN      PVOID   pDM_VOID
576         )
577 {
578         PDM_ODM_T               pDM_Odm = (PDM_ODM_T)pDM_VOID;
579 #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
580         PADAPTER        Adapter = pDM_Odm->Adapter;
581
582         if (ODM_CheckPowerStatus(Adapter) == FALSE) 
583         {
584                 RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("===>ODM_CheckPowerStatus() return FALSE\n"));
585                 return;
586         }
587
588         if(IS_HARDWARE_TYPE_8723A(Adapter))
589                 return;
590
591         if(!Adapter->bSlaveOfDMSP || Adapter->DualMacSmartConcurrent == FALSE)
592                 odm_TXPowerTrackingThermalMeterCheck(Adapter);
593         else {
594                 RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("!Adapter->bSlaveOfDMSP || Adapter->DualMacSmartConcurrent == FALSE\n"));
595         }
596 #endif
597         
598 }
599
600
601 VOID
602 odm_TXPowerTrackingCheckAP(
603         IN      PVOID   pDM_VOID
604         )
605 {
606         PDM_ODM_T               pDM_Odm = (PDM_ODM_T)pDM_VOID;
607 #if (DM_ODM_SUPPORT_TYPE == ODM_AP)
608         prtl8192cd_priv priv            = pDM_Odm->priv;
609
610         if ( (priv->pmib->dot11RFEntry.ther) && ((priv->up_time % priv->pshare->rf_ft_var.tpt_period) == 0)){
611 #ifdef CONFIG_RTL_92D_SUPPORT
612                 if (GET_CHIP_VER(priv)==VERSION_8192D){
613                         tx_power_tracking_92D(priv);
614                 } else 
615 #endif
616                 {
617 #ifdef CONFIG_RTL_92C_SUPPORT                   
618                         tx_power_tracking(priv);
619 #endif
620                 }
621         }
622 #endif  
623
624 }
625
626 #if (DM_ODM_SUPPORT_TYPE == ODM_WIN)
627 VOID
628 odm_TXPowerTrackingThermalMeterCheck(
629         IN      PADAPTER                Adapter
630         )
631 {
632 #ifndef AP_BUILD_WORKAROUND
633         static u1Byte                   TM_Trigger = 0;
634
635         if(!(GET_HAL_DATA(Adapter)->DM_OutSrc.SupportAbility & ODM_RF_TX_PWR_TRACK))
636         {
637                 RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,
638                         ("===>odm_TXPowerTrackingThermalMeterCheck(),pMgntInfo->bTXPowerTracking is FALSE, return!!\n"));
639                 return;
640         }
641
642         if(!TM_Trigger)         //at least delay 1 sec
643         {
644                 if(IS_HARDWARE_TYPE_8192D(Adapter))
645                         PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER_92D, BIT17 | BIT16, 0x03);
646                 else if(IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) ||
647                             IS_HARDWARE_TYPE_8723B(Adapter))
648                         PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03);
649                 else
650                         PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60);
651                 
652                 RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger Thermal Meter!!\n"));
653                 
654                 TM_Trigger = 1;
655                 return;
656         }
657         else
658         {
659                 RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n"));           
660                 odm_TXPowerTrackingDirectCall(Adapter); //Using direct call is instead, added by Roger, 2009.06.18.
661                 TM_Trigger = 0;
662         }
663 #endif
664 }
665 #endif
666
667