Search Linux Wireless

Re: [PATCH] b43: Fix and update LP-PHY code

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



2009/8/26 Michael Buesch <mb@xxxxxxxxx>:
> On Wednesday 26 August 2009 20:51:25 Gábor Stefanik wrote:
>> -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?

This is how the MIPS/hybrid driver does it, I simply updated the code
for parity.

>
>> -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.

>
>>
>> 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 <netrolller.3d@xxxxxxxxx>
>> ---
>>  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(-)
>>
>> diff --git a/drivers/net/wireless/b43/phy_common.c b/drivers/net/wireless/b43/phy_common.c
>> index 51686ec..6e704be 100644
>> --- a/drivers/net/wireless/b43/phy_common.c
>> +++ b/drivers/net/wireless/b43/phy_common.c
>> @@ -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)
>> diff --git a/drivers/net/wireless/b43/phy_common.h b/drivers/net/wireless/b43/phy_common.h
>> index 9f9f23c..b47a0f5 100644
>> --- a/drivers/net/wireless/b43/phy_common.h
>> +++ b/drivers/net/wireless/b43/phy_common.h
>> @@ -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);
>>
>> diff --git a/drivers/net/wireless/b43/phy_lp.c b/drivers/net/wireless/b43/phy_lp.c
>> index 5306f2c..1a57d33 100644
>> --- a/drivers/net/wireless/b43/phy_lp.c
>> +++ b/drivers/net/wireless/b43/phy_lp.c
>> @@ -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,
>> diff --git a/drivers/net/wireless/b43/phy_lp.h b/drivers/net/wireless/b43/phy_lp.h
>> index e158d1f..c3232c1 100644
>> --- a/drivers/net/wireless/b43/phy_lp.h
>> +++ b/drivers/net/wireless/b43/phy_lp.h
>> @@ -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 {
>> diff --git a/drivers/net/wireless/b43/tables_lpphy.c b/drivers/net/wireless/b43/tables_lpphy.c
>> index 60d472f..c784def 100644
>> --- a/drivers/net/wireless/b43/tables_lpphy.c
>> +++ b/drivers/net/wireless/b43/tables_lpphy.c
>> @@ -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),
>
>
>
> --
> Greetings, Michael.
>



-- 
Vista: [V]iruses, [I]ntruders, [S]pyware, [T]rojans and [A]dware. :-)
--
To unsubscribe from this list: send the line "unsubscribe linux-wireless" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html

[Index of Archives]     [Linux Host AP]     [ATH6KL]     [Linux Bluetooth]     [Linux Netdev]     [Kernel Newbies]     [Linux Kernel]     [IDE]     [Security]     [Git]     [Netfilter]     [Bugtraq]     [Yosemite News]     [MIPS Linux]     [ARM Linux]     [Linux Security]     [Linux RAID]     [Linux ATA RAID]     [Samba]     [Device Mapper]
  Powered by Linux