b43: N-PHY: workaround broken auto-increment on BCM43224

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

1 files changed, 6 insertions, 0 deletions

diff --git a/drivers/net/wireless/b43/tables_nphy.c b/drivers/net/wireless/b43/tables_nphy.c
index e1fc337df84b..3252560e9fa1 100644
--- a/drivers/net/wireless/b43/tables_nphy.c
+++ b/drivers/net/wireless/b43/tables_nphy.c
@@ -2905,6 +2905,12 @@ void b43_ntab_read_bulk(struct b43_wldev *dev, u32 offset,
         b43_phy_write(dev, B43_NPHY_TABLE_ADDR, offset);
 
         for (i = 0; i < nr_elements; i++) {
+                /* Auto increment broken + caching issue on BCM43224? */
+                if (dev->dev->chip_id == 43224 && dev->dev->chip_rev == 1) {
+                        b43_phy_read(dev, B43_NPHY_TABLE_DATALO);
+                        b43_phy_write(dev, B43_NPHY_TABLE_ADDR, offset + i);
+                }
+
                 switch (type) {
                 case B43_NTAB_8BIT:
                         *data = b43_phy_read(dev, B43_NPHY_TABLE_DATALO) & 0xFF;