b43: LP-PHY: Fix and simplify Qdiv roundup
PATCH v2 1/1 b43: LP-PHY: Fix and simplify Qdiv roundup
The Qdiv roundup routine is essentially a fixed-point division algorithm, using only integer math. However, the version in the specs had a major error that has been recently fixed (a missing quotient++).
Replace Qdiv roundup with a rewritten, simplified version.
---
v2: Remove divide/modulo operations from the inner loop.
drivers/net/wireless/b43/phy_lp.c | 19 ++++++++----------- 1 files changed, 8 insertions(+), 11 deletions(-)
drivers/net/wireless/b43/phy_lp.c +8 -11
@@ -1032,9 +1032,10 @@ static int lpphy_loopback(struct b43_wldev *dev)return index; } +/* Fixed-point division algorithm using only integer math. */ static u32 lpphy_qdiv_roundup (u32 dividend,u32 divisor,u8 precision) { -u32 quotient, remainder, rbit, roundup, tmp; +u32 quotient, remainder;if (divisor ==0 )return 0 ;
@@ -1042,20 +1043,16 @@ static u32 lpphy_qdiv_roundup(u32 dividend, u32 divisor, u8 precision) quotient = dividend / divisor; remainder = dividend % divisor; - rbit = divisor &0x1 ; - roundup = (divisor >>1 ) + rbit; - -while (precision !=0 ) { - tmp = remainder - roundup; +while (precision >0 ) { quotient <<=1 ; -if (remainder >= roundup) - remainder = (tmp <<1 ) + rbit; -else - remainder <<=1 ; +if (remainder <<1 >= divisor) { + quotient++; + remainder = (remainder <<1 ) - divisor; + } precision--; } -if (remainder >= roundup) +if (remainder <<1 >= divisor) quotient++;return quotient;
Signature · 1 line
1.5.6
PATCH 1/1 b43: Fix and update LP-PHY code
-Fix a few nasty typos (b43_phy_* operations instead of b43_radio_*)
in the channel tune routines.
-Fix some typos & spec errors found by MMIO tracing. -Optimize b43_phy_write & b43_phy_mask/set/maskset to use
only the minimal number of MMIO accesses. (Write is possible using a single 32-bit MMIO write, while set/mask/maskset can be done in 3 16-bit MMIOs).
-Set the default channel back to 1, as the bug forcing us to use
channel 7 is now fixed.
With this, the device comes up, scans, associates, transmits, receives, monitors and injects on all channels - in other words, it's fully functional. Sensitivity and TX power are still sub-optimal, due to the lack of calibration (that's next on my list).
--- drivers/net/wireless/b43/phy_common.c | 27 +++++++-- drivers/net/wireless/b43/phy_common.h | 3 + drivers/net/wireless/b43/phy_lp.c | 91 +++++++++++++++++-------------- drivers/net/wireless/b43/phy_lp.h | 3 + drivers/net/wireless/b43/tables_lpphy.c | 79 +++++++++++++++------------ 5 files changed, 122 insertions(+), 81 deletions(-)
drivers/net/wireless/b43/phy_common.c +21 -6
@@ -249,20 +249,35 @@ void b43_phy_copy(struct b43_wldev *dev, u16 destreg, u16 srcreg)void b43_phy_mask (struct b43_wldev *dev,u16 offset,u16 mask) { -b43_phy_write (dev, offset, -b43_phy_read (dev, offset) & mask); +if (dev->phy.ops->phy_maskset) { +assert_mac_suspended (dev); + dev->phy.ops->phy_maskset (dev, offset, mask,0 ); + }else { +b43_phy_write (dev, offset, +b43_phy_read (dev, offset) & mask); + } }void b43_phy_set (struct b43_wldev *dev,u16 offset,u16 set) { -b43_phy_write (dev, offset, -b43_phy_read (dev, offset) | set); +if (dev->phy.ops->phy_maskset) { +assert_mac_suspended (dev); + dev->phy.ops->phy_maskset (dev, offset,0xFFFF , set); + }else { +b43_phy_write (dev, offset, +b43_phy_read (dev, offset) | set); + } }void b43_phy_maskset (struct b43_wldev *dev,u16 offset,u16 mask,u16 set) { -b43_phy_write (dev, offset, - (b43_phy_read (dev, offset) & mask) | set); +if (dev->phy.ops->phy_maskset) { +assert_mac_suspended (dev); + dev->phy.ops->phy_maskset (dev, offset, mask, set); + }else { +b43_phy_write (dev, offset, + (b43_phy_read (dev, offset) & mask) | set); + } }int b43_switch_channel (struct b43_wldev *dev,unsigned int new_channel)
drivers/net/wireless/b43/phy_common.h +3 -0
@@ -95,6 +95,8 @@ enum b43_txpwr_result {* Must not be NULL. * @phy_write: Write to a PHY register. * Must not be NULL. +* @phy_maskset: Maskset a PHY register, taking shortcuts. +* If it is NULL, a generic algorithm is used. * @radio_read: Read from a Radio register. * Must not be NULL. * @radio_write: Write to a Radio register.
@@ -154,6 +156,7 @@ struct b43_phy_operations {/* Register access */ u16 (*phy_read)(struct b43_wldev *dev,u16 reg);void (*phy_write)(struct b43_wldev *dev,u16 reg,u16 value); +void (*phy_maskset)(struct b43_wldev *dev,u16 reg,u16 mask,u16 set);u16 (*radio_read)(struct b43_wldev *dev,u16 reg);void (*radio_write)(struct b43_wldev *dev,u16 reg,u16 value);
drivers/net/wireless/b43/phy_lp.c +50 -41
231 lines not on this page · raw message
drivers/net/wireless/b43/phy_lp.h +3 -0
@@ -888,6 +888,9 @@ struct b43_phy_lp {bool crs_usr_disable, crs_sys_disable;unsigned int pdiv; + +/* The channel we are tuned to */ +u8 channel; };enum tssi_mux_mode {
drivers/net/wireless/b43/tables_lpphy.c +45 -34
158 lines not on this page · raw message
Signature · 1 line
1.5.6
PATCH 1/1 ssb: Implement PMU LDO control and use it in b43
Implement the "PMU LDO set voltage" and "PMU LDO PA ref enable" functions, and use them during LP-PHY baseband init in b43.
--- drivers/net/wireless/b43/phy_lp.c | 10 +-- drivers/ssb/driver_chipcommon_pmu.c | 94 +++++++++++++++++++++++++++++ include/linux/ssb/ssb_driver_chipcommon.h | 10 +++ 3 files changed, 107 insertions(+), 7 deletions(-)
drivers/net/wireless/b43/phy_lp.c +3 -7
@@ -234,19 +234,15 @@ static void lpphy_baseband_rev0_1_init(struct b43_wldev *dev)if ((bus->sprom.boardflags_lo &B43_BFL_FEM ) && ((b43_current_band (dev->wl) ==IEEE80211_BAND_5GHZ ) || (bus->sprom.boardflags_hi &B43_BFH_PAREF ))) { -/* TODO: -* Set the LDO voltage to 0x0028 - FIXME: What is this? -* Call sb_pmu_set_ldo_voltage with 4 and the LDO voltage -* as arguments -* Call sb_pmu_paref_ldo_enable with argument TRUE -*/ +ssb_pmu_set_ldo_voltage (&bus->chipco,LDO_PAREF ,0x28 ); +ssb_pmu_set_ldo_paref (&bus->chipco, true);if (dev->phy.rev ==0 ) {b43_phy_maskset (dev,B43_LPPHY_LP_RF_SIGNAL_LUT ,0xFFCF ,0x0010 ); }b43_lptab_write (dev,B43_LPTAB16 (11 ,7 ),60 ); }else { -//TODO: Call ssb_pmu_paref_ldo_enable with argument FALSE +ssb_pmu_set_ldo_paref (&bus->chipco, false);b43_phy_maskset (dev,B43_LPPHY_LP_RF_SIGNAL_LUT ,0xFFCF ,0x0020 );b43_lptab_write (dev,B43_LPTAB16 (11 ,7 ),100 );
drivers/ssb/driver_chipcommon_pmu.c +94 -0
103 lines not on this page · raw message
include/linux/ssb/ssb_driver_chipcommon.h +10 -0
@@ -629,5 +629,15 @@ extern int ssb_chipco_serial_init(struct ssb_chipcommon *cc,/* PMU support */ extern void ssb_pmu_init (struct ssb_chipcommon *cc); +enum ssb_pmu_ldo_volt_id { +LDO_PAREF =0 , +LDO_VOLT1 , +LDO_VOLT2 , +LDO_VOLT3 , +}; + +void ssb_pmu_set_ldo_voltage (struct ssb_chipcommon *cc, +enum ssb_pmu_ldo_volt_id id,u32 voltage); +void ssb_pmu_set_ldo_paref (struct ssb_chipcommon *cc,bool on);#endif /* LINUX_SSB_CHIPCO_H_ */
Signature · 1 line
1.5.6
Re: [PATCH] ssb: Implement PMU LDO control and use it in b43
Quoted 4 lines · On Wednesday 26 August 2009 20:51:26 Gábor Stefanik wrote:
Implement the "PMU LDO set voltage" and "PMU LDO PA ref enable" functions, and use them during LP-PHY baseband init in b43.
Signed-off-by Gábor Stefanik <[email protected]>
ack
Signature · 1 line
Greetings, Michael.
Re: [PATCH] b43: Fix and update LP-PHY code
In reply to Gábor StefanikReview
Quoted 7 lines · On Wednesday 26 August 2009 20:51:25 Gábor Stefanik wrote:
(quoted diff) +0
-3-Fix a few nasty typos (b43_phy_* operations instead of b43_radio_*) in the channel tune routines. -Fix some typos & spec errors found by MMIO tracing. -Optimize b43_phy_write & b43_phy_mask/set/maskset to use only the minimal number of MMIO accesses. (Write is possible using a single 32-bit MMIO write, while set/mask/maskset can be done in 3 16-bit MMIOs).
Why does it matter? PHY access is not done in any hotpath. So why not prefer simple code over optimized code?
Quoted 2 lines
-Set the default channel back to 1, as the bug forcing us to use
channel 7 is now fixed.
And, everything in its own patch, please. I don't see a reason for patching unrelated things in one big patch.
Quoted 519 lines
With this, the device comes up, scans, associates, transmits, receives, monitors and injects on all channels - in other words, it's fully functional. Sensitivity and TX power are still sub-optimal, due to the lack of calibration (that's next on my list).
Signed-off-by Gábor Stefanik <[email protected]>--- drivers/net/wireless/b43/phy_common.c | 27 +++++++-- drivers/net/wireless/b43/phy_common.h | 3 + drivers/net/wireless/b43/phy_lp.c | 91 +++++++++++++++++-------------- drivers/net/wireless/b43/phy_lp.h | 3 + drivers/net/wireless/b43/tables_lpphy.c | 79 +++++++++++++++------------ 5 files changed, 122 insertions(+), 81 deletions(-)drivers/net/wireless/b43/phy_common.c +21
-6@@ -249,20 +249,35 @@ void b43_phy_copy(struct b43_wldev *dev, u16 destreg, u16 srcreg)void b43_phy_mask (struct b43_wldev *dev,u16 offset,u16 mask) { -b43_phy_write (dev, offset, -b43_phy_read (dev, offset) & mask); +if (dev->phy.ops->phy_maskset) { +assert_mac_suspended (dev); + dev->phy.ops->phy_maskset (dev, offset, mask,0 ); + }else { +b43_phy_write (dev, offset, +b43_phy_read (dev, offset) & mask); + } }void b43_phy_set (struct b43_wldev *dev,u16 offset,u16 set) { -b43_phy_write (dev, offset, -b43_phy_read (dev, offset) | set); +if (dev->phy.ops->phy_maskset) { +assert_mac_suspended (dev); + dev->phy.ops->phy_maskset (dev, offset,0xFFFF , set); + }else { +b43_phy_write (dev, offset, +b43_phy_read (dev, offset) | set); + } }void b43_phy_maskset (struct b43_wldev *dev,u16 offset,u16 mask,u16 set) { -b43_phy_write (dev, offset, - (b43_phy_read (dev, offset) & mask) | set); +if (dev->phy.ops->phy_maskset) { +assert_mac_suspended (dev); + dev->phy.ops->phy_maskset (dev, offset, mask, set); + }else { +b43_phy_write (dev, offset, + (b43_phy_read (dev, offset) & mask) | set); + } }int b43_switch_channel (struct b43_wldev *dev,unsigned int new_channel)drivers/net/wireless/b43/phy_common.h +3
-0@@ -95,6 +95,8 @@ enum b43_txpwr_result {* Must not be NULL. * @phy_write: Write to a PHY register. * Must not be NULL. +* @phy_maskset: Maskset a PHY register, taking shortcuts. +* If it is NULL, a generic algorithm is used. * @radio_read: Read from a Radio register. * Must not be NULL. * @radio_write: Write to a Radio register. @@ -154,6 +156,7 @@ struct b43_phy_operations {/* Register access */ u16 (*phy_read)(struct b43_wldev *dev,u16 reg);void (*phy_write)(struct b43_wldev *dev,u16 reg,u16 value); +void (*phy_maskset)(struct b43_wldev *dev,u16 reg,u16 mask,u16 set);u16 (*radio_read)(struct b43_wldev *dev,u16 reg);void (*radio_write)(struct b43_wldev *dev,u16 reg,u16 value);drivers/net/wireless/b43/phy_lp.c +50
-41@@ -44,7 +44,7 @@ static inline u16 channel2freq_lp(u8 channel)static unsigned int b43_lpphy_op_get_default_chan (struct b43_wldev *dev) {if (b43_current_band (dev->wl) ==IEEE80211_BAND_2GHZ ) -return 7 ;//FIXME temporary - channel 1 is broken +return 1 ;return 36 ; }@@ -182,8 +182,8 @@ static void lpphy_adjust_gain_table(struct b43_wldev *dev, u32 freq) temp[1 ] = temp[0 ] +0x1000 ; temp[2 ] = temp[0 ] +0x2000 ; -b43_lptab_write_bulk (dev,B43_LPTAB16 (12 ,0 ),3 , temp);b43_lptab_write_bulk (dev,B43_LPTAB16 (13 ,0 ),3 , temp); +b43_lptab_write_bulk (dev,B43_LPTAB16 (12 ,0 ),3 , temp); }static void lpphy_table_init (struct b43_wldev *dev)@@ -223,8 +223,8 @@ static void lpphy_baseband_rev0_1_init(struct b43_wldev *dev)b43_phy_maskset (dev,B43_LPPHY_VERYLOWGAINDB ,0xFF00 ,0x0006 );b43_phy_mask (dev,B43_LPPHY_RX_RADIO_CTL ,0xFFFE );b43_phy_maskset (dev,B43_LPPHY_CLIPCTRTHRESH ,0xFFE0 ,0x0005 ); -b43_phy_maskset (dev,B43_LPPHY_CLIPCTRTHRESH ,0xFC10 ,0x0180 ); -b43_phy_maskset (dev,B43_LPPHY_CLIPCTRTHRESH ,0x83FF ,0x3800 ); +b43_phy_maskset (dev,B43_LPPHY_CLIPCTRTHRESH ,0xFC1F ,0x0180 ); +b43_phy_maskset (dev,B43_LPPHY_CLIPCTRTHRESH ,0x83FF ,0x3C00 );b43_phy_maskset (dev,B43_LPPHY_GAINDIRECTMISMATCH ,0xFFF0 ,0x0005 );b43_phy_maskset (dev,B43_LPPHY_GAIN_MISMATCH_LIMIT ,0xFFC0 ,0x001A );b43_phy_maskset (dev,B43_LPPHY_CRS_ED_THRESH ,0xFF00 ,0x00B3 );@@ -237,7 +237,7 @@ static void lpphy_baseband_rev0_1_init(struct b43_wldev *dev)/* TODO: * Set the LDO voltage to 0x0028 - FIXME: What is this? * Call sb_pmu_set_ldo_voltage with 4 and the LDO voltage -* as arguments +* as arguments * Call sb_pmu_paref_ldo_enable with argument TRUE */ if (dev->phy.rev ==0 ) {@@ -340,11 +340,11 @@ static void lpphy_baseband_rev0_1_init(struct b43_wldev *dev)if (dev->phy.rev ==1 ) { tmp =b43_phy_read (dev,B43_LPPHY_CLIPCTRTHRESH ); tmp2 = (tmp &0x03E0 ) >>5 ; - tmp2 |= tmp <<5 ; + tmp2 |= tmp2 <<5 ;b43_phy_write (dev,B43_LPPHY_4C3 , tmp2); - tmp =b43_phy_read (dev,B43_LPPHY_OFDMSYNCTHRESH0 ); + tmp =b43_phy_read (dev,B43_LPPHY_GAINDIRECTMISMATCH ); tmp2 = (tmp &0x1F00 ) >>8 ; - tmp2 |= tmp <<5 ; + tmp2 |= tmp2 <<5 ;b43_phy_write (dev,B43_LPPHY_4C4 , tmp2); tmp =b43_phy_read (dev,B43_LPPHY_VERYLOWGAINDB ); tmp2 = tmp &0x00FF ;@@ -761,7 +761,7 @@ static void lpphy_disable_crs(struct b43_wldev *dev, bool user)b43_phy_set (dev,B43_LPPHY_RF_OVERRIDE_0 ,0x3 );b43_phy_mask (dev,B43_LPPHY_RF_OVERRIDE_VAL_0 ,0xFFFB );b43_phy_set (dev,B43_LPPHY_RF_OVERRIDE_0 ,0x4 ); -b43_phy_mask (dev,B43_LPPHY_RF_OVERRIDE_0 ,0xFFF7 ); +b43_phy_mask (dev,B43_LPPHY_RF_OVERRIDE_VAL_0 ,0xFFF7 );b43_phy_set (dev,B43_LPPHY_RF_OVERRIDE_0 ,0x8 );b43_phy_set (dev,B43_LPPHY_RF_OVERRIDE_VAL_0 ,0x10 );b43_phy_set (dev,B43_LPPHY_RF_OVERRIDE_0 ,0x10 );@@ -956,7 +956,7 @@ static void lpphy_run_ddfs(struct b43_wldev *dev, int i_on, int q_on,b43_phy_maskset (dev,B43_LPPHY_AFE_DDFS ,0xFF9F , scale_idx <<5 );b43_phy_mask (dev,B43_LPPHY_AFE_DDFS ,0xFFFB );b43_phy_set (dev,B43_LPPHY_AFE_DDFS ,0x2 ); -b43_phy_set (dev,B43_LPPHY_AFE_DDFS ,0x20 ); +b43_phy_set (dev,B43_LPPHY_LP_PHY_CTL ,0x20 ); } static bool lpphy_rx_iq_est(struct b43_wldev *dev, u16 samples, u8 time,@@ -968,7 +968,7 @@ static bool lpphy_rx_iq_est(struct b43_wldev *dev, u16 samples, u8 time,b43_phy_write (dev,B43_LPPHY_IQ_NUM_SMPLS_ADDR , samples);b43_phy_maskset (dev,B43_LPPHY_IQ_ENABLE_WAIT_TIME_ADDR ,0xFF00 , time);b43_phy_mask (dev,B43_LPPHY_IQ_ENABLE_WAIT_TIME_ADDR ,0xFEFF ); -b43_phy_set (dev,B43_LPPHY_IQ_ENABLE_WAIT_TIME_ADDR ,0xFDFF ); +b43_phy_set (dev,B43_LPPHY_IQ_ENABLE_WAIT_TIME_ADDR ,0x200 );for (i =0 ; i <500 ; i++) { if (!(b43_phy_read(dev,@@ -1135,9 +1135,9 @@ static void lpphy_set_tx_power_control(struct b43_wldev *dev, }if (dev->phy.rev >=2 ) {if (mode ==B43_LPPHY_TXPCTL_HW ) -b43_phy_maskset (dev,B43_PHY_OFDM (0xD0 ),0xFD ,0x2 ); +b43_phy_set (dev,B43_PHY_OFDM (0xD0 ),0x2 );else -b43_phy_maskset (dev,B43_PHY_OFDM (0xD0 ),0xFD ,0 ); +b43_phy_mask (dev,B43_PHY_OFDM (0xD0 ),0xFFFD ); }lpphy_write_tx_pctl_mode_to_hardware (dev); }@@ -1169,7 +1169,7 @@ static void lpphy_rev0_1_rc_calib(struct b43_wldev *dev) err =b43_lpphy_op_switch_channel (dev,7 );if (err) {b43dbg (dev->wl, -"RC calib: Failed to switch to channel 7, error = %d" , +"RC calib: Failed to switch to channel 7, error = %d\n" , err); } old_txg_ovr = !!(b43_phy_read (dev,B43_LPPHY_AFE_CTL_OVR ) &0x40 );@@ -1500,8 +1500,15 @@ static u16 b43_lpphy_op_read(struct b43_wldev *dev, u16 reg)static void b43_lpphy_op_write (struct b43_wldev *dev,u16 reg,u16 value) { +b43_write32 (dev,B43_MMIO_PHY_CONTROL , ((u32 )value <<16 ) | reg); +} + +static void b43_lpphy_op_maskset (struct b43_wldev *dev,u16 reg,u16 mask, +u16 set) +{b43_write16 (dev,B43_MMIO_PHY_CONTROL , reg); -b43_write16 (dev,B43_MMIO_PHY_DATA , value); +b43_write16 (dev,B43_MMIO_PHY_DATA , + (b43_read16 (dev,B43_MMIO_PHY_DATA ) & mask) | set); }static u16 b43_lpphy_op_radio_read (struct b43_wldev *dev,u16 reg)@@ -1920,8 +1927,8 @@ static void lpphy_b2062_reset_pll_bias(struct b43_wldev *dev)static void lpphy_b2062_vco_calib (struct b43_wldev *dev) { -b43_phy_write (dev,B2062_S_RFPLL_CTL21 ,0x42 ); -b43_phy_write (dev,B2062_S_RFPLL_CTL21 ,0x62 ); +b43_radio_write (dev,B2062_S_RFPLL_CTL21 ,0x42 ); +b43_radio_write (dev,B2062_S_RFPLL_CTL21 ,0x62 );udelay (200 ); }@@ -1980,7 +1987,7 @@ static int lpphy_b2062_tune(struct b43_wldev *dev, tmp6 = tmp5 / tmp4; tmp7 = tmp5 % tmp4;b43_radio_write (dev,B2062_S_RFPLL_CTL29 , tmp6 + ((2 * tmp7) / tmp4)); - tmp8 =b43_phy_read (dev,B2062_S_RFPLL_CTL19 ); + tmp8 =b43_radio_read (dev,B2062_S_RFPLL_CTL19 ); tmp9 = ((2 * tmp3 * (tmp8 +1 )) + (3 * tmp1)) / (6 * tmp1);b43_radio_write (dev,B2062_S_RFPLL_CTL23 , (tmp9 >>8 ) +16 );b43_radio_write (dev,B2062_S_RFPLL_CTL24 , tmp9 &0xFF );@@ -2019,17 +2026,17 @@ static void lpphy_b2063_vco_calib(struct b43_wldev *dev) {u16 tmp; -b43_phy_mask (dev,B2063_PLL_SP1 , ~0x40 ); - tmp =b43_phy_read (dev,B2063_PLL_JTAG_CALNRST ) &0xF8 ; -b43_phy_write (dev,B2063_PLL_JTAG_CALNRST , tmp); +b43_radio_mask (dev,B2063_PLL_SP1 , ~0x40 ); + tmp =b43_radio_read (dev,B2063_PLL_JTAG_CALNRST ) &0xF8 ; +b43_radio_write (dev,B2063_PLL_JTAG_CALNRST , tmp);udelay (1 ); -b43_phy_write (dev,B2063_PLL_JTAG_CALNRST , tmp |0x4 ); +b43_radio_write (dev,B2063_PLL_JTAG_CALNRST , tmp |0x4 );udelay (1 ); -b43_phy_write (dev,B2063_PLL_JTAG_CALNRST , tmp |0x6 ); +b43_radio_write (dev,B2063_PLL_JTAG_CALNRST , tmp |0x6 );udelay (1 ); -b43_phy_write (dev,B2063_PLL_JTAG_CALNRST , tmp |0x7 ); +b43_radio_write (dev,B2063_PLL_JTAG_CALNRST , tmp |0x7 );udelay (300 ); -b43_phy_set (dev,B2063_PLL_SP1 ,0x40 ); +b43_radio_set (dev,B2063_PLL_SP1 ,0x40 ); } static int lpphy_b2063_tune(struct b43_wldev *dev,@@ -2124,31 +2131,31 @@ static int lpphy_b2063_tune(struct b43_wldev *dev, scale =0 ; tmp5 = ((tmp4 + (tmp3 >>1 )) / tmp3) -8 ; } -b43_phy_maskset (dev,B2063_PLL_JTAG_PLL_CP2 ,0xFFC0 , tmp5); -b43_phy_maskset (dev,B2063_PLL_JTAG_PLL_CP2 ,0xFFBF , scale <<6 ); +b43_radio_maskset (dev,B2063_PLL_JTAG_PLL_CP2 ,0xFFC0 , tmp5); +b43_radio_maskset (dev,B2063_PLL_JTAG_PLL_CP2 ,0xFFBF , scale <<6 ); tmp6 =lpphy_qdiv_roundup (100 * val1, val3,16 ); tmp6 *= (tmp5 *8 ) * (scale +1 );if (tmp6 >150 ) tmp6 =0 ; -b43_phy_maskset (dev,B2063_PLL_JTAG_PLL_CP3 ,0xFFE0 , tmp6); -b43_phy_maskset (dev,B2063_PLL_JTAG_PLL_CP3 ,0xFFDF , scale <<5 ); +b43_radio_maskset (dev,B2063_PLL_JTAG_PLL_CP3 ,0xFFE0 , tmp6); +b43_radio_maskset (dev,B2063_PLL_JTAG_PLL_CP3 ,0xFFDF , scale <<5 ); -b43_phy_maskset (dev,B2063_PLL_JTAG_PLL_XTAL_12 ,0xFFFB ,0x4 ); +b43_radio_maskset (dev,B2063_PLL_JTAG_PLL_XTAL_12 ,0xFFFB ,0x4 );if (crystal_freq >26000000 ) -b43_phy_set (dev,B2063_PLL_JTAG_PLL_XTAL_12 ,0x2 ); +b43_radio_set (dev,B2063_PLL_JTAG_PLL_XTAL_12 ,0x2 );else -b43_phy_mask (dev,B2063_PLL_JTAG_PLL_XTAL_12 ,0xFD ); +b43_radio_mask (dev,B2063_PLL_JTAG_PLL_XTAL_12 ,0xFD );if (val1 ==45 ) -b43_phy_set (dev,B2063_PLL_JTAG_PLL_VCO1 ,0x2 ); +b43_radio_set (dev,B2063_PLL_JTAG_PLL_VCO1 ,0x2 );else -b43_phy_mask (dev,B2063_PLL_JTAG_PLL_VCO1 ,0xFD ); +b43_radio_mask (dev,B2063_PLL_JTAG_PLL_VCO1 ,0xFD ); -b43_phy_set (dev,B2063_PLL_SP2 ,0x3 ); +b43_radio_set (dev,B2063_PLL_SP2 ,0x3 );udelay (1 ); -b43_phy_mask (dev,B2063_PLL_SP2 ,0xFFFC ); +b43_radio_mask (dev,B2063_PLL_SP2 ,0xFFFC );lpphy_b2063_vco_calib (dev);b43_radio_write (dev,B2063_COMM15 , old_comm15);@@ -2158,10 +2165,9 @@ static int lpphy_b2063_tune(struct b43_wldev *dev,static int b43_lpphy_op_switch_channel (struct b43_wldev *dev,unsigned int new_channel) { +struct b43_phy_lp *lpphy = dev->phy.lp;int err; -b43_write16 (dev,B43_MMIO_CHANNEL , new_channel); -if (dev->phy.radio_ver ==0x2063 ) { err =lpphy_b2063_tune (dev, new_channel);if (err)@@ -2174,6 +2180,9 @@ static int b43_lpphy_op_switch_channel(struct b43_wldev *dev,lpphy_adjust_gain_table (dev,channel2freq_lp (new_channel)); } + lpphy->channel = new_channel; +b43_write16 (dev,B43_MMIO_CHANNEL , new_channel); +return 0 ; }@@ -2185,10 +2194,9 @@ static int b43_lpphy_op_init(struct b43_wldev *dev)lpphy_baseband_init (dev);lpphy_radio_init (dev);lpphy_calibrate_rc (dev); - err =b43_lpphy_op_switch_channel (dev, -b43_lpphy_op_get_default_chan (dev)); + err =b43_lpphy_op_switch_channel (dev,7 );if (err) { -b43dbg (dev->wl,"Switch to init channel failed, error = %d.\n" , +b43dbg (dev->wl,"Switch to channel 7 failed, error = %d.\n" , err); }lpphy_tx_pctl_init (dev);@@ -2222,6 +2230,7 @@ const struct b43_phy_operations b43_phyops_lp = { .init = b43_lpphy_op_init, .phy_read = b43_lpphy_op_read, .phy_write = b43_lpphy_op_write, + .phy_maskset = b43_lpphy_op_maskset, .radio_read = b43_lpphy_op_radio_read, .radio_write = b43_lpphy_op_radio_write, .software_rfkill = b43_lpphy_op_software_rfkill,drivers/net/wireless/b43/phy_lp.h +3
-0@@ -888,6 +888,9 @@ struct b43_phy_lp {bool crs_usr_disable, crs_sys_disable;unsigned int pdiv; + +/* The channel we are tuned to */ +u8 channel; };enum tssi_mux_mode {drivers/net/wireless/b43/tables_lpphy.c +45
-34@@ -624,30 +624,35 @@ u32 b43_lptab_read(struct b43_wldev *dev, u32 offset)void b43_lptab_read_bulk (struct b43_wldev *dev,u32 offset,unsigned int nr_elements,void *_data) { -u32 type, value; +u32 type;u8 *data = _data;unsigned int i; type = offset &B43_LPTAB_TYPEMASK ; + offset &= ~B43_LPTAB_TYPEMASK ; +B43_WARN_ON (offset >0xFFFF ); + +b43_phy_write (dev,B43_LPPHY_TABLE_ADDR , offset); +for (i =0 ; i < nr_elements; i++) { - value =b43_lptab_read (dev, offset);switch (type) {case B43_LPTAB_8BIT : - *data = value; + *data =b43_phy_read (dev,B43_LPPHY_TABLEDATALO ) &0xFF ; data++;break ;case B43_LPTAB_16BIT : - *((u16 *)data) = value; + *((u16 *)data) =b43_phy_read (dev,B43_LPPHY_TABLEDATALO ); data +=2 ;break ;case B43_LPTAB_32BIT : - *((u32 *)data) = value; + *((u32 *)data) =b43_phy_read (dev,B43_LPPHY_TABLEDATAHI ); + *((u32 *)data) <<=16 ; + *((u32 *)data) |=b43_phy_read (dev,B43_LPPHY_TABLEDATALO ); data +=4 ;break ;default :B43_WARN_ON (1 ); } - offset++; } }@@ -688,26 +693,34 @@ void b43_lptab_write_bulk(struct b43_wldev *dev, u32 offset,unsigned int i; type = offset &B43_LPTAB_TYPEMASK ; + offset &= ~B43_LPTAB_TYPEMASK ; +B43_WARN_ON (offset >0xFFFF ); + +b43_phy_write (dev,B43_LPPHY_TABLE_ADDR , offset); +for (i =0 ; i < nr_elements; i++) {switch (type) {case B43_LPTAB_8BIT : value = *data; data++; +B43_WARN_ON (value & ~0xFF ); +b43_phy_write (dev,B43_LPPHY_TABLEDATALO , value);break ;case B43_LPTAB_16BIT : value = *((u16 *)data); data +=2 ; +B43_WARN_ON (value & ~0xFFFF ); +b43_phy_write (dev,B43_LPPHY_TABLEDATALO , value);break ;case B43_LPTAB_32BIT : value = *((u32 *)data); data +=4 ; +b43_phy_write (dev,B43_LPPHY_TABLEDATAHI , value >>16 ); +b43_phy_write (dev,B43_LPPHY_TABLEDATALO , value);break ;default :B43_WARN_ON (1 ); - value =0 ; } -b43_lptab_write (dev, offset, value); - offset++; } }@@ -777,7 +790,7 @@ static const u8 lpphy_pll_fraction_table[] = { 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, }; -static const u16 lpphy_iq_local_table[] = { +static const u16 lpphy_iqlo_cal_table[] = {0x0200 ,0x0300 ,0x0400 ,0x0600 ,0x0800 ,0x0b00 ,0x1000 ,0x1001 ,0x1002 ,0x1003 ,0x1004 ,0x1005 ,0x1006 ,0x1007 ,0x1707 ,0x2007 ,0x2d07 ,0x4007 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,@@ -789,10 +802,17 @@ static const u16 lpphy_iq_local_table[] = {0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x4000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 ,0x0000 , - 0x0000, 0x0000, + 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, }; -static const u16 lpphy_ofdm_cck_gain_table[] = { +static const u16 lpphy_rev0_ofdm_cck_gain_table[] = { +0x0001 ,0x0001 ,0x0001 ,0x0001 ,0x1001 ,0x2001 ,0x3001 ,0x4001 ,0x5001 , +0x6001 ,0x7001 ,0x7011 ,0x7021 ,0x2035 ,0x2045 ,0x2055 ,0x2065 ,0x2075 , +0x006d ,0x007d ,0x014d ,0x015d ,0x115d ,0x035d ,0x135d ,0x055d ,0x155d , +0x0d5d ,0x1d5d ,0x2d5d ,0x555d ,0x655d ,0x755d , +}; + +static const u16 lpphy_rev1_ofdm_cck_gain_table[] = {0x5000 ,0x6000 ,0x7000 ,0x0001 ,0x1001 ,0x2001 ,0x3001 ,0x4001 ,0x5001 ,0x6001 ,0x7001 ,0x7011 ,0x7021 ,0x2035 ,0x2045 ,0x2055 ,0x2065 ,0x2075 , 0x006d, 0x007d, 0x014d, 0x015d, 0x115d, 0x035d, 0x135d, 0x055d, 0x155d,@@ -2263,11 +2283,18 @@ void lpphy_rev0_1_table_init(struct b43_wldev *dev)b43_lptab_write_bulk (dev,B43_LPTAB8 (6 ,0 ),ARRAY_SIZE (lpphy_pll_fraction_table), lpphy_pll_fraction_table);b43_lptab_write_bulk (dev,B43_LPTAB16 (0 ,0 ), -ARRAY_SIZE (lpphy_iq_local_table), lpphy_iq_local_table); -b43_lptab_write_bulk (dev,B43_LPTAB16 (13 ,0 ), -ARRAY_SIZE (lpphy_ofdm_cck_gain_table), lpphy_ofdm_cck_gain_table); -b43_lptab_write_bulk (dev,B43_LPTAB16 (12 ,0 ), -ARRAY_SIZE (lpphy_ofdm_cck_gain_table), lpphy_ofdm_cck_gain_table); +ARRAY_SIZE (lpphy_iqlo_cal_table), lpphy_iqlo_cal_table); +if (dev->phy.rev ==0 ) { +b43_lptab_write_bulk (dev,B43_LPTAB16 (13 ,0 ), +ARRAY_SIZE (lpphy_rev0_ofdm_cck_gain_table), lpphy_rev0_ofdm_cck_gain_table); +b43_lptab_write_bulk (dev,B43_LPTAB16 (12 ,0 ), +ARRAY_SIZE (lpphy_rev0_ofdm_cck_gain_table), lpphy_rev0_ofdm_cck_gain_table); + }else { +b43_lptab_write_bulk (dev,B43_LPTAB16 (13 ,0 ), +ARRAY_SIZE (lpphy_rev1_ofdm_cck_gain_table), lpphy_rev1_ofdm_cck_gain_table); +b43_lptab_write_bulk (dev,B43_LPTAB16 (12 ,0 ), +ARRAY_SIZE (lpphy_rev1_ofdm_cck_gain_table), lpphy_rev1_ofdm_cck_gain_table); +}b43_lptab_write_bulk (dev,B43_LPTAB16 (15 ,0 ),ARRAY_SIZE (lpphy_gain_delta_table), lpphy_gain_delta_table); b43_lptab_write_bulk(dev, B43_LPTAB32(10, 0),@@ -2281,22 +2308,6 @@ void lpphy_rev2plus_table_init(struct b43_wldev *dev)B43_WARN_ON (dev->phy.rev <2 ); -/* -* FIXME This code follows the specs, but it looks wrong: -* In each pass, it writes 4 bytes to an offset in table ID 7, -* then increments the offset by 1 for the next pass. This results -* in the first 3 bytes of each pass except the first one getting -* written to a location that has already been zeroed in the previous -* pass. -* This is what the vendor driver does, but it still looks suspicious. -* -* This should probably suffice: -* -* for (i = 0; i < 704; i+=4) -* b43_lptab_write(dev, B43_LPTAB32(7, i), 0) -* -* This should be tested once the code is functional. -*/ for (i =0 ; i <704 ; i++)b43_lptab_write (dev,B43_LPTAB32 (7 , i),0 );@@ -2323,7 +2334,7 @@ void lpphy_rev2plus_table_init(struct b43_wldev *dev)b43_lptab_write_bulk (dev,B43_LPTAB8 (6 ,0 ),ARRAY_SIZE (lpphy_pll_fraction_table), lpphy_pll_fraction_table);b43_lptab_write_bulk (dev,B43_LPTAB16 (0 ,0 ), -ARRAY_SIZE (lpphy_iq_local_table), lpphy_iq_local_table); +ARRAY_SIZE (lpphy_iqlo_cal_table), lpphy_iqlo_cal_table);b43_lptab_write_bulk (dev,B43_LPTAB32 (9 ,0 ),ARRAY_SIZE (lpphy_papd_eps_table), lpphy_papd_eps_table); b43_lptab_write_bulk(dev, B43_LPTAB32(10, 0),
Signature · 1 line
Greetings, Michael.
Re: [PATCH] b43: Fix and update LP-PHY code
2009/8/26 Michael Buesch <[email protected]>:
Quoted 11 lines · On Wednesday 26 August 2009 20:51:25 Gábor Stefanik wrote:
Quoted 7 lines
-Fix a few nasty typos (b43_phy_* operations instead of b43_radio_*) in the channel tune routines.
(quoted diff) +0
-2-Fix some typos & spec errors found by MMIO tracing. -Optimize b43_phy_write & b43_phy_mask/set/maskset to useonly the minimal number of MMIO accesses. (Write is possible using a single 32-bit MMIO write, while set/mask/maskset can be done in 3 16-bit MMIOs).
Why does it matter? PHY access is not done in any hotpath. So why not prefer simple code over optimized code?
This is how the MIPS/hybrid driver does it, I simply updated the code for parity.
Quoted 6 lines
Quoted 3 lines
-Set the default channel back to 1, as the bug forcing us to use channel 7 is now fixed.
And, everything in its own patch, please. I don't see a reason for patching unrelated things in one big patch.
Well, this patch is already in wireless-testing, so doing that would now involve reverting this patch, applying a version without the channel change, and applying the channel change - certainly more confusing than the status quo.
Quoted 526 lines
Quoted 512 lines
With this, the device comes up, scans, associates, transmits, receives, monitors and injects on all channels - in other words, it's fully functional. Sensitivity and TX power are still sub-optimal, due to the lack of calibration (that's next on my list).
Signed-off-by Gábor Stefanik <[email protected]>---
drivers/net/wireless/b43/phy_common.c | 27 +++++++--drivers/net/wireless/b43/phy_common.h| 3 +drivers/net/wireless/b43/phy_lp.c| 91 +++++++++++++++++--------------drivers/net/wireless/b43/phy_lp.h| 3 +drivers/net/wireless/b43/tables_lpphy.c| 79 +++++++++++++++------------5 files changed, 122 insertions(+), 81 deletions(-)drivers/net/wireless/b43/phy_common.c +21
-6@@ -249,20 +249,35 @@ void b43_phy_copy(struct b43_wldev *dev, u16 destreg, u16 srcreg) void b43_phy_mask(struct b43_wldev *dev, u16 offset, u16 mask) { - b43_phy_write(dev, offset, - b43_phy_read(dev, offset) & mask); + if (dev->phy.ops->phy_maskset) { + assert_mac_suspended(dev); + dev->phy.ops->phy_maskset(dev, offset, mask, 0); + } else { + b43_phy_write(dev, offset, + b43_phy_read(dev, offset) & mask); + } } void b43_phy_set(struct b43_wldev *dev, u16 offset, u16 set) { - b43_phy_write(dev, offset, - b43_phy_read(dev, offset) | set); + if (dev->phy.ops->phy_maskset) { + assert_mac_suspended(dev); + dev->phy.ops->phy_maskset(dev, offset, 0xFFFF, set); + } else { + b43_phy_write(dev, offset, + b43_phy_read(dev, offset) | set); + } } void b43_phy_maskset(struct b43_wldev *dev, u16 offset, u16 mask, u16 set) { - b43_phy_write(dev, offset, - (b43_phy_read(dev, offset) & mask) | set); + if (dev->phy.ops->phy_maskset) { + assert_mac_suspended(dev); + dev->phy.ops->phy_maskset(dev, offset, mask, set); + } else { + b43_phy_write(dev, offset, + (b43_phy_read(dev, offset) & mask) | set); + } } int b43_switch_channel(struct b43_wldev *dev, unsigned int new_channel)drivers/net/wireless/b43/phy_common.h +3
-0@@ -95,6 +95,8 @@ enum b43_txpwr_result { * Must not be NULL. * @phy_write: Write to a PHY register. * Must not be NULL. + * @phy_maskset: Maskset a PHY register, taking shortcuts. + * If it is NULL, a generic algorithm is used. * @radio_read: Read from a Radio register. * Must not be NULL. * @radio_write: Write to a Radio register.@@ -154,6 +156,7 @@ struct b43_phy_operations { /* Register access */ u16 (*phy_read)(struct b43_wldev *dev, u16 reg); void (*phy_write)(struct b43_wldev *dev, u16 reg, u16 value); + void (*phy_maskset)(struct b43_wldev *dev, u16 reg, u16 mask, u16 set); u16 (*radio_read)(struct b43_wldev *dev, u16 reg); void (*radio_write)(struct b43_wldev *dev, u16 reg, u16 value);drivers/net/wireless/b43/phy_lp.c +12
-12@@ -44,7 +44,7 @@ static inline u16 channel2freq_lp(u8 channel) static unsigned int b43_lpphy_op_get_default_chan(struct b43_wldev *dev) { if (b43_current_band(dev->wl) == IEEE80211_BAND_2GHZ) - return 7; //FIXME temporary - channel 1 is broken + return 1; return 36; }@@ -182,8 +182,8 @@ static void lpphy_adjust_gain_table(struct b43_wldev *dev, u32 freq) temp[1] = temp[0] + 0x1000; temp[2] = temp[0] + 0x2000; - b43_lptab_write_bulk(dev, B43_LPTAB16(12, 0), 3, temp); b43_lptab_write_bulk(dev, B43_LPTAB16(13, 0), 3, temp); + b43_lptab_write_bulk(dev, B43_LPTAB16(12, 0), 3, temp); } static void lpphy_table_init(struct b43_wldev *dev)@@ -223,8 +223,8 @@ static void lpphy_baseband_rev0_1_init(struct b43_wldev *dev) b43_phy_maskset(dev, B43_LPPHY_VERYLOWGAINDB, 0xFF00, 0x0006); b43_phy_mask(dev, B43_LPPHY_RX_RADIO_CTL, 0xFFFE); b43_phy_maskset(dev, B43_LPPHY_CLIPCTRTHRESH, 0xFFE0, 0x0005); - b43_phy_maskset(dev, B43_LPPHY_CLIPCTRTHRESH, 0xFC10, 0x0180); - b43_phy_maskset(dev, B43_LPPHY_CLIPCTRTHRESH, 0x83FF, 0x3800); + b43_phy_maskset(dev, B43_LPPHY_CLIPCTRTHRESH, 0xFC1F, 0x0180); + b43_phy_maskset(dev, B43_LPPHY_CLIPCTRTHRESH, 0x83FF, 0x3C00); b43_phy_maskset(dev, B43_LPPHY_GAINDIRECTMISMATCH, 0xFFF0, 0x0005); b43_phy_maskset(dev, B43_LPPHY_GAIN_MISMATCH_LIMIT, 0xFFC0, 0x001A); b43_phy_maskset(dev, B43_LPPHY_CRS_ED_THRESH, 0xFF00, 0x00B3);@@ -237,7 +237,7 @@ static void lpphy_baseband_rev0_1_init(struct b43_wldev *dev) /* TODO: * Set the LDO voltage to 0x0028 - FIXME: What is this? * Call sb_pmu_set_ldo_voltage with 4 and the LDO voltage - * as arguments + * as arguments * Call sb_pmu_paref_ldo_enable with argument TRUE */ if (dev->phy.rev == 0) {@@ -340,11 +340,11 @@ static void lpphy_baseband_rev0_1_init(struct b43_wldev *dev) if (dev->phy.rev == 1) { tmp = b43_phy_read(dev, B43_LPPHY_CLIPCTRTHRESH); tmp2 = (tmp & 0x03E0) >> 5; - tmp2 |= tmp << 5; + tmp2 |= tmp2 << 5; b43_phy_write(dev, B43_LPPHY_4C3, tmp2); - tmp = b43_phy_read(dev, B43_LPPHY_OFDMSYNCTHRESH0); + tmp = b43_phy_read(dev, B43_LPPHY_GAINDIRECTMISMATCH); tmp2 = (tmp & 0x1F00) >> 8; - tmp2 |= tmp << 5; + tmp2 |= tmp2 << 5; b43_phy_write(dev, B43_LPPHY_4C4, tmp2); tmp = b43_phy_read(dev, B43_LPPHY_VERYLOWGAINDB); tmp2 = tmp & 0x00FF;@@ -761,7 +761,7 @@ static void lpphy_disable_crs(struct b43_wldev *dev, bool user) b43_phy_set(dev, B43_LPPHY_RF_OVERRIDE_0, 0x3); b43_phy_mask(dev, B43_LPPHY_RF_OVERRIDE_VAL_0, 0xFFFB); b43_phy_set(dev, B43_LPPHY_RF_OVERRIDE_0, 0x4); - b43_phy_mask(dev, B43_LPPHY_RF_OVERRIDE_0, 0xFFF7); + b43_phy_mask(dev, B43_LPPHY_RF_OVERRIDE_VAL_0, 0xFFF7); b43_phy_set(dev, B43_LPPHY_RF_OVERRIDE_0, 0x8); b43_phy_set(dev, B43_LPPHY_RF_OVERRIDE_VAL_0, 0x10); b43_phy_set(dev, B43_LPPHY_RF_OVERRIDE_0, 0x10);@@ -956,7 +956,7 @@ static void lpphy_run_ddfs(struct b43_wldev *dev, int i_on, int q_on, b43_phy_maskset(dev, B43_LPPHY_AFE_DDFS, 0xFF9F, scale_idx << 5); b43_phy_mask(dev, B43_LPPHY_AFE_DDFS, 0xFFFB); b43_phy_set(dev, B43_LPPHY_AFE_DDFS, 0x2); - b43_phy_set(dev, B43_LPPHY_AFE_DDFS, 0x20); + b43_phy_set(dev, B43_LPPHY_LP_PHY_CTL, 0x20); } static bool lpphy_rx_iq_est(struct b43_wldev *dev, u16 samples, u8 time,@@ -968,7 +968,7 @@ static bool lpphy_rx_iq_est(struct b43_wldev *dev, u16 samples, u8 time, b43_phy_write(dev, B43_LPPHY_IQ_NUM_SMPLS_ADDR, samples); b43_phy_maskset(dev, B43_LPPHY_IQ_ENABLE_WAIT_TIME_ADDR, 0xFF00, time); b43_phy_mask(dev, B43_LPPHY_IQ_ENABLE_WAIT_TIME_ADDR, 0xFEFF); - b43_phy_set(dev, B43_LPPHY_IQ_ENABLE_WAIT_TIME_ADDR, 0xFDFF); + b43_phy_set(dev, B43_LPPHY_IQ_ENABLE_WAIT_TIME_ADDR, 0x200); for (i = 0; i < 500; i++) { if (!(b43_phy_read(dev,@@ -1135,9 +1135,9 @@ static void lpphy_set_tx_power_control(struct b43_wldev *dev, } if (dev->phy.rev >= 2) { if (mode == B43_LPPHY_TXPCTL_HW) - b43_phy_maskset(dev, B43_PHY_OFDM(0xD0), 0xFD, 0x2); + b43_phy_set(dev, B43_PHY_OFDM(0xD0), 0x2);else
-b43_phy_maskset(dev, B43_PHY_OFDM(0xD0), 0xFD, 0);
+b43_phy_mask(dev, B43_PHY_OFDM(0xD0), 0xFFFD); }
lpphy_write_tx_pctl_mode_to_hardware(dev);
}drivers/net/wireless/b43/phy_lp.c +25
-18@@ -1169,7 +1169,7 @@ static void lpphy_rev0_1_rc_calib(struct b43_wldev *dev) err = b43_lpphy_op_switch_channel(dev, 7); if (err) { b43dbg(dev->wl, - "RC calib: Failed to switch to channel 7, error = %d", + "RC calib: Failed to switch to channel 7, error = %d\n", err); } old_txg_ovr = !!(b43_phy_read(dev, B43_LPPHY_AFE_CTL_OVR) & 0x40);@@ -1500,8 +1500,15 @@ static u16 b43_lpphy_op_read(struct b43_wldev *dev, u16 reg) static void b43_lpphy_op_write(struct b43_wldev *dev, u16 reg, u16 value) { + b43_write32(dev, B43_MMIO_PHY_CONTROL, ((u32)value << 16) | reg); +} + +static void b43_lpphy_op_maskset (struct b43_wldev *dev,u16 reg,u16 mask, + u16 set) +{ b43_write16(dev, B43_MMIO_PHY_CONTROL, reg); - b43_write16(dev, B43_MMIO_PHY_DATA, value); + b43_write16(dev, B43_MMIO_PHY_DATA, + (b43_read16(dev, B43_MMIO_PHY_DATA) & mask) | set); } static u16 b43_lpphy_op_radio_read(struct b43_wldev *dev, u16 reg)@@ -1920,8 +1927,8 @@ static void lpphy_b2062_reset_pll_bias(struct b43_wldev *dev) static void lpphy_b2062_vco_calib(struct b43_wldev *dev) { - b43_phy_write(dev, B2062_S_RFPLL_CTL21, 0x42); - b43_phy_write(dev, B2062_S_RFPLL_CTL21, 0x62); + b43_radio_write(dev, B2062_S_RFPLL_CTL21, 0x42); + b43_radio_write(dev, B2062_S_RFPLL_CTL21, 0x62); udelay(200); }@@ -1980,7 +1987,7 @@ static int lpphy_b2062_tune(struct b43_wldev *dev, tmp6 = tmp5 / tmp4; tmp7 = tmp5 % tmp4; b43_radio_write(dev, B2062_S_RFPLL_CTL29, tmp6 + ((2 * tmp7) / tmp4)); - tmp8 = b43_phy_read(dev, B2062_S_RFPLL_CTL19); + tmp8 = b43_radio_read(dev, B2062_S_RFPLL_CTL19); tmp9 = ((2 * tmp3 * (tmp8 + 1)) + (3 * tmp1)) / (6 * tmp1); b43_radio_write(dev, B2062_S_RFPLL_CTL23, (tmp9 >> 8) + 16); b43_radio_write(dev, B2062_S_RFPLL_CTL24, tmp9 & 0xFF);@@ -2019,17 +2026,17 @@ static void lpphy_b2063_vco_calib(struct b43_wldev *dev) { u16 tmp; - b43_phy_mask(dev, B2063_PLL_SP1, ~0x40); - tmp = b43_phy_read(dev, B2063_PLL_JTAG_CALNRST) & 0xF8; - b43_phy_write(dev, B2063_PLL_JTAG_CALNRST, tmp); + b43_radio_mask(dev, B2063_PLL_SP1, ~0x40); + tmp = b43_radio_read(dev, B2063_PLL_JTAG_CALNRST) & 0xF8; + b43_radio_write(dev, B2063_PLL_JTAG_CALNRST, tmp); udelay(1); - b43_phy_write(dev, B2063_PLL_JTAG_CALNRST, tmp | 0x4); + b43_radio_write(dev, B2063_PLL_JTAG_CALNRST, tmp | 0x4); udelay(1); - b43_phy_write(dev, B2063_PLL_JTAG_CALNRST, tmp | 0x6); + b43_radio_write(dev, B2063_PLL_JTAG_CALNRST, tmp | 0x6); udelay(1); - b43_phy_write(dev, B2063_PLL_JTAG_CALNRST, tmp | 0x7); + b43_radio_write(dev, B2063_PLL_JTAG_CALNRST, tmp | 0x7); udelay(300); - b43_phy_set(dev, B2063_PLL_SP1, 0x40); + b43_radio_set(dev, B2063_PLL_SP1, 0x40); } static int lpphy_b2063_tune(struct b43_wldev *dev,@@ -2124,31 +2131,31 @@ static int lpphy_b2063_tune(struct b43_wldev *dev, scale = 0; tmp5 = ((tmp4 + (tmp3 >> 1)) / tmp3) - 8; } - b43_phy_maskset(dev, B2063_PLL_JTAG_PLL_CP2, 0xFFC0, tmp5); - b43_phy_maskset(dev, B2063_PLL_JTAG_PLL_CP2, 0xFFBF, scale << 6); + b43_radio_maskset(dev, B2063_PLL_JTAG_PLL_CP2, 0xFFC0, tmp5); + b43_radio_maskset(dev, B2063_PLL_JTAG_PLL_CP2, 0xFFBF, scale << 6); tmp6 = lpphy_qdiv_roundup(100 * val1, val3, 16); tmp6 *= (tmp5 * 8) * (scale + 1); if (tmp6 > 150) tmp6 = 0; - b43_phy_maskset(dev, B2063_PLL_JTAG_PLL_CP3, 0xFFE0, tmp6); - b43_phy_maskset(dev, B2063_PLL_JTAG_PLL_CP3, 0xFFDF, scale << 5); + b43_radio_maskset(dev, B2063_PLL_JTAG_PLL_CP3, 0xFFE0, tmp6); + b43_radio_maskset(dev, B2063_PLL_JTAG_PLL_CP3, 0xFFDF, scale << 5); - b43_phy_maskset(dev, B2063_PLL_JTAG_PLL_XTAL_12, 0xFFFB, 0x4); + b43_radio_maskset(dev, B2063_PLL_JTAG_PLL_XTAL_12, 0xFFFB, 0x4); if (crystal_freq > 26000000) - b43_phy_set(dev, B2063_PLL_JTAG_PLL_XTAL_12, 0x2); + b43_radio_set(dev, B2063_PLL_JTAG_PLL_XTAL_12, 0x2);else
-b43_phy_mask(dev, B2063_PLL_JTAG_PLL_XTAL_12, 0xFD);
+b43_radio_mask(dev, B2063_PLL_JTAG_PLL_XTAL_12, 0xFD);if (val1 == 45)
-b43_phy_set(dev, B2063_PLL_JTAG_PLL_VCO1, 0x2);
+b43_radio_set(dev, B2063_PLL_JTAG_PLL_VCO1, 0x2); else
-b43_phy_mask(dev, B2063_PLL_JTAG_PLL_VCO1, 0xFD);
+b43_radio_mask(dev, B2063_PLL_JTAG_PLL_VCO1, 0xFD);-
b43_phy_set(dev, B2063_PLL_SP2, 0x3);
+b43_radio_set(dev, B2063_PLL_SP2, 0x3); udelay(1);
-b43_phy_mask(dev, B2063_PLL_SP2, 0xFFFC);
+b43_radio_mask(dev, B2063_PLL_SP2, 0xFFFC);lpphy_b2063_vco_calib(dev);b43_radio_write(dev, B2063_COMM15, old_comm15);drivers/net/wireless/b43/phy_lp.c +7
-5@@ -2158,10 +2165,9 @@ static int lpphy_b2063_tune(struct b43_wldev *dev, static int b43_lpphy_op_switch_channel(struct b43_wldev *dev, unsigned int new_channel) { + struct b43_phy_lp *lpphy = dev->phy.lp; int err; - b43_write16(dev, B43_MMIO_CHANNEL, new_channel); - if (dev->phy.radio_ver == 0x2063) { err = lpphy_b2063_tune(dev, new_channel); if (err)@@ -2174,6 +2180,9 @@ static int b43_lpphy_op_switch_channel(struct b43_wldev *dev, lpphy_adjust_gain_table(dev, channel2freq_lp(new_channel)); } + lpphy->channel = new_channel; + b43_write16(dev, B43_MMIO_CHANNEL, new_channel); + return 0; }@@ -2185,10 +2194,9 @@ static int b43_lpphy_op_init(struct b43_wldev *dev) lpphy_baseband_init(dev); lpphy_radio_init(dev); lpphy_calibrate_rc(dev); - err = b43_lpphy_op_switch_channel(dev, - b43_lpphy_op_get_default_chan(dev)); + err = b43_lpphy_op_switch_channel(dev, 7); if (err) { - b43dbg(dev->wl, "Switch to init channel failed, error = %d.\n", + b43dbg(dev->wl, "Switch to channel 7 failed, error = %d.\n", err); } lpphy_tx_pctl_init(dev);@@ -2222,6 +2230,7 @@ const struct b43_phy_operations b43_phyops_lp = { .init = b43_lpphy_op_init, .phy_read = b43_lpphy_op_read, .phy_write = b43_lpphy_op_write, + .phy_maskset = b43_lpphy_op_maskset, .radio_read = b43_lpphy_op_radio_read, .radio_write = b43_lpphy_op_radio_write, .software_rfkill = b43_lpphy_op_software_rfkill,drivers/net/wireless/b43/phy_lp.h +3
-0@@ -888,6 +888,9 @@ struct b43_phy_lp { bool crs_usr_disable, crs_sys_disable; unsigned int pdiv; + + /* The channel we are tuned to */ + u8 channel; }; enum tssi_mux_mode {drivers/net/wireless/b43/tables_lpphy.c +6
-2@@ -624,30 +624,35 @@ u32 b43_lptab_read(struct b43_wldev *dev, u32 offset) void b43_lptab_read_bulk(struct b43_wldev *dev, u32 offset, unsigned int nr_elements, void *_data) { - u32 type, value; + u32 type; u8 *data = _data; unsigned int i; type = offset & B43_LPTAB_TYPEMASK; + offset &= ~B43_LPTAB_TYPEMASK; + B43_WARN_ON(offset > 0xFFFF); + + b43_phy_write(dev, B43_LPPHY_TABLE_ADDR, offset); + for (i = 0; i < nr_elements; i++) { - value = b43_lptab_read(dev, offset); switch (type) {case
B43_LPTAB_8BIT:
- *data = value;
+ *data =b43_phy_read(dev, B43_LPPHY_TABLEDATALO)&0xFF; data++;
break;
caseB43_LPTAB_16BIT:
- *((u16 *)data) = value;
+ *((u16 *)data) =b43_phy_read(dev, B43_LPPHY_TABLEDATALO); data += 2;
break;
caseB43_LPTAB_32BIT:
- *((u32 *)data) = value;
+ *((u32 *)data) =b43_phy_read(dev, B43_LPPHY_TABLEDATAHI);
+ *((u32 *)data) <<= 16;
+ *((u32 *)data) |=b43_phy_read(dev, B43_LPPHY_TABLEDATALO); data += 4;
break;
default:
B43_WARN_ON(1);
}
- offset++;
}
}drivers/net/wireless/b43/tables_lpphy.c +5
-0@@ -688,26 +693,34 @@ void b43_lptab_write_bulk(struct b43_wldev *dev, u32 offset, unsigned int i; type = offset & B43_LPTAB_TYPEMASK; + offset &= ~B43_LPTAB_TYPEMASK; + B43_WARN_ON(offset > 0xFFFF); + + b43_phy_write(dev, B43_LPPHY_TABLE_ADDR, offset); + for (i = 0; i < nr_elements; i++) { switch (type) {case
B43_LPTAB_8BIT:
value = *data;
data++;
+B43_WARN_ON(value & ~0xFF);
+b43_phy_write(dev, B43_LPPHY_TABLEDATALO, value); break;
caseB43_LPTAB_16BIT:
value = *((u16 *)data);
data += 2;
+B43_WARN_ON(value & ~0xFFFF);
+b43_phy_write(dev, B43_LPPHY_TABLEDATALO, value); break;
caseB43_LPTAB_32BIT:
value = *((u32 *)data);
data += 4;
+b43_phy_write(dev, B43_LPPHY_TABLEDATAHI, value >> 16);
+b43_phy_write(dev, B43_LPPHY_TABLEDATALO, value); break;
default:
B43_WARN_ON(1);
- value = 0;
}
-b43_lptab_write(dev, offset, value);
- offset++;
}
}drivers/net/wireless/b43/tables_lpphy.c +22
-24@@ -777,7 +790,7 @@ static const u8 lpphy_pll_fraction_table[] = { 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, }; -static const u16 lpphy_iq_local_table[] = { +static const u16 lpphy_iqlo_cal_table[] = { 0x0200, 0x0300, 0x0400, 0x0600, 0x0800, 0x0b00, 0x1000, 0x1001, 0x1002, 0x1003, 0x1004, 0x1005, 0x1006, 0x1007, 0x1707, 0x2007, 0x2d07, 0x4007, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,@@ -789,10 +802,17 @@ static const u16 lpphy_iq_local_table[] = { 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x4000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, - 0x0000, 0x0000, + 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, }; -static const u16 lpphy_ofdm_cck_gain_table[] = { +static const u16 lpphy_rev0_ofdm_cck_gain_table[] = { + 0x0001, 0x0001, 0x0001, 0x0001, 0x1001, 0x2001, 0x3001, 0x4001, 0x5001, + 0x6001, 0x7001, 0x7011, 0x7021, 0x2035, 0x2045, 0x2055, 0x2065, 0x2075, + 0x006d, 0x007d, 0x014d, 0x015d, 0x115d, 0x035d, 0x135d, 0x055d, 0x155d, + 0x0d5d, 0x1d5d, 0x2d5d, 0x555d, 0x655d, 0x755d, +}; + +static const u16 lpphy_rev1_ofdm_cck_gain_table[] = { 0x5000, 0x6000, 0x7000, 0x0001, 0x1001, 0x2001, 0x3001, 0x4001, 0x5001, 0x6001, 0x7001, 0x7011, 0x7021, 0x2035, 0x2045, 0x2055, 0x2065, 0x2075, 0x006d, 0x007d, 0x014d, 0x015d, 0x115d, 0x035d, 0x135d, 0x055d, 0x155d,@@ -2263,11 +2283,18 @@ void lpphy_rev0_1_table_init(struct b43_wldev *dev) b43_lptab_write_bulk(dev, B43_LPTAB8(6, 0), ARRAY_SIZE(lpphy_pll_fraction_table), lpphy_pll_fraction_table); b43_lptab_write_bulk(dev, B43_LPTAB16(0, 0), - ARRAY_SIZE(lpphy_iq_local_table), lpphy_iq_local_table); - b43_lptab_write_bulk(dev, B43_LPTAB16(13, 0), - ARRAY_SIZE(lpphy_ofdm_cck_gain_table), lpphy_ofdm_cck_gain_table); - b43_lptab_write_bulk(dev, B43_LPTAB16(12, 0), - ARRAY_SIZE(lpphy_ofdm_cck_gain_table), lpphy_ofdm_cck_gain_table); + ARRAY_SIZE(lpphy_iqlo_cal_table), lpphy_iqlo_cal_table); + if (dev->phy.rev == 0) { + b43_lptab_write_bulk(dev, B43_LPTAB16(13, 0), + ARRAY_SIZE(lpphy_rev0_ofdm_cck_gain_table), lpphy_rev0_ofdm_cck_gain_table); + b43_lptab_write_bulk(dev, B43_LPTAB16(12, 0), + ARRAY_SIZE(lpphy_rev0_ofdm_cck_gain_table), lpphy_rev0_ofdm_cck_gain_table); + } else { + b43_lptab_write_bulk(dev, B43_LPTAB16(13, 0), + ARRAY_SIZE(lpphy_rev1_ofdm_cck_gain_table), lpphy_rev1_ofdm_cck_gain_table); + b43_lptab_write_bulk(dev, B43_LPTAB16(12, 0), + ARRAY_SIZE(lpphy_rev1_ofdm_cck_gain_table), lpphy_rev1_ofdm_cck_gain_table); +} b43_lptab_write_bulk(dev, B43_LPTAB16(15, 0), ARRAY_SIZE(lpphy_gain_delta_table), lpphy_gain_delta_table); b43_lptab_write_bulk(dev, B43_LPTAB32(10, 0),@@ -2281,22 +2308,6 @@ void lpphy_rev2plus_table_init(struct b43_wldev *dev) B43_WARN_ON(dev->phy.rev < 2); - /* - * FIXME This code follows the specs, but it looks wrong: - * In each pass, it writes 4 bytes to an offset in table ID 7, - * then increments the offset by 1 for the next pass. This results - * in the first 3 bytes of each pass except the first one getting - * written to a location that has already been zeroed in the previous - * pass. - * This is what the vendor driver does, but it still looks suspicious. - * - * This should probably suffice: - * - * for (i = 0; i < 704; i+=4) - * b43_lptab_write(dev, B43_LPTAB32(7, i), 0) - * - * This should be tested once the code is functional. - */ for (i = 0; i < 704; i++) b43_lptab_write(dev, B43_LPTAB32(7, i), 0);drivers/net/wireless/b43/tables_lpphy.c void lpphy_rev2plus_table_init(struct b43_wldev *dev) · line 2340
Quoted 8 lines
drivers/net/wireless/b43/tables_lpphy.c +1
-1@@ -2323,7 +2334,7 @@ void lpphy_rev2plus_table_init(struct b43_wldev *dev) b43_lptab_write_bulk(dev, B43_LPTAB8(6, 0), ARRAY_SIZE(lpphy_pll_fraction_table), lpphy_pll_fraction_table); b43_lptab_write_bulk(dev, B43_LPTAB16(0, 0), - ARRAY_SIZE(lpphy_iq_local_table), lpphy_iq_local_table); + ARRAY_SIZE(lpphy_iqlo_cal_table), lpphy_iqlo_cal_table); b43_lptab_write_bulk(dev, B43_LPTAB32(9, 0), ARRAY_SIZE(lpphy_papd_eps_table), lpphy_papd_eps_table); b43_lptab_write_bulk(dev, B43_LPTAB32(10, 0),--
Greetings, Michael.
Signature · 1 line
Vista: [V]iruses, [I]ntruders, [S]pyware, [T]rojans and [A]dware. :-)
Re: [PATCH] b43: Fix and update LP-PHY code
Quoted 13 lines · On Wednesday 26 August 2009 22:47:12 Gábor Stefanik wrote:
2009/8/26 Michael Buesch <[email protected]>:
Quoted 11 lines · On Wednesday 26 August 2009 20:51:25 Gábor Stefanik wrote:
Quoted 7 lines
-Fix a few nasty typos (b43_phy_* operations instead of b43_radio_*) in the channel tune routines.
(quoted diff) +0
-2-Fix some typos & spec errors found by MMIO tracing. -Optimize b43_phy_write & b43_phy_mask/set/maskset to useonly the minimal number of MMIO accesses. (Write is possible using a single 32-bit MMIO write, while set/mask/maskset can be done in 3 16-bit MMIOs).
Why does it matter? PHY access is not done in any hotpath. So why not prefer simple code over optimized code?
Quoted 2 lines
This is how the MIPS/hybrid driver does it, I simply updated the code for parity.
I think _if_ we do it (I'm not sure if it's worth it), we should certainly do it in a completely separate patch.
Quoted 9 lines
Quoted 7 lines
Quoted 4 lines
-Set the default channel back to 1, as the bug forcing us to use channel 7 is now fixed.
And, everything in its own patch, please. I don't see a reason for patching unrelated things in one big patch.
Well, this patch is already in wireless-testing, so doing that would
When did I ack it?
Note that I _do_ have a life and I was not able to check mail for the past 9 hours. So please give me an ack latency of one day, at least.
Signature · 1 line
Greetings, Michael.
Re: [PATCH] b43: Fix and update LP-PHY code
In reply to Gábor StefanikQuoted 8 lines · Gábor Stefanik
2009/8/26 Michael Buesch <[email protected]>:
Quoted 2 lines
And, everything in its own patch, please. I don't see a reason for patching unrelated things in one big patch.
Well, this patch is already in wireless-testing, so doing that would now involve reverting this patch, applying a version without the channel change, and applying the channel change - certainly more confusing than the status quo.
But it is not in net-next-2.6. Please submit the patches as Michael requested and I'll take care of the reorganization.
John
Signature · 2 lines
John W. Linville Someday the world will need a hero, and you [email protected] might be all we have. Be ready.
Re: [PATCH] b43: Fix and update LP-PHY code
Quoted 5 lines · On Wednesday 26 August 2009 22:54:03 John W. Linville wrote:
Quoted 4 lines · Gábor Stefanik
2009/8/26 Michael Buesch <[email protected]>:
Quoted 2 lines
And, everything in its own patch, please. I don't see a reason for patching unrelated things in one big patch.
Quoted 7 lines
Quoted 4 lines
Well, this patch is already in wireless-testing, so doing that would now involve reverting this patch, applying a version without the channel change, and applying the channel change - certainly more confusing than the status quo.
But it is not in net-next-2.6. Please submit the patches as Michael requested and I'll take care of the reorganization.
You can leave it as-is. But for the future please make sure to submit independent things in independent patches so they can be discussed and merged independently.
Signature · 1 line
Greetings, Michael.