mac80211: rt2x00: add RXDCOC calibration

Add RXDCOC calibration code from mtk driver. Please try if this makes any difference among various board/RF layouts.

Signed-off-by: Tomislav Požega <pozega.tomislav@gmail.com>

diff --git a/package/kernel/mac80211/patches/rt2x00/984-rt2x00-add-rxdcoc-calibration.patch b/package/kernel/mac80211/patches/rt2x00/984-rt2x00-add-rxdcoc-calibration.patch
new file mode 100644 (file)
index 0000000..ac48383
--- /dev/null
+++ b/package/kernel/mac80211/patches/rt2x00/984-rt2x00-add-rxdcoc-calibration.patch
@@ -0,0 +1,102 @@
+--- a/drivers/net/wireless/ralink/rt2x00/rt2800lib.c
++++ b/drivers/net/wireless/ralink/rt2x00/rt2800lib.c
+@@ -7858,6 +7858,71 @@ void rt2800_r_calibration(struct rt2x00_
+ }
+ EXPORT_SYMBOL_GPL(rt2800_r_calibration);
+ 
++void rt2800_rxdcoc_calibration(struct rt2x00_dev *rt2x00dev)
++{
++      u8 bbpreg = 0;
++      u32 macvalue = 0, macvalue1 = 0;
++      u8 saverfb0r2, saverfb5r4, saverfb7r4, rfvalue;
++      int i;
++
++      saverfb0r2 = rt2800_rfcsr_read_bank(rt2x00dev, 0, 2);
++      rfvalue = saverfb0r2;
++      rfvalue |= 0x03;
++      rt2800_rfcsr_write_bank(rt2x00dev, 0, 2, rfvalue);
++
++      rt2800_bbp_write(rt2x00dev, 158, 141);
++      bbpreg = rt2800_bbp_read(rt2x00dev, 159);
++      bbpreg |= 0x10;
++      rt2800_bbp_write(rt2x00dev, 159, bbpreg);
++
++      macvalue = rt2800_register_read(rt2x00dev, MAC_SYS_CTRL);
++      rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, 0x8);
++
++      for (i = 0; i < 10000; i++) {
++              macvalue1 = rt2800_register_read(rt2x00dev, MAC_STATUS_CFG);
++              if (macvalue1 & 0x1)
++                      udelay(50);
++              else
++                      break;
++      }
++
++      saverfb5r4 = rt2800_rfcsr_read_bank(rt2x00dev, 5, 0);
++      saverfb7r4 = rt2800_rfcsr_read_bank(rt2x00dev, 7, 4);
++      saverfb5r4 = saverfb5r4 & (~0x40);
++      saverfb7r4 = saverfb7r4 & (~0x40);
++      rt2800_rfcsr_write_dccal(rt2x00dev, 4, 0x64);
++      rt2800_rfcsr_write_bank(rt2x00dev, 5, 4, saverfb5r4);
++      rt2800_rfcsr_write_bank(rt2x00dev, 7, 4, saverfb7r4);
++
++      rt2800_bbp_write(rt2x00dev, 158, 141);
++      bbpreg = rt2800_bbp_read(rt2x00dev, 159);
++      bbpreg = bbpreg & (~0x40);
++      rt2800_bbp_write(rt2x00dev, 159, bbpreg);
++      bbpreg |= 0x48;
++      rt2800_bbp_write(rt2x00dev, 159, bbpreg);
++
++      for (i = 0; i < 10000; i++) {
++              bbpreg = rt2800_bbp_read(rt2x00dev, 159);
++              if ((bbpreg & 0x40)==0)
++                      break;
++              udelay(50);
++      }
++
++      bbpreg = rt2800_bbp_read(rt2x00dev, 159);
++      bbpreg = bbpreg & (~0x40);
++      rt2800_bbp_write(rt2x00dev, 159, bbpreg);
++
++      rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, macvalue);
++
++      rt2800_bbp_write(rt2x00dev, 158, 141);
++      bbpreg = rt2800_bbp_read(rt2x00dev, 159);
++      bbpreg &= (~0x10);
++      rt2800_bbp_write(rt2x00dev, 159, bbpreg);
++
++      rt2800_rfcsr_write_bank(rt2x00dev, 0, 2, saverfb0r2);
++}
++EXPORT_SYMBOL_GPL(rt2800_rxdcoc_calibration);
++
+ static void rt2800_bbp_core_soft_reset(struct rt2x00_dev *rt2x00dev,
+                                      bool set_bw, bool is_ht40)
+ {
+@@ -8467,6 +8532,7 @@ static void rt2800_init_rfcsr_6352(struc
+ 
+       rt2800_r_calibration(rt2x00dev);
+       rt2800_rf_self_txdc_cal(rt2x00dev);
++      rt2800_rxdcoc_calibration(rt2x00dev);
+       rt2800_bw_filter_calibration(rt2x00dev, true);
+       rt2800_bw_filter_calibration(rt2x00dev, false);
+ }
+--- a/drivers/net/wireless/ralink/rt2x00/rt2800lib.h
++++ b/drivers/net/wireless/ralink/rt2x00/rt2800lib.h
+@@ -230,6 +230,7 @@ void rt2800_vco_calibration(struct rt2x0
+ void rt2800_rf_self_txdc_cal(struct rt2x00_dev *rt2x00dev);
+ int rt2800_calcrcalibrationcode(struct rt2x00_dev *rt2x00dev, int d1, int d2);
+ void rt2800_r_calibration(struct rt2x00_dev *rt2x00dev);
++void rt2800_rxdcoc_calibration(struct rt2x00_dev *rt2x00dev);
+ 
+ int rt2800_enable_radio(struct rt2x00_dev *rt2x00dev);
+ void rt2800_disable_radio(struct rt2x00_dev *rt2x00dev);
+--- a/drivers/net/wireless/ralink/rt2x00/rt2x00.h
++++ b/drivers/net/wireless/ralink/rt2x00/rt2x00.h
+@@ -573,6 +573,7 @@ struct rt2x00lib_ops {
+       void (*rf_self_txdc_cal) (struct rt2x00_dev *rt2x00dev);
+       int (*calcrcalibrationcode) (struct rt2x00_dev *rt2x00dev, int d1, int d2);
+       void (*r_calibration) (struct rt2x00_dev *rt2x00dev);
++      void (*rxdcoc_calibration) (struct rt2x00_dev *rt2x00dev);
+ 
+       /*
+        * Data queue handlers.