821af87ec18f27077946b0d0f1e1128ba9f55a0f
[openwrt/staging/noltari.git] / package / kernel / mac80211 / patches / rt2x00 / 984-rt2x00-add-RXDCOC-calibration.patch
1 From: =?UTF-8?q?Tomislav=20Po=C5=BEega?= <pozega.tomislav@gmail.com>
2 Date: Mon, 8 Jan 2018 13:43:37 +0100
3 Subject: [PATCH] rt2x00: add RXDCOC calibration
4 MIME-Version: 1.0
5 Content-Type: text/plain; charset=UTF-8
6 Content-Transfer-Encoding: 8bit
7
8 Add RXDCOC calibration code from mtk driver.
9
10 Signed-off-by: Tomislav Požega <pozega.tomislav@gmail.com>
11 ---
12 .../net/wireless/ralink/rt2x00/rt2800lib.c | 65 +++++++++++++++++++
13 1 file changed, 65 insertions(+)
14
15 --- a/drivers/net/wireless/ralink/rt2x00/rt2800lib.c
16 +++ b/drivers/net/wireless/ralink/rt2x00/rt2800lib.c
17 @@ -8637,6 +8637,70 @@ static void rt2800_r_calibration(struct
18 rt2800_register_write(rt2x00dev, PWR_PIN_CFG, MAC_PWR_PIN_CFG);
19 }
20
21 +static void rt2800_rxdcoc_calibration(struct rt2x00_dev *rt2x00dev)
22 +{
23 + u8 bbpreg = 0;
24 + u32 macvalue = 0, macvalue1 = 0;
25 + u8 saverfb0r2, saverfb5r4, saverfb7r4, rfvalue;
26 + int i;
27 +
28 + saverfb0r2 = rt2800_rfcsr_read_bank(rt2x00dev, 0, 2);
29 + rfvalue = saverfb0r2;
30 + rfvalue |= 0x03;
31 + rt2800_rfcsr_write_bank(rt2x00dev, 0, 2, rfvalue);
32 +
33 + rt2800_bbp_write(rt2x00dev, 158, 141);
34 + bbpreg = rt2800_bbp_read(rt2x00dev, 159);
35 + bbpreg |= 0x10;
36 + rt2800_bbp_write(rt2x00dev, 159, bbpreg);
37 +
38 + macvalue = rt2800_register_read(rt2x00dev, MAC_SYS_CTRL);
39 + rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, 0x8);
40 +
41 + for (i = 0; i < 10000; i++) {
42 + macvalue1 = rt2800_register_read(rt2x00dev, MAC_STATUS_CFG);
43 + if (macvalue1 & 0x1)
44 + udelay(50);
45 + else
46 + break;
47 + }
48 +
49 + saverfb5r4 = rt2800_rfcsr_read_bank(rt2x00dev, 5, 0);
50 + saverfb7r4 = rt2800_rfcsr_read_bank(rt2x00dev, 7, 4);
51 + saverfb5r4 = saverfb5r4 & (~0x40);
52 + saverfb7r4 = saverfb7r4 & (~0x40);
53 + rt2800_rfcsr_write_dccal(rt2x00dev, 4, 0x64);
54 + rt2800_rfcsr_write_bank(rt2x00dev, 5, 4, saverfb5r4);
55 + rt2800_rfcsr_write_bank(rt2x00dev, 7, 4, saverfb7r4);
56 +
57 + rt2800_bbp_write(rt2x00dev, 158, 141);
58 + bbpreg = rt2800_bbp_read(rt2x00dev, 159);
59 + bbpreg = bbpreg & (~0x40);
60 + rt2800_bbp_write(rt2x00dev, 159, bbpreg);
61 + bbpreg |= 0x48;
62 + rt2800_bbp_write(rt2x00dev, 159, bbpreg);
63 +
64 + for (i = 0; i < 10000; i++) {
65 + bbpreg = rt2800_bbp_read(rt2x00dev, 159);
66 + if ((bbpreg & 0x40)==0)
67 + break;
68 + udelay(50);
69 + }
70 +
71 + bbpreg = rt2800_bbp_read(rt2x00dev, 159);
72 + bbpreg = bbpreg & (~0x40);
73 + rt2800_bbp_write(rt2x00dev, 159, bbpreg);
74 +
75 + rt2800_register_write(rt2x00dev, MAC_SYS_CTRL, macvalue);
76 +
77 + rt2800_bbp_write(rt2x00dev, 158, 141);
78 + bbpreg = rt2800_bbp_read(rt2x00dev, 159);
79 + bbpreg &= (~0x10);
80 + rt2800_bbp_write(rt2x00dev, 159, bbpreg);
81 +
82 + rt2800_rfcsr_write_bank(rt2x00dev, 0, 2, saverfb0r2);
83 +}
84 +
85 static void rt2800_bbp_core_soft_reset(struct rt2x00_dev *rt2x00dev,
86 bool set_bw, bool is_ht40)
87 {
88 @@ -9246,6 +9310,7 @@ static void rt2800_init_rfcsr_6352(struc
89
90 rt2800_r_calibration(rt2x00dev);
91 rt2800_rf_self_txdc_cal(rt2x00dev);
92 + rt2800_rxdcoc_calibration(rt2x00dev);
93 rt2800_bw_filter_calibration(rt2x00dev, true);
94 rt2800_bw_filter_calibration(rt2x00dev, false);
95 }