fa732c97a6132f2590d983ad8a6463e2cebd068a
[openwrt/staging/hauke.git] / package / kernel / mac80211 / patches / rt2x00 / 984-rt2x00-add-RXDCOC-calibration.patch
1 From 865823b63f608ac024d326a465ba8fc1a28868cd Mon Sep 17 00:00:00 2001
2 From: Daniel Golle <daniel@makrotopia.org>
3 Date: Mon, 8 Jan 2018 13:43:37 +0100
4 Subject: [PATCH 06/16] rt2x00: add RXDCOC calibration for MT7620
5 MIME-Version: 1.0
6 Content-Type: text/plain; charset=UTF-8
7 Content-Transfer-Encoding: 8bit
8 To: linux-wireless@vger.kernel.org,
9 Stanislaw Gruszka <stf_xl@wp.pl>,
10 Helmut Schaa <helmut.schaa@googlemail.com>
11 Cc: Kalle Valo <kvalo@kernel.org>,
12 David S. Miller <davem@davemloft.net>,
13 Eric Dumazet <edumazet@google.com>,
14 Jakub Kicinski <kuba@kernel.org>,
15 Paolo Abeni <pabeni@redhat.com>,
16 Johannes Berg <johannes.berg@intel.com>
17
18 From: Tomislav Požega <pozega.tomislav@gmail.com>
19
20 Add RXDCOC calibration code from mtk driver.
21
22 Signed-off-by: Daniel Golle <daniel@makrotopia.org>
23 [fixed typo reported by Serge Vasilugin <vasilugin@yandex.ru>]
24 Signed-off-by: Tomislav Požega <pozega.tomislav@gmail.com>
25 ---
26 .../net/wireless/ralink/rt2x00/rt2800lib.c | 65 +++++++++++++++++++
27 1 file changed, 65 insertions(+)
28
29 --- a/drivers/net/wireless/ralink/rt2x00/rt2800lib.c
30 +++ b/drivers/net/wireless/ralink/rt2x00/rt2800lib.c
31 @@ -8632,6 +8632,70 @@ static void rt2800_r_calibration(struct
32 rt2800_register_write(rt2x00dev, PWR_PIN_CFG, MAC_PWR_PIN_CFG);
33 }
34
35 +static void rt2800_rxdcoc_calibration(struct rt2x00_dev *rt2x00dev)
36 +{
37 + u8 bbpreg = 0;
38 + u32 macvalue = 0, macvalue1 = 0;
39 + u8 saverfb0r2, saverfb5r4, saverfb7r4, rfvalue;
40 + int i;
41 +
42 + saverfb0r2 = rt2800_rfcsr_read_bank(rt2x00dev, 0, 2);
43 + rfvalue = saverfb0r2;
44 + rfvalue |= 0x03;
45 + rt2800_rfcsr_write_bank(rt2x00dev, 0, 2, rfvalue);
46 +
47 + rt2800_bbp_write(rt2x00dev, 158, 141);
48 + bbpreg = rt2800_bbp_read(rt2x00dev, 159);
49 + bbpreg |= 0x10;
50 + rt2800_bbp_write(rt2x00dev, 159, bbpreg);
51 +
52 + macvalue = rt2800_register_read(rt2x00dev, MAC_SYS_CTRL);
53 + rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, 0x8);
54 +
55 + for (i = 0; i < 10000; i++) {
56 + macvalue1 = rt2800_register_read(rt2x00dev, MAC_STATUS_CFG);
57 + if (macvalue1 & 0x1)
58 + usleep_range(50, 100);
59 + else
60 + break;
61 + }
62 +
63 + saverfb5r4 = rt2800_rfcsr_read_bank(rt2x00dev, 5, 4);
64 + saverfb7r4 = rt2800_rfcsr_read_bank(rt2x00dev, 7, 4);
65 + saverfb5r4 = saverfb5r4 & (~0x40);
66 + saverfb7r4 = saverfb7r4 & (~0x40);
67 + rt2800_rfcsr_write_dccal(rt2x00dev, 4, 0x64);
68 + rt2800_rfcsr_write_bank(rt2x00dev, 5, 4, saverfb5r4);
69 + rt2800_rfcsr_write_bank(rt2x00dev, 7, 4, saverfb7r4);
70 +
71 + rt2800_bbp_write(rt2x00dev, 158, 141);
72 + bbpreg = rt2800_bbp_read(rt2x00dev, 159);
73 + bbpreg = bbpreg & (~0x40);
74 + rt2800_bbp_write(rt2x00dev, 159, bbpreg);
75 + bbpreg |= 0x48;
76 + rt2800_bbp_write(rt2x00dev, 159, bbpreg);
77 +
78 + for (i = 0; i < 10000; i++) {
79 + bbpreg = rt2800_bbp_read(rt2x00dev, 159);
80 + if ((bbpreg & 0x40) == 0)
81 + break;
82 + usleep_range(50, 100);
83 + }
84 +
85 + bbpreg = rt2800_bbp_read(rt2x00dev, 159);
86 + bbpreg = bbpreg & (~0x40);
87 + rt2800_bbp_write(rt2x00dev, 159, bbpreg);
88 +
89 + rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, macvalue);
90 +
91 + rt2800_bbp_write(rt2x00dev, 158, 141);
92 + bbpreg = rt2800_bbp_read(rt2x00dev, 159);
93 + bbpreg &= (~0x10);
94 + rt2800_bbp_write(rt2x00dev, 159, bbpreg);
95 +
96 + rt2800_rfcsr_write_bank(rt2x00dev, 0, 2, saverfb0r2);
97 +}
98 +
99 static void rt2800_bbp_core_soft_reset(struct rt2x00_dev *rt2x00dev,
100 bool set_bw, bool is_ht40)
101 {
102 @@ -9241,6 +9305,7 @@ static void rt2800_init_rfcsr_6352(struc
103
104 rt2800_r_calibration(rt2x00dev);
105 rt2800_rf_self_txdc_cal(rt2x00dev);
106 + rt2800_rxdcoc_calibration(rt2x00dev);
107 rt2800_bw_filter_calibration(rt2x00dev, true);
108 rt2800_bw_filter_calibration(rt2x00dev, false);
109 }