Commit 5250703e authored by Michael Buesch's avatar Michael Buesch Committed by David S. Miller

b43: Fix PHY register routing

This fixes the PHY routing bit handling.
This is needed for N-PHY.
No functional change to A-PHY and G-PHY code.
Signed-off-by: default avatarMichael Buesch <mb@bu3sch.de>
Signed-off-by: default avatarJohn W. Linville <linville@tuxdriver.com>
parent 424047e6
...@@ -555,20 +555,20 @@ struct lo_g_saved_values { ...@@ -555,20 +555,20 @@ struct lo_g_saved_values {
u16 phy_extg_01; u16 phy_extg_01;
u16 phy_dacctl_hwpctl; u16 phy_dacctl_hwpctl;
u16 phy_dacctl; u16 phy_dacctl;
u16 phy_base_14; u16 phy_cck_14;
u16 phy_hpwr_tssictl; u16 phy_hpwr_tssictl;
u16 phy_analogover; u16 phy_analogover;
u16 phy_analogoverval; u16 phy_analogoverval;
u16 phy_rfover; u16 phy_rfover;
u16 phy_rfoverval; u16 phy_rfoverval;
u16 phy_classctl; u16 phy_classctl;
u16 phy_base_3E; u16 phy_cck_3E;
u16 phy_crs0; u16 phy_crs0;
u16 phy_pgactl; u16 phy_pgactl;
u16 phy_base_2A; u16 phy_cck_2A;
u16 phy_syncctl; u16 phy_syncctl;
u16 phy_base_30; u16 phy_cck_30;
u16 phy_base_06; u16 phy_cck_06;
/* Radio registers */ /* Radio registers */
u16 radio_43; u16 radio_43;
...@@ -588,7 +588,7 @@ static void lo_measure_setup(struct b43_wldev *dev, ...@@ -588,7 +588,7 @@ static void lo_measure_setup(struct b43_wldev *dev,
sav->phy_lo_mask = b43_phy_read(dev, B43_PHY_LO_MASK); sav->phy_lo_mask = b43_phy_read(dev, B43_PHY_LO_MASK);
sav->phy_extg_01 = b43_phy_read(dev, B43_PHY_EXTG(0x01)); sav->phy_extg_01 = b43_phy_read(dev, B43_PHY_EXTG(0x01));
sav->phy_dacctl_hwpctl = b43_phy_read(dev, B43_PHY_DACCTL); sav->phy_dacctl_hwpctl = b43_phy_read(dev, B43_PHY_DACCTL);
sav->phy_base_14 = b43_phy_read(dev, B43_PHY_BASE(0x14)); sav->phy_cck_14 = b43_phy_read(dev, B43_PHY_CCK(0x14));
sav->phy_hpwr_tssictl = b43_phy_read(dev, B43_PHY_HPWR_TSSICTL); sav->phy_hpwr_tssictl = b43_phy_read(dev, B43_PHY_HPWR_TSSICTL);
b43_phy_write(dev, B43_PHY_HPWR_TSSICTL, b43_phy_write(dev, B43_PHY_HPWR_TSSICTL,
...@@ -600,14 +600,14 @@ static void lo_measure_setup(struct b43_wldev *dev, ...@@ -600,14 +600,14 @@ static void lo_measure_setup(struct b43_wldev *dev,
b43_phy_write(dev, B43_PHY_DACCTL, b43_phy_write(dev, B43_PHY_DACCTL,
b43_phy_read(dev, B43_PHY_DACCTL) b43_phy_read(dev, B43_PHY_DACCTL)
| 0x40); | 0x40);
b43_phy_write(dev, B43_PHY_BASE(0x14), b43_phy_write(dev, B43_PHY_CCK(0x14),
b43_phy_read(dev, B43_PHY_BASE(0x14)) b43_phy_read(dev, B43_PHY_CCK(0x14))
| 0x200); | 0x200);
} }
if (phy->type == B43_PHYTYPE_B && if (phy->type == B43_PHYTYPE_B &&
phy->radio_ver == 0x2050 && phy->radio_rev < 6) { phy->radio_ver == 0x2050 && phy->radio_rev < 6) {
b43_phy_write(dev, B43_PHY_BASE(0x16), 0x410); b43_phy_write(dev, B43_PHY_CCK(0x16), 0x410);
b43_phy_write(dev, B43_PHY_BASE(0x17), 0x820); b43_phy_write(dev, B43_PHY_CCK(0x17), 0x820);
} }
if (!lo->rebuild && b43_has_hardware_pctl(phy)) if (!lo->rebuild && b43_has_hardware_pctl(phy))
lo_read_power_vector(dev); lo_read_power_vector(dev);
...@@ -618,7 +618,7 @@ static void lo_measure_setup(struct b43_wldev *dev, ...@@ -618,7 +618,7 @@ static void lo_measure_setup(struct b43_wldev *dev,
sav->phy_rfover = b43_phy_read(dev, B43_PHY_RFOVER); sav->phy_rfover = b43_phy_read(dev, B43_PHY_RFOVER);
sav->phy_rfoverval = b43_phy_read(dev, B43_PHY_RFOVERVAL); sav->phy_rfoverval = b43_phy_read(dev, B43_PHY_RFOVERVAL);
sav->phy_classctl = b43_phy_read(dev, B43_PHY_CLASSCTL); sav->phy_classctl = b43_phy_read(dev, B43_PHY_CLASSCTL);
sav->phy_base_3E = b43_phy_read(dev, B43_PHY_BASE(0x3E)); sav->phy_cck_3E = b43_phy_read(dev, B43_PHY_CCK(0x3E));
sav->phy_crs0 = b43_phy_read(dev, B43_PHY_CRS0); sav->phy_crs0 = b43_phy_read(dev, B43_PHY_CRS0);
b43_phy_write(dev, B43_PHY_CLASSCTL, b43_phy_write(dev, B43_PHY_CLASSCTL,
...@@ -642,14 +642,14 @@ static void lo_measure_setup(struct b43_wldev *dev, ...@@ -642,14 +642,14 @@ static void lo_measure_setup(struct b43_wldev *dev,
} else { } else {
b43_phy_write(dev, B43_PHY_RFOVER, 0); b43_phy_write(dev, B43_PHY_RFOVER, 0);
} }
b43_phy_write(dev, B43_PHY_BASE(0x3E), 0); b43_phy_write(dev, B43_PHY_CCK(0x3E), 0);
} }
sav->reg_3F4 = b43_read16(dev, 0x3F4); sav->reg_3F4 = b43_read16(dev, 0x3F4);
sav->reg_3E2 = b43_read16(dev, 0x3E2); sav->reg_3E2 = b43_read16(dev, 0x3E2);
sav->radio_43 = b43_radio_read16(dev, 0x43); sav->radio_43 = b43_radio_read16(dev, 0x43);
sav->radio_7A = b43_radio_read16(dev, 0x7A); sav->radio_7A = b43_radio_read16(dev, 0x7A);
sav->phy_pgactl = b43_phy_read(dev, B43_PHY_PGACTL); sav->phy_pgactl = b43_phy_read(dev, B43_PHY_PGACTL);
sav->phy_base_2A = b43_phy_read(dev, B43_PHY_BASE(0x2A)); sav->phy_cck_2A = b43_phy_read(dev, B43_PHY_CCK(0x2A));
sav->phy_syncctl = b43_phy_read(dev, B43_PHY_SYNCCTL); sav->phy_syncctl = b43_phy_read(dev, B43_PHY_SYNCCTL);
sav->phy_dacctl = b43_phy_read(dev, B43_PHY_DACCTL); sav->phy_dacctl = b43_phy_read(dev, B43_PHY_DACCTL);
...@@ -658,10 +658,10 @@ static void lo_measure_setup(struct b43_wldev *dev, ...@@ -658,10 +658,10 @@ static void lo_measure_setup(struct b43_wldev *dev,
sav->radio_52 &= 0x00F0; sav->radio_52 &= 0x00F0;
} }
if (phy->type == B43_PHYTYPE_B) { if (phy->type == B43_PHYTYPE_B) {
sav->phy_base_30 = b43_phy_read(dev, B43_PHY_BASE(0x30)); sav->phy_cck_30 = b43_phy_read(dev, B43_PHY_CCK(0x30));
sav->phy_base_06 = b43_phy_read(dev, B43_PHY_BASE(0x06)); sav->phy_cck_06 = b43_phy_read(dev, B43_PHY_CCK(0x06));
b43_phy_write(dev, B43_PHY_BASE(0x30), 0x00FF); b43_phy_write(dev, B43_PHY_CCK(0x30), 0x00FF);
b43_phy_write(dev, B43_PHY_BASE(0x06), 0x3F3F); b43_phy_write(dev, B43_PHY_CCK(0x06), 0x3F3F);
} else { } else {
b43_write16(dev, 0x3E2, b43_read16(dev, 0x3E2) b43_write16(dev, 0x3E2, b43_read16(dev, 0x3E2)
| 0x8000); | 0x8000);
...@@ -670,7 +670,7 @@ static void lo_measure_setup(struct b43_wldev *dev, ...@@ -670,7 +670,7 @@ static void lo_measure_setup(struct b43_wldev *dev,
& 0xF000); & 0xF000);
tmp = tmp =
(phy->type == B43_PHYTYPE_G) ? B43_PHY_LO_MASK : B43_PHY_BASE(0x2E); (phy->type == B43_PHYTYPE_G) ? B43_PHY_LO_MASK : B43_PHY_CCK(0x2E);
b43_phy_write(dev, tmp, 0x007F); b43_phy_write(dev, tmp, 0x007F);
tmp = sav->phy_syncctl; tmp = sav->phy_syncctl;
...@@ -678,26 +678,26 @@ static void lo_measure_setup(struct b43_wldev *dev, ...@@ -678,26 +678,26 @@ static void lo_measure_setup(struct b43_wldev *dev,
tmp = sav->radio_7A; tmp = sav->radio_7A;
b43_radio_write16(dev, 0x007A, tmp & 0xFFF0); b43_radio_write16(dev, 0x007A, tmp & 0xFFF0);
b43_phy_write(dev, B43_PHY_BASE(0x2A), 0x8A3); b43_phy_write(dev, B43_PHY_CCK(0x2A), 0x8A3);
if (phy->type == B43_PHYTYPE_G || if (phy->type == B43_PHYTYPE_G ||
(phy->type == B43_PHYTYPE_B && (phy->type == B43_PHYTYPE_B &&
phy->radio_ver == 0x2050 && phy->radio_rev >= 6)) { phy->radio_ver == 0x2050 && phy->radio_rev >= 6)) {
b43_phy_write(dev, B43_PHY_BASE(0x2B), 0x1003); b43_phy_write(dev, B43_PHY_CCK(0x2B), 0x1003);
} else } else
b43_phy_write(dev, B43_PHY_BASE(0x2B), 0x0802); b43_phy_write(dev, B43_PHY_CCK(0x2B), 0x0802);
if (phy->rev >= 2) if (phy->rev >= 2)
b43_dummy_transmission(dev); b43_dummy_transmission(dev);
b43_radio_selectchannel(dev, 6, 0); b43_radio_selectchannel(dev, 6, 0);
b43_radio_read16(dev, 0x51); /* dummy read */ b43_radio_read16(dev, 0x51); /* dummy read */
if (phy->type == B43_PHYTYPE_G) if (phy->type == B43_PHYTYPE_G)
b43_phy_write(dev, B43_PHY_BASE(0x2F), 0); b43_phy_write(dev, B43_PHY_CCK(0x2F), 0);
if (lo->rebuild) if (lo->rebuild)
lo_measure_txctl_values(dev); lo_measure_txctl_values(dev);
if (phy->type == B43_PHYTYPE_G && phy->rev >= 3) { if (phy->type == B43_PHYTYPE_G && phy->rev >= 3) {
b43_phy_write(dev, B43_PHY_LO_MASK, 0xC078); b43_phy_write(dev, B43_PHY_LO_MASK, 0xC078);
} else { } else {
if (phy->type == B43_PHYTYPE_B) if (phy->type == B43_PHYTYPE_B)
b43_phy_write(dev, B43_PHY_BASE(0x2E), 0x8078); b43_phy_write(dev, B43_PHY_CCK(0x2E), 0x8078);
else else
b43_phy_write(dev, B43_PHY_LO_MASK, 0x8078); b43_phy_write(dev, B43_PHY_LO_MASK, 0x8078);
} }
...@@ -732,17 +732,17 @@ static void lo_measure_restore(struct b43_wldev *dev, ...@@ -732,17 +732,17 @@ static void lo_measure_restore(struct b43_wldev *dev,
} }
if (phy->type == B43_PHYTYPE_G) { if (phy->type == B43_PHYTYPE_G) {
if (phy->rev >= 3) if (phy->rev >= 3)
b43_phy_write(dev, B43_PHY_BASE(0x2E), 0xC078); b43_phy_write(dev, B43_PHY_CCK(0x2E), 0xC078);
else else
b43_phy_write(dev, B43_PHY_BASE(0x2E), 0x8078); b43_phy_write(dev, B43_PHY_CCK(0x2E), 0x8078);
if (phy->rev >= 2) if (phy->rev >= 2)
b43_phy_write(dev, B43_PHY_BASE(0x2F), 0x0202); b43_phy_write(dev, B43_PHY_CCK(0x2F), 0x0202);
else else
b43_phy_write(dev, B43_PHY_BASE(0x2F), 0x0101); b43_phy_write(dev, B43_PHY_CCK(0x2F), 0x0101);
} }
b43_write16(dev, 0x3F4, sav->reg_3F4); b43_write16(dev, 0x3F4, sav->reg_3F4);
b43_phy_write(dev, B43_PHY_PGACTL, sav->phy_pgactl); b43_phy_write(dev, B43_PHY_PGACTL, sav->phy_pgactl);
b43_phy_write(dev, B43_PHY_BASE(0x2A), sav->phy_base_2A); b43_phy_write(dev, B43_PHY_CCK(0x2A), sav->phy_cck_2A);
b43_phy_write(dev, B43_PHY_SYNCCTL, sav->phy_syncctl); b43_phy_write(dev, B43_PHY_SYNCCTL, sav->phy_syncctl);
b43_phy_write(dev, B43_PHY_DACCTL, sav->phy_dacctl); b43_phy_write(dev, B43_PHY_DACCTL, sav->phy_dacctl);
b43_radio_write16(dev, 0x43, sav->radio_43); b43_radio_write16(dev, 0x43, sav->radio_43);
...@@ -755,8 +755,8 @@ static void lo_measure_restore(struct b43_wldev *dev, ...@@ -755,8 +755,8 @@ static void lo_measure_restore(struct b43_wldev *dev,
b43_write16(dev, 0x3E2, sav->reg_3E2); b43_write16(dev, 0x3E2, sav->reg_3E2);
if (phy->type == B43_PHYTYPE_B && if (phy->type == B43_PHYTYPE_B &&
phy->radio_ver == 0x2050 && phy->radio_rev <= 5) { phy->radio_ver == 0x2050 && phy->radio_rev <= 5) {
b43_phy_write(dev, B43_PHY_BASE(0x30), sav->phy_base_30); b43_phy_write(dev, B43_PHY_CCK(0x30), sav->phy_cck_30);
b43_phy_write(dev, B43_PHY_BASE(0x06), sav->phy_base_06); b43_phy_write(dev, B43_PHY_CCK(0x06), sav->phy_cck_06);
} }
if (phy->rev >= 2) { if (phy->rev >= 2) {
b43_phy_write(dev, B43_PHY_ANALOGOVER, sav->phy_analogover); b43_phy_write(dev, B43_PHY_ANALOGOVER, sav->phy_analogover);
...@@ -765,7 +765,7 @@ static void lo_measure_restore(struct b43_wldev *dev, ...@@ -765,7 +765,7 @@ static void lo_measure_restore(struct b43_wldev *dev,
b43_phy_write(dev, B43_PHY_CLASSCTL, sav->phy_classctl); b43_phy_write(dev, B43_PHY_CLASSCTL, sav->phy_classctl);
b43_phy_write(dev, B43_PHY_RFOVER, sav->phy_rfover); b43_phy_write(dev, B43_PHY_RFOVER, sav->phy_rfover);
b43_phy_write(dev, B43_PHY_RFOVERVAL, sav->phy_rfoverval); b43_phy_write(dev, B43_PHY_RFOVERVAL, sav->phy_rfoverval);
b43_phy_write(dev, B43_PHY_BASE(0x3E), sav->phy_base_3E); b43_phy_write(dev, B43_PHY_CCK(0x3E), sav->phy_cck_3E);
b43_phy_write(dev, B43_PHY_CRS0, sav->phy_crs0); b43_phy_write(dev, B43_PHY_CRS0, sav->phy_crs0);
} }
if (b43_has_hardware_pctl(phy)) { if (b43_has_hardware_pctl(phy)) {
...@@ -773,7 +773,7 @@ static void lo_measure_restore(struct b43_wldev *dev, ...@@ -773,7 +773,7 @@ static void lo_measure_restore(struct b43_wldev *dev,
b43_phy_write(dev, B43_PHY_LO_MASK, tmp); b43_phy_write(dev, B43_PHY_LO_MASK, tmp);
b43_phy_write(dev, B43_PHY_EXTG(0x01), sav->phy_extg_01); b43_phy_write(dev, B43_PHY_EXTG(0x01), sav->phy_extg_01);
b43_phy_write(dev, B43_PHY_DACCTL, sav->phy_dacctl_hwpctl); b43_phy_write(dev, B43_PHY_DACCTL, sav->phy_dacctl_hwpctl);
b43_phy_write(dev, B43_PHY_BASE(0x14), sav->phy_base_14); b43_phy_write(dev, B43_PHY_CCK(0x14), sav->phy_cck_14);
b43_phy_write(dev, B43_PHY_HPWR_TSSICTL, sav->phy_hpwr_tssictl); b43_phy_write(dev, B43_PHY_HPWR_TSSICTL, sav->phy_hpwr_tssictl);
} }
b43_radio_selectchannel(dev, sav->old_channel, 1); b43_radio_selectchannel(dev, sav->old_channel, 1);
......
This diff is collapsed.
...@@ -9,17 +9,21 @@ struct b43_phy; ...@@ -9,17 +9,21 @@ struct b43_phy;
/*** PHY Registers ***/ /*** PHY Registers ***/
/* Routing */ /* Routing */
#define B43_PHYROUTE_OFDM_GPHY 0x0400 /* OFDM register routing for G-PHYs */ #define B43_PHYROUTE 0x0C00 /* PHY register routing bits mask */
#define B43_PHYROUTE_EXT_GPHY 0x0800 /* Extended G-PHY registers */ #define B43_PHYROUTE_BASE 0x0000 /* Base registers */
#define B43_PHYROUTE_N_BMODE 0x3000 /* N-PHY BMODE registers */ #define B43_PHYROUTE_OFDM_GPHY 0x0400 /* OFDM register routing for G-PHYs */
#define B43_PHYROUTE_EXT_GPHY 0x0800 /* Extended G-PHY registers */
/* Base registers. */ #define B43_PHYROUTE_N_BMODE 0x0C00 /* N-PHY BMODE registers */
#define B43_PHY_BASE(reg) (reg)
/* CCK (B-PHY) registers. */
#define B43_PHY_CCK(reg) ((reg) | B43_PHYROUTE_BASE)
/* N-PHY registers. */ /* N-PHY registers. */
#define B43_PHY_N(reg) (reg) #define B43_PHY_N(reg) ((reg) | B43_PHYROUTE_BASE)
/* OFDM (A) registers of a G-PHY */ /* N-PHY BMODE registers. */
#define B43_PHY_N_BMODE(reg) ((reg) | B43_PHYROUTE_N_BMODE)
/* OFDM (A-PHY) registers. */
#define B43_PHY_OFDM(reg) ((reg) | B43_PHYROUTE_OFDM_GPHY) #define B43_PHY_OFDM(reg) ((reg) | B43_PHYROUTE_OFDM_GPHY)
/* Extended G-PHY registers */ /* Extended G-PHY registers. */
#define B43_PHY_EXTG(reg) ((reg) | B43_PHYROUTE_EXT_GPHY) #define B43_PHY_EXTG(reg) ((reg) | B43_PHYROUTE_EXT_GPHY)
/* OFDM (A) PHY Registers */ /* OFDM (A) PHY Registers */
...@@ -79,20 +83,20 @@ struct b43_phy; ...@@ -79,20 +83,20 @@ struct b43_phy;
#define B43_PHY_GAIN_LTBASE B43_PHY_OFDM(0x3C0) /* Gain lookup table base */ #define B43_PHY_GAIN_LTBASE B43_PHY_OFDM(0x3C0) /* Gain lookup table base */
/* CCK (B) PHY Registers */ /* CCK (B) PHY Registers */
#define B43_PHY_VERSION_CCK B43_PHY_BASE(0x00) /* Versioning register for B-PHY */ #define B43_PHY_VERSION_CCK B43_PHY_CCK(0x00) /* Versioning register for B-PHY */
#define B43_PHY_CCKBBANDCFG B43_PHY_BASE(0x01) /* Contains antenna 0/1 control bit */ #define B43_PHY_CCKBBANDCFG B43_PHY_CCK(0x01) /* Contains antenna 0/1 control bit */
#define B43_PHY_PGACTL B43_PHY_BASE(0x15) /* PGA control */ #define B43_PHY_PGACTL B43_PHY_CCK(0x15) /* PGA control */
#define B43_PHY_PGACTL_LPF 0x1000 /* Low pass filter (?) */ #define B43_PHY_PGACTL_LPF 0x1000 /* Low pass filter (?) */
#define B43_PHY_PGACTL_LOWBANDW 0x0040 /* Low bandwidth flag */ #define B43_PHY_PGACTL_LOWBANDW 0x0040 /* Low bandwidth flag */
#define B43_PHY_PGACTL_UNKNOWN 0xEFA0 #define B43_PHY_PGACTL_UNKNOWN 0xEFA0
#define B43_PHY_FBCTL1 B43_PHY_BASE(0x18) /* Frequency bandwidth control 1 */ #define B43_PHY_FBCTL1 B43_PHY_CCK(0x18) /* Frequency bandwidth control 1 */
#define B43_PHY_ITSSI B43_PHY_BASE(0x29) /* Idle TSSI */ #define B43_PHY_ITSSI B43_PHY_CCK(0x29) /* Idle TSSI */
#define B43_PHY_LO_LEAKAGE B43_PHY_BASE(0x2D) /* Measured LO leakage */ #define B43_PHY_LO_LEAKAGE B43_PHY_CCK(0x2D) /* Measured LO leakage */
#define B43_PHY_ENERGY B43_PHY_BASE(0x33) /* Energy */ #define B43_PHY_ENERGY B43_PHY_CCK(0x33) /* Energy */
#define B43_PHY_SYNCCTL B43_PHY_BASE(0x35) #define B43_PHY_SYNCCTL B43_PHY_CCK(0x35)
#define B43_PHY_FBCTL2 B43_PHY_BASE(0x38) /* Frequency bandwidth control 2 */ #define B43_PHY_FBCTL2 B43_PHY_CCK(0x38) /* Frequency bandwidth control 2 */
#define B43_PHY_DACCTL B43_PHY_BASE(0x60) /* DAC control */ #define B43_PHY_DACCTL B43_PHY_CCK(0x60) /* DAC control */
#define B43_PHY_RCCALOVER B43_PHY_BASE(0x78) /* RC calibration override */ #define B43_PHY_RCCALOVER B43_PHY_CCK(0x78) /* RC calibration override */
/* Extended G-PHY Registers */ /* Extended G-PHY Registers */
#define B43_PHY_CLASSCTL B43_PHY_EXTG(0x02) /* Classify control */ #define B43_PHY_CLASSCTL B43_PHY_EXTG(0x02) /* Classify control */
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment