b43: N-PHY: update rev3+ gain control workarounds

This fixes workarounds on rev 6+ and cleans code slightly.

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/tables_nphy.c b/drivers/net/wireless/b43/tables_nphy.c
index 4b5885077b01bd5b223a3d45868adfc52a744882..f449cffc697b7650b30c98d856a6d2ad8a03da15 100644 (file)
--- a/drivers/net/wireless/b43/tables_nphy.c
+++ b/drivers/net/wireless/b43/tables_nphy.c
@@ -3197,7 +3197,7 @@ static struct nphy_gain_ctl_workaround_entry nphy_gain_ctl_workaround[2][4] = {
                        { 3, 3, 3, 3, 3, 3, 3, 3, 3, 3 },
                        0x527E, /* invalid for external LNA! */
                        { 0x513F, 0x513F, 0x513F, 0x513F }, /* invalid for external LNA! */
-                       0x1076, 0x0066, 0x0000, /* low is invalid (the last one) */
+                       0x007E, 0x0066, 0x0000, /* low is invalid (the last one) */
                        0x18, 0x18, 0x18,
                        0x01D0, 0x5,
                },
@@ -3711,6 +3711,7 @@ const u32 *b43_nphy_get_tx_gain_table(struct b43_wldev *dev)
 struct nphy_gain_ctl_workaround_entry *b43_nphy_get_gain_ctl_workaround_ent(
        struct b43_wldev *dev, bool ghz5, bool ext_lna)
 {
+       struct b43_phy *phy = &dev->phy;
        struct nphy_gain_ctl_workaround_entry *e;
        u8 phy_idx;
 
@@ -3729,37 +3730,49 @@ struct nphy_gain_ctl_workaround_entry *b43_nphy_get_gain_ctl_workaround_ent(
        e = &nphy_gain_ctl_workaround[ghz5][phy_idx];
 
        /* Some workarounds to the workarounds... */
-       if (ghz5 && dev->phy.rev >= 6) {
-               if (dev->phy.radio_rev == 11 &&
-                   !b43_is_40mhz(dev))
-                       e->cliplo_gain = 0x2d;
-       } else if (!ghz5 && dev->phy.rev >= 5) {
-               static const int gain_data[] = {0x0062, 0x0064, 0x006a, 0x106a,
-                                               0x106c, 0x1074, 0x107c, 0x207c};
+       if (!ghz5) {
                u8 tr_iso = dev->dev->bus_sprom->fem.ghz2.tr_iso;
 
-               if (ext_lna) {
+               if (tr_iso > 7)
+                       tr_iso = 3;
+
+               if (phy->rev >= 6) {
+                       static const int gain_data[] = { 0x106a, 0x106c, 0x1074,
+                                                        0x107c, 0x007e, 0x107e,
+                                                        0x207e, 0x307e, };
+
+                       e->cliplo_gain = gain_data[tr_iso];
+               } else if (phy->rev == 5) {
+                       static const int gain_data[] = { 0x0062, 0x0064, 0x006a,
+                                                        0x106a, 0x106c, 0x1074,
+                                                        0x107c, 0x207c, };
+
+                       e->cliplo_gain = gain_data[tr_iso];
+               }
+
+               if (phy->rev >= 5 && ext_lna) {
                        e->rfseq_init[0] &= ~0x4000;
                        e->rfseq_init[1] &= ~0x4000;
                        e->rfseq_init[2] &= ~0x4000;
                        e->rfseq_init[3] &= ~0x4000;
                        e->init_gain &= ~0x4000;
                }
-               if (tr_iso > 7)
-                       tr_iso = 3;
-               e->cliplo_gain = gain_data[tr_iso];
-
-       } else if (ghz5 && dev->phy.rev == 4 && ext_lna) {
-               e->rfseq_init[0] &= ~0x4000;
-               e->rfseq_init[1] &= ~0x4000;
-               e->rfseq_init[2] &= ~0x4000;
-               e->rfseq_init[3] &= ~0x4000;
-               e->init_gain &= ~0x4000;
-               e->rfseq_init[0] |= 0x1000;
-               e->rfseq_init[1] |= 0x1000;
-               e->rfseq_init[2] |= 0x1000;
-               e->rfseq_init[3] |= 0x1000;
-               e->init_gain |= 0x1000;
+       } else {
+               if (phy->rev >= 6) {
+                       if (phy->radio_rev == 11 && !b43_is_40mhz(dev))
+                               e->crsminu = 0x2d;
+               } else if (phy->rev == 4 && ext_lna) {
+                       e->rfseq_init[0] &= ~0x4000;
+                       e->rfseq_init[1] &= ~0x4000;
+                       e->rfseq_init[2] &= ~0x4000;
+                       e->rfseq_init[3] &= ~0x4000;
+                       e->init_gain &= ~0x4000;
+                       e->rfseq_init[0] |= 0x1000;
+                       e->rfseq_init[1] |= 0x1000;
+                       e->rfseq_init[2] |= 0x1000;
+                       e->rfseq_init[3] |= 0x1000;
+                       e->init_gain |= 0x1000;
+               }
        }
 
        return e;