b43legacy: drop packets we are not able to encrypt
[linux-2.6] / drivers / net / wireless / ath5k / phy.c
1 /*
2  * PHY functions
3  *
4  * Copyright (c) 2004, 2005, 2006, 2007 Reyk Floeter <reyk@openbsd.org>
5  * Copyright (c) 2006, 2007 Nick Kossifidis <mickflemm@gmail.com>
6  * Copyright (c) 2007 Jiri Slaby <jirislaby@gmail.com>
7  *
8  * Permission to use, copy, modify, and distribute this software for any
9  * purpose with or without fee is hereby granted, provided that the above
10  * copyright notice and this permission notice appear in all copies.
11  *
12  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
13  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
14  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
15  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
16  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
18  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19  *
20  */
21
22 #include <linux/delay.h>
23
24 #include "ath5k.h"
25 #include "reg.h"
26 #include "base.h"
27
28 /* Struct to hold initial RF register values (RF Banks) */
29 struct ath5k_ini_rf {
30         u8      rf_bank;        /* check out ath5k_reg.h */
31         u16     rf_register;    /* register address */
32         u32     rf_value[5];    /* register value for different modes (above) */
33 };
34
35 /*
36  * Mode-specific RF Gain table (64bytes) for RF5111/5112
37  * (RF5110 only comes with AR5210 and only supports a/turbo a mode so initial
38  * RF Gain values are included in AR5K_AR5210_INI)
39  */
40 struct ath5k_ini_rfgain {
41         u16     rfg_register;   /* RF Gain register address */
42         u32     rfg_value[2];   /* [freq (see below)] */
43 };
44
45 struct ath5k_gain_opt {
46         u32                     go_default;
47         u32                     go_steps_count;
48         const struct ath5k_gain_opt_step        go_step[AR5K_GAIN_STEP_COUNT];
49 };
50
51 /* RF5111 mode-specific init registers */
52 static const struct ath5k_ini_rf rfregs_5111[] = {
53         { 0, 0x989c,
54         /*    mode a/XR   mode aTurbo mode b      mode g      mode gTurbo */
55             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
56         { 0, 0x989c,
57             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
58         { 0, 0x989c,
59             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
60         { 0, 0x989c,
61             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
62         { 0, 0x989c,
63             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
64         { 0, 0x989c,
65             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
66         { 0, 0x989c,
67             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
68         { 0, 0x989c,
69             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
70         { 0, 0x989c,
71             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
72         { 0, 0x989c,
73             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
74         { 0, 0x989c,
75             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
76         { 0, 0x989c,
77             { 0x00380000, 0x00380000, 0x00380000, 0x00380000, 0x00380000 } },
78         { 0, 0x989c,
79             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
80         { 0, 0x989c,
81             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
82         { 0, 0x989c,
83             { 0x00000000, 0x00000000, 0x000000c0, 0x00000080, 0x00000080 } },
84         { 0, 0x989c,
85             { 0x000400f9, 0x000400f9, 0x000400ff, 0x000400fd, 0x000400fd } },
86         { 0, 0x98d4,
87             { 0x00000000, 0x00000000, 0x00000004, 0x00000004, 0x00000004 } },
88         { 1, 0x98d4,
89             { 0x00000020, 0x00000020, 0x00000020, 0x00000020, 0x00000020 } },
90         { 2, 0x98d4,
91             { 0x00000010, 0x00000014, 0x00000010, 0x00000010, 0x00000014 } },
92         { 3, 0x98d8,
93             { 0x00601068, 0x00601068, 0x00601068, 0x00601068, 0x00601068 } },
94         { 6, 0x989c,
95             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
96         { 6, 0x989c,
97             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
98         { 6, 0x989c,
99             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
100         { 6, 0x989c,
101             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
102         { 6, 0x989c,
103             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
104         { 6, 0x989c,
105             { 0x10000000, 0x10000000, 0x10000000, 0x10000000, 0x10000000 } },
106         { 6, 0x989c,
107             { 0x04000000, 0x04000000, 0x04000000, 0x04000000, 0x04000000 } },
108         { 6, 0x989c,
109             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
110         { 6, 0x989c,
111             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
112         { 6, 0x989c,
113             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
114         { 6, 0x989c,
115             { 0x00000000, 0x00000000, 0x0a000000, 0x00000000, 0x00000000 } },
116         { 6, 0x989c,
117             { 0x003800c0, 0x00380080, 0x023800c0, 0x003800c0, 0x003800c0 } },
118         { 6, 0x989c,
119             { 0x00020006, 0x00020006, 0x00000006, 0x00020006, 0x00020006 } },
120         { 6, 0x989c,
121             { 0x00000089, 0x00000089, 0x00000089, 0x00000089, 0x00000089 } },
122         { 6, 0x989c,
123             { 0x000000a0, 0x000000a0, 0x000000a0, 0x000000a0, 0x000000a0 } },
124         { 6, 0x989c,
125             { 0x00040007, 0x00040007, 0x00040007, 0x00040007, 0x00040007 } },
126         { 6, 0x98d4,
127             { 0x0000001a, 0x0000001a, 0x0000001a, 0x0000001a, 0x0000001a } },
128         { 7, 0x989c,
129             { 0x00000040, 0x00000048, 0x00000040, 0x00000040, 0x00000040 } },
130         { 7, 0x989c,
131             { 0x00000010, 0x00000010, 0x00000010, 0x00000010, 0x00000010 } },
132         { 7, 0x989c,
133             { 0x00000008, 0x00000008, 0x00000008, 0x00000008, 0x00000008 } },
134         { 7, 0x989c,
135             { 0x0000004f, 0x0000004f, 0x0000004f, 0x0000004f, 0x0000004f } },
136         { 7, 0x989c,
137             { 0x000000f1, 0x000000f1, 0x00000061, 0x000000f1, 0x000000f1 } },
138         { 7, 0x989c,
139             { 0x0000904f, 0x0000904f, 0x0000904c, 0x0000904f, 0x0000904f } },
140         { 7, 0x989c,
141             { 0x0000125a, 0x0000125a, 0x0000129a, 0x0000125a, 0x0000125a } },
142         { 7, 0x98cc,
143             { 0x0000000e, 0x0000000e, 0x0000000f, 0x0000000e, 0x0000000e } },
144 };
145
146 /* Initial RF Gain settings for RF5111 */
147 static const struct ath5k_ini_rfgain rfgain_5111[] = {
148         /*                            5Ghz      2Ghz    */
149         { AR5K_RF_GAIN(0),      { 0x000001a9, 0x00000000 } },
150         { AR5K_RF_GAIN(1),      { 0x000001e9, 0x00000040 } },
151         { AR5K_RF_GAIN(2),      { 0x00000029, 0x00000080 } },
152         { AR5K_RF_GAIN(3),      { 0x00000069, 0x00000150 } },
153         { AR5K_RF_GAIN(4),      { 0x00000199, 0x00000190 } },
154         { AR5K_RF_GAIN(5),      { 0x000001d9, 0x000001d0 } },
155         { AR5K_RF_GAIN(6),      { 0x00000019, 0x00000010 } },
156         { AR5K_RF_GAIN(7),      { 0x00000059, 0x00000044 } },
157         { AR5K_RF_GAIN(8),      { 0x00000099, 0x00000084 } },
158         { AR5K_RF_GAIN(9),      { 0x000001a5, 0x00000148 } },
159         { AR5K_RF_GAIN(10),     { 0x000001e5, 0x00000188 } },
160         { AR5K_RF_GAIN(11),     { 0x00000025, 0x000001c8 } },
161         { AR5K_RF_GAIN(12),     { 0x000001c8, 0x00000014 } },
162         { AR5K_RF_GAIN(13),     { 0x00000008, 0x00000042 } },
163         { AR5K_RF_GAIN(14),     { 0x00000048, 0x00000082 } },
164         { AR5K_RF_GAIN(15),     { 0x00000088, 0x00000178 } },
165         { AR5K_RF_GAIN(16),     { 0x00000198, 0x000001b8 } },
166         { AR5K_RF_GAIN(17),     { 0x000001d8, 0x000001f8 } },
167         { AR5K_RF_GAIN(18),     { 0x00000018, 0x00000012 } },
168         { AR5K_RF_GAIN(19),     { 0x00000058, 0x00000052 } },
169         { AR5K_RF_GAIN(20),     { 0x00000098, 0x00000092 } },
170         { AR5K_RF_GAIN(21),     { 0x000001a4, 0x0000017c } },
171         { AR5K_RF_GAIN(22),     { 0x000001e4, 0x000001bc } },
172         { AR5K_RF_GAIN(23),     { 0x00000024, 0x000001fc } },
173         { AR5K_RF_GAIN(24),     { 0x00000064, 0x0000000a } },
174         { AR5K_RF_GAIN(25),     { 0x000000a4, 0x0000004a } },
175         { AR5K_RF_GAIN(26),     { 0x000000e4, 0x0000008a } },
176         { AR5K_RF_GAIN(27),     { 0x0000010a, 0x0000015a } },
177         { AR5K_RF_GAIN(28),     { 0x0000014a, 0x0000019a } },
178         { AR5K_RF_GAIN(29),     { 0x0000018a, 0x000001da } },
179         { AR5K_RF_GAIN(30),     { 0x000001ca, 0x0000000e } },
180         { AR5K_RF_GAIN(31),     { 0x0000000a, 0x0000004e } },
181         { AR5K_RF_GAIN(32),     { 0x0000004a, 0x0000008e } },
182         { AR5K_RF_GAIN(33),     { 0x0000008a, 0x0000015e } },
183         { AR5K_RF_GAIN(34),     { 0x000001ba, 0x0000019e } },
184         { AR5K_RF_GAIN(35),     { 0x000001fa, 0x000001de } },
185         { AR5K_RF_GAIN(36),     { 0x0000003a, 0x00000009 } },
186         { AR5K_RF_GAIN(37),     { 0x0000007a, 0x00000049 } },
187         { AR5K_RF_GAIN(38),     { 0x00000186, 0x00000089 } },
188         { AR5K_RF_GAIN(39),     { 0x000001c6, 0x00000179 } },
189         { AR5K_RF_GAIN(40),     { 0x00000006, 0x000001b9 } },
190         { AR5K_RF_GAIN(41),     { 0x00000046, 0x000001f9 } },
191         { AR5K_RF_GAIN(42),     { 0x00000086, 0x00000039 } },
192         { AR5K_RF_GAIN(43),     { 0x000000c6, 0x00000079 } },
193         { AR5K_RF_GAIN(44),     { 0x000000c6, 0x000000b9 } },
194         { AR5K_RF_GAIN(45),     { 0x000000c6, 0x000001bd } },
195         { AR5K_RF_GAIN(46),     { 0x000000c6, 0x000001fd } },
196         { AR5K_RF_GAIN(47),     { 0x000000c6, 0x0000003d } },
197         { AR5K_RF_GAIN(48),     { 0x000000c6, 0x0000007d } },
198         { AR5K_RF_GAIN(49),     { 0x000000c6, 0x000000bd } },
199         { AR5K_RF_GAIN(50),     { 0x000000c6, 0x000000fd } },
200         { AR5K_RF_GAIN(51),     { 0x000000c6, 0x000000fd } },
201         { AR5K_RF_GAIN(52),     { 0x000000c6, 0x000000fd } },
202         { AR5K_RF_GAIN(53),     { 0x000000c6, 0x000000fd } },
203         { AR5K_RF_GAIN(54),     { 0x000000c6, 0x000000fd } },
204         { AR5K_RF_GAIN(55),     { 0x000000c6, 0x000000fd } },
205         { AR5K_RF_GAIN(56),     { 0x000000c6, 0x000000fd } },
206         { AR5K_RF_GAIN(57),     { 0x000000c6, 0x000000fd } },
207         { AR5K_RF_GAIN(58),     { 0x000000c6, 0x000000fd } },
208         { AR5K_RF_GAIN(59),     { 0x000000c6, 0x000000fd } },
209         { AR5K_RF_GAIN(60),     { 0x000000c6, 0x000000fd } },
210         { AR5K_RF_GAIN(61),     { 0x000000c6, 0x000000fd } },
211         { AR5K_RF_GAIN(62),     { 0x000000c6, 0x000000fd } },
212         { AR5K_RF_GAIN(63),     { 0x000000c6, 0x000000fd } },
213 };
214
215 static const struct ath5k_gain_opt rfgain_opt_5111 = {
216         4,
217         9,
218         {
219                 { { 4, 1, 1, 1 }, 6 },
220                 { { 4, 0, 1, 1 }, 4 },
221                 { { 3, 1, 1, 1 }, 3 },
222                 { { 4, 0, 0, 1 }, 1 },
223                 { { 4, 1, 1, 0 }, 0 },
224                 { { 4, 0, 1, 0 }, -2 },
225                 { { 3, 1, 1, 0 }, -3 },
226                 { { 4, 0, 0, 0 }, -4 },
227                 { { 2, 1, 1, 0 }, -6 }
228         }
229 };
230
231 /* RF5112 mode-specific init registers */
232 static const struct ath5k_ini_rf rfregs_5112[] = {
233         { 1, 0x98d4,
234         /*    mode a/XR   mode aTurbo mode b      mode g      mode gTurbo */
235             { 0x00000020, 0x00000020, 0x00000020, 0x00000020, 0x00000020 } },
236         { 2, 0x98d0,
237             { 0x03060408, 0x03070408, 0x03060408, 0x03060408, 0x03070408 } },
238         { 3, 0x98dc,
239             { 0x00a0c0c0, 0x00a0c0c0, 0x00e0c0c0, 0x00e0c0c0, 0x00e0c0c0 } },
240         { 6, 0x989c,
241             { 0x00a00000, 0x00a00000, 0x00a00000, 0x00a00000, 0x00a00000 } },
242         { 6, 0x989c,
243             { 0x000a0000, 0x000a0000, 0x000a0000, 0x000a0000, 0x000a0000 } },
244         { 6, 0x989c,
245             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
246         { 6, 0x989c,
247             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
248         { 6, 0x989c,
249             { 0x00660000, 0x00660000, 0x00660000, 0x00660000, 0x00660000 } },
250         { 6, 0x989c,
251             { 0x00db0000, 0x00db0000, 0x00db0000, 0x00db0000, 0x00db0000 } },
252         { 6, 0x989c,
253             { 0x00f10000, 0x00f10000, 0x00f10000, 0x00f10000, 0x00f10000 } },
254         { 6, 0x989c,
255             { 0x00120000, 0x00120000, 0x00120000, 0x00120000, 0x00120000 } },
256         { 6, 0x989c,
257             { 0x00120000, 0x00120000, 0x00120000, 0x00120000, 0x00120000 } },
258         { 6, 0x989c,
259             { 0x00730000, 0x00730000, 0x00730000, 0x00730000, 0x00730000 } },
260         { 6, 0x989c,
261             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
262         { 6, 0x989c,
263             { 0x000c0000, 0x000c0000, 0x000c0000, 0x000c0000, 0x000c0000 } },
264         { 6, 0x989c,
265             { 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000 } },
266         { 6, 0x989c,
267             { 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000 } },
268         { 6, 0x989c,
269             { 0x008b0000, 0x008b0000, 0x008b0000, 0x008b0000, 0x008b0000 } },
270         { 6, 0x989c,
271             { 0x00600000, 0x00600000, 0x00600000, 0x00600000, 0x00600000 } },
272         { 6, 0x989c,
273             { 0x000c0000, 0x000c0000, 0x000c0000, 0x000c0000, 0x000c0000 } },
274         { 6, 0x989c,
275             { 0x00840000, 0x00840000, 0x00840000, 0x00840000, 0x00840000 } },
276         { 6, 0x989c,
277             { 0x00640000, 0x00640000, 0x00640000, 0x00640000, 0x00640000 } },
278         { 6, 0x989c,
279             { 0x00200000, 0x00200000, 0x00200000, 0x00200000, 0x00200000 } },
280         { 6, 0x989c,
281             { 0x00240000, 0x00240000, 0x00240000, 0x00240000, 0x00240000 } },
282         { 6, 0x989c,
283             { 0x00250000, 0x00250000, 0x00250000, 0x00250000, 0x00250000 } },
284         { 6, 0x989c,
285             { 0x00110000, 0x00110000, 0x00110000, 0x00110000, 0x00110000 } },
286         { 6, 0x989c,
287             { 0x00110000, 0x00110000, 0x00110000, 0x00110000, 0x00110000 } },
288         { 6, 0x989c,
289             { 0x00510000, 0x00510000, 0x00510000, 0x00510000, 0x00510000 } },
290         { 6, 0x989c,
291             { 0x1c040000, 0x1c040000, 0x1c040000, 0x1c040000, 0x1c040000 } },
292         { 6, 0x989c,
293             { 0x000a0000, 0x000a0000, 0x000a0000, 0x000a0000, 0x000a0000 } },
294         { 6, 0x989c,
295             { 0x00a10000, 0x00a10000, 0x00a10000, 0x00a10000, 0x00a10000 } },
296         { 6, 0x989c,
297             { 0x00400000, 0x00400000, 0x00400000, 0x00400000, 0x00400000 } },
298         { 6, 0x989c,
299             { 0x03090000, 0x03090000, 0x03090000, 0x03090000, 0x03090000 } },
300         { 6, 0x989c,
301             { 0x06000000, 0x06000000, 0x06000000, 0x06000000, 0x06000000 } },
302         { 6, 0x989c,
303             { 0x000000b0, 0x000000b0, 0x000000a8, 0x000000a8, 0x000000a8 } },
304         { 6, 0x989c,
305             { 0x0000002e, 0x0000002e, 0x0000002e, 0x0000002e, 0x0000002e } },
306         { 6, 0x989c,
307             { 0x006c4a41, 0x006c4a41, 0x006c4af1, 0x006c4a61, 0x006c4a61 } },
308         { 6, 0x989c,
309             { 0x0050892a, 0x0050892a, 0x0050892b, 0x0050892b, 0x0050892b } },
310         { 6, 0x989c,
311             { 0x00842400, 0x00842400, 0x00842400, 0x00842400, 0x00842400 } },
312         { 6, 0x989c,
313             { 0x00c69200, 0x00c69200, 0x00c69200, 0x00c69200, 0x00c69200 } },
314         { 6, 0x98d0,
315             { 0x0002000c, 0x0002000c, 0x0002000c, 0x0002000c, 0x0002000c } },
316         { 7, 0x989c,
317             { 0x00000094, 0x00000094, 0x00000094, 0x00000094, 0x00000094 } },
318         { 7, 0x989c,
319             { 0x00000091, 0x00000091, 0x00000091, 0x00000091, 0x00000091 } },
320         { 7, 0x989c,
321             { 0x0000000a, 0x0000000a, 0x00000012, 0x00000012, 0x00000012 } },
322         { 7, 0x989c,
323             { 0x00000080, 0x00000080, 0x00000080, 0x00000080, 0x00000080 } },
324         { 7, 0x989c,
325             { 0x000000c1, 0x000000c1, 0x000000c1, 0x000000c1, 0x000000c1 } },
326         { 7, 0x989c,
327             { 0x00000060, 0x00000060, 0x00000060, 0x00000060, 0x00000060 } },
328         { 7, 0x989c,
329             { 0x000000f0, 0x000000f0, 0x000000f0, 0x000000f0, 0x000000f0 } },
330         { 7, 0x989c,
331             { 0x00000022, 0x00000022, 0x00000022, 0x00000022, 0x00000022 } },
332         { 7, 0x989c,
333             { 0x00000092, 0x00000092, 0x00000092, 0x00000092, 0x00000092 } },
334         { 7, 0x989c,
335             { 0x000000d4, 0x000000d4, 0x000000d4, 0x000000d4, 0x000000d4 } },
336         { 7, 0x989c,
337             { 0x000014cc, 0x000014cc, 0x000014cc, 0x000014cc, 0x000014cc } },
338         { 7, 0x989c,
339             { 0x0000048c, 0x0000048c, 0x0000048c, 0x0000048c, 0x0000048c } },
340         { 7, 0x98c4,
341             { 0x00000003, 0x00000003, 0x00000003, 0x00000003, 0x00000003 } },
342 };
343
344 /* RF5112A mode-specific init registers */
345 static const struct ath5k_ini_rf rfregs_5112a[] = {
346         { 1, 0x98d4,
347         /*    mode a/XR   mode aTurbo mode b      mode g      mode gTurbo */
348             { 0x00000020, 0x00000020, 0x00000020, 0x00000020, 0x00000020 } },
349         { 2, 0x98d0,
350             { 0x03060408, 0x03070408, 0x03060408, 0x03060408, 0x03070408 } },
351         { 3, 0x98dc,
352             { 0x00a0c0c0, 0x00a0c0c0, 0x00e0c0c0, 0x00e0c0c0, 0x00e0c0c0 } },
353         { 6, 0x989c,
354             { 0x0f000000, 0x0f000000, 0x0f000000, 0x0f000000, 0x0f000000 } },
355         { 6, 0x989c,
356             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
357         { 6, 0x989c,
358             { 0x00800000, 0x00800000, 0x00800000, 0x00800000, 0x00800000 } },
359         { 6, 0x989c,
360             { 0x002a0000, 0x002a0000, 0x002a0000, 0x002a0000, 0x002a0000 } },
361         { 6, 0x989c,
362             { 0x00010000, 0x00010000, 0x00010000, 0x00010000, 0x00010000 } },
363         { 6, 0x989c,
364             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
365         { 6, 0x989c,
366             { 0x00180000, 0x00180000, 0x00180000, 0x00180000, 0x00180000 } },
367         { 6, 0x989c,
368             { 0x00600000, 0x00600000, 0x006e0000, 0x006e0000, 0x006e0000 } },
369         { 6, 0x989c,
370             { 0x00c70000, 0x00c70000, 0x00c70000, 0x00c70000, 0x00c70000 } },
371         { 6, 0x989c,
372             { 0x004b0000, 0x004b0000, 0x004b0000, 0x004b0000, 0x004b0000 } },
373         { 6, 0x989c,
374             { 0x04480000, 0x04480000, 0x04480000, 0x04480000, 0x04480000 } },
375         { 6, 0x989c,
376             { 0x00220000, 0x00220000, 0x00220000, 0x00220000, 0x00220000 } },
377         { 6, 0x989c,
378             { 0x00e40000, 0x00e40000, 0x00e40000, 0x00e40000, 0x00e40000 } },
379         { 6, 0x989c,
380             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
381         { 6, 0x989c,
382             { 0x00fc0000, 0x00fc0000, 0x00fc0000, 0x00fc0000, 0x00fc0000 } },
383         { 6, 0x989c,
384             { 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000 } },
385         { 6, 0x989c,
386             { 0x043f0000, 0x043f0000, 0x043f0000, 0x043f0000, 0x043f0000 } },
387         { 6, 0x989c,
388             { 0x000c0000, 0x000c0000, 0x000c0000, 0x000c0000, 0x000c0000 } },
389         { 6, 0x989c,
390             { 0x00190000, 0x00190000, 0x00190000, 0x00190000, 0x00190000 } },
391         { 6, 0x989c,
392             { 0x00240000, 0x00240000, 0x00240000, 0x00240000, 0x00240000 } },
393         { 6, 0x989c,
394             { 0x00b40000, 0x00b40000, 0x00b40000, 0x00b40000, 0x00b40000 } },
395         { 6, 0x989c,
396             { 0x00990000, 0x00990000, 0x00990000, 0x00990000, 0x00990000 } },
397         { 6, 0x989c,
398             { 0x00500000, 0x00500000, 0x00500000, 0x00500000, 0x00500000 } },
399         { 6, 0x989c,
400             { 0x002a0000, 0x002a0000, 0x002a0000, 0x002a0000, 0x002a0000 } },
401         { 6, 0x989c,
402             { 0x00120000, 0x00120000, 0x00120000, 0x00120000, 0x00120000 } },
403         { 6, 0x989c,
404             { 0xc0320000, 0xc0320000, 0xc0320000, 0xc0320000, 0xc0320000 } },
405         { 6, 0x989c,
406             { 0x01740000, 0x01740000, 0x01740000, 0x01740000, 0x01740000 } },
407         { 6, 0x989c,
408             { 0x00110000, 0x00110000, 0x00110000, 0x00110000, 0x00110000 } },
409         { 6, 0x989c,
410             { 0x86280000, 0x86280000, 0x86280000, 0x86280000, 0x86280000 } },
411         { 6, 0x989c,
412             { 0x31840000, 0x31840000, 0x31840000, 0x31840000, 0x31840000 } },
413         { 6, 0x989c,
414             { 0x00020080, 0x00020080, 0x00020080, 0x00020080, 0x00020080 } },
415         { 6, 0x989c,
416             { 0x00080009, 0x00080009, 0x00080009, 0x00080009, 0x00080009 } },
417         { 6, 0x989c,
418             { 0x00000003, 0x00000003, 0x00000003, 0x00000003, 0x00000003 } },
419         { 6, 0x989c,
420             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
421         { 6, 0x989c,
422             { 0x000000b2, 0x000000b2, 0x000000b2, 0x000000b2, 0x000000b2 } },
423         { 6, 0x989c,
424             { 0x00b02084, 0x00b02084, 0x00b02084, 0x00b02084, 0x00b02084 } },
425         { 6, 0x989c,
426             { 0x004125a4, 0x004125a4, 0x004125a4, 0x004125a4, 0x004125a4 } },
427         { 6, 0x989c,
428             { 0x00119220, 0x00119220, 0x00119220, 0x00119220, 0x00119220 } },
429         { 6, 0x989c,
430             { 0x001a4800, 0x001a4800, 0x001a4800, 0x001a4800, 0x001a4800 } },
431         { 6, 0x98d8,
432             { 0x000b0230, 0x000b0230, 0x000b0230, 0x000b0230, 0x000b0230 } },
433         { 7, 0x989c,
434             { 0x00000094, 0x00000094, 0x00000094, 0x00000094, 0x00000094 } },
435         { 7, 0x989c,
436             { 0x00000091, 0x00000091, 0x00000091, 0x00000091, 0x00000091 } },
437         { 7, 0x989c,
438             { 0x00000012, 0x00000012, 0x00000012, 0x00000012, 0x00000012 } },
439         { 7, 0x989c,
440             { 0x00000080, 0x00000080, 0x00000080, 0x00000080, 0x00000080 } },
441         { 7, 0x989c,
442             { 0x000000d9, 0x000000d9, 0x000000d9, 0x000000d9, 0x000000d9 } },
443         { 7, 0x989c,
444             { 0x00000060, 0x00000060, 0x00000060, 0x00000060, 0x00000060 } },
445         { 7, 0x989c,
446             { 0x000000f0, 0x000000f0, 0x000000f0, 0x000000f0, 0x000000f0 } },
447         { 7, 0x989c,
448             { 0x000000a2, 0x000000a2, 0x000000a2, 0x000000a2, 0x000000a2 } },
449         { 7, 0x989c,
450             { 0x00000052, 0x00000052, 0x00000052, 0x00000052, 0x00000052 } },
451         { 7, 0x989c,
452             { 0x000000d4, 0x000000d4, 0x000000d4, 0x000000d4, 0x000000d4 } },
453         { 7, 0x989c,
454             { 0x000014cc, 0x000014cc, 0x000014cc, 0x000014cc, 0x000014cc } },
455         { 7, 0x989c,
456             { 0x0000048c, 0x0000048c, 0x0000048c, 0x0000048c, 0x0000048c } },
457         { 7, 0x98c4,
458             { 0x00000003, 0x00000003, 0x00000003, 0x00000003, 0x00000003 } },
459 };
460
461
462 static const struct ath5k_ini_rf rfregs_2112a[] = {
463         { 1, AR5K_RF_BUFFER_CONTROL_4,
464         /*         mode b       mode g    mode gTurbo */
465                 { 0x00000020, 0x00000020, 0x00000020 } },
466         { 2, AR5K_RF_BUFFER_CONTROL_3,
467                 { 0x03060408, 0x03060408, 0x03070408 } },
468         { 3, AR5K_RF_BUFFER_CONTROL_6,
469                 { 0x00e020c0, 0x00e020c0, 0x00e020c0 } },
470         { 6, AR5K_RF_BUFFER,
471                 { 0x0a000000, 0x0a000000, 0x0a000000 } },
472         { 6, AR5K_RF_BUFFER,
473                 { 0x00000000, 0x00000000, 0x00000000 } },
474         { 6, AR5K_RF_BUFFER,
475                 { 0x00800000, 0x00800000, 0x00800000 } },
476         { 6, AR5K_RF_BUFFER,
477                 { 0x002a0000, 0x002a0000, 0x002a0000 } },
478         { 6, AR5K_RF_BUFFER,
479                 { 0x00010000, 0x00010000, 0x00010000 } },
480         { 6, AR5K_RF_BUFFER,
481                 { 0x00000000, 0x00000000, 0x00000000 } },
482         { 6, AR5K_RF_BUFFER,
483                 { 0x00180000, 0x00180000, 0x00180000 } },
484         { 6, AR5K_RF_BUFFER,
485                 { 0x006e0000, 0x006e0000, 0x006e0000 } },
486         { 6, AR5K_RF_BUFFER,
487                 { 0x00c70000, 0x00c70000, 0x00c70000 } },
488         { 6, AR5K_RF_BUFFER,
489                 { 0x004b0000, 0x004b0000, 0x004b0000 } },
490         { 6, AR5K_RF_BUFFER,
491                 { 0x04480000, 0x04480000, 0x04480000 } },
492         { 6, AR5K_RF_BUFFER,
493                 { 0x002a0000, 0x002a0000, 0x002a0000 } },
494         { 6, AR5K_RF_BUFFER,
495                 { 0x00e40000, 0x00e40000, 0x00e40000 } },
496         { 6, AR5K_RF_BUFFER,
497                 { 0x00000000, 0x00000000, 0x00000000 } },
498         { 6, AR5K_RF_BUFFER,
499                 { 0x00fc0000, 0x00fc0000, 0x00fc0000 } },
500         { 6, AR5K_RF_BUFFER,
501                 { 0x00ff0000, 0x00ff0000, 0x00ff0000 } },
502         { 6, AR5K_RF_BUFFER,
503                 { 0x043f0000, 0x043f0000, 0x043f0000 } },
504         { 6, AR5K_RF_BUFFER,
505                 { 0x0c0c0000, 0x0c0c0000, 0x0c0c0000 } },
506         { 6, AR5K_RF_BUFFER,
507                 { 0x02190000, 0x02190000, 0x02190000 } },
508         { 6, AR5K_RF_BUFFER,
509                 { 0x00240000, 0x00240000, 0x00240000 } },
510         { 6, AR5K_RF_BUFFER,
511                 { 0x00b40000, 0x00b40000, 0x00b40000 } },
512         { 6, AR5K_RF_BUFFER,
513                 { 0x00990000, 0x00990000, 0x00990000 } },
514         { 6, AR5K_RF_BUFFER,
515                 { 0x00500000, 0x00500000, 0x00500000 } },
516         { 6, AR5K_RF_BUFFER,
517                 { 0x002a0000, 0x002a0000, 0x002a0000 } },
518         { 6, AR5K_RF_BUFFER,
519                 { 0x00120000, 0x00120000, 0x00120000 } },
520         { 6, AR5K_RF_BUFFER,
521                 { 0xc0320000, 0xc0320000, 0xc0320000 } },
522         { 6, AR5K_RF_BUFFER,
523                 { 0x01740000, 0x01740000, 0x01740000 } },
524         { 6, AR5K_RF_BUFFER,
525                 { 0x00110000, 0x00110000, 0x00110000 } },
526         { 6, AR5K_RF_BUFFER,
527                 { 0x86280000, 0x86280000, 0x86280000 } },
528         { 6, AR5K_RF_BUFFER,
529                 { 0x31840000, 0x31840000, 0x31840000 } },
530         { 6, AR5K_RF_BUFFER,
531                 { 0x00f20080, 0x00f20080, 0x00f20080 } },
532         { 6, AR5K_RF_BUFFER,
533                 { 0x00070019, 0x00070019, 0x00070019 } },
534         { 6, AR5K_RF_BUFFER,
535                 { 0x00000000, 0x00000000, 0x00000000 } },
536         { 6, AR5K_RF_BUFFER,
537                 { 0x00000000, 0x00000000, 0x00000000 } },
538         { 6, AR5K_RF_BUFFER,
539                 { 0x000000b2, 0x000000b2, 0x000000b2 } },
540         { 6, AR5K_RF_BUFFER,
541                 { 0x00b02184, 0x00b02184, 0x00b02184 } },
542         { 6, AR5K_RF_BUFFER,
543                 { 0x004125a4, 0x004125a4, 0x004125a4 } },
544         { 6, AR5K_RF_BUFFER,
545                 { 0x00119220, 0x00119220, 0x00119220 } },
546         { 6, AR5K_RF_BUFFER,
547                 { 0x001a4800, 0x001a4800, 0x001a4800 } },
548         { 6, AR5K_RF_BUFFER_CONTROL_5,
549                 { 0x000b0230, 0x000b0230, 0x000b0230 } },
550         { 7, AR5K_RF_BUFFER,
551                 { 0x00000094, 0x00000094, 0x00000094 } },
552         { 7, AR5K_RF_BUFFER,
553                 { 0x00000091, 0x00000091, 0x00000091 } },
554         { 7, AR5K_RF_BUFFER,
555                 { 0x00000012, 0x00000012, 0x00000012 } },
556         { 7, AR5K_RF_BUFFER,
557                 { 0x00000080, 0x00000080, 0x00000080 } },
558         { 7, AR5K_RF_BUFFER,
559                 { 0x000000d9, 0x000000d9, 0x000000d9 } },
560         { 7, AR5K_RF_BUFFER,
561                 { 0x00000060, 0x00000060, 0x00000060 } },
562         { 7, AR5K_RF_BUFFER,
563                 { 0x000000f0, 0x000000f0, 0x000000f0 } },
564         { 7, AR5K_RF_BUFFER,
565                 { 0x000000a2, 0x000000a2, 0x000000a2 } },
566         { 7, AR5K_RF_BUFFER,
567                 { 0x00000052, 0x00000052, 0x00000052 } },
568         { 7, AR5K_RF_BUFFER,
569                 { 0x000000d4, 0x000000d4, 0x000000d4 } },
570         { 7, AR5K_RF_BUFFER,
571                 { 0x000014cc, 0x000014cc, 0x000014cc } },
572         { 7, AR5K_RF_BUFFER,
573                 { 0x0000048c, 0x0000048c, 0x0000048c } },
574         { 7, AR5K_RF_BUFFER_CONTROL_1,
575                 { 0x00000003, 0x00000003, 0x00000003 } },
576 };
577
578 /* RF5413/5414 mode-specific init registers */
579 static const struct ath5k_ini_rf rfregs_5413[] = {
580         { 1, 0x98d4,
581         /*    mode a/XR   mode aTurbo mode b      mode g      mode gTurbo */
582             { 0x00000020, 0x00000020, 0x00000020, 0x00000020, 0x00000020 } },
583         { 2, 0x98d0,
584             { 0x00000008, 0x00000008, 0x00000008, 0x00000008, 0x00000008 } },
585         { 3, 0x98dc,
586             { 0x00a000c0, 0x00a000c0, 0x00e000c0, 0x00e000c0, 0x00e000c0 } },
587         { 6, 0x989c,
588             { 0x33000000, 0x33000000, 0x33000000, 0x33000000, 0x33000000 } },
589         { 6, 0x989c,
590             { 0x01000000, 0x01000000, 0x01000000, 0x01000000, 0x01000000 } },
591         { 6, 0x989c,
592             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
593         { 6, 0x989c,
594             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
595         { 6, 0x989c,
596             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
597         { 6, 0x989c,
598             { 0x1f000000, 0x1f000000, 0x1f000000, 0x1f000000, 0x1f000000 } },
599         { 6, 0x989c,
600             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
601         { 6, 0x989c,
602             { 0x00b80000, 0x00b80000, 0x00b80000, 0x00b80000, 0x00b80000 } },
603         { 6, 0x989c,
604             { 0x00b70000, 0x00b70000, 0x00b70000, 0x00b70000, 0x00b70000 } },
605         { 6, 0x989c,
606             { 0x00840000, 0x00840000, 0x00840000, 0x00840000, 0x00840000 } },
607         { 6, 0x989c,
608             { 0x00980000, 0x00980000, 0x00980000, 0x00980000, 0x00980000 } },
609         { 6, 0x989c,
610             { 0x00c00000, 0x00c00000, 0x00c00000, 0x00c00000, 0x00c00000 } },
611         { 6, 0x989c,
612             { 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000 } },
613         { 6, 0x989c,
614             { 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000 } },
615         { 6, 0x989c,
616             { 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000 } },
617         { 6, 0x989c,
618             { 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000, 0x00ff0000 } },
619         { 6, 0x989c,
620             { 0x00d70000, 0x00d70000, 0x00d70000, 0x00d70000, 0x00d70000 } },
621         { 6, 0x989c,
622             { 0x00610000, 0x00610000, 0x00610000, 0x00610000, 0x00610000 } },
623         { 6, 0x989c,
624             { 0x00fe0000, 0x00fe0000, 0x00fe0000, 0x00fe0000, 0x00fe0000 } },
625         { 6, 0x989c,
626             { 0x00de0000, 0x00de0000, 0x00de0000, 0x00de0000, 0x00de0000 } },
627         { 6, 0x989c,
628             { 0x007f0000, 0x007f0000, 0x007f0000, 0x007f0000, 0x007f0000 } },
629         { 6, 0x989c,
630             { 0x043d0000, 0x043d0000, 0x043d0000, 0x043d0000, 0x043d0000 } },
631         { 6, 0x989c,
632             { 0x00770000, 0x00770000, 0x00770000, 0x00770000, 0x00770000 } },
633         { 6, 0x989c,
634             { 0x00440000, 0x00440000, 0x00440000, 0x00440000, 0x00440000 } },
635         { 6, 0x989c,
636             { 0x00980000, 0x00980000, 0x00980000, 0x00980000, 0x00980000 } },
637         { 6, 0x989c,
638             { 0x00100080, 0x00100080, 0x00100080, 0x00100080, 0x00100080 } },
639         { 6, 0x989c,
640             { 0x0005c034, 0x0005c034, 0x0005c034, 0x0005c034, 0x0005c034 } },
641         { 6, 0x989c,
642             { 0x003100f0, 0x003100f0, 0x003100f0, 0x003100f0, 0x003100f0 } },
643         { 6, 0x989c,
644             { 0x000c011f, 0x000c011f, 0x000c011f, 0x000c011f, 0x000c011f } },
645         { 6, 0x989c,
646             { 0x00510040, 0x00510040, 0x005100a0, 0x005100a0, 0x005100a0 } },
647         { 6, 0x989c,
648             { 0x0050006a, 0x0050006a, 0x005000dd, 0x005000dd, 0x005000dd } },
649         { 6, 0x989c,
650             { 0x00000001, 0x00000001, 0x00000000, 0x00000000, 0x00000000 } },
651         { 6, 0x989c,
652             { 0x00004044, 0x00004044, 0x00004044, 0x00004044, 0x00004044 } },
653         { 6, 0x989c,
654             { 0x00000000, 0x00000000, 0x00000000, 0x00000000, 0x00000000 } },
655         { 6, 0x989c,
656             { 0x000060c0, 0x000060c0, 0x000060c0, 0x000060c0, 0x000060c0 } },
657         { 6, 0x989c,
658             { 0x00002c00, 0x00002c00, 0x00003600, 0x00003600, 0x00003600 } },
659         { 6, 0x98c8,
660             { 0x00000403, 0x00000403, 0x00040403, 0x00040403, 0x00040403 } },
661         { 7, 0x989c,
662             { 0x00006400, 0x00006400, 0x00006400, 0x00006400, 0x00006400 } },
663         { 7, 0x989c,
664             { 0x00000800, 0x00000800, 0x00000800, 0x00000800, 0x00000800 } },
665         { 7, 0x98cc,
666             { 0x0000000e, 0x0000000e, 0x0000000e, 0x0000000e, 0x0000000e } },
667 };
668
669
670 /* Initial RF Gain settings for RF5112 */
671 static const struct ath5k_ini_rfgain rfgain_5112[] = {
672         /*                            5Ghz      2Ghz    */
673         { AR5K_RF_GAIN(0),      { 0x00000007, 0x00000007 } },
674         { AR5K_RF_GAIN(1),      { 0x00000047, 0x00000047 } },
675         { AR5K_RF_GAIN(2),      { 0x00000087, 0x00000087 } },
676         { AR5K_RF_GAIN(3),      { 0x000001a0, 0x000001a0 } },
677         { AR5K_RF_GAIN(4),      { 0x000001e0, 0x000001e0 } },
678         { AR5K_RF_GAIN(5),      { 0x00000020, 0x00000020 } },
679         { AR5K_RF_GAIN(6),      { 0x00000060, 0x00000060 } },
680         { AR5K_RF_GAIN(7),      { 0x000001a1, 0x000001a1 } },
681         { AR5K_RF_GAIN(8),      { 0x000001e1, 0x000001e1 } },
682         { AR5K_RF_GAIN(9),      { 0x00000021, 0x00000021 } },
683         { AR5K_RF_GAIN(10),     { 0x00000061, 0x00000061 } },
684         { AR5K_RF_GAIN(11),     { 0x00000162, 0x00000162 } },
685         { AR5K_RF_GAIN(12),     { 0x000001a2, 0x000001a2 } },
686         { AR5K_RF_GAIN(13),     { 0x000001e2, 0x000001e2 } },
687         { AR5K_RF_GAIN(14),     { 0x00000022, 0x00000022 } },
688         { AR5K_RF_GAIN(15),     { 0x00000062, 0x00000062 } },
689         { AR5K_RF_GAIN(16),     { 0x00000163, 0x00000163 } },
690         { AR5K_RF_GAIN(17),     { 0x000001a3, 0x000001a3 } },
691         { AR5K_RF_GAIN(18),     { 0x000001e3, 0x000001e3 } },
692         { AR5K_RF_GAIN(19),     { 0x00000023, 0x00000023 } },
693         { AR5K_RF_GAIN(20),     { 0x00000063, 0x00000063 } },
694         { AR5K_RF_GAIN(21),     { 0x00000184, 0x00000184 } },
695         { AR5K_RF_GAIN(22),     { 0x000001c4, 0x000001c4 } },
696         { AR5K_RF_GAIN(23),     { 0x00000004, 0x00000004 } },
697         { AR5K_RF_GAIN(24),     { 0x000001ea, 0x0000000b } },
698         { AR5K_RF_GAIN(25),     { 0x0000002a, 0x0000004b } },
699         { AR5K_RF_GAIN(26),     { 0x0000006a, 0x0000008b } },
700         { AR5K_RF_GAIN(27),     { 0x000000aa, 0x000001ac } },
701         { AR5K_RF_GAIN(28),     { 0x000001ab, 0x000001ec } },
702         { AR5K_RF_GAIN(29),     { 0x000001eb, 0x0000002c } },
703         { AR5K_RF_GAIN(30),     { 0x0000002b, 0x00000012 } },
704         { AR5K_RF_GAIN(31),     { 0x0000006b, 0x00000052 } },
705         { AR5K_RF_GAIN(32),     { 0x000000ab, 0x00000092 } },
706         { AR5K_RF_GAIN(33),     { 0x000001ac, 0x00000193 } },
707         { AR5K_RF_GAIN(34),     { 0x000001ec, 0x000001d3 } },
708         { AR5K_RF_GAIN(35),     { 0x0000002c, 0x00000013 } },
709         { AR5K_RF_GAIN(36),     { 0x0000003a, 0x00000053 } },
710         { AR5K_RF_GAIN(37),     { 0x0000007a, 0x00000093 } },
711         { AR5K_RF_GAIN(38),     { 0x000000ba, 0x00000194 } },
712         { AR5K_RF_GAIN(39),     { 0x000001bb, 0x000001d4 } },
713         { AR5K_RF_GAIN(40),     { 0x000001fb, 0x00000014 } },
714         { AR5K_RF_GAIN(41),     { 0x0000003b, 0x0000003a } },
715         { AR5K_RF_GAIN(42),     { 0x0000007b, 0x0000007a } },
716         { AR5K_RF_GAIN(43),     { 0x000000bb, 0x000000ba } },
717         { AR5K_RF_GAIN(44),     { 0x000001bc, 0x000001bb } },
718         { AR5K_RF_GAIN(45),     { 0x000001fc, 0x000001fb } },
719         { AR5K_RF_GAIN(46),     { 0x0000003c, 0x0000003b } },
720         { AR5K_RF_GAIN(47),     { 0x0000007c, 0x0000007b } },
721         { AR5K_RF_GAIN(48),     { 0x000000bc, 0x000000bb } },
722         { AR5K_RF_GAIN(49),     { 0x000000fc, 0x000001bc } },
723         { AR5K_RF_GAIN(50),     { 0x000000fc, 0x000001fc } },
724         { AR5K_RF_GAIN(51),     { 0x000000fc, 0x0000003c } },
725         { AR5K_RF_GAIN(52),     { 0x000000fc, 0x0000007c } },
726         { AR5K_RF_GAIN(53),     { 0x000000fc, 0x000000bc } },
727         { AR5K_RF_GAIN(54),     { 0x000000fc, 0x000000fc } },
728         { AR5K_RF_GAIN(55),     { 0x000000fc, 0x000000fc } },
729         { AR5K_RF_GAIN(56),     { 0x000000fc, 0x000000fc } },
730         { AR5K_RF_GAIN(57),     { 0x000000fc, 0x000000fc } },
731         { AR5K_RF_GAIN(58),     { 0x000000fc, 0x000000fc } },
732         { AR5K_RF_GAIN(59),     { 0x000000fc, 0x000000fc } },
733         { AR5K_RF_GAIN(60),     { 0x000000fc, 0x000000fc } },
734         { AR5K_RF_GAIN(61),     { 0x000000fc, 0x000000fc } },
735         { AR5K_RF_GAIN(62),     { 0x000000fc, 0x000000fc } },
736         { AR5K_RF_GAIN(63),     { 0x000000fc, 0x000000fc } },
737 };
738
739 /* Initial RF Gain settings for RF5413 */
740 static const struct ath5k_ini_rfgain rfgain_5413[] = {
741         /*                            5Ghz      2Ghz    */
742         { AR5K_RF_GAIN(0),      { 0x00000000, 0x00000000 } },
743         { AR5K_RF_GAIN(1),      { 0x00000040, 0x00000040 } },
744         { AR5K_RF_GAIN(2),      { 0x00000080, 0x00000080 } },
745         { AR5K_RF_GAIN(3),      { 0x000001a1, 0x00000161 } },
746         { AR5K_RF_GAIN(4),      { 0x000001e1, 0x000001a1 } },
747         { AR5K_RF_GAIN(5),      { 0x00000021, 0x000001e1 } },
748         { AR5K_RF_GAIN(6),      { 0x00000061, 0x00000021 } },
749         { AR5K_RF_GAIN(7),      { 0x00000188, 0x00000061 } },
750         { AR5K_RF_GAIN(8),      { 0x000001c8, 0x00000188 } },
751         { AR5K_RF_GAIN(9),      { 0x00000008, 0x000001c8 } },
752         { AR5K_RF_GAIN(10),     { 0x00000048, 0x00000008 } },
753         { AR5K_RF_GAIN(11),     { 0x00000088, 0x00000048 } },
754         { AR5K_RF_GAIN(12),     { 0x000001a9, 0x00000088 } },
755         { AR5K_RF_GAIN(13),     { 0x000001e9, 0x00000169 } },
756         { AR5K_RF_GAIN(14),     { 0x00000029, 0x000001a9 } },
757         { AR5K_RF_GAIN(15),     { 0x00000069, 0x000001e9 } },
758         { AR5K_RF_GAIN(16),     { 0x000001d0, 0x00000029 } },
759         { AR5K_RF_GAIN(17),     { 0x00000010, 0x00000069 } },
760         { AR5K_RF_GAIN(18),     { 0x00000050, 0x00000190 } },
761         { AR5K_RF_GAIN(19),     { 0x00000090, 0x000001d0 } },
762         { AR5K_RF_GAIN(20),     { 0x000001b1, 0x00000010 } },
763         { AR5K_RF_GAIN(21),     { 0x000001f1, 0x00000050 } },
764         { AR5K_RF_GAIN(22),     { 0x00000031, 0x00000090 } },
765         { AR5K_RF_GAIN(23),     { 0x00000071, 0x00000171 } },
766         { AR5K_RF_GAIN(24),     { 0x000001b8, 0x000001b1 } },
767         { AR5K_RF_GAIN(25),     { 0x000001f8, 0x000001f1 } },
768         { AR5K_RF_GAIN(26),     { 0x00000038, 0x00000031 } },
769         { AR5K_RF_GAIN(27),     { 0x00000078, 0x00000071 } },
770         { AR5K_RF_GAIN(28),     { 0x00000199, 0x00000198 } },
771         { AR5K_RF_GAIN(29),     { 0x000001d9, 0x000001d8 } },
772         { AR5K_RF_GAIN(30),     { 0x00000019, 0x00000018 } },
773         { AR5K_RF_GAIN(31),     { 0x00000059, 0x00000058 } },
774         { AR5K_RF_GAIN(32),     { 0x00000099, 0x00000098 } },
775         { AR5K_RF_GAIN(33),     { 0x000000d9, 0x00000179 } },
776         { AR5K_RF_GAIN(34),     { 0x000000f9, 0x000001b9 } },
777         { AR5K_RF_GAIN(35),     { 0x000000f9, 0x000001f9 } },
778         { AR5K_RF_GAIN(36),     { 0x000000f9, 0x00000039 } },
779         { AR5K_RF_GAIN(37),     { 0x000000f9, 0x00000079 } },
780         { AR5K_RF_GAIN(38),     { 0x000000f9, 0x000000b9 } },
781         { AR5K_RF_GAIN(39),     { 0x000000f9, 0x000000f9 } },
782         { AR5K_RF_GAIN(40),     { 0x000000f9, 0x000000f9 } },
783         { AR5K_RF_GAIN(41),     { 0x000000f9, 0x000000f9 } },
784         { AR5K_RF_GAIN(42),     { 0x000000f9, 0x000000f9 } },
785         { AR5K_RF_GAIN(43),     { 0x000000f9, 0x000000f9 } },
786         { AR5K_RF_GAIN(44),     { 0x000000f9, 0x000000f9 } },
787         { AR5K_RF_GAIN(45),     { 0x000000f9, 0x000000f9 } },
788         { AR5K_RF_GAIN(46),     { 0x000000f9, 0x000000f9 } },
789         { AR5K_RF_GAIN(47),     { 0x000000f9, 0x000000f9 } },
790         { AR5K_RF_GAIN(48),     { 0x000000f9, 0x000000f9 } },
791         { AR5K_RF_GAIN(49),     { 0x000000f9, 0x000000f9 } },
792         { AR5K_RF_GAIN(50),     { 0x000000f9, 0x000000f9 } },
793         { AR5K_RF_GAIN(51),     { 0x000000f9, 0x000000f9 } },
794         { AR5K_RF_GAIN(52),     { 0x000000f9, 0x000000f9 } },
795         { AR5K_RF_GAIN(53),     { 0x000000f9, 0x000000f9 } },
796         { AR5K_RF_GAIN(54),     { 0x000000f9, 0x000000f9 } },
797         { AR5K_RF_GAIN(55),     { 0x000000f9, 0x000000f9 } },
798         { AR5K_RF_GAIN(56),     { 0x000000f9, 0x000000f9 } },
799         { AR5K_RF_GAIN(57),     { 0x000000f9, 0x000000f9 } },
800         { AR5K_RF_GAIN(58),     { 0x000000f9, 0x000000f9 } },
801         { AR5K_RF_GAIN(59),     { 0x000000f9, 0x000000f9 } },
802         { AR5K_RF_GAIN(60),     { 0x000000f9, 0x000000f9 } },
803         { AR5K_RF_GAIN(61),     { 0x000000f9, 0x000000f9 } },
804         { AR5K_RF_GAIN(62),     { 0x000000f9, 0x000000f9 } },
805         { AR5K_RF_GAIN(63),     { 0x000000f9, 0x000000f9 } },
806 };
807
808 static const struct ath5k_gain_opt rfgain_opt_5112 = {
809         1,
810         8,
811         {
812                 { { 3, 0, 0, 0, 0, 0, 0 }, 6 },
813                 { { 2, 0, 0, 0, 0, 0, 0 }, 0 },
814                 { { 1, 0, 0, 0, 0, 0, 0 }, -3 },
815                 { { 0, 0, 0, 0, 0, 0, 0 }, -6 },
816                 { { 0, 1, 1, 0, 0, 0, 0 }, -8 },
817                 { { 0, 1, 1, 0, 1, 1, 0 }, -10 },
818                 { { 0, 1, 0, 1, 1, 1, 0 }, -13 },
819                 { { 0, 1, 0, 1, 1, 0, 1 }, -16 },
820         }
821 };
822
823 /*
824  * Used to modify RF Banks before writing them to AR5K_RF_BUFFER
825  */
826 static unsigned int ath5k_hw_rfregs_op(u32 *rf, u32 offset, u32 reg, u32 bits,
827                 u32 first, u32 col, bool set)
828 {
829         u32 mask, entry, last, data, shift, position;
830         s32 left;
831         int i;
832
833         data = 0;
834
835         if (rf == NULL)
836                 /* should not happen */
837                 return 0;
838
839         if (!(col <= 3 && bits <= 32 && first + bits <= 319)) {
840                 ATH5K_PRINTF("invalid values at offset %u\n", offset);
841                 return 0;
842         }
843
844         entry = ((first - 1) / 8) + offset;
845         position = (first - 1) % 8;
846
847         if (set == true)
848                 data = ath5k_hw_bitswap(reg, bits);
849
850         for (i = shift = 0, left = bits; left > 0; position = 0, entry++, i++) {
851                 last = (position + left > 8) ? 8 : position + left;
852                 mask = (((1 << last) - 1) ^ ((1 << position) - 1)) << (col * 8);
853
854                 if (set == true) {
855                         rf[entry] &= ~mask;
856                         rf[entry] |= ((data << position) << (col * 8)) & mask;
857                         data >>= (8 - position);
858                 } else {
859                         data = (((rf[entry] & mask) >> (col * 8)) >> position)
860                                 << shift;
861                         shift += last - position;
862                 }
863
864                 left -= 8 - position;
865         }
866
867         data = set == true ? 1 : ath5k_hw_bitswap(data, bits);
868
869         return data;
870 }
871
872 static u32 ath5k_hw_rfregs_gainf_corr(struct ath5k_hw *ah)
873 {
874         u32 mix, step;
875         u32 *rf;
876
877         if (ah->ah_rf_banks == NULL)
878                 return 0;
879
880         rf = ah->ah_rf_banks;
881         ah->ah_gain.g_f_corr = 0;
882
883         if (ath5k_hw_rfregs_op(rf, ah->ah_offset[7], 0, 1, 36, 0, false) != 1)
884                 return 0;
885
886         step = ath5k_hw_rfregs_op(rf, ah->ah_offset[7], 0, 4, 32, 0, false);
887         mix = ah->ah_gain.g_step->gos_param[0];
888
889         switch (mix) {
890         case 3:
891                 ah->ah_gain.g_f_corr = step * 2;
892                 break;
893         case 2:
894                 ah->ah_gain.g_f_corr = (step - 5) * 2;
895                 break;
896         case 1:
897                 ah->ah_gain.g_f_corr = step;
898                 break;
899         default:
900                 ah->ah_gain.g_f_corr = 0;
901                 break;
902         }
903
904         return ah->ah_gain.g_f_corr;
905 }
906
907 static bool ath5k_hw_rfregs_gain_readback(struct ath5k_hw *ah)
908 {
909         u32 step, mix, level[4];
910         u32 *rf;
911
912         if (ah->ah_rf_banks == NULL)
913                 return false;
914
915         rf = ah->ah_rf_banks;
916
917         if (ah->ah_radio == AR5K_RF5111) {
918                 step = ath5k_hw_rfregs_op(rf, ah->ah_offset[7], 0, 6, 37, 0,
919                                 false);
920                 level[0] = 0;
921                 level[1] = (step == 0x3f) ? 0x32 : step + 4;
922                 level[2] = (step != 0x3f) ? 0x40 : level[0];
923                 level[3] = level[2] + 0x32;
924
925                 ah->ah_gain.g_high = level[3] -
926                         (step == 0x3f ? AR5K_GAIN_DYN_ADJUST_HI_MARGIN : -5);
927                 ah->ah_gain.g_low = level[0] +
928                         (step == 0x3f ? AR5K_GAIN_DYN_ADJUST_LO_MARGIN : 0);
929         } else {
930                 mix = ath5k_hw_rfregs_op(rf, ah->ah_offset[7], 0, 1, 36, 0,
931                                 false);
932                 level[0] = level[2] = 0;
933
934                 if (mix == 1) {
935                         level[1] = level[3] = 83;
936                 } else {
937                         level[1] = level[3] = 107;
938                         ah->ah_gain.g_high = 55;
939                 }
940         }
941
942         return (ah->ah_gain.g_current >= level[0] &&
943                         ah->ah_gain.g_current <= level[1]) ||
944                 (ah->ah_gain.g_current >= level[2] &&
945                         ah->ah_gain.g_current <= level[3]);
946 }
947
948 static s32 ath5k_hw_rfregs_gain_adjust(struct ath5k_hw *ah)
949 {
950         const struct ath5k_gain_opt *go;
951         int ret = 0;
952
953         switch (ah->ah_radio) {
954         case AR5K_RF5111:
955                 go = &rfgain_opt_5111;
956                 break;
957         case AR5K_RF5112:
958         case AR5K_RF5413: /* ??? */
959                 go = &rfgain_opt_5112;
960                 break;
961         default:
962                 return 0;
963         }
964
965         ah->ah_gain.g_step = &go->go_step[ah->ah_gain.g_step_idx];
966
967         if (ah->ah_gain.g_current >= ah->ah_gain.g_high) {
968                 if (ah->ah_gain.g_step_idx == 0)
969                         return -1;
970                 for (ah->ah_gain.g_target = ah->ah_gain.g_current;
971                                 ah->ah_gain.g_target >=  ah->ah_gain.g_high &&
972                                 ah->ah_gain.g_step_idx > 0;
973                                 ah->ah_gain.g_step =
974                                         &go->go_step[ah->ah_gain.g_step_idx])
975                         ah->ah_gain.g_target -= 2 *
976                             (go->go_step[--(ah->ah_gain.g_step_idx)].gos_gain -
977                             ah->ah_gain.g_step->gos_gain);
978
979                 ret = 1;
980                 goto done;
981         }
982
983         if (ah->ah_gain.g_current <= ah->ah_gain.g_low) {
984                 if (ah->ah_gain.g_step_idx == (go->go_steps_count - 1))
985                         return -2;
986                 for (ah->ah_gain.g_target = ah->ah_gain.g_current;
987                                 ah->ah_gain.g_target <= ah->ah_gain.g_low &&
988                                 ah->ah_gain.g_step_idx < go->go_steps_count-1;
989                                 ah->ah_gain.g_step =
990                                         &go->go_step[ah->ah_gain.g_step_idx])
991                         ah->ah_gain.g_target -= 2 *
992                             (go->go_step[++ah->ah_gain.g_step_idx].gos_gain -
993                             ah->ah_gain.g_step->gos_gain);
994
995                 ret = 2;
996                 goto done;
997         }
998
999 done:
1000         ATH5K_DBG(ah->ah_sc, ATH5K_DEBUG_CALIBRATE,
1001                 "ret %d, gain step %u, current gain %u, target gain %u\n",
1002                 ret, ah->ah_gain.g_step_idx, ah->ah_gain.g_current,
1003                 ah->ah_gain.g_target);
1004
1005         return ret;
1006 }
1007
1008 /*
1009  * Read EEPROM Calibration data, modify RF Banks and Initialize RF5111
1010  */
1011 static int ath5k_hw_rf5111_rfregs(struct ath5k_hw *ah,
1012                 struct ieee80211_channel *channel, unsigned int mode)
1013 {
1014         struct ath5k_eeprom_info *ee = &ah->ah_capabilities.cap_eeprom;
1015         u32 *rf;
1016         const unsigned int rf_size = ARRAY_SIZE(rfregs_5111);
1017         unsigned int i;
1018         int obdb = -1, bank = -1;
1019         u32 ee_mode;
1020
1021         AR5K_ASSERT_ENTRY(mode, AR5K_INI_VAL_MAX);
1022
1023         rf = ah->ah_rf_banks;
1024
1025         /* Copy values to modify them */
1026         for (i = 0; i < rf_size; i++) {
1027                 if (rfregs_5111[i].rf_bank >= AR5K_RF5111_INI_RF_MAX_BANKS) {
1028                         ATH5K_ERR(ah->ah_sc, "invalid bank\n");
1029                         return -EINVAL;
1030                 }
1031
1032                 if (bank != rfregs_5111[i].rf_bank) {
1033                         bank = rfregs_5111[i].rf_bank;
1034                         ah->ah_offset[bank] = i;
1035                 }
1036
1037                 rf[i] = rfregs_5111[i].rf_value[mode];
1038         }
1039
1040         /* Modify bank 0 */
1041         if (channel->val & CHANNEL_2GHZ) {
1042                 if (channel->val & CHANNEL_CCK)
1043                         ee_mode = AR5K_EEPROM_MODE_11B;
1044                 else
1045                         ee_mode = AR5K_EEPROM_MODE_11G;
1046                 obdb = 0;
1047
1048                 if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[0],
1049                                 ee->ee_ob[ee_mode][obdb], 3, 119, 0, true))
1050                         return -EINVAL;
1051
1052                 if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[0],
1053                                 ee->ee_ob[ee_mode][obdb], 3, 122, 0, true))
1054                         return -EINVAL;
1055
1056                 obdb = 1;
1057         /* Modify bank 6 */
1058         } else {
1059                 /* For 11a, Turbo and XR */
1060                 ee_mode = AR5K_EEPROM_MODE_11A;
1061                 obdb =   channel->freq >= 5725 ? 3 :
1062                         (channel->freq >= 5500 ? 2 :
1063                         (channel->freq >= 5260 ? 1 :
1064                          (channel->freq > 4000 ? 0 : -1)));
1065
1066                 if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[6],
1067                                 ee->ee_pwd_84, 1, 51, 3, true))
1068                         return -EINVAL;
1069
1070                 if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[6],
1071                                 ee->ee_pwd_90, 1, 45, 3, true))
1072                         return -EINVAL;
1073         }
1074
1075         if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[6],
1076                         !ee->ee_xpd[ee_mode], 1, 95, 0, true))
1077                 return -EINVAL;
1078
1079         if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[6],
1080                         ee->ee_x_gain[ee_mode], 4, 96, 0, true))
1081                 return -EINVAL;
1082
1083         if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[6], obdb >= 0 ?
1084                         ee->ee_ob[ee_mode][obdb] : 0, 3, 104, 0, true))
1085                 return -EINVAL;
1086
1087         if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[6], obdb >= 0 ?
1088                         ee->ee_db[ee_mode][obdb] : 0, 3, 107, 0, true))
1089                 return -EINVAL;
1090
1091         /* Modify bank 7 */
1092         if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[7],
1093                         ee->ee_i_gain[ee_mode], 6, 29, 0, true))
1094                 return -EINVAL;
1095
1096         if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[7],
1097                         ee->ee_xpd[ee_mode], 1, 4, 0, true))
1098                 return -EINVAL;
1099
1100         /* Write RF values */
1101         for (i = 0; i < rf_size; i++) {
1102                 AR5K_REG_WAIT(i);
1103                 ath5k_hw_reg_write(ah, rf[i], rfregs_5111[i].rf_register);
1104         }
1105
1106         return 0;
1107 }
1108
1109 /*
1110  * Read EEPROM Calibration data, modify RF Banks and Initialize RF5112
1111  */
1112 static int ath5k_hw_rf5112_rfregs(struct ath5k_hw *ah,
1113                 struct ieee80211_channel *channel, unsigned int mode)
1114 {
1115         const struct ath5k_ini_rf *rf_ini;
1116         struct ath5k_eeprom_info *ee = &ah->ah_capabilities.cap_eeprom;
1117         u32 *rf;
1118         unsigned int rf_size, i;
1119         int obdb = -1, bank = -1;
1120         u32 ee_mode;
1121
1122         AR5K_ASSERT_ENTRY(mode, AR5K_INI_VAL_MAX);
1123
1124         rf = ah->ah_rf_banks;
1125
1126         if (ah->ah_radio_5ghz_revision >= AR5K_SREV_RAD_2112A
1127                 && !test_bit(MODE_IEEE80211A, ah->ah_capabilities.cap_mode)){
1128                 rf_ini = rfregs_2112a;
1129                 rf_size = ARRAY_SIZE(rfregs_5112a);
1130                 if (mode < 2) {
1131                         ATH5K_ERR(ah->ah_sc,"invalid channel mode: %i\n",mode);
1132                         return -EINVAL;
1133                 }
1134                 mode = mode - 2; /*no a/turboa modes for 2112*/
1135         } else if (ah->ah_radio_5ghz_revision >= AR5K_SREV_RAD_5112A) {
1136                 rf_ini = rfregs_5112a;
1137                 rf_size = ARRAY_SIZE(rfregs_5112a);
1138         } else {
1139                 rf_ini = rfregs_5112;
1140                 rf_size = ARRAY_SIZE(rfregs_5112);
1141         }
1142
1143         /* Copy values to modify them */
1144         for (i = 0; i < rf_size; i++) {
1145                 if (rf_ini[i].rf_bank >= AR5K_RF5112_INI_RF_MAX_BANKS) {
1146                         ATH5K_ERR(ah->ah_sc, "invalid bank\n");
1147                         return -EINVAL;
1148                 }
1149
1150                 if (bank != rf_ini[i].rf_bank) {
1151                         bank = rf_ini[i].rf_bank;
1152                         ah->ah_offset[bank] = i;
1153                 }
1154
1155                 rf[i] = rf_ini[i].rf_value[mode];
1156         }
1157
1158         /* Modify bank 6 */
1159         if (channel->val & CHANNEL_2GHZ) {
1160                 if (channel->val & CHANNEL_OFDM)
1161                         ee_mode = AR5K_EEPROM_MODE_11G;
1162                 else
1163                         ee_mode = AR5K_EEPROM_MODE_11B;
1164                 obdb = 0;
1165
1166                 if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[6],
1167                                 ee->ee_ob[ee_mode][obdb], 3, 287, 0, true))
1168                         return -EINVAL;
1169
1170                 if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[6],
1171                                 ee->ee_ob[ee_mode][obdb], 3, 290, 0, true))
1172                         return -EINVAL;
1173         } else {
1174                 /* For 11a, Turbo and XR */
1175                 ee_mode = AR5K_EEPROM_MODE_11A;
1176                 obdb = channel->freq >= 5725 ? 3 :
1177                     (channel->freq >= 5500 ? 2 :
1178                         (channel->freq >= 5260 ? 1 :
1179                             (channel->freq > 4000 ? 0 : -1)));
1180
1181                 if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[6],
1182                                 ee->ee_ob[ee_mode][obdb], 3, 279, 0, true))
1183                         return -EINVAL;
1184
1185                 if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[6],
1186                                 ee->ee_ob[ee_mode][obdb], 3, 282, 0, true))
1187                         return -EINVAL;
1188         }
1189
1190         ath5k_hw_rfregs_op(rf, ah->ah_offset[6],
1191             ee->ee_x_gain[ee_mode], 2, 270, 0, true);
1192         ath5k_hw_rfregs_op(rf, ah->ah_offset[6],
1193             ee->ee_x_gain[ee_mode], 2, 257, 0, true);
1194
1195         if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[6],
1196                         ee->ee_xpd[ee_mode], 1, 302, 0, true))
1197                 return -EINVAL;
1198
1199         /* Modify bank 7 */
1200         if (!ath5k_hw_rfregs_op(rf, ah->ah_offset[7],
1201                         ee->ee_i_gain[ee_mode], 6, 14, 0, true))
1202                 return -EINVAL;
1203
1204         /* Write RF values */
1205         for (i = 0; i < rf_size; i++)
1206                 ath5k_hw_reg_write(ah, rf[i], rf_ini[i].rf_register);
1207
1208         return 0;
1209 }
1210
1211 /*
1212  * Initialize RF5413/5414
1213  */
1214 static int ath5k_hw_rf5413_rfregs(struct ath5k_hw *ah,
1215                 struct ieee80211_channel *channel, unsigned int mode)
1216 {
1217         const struct ath5k_ini_rf *rf_ini;
1218         u32 *rf;
1219         unsigned int rf_size, i;
1220         int bank = -1;
1221
1222         AR5K_ASSERT_ENTRY(mode, AR5K_INI_VAL_MAX);
1223
1224         rf = ah->ah_rf_banks;
1225
1226         rf_ini = rfregs_5413;
1227         rf_size = ARRAY_SIZE(rfregs_5413);
1228
1229         /* Copy values to modify them */
1230         for (i = 0; i < rf_size; i++) {
1231                 if (rf_ini[i].rf_bank >= AR5K_RF5112_INI_RF_MAX_BANKS) {
1232                         ATH5K_ERR(ah->ah_sc, "invalid bank\n");
1233                         return -EINVAL;
1234                 }
1235
1236                 if (bank != rf_ini[i].rf_bank) {
1237                         bank = rf_ini[i].rf_bank;
1238                         ah->ah_offset[bank] = i;
1239                 }
1240
1241                 rf[i] = rf_ini[i].rf_value[mode];
1242         }
1243
1244         /*
1245          * After compairing dumps from different cards
1246          * we get the same RF_BUFFER settings (diff returns
1247          * 0 lines). It seems that RF_BUFFER settings are static
1248          * and are written unmodified (no EEPROM stuff
1249          * is used because calibration data would be
1250          * different between different cards and would result
1251          * different RF_BUFFER settings)
1252          */
1253
1254         /* Write RF values */
1255         for (i = 0; i < rf_size; i++)
1256                 ath5k_hw_reg_write(ah, rf[i], rf_ini[i].rf_register);
1257
1258         return 0;
1259 }
1260
1261 /*
1262  * Initialize RF
1263  */
1264 int ath5k_hw_rfregs(struct ath5k_hw *ah, struct ieee80211_channel *channel,
1265                 unsigned int mode)
1266 {
1267         int (*func)(struct ath5k_hw *, struct ieee80211_channel *, unsigned int);
1268         int ret;
1269
1270         switch (ah->ah_radio) {
1271         case AR5K_RF5111:
1272                 ah->ah_rf_banks_size = sizeof(rfregs_5111);
1273                 func = ath5k_hw_rf5111_rfregs;
1274                 break;
1275         case AR5K_RF5112:
1276                 if (ah->ah_radio_5ghz_revision >= AR5K_SREV_RAD_5112A)
1277                         ah->ah_rf_banks_size = sizeof(rfregs_5112a);
1278                 else
1279                         ah->ah_rf_banks_size = sizeof(rfregs_5112);
1280                 func = ath5k_hw_rf5112_rfregs;
1281                 break;
1282         case AR5K_RF5413:
1283                 ah->ah_rf_banks_size = sizeof(rfregs_5413);
1284                 func = ath5k_hw_rf5413_rfregs;
1285                 break;
1286         default:
1287                 return -EINVAL;
1288         }
1289
1290         if (ah->ah_rf_banks == NULL) {
1291                 /* XXX do extra checks? */
1292                 ah->ah_rf_banks = kmalloc(ah->ah_rf_banks_size, GFP_KERNEL);
1293                 if (ah->ah_rf_banks == NULL) {
1294                         ATH5K_ERR(ah->ah_sc, "out of memory\n");
1295                         return -ENOMEM;
1296                 }
1297         }
1298
1299         ret = func(ah, channel, mode);
1300         if (!ret)
1301                 ah->ah_rf_gain = AR5K_RFGAIN_INACTIVE;
1302
1303         return ret;
1304 }
1305
1306 int ath5k_hw_rfgain(struct ath5k_hw *ah, unsigned int freq)
1307 {
1308         const struct ath5k_ini_rfgain *ath5k_rfg;
1309         unsigned int i, size;
1310
1311         switch (ah->ah_radio) {
1312         case AR5K_RF5111:
1313                 ath5k_rfg = rfgain_5111;
1314                 size = ARRAY_SIZE(rfgain_5111);
1315                 break;
1316         case AR5K_RF5112:
1317                 ath5k_rfg = rfgain_5112;
1318                 size = ARRAY_SIZE(rfgain_5112);
1319                 break;
1320         case AR5K_RF5413:
1321                 ath5k_rfg = rfgain_5413;
1322                 size = ARRAY_SIZE(rfgain_5413);
1323                 break;
1324         default:
1325                 return -EINVAL;
1326         }
1327
1328         switch (freq) {
1329         case AR5K_INI_RFGAIN_2GHZ:
1330         case AR5K_INI_RFGAIN_5GHZ:
1331                 break;
1332         default:
1333                 return -EINVAL;
1334         }
1335
1336         for (i = 0; i < size; i++) {
1337                 AR5K_REG_WAIT(i);
1338                 ath5k_hw_reg_write(ah, ath5k_rfg[i].rfg_value[freq],
1339                         (u32)ath5k_rfg[i].rfg_register);
1340         }
1341
1342         return 0;
1343 }
1344
1345 enum ath5k_rfgain ath5k_hw_get_rf_gain(struct ath5k_hw *ah)
1346 {
1347         u32 data, type;
1348
1349         ATH5K_TRACE(ah->ah_sc);
1350
1351         if (ah->ah_rf_banks == NULL || !ah->ah_gain.g_active ||
1352                         ah->ah_version <= AR5K_AR5211)
1353                 return AR5K_RFGAIN_INACTIVE;
1354
1355         if (ah->ah_rf_gain != AR5K_RFGAIN_READ_REQUESTED)
1356                 goto done;
1357
1358         data = ath5k_hw_reg_read(ah, AR5K_PHY_PAPD_PROBE);
1359
1360         if (!(data & AR5K_PHY_PAPD_PROBE_TX_NEXT)) {
1361                 ah->ah_gain.g_current = data >> AR5K_PHY_PAPD_PROBE_GAINF_S;
1362                 type = AR5K_REG_MS(data, AR5K_PHY_PAPD_PROBE_TYPE);
1363
1364                 if (type == AR5K_PHY_PAPD_PROBE_TYPE_CCK)
1365                         ah->ah_gain.g_current += AR5K_GAIN_CCK_PROBE_CORR;
1366
1367                 if (ah->ah_radio >= AR5K_RF5112) {
1368                         ath5k_hw_rfregs_gainf_corr(ah);
1369                         ah->ah_gain.g_current =
1370                                 ah->ah_gain.g_current>=ah->ah_gain.g_f_corr ?
1371                                 (ah->ah_gain.g_current-ah->ah_gain.g_f_corr) :
1372                                 0;
1373                 }
1374
1375                 if (ath5k_hw_rfregs_gain_readback(ah) &&
1376                                 AR5K_GAIN_CHECK_ADJUST(&ah->ah_gain) &&
1377                                 ath5k_hw_rfregs_gain_adjust(ah))
1378                         ah->ah_rf_gain = AR5K_RFGAIN_NEED_CHANGE;
1379         }
1380
1381 done:
1382         return ah->ah_rf_gain;
1383 }
1384
1385 int ath5k_hw_set_rfgain_opt(struct ath5k_hw *ah)
1386 {
1387         /* Initialize the gain optimization values */
1388         switch (ah->ah_radio) {
1389         case AR5K_RF5111:
1390                 ah->ah_gain.g_step_idx = rfgain_opt_5111.go_default;
1391                 ah->ah_gain.g_step =
1392                     &rfgain_opt_5111.go_step[ah->ah_gain.g_step_idx];
1393                 ah->ah_gain.g_low = 20;
1394                 ah->ah_gain.g_high = 35;
1395                 ah->ah_gain.g_active = 1;
1396                 break;
1397         case AR5K_RF5112:
1398         case AR5K_RF5413: /* ??? */
1399                 ah->ah_gain.g_step_idx = rfgain_opt_5112.go_default;
1400                 ah->ah_gain.g_step =
1401                     &rfgain_opt_5112.go_step[ah->ah_gain.g_step_idx];
1402                 ah->ah_gain.g_low = 20;
1403                 ah->ah_gain.g_high = 85;
1404                 ah->ah_gain.g_active = 1;
1405                 break;
1406         default:
1407                 return -EINVAL;
1408         }
1409
1410         return 0;
1411 }
1412
1413 /**************************\
1414   PHY/RF channel functions
1415 \**************************/
1416
1417 /*
1418  * Check if a channel is supported
1419  */
1420 bool ath5k_channel_ok(struct ath5k_hw *ah, u16 freq, unsigned int flags)
1421 {
1422         /* Check if the channel is in our supported range */
1423         if (flags & CHANNEL_2GHZ) {
1424                 if ((freq >= ah->ah_capabilities.cap_range.range_2ghz_min) &&
1425                     (freq <= ah->ah_capabilities.cap_range.range_2ghz_max))
1426                         return true;
1427         } else if (flags & CHANNEL_5GHZ)
1428                 if ((freq >= ah->ah_capabilities.cap_range.range_5ghz_min) &&
1429                     (freq <= ah->ah_capabilities.cap_range.range_5ghz_max))
1430                         return true;
1431
1432         return false;
1433 }
1434
1435 /*
1436  * Convertion needed for RF5110
1437  */
1438 static u32 ath5k_hw_rf5110_chan2athchan(struct ieee80211_channel *channel)
1439 {
1440         u32 athchan;
1441
1442         /*
1443          * Convert IEEE channel/MHz to an internal channel value used
1444          * by the AR5210 chipset. This has not been verified with
1445          * newer chipsets like the AR5212A who have a completely
1446          * different RF/PHY part.
1447          */
1448         athchan = (ath5k_hw_bitswap((channel->chan - 24) / 2, 5) << 1) |
1449                 (1 << 6) | 0x1;
1450
1451         return athchan;
1452 }
1453
1454 /*
1455  * Set channel on RF5110
1456  */
1457 static int ath5k_hw_rf5110_channel(struct ath5k_hw *ah,
1458                 struct ieee80211_channel *channel)
1459 {
1460         u32 data;
1461
1462         /*
1463          * Set the channel and wait
1464          */
1465         data = ath5k_hw_rf5110_chan2athchan(channel);
1466         ath5k_hw_reg_write(ah, data, AR5K_RF_BUFFER);
1467         ath5k_hw_reg_write(ah, 0, AR5K_RF_BUFFER_CONTROL_0);
1468         mdelay(1);
1469
1470         return 0;
1471 }
1472
1473 /*
1474  * Convertion needed for 5111
1475  */
1476 static int ath5k_hw_rf5111_chan2athchan(unsigned int ieee,
1477                 struct ath5k_athchan_2ghz *athchan)
1478 {
1479         int channel;
1480
1481         /* Cast this value to catch negative channel numbers (>= -19) */
1482         channel = (int)ieee;
1483
1484         /*
1485          * Map 2GHz IEEE channel to 5GHz Atheros channel
1486          */
1487         if (channel <= 13) {
1488                 athchan->a2_athchan = 115 + channel;
1489                 athchan->a2_flags = 0x46;
1490         } else if (channel == 14) {
1491                 athchan->a2_athchan = 124;
1492                 athchan->a2_flags = 0x44;
1493         } else if (channel >= 15 && channel <= 26) {
1494                 athchan->a2_athchan = ((channel - 14) * 4) + 132;
1495                 athchan->a2_flags = 0x46;
1496         } else
1497                 return -EINVAL;
1498
1499         return 0;
1500 }
1501
1502 /*
1503  * Set channel on 5111
1504  */
1505 static int ath5k_hw_rf5111_channel(struct ath5k_hw *ah,
1506                 struct ieee80211_channel *channel)
1507 {
1508         struct ath5k_athchan_2ghz ath5k_channel_2ghz;
1509         unsigned int ath5k_channel = channel->chan;
1510         u32 data0, data1, clock;
1511         int ret;
1512
1513         /*
1514          * Set the channel on the RF5111 radio
1515          */
1516         data0 = data1 = 0;
1517
1518         if (channel->val & CHANNEL_2GHZ) {
1519                 /* Map 2GHz channel to 5GHz Atheros channel ID */
1520                 ret = ath5k_hw_rf5111_chan2athchan(channel->chan,
1521                                 &ath5k_channel_2ghz);
1522                 if (ret)
1523                         return ret;
1524
1525                 ath5k_channel = ath5k_channel_2ghz.a2_athchan;
1526                 data0 = ((ath5k_hw_bitswap(ath5k_channel_2ghz.a2_flags, 8) & 0xff)
1527                     << 5) | (1 << 4);
1528         }
1529
1530         if (ath5k_channel < 145 || !(ath5k_channel & 1)) {
1531                 clock = 1;
1532                 data1 = ((ath5k_hw_bitswap(ath5k_channel - 24, 8) & 0xff) << 2) |
1533                         (clock << 1) | (1 << 10) | 1;
1534         } else {
1535                 clock = 0;
1536                 data1 = ((ath5k_hw_bitswap((ath5k_channel - 24) / 2, 8) & 0xff)
1537                         << 2) | (clock << 1) | (1 << 10) | 1;
1538         }
1539
1540         ath5k_hw_reg_write(ah, (data1 & 0xff) | ((data0 & 0xff) << 8),
1541                         AR5K_RF_BUFFER);
1542         ath5k_hw_reg_write(ah, ((data1 >> 8) & 0xff) | (data0 & 0xff00),
1543                         AR5K_RF_BUFFER_CONTROL_3);
1544
1545         return 0;
1546 }
1547
1548 /*
1549  * Set channel on 5112 and newer
1550  */
1551 static int ath5k_hw_rf5112_channel(struct ath5k_hw *ah,
1552                 struct ieee80211_channel *channel)
1553 {
1554         u32 data, data0, data1, data2;
1555         u16 c;
1556
1557         data = data0 = data1 = data2 = 0;
1558         c = channel->freq;
1559
1560         /*
1561          * Set the channel on the RF5112 or newer
1562          */
1563         if (c < 4800) {
1564                 if (!((c - 2224) % 5)) {
1565                         data0 = ((2 * (c - 704)) - 3040) / 10;
1566                         data1 = 1;
1567                 } else if (!((c - 2192) % 5)) {
1568                         data0 = ((2 * (c - 672)) - 3040) / 10;
1569                         data1 = 0;
1570                 } else
1571                         return -EINVAL;
1572
1573                 data0 = ath5k_hw_bitswap((data0 << 2) & 0xff, 8);
1574         } else {
1575                 if (!(c % 20) && c >= 5120) {
1576                         data0 = ath5k_hw_bitswap(((c - 4800) / 20 << 2), 8);
1577                         data2 = ath5k_hw_bitswap(3, 2);
1578                 } else if (!(c % 10)) {
1579                         data0 = ath5k_hw_bitswap(((c - 4800) / 10 << 1), 8);
1580                         data2 = ath5k_hw_bitswap(2, 2);
1581                 } else if (!(c % 5)) {
1582                         data0 = ath5k_hw_bitswap((c - 4800) / 5, 8);
1583                         data2 = ath5k_hw_bitswap(1, 2);
1584                 } else
1585                         return -EINVAL;
1586         }
1587
1588         data = (data0 << 4) | (data1 << 1) | (data2 << 2) | 0x1001;
1589
1590         ath5k_hw_reg_write(ah, data & 0xff, AR5K_RF_BUFFER);
1591         ath5k_hw_reg_write(ah, (data >> 8) & 0x7f, AR5K_RF_BUFFER_CONTROL_5);
1592
1593         return 0;
1594 }
1595
1596 /*
1597  * Set a channel on the radio chip
1598  */
1599 int ath5k_hw_channel(struct ath5k_hw *ah, struct ieee80211_channel *channel)
1600 {
1601         int ret;
1602
1603         /*
1604          * Check bounds supported by the PHY
1605          * (don't care about regulation restrictions at this point)
1606          */
1607         if ((channel->freq < ah->ah_capabilities.cap_range.range_2ghz_min ||
1608             channel->freq > ah->ah_capabilities.cap_range.range_2ghz_max) &&
1609             (channel->freq < ah->ah_capabilities.cap_range.range_5ghz_min ||
1610             channel->freq > ah->ah_capabilities.cap_range.range_5ghz_max)) {
1611                 ATH5K_ERR(ah->ah_sc,
1612                         "channel out of supported range (%u MHz)\n",
1613                         channel->freq);
1614                 return -EINVAL;
1615         }
1616
1617         /*
1618          * Set the channel and wait
1619          */
1620         switch (ah->ah_radio) {
1621         case AR5K_RF5110:
1622                 ret = ath5k_hw_rf5110_channel(ah, channel);
1623                 break;
1624         case AR5K_RF5111:
1625                 ret = ath5k_hw_rf5111_channel(ah, channel);
1626                 break;
1627         default:
1628                 ret = ath5k_hw_rf5112_channel(ah, channel);
1629                 break;
1630         }
1631
1632         if (ret)
1633                 return ret;
1634
1635         ah->ah_current_channel.freq = channel->freq;
1636         ah->ah_current_channel.val = channel->val;
1637         ah->ah_turbo = channel->val == CHANNEL_T ? true : false;
1638
1639         return 0;
1640 }
1641
1642 /*****************\
1643   PHY calibration
1644 \*****************/
1645
1646 /**
1647  * ath5k_hw_noise_floor_calibration - perform PHY noise floor calibration
1648  *
1649  * @ah: struct ath5k_hw pointer we are operating on
1650  * @freq: the channel frequency, just used for error logging
1651  *
1652  * This function performs a noise floor calibration of the PHY and waits for
1653  * it to complete. Then the noise floor value is compared to some maximum
1654  * noise floor we consider valid.
1655  *
1656  * Note that this is different from what the madwifi HAL does: it reads the
1657  * noise floor and afterwards initiates the calibration. Since the noise floor
1658  * calibration can take some time to finish, depending on the current channel
1659  * use, that avoids the occasional timeout warnings we are seeing now.
1660  *
1661  * See the following link for an Atheros patent on noise floor calibration:
1662  * http://patft.uspto.gov/netacgi/nph-Parser?Sect1=PTO1&Sect2=HITOFF&d=PALL \
1663  * &p=1&u=%2Fnetahtml%2FPTO%2Fsrchnum.htm&r=1&f=G&l=50&s1=7245893.PN.&OS=PN/7
1664  *
1665  */
1666 int
1667 ath5k_hw_noise_floor_calibration(struct ath5k_hw *ah, short freq)
1668 {
1669         int ret;
1670         unsigned int i;
1671         s32 noise_floor;
1672
1673         /*
1674          * Enable noise floor calibration and wait until completion
1675          */
1676         AR5K_REG_ENABLE_BITS(ah, AR5K_PHY_AGCCTL,
1677                                 AR5K_PHY_AGCCTL_NF);
1678
1679         ret = ath5k_hw_register_timeout(ah, AR5K_PHY_AGCCTL,
1680                         AR5K_PHY_AGCCTL_NF, 0, false);
1681         if (ret) {
1682                 ATH5K_ERR(ah->ah_sc,
1683                         "noise floor calibration timeout (%uMHz)\n", freq);
1684                 return ret;
1685         }
1686
1687         /* Wait until the noise floor is calibrated and read the value */
1688         for (i = 20; i > 0; i--) {
1689                 mdelay(1);
1690                 noise_floor = ath5k_hw_reg_read(ah, AR5K_PHY_NF);
1691                 noise_floor = AR5K_PHY_NF_RVAL(noise_floor);
1692                 if (noise_floor & AR5K_PHY_NF_ACTIVE) {
1693                         noise_floor = AR5K_PHY_NF_AVAL(noise_floor);
1694
1695                         if (noise_floor <= AR5K_TUNE_NOISE_FLOOR)
1696                                 break;
1697                 }
1698         }
1699
1700         ATH5K_DBG_UNLIMIT(ah->ah_sc, ATH5K_DEBUG_CALIBRATE,
1701                 "noise floor %d\n", noise_floor);
1702
1703         if (noise_floor > AR5K_TUNE_NOISE_FLOOR) {
1704                 ATH5K_ERR(ah->ah_sc,
1705                         "noise floor calibration failed (%uMHz)\n", freq);
1706                 return -EIO;
1707         }
1708
1709         ah->ah_noise_floor = noise_floor;
1710
1711         return 0;
1712 }
1713
1714 /*
1715  * Perform a PHY calibration on RF5110
1716  * -Fix BPSK/QAM Constellation (I/Q correction)
1717  * -Calculate Noise Floor
1718  */
1719 static int ath5k_hw_rf5110_calibrate(struct ath5k_hw *ah,
1720                 struct ieee80211_channel *channel)
1721 {
1722         u32 phy_sig, phy_agc, phy_sat, beacon;
1723         int ret;
1724
1725         /*
1726          * Disable beacons and RX/TX queues, wait
1727          */
1728         AR5K_REG_ENABLE_BITS(ah, AR5K_DIAG_SW_5210,
1729                 AR5K_DIAG_SW_DIS_TX | AR5K_DIAG_SW_DIS_RX_5210);
1730         beacon = ath5k_hw_reg_read(ah, AR5K_BEACON_5210);
1731         ath5k_hw_reg_write(ah, beacon & ~AR5K_BEACON_ENABLE, AR5K_BEACON_5210);
1732
1733         udelay(2300);
1734
1735         /*
1736          * Set the channel (with AGC turned off)
1737          */
1738         AR5K_REG_ENABLE_BITS(ah, AR5K_PHY_AGC, AR5K_PHY_AGC_DISABLE);
1739         udelay(10);
1740         ret = ath5k_hw_channel(ah, channel);
1741
1742         /*
1743          * Activate PHY and wait
1744          */
1745         ath5k_hw_reg_write(ah, AR5K_PHY_ACT_ENABLE, AR5K_PHY_ACT);
1746         mdelay(1);
1747
1748         AR5K_REG_DISABLE_BITS(ah, AR5K_PHY_AGC, AR5K_PHY_AGC_DISABLE);
1749
1750         if (ret)
1751                 return ret;
1752
1753         /*
1754          * Calibrate the radio chip
1755          */
1756
1757         /* Remember normal state */
1758         phy_sig = ath5k_hw_reg_read(ah, AR5K_PHY_SIG);
1759         phy_agc = ath5k_hw_reg_read(ah, AR5K_PHY_AGCCOARSE);
1760         phy_sat = ath5k_hw_reg_read(ah, AR5K_PHY_ADCSAT);
1761
1762         /* Update radio registers */
1763         ath5k_hw_reg_write(ah, (phy_sig & ~(AR5K_PHY_SIG_FIRPWR)) |
1764                 AR5K_REG_SM(-1, AR5K_PHY_SIG_FIRPWR), AR5K_PHY_SIG);
1765
1766         ath5k_hw_reg_write(ah, (phy_agc & ~(AR5K_PHY_AGCCOARSE_HI |
1767                         AR5K_PHY_AGCCOARSE_LO)) |
1768                 AR5K_REG_SM(-1, AR5K_PHY_AGCCOARSE_HI) |
1769                 AR5K_REG_SM(-127, AR5K_PHY_AGCCOARSE_LO), AR5K_PHY_AGCCOARSE);
1770
1771         ath5k_hw_reg_write(ah, (phy_sat & ~(AR5K_PHY_ADCSAT_ICNT |
1772                         AR5K_PHY_ADCSAT_THR)) |
1773                 AR5K_REG_SM(2, AR5K_PHY_ADCSAT_ICNT) |
1774                 AR5K_REG_SM(12, AR5K_PHY_ADCSAT_THR), AR5K_PHY_ADCSAT);
1775
1776         udelay(20);
1777
1778         AR5K_REG_ENABLE_BITS(ah, AR5K_PHY_AGC, AR5K_PHY_AGC_DISABLE);
1779         udelay(10);
1780         ath5k_hw_reg_write(ah, AR5K_PHY_RFSTG_DISABLE, AR5K_PHY_RFSTG);
1781         AR5K_REG_DISABLE_BITS(ah, AR5K_PHY_AGC, AR5K_PHY_AGC_DISABLE);
1782
1783         mdelay(1);
1784
1785         /*
1786          * Enable calibration and wait until completion
1787          */
1788         AR5K_REG_ENABLE_BITS(ah, AR5K_PHY_AGCCTL, AR5K_PHY_AGCCTL_CAL);
1789
1790         ret = ath5k_hw_register_timeout(ah, AR5K_PHY_AGCCTL,
1791                         AR5K_PHY_AGCCTL_CAL, 0, false);
1792
1793         /* Reset to normal state */
1794         ath5k_hw_reg_write(ah, phy_sig, AR5K_PHY_SIG);
1795         ath5k_hw_reg_write(ah, phy_agc, AR5K_PHY_AGCCOARSE);
1796         ath5k_hw_reg_write(ah, phy_sat, AR5K_PHY_ADCSAT);
1797
1798         if (ret) {
1799                 ATH5K_ERR(ah->ah_sc, "calibration timeout (%uMHz)\n",
1800                                 channel->freq);
1801                 return ret;
1802         }
1803
1804         ret = ath5k_hw_noise_floor_calibration(ah, channel->freq);
1805         if (ret)
1806                 return ret;
1807
1808         /*
1809          * Re-enable RX/TX and beacons
1810          */
1811         AR5K_REG_DISABLE_BITS(ah, AR5K_DIAG_SW_5210,
1812                 AR5K_DIAG_SW_DIS_TX | AR5K_DIAG_SW_DIS_RX_5210);
1813         ath5k_hw_reg_write(ah, beacon, AR5K_BEACON_5210);
1814
1815         return 0;
1816 }
1817
1818 /*
1819  * Perform a PHY calibration on RF5111/5112
1820  */
1821 static int ath5k_hw_rf511x_calibrate(struct ath5k_hw *ah,
1822                 struct ieee80211_channel *channel)
1823 {
1824         u32 i_pwr, q_pwr;
1825         s32 iq_corr, i_coff, i_coffd, q_coff, q_coffd;
1826         ATH5K_TRACE(ah->ah_sc);
1827
1828         if (ah->ah_calibration == false ||
1829                         ath5k_hw_reg_read(ah, AR5K_PHY_IQ) & AR5K_PHY_IQ_RUN)
1830                 goto done;
1831
1832         ah->ah_calibration = false;
1833
1834         iq_corr = ath5k_hw_reg_read(ah, AR5K_PHY_IQRES_CAL_CORR);
1835         i_pwr = ath5k_hw_reg_read(ah, AR5K_PHY_IQRES_CAL_PWR_I);
1836         q_pwr = ath5k_hw_reg_read(ah, AR5K_PHY_IQRES_CAL_PWR_Q);
1837         i_coffd = ((i_pwr >> 1) + (q_pwr >> 1)) >> 7;
1838         q_coffd = q_pwr >> 6;
1839
1840         if (i_coffd == 0 || q_coffd == 0)
1841                 goto done;
1842
1843         i_coff = ((-iq_corr) / i_coffd) & 0x3f;
1844         q_coff = (((s32)i_pwr / q_coffd) - 64) & 0x1f;
1845
1846         /* Commit new IQ value */
1847         AR5K_REG_ENABLE_BITS(ah, AR5K_PHY_IQ, AR5K_PHY_IQ_CORR_ENABLE |
1848                 ((u32)q_coff) | ((u32)i_coff << AR5K_PHY_IQ_CORR_Q_I_COFF_S));
1849
1850 done:
1851         ath5k_hw_noise_floor_calibration(ah, channel->freq);
1852
1853         /* Request RF gain */
1854         if (channel->val & CHANNEL_5GHZ) {
1855                 ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txpower.txp_max,
1856                         AR5K_PHY_PAPD_PROBE_TXPOWER) |
1857                         AR5K_PHY_PAPD_PROBE_TX_NEXT, AR5K_PHY_PAPD_PROBE);
1858                 ah->ah_rf_gain = AR5K_RFGAIN_READ_REQUESTED;
1859         }
1860
1861         return 0;
1862 }
1863
1864 /*
1865  * Perform a PHY calibration
1866  */
1867 int ath5k_hw_phy_calibrate(struct ath5k_hw *ah,
1868                 struct ieee80211_channel *channel)
1869 {
1870         int ret;
1871
1872         if (ah->ah_radio == AR5K_RF5110)
1873                 ret = ath5k_hw_rf5110_calibrate(ah, channel);
1874         else
1875                 ret = ath5k_hw_rf511x_calibrate(ah, channel);
1876
1877         return ret;
1878 }
1879
1880 int ath5k_hw_phy_disable(struct ath5k_hw *ah)
1881 {
1882         ATH5K_TRACE(ah->ah_sc);
1883         /*Just a try M.F.*/
1884         ath5k_hw_reg_write(ah, AR5K_PHY_ACT_DISABLE, AR5K_PHY_ACT);
1885
1886         return 0;
1887 }
1888
1889 /********************\
1890   Misc PHY functions
1891 \********************/
1892
1893 /*
1894  * Get the PHY Chip revision
1895  */
1896 u16 ath5k_hw_radio_revision(struct ath5k_hw *ah, unsigned int chan)
1897 {
1898         unsigned int i;
1899         u32 srev;
1900         u16 ret;
1901
1902         ATH5K_TRACE(ah->ah_sc);
1903
1904         /*
1905          * Set the radio chip access register
1906          */
1907         switch (chan) {
1908         case CHANNEL_2GHZ:
1909                 ath5k_hw_reg_write(ah, AR5K_PHY_SHIFT_2GHZ, AR5K_PHY(0));
1910                 break;
1911         case CHANNEL_5GHZ:
1912                 ath5k_hw_reg_write(ah, AR5K_PHY_SHIFT_5GHZ, AR5K_PHY(0));
1913                 break;
1914         default:
1915                 return 0;
1916         }
1917
1918         mdelay(2);
1919
1920         /* ...wait until PHY is ready and read the selected radio revision */
1921         ath5k_hw_reg_write(ah, 0x00001c16, AR5K_PHY(0x34));
1922
1923         for (i = 0; i < 8; i++)
1924                 ath5k_hw_reg_write(ah, 0x00010000, AR5K_PHY(0x20));
1925
1926         if (ah->ah_version == AR5K_AR5210) {
1927                 srev = ath5k_hw_reg_read(ah, AR5K_PHY(256) >> 28) & 0xf;
1928                 ret = (u16)ath5k_hw_bitswap(srev, 4) + 1;
1929         } else {
1930                 srev = (ath5k_hw_reg_read(ah, AR5K_PHY(0x100)) >> 24) & 0xff;
1931                 ret = (u16)ath5k_hw_bitswap(((srev & 0xf0) >> 4) |
1932                                 ((srev & 0x0f) << 4), 8);
1933         }
1934
1935         /* Reset to the 5GHz mode */
1936         ath5k_hw_reg_write(ah, AR5K_PHY_SHIFT_5GHZ, AR5K_PHY(0));
1937
1938         return ret;
1939 }
1940
1941 void /*TODO:Boundary check*/
1942 ath5k_hw_set_def_antenna(struct ath5k_hw *ah, unsigned int ant)
1943 {
1944         ATH5K_TRACE(ah->ah_sc);
1945         /*Just a try M.F.*/
1946         if (ah->ah_version != AR5K_AR5210)
1947                 ath5k_hw_reg_write(ah, ant, AR5K_DEFAULT_ANTENNA);
1948 }
1949
1950 unsigned int ath5k_hw_get_def_antenna(struct ath5k_hw *ah)
1951 {
1952         ATH5K_TRACE(ah->ah_sc);
1953         /*Just a try M.F.*/
1954         if (ah->ah_version != AR5K_AR5210)
1955                 return ath5k_hw_reg_read(ah, AR5K_DEFAULT_ANTENNA);
1956
1957         return false; /*XXX: What do we return for 5210 ?*/
1958 }
1959
1960 /*
1961  * TX power setup
1962  */
1963
1964 /*
1965  * Initialize the tx power table (not fully implemented)
1966  */
1967 static void ath5k_txpower_table(struct ath5k_hw *ah,
1968                 struct ieee80211_channel *channel, s16 max_power)
1969 {
1970         unsigned int i, min, max, n;
1971         u16 txpower, *rates;
1972
1973         rates = ah->ah_txpower.txp_rates;
1974
1975         txpower = AR5K_TUNE_DEFAULT_TXPOWER * 2;
1976         if (max_power > txpower)
1977                 txpower = max_power > AR5K_TUNE_MAX_TXPOWER ?
1978                     AR5K_TUNE_MAX_TXPOWER : max_power;
1979
1980         for (i = 0; i < AR5K_MAX_RATES; i++)
1981                 rates[i] = txpower;
1982
1983         /* XXX setup target powers by rate */
1984
1985         ah->ah_txpower.txp_min = rates[7];
1986         ah->ah_txpower.txp_max = rates[0];
1987         ah->ah_txpower.txp_ofdm = rates[0];
1988
1989         /* Calculate the power table */
1990         n = ARRAY_SIZE(ah->ah_txpower.txp_pcdac);
1991         min = AR5K_EEPROM_PCDAC_START;
1992         max = AR5K_EEPROM_PCDAC_STOP;
1993         for (i = 0; i < n; i += AR5K_EEPROM_PCDAC_STEP)
1994                 ah->ah_txpower.txp_pcdac[i] =
1995 #ifdef notyet
1996                 min + ((i * (max - min)) / n);
1997 #else
1998                 min;
1999 #endif
2000 }
2001
2002 /*
2003  * Set transmition power
2004  */
2005 int /*O.K. - txpower_table is unimplemented so this doesn't work*/
2006 ath5k_hw_txpower(struct ath5k_hw *ah, struct ieee80211_channel *channel,
2007                 unsigned int txpower)
2008 {
2009         bool tpc = ah->ah_txpower.txp_tpc;
2010         unsigned int i;
2011
2012         ATH5K_TRACE(ah->ah_sc);
2013         if (txpower > AR5K_TUNE_MAX_TXPOWER) {
2014                 ATH5K_ERR(ah->ah_sc, "invalid tx power: %u\n", txpower);
2015                 return -EINVAL;
2016         }
2017
2018         /* Reset TX power values */
2019         memset(&ah->ah_txpower, 0, sizeof(ah->ah_txpower));
2020         ah->ah_txpower.txp_tpc = tpc;
2021
2022         /* Initialize TX power table */
2023         ath5k_txpower_table(ah, channel, txpower);
2024
2025         /*
2026          * Write TX power values
2027          */
2028         for (i = 0; i < (AR5K_EEPROM_POWER_TABLE_SIZE / 2); i++) {
2029                 ath5k_hw_reg_write(ah,
2030                         ((((ah->ah_txpower.txp_pcdac[(i << 1) + 1] << 8) | 0xff) & 0xffff) << 16) |
2031                         (((ah->ah_txpower.txp_pcdac[(i << 1)    ] << 8) | 0xff) & 0xffff),
2032                         AR5K_PHY_PCDAC_TXPOWER(i));
2033         }
2034
2035         ath5k_hw_reg_write(ah, AR5K_TXPOWER_OFDM(3, 24) |
2036                 AR5K_TXPOWER_OFDM(2, 16) | AR5K_TXPOWER_OFDM(1, 8) |
2037                 AR5K_TXPOWER_OFDM(0, 0), AR5K_PHY_TXPOWER_RATE1);
2038
2039         ath5k_hw_reg_write(ah, AR5K_TXPOWER_OFDM(7, 24) |
2040                 AR5K_TXPOWER_OFDM(6, 16) | AR5K_TXPOWER_OFDM(5, 8) |
2041                 AR5K_TXPOWER_OFDM(4, 0), AR5K_PHY_TXPOWER_RATE2);
2042
2043         ath5k_hw_reg_write(ah, AR5K_TXPOWER_CCK(10, 24) |
2044                 AR5K_TXPOWER_CCK(9, 16) | AR5K_TXPOWER_CCK(15, 8) |
2045                 AR5K_TXPOWER_CCK(8, 0), AR5K_PHY_TXPOWER_RATE3);
2046
2047         ath5k_hw_reg_write(ah, AR5K_TXPOWER_CCK(14, 24) |
2048                 AR5K_TXPOWER_CCK(13, 16) | AR5K_TXPOWER_CCK(12, 8) |
2049                 AR5K_TXPOWER_CCK(11, 0), AR5K_PHY_TXPOWER_RATE4);
2050
2051         if (ah->ah_txpower.txp_tpc == true)
2052                 ath5k_hw_reg_write(ah, AR5K_PHY_TXPOWER_RATE_MAX_TPC_ENABLE |
2053                         AR5K_TUNE_MAX_TXPOWER, AR5K_PHY_TXPOWER_RATE_MAX);
2054         else
2055                 ath5k_hw_reg_write(ah, AR5K_PHY_TXPOWER_RATE_MAX |
2056                         AR5K_TUNE_MAX_TXPOWER, AR5K_PHY_TXPOWER_RATE_MAX);
2057
2058         return 0;
2059 }
2060
2061 int ath5k_hw_set_txpower_limit(struct ath5k_hw *ah, unsigned int power)
2062 {
2063         /*Just a try M.F.*/
2064         struct ieee80211_channel *channel = &ah->ah_current_channel;
2065
2066         ATH5K_TRACE(ah->ah_sc);
2067         ATH5K_DBG(ah->ah_sc, ATH5K_DEBUG_TXPOWER,
2068                 "changing txpower to %d\n", power);
2069
2070         return ath5k_hw_txpower(ah, channel, power);
2071 }