blob: 4f052ebf06da3a008aaf788749b0e09b978026dc [file] [log] [blame]
Michael Bueschef1a6282008-08-27 18:53:02 +02001/*
2
3 Broadcom B43 wireless driver
4 IEEE 802.11a PHY driver
5
6 Copyright (c) 2005 Martin Langer <martin-langer@gmx.de>,
7 Copyright (c) 2005-2007 Stefano Brivio <stefano.brivio@polimi.it>
8 Copyright (c) 2005-2008 Michael Buesch <mb@bu3sch.de>
9 Copyright (c) 2005, 2006 Danny van Dyk <kugelfang@gentoo.org>
10 Copyright (c) 2005, 2006 Andreas Jaggi <andreas.jaggi@waterwave.ch>
11
12 This program is free software; you can redistribute it and/or modify
13 it under the terms of the GNU General Public License as published by
14 the Free Software Foundation; either version 2 of the License, or
15 (at your option) any later version.
16
17 This program is distributed in the hope that it will be useful,
18 but WITHOUT ANY WARRANTY; without even the implied warranty of
19 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 GNU General Public License for more details.
21
22 You should have received a copy of the GNU General Public License
23 along with this program; see the file COPYING. If not, write to
24 the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
25 Boston, MA 02110-1301, USA.
26
27*/
28
29#include "b43.h"
30#include "phy_a.h"
31#include "phy_common.h"
32#include "wa.h"
33#include "tables.h"
34#include "main.h"
35
36
37/* Get the freq, as it has to be written to the device. */
38static inline u16 channel2freq_a(u8 channel)
39{
40 B43_WARN_ON(channel > 200);
41
42 return (5000 + 5 * channel);
43}
44
45static inline u16 freq_r3A_value(u16 frequency)
46{
47 u16 value;
48
49 if (frequency < 5091)
50 value = 0x0040;
51 else if (frequency < 5321)
52 value = 0x0000;
53 else if (frequency < 5806)
54 value = 0x0080;
55 else
56 value = 0x0040;
57
58 return value;
59}
60
Michael Buesch99c4a782008-08-30 02:09:08 +020061#if 0
62/* This function converts a TSSI value to dBm in Q5.2 */
63static s8 b43_aphy_estimate_power_out(struct b43_wldev *dev, s8 tssi)
64{
65 struct b43_phy *phy = &dev->phy;
66 struct b43_phy_a *aphy = phy->a;
67 s8 dbm = 0;
68 s32 tmp;
69
70 tmp = (aphy->tgt_idle_tssi - aphy->cur_idle_tssi + tssi);
71 tmp += 0x80;
72 tmp = clamp_val(tmp, 0x00, 0xFF);
73 dbm = aphy->tssi2dbm[tmp];
74 //TODO: There's a FIXME on the specs
75
76 return dbm;
77}
78#endif
79
Hannes Eder11ab72a2008-12-26 00:13:46 -080080static void b43_radio_set_tx_iq(struct b43_wldev *dev)
Michael Bueschef1a6282008-08-27 18:53:02 +020081{
82 static const u8 data_high[5] = { 0x00, 0x40, 0x80, 0x90, 0xD0 };
83 static const u8 data_low[5] = { 0x00, 0x01, 0x05, 0x06, 0x0A };
84 u16 tmp = b43_radio_read16(dev, 0x001E);
85 int i, j;
86
87 for (i = 0; i < 5; i++) {
88 for (j = 0; j < 5; j++) {
89 if (tmp == (data_high[i] << 4 | data_low[j])) {
90 b43_phy_write(dev, 0x0069,
91 (i - j) << 8 | 0x00C0);
92 return;
93 }
94 }
95 }
96}
97
98static void aphy_channel_switch(struct b43_wldev *dev, unsigned int channel)
99{
100 u16 freq, r8, tmp;
101
102 freq = channel2freq_a(channel);
103
104 r8 = b43_radio_read16(dev, 0x0008);
105 b43_write16(dev, 0x03F0, freq);
106 b43_radio_write16(dev, 0x0008, r8);
107
108 //TODO: write max channel TX power? to Radio 0x2D
109 tmp = b43_radio_read16(dev, 0x002E);
110 tmp &= 0x0080;
111 //TODO: OR tmp with the Power out estimation for this channel?
112 b43_radio_write16(dev, 0x002E, tmp);
113
114 if (freq >= 4920 && freq <= 5500) {
115 /*
116 * r8 = (((freq * 15 * 0xE1FC780F) >> 32) / 29) & 0x0F;
117 * = (freq * 0.025862069
118 */
119 r8 = 3 * freq / 116; /* is equal to r8 = freq * 0.025862 */
120 }
121 b43_radio_write16(dev, 0x0007, (r8 << 4) | r8);
122 b43_radio_write16(dev, 0x0020, (r8 << 4) | r8);
123 b43_radio_write16(dev, 0x0021, (r8 << 4) | r8);
124 b43_radio_write16(dev, 0x0022, (b43_radio_read16(dev, 0x0022)
125 & 0x000F) | (r8 << 4));
126 b43_radio_write16(dev, 0x002A, (r8 << 4));
127 b43_radio_write16(dev, 0x002B, (r8 << 4));
128 b43_radio_write16(dev, 0x0008, (b43_radio_read16(dev, 0x0008)
129 & 0x00F0) | (r8 << 4));
130 b43_radio_write16(dev, 0x0029, (b43_radio_read16(dev, 0x0029)
131 & 0xFF0F) | 0x00B0);
132 b43_radio_write16(dev, 0x0035, 0x00AA);
133 b43_radio_write16(dev, 0x0036, 0x0085);
134 b43_radio_write16(dev, 0x003A, (b43_radio_read16(dev, 0x003A)
135 & 0xFF20) |
136 freq_r3A_value(freq));
Michael Buesch37185822009-02-20 19:30:10 +0100137 b43_radio_mask(dev, 0x003D, 0x00FF);
Michael Bueschef1a6282008-08-27 18:53:02 +0200138 b43_radio_write16(dev, 0x0081, (b43_radio_read16(dev, 0x0081)
139 & 0xFF7F) | 0x0080);
Michael Buesch37185822009-02-20 19:30:10 +0100140 b43_radio_mask(dev, 0x0035, 0xFFEF);
Michael Bueschef1a6282008-08-27 18:53:02 +0200141 b43_radio_write16(dev, 0x0035, (b43_radio_read16(dev, 0x0035)
142 & 0xFFEF) | 0x0010);
143 b43_radio_set_tx_iq(dev);
144 //TODO: TSSI2dbm workaround
145//FIXME b43_phy_xmitpower(dev);
146}
147
Hannes Eder11ab72a2008-12-26 00:13:46 -0800148static void b43_radio_init2060(struct b43_wldev *dev)
Michael Bueschef1a6282008-08-27 18:53:02 +0200149{
150 b43_radio_write16(dev, 0x0004, 0x00C0);
151 b43_radio_write16(dev, 0x0005, 0x0008);
152 b43_radio_write16(dev, 0x0009, 0x0040);
153 b43_radio_write16(dev, 0x0005, 0x00AA);
154 b43_radio_write16(dev, 0x0032, 0x008F);
155 b43_radio_write16(dev, 0x0006, 0x008F);
156 b43_radio_write16(dev, 0x0034, 0x008F);
157 b43_radio_write16(dev, 0x002C, 0x0007);
158 b43_radio_write16(dev, 0x0082, 0x0080);
159 b43_radio_write16(dev, 0x0080, 0x0000);
160 b43_radio_write16(dev, 0x003F, 0x00DA);
Michael Buesch37185822009-02-20 19:30:10 +0100161 b43_radio_mask(dev, 0x0005, ~0x0008);
162 b43_radio_mask(dev, 0x0081, ~0x0010);
163 b43_radio_mask(dev, 0x0081, ~0x0020);
164 b43_radio_mask(dev, 0x0081, ~0x0020);
Michael Bueschef1a6282008-08-27 18:53:02 +0200165 msleep(1); /* delay 400usec */
166
167 b43_radio_write16(dev, 0x0081,
168 (b43_radio_read16(dev, 0x0081) & ~0x0020) | 0x0010);
169 msleep(1); /* delay 400usec */
170
171 b43_radio_write16(dev, 0x0005,
172 (b43_radio_read16(dev, 0x0005) & ~0x0008) | 0x0008);
Michael Buesch37185822009-02-20 19:30:10 +0100173 b43_radio_mask(dev, 0x0085, ~0x0010);
174 b43_radio_mask(dev, 0x0005, ~0x0008);
175 b43_radio_mask(dev, 0x0081, ~0x0040);
Michael Bueschef1a6282008-08-27 18:53:02 +0200176 b43_radio_write16(dev, 0x0081,
177 (b43_radio_read16(dev, 0x0081) & ~0x0040) | 0x0040);
178 b43_radio_write16(dev, 0x0005,
179 (b43_radio_read16(dev, 0x0081) & ~0x0008) | 0x0008);
180 b43_phy_write(dev, 0x0063, 0xDDC6);
181 b43_phy_write(dev, 0x0069, 0x07BE);
182 b43_phy_write(dev, 0x006A, 0x0000);
183
184 aphy_channel_switch(dev, dev->phy.ops->get_default_chan(dev));
185
186 msleep(1);
187}
188
189static void b43_phy_rssiagc(struct b43_wldev *dev, u8 enable)
190{
191 int i;
192
193 if (dev->phy.rev < 3) {
194 if (enable)
195 for (i = 0; i < B43_TAB_RSSIAGC1_SIZE; i++) {
196 b43_ofdmtab_write16(dev,
197 B43_OFDMTAB_LNAHPFGAIN1, i, 0xFFF8);
198 b43_ofdmtab_write16(dev,
199 B43_OFDMTAB_WRSSI, i, 0xFFF8);
200 }
201 else
202 for (i = 0; i < B43_TAB_RSSIAGC1_SIZE; i++) {
203 b43_ofdmtab_write16(dev,
204 B43_OFDMTAB_LNAHPFGAIN1, i, b43_tab_rssiagc1[i]);
205 b43_ofdmtab_write16(dev,
206 B43_OFDMTAB_WRSSI, i, b43_tab_rssiagc1[i]);
207 }
208 } else {
209 if (enable)
210 for (i = 0; i < B43_TAB_RSSIAGC1_SIZE; i++)
211 b43_ofdmtab_write16(dev,
212 B43_OFDMTAB_WRSSI, i, 0x0820);
213 else
214 for (i = 0; i < B43_TAB_RSSIAGC2_SIZE; i++)
215 b43_ofdmtab_write16(dev,
216 B43_OFDMTAB_WRSSI, i, b43_tab_rssiagc2[i]);
217 }
218}
219
220static void b43_phy_ww(struct b43_wldev *dev)
221{
222 u16 b, curr_s, best_s = 0xFFFF;
223 int i;
224
Michael Bueschac1ea392009-02-20 19:25:05 +0100225 b43_phy_mask(dev, B43_PHY_CRS0, ~B43_PHY_CRS0_EN);
Michael Buesche59be0b2009-02-20 19:22:36 +0100226 b43_phy_set(dev, B43_PHY_OFDM(0x1B), 0x1000);
Michael Buesch76e190c2009-02-20 19:26:27 +0100227 b43_phy_maskset(dev, B43_PHY_OFDM(0x82), 0xF0FF, 0x0300);
Michael Buesch4cf50762009-02-20 19:28:14 +0100228 b43_radio_set(dev, 0x0009, 0x0080);
Michael Bueschef1a6282008-08-27 18:53:02 +0200229 b43_radio_write16(dev, 0x0012,
230 (b43_radio_read16(dev, 0x0012) & 0xFFFC) | 0x0002);
231 b43_wa_initgains(dev);
232 b43_phy_write(dev, B43_PHY_OFDM(0xBA), 0x3ED5);
233 b = b43_phy_read(dev, B43_PHY_PWRDOWN);
234 b43_phy_write(dev, B43_PHY_PWRDOWN, (b & 0xFFF8) | 0x0005);
Michael Buesch4cf50762009-02-20 19:28:14 +0100235 b43_radio_set(dev, 0x0004, 0x0004);
Michael Bueschef1a6282008-08-27 18:53:02 +0200236 for (i = 0x10; i <= 0x20; i++) {
237 b43_radio_write16(dev, 0x0013, i);
238 curr_s = b43_phy_read(dev, B43_PHY_OTABLEQ) & 0x00FF;
239 if (!curr_s) {
240 best_s = 0x0000;
241 break;
242 } else if (curr_s >= 0x0080)
243 curr_s = 0x0100 - curr_s;
244 if (curr_s < best_s)
245 best_s = curr_s;
246 }
247 b43_phy_write(dev, B43_PHY_PWRDOWN, b);
Michael Buesch37185822009-02-20 19:30:10 +0100248 b43_radio_mask(dev, 0x0004, 0xFFFB);
Michael Bueschef1a6282008-08-27 18:53:02 +0200249 b43_radio_write16(dev, 0x0013, best_s);
250 b43_ofdmtab_write16(dev, B43_OFDMTAB_AGC1_R1, 0, 0xFFEC);
251 b43_phy_write(dev, B43_PHY_OFDM(0xB7), 0x1E80);
252 b43_phy_write(dev, B43_PHY_OFDM(0xB6), 0x1C00);
253 b43_phy_write(dev, B43_PHY_OFDM(0xB5), 0x0EC0);
254 b43_phy_write(dev, B43_PHY_OFDM(0xB2), 0x00C0);
255 b43_phy_write(dev, B43_PHY_OFDM(0xB9), 0x1FFF);
Michael Buesch76e190c2009-02-20 19:26:27 +0100256 b43_phy_maskset(dev, B43_PHY_OFDM(0xBB), 0xF000, 0x0053);
257 b43_phy_maskset(dev, B43_PHY_OFDM61, 0xFE1F, 0x0120);
258 b43_phy_maskset(dev, B43_PHY_OFDM(0x13), 0x0FFF, 0x3000);
259 b43_phy_maskset(dev, B43_PHY_OFDM(0x14), 0x0FFF, 0x3000);
Michael Bueschef1a6282008-08-27 18:53:02 +0200260 b43_ofdmtab_write16(dev, B43_OFDMTAB_AGC1, 6, 0x0017);
261 for (i = 0; i < 6; i++)
262 b43_ofdmtab_write16(dev, B43_OFDMTAB_AGC1, i, 0x000F);
263 b43_ofdmtab_write16(dev, B43_OFDMTAB_AGC1, 0x0D, 0x000E);
264 b43_ofdmtab_write16(dev, B43_OFDMTAB_AGC1, 0x0E, 0x0011);
265 b43_ofdmtab_write16(dev, B43_OFDMTAB_AGC1, 0x0F, 0x0013);
266 b43_phy_write(dev, B43_PHY_OFDM(0x33), 0x5030);
Michael Buesche59be0b2009-02-20 19:22:36 +0100267 b43_phy_set(dev, B43_PHY_CRS0, B43_PHY_CRS0_EN);
Michael Bueschef1a6282008-08-27 18:53:02 +0200268}
269
270static void hardware_pctl_init_aphy(struct b43_wldev *dev)
271{
272 //TODO
273}
274
275void b43_phy_inita(struct b43_wldev *dev)
276{
277 struct ssb_bus *bus = dev->dev->bus;
278 struct b43_phy *phy = &dev->phy;
279
280 /* This lowlevel A-PHY init is also called from G-PHY init.
281 * So we must not access phy->a, if called from G-PHY code.
282 */
283 B43_WARN_ON((phy->type != B43_PHYTYPE_A) &&
284 (phy->type != B43_PHYTYPE_G));
285
286 might_sleep();
287
288 if (phy->rev >= 6) {
289 if (phy->type == B43_PHYTYPE_A)
Michael Bueschac1ea392009-02-20 19:25:05 +0100290 b43_phy_mask(dev, B43_PHY_OFDM(0x1B), ~0x1000);
Michael Bueschef1a6282008-08-27 18:53:02 +0200291 if (b43_phy_read(dev, B43_PHY_ENCORE) & B43_PHY_ENCORE_EN)
Michael Buesche59be0b2009-02-20 19:22:36 +0100292 b43_phy_set(dev, B43_PHY_ENCORE, 0x0010);
Michael Bueschef1a6282008-08-27 18:53:02 +0200293 else
Michael Bueschac1ea392009-02-20 19:25:05 +0100294 b43_phy_mask(dev, B43_PHY_ENCORE, ~0x1010);
Michael Bueschef1a6282008-08-27 18:53:02 +0200295 }
296
297 b43_wa_all(dev);
298
299 if (phy->type == B43_PHYTYPE_A) {
300 if (phy->gmode && (phy->rev < 3))
Michael Buesche59be0b2009-02-20 19:22:36 +0100301 b43_phy_set(dev, 0x0034, 0x0001);
Michael Bueschef1a6282008-08-27 18:53:02 +0200302 b43_phy_rssiagc(dev, 0);
303
Michael Buesche59be0b2009-02-20 19:22:36 +0100304 b43_phy_set(dev, B43_PHY_CRS0, B43_PHY_CRS0_EN);
Michael Bueschef1a6282008-08-27 18:53:02 +0200305
306 b43_radio_init2060(dev);
307
308 if ((bus->boardinfo.vendor == SSB_BOARDVENDOR_BCM) &&
309 ((bus->boardinfo.type == SSB_BOARD_BU4306) ||
310 (bus->boardinfo.type == SSB_BOARD_BU4309))) {
311 ; //TODO: A PHY LO
312 }
313
314 if (phy->rev >= 3)
315 b43_phy_ww(dev);
316
317 hardware_pctl_init_aphy(dev);
318
319 //TODO: radar detection
320 }
321
322 if ((phy->type == B43_PHYTYPE_G) &&
323 (dev->dev->bus->sprom.boardflags_lo & B43_BFL_PACTRL)) {
Michael Buesch76e190c2009-02-20 19:26:27 +0100324 b43_phy_maskset(dev, B43_PHY_OFDM(0x6E), 0xE000, 0x3CF);
Michael Bueschef1a6282008-08-27 18:53:02 +0200325 }
326}
327
Michael Buesch99c4a782008-08-30 02:09:08 +0200328/* Initialise the TSSI->dBm lookup table */
329static int b43_aphy_init_tssi2dbm_table(struct b43_wldev *dev)
330{
331 struct b43_phy *phy = &dev->phy;
332 struct b43_phy_a *aphy = phy->a;
333 s16 pab0, pab1, pab2;
334
335 pab0 = (s16) (dev->dev->bus->sprom.pa1b0);
336 pab1 = (s16) (dev->dev->bus->sprom.pa1b1);
337 pab2 = (s16) (dev->dev->bus->sprom.pa1b2);
338
339 if (pab0 != 0 && pab1 != 0 && pab2 != 0 &&
340 pab0 != -1 && pab1 != -1 && pab2 != -1) {
341 /* The pabX values are set in SPROM. Use them. */
342 if ((s8) dev->dev->bus->sprom.itssi_a != 0 &&
343 (s8) dev->dev->bus->sprom.itssi_a != -1)
344 aphy->tgt_idle_tssi =
345 (s8) (dev->dev->bus->sprom.itssi_a);
346 else
347 aphy->tgt_idle_tssi = 62;
348 aphy->tssi2dbm = b43_generate_dyn_tssi2dbm_tab(dev, pab0,
349 pab1, pab2);
350 if (!aphy->tssi2dbm)
351 return -ENOMEM;
352 } else {
353 /* pabX values not set in SPROM,
354 * but APHY needs a generated table. */
355 aphy->tssi2dbm = NULL;
356 b43err(dev->wl, "Could not generate tssi2dBm "
357 "table (wrong SPROM info)!\n");
358 return -ENODEV;
359 }
360
361 return 0;
362}
363
Michael Bueschef1a6282008-08-27 18:53:02 +0200364static int b43_aphy_op_allocate(struct b43_wldev *dev)
365{
366 struct b43_phy_a *aphy;
Michael Buesch99c4a782008-08-30 02:09:08 +0200367 int err;
Michael Bueschef1a6282008-08-27 18:53:02 +0200368
369 aphy = kzalloc(sizeof(*aphy), GFP_KERNEL);
370 if (!aphy)
371 return -ENOMEM;
372 dev->phy.a = aphy;
373
Michael Buesch99c4a782008-08-30 02:09:08 +0200374 err = b43_aphy_init_tssi2dbm_table(dev);
375 if (err)
376 goto err_free_aphy;
377
Michael Bueschef1a6282008-08-27 18:53:02 +0200378 return 0;
Michael Buesch99c4a782008-08-30 02:09:08 +0200379
380err_free_aphy:
381 kfree(aphy);
382 dev->phy.a = NULL;
383
384 return err;
Michael Bueschef1a6282008-08-27 18:53:02 +0200385}
386
Michael Bueschfb111372008-09-02 13:00:34 +0200387static void b43_aphy_op_prepare_structs(struct b43_wldev *dev)
Michael Bueschef1a6282008-08-27 18:53:02 +0200388{
Michael Bueschfb111372008-09-02 13:00:34 +0200389 struct b43_phy *phy = &dev->phy;
390 struct b43_phy_a *aphy = phy->a;
391 const void *tssi2dbm;
392 int tgt_idle_tssi;
Michael Bueschef1a6282008-08-27 18:53:02 +0200393
Michael Bueschfb111372008-09-02 13:00:34 +0200394 /* tssi2dbm table is constant, so it is initialized at alloc time.
395 * Save a copy of the pointer. */
396 tssi2dbm = aphy->tssi2dbm;
397 tgt_idle_tssi = aphy->tgt_idle_tssi;
Michael Bueschef1a6282008-08-27 18:53:02 +0200398
Michael Bueschfb111372008-09-02 13:00:34 +0200399 /* Zero out the whole PHY structure. */
400 memset(aphy, 0, sizeof(*aphy));
401
402 aphy->tssi2dbm = tssi2dbm;
403 aphy->tgt_idle_tssi = tgt_idle_tssi;
404
405 //TODO init struct b43_phy_a
406
Michael Bueschef1a6282008-08-27 18:53:02 +0200407}
408
Michael Bueschfb111372008-09-02 13:00:34 +0200409static void b43_aphy_op_free(struct b43_wldev *dev)
Michael Bueschef1a6282008-08-27 18:53:02 +0200410{
Michael Bueschfb111372008-09-02 13:00:34 +0200411 struct b43_phy *phy = &dev->phy;
412 struct b43_phy_a *aphy = phy->a;
Michael Bueschef1a6282008-08-27 18:53:02 +0200413
Michael Buesch99c4a782008-08-30 02:09:08 +0200414 kfree(aphy->tssi2dbm);
Michael Bueschfb111372008-09-02 13:00:34 +0200415 aphy->tssi2dbm = NULL;
416
Michael Bueschef1a6282008-08-27 18:53:02 +0200417 kfree(aphy);
418 dev->phy.a = NULL;
419}
420
Michael Bueschfb111372008-09-02 13:00:34 +0200421static int b43_aphy_op_init(struct b43_wldev *dev)
422{
423 b43_phy_inita(dev);
424
425 return 0;
426}
427
Michael Bueschef1a6282008-08-27 18:53:02 +0200428static inline u16 adjust_phyreg(struct b43_wldev *dev, u16 offset)
429{
430 /* OFDM registers are base-registers for the A-PHY. */
431 if ((offset & B43_PHYROUTE) == B43_PHYROUTE_OFDM_GPHY) {
432 offset &= ~B43_PHYROUTE;
433 offset |= B43_PHYROUTE_BASE;
434 }
435
436#if B43_DEBUG
437 if ((offset & B43_PHYROUTE) == B43_PHYROUTE_EXT_GPHY) {
438 /* Ext-G registers are only available on G-PHYs */
439 b43err(dev->wl, "Invalid EXT-G PHY access at "
440 "0x%04X on A-PHY\n", offset);
441 dump_stack();
442 }
443 if ((offset & B43_PHYROUTE) == B43_PHYROUTE_N_BMODE) {
444 /* N-BMODE registers are only available on N-PHYs */
445 b43err(dev->wl, "Invalid N-BMODE PHY access at "
446 "0x%04X on A-PHY\n", offset);
447 dump_stack();
448 }
449#endif /* B43_DEBUG */
450
451 return offset;
452}
453
454static u16 b43_aphy_op_read(struct b43_wldev *dev, u16 reg)
455{
456 reg = adjust_phyreg(dev, reg);
457 b43_write16(dev, B43_MMIO_PHY_CONTROL, reg);
458 return b43_read16(dev, B43_MMIO_PHY_DATA);
459}
460
461static void b43_aphy_op_write(struct b43_wldev *dev, u16 reg, u16 value)
462{
463 reg = adjust_phyreg(dev, reg);
464 b43_write16(dev, B43_MMIO_PHY_CONTROL, reg);
465 b43_write16(dev, B43_MMIO_PHY_DATA, value);
466}
467
468static u16 b43_aphy_op_radio_read(struct b43_wldev *dev, u16 reg)
469{
470 /* Register 1 is a 32-bit register. */
471 B43_WARN_ON(reg == 1);
472 /* A-PHY needs 0x40 for read access */
473 reg |= 0x40;
474
475 b43_write16(dev, B43_MMIO_RADIO_CONTROL, reg);
476 return b43_read16(dev, B43_MMIO_RADIO_DATA_LOW);
477}
478
479static void b43_aphy_op_radio_write(struct b43_wldev *dev, u16 reg, u16 value)
480{
481 /* Register 1 is a 32-bit register. */
482 B43_WARN_ON(reg == 1);
483
484 b43_write16(dev, B43_MMIO_RADIO_CONTROL, reg);
485 b43_write16(dev, B43_MMIO_RADIO_DATA_LOW, value);
486}
487
488static bool b43_aphy_op_supports_hwpctl(struct b43_wldev *dev)
489{
490 return (dev->phy.rev >= 5);
491}
492
493static void b43_aphy_op_software_rfkill(struct b43_wldev *dev,
494 enum rfkill_state state)
Michael Buesch99c4a782008-08-30 02:09:08 +0200495{
496 struct b43_phy *phy = &dev->phy;
497
498 if (state == RFKILL_STATE_UNBLOCKED) {
499 if (phy->radio_on)
500 return;
501 b43_radio_write16(dev, 0x0004, 0x00C0);
502 b43_radio_write16(dev, 0x0005, 0x0008);
Michael Bueschac1ea392009-02-20 19:25:05 +0100503 b43_phy_mask(dev, 0x0010, 0xFFF7);
504 b43_phy_mask(dev, 0x0011, 0xFFF7);
Michael Buesch99c4a782008-08-30 02:09:08 +0200505 b43_radio_init2060(dev);
506 } else {
507 b43_radio_write16(dev, 0x0004, 0x00FF);
508 b43_radio_write16(dev, 0x0005, 0x00FB);
Michael Buesche59be0b2009-02-20 19:22:36 +0100509 b43_phy_set(dev, 0x0010, 0x0008);
510 b43_phy_set(dev, 0x0011, 0x0008);
Michael Buesch99c4a782008-08-30 02:09:08 +0200511 }
Michael Bueschef1a6282008-08-27 18:53:02 +0200512}
513
514static int b43_aphy_op_switch_channel(struct b43_wldev *dev,
515 unsigned int new_channel)
516{
517 if (new_channel > 200)
518 return -EINVAL;
519 aphy_channel_switch(dev, new_channel);
520
521 return 0;
522}
523
524static unsigned int b43_aphy_op_get_default_chan(struct b43_wldev *dev)
525{
526 return 36; /* Default to channel 36 */
527}
528
529static void b43_aphy_op_set_rx_antenna(struct b43_wldev *dev, int antenna)
530{//TODO
531 struct b43_phy *phy = &dev->phy;
532 u64 hf;
533 u16 tmp;
534 int autodiv = 0;
535
536 if (antenna == B43_ANTENNA_AUTO0 || antenna == B43_ANTENNA_AUTO1)
537 autodiv = 1;
538
539 hf = b43_hf_read(dev);
540 hf &= ~B43_HF_ANTDIVHELP;
541 b43_hf_write(dev, hf);
542
543 tmp = b43_phy_read(dev, B43_PHY_BBANDCFG);
544 tmp &= ~B43_PHY_BBANDCFG_RXANT;
545 tmp |= (autodiv ? B43_ANTENNA_AUTO0 : antenna)
546 << B43_PHY_BBANDCFG_RXANT_SHIFT;
547 b43_phy_write(dev, B43_PHY_BBANDCFG, tmp);
548
549 if (autodiv) {
550 tmp = b43_phy_read(dev, B43_PHY_ANTDWELL);
551 if (antenna == B43_ANTENNA_AUTO0)
552 tmp &= ~B43_PHY_ANTDWELL_AUTODIV1;
553 else
554 tmp |= B43_PHY_ANTDWELL_AUTODIV1;
555 b43_phy_write(dev, B43_PHY_ANTDWELL, tmp);
556 }
557 if (phy->rev < 3) {
558 tmp = b43_phy_read(dev, B43_PHY_ANTDWELL);
559 tmp = (tmp & 0xFF00) | 0x24;
560 b43_phy_write(dev, B43_PHY_ANTDWELL, tmp);
561 } else {
562 tmp = b43_phy_read(dev, B43_PHY_OFDM61);
563 tmp |= 0x10;
564 b43_phy_write(dev, B43_PHY_OFDM61, tmp);
565 if (phy->analog == 3) {
566 b43_phy_write(dev, B43_PHY_CLIPPWRDOWNT,
567 0x1D);
568 b43_phy_write(dev, B43_PHY_ADIVRELATED,
569 8);
570 } else {
571 b43_phy_write(dev, B43_PHY_CLIPPWRDOWNT,
572 0x3A);
573 tmp =
574 b43_phy_read(dev,
575 B43_PHY_ADIVRELATED);
576 tmp = (tmp & 0xFF00) | 8;
577 b43_phy_write(dev, B43_PHY_ADIVRELATED,
578 tmp);
579 }
580 }
581
582 hf |= B43_HF_ANTDIVHELP;
583 b43_hf_write(dev, hf);
584}
585
Michael Buesch18c8ade2008-08-28 19:33:40 +0200586static void b43_aphy_op_adjust_txpower(struct b43_wldev *dev)
Michael Bueschef1a6282008-08-27 18:53:02 +0200587{//TODO
588}
589
Michael Buesch18c8ade2008-08-28 19:33:40 +0200590static enum b43_txpwr_result b43_aphy_op_recalc_txpower(struct b43_wldev *dev,
591 bool ignore_tssi)
592{//TODO
593 return B43_TXPWR_RES_DONE;
594}
595
Michael Bueschef1a6282008-08-27 18:53:02 +0200596static void b43_aphy_op_pwork_15sec(struct b43_wldev *dev)
597{//TODO
598}
599
600static void b43_aphy_op_pwork_60sec(struct b43_wldev *dev)
601{//TODO
602}
603
604const struct b43_phy_operations b43_phyops_a = {
605 .allocate = b43_aphy_op_allocate,
Michael Bueschfb111372008-09-02 13:00:34 +0200606 .free = b43_aphy_op_free,
607 .prepare_structs = b43_aphy_op_prepare_structs,
Michael Bueschef1a6282008-08-27 18:53:02 +0200608 .init = b43_aphy_op_init,
Michael Bueschef1a6282008-08-27 18:53:02 +0200609 .phy_read = b43_aphy_op_read,
610 .phy_write = b43_aphy_op_write,
611 .radio_read = b43_aphy_op_radio_read,
612 .radio_write = b43_aphy_op_radio_write,
613 .supports_hwpctl = b43_aphy_op_supports_hwpctl,
614 .software_rfkill = b43_aphy_op_software_rfkill,
Michael Bueschcb24f572008-09-03 12:12:20 +0200615 .switch_analog = b43_phyop_switch_analog_generic,
Michael Bueschef1a6282008-08-27 18:53:02 +0200616 .switch_channel = b43_aphy_op_switch_channel,
617 .get_default_chan = b43_aphy_op_get_default_chan,
618 .set_rx_antenna = b43_aphy_op_set_rx_antenna,
Michael Buesch18c8ade2008-08-28 19:33:40 +0200619 .recalc_txpower = b43_aphy_op_recalc_txpower,
620 .adjust_txpower = b43_aphy_op_adjust_txpower,
Michael Bueschef1a6282008-08-27 18:53:02 +0200621 .pwork_15sec = b43_aphy_op_pwork_15sec,
622 .pwork_60sec = b43_aphy_op_pwork_60sec,
623};