lisa/android_kernel_xiaomi_sm8350
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
12f981f902
android_kernel_xiaomi_sm8350/drivers/net/wireless/b43legacy/phy.c
Stefano Brivio e78c9d2857 b43legacy: fix MAC control and microcode init 
This zeros out all microcode related memory before loading
the microcode.

This also fixes initialization of the MAC control register.
The _only_ place where we overwrite the contents of the MAC control
register is at the beginning of b43_chip_init().
All other places must do read() -> mask/set -> write() to not
overwrite existing bits.

This also adds a longer delay for waiting for the microcode
to initialize itself. It seems that the current timeout is sufficient
on all available devices, but there's no real reason why we shouldn't
wait for up to one second. Slow embedded devices might exist.
Better safe than sorry.

While at it, fix naming of MACCTL values.

This patch by Michael Buesch has been ported to b43legacy.

Signed-off-by: Stefano Brivio <stefano.brivio@polimi.it>
Acked-by: Michael Buesch <mb@bu3sch.de>
Signed-off-by: John W. Linville <linville@tuxdriver.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2008-01-31 19:26:37 -08:00

2253 lines
64 KiB
C
Raw Blame History

/*
Broadcom B43legacy wireless driver
Copyright (c) 2005 Martin Langer <martin-langer@gmx.de>,
Stefano Brivio <stefano.brivio@polimi.it>
Michael Buesch <mbuesch@freenet.de>
Danny van Dyk <kugelfang@gentoo.org>
Andreas Jaggi <andreas.jaggi@waterwave.ch>
Copyright (c) 2007 Larry Finger <Larry.Finger@lwfinger.net>
Some parts of the code in this file are derived from the ipw2200
driver Copyright(c) 2003 - 2004 Intel Corporation.
This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program; see the file COPYING. If not, write to
the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor,
Boston, MA 02110-1301, USA.
*/
#include <linux/delay.h>
#include <linux/pci.h>
#include <linux/types.h>
#include "b43legacy.h"
#include "phy.h"
#include "main.h"
#include "radio.h"
#include "ilt.h"
static const s8 b43legacy_tssi2dbm_b_table[] = {
0x4D, 0x4C, 0x4B, 0x4A,
0x4A, 0x49, 0x48, 0x47,
0x47, 0x46, 0x45, 0x45,
0x44, 0x43, 0x42, 0x42,
0x41, 0x40, 0x3F, 0x3E,
0x3D, 0x3C, 0x3B, 0x3A,
0x39, 0x38, 0x37, 0x36,
0x35, 0x34, 0x32, 0x31,
0x30, 0x2F, 0x2D, 0x2C,
0x2B, 0x29, 0x28, 0x26,
0x25, 0x23, 0x21, 0x1F,
0x1D, 0x1A, 0x17, 0x14,
0x10, 0x0C, 0x06, 0x00,
-7, -7, -7, -7,
-7, -7, -7, -7,
-7, -7, -7, -7,
};
static const s8 b43legacy_tssi2dbm_g_table[] = {
77, 77, 77, 76,
76, 76, 75, 75,
74, 74, 73, 73,
73, 72, 72, 71,
71, 70, 70, 69,
68, 68, 67, 67,
66, 65, 65, 64,
63, 63, 62, 61,
60, 59, 58, 57,
56, 55, 54, 53,
52, 50, 49, 47,
45, 43, 40, 37,
33, 28, 22, 14,
5, -7, -20, -20,
-20, -20, -20, -20,
-20, -20, -20, -20,
};
static void b43legacy_phy_initg(struct b43legacy_wldev *dev);
static inline
void b43legacy_voluntary_preempt(void)
{
B43legacy_BUG_ON(!(!in_atomic() && !in_irq() &&
!in_interrupt() && !irqs_disabled()));
#ifndef CONFIG_PREEMPT
cond_resched();
#endif /* CONFIG_PREEMPT */
}
/* Lock the PHY registers against concurrent access from the microcode.
* This lock is nonrecursive. */
void b43legacy_phy_lock(struct b43legacy_wldev *dev)
{
#if B43legacy_DEBUG
B43legacy_WARN_ON(dev->phy.phy_locked);
dev->phy.phy_locked = 1;
#endif
if (dev->dev->id.revision < 3) {
b43legacy_mac_suspend(dev);
} else {
if (!b43legacy_is_mode(dev->wl, IEEE80211_IF_TYPE_AP))
b43legacy_power_saving_ctl_bits(dev, -1, 1);
}
}
void b43legacy_phy_unlock(struct b43legacy_wldev *dev)
{
#if B43legacy_DEBUG
B43legacy_WARN_ON(!dev->phy.phy_locked);
dev->phy.phy_locked = 0;
#endif
if (dev->dev->id.revision < 3) {
b43legacy_mac_enable(dev);
} else {
if (!b43legacy_is_mode(dev->wl, IEEE80211_IF_TYPE_AP))
b43legacy_power_saving_ctl_bits(dev, -1, -1);
}
}
u16 b43legacy_phy_read(struct b43legacy_wldev *dev, u16 offset)
{
b43legacy_write16(dev, B43legacy_MMIO_PHY_CONTROL, offset);
return b43legacy_read16(dev, B43legacy_MMIO_PHY_DATA);
}
void b43legacy_phy_write(struct b43legacy_wldev *dev, u16 offset, u16 val)
{
b43legacy_write16(dev, B43legacy_MMIO_PHY_CONTROL, offset);
mmiowb();
b43legacy_write16(dev, B43legacy_MMIO_PHY_DATA, val);
}
void b43legacy_phy_calibrate(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
b43legacy_read32(dev, B43legacy_MMIO_MACCTL); /* Dummy read. */
if (phy->calibrated)
return;
if (phy->type == B43legacy_PHYTYPE_G && phy->rev == 1) {
b43legacy_wireless_core_reset(dev, 0);
b43legacy_phy_initg(dev);
b43legacy_wireless_core_reset(dev, B43legacy_TMSLOW_GMODE);
}
phy->calibrated = 1;
}
/* intialize B PHY power control
* as described in http://bcm-specs.sipsolutions.net/InitPowerControl
*/
static void b43legacy_phy_init_pctl(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 saved_batt = 0;
u16 saved_ratt = 0;
u16 saved_txctl1 = 0;
int must_reset_txpower = 0;
B43legacy_BUG_ON(!(phy->type == B43legacy_PHYTYPE_B ||
phy->type == B43legacy_PHYTYPE_G));
if (is_bcm_board_vendor(dev) &&
(dev->dev->bus->boardinfo.type == 0x0416))
return;
b43legacy_phy_write(dev, 0x0028, 0x8018);
b43legacy_write16(dev, 0x03E6, b43legacy_read16(dev, 0x03E6) & 0xFFDF);
if (phy->type == B43legacy_PHYTYPE_G) {
if (!phy->gmode)
return;
b43legacy_phy_write(dev, 0x047A, 0xC111);
}
if (phy->savedpctlreg != 0xFFFF)
return;
#ifdef CONFIG_B43LEGACY_DEBUG
if (phy->manual_txpower_control)
return;
#endif
if (phy->type == B43legacy_PHYTYPE_B &&
phy->rev >= 2 &&
phy->radio_ver == 0x2050)
b43legacy_radio_write16(dev, 0x0076,
b43legacy_radio_read16(dev, 0x0076)
| 0x0084);
else {
saved_batt = phy->bbatt;
saved_ratt = phy->rfatt;
saved_txctl1 = phy->txctl1;
if ((phy->radio_rev >= 6) && (phy->radio_rev <= 8)
&& /*FIXME: incomplete specs for 5 < revision < 9 */ 0)
b43legacy_radio_set_txpower_bg(dev, 0xB, 0x1F, 0);
else
b43legacy_radio_set_txpower_bg(dev, 0xB, 9, 0);
must_reset_txpower = 1;
}
b43legacy_dummy_transmission(dev);
phy->savedpctlreg = b43legacy_phy_read(dev, B43legacy_PHY_G_PCTL);
if (must_reset_txpower)
b43legacy_radio_set_txpower_bg(dev, saved_batt, saved_ratt,
saved_txctl1);
else
b43legacy_radio_write16(dev, 0x0076, b43legacy_radio_read16(dev,
0x0076) & 0xFF7B);
b43legacy_radio_clear_tssi(dev);
}
static void b43legacy_phy_agcsetup(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 offset = 0x0000;
if (phy->rev == 1)
offset = 0x4C00;
b43legacy_ilt_write(dev, offset, 0x00FE);
b43legacy_ilt_write(dev, offset + 1, 0x000D);
b43legacy_ilt_write(dev, offset + 2, 0x0013);
b43legacy_ilt_write(dev, offset + 3, 0x0019);
if (phy->rev == 1) {
b43legacy_ilt_write(dev, 0x1800, 0x2710);
b43legacy_ilt_write(dev, 0x1801, 0x9B83);
b43legacy_ilt_write(dev, 0x1802, 0x9B83);
b43legacy_ilt_write(dev, 0x1803, 0x0F8D);
b43legacy_phy_write(dev, 0x0455, 0x0004);
}
b43legacy_phy_write(dev, 0x04A5, (b43legacy_phy_read(dev, 0x04A5)
& 0x00FF) | 0x5700);
b43legacy_phy_write(dev, 0x041A, (b43legacy_phy_read(dev, 0x041A)
& 0xFF80) | 0x000F);
b43legacy_phy_write(dev, 0x041A, (b43legacy_phy_read(dev, 0x041A)
& 0xC07F) | 0x2B80);
b43legacy_phy_write(dev, 0x048C, (b43legacy_phy_read(dev, 0x048C)
& 0xF0FF) | 0x0300);
b43legacy_radio_write16(dev, 0x007A,
b43legacy_radio_read16(dev, 0x007A)
| 0x0008);
b43legacy_phy_write(dev, 0x04A0, (b43legacy_phy_read(dev, 0x04A0)
& 0xFFF0) | 0x0008);
b43legacy_phy_write(dev, 0x04A1, (b43legacy_phy_read(dev, 0x04A1)
& 0xF0FF) | 0x0600);
b43legacy_phy_write(dev, 0x04A2, (b43legacy_phy_read(dev, 0x04A2)
& 0xF0FF) | 0x0700);
b43legacy_phy_write(dev, 0x04A0, (b43legacy_phy_read(dev, 0x04A0)
& 0xF0FF) | 0x0100);
if (phy->rev == 1)
b43legacy_phy_write(dev, 0x04A2,
(b43legacy_phy_read(dev, 0x04A2)
& 0xFFF0) | 0x0007);
b43legacy_phy_write(dev, 0x0488, (b43legacy_phy_read(dev, 0x0488)
& 0xFF00) | 0x001C);
b43legacy_phy_write(dev, 0x0488, (b43legacy_phy_read(dev, 0x0488)
& 0xC0FF) | 0x0200);
b43legacy_phy_write(dev, 0x0496, (b43legacy_phy_read(dev, 0x0496)
& 0xFF00) | 0x001C);
b43legacy_phy_write(dev, 0x0489, (b43legacy_phy_read(dev, 0x0489)
& 0xFF00) | 0x0020);
b43legacy_phy_write(dev, 0x0489, (b43legacy_phy_read(dev, 0x0489)
& 0xC0FF) | 0x0200);
b43legacy_phy_write(dev, 0x0482, (b43legacy_phy_read(dev, 0x0482)
& 0xFF00) | 0x002E);
b43legacy_phy_write(dev, 0x0496, (b43legacy_phy_read(dev, 0x0496)
& 0x00FF) | 0x1A00);
b43legacy_phy_write(dev, 0x0481, (b43legacy_phy_read(dev, 0x0481)
& 0xFF00) | 0x0028);
b43legacy_phy_write(dev, 0x0481, (b43legacy_phy_read(dev, 0x0481)
& 0x00FF) | 0x2C00);
if (phy->rev == 1) {
b43legacy_phy_write(dev, 0x0430, 0x092B);
b43legacy_phy_write(dev, 0x041B,
(b43legacy_phy_read(dev, 0x041B)
& 0xFFE1) | 0x0002);
} else {
b43legacy_phy_write(dev, 0x041B,
b43legacy_phy_read(dev, 0x041B) & 0xFFE1);
b43legacy_phy_write(dev, 0x041F, 0x287A);
b43legacy_phy_write(dev, 0x0420,
(b43legacy_phy_read(dev, 0x0420)
& 0xFFF0) | 0x0004);
}
if (phy->rev > 2) {
b43legacy_phy_write(dev, 0x0422, 0x287A);
b43legacy_phy_write(dev, 0x0420,
(b43legacy_phy_read(dev, 0x0420)
& 0x0FFF) | 0x3000);
}
b43legacy_phy_write(dev, 0x04A8, (b43legacy_phy_read(dev, 0x04A8)
& 0x8080) | 0x7874);
b43legacy_phy_write(dev, 0x048E, 0x1C00);
if (phy->rev == 1) {
b43legacy_phy_write(dev, 0x04AB,
(b43legacy_phy_read(dev, 0x04AB)
& 0xF0FF) | 0x0600);
b43legacy_phy_write(dev, 0x048B, 0x005E);
b43legacy_phy_write(dev, 0x048C,
(b43legacy_phy_read(dev, 0x048C) & 0xFF00)
| 0x001E);
b43legacy_phy_write(dev, 0x048D, 0x0002);
}
b43legacy_ilt_write(dev, offset + 0x0800, 0);
b43legacy_ilt_write(dev, offset + 0x0801, 7);
b43legacy_ilt_write(dev, offset + 0x0802, 16);
b43legacy_ilt_write(dev, offset + 0x0803, 28);
if (phy->rev >= 6) {
b43legacy_phy_write(dev, 0x0426,
(b43legacy_phy_read(dev, 0x0426) & 0xFFFC));
b43legacy_phy_write(dev, 0x0426,
(b43legacy_phy_read(dev, 0x0426) & 0xEFFF));
}
}
static void b43legacy_phy_setupg(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 i;
B43legacy_BUG_ON(phy->type != B43legacy_PHYTYPE_G);
if (phy->rev == 1) {
b43legacy_phy_write(dev, 0x0406, 0x4F19);
b43legacy_phy_write(dev, B43legacy_PHY_G_CRS,
(b43legacy_phy_read(dev,
B43legacy_PHY_G_CRS) & 0xFC3F) | 0x0340);
b43legacy_phy_write(dev, 0x042C, 0x005A);
b43legacy_phy_write(dev, 0x0427, 0x001A);
for (i = 0; i < B43legacy_ILT_FINEFREQG_SIZE; i++)
b43legacy_ilt_write(dev, 0x5800 + i,
b43legacy_ilt_finefreqg[i]);
for (i = 0; i < B43legacy_ILT_NOISEG1_SIZE; i++)
b43legacy_ilt_write(dev, 0x1800 + i,
b43legacy_ilt_noiseg1[i]);
for (i = 0; i < B43legacy_ILT_ROTOR_SIZE; i++)
b43legacy_ilt_write32(dev, 0x2000 + i,
b43legacy_ilt_rotor[i]);
} else {
/* nrssi values are signed 6-bit values. Why 0x7654 here? */
b43legacy_nrssi_hw_write(dev, 0xBA98, (s16)0x7654);
if (phy->rev == 2) {
b43legacy_phy_write(dev, 0x04C0, 0x1861);
b43legacy_phy_write(dev, 0x04C1, 0x0271);
} else if (phy->rev > 2) {
b43legacy_phy_write(dev, 0x04C0, 0x0098);
b43legacy_phy_write(dev, 0x04C1, 0x0070);
b43legacy_phy_write(dev, 0x04C9, 0x0080);
}
b43legacy_phy_write(dev, 0x042B, b43legacy_phy_read(dev,
0x042B) | 0x800);
for (i = 0; i < 64; i++)
b43legacy_ilt_write(dev, 0x4000 + i, i);
for (i = 0; i < B43legacy_ILT_NOISEG2_SIZE; i++)
b43legacy_ilt_write(dev, 0x1800 + i,
b43legacy_ilt_noiseg2[i]);
}
if (phy->rev <= 2)
for (i = 0; i < B43legacy_ILT_NOISESCALEG_SIZE; i++)
b43legacy_ilt_write(dev, 0x1400 + i,
b43legacy_ilt_noisescaleg1[i]);
else if ((phy->rev >= 7) && (b43legacy_phy_read(dev, 0x0449) & 0x0200))
for (i = 0; i < B43legacy_ILT_NOISESCALEG_SIZE; i++)
b43legacy_ilt_write(dev, 0x1400 + i,
b43legacy_ilt_noisescaleg3[i]);
else
for (i = 0; i < B43legacy_ILT_NOISESCALEG_SIZE; i++)
b43legacy_ilt_write(dev, 0x1400 + i,
b43legacy_ilt_noisescaleg2[i]);
if (phy->rev == 2)
for (i = 0; i < B43legacy_ILT_SIGMASQR_SIZE; i++)
b43legacy_ilt_write(dev, 0x5000 + i,
b43legacy_ilt_sigmasqr1[i]);
else if ((phy->rev > 2) && (phy->rev <= 8))
for (i = 0; i < B43legacy_ILT_SIGMASQR_SIZE; i++)
b43legacy_ilt_write(dev, 0x5000 + i,
b43legacy_ilt_sigmasqr2[i]);
if (phy->rev == 1) {
for (i = 0; i < B43legacy_ILT_RETARD_SIZE; i++)
b43legacy_ilt_write32(dev, 0x2400 + i,
b43legacy_ilt_retard[i]);
for (i = 4; i < 20; i++)
b43legacy_ilt_write(dev, 0x5400 + i, 0x0020);
b43legacy_phy_agcsetup(dev);
if (is_bcm_board_vendor(dev) &&
(dev->dev->bus->boardinfo.type == 0x0416) &&
(dev->dev->bus->boardinfo.rev == 0x0017))
return;
b43legacy_ilt_write(dev, 0x5001, 0x0002);
b43legacy_ilt_write(dev, 0x5002, 0x0001);
} else {
for (i = 0; i <= 0x20; i++)
b43legacy_ilt_write(dev, 0x1000 + i, 0x0820);
b43legacy_phy_agcsetup(dev);
b43legacy_phy_read(dev, 0x0400); /* dummy read */
b43legacy_phy_write(dev, 0x0403, 0x1000);
b43legacy_ilt_write(dev, 0x3C02, 0x000F);
b43legacy_ilt_write(dev, 0x3C03, 0x0014);
if (is_bcm_board_vendor(dev) &&
(dev->dev->bus->boardinfo.type == 0x0416) &&
(dev->dev->bus->boardinfo.rev == 0x0017))
return;
b43legacy_ilt_write(dev, 0x0401, 0x0002);
b43legacy_ilt_write(dev, 0x0402, 0x0001);
}
}
/* Initialize the APHY portion of a GPHY. */
static void b43legacy_phy_inita(struct b43legacy_wldev *dev)
{
might_sleep();
b43legacy_phy_setupg(dev);
if (dev->dev->bus->sprom.boardflags_lo & B43legacy_BFL_PACTRL)
b43legacy_phy_write(dev, 0x046E, 0x03CF);
}
static void b43legacy_phy_initb2(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 offset;
int val;
b43legacy_write16(dev, 0x03EC, 0x3F22);
b43legacy_phy_write(dev, 0x0020, 0x301C);
b43legacy_phy_write(dev, 0x0026, 0x0000);
b43legacy_phy_write(dev, 0x0030, 0x00C6);
b43legacy_phy_write(dev, 0x0088, 0x3E00);
val = 0x3C3D;
for (offset = 0x0089; offset < 0x00A7; offset++) {
b43legacy_phy_write(dev, offset, val);
val -= 0x0202;
}
b43legacy_phy_write(dev, 0x03E4, 0x3000);
b43legacy_radio_selectchannel(dev, phy->channel, 0);
if (phy->radio_ver != 0x2050) {
b43legacy_radio_write16(dev, 0x0075, 0x0080);
b43legacy_radio_write16(dev, 0x0079, 0x0081);
}
b43legacy_radio_write16(dev, 0x0050, 0x0020);
b43legacy_radio_write16(dev, 0x0050, 0x0023);
if (phy->radio_ver == 0x2050) {
b43legacy_radio_write16(dev, 0x0050, 0x0020);
b43legacy_radio_write16(dev, 0x005A, 0x0070);
b43legacy_radio_write16(dev, 0x005B, 0x007B);
b43legacy_radio_write16(dev, 0x005C, 0x00B0);
b43legacy_radio_write16(dev, 0x007A, 0x000F);
b43legacy_phy_write(dev, 0x0038, 0x0677);
b43legacy_radio_init2050(dev);
}
b43legacy_phy_write(dev, 0x0014, 0x0080);
b43legacy_phy_write(dev, 0x0032, 0x00CA);
b43legacy_phy_write(dev, 0x0032, 0x00CC);
b43legacy_phy_write(dev, 0x0035, 0x07C2);
b43legacy_phy_lo_b_measure(dev);
b43legacy_phy_write(dev, 0x0026, 0xCC00);
if (phy->radio_ver != 0x2050)
b43legacy_phy_write(dev, 0x0026, 0xCE00);
b43legacy_write16(dev, B43legacy_MMIO_CHANNEL_EXT, 0x1000);
b43legacy_phy_write(dev, 0x002A, 0x88A3);
if (phy->radio_ver != 0x2050)
b43legacy_phy_write(dev, 0x002A, 0x88C2);
b43legacy_radio_set_txpower_bg(dev, 0xFFFF, 0xFFFF, 0xFFFF);
b43legacy_phy_init_pctl(dev);
}
static void b43legacy_phy_initb4(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 offset;
u16 val;
b43legacy_write16(dev, 0x03EC, 0x3F22);
b43legacy_phy_write(dev, 0x0020, 0x301C);
b43legacy_phy_write(dev, 0x0026, 0x0000);
b43legacy_phy_write(dev, 0x0030, 0x00C6);
b43legacy_phy_write(dev, 0x0088, 0x3E00);
val = 0x3C3D;
for (offset = 0x0089; offset < 0x00A7; offset++) {
b43legacy_phy_write(dev, offset, val);
val -= 0x0202;
}
b43legacy_phy_write(dev, 0x03E4, 0x3000);
b43legacy_radio_selectchannel(dev, phy->channel, 0);
if (phy->radio_ver != 0x2050) {
b43legacy_radio_write16(dev, 0x0075, 0x0080);
b43legacy_radio_write16(dev, 0x0079, 0x0081);
}
b43legacy_radio_write16(dev, 0x0050, 0x0020);
b43legacy_radio_write16(dev, 0x0050, 0x0023);
if (phy->radio_ver == 0x2050) {
b43legacy_radio_write16(dev, 0x0050, 0x0020);
b43legacy_radio_write16(dev, 0x005A, 0x0070);
b43legacy_radio_write16(dev, 0x005B, 0x007B);
b43legacy_radio_write16(dev, 0x005C, 0x00B0);
b43legacy_radio_write16(dev, 0x007A, 0x000F);
b43legacy_phy_write(dev, 0x0038, 0x0677);
b43legacy_radio_init2050(dev);
}
b43legacy_phy_write(dev, 0x0014, 0x0080);
b43legacy_phy_write(dev, 0x0032, 0x00CA);
if (phy->radio_ver == 0x2050)
b43legacy_phy_write(dev, 0x0032, 0x00E0);
b43legacy_phy_write(dev, 0x0035, 0x07C2);
b43legacy_phy_lo_b_measure(dev);
b43legacy_phy_write(dev, 0x0026, 0xCC00);
if (phy->radio_ver == 0x2050)
b43legacy_phy_write(dev, 0x0026, 0xCE00);
b43legacy_write16(dev, B43legacy_MMIO_CHANNEL_EXT, 0x1100);
b43legacy_phy_write(dev, 0x002A, 0x88A3);
if (phy->radio_ver == 0x2050)
b43legacy_phy_write(dev, 0x002A, 0x88C2);
b43legacy_radio_set_txpower_bg(dev, 0xFFFF, 0xFFFF, 0xFFFF);
if (dev->dev->bus->sprom.boardflags_lo & B43legacy_BFL_RSSI) {
b43legacy_calc_nrssi_slope(dev);
b43legacy_calc_nrssi_threshold(dev);
}
b43legacy_phy_init_pctl(dev);
}
static void b43legacy_phy_initb5(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 offset;
u16 value;
u8 old_channel;
if (phy->analog == 1)
b43legacy_radio_write16(dev, 0x007A,
b43legacy_radio_read16(dev, 0x007A)
| 0x0050);
if (!is_bcm_board_vendor(dev) &&
(dev->dev->bus->boardinfo.type != 0x0416)) {
value = 0x2120;
for (offset = 0x00A8 ; offset < 0x00C7; offset++) {
b43legacy_phy_write(dev, offset, value);
value += 0x0202;
}
}
b43legacy_phy_write(dev, 0x0035,
(b43legacy_phy_read(dev, 0x0035) & 0xF0FF)
| 0x0700);
if (phy->radio_ver == 0x2050)
b43legacy_phy_write(dev, 0x0038, 0x0667);
if (phy->gmode) {
if (phy->radio_ver == 0x2050) {
b43legacy_radio_write16(dev, 0x007A,
b43legacy_radio_read16(dev, 0x007A)
| 0x0020);
b43legacy_radio_write16(dev, 0x0051,
b43legacy_radio_read16(dev, 0x0051)
| 0x0004);
}
b43legacy_write16(dev, B43legacy_MMIO_PHY_RADIO, 0x0000);
b43legacy_phy_write(dev, 0x0802, b43legacy_phy_read(dev, 0x0802)
| 0x0100);
b43legacy_phy_write(dev, 0x042B, b43legacy_phy_read(dev, 0x042B)
| 0x2000);
b43legacy_phy_write(dev, 0x001C, 0x186A);
b43legacy_phy_write(dev, 0x0013, (b43legacy_phy_read(dev,
0x0013) & 0x00FF) | 0x1900);
b43legacy_phy_write(dev, 0x0035, (b43legacy_phy_read(dev,
0x0035) & 0xFFC0) | 0x0064);
b43legacy_phy_write(dev, 0x005D, (b43legacy_phy_read(dev,
0x005D) & 0xFF80) | 0x000A);
}
if (dev->bad_frames_preempt)
b43legacy_phy_write(dev, B43legacy_PHY_RADIO_BITFIELD,
b43legacy_phy_read(dev,
B43legacy_PHY_RADIO_BITFIELD) | (1 << 11));
if (phy->analog == 1) {
b43legacy_phy_write(dev, 0x0026, 0xCE00);
b43legacy_phy_write(dev, 0x0021, 0x3763);
b43legacy_phy_write(dev, 0x0022, 0x1BC3);
b43legacy_phy_write(dev, 0x0023, 0x06F9);
b43legacy_phy_write(dev, 0x0024, 0x037E);
} else
b43legacy_phy_write(dev, 0x0026, 0xCC00);
b43legacy_phy_write(dev, 0x0030, 0x00C6);
b43legacy_write16(dev, 0x03EC, 0x3F22);
if (phy->analog == 1)
b43legacy_phy_write(dev, 0x0020, 0x3E1C);
else
b43legacy_phy_write(dev, 0x0020, 0x301C);
if (phy->analog == 0)
b43legacy_write16(dev, 0x03E4, 0x3000);
old_channel = (phy->channel == 0xFF) ? 1 : phy->channel;
/* Force to channel 7, even if not supported. */
b43legacy_radio_selectchannel(dev, 7, 0);
if (phy->radio_ver != 0x2050) {
b43legacy_radio_write16(dev, 0x0075, 0x0080);
b43legacy_radio_write16(dev, 0x0079, 0x0081);
}
b43legacy_radio_write16(dev, 0x0050, 0x0020);
b43legacy_radio_write16(dev, 0x0050, 0x0023);
if (phy->radio_ver == 0x2050) {
b43legacy_radio_write16(dev, 0x0050, 0x0020);
b43legacy_radio_write16(dev, 0x005A, 0x0070);
}
b43legacy_radio_write16(dev, 0x005B, 0x007B);
b43legacy_radio_write16(dev, 0x005C, 0x00B0);
b43legacy_radio_write16(dev, 0x007A, b43legacy_radio_read16(dev,
0x007A) | 0x0007);
b43legacy_radio_selectchannel(dev, old_channel, 0);
b43legacy_phy_write(dev, 0x0014, 0x0080);
b43legacy_phy_write(dev, 0x0032, 0x00CA);
b43legacy_phy_write(dev, 0x002A, 0x88A3);
b43legacy_radio_set_txpower_bg(dev, 0xFFFF, 0xFFFF, 0xFFFF);
if (phy->radio_ver == 0x2050)
b43legacy_radio_write16(dev, 0x005D, 0x000D);
b43legacy_write16(dev, 0x03E4, (b43legacy_read16(dev, 0x03E4) &
0xFFC0) | 0x0004);
}
static void b43legacy_phy_initb6(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 offset;
u16 val;
u8 old_channel;
b43legacy_phy_write(dev, 0x003E, 0x817A);
b43legacy_radio_write16(dev, 0x007A,
(b43legacy_radio_read16(dev, 0x007A) | 0x0058));
if (phy->radio_rev == 4 ||
phy->radio_rev == 5) {
b43legacy_radio_write16(dev, 0x0051, 0x0037);
b43legacy_radio_write16(dev, 0x0052, 0x0070);
b43legacy_radio_write16(dev, 0x0053, 0x00B3);
b43legacy_radio_write16(dev, 0x0054, 0x009B);
b43legacy_radio_write16(dev, 0x005A, 0x0088);
b43legacy_radio_write16(dev, 0x005B, 0x0088);
b43legacy_radio_write16(dev, 0x005D, 0x0088);
b43legacy_radio_write16(dev, 0x005E, 0x0088);
b43legacy_radio_write16(dev, 0x007D, 0x0088);
b43legacy_shm_write32(dev, B43legacy_SHM_SHARED,
B43legacy_UCODEFLAGS_OFFSET,
(b43legacy_shm_read32(dev,
B43legacy_SHM_SHARED,
B43legacy_UCODEFLAGS_OFFSET)
| 0x00000200));
}
if (phy->radio_rev == 8) {
b43legacy_radio_write16(dev, 0x0051, 0x0000);
b43legacy_radio_write16(dev, 0x0052, 0x0040);
b43legacy_radio_write16(dev, 0x0053, 0x00B7);
b43legacy_radio_write16(dev, 0x0054, 0x0098);
b43legacy_radio_write16(dev, 0x005A, 0x0088);
b43legacy_radio_write16(dev, 0x005B, 0x006B);
b43legacy_radio_write16(dev, 0x005C, 0x000F);
if (dev->dev->bus->sprom.boardflags_lo & 0x8000) {
b43legacy_radio_write16(dev, 0x005D, 0x00FA);
b43legacy_radio_write16(dev, 0x005E, 0x00D8);
} else {
b43legacy_radio_write16(dev, 0x005D, 0x00F5);
b43legacy_radio_write16(dev, 0x005E, 0x00B8);
}
b43legacy_radio_write16(dev, 0x0073, 0x0003);
b43legacy_radio_write16(dev, 0x007D, 0x00A8);
b43legacy_radio_write16(dev, 0x007C, 0x0001);
b43legacy_radio_write16(dev, 0x007E, 0x0008);
}
val = 0x1E1F;
for (offset = 0x0088; offset < 0x0098; offset++) {
b43legacy_phy_write(dev, offset, val);
val -= 0x0202;
}
val = 0x3E3F;
for (offset = 0x0098; offset < 0x00A8; offset++) {
b43legacy_phy_write(dev, offset, val);
val -= 0x0202;
}
val = 0x2120;
for (offset = 0x00A8; offset < 0x00C8; offset++) {
b43legacy_phy_write(dev, offset, (val & 0x3F3F));
val += 0x0202;
}
if (phy->type == B43legacy_PHYTYPE_G) {
b43legacy_radio_write16(dev, 0x007A,
b43legacy_radio_read16(dev, 0x007A) |
0x0020);
b43legacy_radio_write16(dev, 0x0051,
b43legacy_radio_read16(dev, 0x0051) |
0x0004);
b43legacy_phy_write(dev, 0x0802,
b43legacy_phy_read(dev, 0x0802) | 0x0100);
b43legacy_phy_write(dev, 0x042B,
b43legacy_phy_read(dev, 0x042B) | 0x2000);
b43legacy_phy_write(dev, 0x5B, 0x0000);
b43legacy_phy_write(dev, 0x5C, 0x0000);
}
old_channel = phy->channel;
if (old_channel >= 8)
b43legacy_radio_selectchannel(dev, 1, 0);
else
b43legacy_radio_selectchannel(dev, 13, 0);
b43legacy_radio_write16(dev, 0x0050, 0x0020);
b43legacy_radio_write16(dev, 0x0050, 0x0023);
udelay(40);
if (phy->radio_rev < 6 || phy->radio_rev == 8) {
b43legacy_radio_write16(dev, 0x007C,
(b43legacy_radio_read16(dev, 0x007C)
| 0x0002));
b43legacy_radio_write16(dev, 0x0050, 0x0020);
}
if (phy->radio_rev <= 2) {
b43legacy_radio_write16(dev, 0x007C, 0x0020);
b43legacy_radio_write16(dev, 0x005A, 0x0070);
b43legacy_radio_write16(dev, 0x005B, 0x007B);
b43legacy_radio_write16(dev, 0x005C, 0x00B0);
}
b43legacy_radio_write16(dev, 0x007A,
(b43legacy_radio_read16(dev,
0x007A) & 0x00F8) | 0x0007);
b43legacy_radio_selectchannel(dev, old_channel, 0);
b43legacy_phy_write(dev, 0x0014, 0x0200);
if (phy->radio_rev >= 6)
b43legacy_phy_write(dev, 0x002A, 0x88C2);
else
b43legacy_phy_write(dev, 0x002A, 0x8AC0);
b43legacy_phy_write(dev, 0x0038, 0x0668);
b43legacy_radio_set_txpower_bg(dev, 0xFFFF, 0xFFFF, 0xFFFF);
if (phy->radio_rev <= 5)
b43legacy_phy_write(dev, 0x005D, (b43legacy_phy_read(dev,
0x005D) & 0xFF80) | 0x0003);
if (phy->radio_rev <= 2)
b43legacy_radio_write16(dev, 0x005D, 0x000D);
if (phy->analog == 4) {
b43legacy_write16(dev, 0x03E4, 0x0009);
b43legacy_phy_write(dev, 0x61, b43legacy_phy_read(dev, 0x61)
& 0xFFF);
} else
b43legacy_phy_write(dev, 0x0002, (b43legacy_phy_read(dev,
0x0002) & 0xFFC0) | 0x0004);
if (phy->type == B43legacy_PHYTYPE_G)
b43legacy_write16(dev, 0x03E6, 0x0);
if (phy->type == B43legacy_PHYTYPE_B) {
b43legacy_write16(dev, 0x03E6, 0x8140);
b43legacy_phy_write(dev, 0x0016, 0x0410);
b43legacy_phy_write(dev, 0x0017, 0x0820);
b43legacy_phy_write(dev, 0x0062, 0x0007);
b43legacy_radio_init2050(dev);
b43legacy_phy_lo_g_measure(dev);
if (dev->dev->bus->sprom.boardflags_lo &
B43legacy_BFL_RSSI) {
b43legacy_calc_nrssi_slope(dev);
b43legacy_calc_nrssi_threshold(dev);
}
b43legacy_phy_init_pctl(dev);
}
}
static void b43legacy_calc_loopback_gain(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 backup_phy[15] = {0};
u16 backup_radio[3];
u16 backup_bband;
u16 i;
u16 loop1_cnt;
u16 loop1_done;
u16 loop1_omitted;
u16 loop2_done;
backup_phy[0] = b43legacy_phy_read(dev, 0x0429);
backup_phy[1] = b43legacy_phy_read(dev, 0x0001);
backup_phy[2] = b43legacy_phy_read(dev, 0x0811);
backup_phy[3] = b43legacy_phy_read(dev, 0x0812);
if (phy->rev != 1) {
backup_phy[4] = b43legacy_phy_read(dev, 0x0814);
backup_phy[5] = b43legacy_phy_read(dev, 0x0815);
}
backup_phy[6] = b43legacy_phy_read(dev, 0x005A);
backup_phy[7] = b43legacy_phy_read(dev, 0x0059);
backup_phy[8] = b43legacy_phy_read(dev, 0x0058);
backup_phy[9] = b43legacy_phy_read(dev, 0x000A);
backup_phy[10] = b43legacy_phy_read(dev, 0x0003);
backup_phy[11] = b43legacy_phy_read(dev, 0x080F);
backup_phy[12] = b43legacy_phy_read(dev, 0x0810);
backup_phy[13] = b43legacy_phy_read(dev, 0x002B);
backup_phy[14] = b43legacy_phy_read(dev, 0x0015);
b43legacy_phy_read(dev, 0x002D); /* dummy read */
backup_bband = phy->bbatt;
backup_radio[0] = b43legacy_radio_read16(dev, 0x0052);
backup_radio[1] = b43legacy_radio_read16(dev, 0x0043);
backup_radio[2] = b43legacy_radio_read16(dev, 0x007A);
b43legacy_phy_write(dev, 0x0429,
b43legacy_phy_read(dev, 0x0429) & 0x3FFF);
b43legacy_phy_write(dev, 0x0001,
b43legacy_phy_read(dev, 0x0001) & 0x8000);
b43legacy_phy_write(dev, 0x0811,
b43legacy_phy_read(dev, 0x0811) | 0x0002);
b43legacy_phy_write(dev, 0x0812,
b43legacy_phy_read(dev, 0x0812) & 0xFFFD);
b43legacy_phy_write(dev, 0x0811,
b43legacy_phy_read(dev, 0x0811) | 0x0001);
b43legacy_phy_write(dev, 0x0812,
b43legacy_phy_read(dev, 0x0812) & 0xFFFE);
if (phy->rev != 1) {
b43legacy_phy_write(dev, 0x0814,
b43legacy_phy_read(dev, 0x0814) | 0x0001);
b43legacy_phy_write(dev, 0x0815,
b43legacy_phy_read(dev, 0x0815) & 0xFFFE);
b43legacy_phy_write(dev, 0x0814,
b43legacy_phy_read(dev, 0x0814) | 0x0002);
b43legacy_phy_write(dev, 0x0815,
b43legacy_phy_read(dev, 0x0815) & 0xFFFD);
}
b43legacy_phy_write(dev, 0x0811, b43legacy_phy_read(dev, 0x0811) |
0x000C);
b43legacy_phy_write(dev, 0x0812, b43legacy_phy_read(dev, 0x0812) |
0x000C);
b43legacy_phy_write(dev, 0x0811, (b43legacy_phy_read(dev, 0x0811)
& 0xFFCF) | 0x0030);
b43legacy_phy_write(dev, 0x0812, (b43legacy_phy_read(dev, 0x0812)
& 0xFFCF) | 0x0010);
b43legacy_phy_write(dev, 0x005A, 0x0780);
b43legacy_phy_write(dev, 0x0059, 0xC810);
b43legacy_phy_write(dev, 0x0058, 0x000D);
if (phy->analog == 0)
b43legacy_phy_write(dev, 0x0003, 0x0122);
else
b43legacy_phy_write(dev, 0x000A,
b43legacy_phy_read(dev, 0x000A)
| 0x2000);
if (phy->rev != 1) {
b43legacy_phy_write(dev, 0x0814,
b43legacy_phy_read(dev, 0x0814) | 0x0004);
b43legacy_phy_write(dev, 0x0815,
b43legacy_phy_read(dev, 0x0815) & 0xFFFB);
}
b43legacy_phy_write(dev, 0x0003,
(b43legacy_phy_read(dev, 0x0003)
& 0xFF9F) | 0x0040);
if (phy->radio_ver == 0x2050 && phy->radio_rev == 2) {
b43legacy_radio_write16(dev, 0x0052, 0x0000);
b43legacy_radio_write16(dev, 0x0043,
(b43legacy_radio_read16(dev, 0x0043)
& 0xFFF0) | 0x0009);
loop1_cnt = 9;
} else if (phy->radio_rev == 8) {
b43legacy_radio_write16(dev, 0x0043, 0x000F);
loop1_cnt = 15;
} else
loop1_cnt = 0;
b43legacy_phy_set_baseband_attenuation(dev, 11);
if (phy->rev >= 3)
b43legacy_phy_write(dev, 0x080F, 0xC020);
else
b43legacy_phy_write(dev, 0x080F, 0x8020);
b43legacy_phy_write(dev, 0x0810, 0x0000);
b43legacy_phy_write(dev, 0x002B,
(b43legacy_phy_read(dev, 0x002B)
& 0xFFC0) | 0x0001);
b43legacy_phy_write(dev, 0x002B,
(b43legacy_phy_read(dev, 0x002B)
& 0xC0FF) | 0x0800);
b43legacy_phy_write(dev, 0x0811,
b43legacy_phy_read(dev, 0x0811) | 0x0100);
b43legacy_phy_write(dev, 0x0812,
b43legacy_phy_read(dev, 0x0812) & 0xCFFF);
if (dev->dev->bus->sprom.boardflags_lo & B43legacy_BFL_EXTLNA) {
if (phy->rev >= 7) {
b43legacy_phy_write(dev, 0x0811,
b43legacy_phy_read(dev, 0x0811)
| 0x0800);
b43legacy_phy_write(dev, 0x0812,
b43legacy_phy_read(dev, 0x0812)
| 0x8000);
}
}
b43legacy_radio_write16(dev, 0x007A,
b43legacy_radio_read16(dev, 0x007A)
& 0x00F7);
for (i = 0; i < loop1_cnt; i++) {
b43legacy_radio_write16(dev, 0x0043, loop1_cnt);
b43legacy_phy_write(dev, 0x0812,
(b43legacy_phy_read(dev, 0x0812)
& 0xF0FF) | (i << 8));
b43legacy_phy_write(dev, 0x0015,
(b43legacy_phy_read(dev, 0x0015)
& 0x0FFF) | 0xA000);
b43legacy_phy_write(dev, 0x0015,
(b43legacy_phy_read(dev, 0x0015)
& 0x0FFF) | 0xF000);
udelay(20);
if (b43legacy_phy_read(dev, 0x002D) >= 0x0DFC)
break;
}
loop1_done = i;
loop1_omitted = loop1_cnt - loop1_done;
loop2_done = 0;
if (loop1_done >= 8) {
b43legacy_phy_write(dev, 0x0812,
b43legacy_phy_read(dev, 0x0812)
| 0x0030);
for (i = loop1_done - 8; i < 16; i++) {
b43legacy_phy_write(dev, 0x0812,
(b43legacy_phy_read(dev, 0x0812)
& 0xF0FF) | (i << 8));
b43legacy_phy_write(dev, 0x0015,
(b43legacy_phy_read(dev, 0x0015)
& 0x0FFF) | 0xA000);
b43legacy_phy_write(dev, 0x0015,
(b43legacy_phy_read(dev, 0x0015)
& 0x0FFF) | 0xF000);
udelay(20);
if (b43legacy_phy_read(dev, 0x002D) >= 0x0DFC)
break;
}
}
if (phy->rev != 1) {
b43legacy_phy_write(dev, 0x0814, backup_phy[4]);
b43legacy_phy_write(dev, 0x0815, backup_phy[5]);
}
b43legacy_phy_write(dev, 0x005A, backup_phy[6]);
b43legacy_phy_write(dev, 0x0059, backup_phy[7]);
b43legacy_phy_write(dev, 0x0058, backup_phy[8]);
b43legacy_phy_write(dev, 0x000A, backup_phy[9]);
b43legacy_phy_write(dev, 0x0003, backup_phy[10]);
b43legacy_phy_write(dev, 0x080F, backup_phy[11]);
b43legacy_phy_write(dev, 0x0810, backup_phy[12]);
b43legacy_phy_write(dev, 0x002B, backup_phy[13]);
b43legacy_phy_write(dev, 0x0015, backup_phy[14]);
b43legacy_phy_set_baseband_attenuation(dev, backup_bband);
b43legacy_radio_write16(dev, 0x0052, backup_radio[0]);
b43legacy_radio_write16(dev, 0x0043, backup_radio[1]);
b43legacy_radio_write16(dev, 0x007A, backup_radio[2]);
b43legacy_phy_write(dev, 0x0811, backup_phy[2] | 0x0003);
udelay(10);
b43legacy_phy_write(dev, 0x0811, backup_phy[2]);
b43legacy_phy_write(dev, 0x0812, backup_phy[3]);
b43legacy_phy_write(dev, 0x0429, backup_phy[0]);
b43legacy_phy_write(dev, 0x0001, backup_phy[1]);
phy->loopback_gain[0] = ((loop1_done * 6) - (loop1_omitted * 4)) - 11;
phy->loopback_gain[1] = (24 - (3 * loop2_done)) * 2;
}
static void b43legacy_phy_initg(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 tmp;
if (phy->rev == 1)
b43legacy_phy_initb5(dev);
else
b43legacy_phy_initb6(dev);
if (phy->rev >= 2 || phy->gmode)
b43legacy_phy_inita(dev);
if (phy->rev >= 2) {
b43legacy_phy_write(dev, 0x0814, 0x0000);
b43legacy_phy_write(dev, 0x0815, 0x0000);
}
if (phy->rev == 2) {
b43legacy_phy_write(dev, 0x0811, 0x0000);
b43legacy_phy_write(dev, 0x0015, 0x00C0);
}
if (phy->rev > 5) {
b43legacy_phy_write(dev, 0x0811, 0x0400);
b43legacy_phy_write(dev, 0x0015, 0x00C0);
}
if (phy->rev >= 2 || phy->gmode) {
tmp = b43legacy_phy_read(dev, 0x0400) & 0xFF;
if (tmp == 3 || tmp == 5) {
b43legacy_phy_write(dev, 0x04C2, 0x1816);
b43legacy_phy_write(dev, 0x04C3, 0x8006);
if (tmp == 5)
b43legacy_phy_write(dev, 0x04CC,
(b43legacy_phy_read(dev,
0x04CC) & 0x00FF) |
0x1F00);
}
b43legacy_phy_write(dev, 0x047E, 0x0078);
}
if (phy->radio_rev == 8) {
b43legacy_phy_write(dev, 0x0801, b43legacy_phy_read(dev, 0x0801)
| 0x0080);
b43legacy_phy_write(dev, 0x043E, b43legacy_phy_read(dev, 0x043E)
| 0x0004);
}
if (phy->rev >= 2 && phy->gmode)
b43legacy_calc_loopback_gain(dev);
if (phy->radio_rev != 8) {
if (phy->initval == 0xFFFF)
phy->initval = b43legacy_radio_init2050(dev);
else
b43legacy_radio_write16(dev, 0x0078, phy->initval);
}
if (phy->txctl2 == 0xFFFF)
b43legacy_phy_lo_g_measure(dev);
else {
if (phy->radio_ver == 0x2050 && phy->radio_rev == 8)
b43legacy_radio_write16(dev, 0x0052,
(phy->txctl1 << 4) |
phy->txctl2);
else
b43legacy_radio_write16(dev, 0x0052,
(b43legacy_radio_read16(dev,
0x0052) & 0xFFF0) |
phy->txctl1);
if (phy->rev >= 6)
b43legacy_phy_write(dev, 0x0036,
(b43legacy_phy_read(dev, 0x0036)
& 0x0FFF) | (phy->txctl2 << 12));
if (dev->dev->bus->sprom.boardflags_lo &
B43legacy_BFL_PACTRL)
b43legacy_phy_write(dev, 0x002E, 0x8075);
else
b43legacy_phy_write(dev, 0x002E, 0x807F);
if (phy->rev < 2)
b43legacy_phy_write(dev, 0x002F, 0x0101);
else
b43legacy_phy_write(dev, 0x002F, 0x0202);
}
if (phy->gmode || phy->rev >= 2) {
b43legacy_phy_lo_adjust(dev, 0);
b43legacy_phy_write(dev, 0x080F, 0x8078);
}
if (!(dev->dev->bus->sprom.boardflags_lo & B43legacy_BFL_RSSI)) {
/* The specs state to update the NRSSI LT with
* the value 0x7FFFFFFF here. I think that is some weird
* compiler optimization in the original driver.
* Essentially, what we do here is resetting all NRSSI LT
* entries to -32 (see the limit_value() in nrssi_hw_update())
*/
b43legacy_nrssi_hw_update(dev, 0xFFFF);
b43legacy_calc_nrssi_threshold(dev);
} else if (phy->gmode || phy->rev >= 2) {
if (phy->nrssi[0] == -1000) {
B43legacy_WARN_ON(phy->nrssi[1] != -1000);
b43legacy_calc_nrssi_slope(dev);
} else {
B43legacy_WARN_ON(phy->nrssi[1] == -1000);
b43legacy_calc_nrssi_threshold(dev);
}
}
if (phy->radio_rev == 8)
b43legacy_phy_write(dev, 0x0805, 0x3230);
b43legacy_phy_init_pctl(dev);
if (dev->dev->bus->chip_id == 0x4306
&& dev->dev->bus->chip_package == 2) {
b43legacy_phy_write(dev, 0x0429,
b43legacy_phy_read(dev, 0x0429) & 0xBFFF);
b43legacy_phy_write(dev, 0x04C3,
b43legacy_phy_read(dev, 0x04C3) & 0x7FFF);
}
}
static u16 b43legacy_phy_lo_b_r15_loop(struct b43legacy_wldev *dev)
{
int i;
u16 ret = 0;
unsigned long flags;
local_irq_save(flags);
for (i = 0; i < 10; i++) {
b43legacy_phy_write(dev, 0x0015, 0xAFA0);
udelay(1);
b43legacy_phy_write(dev, 0x0015, 0xEFA0);
udelay(10);
b43legacy_phy_write(dev, 0x0015, 0xFFA0);
udelay(40);
ret += b43legacy_phy_read(dev, 0x002C);
}
local_irq_restore(flags);
b43legacy_voluntary_preempt();
return ret;
}
void b43legacy_phy_lo_b_measure(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 regstack[12] = { 0 };
u16 mls;
u16 fval;
int i;
int j;
regstack[0] = b43legacy_phy_read(dev, 0x0015);
regstack[1] = b43legacy_radio_read16(dev, 0x0052) & 0xFFF0;
if (phy->radio_ver == 0x2053) {
regstack[2] = b43legacy_phy_read(dev, 0x000A);
regstack[3] = b43legacy_phy_read(dev, 0x002A);
regstack[4] = b43legacy_phy_read(dev, 0x0035);
regstack[5] = b43legacy_phy_read(dev, 0x0003);
regstack[6] = b43legacy_phy_read(dev, 0x0001);
regstack[7] = b43legacy_phy_read(dev, 0x0030);
regstack[8] = b43legacy_radio_read16(dev, 0x0043);
regstack[9] = b43legacy_radio_read16(dev, 0x007A);
regstack[10] = b43legacy_read16(dev, 0x03EC);
regstack[11] = b43legacy_radio_read16(dev, 0x0052) & 0x00F0;
b43legacy_phy_write(dev, 0x0030, 0x00FF);
b43legacy_write16(dev, 0x03EC, 0x3F3F);
b43legacy_phy_write(dev, 0x0035, regstack[4] & 0xFF7F);
b43legacy_radio_write16(dev, 0x007A, regstack[9] & 0xFFF0);
}
b43legacy_phy_write(dev, 0x0015, 0xB000);
b43legacy_phy_write(dev, 0x002B, 0x0004);
if (phy->radio_ver == 0x2053) {
b43legacy_phy_write(dev, 0x002B, 0x0203);
b43legacy_phy_write(dev, 0x002A, 0x08A3);
}
phy->minlowsig[0] = 0xFFFF;
for (i = 0; i < 4; i++) {
b43legacy_radio_write16(dev, 0x0052, regstack[1] | i);
b43legacy_phy_lo_b_r15_loop(dev);
}
for (i = 0; i < 10; i++) {
b43legacy_radio_write16(dev, 0x0052, regstack[1] | i);
mls = b43legacy_phy_lo_b_r15_loop(dev) / 10;
if (mls < phy->minlowsig[0]) {
phy->minlowsig[0] = mls;
phy->minlowsigpos[0] = i;
}
}
b43legacy_radio_write16(dev, 0x0052, regstack[1]
| phy->minlowsigpos[0]);
phy->minlowsig[1] = 0xFFFF;
for (i = -4; i < 5; i += 2) {
for (j = -4; j < 5; j += 2) {
if (j < 0)
fval = (0x0100 * i) + j + 0x0100;
else
fval = (0x0100 * i) + j;
b43legacy_phy_write(dev, 0x002F, fval);
mls = b43legacy_phy_lo_b_r15_loop(dev) / 10;
if (mls < phy->minlowsig[1]) {
phy->minlowsig[1] = mls;
phy->minlowsigpos[1] = fval;
}
}
}
phy->minlowsigpos[1] += 0x0101;
b43legacy_phy_write(dev, 0x002F, phy->minlowsigpos[1]);
if (phy->radio_ver == 0x2053) {
b43legacy_phy_write(dev, 0x000A, regstack[2]);
b43legacy_phy_write(dev, 0x002A, regstack[3]);
b43legacy_phy_write(dev, 0x0035, regstack[4]);
b43legacy_phy_write(dev, 0x0003, regstack[5]);
b43legacy_phy_write(dev, 0x0001, regstack[6]);
b43legacy_phy_write(dev, 0x0030, regstack[7]);
b43legacy_radio_write16(dev, 0x0043, regstack[8]);
b43legacy_radio_write16(dev, 0x007A, regstack[9]);
b43legacy_radio_write16(dev, 0x0052,
(b43legacy_radio_read16(dev, 0x0052)
& 0x000F) | regstack[11]);
b43legacy_write16(dev, 0x03EC, regstack[10]);
}
b43legacy_phy_write(dev, 0x0015, regstack[0]);
}
static inline
u16 b43legacy_phy_lo_g_deviation_subval(struct b43legacy_wldev *dev,
u16 control)
{
struct b43legacy_phy *phy = &dev->phy;
u16 ret;
unsigned long flags;
local_irq_save(flags);
if (phy->gmode) {
b43legacy_phy_write(dev, 0x15, 0xE300);
control <<= 8;
b43legacy_phy_write(dev, 0x0812, control | 0x00B0);
udelay(5);
b43legacy_phy_write(dev, 0x0812, control | 0x00B2);
udelay(2);
b43legacy_phy_write(dev, 0x0812, control | 0x00B3);
udelay(4);
b43legacy_phy_write(dev, 0x0015, 0xF300);
udelay(8);
} else {
b43legacy_phy_write(dev, 0x0015, control | 0xEFA0);
udelay(2);
b43legacy_phy_write(dev, 0x0015, control | 0xEFE0);
udelay(4);
b43legacy_phy_write(dev, 0x0015, control | 0xFFE0);
udelay(8);
}
ret = b43legacy_phy_read(dev, 0x002D);
local_irq_restore(flags);
b43legacy_voluntary_preempt();
return ret;
}
static u32 b43legacy_phy_lo_g_singledeviation(struct b43legacy_wldev *dev,
u16 control)
{
int i;
u32 ret = 0;
for (i = 0; i < 8; i++)
ret += b43legacy_phy_lo_g_deviation_subval(dev, control);
return ret;
}
/* Write the LocalOscillator CONTROL */
static inline
void b43legacy_lo_write(struct b43legacy_wldev *dev,
struct b43legacy_lopair *pair)
{
u16 value;
value = (u8)(pair->low);
value |= ((u8)(pair->high)) << 8;
#ifdef CONFIG_B43LEGACY_DEBUG
/* Sanity check. */
if (pair->low < -8 || pair->low > 8 ||
pair->high < -8 || pair->high > 8) {
struct b43legacy_phy *phy = &dev->phy;
b43legacydbg(dev->wl,
"WARNING: Writing invalid LOpair "
"(low: %d, high: %d, index: %lu)\n",
pair->low, pair->high,
(unsigned long)(pair - phy->_lo_pairs));
dump_stack();
}
#endif
b43legacy_phy_write(dev, B43legacy_PHY_G_LO_CONTROL, value);
}
static inline
struct b43legacy_lopair *b43legacy_find_lopair(struct b43legacy_wldev *dev,
u16 bbatt,
u16 rfatt,
u16 tx)
{
static const u8 dict[10] = { 11, 10, 11, 12, 13, 12, 13, 12, 13, 12 };
struct b43legacy_phy *phy = &dev->phy;
if (bbatt > 6)
bbatt = 6;
B43legacy_WARN_ON(rfatt >= 10);
if (tx == 3)
return b43legacy_get_lopair(phy, rfatt, bbatt);
return b43legacy_get_lopair(phy, dict[rfatt], bbatt);
}
static inline
struct b43legacy_lopair *b43legacy_current_lopair(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
return b43legacy_find_lopair(dev, phy->bbatt,
phy->rfatt, phy->txctl1);
}
/* Adjust B/G LO */
void b43legacy_phy_lo_adjust(struct b43legacy_wldev *dev, int fixed)
{
struct b43legacy_lopair *pair;
if (fixed) {
/* Use fixed values. Only for initialization. */
pair = b43legacy_find_lopair(dev, 2, 3, 0);
} else
pair = b43legacy_current_lopair(dev);
b43legacy_lo_write(dev, pair);
}
static void b43legacy_phy_lo_g_measure_txctl2(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 txctl2 = 0;
u16 i;
u32 smallest;
u32 tmp;
b43legacy_radio_write16(dev, 0x0052, 0x0000);
udelay(10);
smallest = b43legacy_phy_lo_g_singledeviation(dev, 0);
for (i = 0; i < 16; i++) {
b43legacy_radio_write16(dev, 0x0052, i);
udelay(10);
tmp = b43legacy_phy_lo_g_singledeviation(dev, 0);
if (tmp < smallest) {
smallest = tmp;
txctl2 = i;
}
}
phy->txctl2 = txctl2;
}
static
void b43legacy_phy_lo_g_state(struct b43legacy_wldev *dev,
const struct b43legacy_lopair *in_pair,
struct b43legacy_lopair *out_pair,
u16 r27)
{
static const struct b43legacy_lopair transitions[8] = {
{ .high = 1, .low = 1, },
{ .high = 1, .low = 0, },
{ .high = 1, .low = -1, },
{ .high = 0, .low = -1, },
{ .high = -1, .low = -1, },
{ .high = -1, .low = 0, },
{ .high = -1, .low = 1, },
{ .high = 0, .low = 1, },
};
struct b43legacy_lopair lowest_transition = {
.high = in_pair->high,
.low = in_pair->low,
};
struct b43legacy_lopair tmp_pair;
struct b43legacy_lopair transition;
int i = 12;
int state = 0;
int found_lower;
int j;
int begin;
int end;
u32 lowest_deviation;
u32 tmp;
/* Note that in_pair and out_pair can point to the same pair.
* Be careful. */
b43legacy_lo_write(dev, &lowest_transition);
lowest_deviation = b43legacy_phy_lo_g_singledeviation(dev, r27);
do {
found_lower = 0;
B43legacy_WARN_ON(!(state >= 0 && state <= 8));
if (state == 0) {
begin = 1;
end = 8;
} else if (state % 2 == 0) {
begin = state - 1;
end = state + 1;
} else {
begin = state - 2;
end = state + 2;
}
if (begin < 1)
begin += 8;
if (end > 8)
end -= 8;
j = begin;
tmp_pair.high = lowest_transition.high;
tmp_pair.low = lowest_transition.low;
while (1) {
B43legacy_WARN_ON(!(j >= 1 && j <= 8));
transition.high = tmp_pair.high +
transitions[j - 1].high;
transition.low = tmp_pair.low + transitions[j - 1].low;
if ((abs(transition.low) < 9)
&& (abs(transition.high) < 9)) {
b43legacy_lo_write(dev, &transition);
tmp = b43legacy_phy_lo_g_singledeviation(dev,
r27);
if (tmp < lowest_deviation) {
lowest_deviation = tmp;
state = j;
found_lower = 1;
lowest_transition.high =
transition.high;
lowest_transition.low = transition.low;
}
}
if (j == end)
break;
if (j == 8)
j = 1;
else
j++;
}
} while (i-- && found_lower);
out_pair->high = lowest_transition.high;
out_pair->low = lowest_transition.low;
}
/* Set the baseband attenuation value on chip. */
void b43legacy_phy_set_baseband_attenuation(struct b43legacy_wldev *dev,
u16 bbatt)
{
struct b43legacy_phy *phy = &dev->phy;
u16 value;
if (phy->analog == 0) {
value = (b43legacy_read16(dev, 0x03E6) & 0xFFF0);
value |= (bbatt & 0x000F);
b43legacy_write16(dev, 0x03E6, value);
return;
}
if (phy->analog > 1) {
value = b43legacy_phy_read(dev, 0x0060) & 0xFFC3;
value |= (bbatt << 2) & 0x003C;
} else {
value = b43legacy_phy_read(dev, 0x0060) & 0xFF87;
value |= (bbatt << 3) & 0x0078;
}
b43legacy_phy_write(dev, 0x0060, value);
}
/* http://bcm-specs.sipsolutions.net/LocalOscillator/Measure */
void b43legacy_phy_lo_g_measure(struct b43legacy_wldev *dev)
{
static const u8 pairorder[10] = { 3, 1, 5, 7, 9, 2, 0, 4, 6, 8 };
const int is_initializing = (b43legacy_status(dev)
< B43legacy_STAT_STARTED);
struct b43legacy_phy *phy = &dev->phy;
u16 h;
u16 i;
u16 oldi = 0;
u16 j;
struct b43legacy_lopair control;
struct b43legacy_lopair *tmp_control;
u16 tmp;
u16 regstack[16] = { 0 };
u8 oldchannel;
/* XXX: What are these? */
u8 r27 = 0;
u16 r31;
oldchannel = phy->channel;
/* Setup */
if (phy->gmode) {
regstack[0] = b43legacy_phy_read(dev, B43legacy_PHY_G_CRS);
regstack[1] = b43legacy_phy_read(dev, 0x0802);
b43legacy_phy_write(dev, B43legacy_PHY_G_CRS, regstack[0]
& 0x7FFF);
b43legacy_phy_write(dev, 0x0802, regstack[1] & 0xFFFC);
}
regstack[3] = b43legacy_read16(dev, 0x03E2);
b43legacy_write16(dev, 0x03E2, regstack[3] | 0x8000);
regstack[4] = b43legacy_read16(dev, B43legacy_MMIO_CHANNEL_EXT);
regstack[5] = b43legacy_phy_read(dev, 0x15);
regstack[6] = b43legacy_phy_read(dev, 0x2A);
regstack[7] = b43legacy_phy_read(dev, 0x35);
regstack[8] = b43legacy_phy_read(dev, 0x60);
regstack[9] = b43legacy_radio_read16(dev, 0x43);
regstack[10] = b43legacy_radio_read16(dev, 0x7A);
regstack[11] = b43legacy_radio_read16(dev, 0x52);
if (phy->gmode) {
regstack[12] = b43legacy_phy_read(dev, 0x0811);
regstack[13] = b43legacy_phy_read(dev, 0x0812);
regstack[14] = b43legacy_phy_read(dev, 0x0814);
regstack[15] = b43legacy_phy_read(dev, 0x0815);
}
b43legacy_radio_selectchannel(dev, 6, 0);
if (phy->gmode) {
b43legacy_phy_write(dev, B43legacy_PHY_G_CRS, regstack[0]
& 0x7FFF);
b43legacy_phy_write(dev, 0x0802, regstack[1] & 0xFFFC);
b43legacy_dummy_transmission(dev);
}
b43legacy_radio_write16(dev, 0x0043, 0x0006);
b43legacy_phy_set_baseband_attenuation(dev, 2);
b43legacy_write16(dev, B43legacy_MMIO_CHANNEL_EXT, 0x0000);
b43legacy_phy_write(dev, 0x002E, 0x007F);
b43legacy_phy_write(dev, 0x080F, 0x0078);
b43legacy_phy_write(dev, 0x0035, regstack[7] & ~(1 << 7));
b43legacy_radio_write16(dev, 0x007A, regstack[10] & 0xFFF0);
b43legacy_phy_write(dev, 0x002B, 0x0203);
b43legacy_phy_write(dev, 0x002A, 0x08A3);
if (phy->gmode) {
b43legacy_phy_write(dev, 0x0814, regstack[14] | 0x0003);
b43legacy_phy_write(dev, 0x0815, regstack[15] & 0xFFFC);
b43legacy_phy_write(dev, 0x0811, 0x01B3);
b43legacy_phy_write(dev, 0x0812, 0x00B2);
}
if (is_initializing)
b43legacy_phy_lo_g_measure_txctl2(dev);
b43legacy_phy_write(dev, 0x080F, 0x8078);
/* Measure */
control.low = 0;
control.high = 0;
for (h = 0; h < 10; h++) {
/* Loop over each possible RadioAttenuation (0-9) */
i = pairorder[h];
if (is_initializing) {
if (i == 3) {
control.low = 0;
control.high = 0;
} else if (((i % 2 == 1) && (oldi % 2 == 1)) ||
((i % 2 == 0) && (oldi % 2 == 0))) {
tmp_control = b43legacy_get_lopair(phy, oldi,
0);
memcpy(&control, tmp_control, sizeof(control));
} else {
tmp_control = b43legacy_get_lopair(phy, 3, 0);
memcpy(&control, tmp_control, sizeof(control));
}
}
/* Loop over each possible BasebandAttenuation/2 */
for (j = 0; j < 4; j++) {
if (is_initializing) {
tmp = i * 2 + j;
r27 = 0;
r31 = 0;
if (tmp > 14) {
r31 = 1;
if (tmp > 17)
r27 = 1;
if (tmp > 19)
r27 = 2;
}
} else {
tmp_control = b43legacy_get_lopair(phy, i,
j * 2);
if (!tmp_control->used)
continue;
memcpy(&control, tmp_control, sizeof(control));
r27 = 3;
r31 = 0;
}
b43legacy_radio_write16(dev, 0x43, i);
b43legacy_radio_write16(dev, 0x52, phy->txctl2);
udelay(10);
b43legacy_voluntary_preempt();
b43legacy_phy_set_baseband_attenuation(dev, j * 2);
tmp = (regstack[10] & 0xFFF0);
if (r31)
tmp |= 0x0008;
b43legacy_radio_write16(dev, 0x007A, tmp);
tmp_control = b43legacy_get_lopair(phy, i, j * 2);
b43legacy_phy_lo_g_state(dev, &control, tmp_control,
r27);
}
oldi = i;
}
/* Loop over each possible RadioAttenuation (10-13) */
for (i = 10; i < 14; i++) {
/* Loop over each possible BasebandAttenuation/2 */
for (j = 0; j < 4; j++) {
if (is_initializing) {
tmp_control = b43legacy_get_lopair(phy, i - 9,
j * 2);
memcpy(&control, tmp_control, sizeof(control));
/* FIXME: The next line is wrong, as the
* following if statement can never trigger. */
tmp = (i - 9) * 2 + j - 5;
r27 = 0;
r31 = 0;
if (tmp > 14) {
r31 = 1;
if (tmp > 17)
r27 = 1;
if (tmp > 19)
r27 = 2;
}
} else {
tmp_control = b43legacy_get_lopair(phy, i - 9,
j * 2);
if (!tmp_control->used)
continue;
memcpy(&control, tmp_control, sizeof(control));
r27 = 3;
r31 = 0;
}
b43legacy_radio_write16(dev, 0x43, i - 9);
/* FIXME: shouldn't txctl1 be zero in the next line
* and 3 in the loop above? */
b43legacy_radio_write16(dev, 0x52,
phy->txctl2
| (3/*txctl1*/ << 4));
udelay(10);
b43legacy_voluntary_preempt();
b43legacy_phy_set_baseband_attenuation(dev, j * 2);
tmp = (regstack[10] & 0xFFF0);
if (r31)
tmp |= 0x0008;
b43legacy_radio_write16(dev, 0x7A, tmp);
tmp_control = b43legacy_get_lopair(phy, i, j * 2);
b43legacy_phy_lo_g_state(dev, &control, tmp_control,
r27);
}
}
/* Restoration */
if (phy->gmode) {
b43legacy_phy_write(dev, 0x0015, 0xE300);
b43legacy_phy_write(dev, 0x0812, (r27 << 8) | 0xA0);
udelay(5);
b43legacy_phy_write(dev, 0x0812, (r27 << 8) | 0xA2);
udelay(2);
b43legacy_phy_write(dev, 0x0812, (r27 << 8) | 0xA3);
b43legacy_voluntary_preempt();
} else
b43legacy_phy_write(dev, 0x0015, r27 | 0xEFA0);
b43legacy_phy_lo_adjust(dev, is_initializing);
b43legacy_phy_write(dev, 0x002E, 0x807F);
if (phy->gmode)
b43legacy_phy_write(dev, 0x002F, 0x0202);
else
b43legacy_phy_write(dev, 0x002F, 0x0101);
b43legacy_write16(dev, B43legacy_MMIO_CHANNEL_EXT, regstack[4]);
b43legacy_phy_write(dev, 0x0015, regstack[5]);
b43legacy_phy_write(dev, 0x002A, regstack[6]);
b43legacy_phy_write(dev, 0x0035, regstack[7]);
b43legacy_phy_write(dev, 0x0060, regstack[8]);
b43legacy_radio_write16(dev, 0x0043, regstack[9]);
b43legacy_radio_write16(dev, 0x007A, regstack[10]);
regstack[11] &= 0x00F0;
regstack[11] |= (b43legacy_radio_read16(dev, 0x52) & 0x000F);
b43legacy_radio_write16(dev, 0x52, regstack[11]);
b43legacy_write16(dev, 0x03E2, regstack[3]);
if (phy->gmode) {
b43legacy_phy_write(dev, 0x0811, regstack[12]);
b43legacy_phy_write(dev, 0x0812, regstack[13]);
b43legacy_phy_write(dev, 0x0814, regstack[14]);
b43legacy_phy_write(dev, 0x0815, regstack[15]);
b43legacy_phy_write(dev, B43legacy_PHY_G_CRS, regstack[0]);
b43legacy_phy_write(dev, 0x0802, regstack[1]);
}
b43legacy_radio_selectchannel(dev, oldchannel, 1);
#ifdef CONFIG_B43LEGACY_DEBUG
{
/* Sanity check for all lopairs. */
for (i = 0; i < B43legacy_LO_COUNT; i++) {
tmp_control = phy->_lo_pairs + i;
if (tmp_control->low < -8 || tmp_control->low > 8 ||
tmp_control->high < -8 || tmp_control->high > 8)
b43legacywarn(dev->wl,
"WARNING: Invalid LOpair (low: %d, high:"
" %d, index: %d)\n",
tmp_control->low, tmp_control->high, i);
}
}
#endif /* CONFIG_B43LEGACY_DEBUG */
}
static
void b43legacy_phy_lo_mark_current_used(struct b43legacy_wldev *dev)
{
struct b43legacy_lopair *pair;
pair = b43legacy_current_lopair(dev);
pair->used = 1;
}
void b43legacy_phy_lo_mark_all_unused(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
struct b43legacy_lopair *pair;
int i;
for (i = 0; i < B43legacy_LO_COUNT; i++) {
pair = phy->_lo_pairs + i;
pair->used = 0;
}
}
/* http://bcm-specs.sipsolutions.net/EstimatePowerOut
* This function converts a TSSI value to dBm in Q5.2
*/
static s8 b43legacy_phy_estimate_power_out(struct b43legacy_wldev *dev, s8 tssi)
{
struct b43legacy_phy *phy = &dev->phy;
s8 dbm = 0;
s32 tmp;
tmp = phy->idle_tssi;
tmp += tssi;
tmp -= phy->savedpctlreg;
switch (phy->type) {
case B43legacy_PHYTYPE_B:
case B43legacy_PHYTYPE_G:
tmp = limit_value(tmp, 0x00, 0x3F);
dbm = phy->tssi2dbm[tmp];
break;
default:
B43legacy_BUG_ON(1);
}
return dbm;
}
/* http://bcm-specs.sipsolutions.net/RecalculateTransmissionPower */
void b43legacy_phy_xmitpower(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 tmp;
u16 txpower;
s8 v0;
s8 v1;
s8 v2;
s8 v3;
s8 average;
int max_pwr;
s16 desired_pwr;
s16 estimated_pwr;
s16 pwr_adjust;
s16 radio_att_delta;
s16 baseband_att_delta;
s16 radio_attenuation;
s16 baseband_attenuation;
if (phy->savedpctlreg == 0xFFFF)
return;
if ((dev->dev->bus->boardinfo.type == 0x0416) &&
is_bcm_board_vendor(dev))
return;
#ifdef CONFIG_B43LEGACY_DEBUG
if (phy->manual_txpower_control)
return;
#endif
B43legacy_BUG_ON(!(phy->type == B43legacy_PHYTYPE_B ||
phy->type == B43legacy_PHYTYPE_G));
tmp = b43legacy_shm_read16(dev, B43legacy_SHM_SHARED, 0x0058);
v0 = (s8)(tmp & 0x00FF);
v1 = (s8)((tmp & 0xFF00) >> 8);
tmp = b43legacy_shm_read16(dev, B43legacy_SHM_SHARED, 0x005A);
v2 = (s8)(tmp & 0x00FF);
v3 = (s8)((tmp & 0xFF00) >> 8);
tmp = 0;
if (v0 == 0x7F || v1 == 0x7F || v2 == 0x7F || v3 == 0x7F) {
tmp = b43legacy_shm_read16(dev, B43legacy_SHM_SHARED,
0x0070);
v0 = (s8)(tmp & 0x00FF);
v1 = (s8)((tmp & 0xFF00) >> 8);
tmp = b43legacy_shm_read16(dev, B43legacy_SHM_SHARED,
0x0072);
v2 = (s8)(tmp & 0x00FF);
v3 = (s8)((tmp & 0xFF00) >> 8);
if (v0 == 0x7F || v1 == 0x7F || v2 == 0x7F || v3 == 0x7F)
return;
v0 = (v0 + 0x20) & 0x3F;
v1 = (v1 + 0x20) & 0x3F;
v2 = (v2 + 0x20) & 0x3F;
v3 = (v3 + 0x20) & 0x3F;
tmp = 1;
}
b43legacy_radio_clear_tssi(dev);
average = (v0 + v1 + v2 + v3 + 2) / 4;
if (tmp && (b43legacy_shm_read16(dev, B43legacy_SHM_SHARED, 0x005E)
& 0x8))
average -= 13;
estimated_pwr = b43legacy_phy_estimate_power_out(dev, average);
max_pwr = dev->dev->bus->sprom.maxpwr_bg;
if ((dev->dev->bus->sprom.boardflags_lo
& B43legacy_BFL_PACTRL) &&
(phy->type == B43legacy_PHYTYPE_G))
max_pwr -= 0x3;
if (unlikely(max_pwr <= 0)) {
b43legacywarn(dev->wl, "Invalid max-TX-power value in SPROM."
"\n");
max_pwr = 74; /* fake it */
dev->dev->bus->sprom.maxpwr_bg = max_pwr;
}
/* Use regulatory information to get the maximum power.
* In the absence of such data from mac80211, we will use 20 dBm, which
* is the value for the EU, US, Canada, and most of the world.
* The regulatory maximum is reduced by the antenna gain (from sprom)
* and 1.5 dBm (a safety factor??). The result is in Q5.2 format
* which accounts for the factor of 4 */
#define REG_MAX_PWR 20
max_pwr = min(REG_MAX_PWR * 4
- dev->dev->bus->sprom.antenna_gain.ghz24.a0
- 0x6, max_pwr);
/* find the desired power in Q5.2 - power_level is in dBm
* and limit it - max_pwr is already in Q5.2 */
desired_pwr = limit_value(phy->power_level << 2, 0, max_pwr);
if (b43legacy_debug(dev, B43legacy_DBG_XMITPOWER))
b43legacydbg(dev->wl, "Current TX power output: " Q52_FMT
" dBm, Desired TX power output: " Q52_FMT
" dBm\n", Q52_ARG(estimated_pwr),
Q52_ARG(desired_pwr));
/* Check if we need to adjust the current power. The factor of 2 is
* for damping */
pwr_adjust = (desired_pwr - estimated_pwr) / 2;
/* RF attenuation delta
* The minus sign is because lower attenuation => more power */
radio_att_delta = -(pwr_adjust + 7) >> 3;
/* Baseband attenuation delta */
baseband_att_delta = -(pwr_adjust >> 1) - (4 * radio_att_delta);
/* Do we need to adjust anything? */
if ((radio_att_delta == 0) && (baseband_att_delta == 0)) {
b43legacy_phy_lo_mark_current_used(dev);
return;
}
/* Calculate the new attenuation values. */
baseband_attenuation = phy->bbatt;
baseband_attenuation += baseband_att_delta;
radio_attenuation = phy->rfatt;
radio_attenuation += radio_att_delta;
/* Get baseband and radio attenuation values into permitted ranges.
* baseband 0-11, radio 0-9.
* Radio attenuation affects power level 4 times as much as baseband.
*/
if (radio_attenuation < 0) {
baseband_attenuation -= (4 * -radio_attenuation);
radio_attenuation = 0;
} else if (radio_attenuation > 9) {
baseband_attenuation += (4 * (radio_attenuation - 9));
radio_attenuation = 9;
} else {
while (baseband_attenuation < 0 && radio_attenuation > 0) {
baseband_attenuation += 4;
radio_attenuation--;
}
while (baseband_attenuation > 11 && radio_attenuation < 9) {
baseband_attenuation -= 4;
radio_attenuation++;
}
}
baseband_attenuation = limit_value(baseband_attenuation, 0, 11);
txpower = phy->txctl1;
if ((phy->radio_ver == 0x2050) && (phy->radio_rev == 2)) {
if (radio_attenuation <= 1) {
if (txpower == 0) {
txpower = 3;
radio_attenuation += 2;
baseband_attenuation += 2;
} else if (dev->dev->bus->sprom.boardflags_lo
& B43legacy_BFL_PACTRL) {
baseband_attenuation += 4 *
(radio_attenuation - 2);
radio_attenuation = 2;
}
} else if (radio_attenuation > 4 && txpower != 0) {
txpower = 0;
if (baseband_attenuation < 3) {
radio_attenuation -= 3;
baseband_attenuation += 2;
} else {
radio_attenuation -= 2;
baseband_attenuation -= 2;
}
}
}
/* Save the control values */
phy->txctl1 = txpower;
baseband_attenuation = limit_value(baseband_attenuation, 0, 11);
radio_attenuation = limit_value(radio_attenuation, 0, 9);
phy->rfatt = radio_attenuation;
phy->bbatt = baseband_attenuation;
/* Adjust the hardware */
b43legacy_phy_lock(dev);
b43legacy_radio_lock(dev);
b43legacy_radio_set_txpower_bg(dev, baseband_attenuation,
radio_attenuation, txpower);
b43legacy_phy_lo_mark_current_used(dev);
b43legacy_radio_unlock(dev);
b43legacy_phy_unlock(dev);
}
static inline
s32 b43legacy_tssi2dbm_ad(s32 num, s32 den)
{
if (num < 0)
return num/den;
else
return (num+den/2)/den;
}
static inline
s8 b43legacy_tssi2dbm_entry(s8 entry [], u8 index, s16 pab0, s16 pab1, s16 pab2)
{
s32 m1;
s32 m2;
s32 f = 256;
s32 q;
s32 delta;
s8 i = 0;
m1 = b43legacy_tssi2dbm_ad(16 * pab0 + index * pab1, 32);
m2 = max(b43legacy_tssi2dbm_ad(32768 + index * pab2, 256), 1);
do {
if (i > 15)
return -EINVAL;
q = b43legacy_tssi2dbm_ad(f * 4096 -
b43legacy_tssi2dbm_ad(m2 * f, 16) *
f, 2048);
delta = abs(q - f);
f = q;
i++;
} while (delta >= 2);
entry[index] = limit_value(b43legacy_tssi2dbm_ad(m1 * f, 8192),
-127, 128);
return 0;
}
/* http://bcm-specs.sipsolutions.net/TSSI_to_DBM_Table */
int b43legacy_phy_init_tssi2dbm_table(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
s16 pab0;
s16 pab1;
s16 pab2;
u8 idx;
s8 *dyn_tssi2dbm;
B43legacy_WARN_ON(!(phy->type == B43legacy_PHYTYPE_B ||
phy->type == B43legacy_PHYTYPE_G));
pab0 = (s16)(dev->dev->bus->sprom.pa0b0);
pab1 = (s16)(dev->dev->bus->sprom.pa0b1);
pab2 = (s16)(dev->dev->bus->sprom.pa0b2);
if ((dev->dev->bus->chip_id == 0x4301) && (phy->radio_ver != 0x2050)) {
phy->idle_tssi = 0x34;
phy->tssi2dbm = b43legacy_tssi2dbm_b_table;
return 0;
}
if (pab0 != 0 && pab1 != 0 && pab2 != 0 &&
pab0 != -1 && pab1 != -1 && pab2 != -1) {
/* The pabX values are set in SPROM. Use them. */
if ((s8)dev->dev->bus->sprom.itssi_bg != 0 &&
(s8)dev->dev->bus->sprom.itssi_bg != -1)
phy->idle_tssi = (s8)(dev->dev->bus->sprom.
itssi_bg);
else
phy->idle_tssi = 62;
dyn_tssi2dbm = kmalloc(64, GFP_KERNEL);
if (dyn_tssi2dbm == NULL) {
b43legacyerr(dev->wl, "Could not allocate memory "
"for tssi2dbm table\n");
return -ENOMEM;
}
for (idx = 0; idx < 64; idx++)
if (b43legacy_tssi2dbm_entry(dyn_tssi2dbm, idx, pab0,
pab1, pab2)) {
phy->tssi2dbm = NULL;
b43legacyerr(dev->wl, "Could not generate "
"tssi2dBm table\n");
kfree(dyn_tssi2dbm);
return -ENODEV;
}
phy->tssi2dbm = dyn_tssi2dbm;
phy->dyn_tssi_tbl = 1;
} else {
/* pabX values not set in SPROM. */
switch (phy->type) {
case B43legacy_PHYTYPE_B:
phy->idle_tssi = 0x34;
phy->tssi2dbm = b43legacy_tssi2dbm_b_table;
break;
case B43legacy_PHYTYPE_G:
phy->idle_tssi = 0x34;
phy->tssi2dbm = b43legacy_tssi2dbm_g_table;
break;
}
}
return 0;
}
int b43legacy_phy_init(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
int err = -ENODEV;
switch (phy->type) {
case B43legacy_PHYTYPE_B:
switch (phy->rev) {
case 2:
b43legacy_phy_initb2(dev);
err = 0;
break;
case 4:
b43legacy_phy_initb4(dev);
err = 0;
break;
case 5:
b43legacy_phy_initb5(dev);
err = 0;
break;
case 6:
b43legacy_phy_initb6(dev);
err = 0;
break;
}
break;
case B43legacy_PHYTYPE_G:
b43legacy_phy_initg(dev);
err = 0;
break;
}
if (err)
b43legacyerr(dev->wl, "Unknown PHYTYPE found\n");
return err;
}
void b43legacy_phy_set_antenna_diversity(struct b43legacy_wldev *dev)
{
struct b43legacy_phy *phy = &dev->phy;
u16 antennadiv;
u16 offset;
u16 value;
u32 ucodeflags;
antennadiv = phy->antenna_diversity;
if (antennadiv == 0xFFFF)
antennadiv = 3;
B43legacy_WARN_ON(antennadiv > 3);
ucodeflags = b43legacy_shm_read32(dev, B43legacy_SHM_SHARED,
B43legacy_UCODEFLAGS_OFFSET);
b43legacy_shm_write32(dev, B43legacy_SHM_SHARED,
B43legacy_UCODEFLAGS_OFFSET,
ucodeflags & ~B43legacy_UCODEFLAG_AUTODIV);
switch (phy->type) {
case B43legacy_PHYTYPE_G:
offset = 0x0400;
if (antennadiv == 2)
value = (3/*automatic*/ << 7);
else
value = (antennadiv << 7);
b43legacy_phy_write(dev, offset + 1,
(b43legacy_phy_read(dev, offset + 1)
& 0x7E7F) | value);
if (antennadiv >= 2) {
if (antennadiv == 2)
value = (antennadiv << 7);
else
value = (0/*force0*/ << 7);
b43legacy_phy_write(dev, offset + 0x2B,
(b43legacy_phy_read(dev,
offset + 0x2B)
& 0xFEFF) | value);
}
if (phy->type == B43legacy_PHYTYPE_G) {
if (antennadiv >= 2)
b43legacy_phy_write(dev, 0x048C,
b43legacy_phy_read(dev,
0x048C) | 0x2000);
else
b43legacy_phy_write(dev, 0x048C,
b43legacy_phy_read(dev,
0x048C) & ~0x2000);
if (phy->rev >= 2) {
b43legacy_phy_write(dev, 0x0461,
b43legacy_phy_read(dev,
0x0461) | 0x0010);
b43legacy_phy_write(dev, 0x04AD,
(b43legacy_phy_read(dev,
0x04AD)
& 0x00FF) | 0x0015);
if (phy->rev == 2)
b43legacy_phy_write(dev, 0x0427,
0x0008);
else
b43legacy_phy_write(dev, 0x0427,
(b43legacy_phy_read(dev, 0x0427)
& 0x00FF) | 0x0008);
} else if (phy->rev >= 6)
b43legacy_phy_write(dev, 0x049B, 0x00DC);
} else {
if (phy->rev < 3)
b43legacy_phy_write(dev, 0x002B,
(b43legacy_phy_read(dev,
0x002B) & 0x00FF)
| 0x0024);
else {
b43legacy_phy_write(dev, 0x0061,
b43legacy_phy_read(dev,
0x0061) | 0x0010);
if (phy->rev == 3) {
b43legacy_phy_write(dev, 0x0093,
0x001D);
b43legacy_phy_write(dev, 0x0027,
0x0008);
} else {
b43legacy_phy_write(dev, 0x0093,
0x003A);
b43legacy_phy_write(dev, 0x0027,
(b43legacy_phy_read(dev, 0x0027)
& 0x00FF) | 0x0008);
}
}
}
break;
case B43legacy_PHYTYPE_B:
if (dev->dev->id.revision == 2)
value = (3/*automatic*/ << 7);
else
value = (antennadiv << 7);
b43legacy_phy_write(dev, 0x03E2,
(b43legacy_phy_read(dev, 0x03E2)
& 0xFE7F) | value);
break;
default:
B43legacy_WARN_ON(1);
}
if (antennadiv >= 2) {
ucodeflags = b43legacy_shm_read32(dev, B43legacy_SHM_SHARED,
B43legacy_UCODEFLAGS_OFFSET);
b43legacy_shm_write32(dev, B43legacy_SHM_SHARED,
B43legacy_UCODEFLAGS_OFFSET,
ucodeflags | B43legacy_UCODEFLAG_AUTODIV);
}
phy->antenna_diversity = antennadiv;
}
/* Set the PowerSavingControlBits.
* Bitvalues:
* 0 => unset the bit
* 1 => set the bit
* -1 => calculate the bit
*/
void b43legacy_power_saving_ctl_bits(struct b43legacy_wldev *dev,
int bit25, int bit26)
{
int i;
u32 status;
/* FIXME: Force 25 to off and 26 to on for now: */
bit25 = 0;
bit26 = 1;
if (bit25 == -1) {
/* TODO: If powersave is not off and FIXME is not set and we
* are not in adhoc and thus is not an AP and we arei
* associated, set bit 25 */
}
if (bit26 == -1) {
/* TODO: If the device is awake or this is an AP, or we are
* scanning, or FIXME, or we are associated, or FIXME,
* or the latest PS-Poll packet sent was successful,
* set bit26 */
}
status = b43legacy_read32(dev, B43legacy_MMIO_MACCTL);
if (bit25)
status |= B43legacy_MACCTL_HWPS;
else
status &= ~B43legacy_MACCTL_HWPS;
if (bit26)
status |= B43legacy_MACCTL_AWAKE;
else
status &= ~B43legacy_MACCTL_AWAKE;
b43legacy_write32(dev, B43legacy_MMIO_MACCTL, status);
if (bit26 && dev->dev->id.revision >= 5) {
for (i = 0; i < 100; i++) {
if (b43legacy_shm_read32(dev, B43legacy_SHM_SHARED,
0x0040) != 4)
break;
udelay(10);
}
}
}
Reference in New Issue View Git Blame Copy Permalink