b43: HT-PHY: init: zero EXTG registers

Signed-off-by: Rafał Miłecki <zajec5@gmail.com>
Signed-off-by: John W. Linville <linville@tuxdriver.com>

diff --git a/drivers/net/wireless/b43/phy_ht.c b/drivers/net/wireless/b43/phy_ht.c
index 7c40919651a741d5eca93cf9d447275591a425e0..99b3035d48ecfe48fc494d87d7854aa8d9505f17 100644 (file)
--- a/drivers/net/wireless/b43/phy_ht.c
+++ b/drivers/net/wireless/b43/phy_ht.c
@@ -151,6 +151,24 @@ static void b43_radio_2059_init(struct b43_wldev *dev)
        b43_radio_mask(dev, 0x11, ~0x0008);
 }
 
+/**************************************************
+ * Various PHY ops
+ **************************************************/
+
+static void b43_phy_ht_zero_extg(struct b43_wldev *dev)
+{
+       u8 i, j;
+       u16 base[] = { 0x40, 0x60, 0x80 };
+
+       for (i = 0; i < ARRAY_SIZE(base); i++) {
+               for (j = 0; j < 4; j++)
+                       b43_phy_write(dev, B43_PHY_EXTG(base[i] + j), 0);
+       }
+
+       for (i = 0; i < ARRAY_SIZE(base); i++)
+               b43_phy_write(dev, B43_PHY_EXTG(base[i] + 0xc), 0);
+}
+
 /**************************************************
  * Channel switching ops.
  **************************************************/
@@ -257,6 +275,10 @@ static int b43_phy_ht_op_init(struct b43_wldev *dev)
 {
        b43_phy_ht_tables_init(dev);
 
+       /* TODO: PHY ops on regs 0x0be, 0x23f 0x240 0x241 */
+
+       b43_phy_ht_zero_extg(dev);
+
        return 0;
 }