b43: LCN-PHY: set TX filters

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_lcn.c b/drivers/net/wireless/b43/phy_lcn.c
index 06d8efc..7650364 100644 (file)
--- a/drivers/net/wireless/b43/phy_lcn.c
+++ b/drivers/net/wireless/b43/phy_lcn.c
@@ -37,6 +37,11 @@
 #include "tables_phy_lcn.h"
 #include "main.h"
 
+struct lcn_tx_iir_filter {
+       u8 type;
+       u16 values[16];
+};
+
 /**************************************************
  * Radio 2064.
  **************************************************/
@@ -282,6 +287,86 @@ static void b43_phy_lcn_sense_setup(struct b43_wldev *dev)
        b43_radio_write(dev, 0x4a4, save_radio_4a4);
 }
 
+static bool b43_phy_lcn_load_tx_iir_cck_filter(struct b43_wldev *dev,
+                                              u8 filter_type)
+{
+       int i, j;
+       u16 phy_regs[] = { 0x910, 0x91e, 0x91f, 0x924, 0x925, 0x926, 0x920,
+                          0x921, 0x927, 0x928, 0x929, 0x922, 0x923, 0x930,
+                          0x931, 0x932 };
+       /* Table is from brcmsmac, values for type 25 were outdated, probably
+        * others need updating too */
+       struct lcn_tx_iir_filter tx_iir_filters_cck[] = {
+               { 0,  { 1, 415, 1874, 64, 128, 64, 792, 1656, 64, 128, 64, 778,
+                       1582, 64, 128, 64 } },
+               { 1,  { 1, 402, 1847, 259, 59, 259, 671, 1794, 68, 54, 68, 608,
+                       1863, 93, 167, 93 } },
+               { 2,  { 1, 415, 1874, 64, 128, 64, 792, 1656, 192, 384, 192,
+                       778, 1582, 64, 128, 64 } },
+               { 3,  { 1, 302, 1841, 129, 258, 129, 658, 1720, 205, 410, 205,
+                       754, 1760, 170, 340, 170 } },
+               { 20, { 1, 360, 1884, 242, 1734, 242, 752, 1720, 205, 1845, 205,
+                       767, 1760, 256, 185, 256 } },
+               { 21, { 1, 360, 1884, 149, 1874, 149, 752, 1720, 205, 1883, 205,
+                       767, 1760, 256, 273, 256 } },
+               { 22, { 1, 360, 1884, 98, 1948, 98, 752, 1720, 205, 1924, 205,
+                       767, 1760, 256, 352, 256 } },
+               { 23, { 1, 350, 1884, 116, 1966, 116, 752, 1720, 205, 2008, 205,
+                       767, 1760, 128, 233, 128 } },
+               { 24, { 1, 325, 1884, 32, 40, 32, 756, 1720, 256, 471, 256, 766,
+                       1760, 256, 1881, 256 } },
+               { 25, { 1, 299, 1884, 51, 64, 51, 736, 1720, 256, 471, 256, 765,
+                       1760, 262, 1878, 262 } },
+               /* brcmsmac version { 25, { 1, 299, 1884, 51, 64, 51, 736, 1720,
+                * 256, 471, 256, 765, 1760, 256, 1881, 256 } }, */
+               { 26, { 1, 277, 1943, 39, 117, 88, 637, 1838, 64, 192, 144, 614,
+                       1864, 128, 384, 288 } },
+               { 27, { 1, 245, 1943, 49, 147, 110, 626, 1838, 256, 768, 576,
+                       613, 1864, 128, 384, 288 } },
+               { 30, { 1, 302, 1841, 61, 122, 61, 658, 1720, 205, 410, 205,
+                       754, 1760, 170, 340, 170 } },
+       };
+
+       for (i = 0; i < ARRAY_SIZE(tx_iir_filters_cck); i++) {
+               if (tx_iir_filters_cck[i].type == filter_type) {
+                       for (j = 0; j < 16; j++)
+                               b43_phy_write(dev, phy_regs[j],
+                                             tx_iir_filters_cck[i].values[j]);
+                       return true;
+               }
+       }
+
+       return false;
+}
+
+static bool b43_phy_lcn_load_tx_iir_ofdm_filter(struct b43_wldev *dev,
+                                               u8 filter_type)
+{
+       int i, j;
+       u16 phy_regs[] = { 0x90f, 0x900, 0x901, 0x906, 0x907, 0x908, 0x902,
+                          0x903, 0x909, 0x90a, 0x90b, 0x904, 0x905, 0x90c,
+                          0x90d, 0x90e };
+       struct lcn_tx_iir_filter tx_iir_filters_ofdm[] = {
+               { 0, { 0, 0xa2, 0x0, 0x100, 0x100, 0x0, 0x0, 0x0, 0x100, 0x0,
+                      0x0, 0x278, 0xfea0, 0x80, 0x100, 0x80 } },
+               { 1, { 0, 374, 0xFF79, 16, 32, 16, 799, 0xFE74, 50, 32, 50, 750,
+                      0xFE2B, 212, 0xFFCE, 212 } },
+               { 2, { 0, 375, 0xFF16, 37, 76, 37, 799, 0xFE74, 32, 20, 32, 748,
+                      0xFEF2, 128, 0xFFE2, 128 } },
+       };
+
+       for (i = 0; i < ARRAY_SIZE(tx_iir_filters_ofdm); i++) {
+               if (tx_iir_filters_ofdm[i].type == filter_type) {
+                       for (j = 0; j < 16; j++)
+                               b43_phy_write(dev, phy_regs[j],
+                                             tx_iir_filters_ofdm[i].values[j]);
+                       return true;
+               }
+       }
+
+       return false;
+}
+
 /**************************************************
  * Channel switching ops.
  **************************************************/
