1 files changed, 104 insertions, 24 deletions

diff --git a/drivers/net/wireless/b43/tables_nphy.c b/drivers/net/wireless/b43/tables_nphy.c
index 4b5885077b01..25d1cbd34306 100644
--- a/drivers/net/wireless/b43/tables_nphy.c
+++ b/drivers/net/wireless/b43/tables_nphy.c
@@ -2878,6 +2878,40 @@ const s8 b43_ntab_papd_pga_gain_delta_ipa_2g[] = {
         -54, -46, -39, -31, -23, -15, -8, 0
 };
 
+/* Extracted from MMIO dump of 6.30.223.248
+ * Entries: 0, 15, 17, 21, 24, 26, 27, 29, 30 were guessed
+ */
+static const s16 b43_ntab_rf_pwr_offset_2057_rev9_2g[] = {
+        -133, -133, -107, -92, -81,
+        -73, -66, -61, -56, -52,
+        -48, -44, -41, -37, -34,
+        -31, -28, -25, -22, -19,
+        -17, -14, -12, -10, -9,
+        -7, -5, -4, -3, -2,
+        -1, 0,
+};
+
+/* Extracted from MMIO dump of 6.30.223.248 */
+static const s16 b43_ntab_rf_pwr_offset_2057_rev9_5g[] = {
+        -101, -94, -86, -79, -72,
+        -65, -57, -50, -42, -35,
+        -28, -21, -16, -9, -4,
+        0,
+};
+
+/* Extracted from MMIO dump of 6.30.223.248
+ * Entries: 0, 26, 28, 29, 30, 31 were guessed
+ */
+static const s16 b43_ntab_rf_pwr_offset_2057_rev14_2g[] = {
+        -111, -111, -111, -84, -70,
+        -59, -52, -45, -40, -36,
+        -32, -29, -26, -23, -21,
+        -18, -16, -15, -13, -11,
+        -10, -8, -7, -6, -5,
+        -4, -4, -3, -3, -2,
+        -2, -1,
+};
+
 const u16 tbl_iqcal_gainparams[2][9][8] = {
         {
                 { 0x000, 0, 0, 2, 0x69, 0x69, 0x69, 0x69 },
@@ -3197,7 +3231,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,
                 },
@@ -3708,9 +3742,43 @@ const u32 *b43_nphy_get_tx_gain_table(struct b43_wldev *dev)
         }
 }
 
+const s16 *b43_ntab_get_rf_pwr_offset_table(struct b43_wldev *dev)
+{
+        struct b43_phy *phy = &dev->phy;
+
+        if (b43_current_band(dev->wl) == IEEE80211_BAND_2GHZ) {
+                switch (phy->rev) {
+                case 17:
+                        if (phy->radio_rev == 14)
+                                return b43_ntab_rf_pwr_offset_2057_rev14_2g;
+                        break;
+                case 16:
+                        if (phy->radio_rev == 9)
+                                return b43_ntab_rf_pwr_offset_2057_rev9_2g;
+                        break;
+                }
+
+                b43err(dev->wl,
+                       "No 2GHz RF power table available for this device\n");
+                return NULL;
+        } else {
+                switch (phy->rev) {
+                case 16:
+                        if (phy->radio_rev == 9)
+                                return b43_ntab_rf_pwr_offset_2057_rev9_5g;
+                        break;
+                }
+
+                b43err(dev->wl,
+                       "No 5GHz RF power table available for this device\n");
+                return NULL;
+        }
+}
+
 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 +3797,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;