]> Pileus Git - ~andy/linux/blob - drivers/net/wireless/ath5k/phy.c
248c0f545f249b0213d499f8629c231f23d230ad
[~andy/linux] / 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_MODE_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->hw_value & CHANNEL_2GHZ) {
1042                 if (channel->hw_value & 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->center_freq >= 5725 ? 3 :
1062                         (channel->center_freq >= 5500 ? 2 :
1063                         (channel->center_freq >= 5260 ? 1 :
1064                          (channel->center_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_MODE_MAX);
1123
1124         rf = ah->ah_rf_banks;
1125
1126         if (ah->ah_radio_5ghz_revision >= AR5K_SREV_RAD_2112A
1127                 && !test_bit(AR5K_MODE_11A, 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->hw_value & CHANNEL_2GHZ) {
1160                 if (channel->hw_value & 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->center_freq >= 5725 ? 3 :
1177                     (channel->center_freq >= 5500 ? 2 :
1178                         (channel->center_freq >= 5260 ? 1 :
1179                             (channel->center_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_MODE_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(
1449                         (ieee80211_frequency_to_channel(
1450                                 channel->center_freq) - 24) / 2, 5)
1451                                 << 1) | (1 << 6) | 0x1;
1452         return athchan;
1453 }
1454
1455 /*
1456  * Set channel on RF5110
1457  */
1458 static int ath5k_hw_rf5110_channel(struct ath5k_hw *ah,
1459                 struct ieee80211_channel *channel)
1460 {
1461         u32 data;
1462
1463         /*
1464          * Set the channel and wait
1465          */
1466         data = ath5k_hw_rf5110_chan2athchan(channel);
1467         ath5k_hw_reg_write(ah, data, AR5K_RF_BUFFER);
1468         ath5k_hw_reg_write(ah, 0, AR5K_RF_BUFFER_CONTROL_0);
1469         mdelay(1);
1470
1471         return 0;
1472 }
1473
1474 /*
1475  * Convertion needed for 5111
1476  */
1477 static int ath5k_hw_rf5111_chan2athchan(unsigned int ieee,
1478                 struct ath5k_athchan_2ghz *athchan)
1479 {
1480         int channel;
1481
1482         /* Cast this value to catch negative channel numbers (>= -19) */
1483         channel = (int)ieee;
1484
1485         /*
1486          * Map 2GHz IEEE channel to 5GHz Atheros channel
1487          */
1488         if (channel <= 13) {
1489                 athchan->a2_athchan = 115 + channel;
1490                 athchan->a2_flags = 0x46;
1491         } else if (channel == 14) {
1492                 athchan->a2_athchan = 124;
1493                 athchan->a2_flags = 0x44;
1494         } else if (channel >= 15 && channel <= 26) {
1495                 athchan->a2_athchan = ((channel - 14) * 4) + 132;
1496                 athchan->a2_flags = 0x46;
1497         } else
1498                 return -EINVAL;
1499
1500         return 0;
1501 }
1502
1503 /*
1504  * Set channel on 5111
1505  */
1506 static int ath5k_hw_rf5111_channel(struct ath5k_hw *ah,
1507                 struct ieee80211_channel *channel)
1508 {
1509         struct ath5k_athchan_2ghz ath5k_channel_2ghz;
1510         unsigned int ath5k_channel =
1511                 ieee80211_frequency_to_channel(channel->center_freq);
1512         u32 data0, data1, clock;
1513         int ret;
1514
1515         /*
1516          * Set the channel on the RF5111 radio
1517          */
1518         data0 = data1 = 0;
1519
1520         if (channel->hw_value & CHANNEL_2GHZ) {
1521                 /* Map 2GHz channel to 5GHz Atheros channel ID */
1522                 ret = ath5k_hw_rf5111_chan2athchan(
1523                         ieee80211_frequency_to_channel(channel->center_freq),
1524                         &ath5k_channel_2ghz);
1525                 if (ret)
1526                         return ret;
1527
1528                 ath5k_channel = ath5k_channel_2ghz.a2_athchan;
1529                 data0 = ((ath5k_hw_bitswap(ath5k_channel_2ghz.a2_flags, 8) & 0xff)
1530                     << 5) | (1 << 4);
1531         }
1532
1533         if (ath5k_channel < 145 || !(ath5k_channel & 1)) {
1534                 clock = 1;
1535                 data1 = ((ath5k_hw_bitswap(ath5k_channel - 24, 8) & 0xff) << 2) |
1536                         (clock << 1) | (1 << 10) | 1;
1537         } else {
1538                 clock = 0;
1539                 data1 = ((ath5k_hw_bitswap((ath5k_channel - 24) / 2, 8) & 0xff)
1540                         << 2) | (clock << 1) | (1 << 10) | 1;
1541         }
1542
1543         ath5k_hw_reg_write(ah, (data1 & 0xff) | ((data0 & 0xff) << 8),
1544                         AR5K_RF_BUFFER);
1545         ath5k_hw_reg_write(ah, ((data1 >> 8) & 0xff) | (data0 & 0xff00),
1546                         AR5K_RF_BUFFER_CONTROL_3);
1547
1548         return 0;
1549 }
1550
1551 /*
1552  * Set channel on 5112 and newer
1553  */
1554 static int ath5k_hw_rf5112_channel(struct ath5k_hw *ah,
1555                 struct ieee80211_channel *channel)
1556 {
1557         u32 data, data0, data1, data2;
1558         u16 c;
1559
1560         data = data0 = data1 = data2 = 0;
1561         c = channel->center_freq;
1562
1563         /*
1564          * Set the channel on the RF5112 or newer
1565          */
1566         if (c < 4800) {
1567                 if (!((c - 2224) % 5)) {
1568                         data0 = ((2 * (c - 704)) - 3040) / 10;
1569                         data1 = 1;
1570                 } else if (!((c - 2192) % 5)) {
1571                         data0 = ((2 * (c - 672)) - 3040) / 10;
1572                         data1 = 0;
1573                 } else
1574                         return -EINVAL;
1575
1576                 data0 = ath5k_hw_bitswap((data0 << 2) & 0xff, 8);
1577         } else {
1578                 if (!(c % 20) && c >= 5120) {
1579                         data0 = ath5k_hw_bitswap(((c - 4800) / 20 << 2), 8);
1580                         data2 = ath5k_hw_bitswap(3, 2);
1581                 } else if (!(c % 10)) {
1582                         data0 = ath5k_hw_bitswap(((c - 4800) / 10 << 1), 8);
1583                         data2 = ath5k_hw_bitswap(2, 2);
1584                 } else if (!(c % 5)) {
1585                         data0 = ath5k_hw_bitswap((c - 4800) / 5, 8);
1586                         data2 = ath5k_hw_bitswap(1, 2);
1587                 } else
1588                         return -EINVAL;
1589         }
1590
1591         data = (data0 << 4) | (data1 << 1) | (data2 << 2) | 0x1001;
1592
1593         ath5k_hw_reg_write(ah, data & 0xff, AR5K_RF_BUFFER);
1594         ath5k_hw_reg_write(ah, (data >> 8) & 0x7f, AR5K_RF_BUFFER_CONTROL_5);
1595
1596         return 0;
1597 }
1598
1599 /*
1600  * Set a channel on the radio chip
1601  */
1602 int ath5k_hw_channel(struct ath5k_hw *ah, struct ieee80211_channel *channel)
1603 {
1604         int ret;
1605         /*
1606          * Check bounds supported by the PHY (we don't care about regultory
1607          * restrictions at this point). Note: hw_value already has the band
1608          * (CHANNEL_2GHZ, or CHANNEL_5GHZ) so we inform ath5k_channel_ok()
1609          * of the band by that */
1610         if (!ath5k_channel_ok(ah, channel->center_freq, channel->hw_value)) {
1611                 ATH5K_ERR(ah->ah_sc,
1612                         "channel frequency (%u MHz) out of supported "
1613                         "band range\n",
1614                         channel->center_freq);
1615                         return -EINVAL;
1616         }
1617
1618         /*
1619          * Set the channel and wait
1620          */
1621         switch (ah->ah_radio) {
1622         case AR5K_RF5110:
1623                 ret = ath5k_hw_rf5110_channel(ah, channel);
1624                 break;
1625         case AR5K_RF5111:
1626                 ret = ath5k_hw_rf5111_channel(ah, channel);
1627                 break;
1628         default:
1629                 ret = ath5k_hw_rf5112_channel(ah, channel);
1630                 break;
1631         }
1632
1633         if (ret)
1634                 return ret;
1635
1636         ah->ah_current_channel.center_freq = channel->center_freq;
1637         ah->ah_current_channel.hw_value = channel->hw_value;
1638         ah->ah_turbo = channel->hw_value == CHANNEL_T ? true : false;
1639
1640         return 0;
1641 }
1642
1643 /*****************\
1644   PHY calibration
1645 \*****************/
1646
1647 /**
1648  * ath5k_hw_noise_floor_calibration - perform PHY noise floor calibration
1649  *
1650  * @ah: struct ath5k_hw pointer we are operating on
1651  * @freq: the channel frequency, just used for error logging
1652  *
1653  * This function performs a noise floor calibration of the PHY and waits for
1654  * it to complete. Then the noise floor value is compared to some maximum
1655  * noise floor we consider valid.
1656  *
1657  * Note that this is different from what the madwifi HAL does: it reads the
1658  * noise floor and afterwards initiates the calibration. Since the noise floor
1659  * calibration can take some time to finish, depending on the current channel
1660  * use, that avoids the occasional timeout warnings we are seeing now.
1661  *
1662  * See the following link for an Atheros patent on noise floor calibration:
1663  * http://patft.uspto.gov/netacgi/nph-Parser?Sect1=PTO1&Sect2=HITOFF&d=PALL \
1664  * &p=1&u=%2Fnetahtml%2FPTO%2Fsrchnum.htm&r=1&f=G&l=50&s1=7245893.PN.&OS=PN/7
1665  *
1666  */
1667 int
1668 ath5k_hw_noise_floor_calibration(struct ath5k_hw *ah, short freq)
1669 {
1670         int ret;
1671         unsigned int i;
1672         s32 noise_floor;
1673
1674         /*
1675          * Enable noise floor calibration and wait until completion
1676          */
1677         AR5K_REG_ENABLE_BITS(ah, AR5K_PHY_AGCCTL,
1678                                 AR5K_PHY_AGCCTL_NF);
1679
1680         ret = ath5k_hw_register_timeout(ah, AR5K_PHY_AGCCTL,
1681                         AR5K_PHY_AGCCTL_NF, 0, false);
1682         if (ret) {
1683                 ATH5K_ERR(ah->ah_sc,
1684                         "noise floor calibration timeout (%uMHz)\n", freq);
1685                 return ret;
1686         }
1687
1688         /* Wait until the noise floor is calibrated and read the value */
1689         for (i = 20; i > 0; i--) {
1690                 mdelay(1);
1691                 noise_floor = ath5k_hw_reg_read(ah, AR5K_PHY_NF);
1692                 noise_floor = AR5K_PHY_NF_RVAL(noise_floor);
1693                 if (noise_floor & AR5K_PHY_NF_ACTIVE) {
1694                         noise_floor = AR5K_PHY_NF_AVAL(noise_floor);
1695
1696                         if (noise_floor <= AR5K_TUNE_NOISE_FLOOR)
1697                                 break;
1698                 }
1699         }
1700
1701         ATH5K_DBG_UNLIMIT(ah->ah_sc, ATH5K_DEBUG_CALIBRATE,
1702                 "noise floor %d\n", noise_floor);
1703
1704         if (noise_floor > AR5K_TUNE_NOISE_FLOOR) {
1705                 ATH5K_ERR(ah->ah_sc,
1706                         "noise floor calibration failed (%uMHz)\n", freq);
1707                 return -EIO;
1708         }
1709
1710         ah->ah_noise_floor = noise_floor;
1711
1712         return 0;
1713 }
1714
1715 /*
1716  * Perform a PHY calibration on RF5110
1717  * -Fix BPSK/QAM Constellation (I/Q correction)
1718  * -Calculate Noise Floor
1719  */
1720 static int ath5k_hw_rf5110_calibrate(struct ath5k_hw *ah,
1721                 struct ieee80211_channel *channel)
1722 {
1723         u32 phy_sig, phy_agc, phy_sat, beacon;
1724         int ret;
1725
1726         /*
1727          * Disable beacons and RX/TX queues, wait
1728          */
1729         AR5K_REG_ENABLE_BITS(ah, AR5K_DIAG_SW_5210,
1730                 AR5K_DIAG_SW_DIS_TX | AR5K_DIAG_SW_DIS_RX_5210);
1731         beacon = ath5k_hw_reg_read(ah, AR5K_BEACON_5210);
1732         ath5k_hw_reg_write(ah, beacon & ~AR5K_BEACON_ENABLE, AR5K_BEACON_5210);
1733
1734         udelay(2300);
1735
1736         /*
1737          * Set the channel (with AGC turned off)
1738          */
1739         AR5K_REG_ENABLE_BITS(ah, AR5K_PHY_AGC, AR5K_PHY_AGC_DISABLE);
1740         udelay(10);
1741         ret = ath5k_hw_channel(ah, channel);
1742
1743         /*
1744          * Activate PHY and wait
1745          */
1746         ath5k_hw_reg_write(ah, AR5K_PHY_ACT_ENABLE, AR5K_PHY_ACT);
1747         mdelay(1);
1748
1749         AR5K_REG_DISABLE_BITS(ah, AR5K_PHY_AGC, AR5K_PHY_AGC_DISABLE);
1750
1751         if (ret)
1752                 return ret;
1753
1754         /*
1755          * Calibrate the radio chip
1756          */
1757
1758         /* Remember normal state */
1759         phy_sig = ath5k_hw_reg_read(ah, AR5K_PHY_SIG);
1760         phy_agc = ath5k_hw_reg_read(ah, AR5K_PHY_AGCCOARSE);
1761         phy_sat = ath5k_hw_reg_read(ah, AR5K_PHY_ADCSAT);
1762
1763         /* Update radio registers */
1764         ath5k_hw_reg_write(ah, (phy_sig & ~(AR5K_PHY_SIG_FIRPWR)) |
1765                 AR5K_REG_SM(-1, AR5K_PHY_SIG_FIRPWR), AR5K_PHY_SIG);
1766
1767         ath5k_hw_reg_write(ah, (phy_agc & ~(AR5K_PHY_AGCCOARSE_HI |
1768                         AR5K_PHY_AGCCOARSE_LO)) |
1769                 AR5K_REG_SM(-1, AR5K_PHY_AGCCOARSE_HI) |
1770                 AR5K_REG_SM(-127, AR5K_PHY_AGCCOARSE_LO), AR5K_PHY_AGCCOARSE);
1771
1772         ath5k_hw_reg_write(ah, (phy_sat & ~(AR5K_PHY_ADCSAT_ICNT |
1773                         AR5K_PHY_ADCSAT_THR)) |
1774                 AR5K_REG_SM(2, AR5K_PHY_ADCSAT_ICNT) |
1775                 AR5K_REG_SM(12, AR5K_PHY_ADCSAT_THR), AR5K_PHY_ADCSAT);
1776
1777         udelay(20);
1778
1779         AR5K_REG_ENABLE_BITS(ah, AR5K_PHY_AGC, AR5K_PHY_AGC_DISABLE);
1780         udelay(10);
1781         ath5k_hw_reg_write(ah, AR5K_PHY_RFSTG_DISABLE, AR5K_PHY_RFSTG);
1782         AR5K_REG_DISABLE_BITS(ah, AR5K_PHY_AGC, AR5K_PHY_AGC_DISABLE);
1783
1784         mdelay(1);
1785
1786         /*
1787          * Enable calibration and wait until completion
1788          */
1789         AR5K_REG_ENABLE_BITS(ah, AR5K_PHY_AGCCTL, AR5K_PHY_AGCCTL_CAL);
1790
1791         ret = ath5k_hw_register_timeout(ah, AR5K_PHY_AGCCTL,
1792                         AR5K_PHY_AGCCTL_CAL, 0, false);
1793
1794         /* Reset to normal state */
1795         ath5k_hw_reg_write(ah, phy_sig, AR5K_PHY_SIG);
1796         ath5k_hw_reg_write(ah, phy_agc, AR5K_PHY_AGCCOARSE);
1797         ath5k_hw_reg_write(ah, phy_sat, AR5K_PHY_ADCSAT);
1798
1799         if (ret) {
1800                 ATH5K_ERR(ah->ah_sc, "calibration timeout (%uMHz)\n",
1801                                 channel->center_freq);
1802                 return ret;
1803         }
1804
1805         ret = ath5k_hw_noise_floor_calibration(ah, channel->center_freq);
1806         if (ret)
1807                 return ret;
1808
1809         /*
1810          * Re-enable RX/TX and beacons
1811          */
1812         AR5K_REG_DISABLE_BITS(ah, AR5K_DIAG_SW_5210,
1813                 AR5K_DIAG_SW_DIS_TX | AR5K_DIAG_SW_DIS_RX_5210);
1814         ath5k_hw_reg_write(ah, beacon, AR5K_BEACON_5210);
1815
1816         return 0;
1817 }
1818
1819 /*
1820  * Perform a PHY calibration on RF5111/5112
1821  */
1822 static int ath5k_hw_rf511x_calibrate(struct ath5k_hw *ah,
1823                 struct ieee80211_channel *channel)
1824 {
1825         u32 i_pwr, q_pwr;
1826         s32 iq_corr, i_coff, i_coffd, q_coff, q_coffd;
1827         ATH5K_TRACE(ah->ah_sc);
1828
1829         if (ah->ah_calibration == false ||
1830                         ath5k_hw_reg_read(ah, AR5K_PHY_IQ) & AR5K_PHY_IQ_RUN)
1831                 goto done;
1832
1833         ah->ah_calibration = false;
1834
1835         iq_corr = ath5k_hw_reg_read(ah, AR5K_PHY_IQRES_CAL_CORR);
1836         i_pwr = ath5k_hw_reg_read(ah, AR5K_PHY_IQRES_CAL_PWR_I);
1837         q_pwr = ath5k_hw_reg_read(ah, AR5K_PHY_IQRES_CAL_PWR_Q);
1838         i_coffd = ((i_pwr >> 1) + (q_pwr >> 1)) >> 7;
1839         q_coffd = q_pwr >> 6;
1840
1841         if (i_coffd == 0 || q_coffd == 0)
1842                 goto done;
1843
1844         i_coff = ((-iq_corr) / i_coffd) & 0x3f;
1845         q_coff = (((s32)i_pwr / q_coffd) - 64) & 0x1f;
1846
1847         /* Commit new IQ value */
1848         AR5K_REG_ENABLE_BITS(ah, AR5K_PHY_IQ, AR5K_PHY_IQ_CORR_ENABLE |
1849                 ((u32)q_coff) | ((u32)i_coff << AR5K_PHY_IQ_CORR_Q_I_COFF_S));
1850
1851 done:
1852         ath5k_hw_noise_floor_calibration(ah, channel->center_freq);
1853
1854         /* Request RF gain */
1855         if (channel->hw_value & CHANNEL_5GHZ) {
1856                 ath5k_hw_reg_write(ah, AR5K_REG_SM(ah->ah_txpower.txp_max,
1857                         AR5K_PHY_PAPD_PROBE_TXPOWER) |
1858                         AR5K_PHY_PAPD_PROBE_TX_NEXT, AR5K_PHY_PAPD_PROBE);
1859                 ah->ah_rf_gain = AR5K_RFGAIN_READ_REQUESTED;
1860         }
1861
1862         return 0;
1863 }
1864
1865 /*
1866  * Perform a PHY calibration
1867  */
1868 int ath5k_hw_phy_calibrate(struct ath5k_hw *ah,
1869                 struct ieee80211_channel *channel)
1870 {
1871         int ret;
1872
1873         if (ah->ah_radio == AR5K_RF5110)
1874                 ret = ath5k_hw_rf5110_calibrate(ah, channel);
1875         else
1876                 ret = ath5k_hw_rf511x_calibrate(ah, channel);
1877
1878         return ret;
1879 }
1880
1881 int ath5k_hw_phy_disable(struct ath5k_hw *ah)
1882 {
1883         ATH5K_TRACE(ah->ah_sc);
1884         /*Just a try M.F.*/
1885         ath5k_hw_reg_write(ah, AR5K_PHY_ACT_DISABLE, AR5K_PHY_ACT);
1886
1887         return 0;
1888 }
1889
1890 /********************\
1891   Misc PHY functions
1892 \********************/
1893
1894 /*
1895  * Get the PHY Chip revision
1896  */
1897 u16 ath5k_hw_radio_revision(struct ath5k_hw *ah, unsigned int chan)
1898 {
1899         unsigned int i;
1900         u32 srev;
1901         u16 ret;
1902
1903         ATH5K_TRACE(ah->ah_sc);
1904
1905         /*
1906          * Set the radio chip access register
1907          */
1908         switch (chan) {
1909         case CHANNEL_2GHZ:
1910                 ath5k_hw_reg_write(ah, AR5K_PHY_SHIFT_2GHZ, AR5K_PHY(0));
1911                 break;
1912         case CHANNEL_5GHZ:
1913                 ath5k_hw_reg_write(ah, AR5K_PHY_SHIFT_5GHZ, AR5K_PHY(0));
1914                 break;
1915         default:
1916                 return 0;
1917         }
1918
1919         mdelay(2);
1920
1921         /* ...wait until PHY is ready and read the selected radio revision */
1922         ath5k_hw_reg_write(ah, 0x00001c16, AR5K_PHY(0x34));
1923
1924         for (i = 0; i < 8; i++)
1925                 ath5k_hw_reg_write(ah, 0x00010000, AR5K_PHY(0x20));
1926
1927         if (ah->ah_version == AR5K_AR5210) {
1928                 srev = ath5k_hw_reg_read(ah, AR5K_PHY(256) >> 28) & 0xf;
1929                 ret = (u16)ath5k_hw_bitswap(srev, 4) + 1;
1930         } else {
1931                 srev = (ath5k_hw_reg_read(ah, AR5K_PHY(0x100)) >> 24) & 0xff;
1932                 ret = (u16)ath5k_hw_bitswap(((srev & 0xf0) >> 4) |
1933                                 ((srev & 0x0f) << 4), 8);
1934         }
1935
1936         /* Reset to the 5GHz mode */
1937         ath5k_hw_reg_write(ah, AR5K_PHY_SHIFT_5GHZ, AR5K_PHY(0));
1938
1939         return ret;
1940 }
1941
1942 void /*TODO:Boundary check*/
1943 ath5k_hw_set_def_antenna(struct ath5k_hw *ah, unsigned int ant)
1944 {
1945         ATH5K_TRACE(ah->ah_sc);
1946         /*Just a try M.F.*/
1947         if (ah->ah_version != AR5K_AR5210)
1948                 ath5k_hw_reg_write(ah, ant, AR5K_DEFAULT_ANTENNA);
1949 }
1950
1951 unsigned int ath5k_hw_get_def_antenna(struct ath5k_hw *ah)
1952 {
1953         ATH5K_TRACE(ah->ah_sc);
1954         /*Just a try M.F.*/
1955         if (ah->ah_version != AR5K_AR5210)
1956                 return ath5k_hw_reg_read(ah, AR5K_DEFAULT_ANTENNA);
1957
1958         return false; /*XXX: What do we return for 5210 ?*/
1959 }
1960
1961 /*
1962  * TX power setup
1963  */
1964
1965 /*
1966  * Initialize the tx power table (not fully implemented)
1967  */
1968 static void ath5k_txpower_table(struct ath5k_hw *ah,
1969                 struct ieee80211_channel *channel, s16 max_power)
1970 {
1971         unsigned int i, min, max, n;
1972         u16 txpower, *rates;
1973
1974         rates = ah->ah_txpower.txp_rates;
1975
1976         txpower = AR5K_TUNE_DEFAULT_TXPOWER * 2;
1977         if (max_power > txpower)
1978                 txpower = max_power > AR5K_TUNE_MAX_TXPOWER ?
1979                     AR5K_TUNE_MAX_TXPOWER : max_power;
1980
1981         for (i = 0; i < AR5K_MAX_RATES; i++)
1982                 rates[i] = txpower;
1983
1984         /* XXX setup target powers by rate */
1985
1986         ah->ah_txpower.txp_min = rates[7];
1987         ah->ah_txpower.txp_max = rates[0];
1988         ah->ah_txpower.txp_ofdm = rates[0];
1989
1990         /* Calculate the power table */
1991         n = ARRAY_SIZE(ah->ah_txpower.txp_pcdac);
1992         min = AR5K_EEPROM_PCDAC_START;
1993         max = AR5K_EEPROM_PCDAC_STOP;
1994         for (i = 0; i < n; i += AR5K_EEPROM_PCDAC_STEP)
1995                 ah->ah_txpower.txp_pcdac[i] =
1996 #ifdef notyet
1997                 min + ((i * (max - min)) / n);
1998 #else
1999                 min;
2000 #endif
2001 }
2002
2003 /*
2004  * Set transmition power
2005  */
2006 int /*O.K. - txpower_table is unimplemented so this doesn't work*/
2007 ath5k_hw_txpower(struct ath5k_hw *ah, struct ieee80211_channel *channel,
2008                 unsigned int txpower)
2009 {
2010         bool tpc = ah->ah_txpower.txp_tpc;
2011         unsigned int i;
2012
2013         ATH5K_TRACE(ah->ah_sc);
2014         if (txpower > AR5K_TUNE_MAX_TXPOWER) {
2015                 ATH5K_ERR(ah->ah_sc, "invalid tx power: %u\n", txpower);
2016                 return -EINVAL;
2017         }
2018
2019         /* Reset TX power values */
2020         memset(&ah->ah_txpower, 0, sizeof(ah->ah_txpower));
2021         ah->ah_txpower.txp_tpc = tpc;
2022
2023         /* Initialize TX power table */
2024         ath5k_txpower_table(ah, channel, txpower);
2025
2026         /*
2027          * Write TX power values
2028          */
2029         for (i = 0; i < (AR5K_EEPROM_POWER_TABLE_SIZE / 2); i++) {
2030                 ath5k_hw_reg_write(ah,
2031                         ((((ah->ah_txpower.txp_pcdac[(i << 1) + 1] << 8) | 0xff) & 0xffff) << 16) |
2032                         (((ah->ah_txpower.txp_pcdac[(i << 1)    ] << 8) | 0xff) & 0xffff),
2033                         AR5K_PHY_PCDAC_TXPOWER(i));
2034         }
2035
2036         ath5k_hw_reg_write(ah, AR5K_TXPOWER_OFDM(3, 24) |
2037                 AR5K_TXPOWER_OFDM(2, 16) | AR5K_TXPOWER_OFDM(1, 8) |
2038                 AR5K_TXPOWER_OFDM(0, 0), AR5K_PHY_TXPOWER_RATE1);
2039
2040         ath5k_hw_reg_write(ah, AR5K_TXPOWER_OFDM(7, 24) |
2041                 AR5K_TXPOWER_OFDM(6, 16) | AR5K_TXPOWER_OFDM(5, 8) |
2042                 AR5K_TXPOWER_OFDM(4, 0), AR5K_PHY_TXPOWER_RATE2);
2043
2044         ath5k_hw_reg_write(ah, AR5K_TXPOWER_CCK(10, 24) |
2045                 AR5K_TXPOWER_CCK(9, 16) | AR5K_TXPOWER_CCK(15, 8) |
2046                 AR5K_TXPOWER_CCK(8, 0), AR5K_PHY_TXPOWER_RATE3);
2047
2048         ath5k_hw_reg_write(ah, AR5K_TXPOWER_CCK(14, 24) |
2049                 AR5K_TXPOWER_CCK(13, 16) | AR5K_TXPOWER_CCK(12, 8) |
2050                 AR5K_TXPOWER_CCK(11, 0), AR5K_PHY_TXPOWER_RATE4);
2051
2052         if (ah->ah_txpower.txp_tpc == true)
2053                 ath5k_hw_reg_write(ah, AR5K_PHY_TXPOWER_RATE_MAX_TPC_ENABLE |
2054                         AR5K_TUNE_MAX_TXPOWER, AR5K_PHY_TXPOWER_RATE_MAX);
2055         else
2056                 ath5k_hw_reg_write(ah, AR5K_PHY_TXPOWER_RATE_MAX |
2057                         AR5K_TUNE_MAX_TXPOWER, AR5K_PHY_TXPOWER_RATE_MAX);
2058
2059         return 0;
2060 }
2061
2062 int ath5k_hw_set_txpower_limit(struct ath5k_hw *ah, unsigned int power)
2063 {
2064         /*Just a try M.F.*/
2065         struct ieee80211_channel *channel = &ah->ah_current_channel;
2066
2067         ATH5K_TRACE(ah->ah_sc);
2068         ATH5K_DBG(ah->ah_sc, ATH5K_DEBUG_TXPOWER,
2069                 "changing txpower to %d\n", power);
2070
2071         return ath5k_hw_txpower(ah, channel, power);
2072 }