@@ -329,6 +414,12 @@ static int b43_phy_lcn_set_channel(struct b43_wldev *dev,
                                   struct ieee80211_channel *channel,
                                   enum nl80211_channel_type channel_type)
 {
+       static const u16 sfo_cfg[14][2] = {
+               {965, 1087}, {967, 1085}, {969, 1082}, {971, 1080}, {973, 1078},
+               {975, 1076}, {977, 1073}, {979, 1071}, {981, 1069}, {983, 1067},
+               {985, 1065}, {987, 1063}, {989, 1060}, {994, 1055},
+       };
+
        b43_phy_lcn_set_channel_tweaks(dev, channel->hw_value);
 
        b43_phy_set(dev, 0x44a, 0x44);
@@ -339,7 +430,21 @@ static int b43_phy_lcn_set_channel(struct b43_wldev *dev,
 
        b43_phy_lcn_afe_set_unset(dev);
 
-       /* TODO */
+       b43_phy_write(dev, 0x657, sfo_cfg[channel->hw_value - 1][0]);
+       b43_phy_write(dev, 0x658, sfo_cfg[channel->hw_value - 1][1]);
+
+       if (channel->hw_value == 14) {
+               b43_phy_maskset(dev, 0x448, ~(0x3 << 8), (2) << 8);
+               b43_phy_lcn_load_tx_iir_cck_filter(dev, 3);
+       } else {
+               b43_phy_maskset(dev, 0x448, ~(0x3 << 8), (1) << 8);
+               /* brcmsmac uses filter_type 2, we follow wl with 25 */
+               b43_phy_lcn_load_tx_iir_cck_filter(dev, 25);
+       }
+       /* brcmsmac uses filter_type 2, we follow wl with 0 */
+       b43_phy_lcn_load_tx_iir_ofdm_filter(dev, 0);
+
+       b43_phy_maskset(dev, 0x4eb, ~(0x7 << 3), 0x1 << 3);
 
        return 0;
 }