1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /* Copyright(c) 2018-2019 Realtek Corporation
3 */
4
5 #include <linux/module.h>
6 #include "main.h"
7 #include "coex.h"
8 #include "fw.h"
9 #include "tx.h"
10 #include "rx.h"
11 #include "phy.h"
12 #include "rtw8723d.h"
13 #include "rtw8723d_table.h"
14 #include "mac.h"
15 #include "reg.h"
16 #include "debug.h"
17
18 static const struct rtw_hw_reg rtw8723d_txagc[] = {
19 [DESC_RATE1M] = { .addr = 0xe08, .mask = 0x0000ff00 },
20 [DESC_RATE2M] = { .addr = 0x86c, .mask = 0x0000ff00 },
21 [DESC_RATE5_5M] = { .addr = 0x86c, .mask = 0x00ff0000 },
22 [DESC_RATE11M] = { .addr = 0x86c, .mask = 0xff000000 },
23 [DESC_RATE6M] = { .addr = 0xe00, .mask = 0x000000ff },
24 [DESC_RATE9M] = { .addr = 0xe00, .mask = 0x0000ff00 },
25 [DESC_RATE12M] = { .addr = 0xe00, .mask = 0x00ff0000 },
26 [DESC_RATE18M] = { .addr = 0xe00, .mask = 0xff000000 },
27 [DESC_RATE24M] = { .addr = 0xe04, .mask = 0x000000ff },
28 [DESC_RATE36M] = { .addr = 0xe04, .mask = 0x0000ff00 },
29 [DESC_RATE48M] = { .addr = 0xe04, .mask = 0x00ff0000 },
30 [DESC_RATE54M] = { .addr = 0xe04, .mask = 0xff000000 },
31 [DESC_RATEMCS0] = { .addr = 0xe10, .mask = 0x000000ff },
32 [DESC_RATEMCS1] = { .addr = 0xe10, .mask = 0x0000ff00 },
33 [DESC_RATEMCS2] = { .addr = 0xe10, .mask = 0x00ff0000 },
34 [DESC_RATEMCS3] = { .addr = 0xe10, .mask = 0xff000000 },
35 [DESC_RATEMCS4] = { .addr = 0xe14, .mask = 0x000000ff },
36 [DESC_RATEMCS5] = { .addr = 0xe14, .mask = 0x0000ff00 },
37 [DESC_RATEMCS6] = { .addr = 0xe14, .mask = 0x00ff0000 },
38 [DESC_RATEMCS7] = { .addr = 0xe14, .mask = 0xff000000 },
39 };
40
41 #define WLAN_TXQ_RPT_EN 0x1F
42 #define WLAN_SLOT_TIME 0x09
43 #define WLAN_RL_VAL 0x3030
44 #define WLAN_BAR_VAL 0x0201ffff
45 #define BIT_MASK_TBTT_HOLD 0x00000fff
46 #define BIT_SHIFT_TBTT_HOLD 8
47 #define BIT_MASK_TBTT_SETUP 0x000000ff
48 #define BIT_SHIFT_TBTT_SETUP 0
49 #define BIT_MASK_TBTT_MASK ((BIT_MASK_TBTT_HOLD << BIT_SHIFT_TBTT_HOLD) | \
50 (BIT_MASK_TBTT_SETUP << BIT_SHIFT_TBTT_SETUP))
51 #define TBTT_TIME(s, h)((((s) & BIT_MASK_TBTT_SETUP) << BIT_SHIFT_TBTT_SETUP) |\
52 (((h) & BIT_MASK_TBTT_HOLD) << BIT_SHIFT_TBTT_HOLD))
53 #define WLAN_TBTT_TIME_NORMAL TBTT_TIME(0x04, 0x80)
54 #define WLAN_TBTT_TIME_STOP_BCN TBTT_TIME(0x04, 0x64)
55 #define WLAN_PIFS_VAL 0
56 #define WLAN_AGG_BRK_TIME 0x16
57 #define WLAN_NAV_PROT_LEN 0x0040
58 #define WLAN_SPEC_SIFS 0x100a
59 #define WLAN_RX_PKT_LIMIT 0x17
60 #define WLAN_MAX_AGG_NR 0x0A
61 #define WLAN_AMPDU_MAX_TIME 0x1C
62 #define WLAN_ANT_SEL 0x82
63 #define WLAN_LTR_IDLE_LAT 0x90039003
64 #define WLAN_LTR_ACT_LAT 0x883c883c
65 #define WLAN_LTR_CTRL1 0xCB004010
66 #define WLAN_LTR_CTRL2 0x01233425
67
rtw8723d_lck(struct rtw_dev * rtwdev)68 static void rtw8723d_lck(struct rtw_dev *rtwdev)
69 {
70 u32 lc_cal;
71 u8 val_ctx, rf_val;
72 int ret;
73
74 val_ctx = rtw_read8(rtwdev, REG_CTX);
75 if ((val_ctx & BIT_MASK_CTX_TYPE) != 0)
76 rtw_write8(rtwdev, REG_CTX, val_ctx & ~BIT_MASK_CTX_TYPE);
77 else
78 rtw_write8(rtwdev, REG_TXPAUSE, 0xFF);
79 lc_cal = rtw_read_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK);
80
81 rtw_write_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK, lc_cal | BIT_LCK);
82
83 ret = read_poll_timeout(rtw_read_rf, rf_val, rf_val != 0x1,
84 10000, 1000000, false,
85 rtwdev, RF_PATH_A, RF_CFGCH, BIT_LCK);
86 if (ret)
87 rtw_warn(rtwdev, "failed to poll LCK status bit\n");
88
89 rtw_write_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK, lc_cal);
90 if ((val_ctx & BIT_MASK_CTX_TYPE) != 0)
91 rtw_write8(rtwdev, REG_CTX, val_ctx);
92 else
93 rtw_write8(rtwdev, REG_TXPAUSE, 0x00);
94 }
95
96 static const u32 rtw8723d_ofdm_swing_table[] = {
97 0x0b40002d, 0x0c000030, 0x0cc00033, 0x0d800036, 0x0e400039, 0x0f00003c,
98 0x10000040, 0x11000044, 0x12000048, 0x1300004c, 0x14400051, 0x15800056,
99 0x16c0005b, 0x18000060, 0x19800066, 0x1b00006c, 0x1c800072, 0x1e400079,
100 0x20000080, 0x22000088, 0x24000090, 0x26000098, 0x288000a2, 0x2ac000ab,
101 0x2d4000b5, 0x300000c0, 0x32c000cb, 0x35c000d7, 0x390000e4, 0x3c8000f2,
102 0x40000100, 0x43c0010f, 0x47c0011f, 0x4c000130, 0x50800142, 0x55400155,
103 0x5a400169, 0x5fc0017f, 0x65400195, 0x6b8001ae, 0x71c001c7, 0x788001e2,
104 0x7f8001fe,
105 };
106
107 static const u32 rtw8723d_cck_swing_table[] = {
108 0x0CD, 0x0D9, 0x0E6, 0x0F3, 0x102, 0x111, 0x121, 0x132, 0x144, 0x158,
109 0x16C, 0x182, 0x198, 0x1B1, 0x1CA, 0x1E5, 0x202, 0x221, 0x241, 0x263,
110 0x287, 0x2AE, 0x2D6, 0x301, 0x32F, 0x35F, 0x392, 0x3C9, 0x402, 0x43F,
111 0x47F, 0x4C3, 0x50C, 0x558, 0x5A9, 0x5FF, 0x65A, 0x6BA, 0x720, 0x78C,
112 0x7FF,
113 };
114
115 #define RTW_OFDM_SWING_TABLE_SIZE ARRAY_SIZE(rtw8723d_ofdm_swing_table)
116 #define RTW_CCK_SWING_TABLE_SIZE ARRAY_SIZE(rtw8723d_cck_swing_table)
117
rtw8723d_pwrtrack_init(struct rtw_dev * rtwdev)118 static void rtw8723d_pwrtrack_init(struct rtw_dev *rtwdev)
119 {
120 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
121 u8 path;
122
123 dm_info->default_ofdm_index = RTW_DEF_OFDM_SWING_INDEX;
124
125 for (path = RF_PATH_A; path < rtwdev->hal.rf_path_num; path++) {
126 ewma_thermal_init(&dm_info->avg_thermal[path]);
127 dm_info->delta_power_index[path] = 0;
128 }
129 dm_info->pwr_trk_triggered = false;
130 dm_info->pwr_trk_init_trigger = true;
131 dm_info->thermal_meter_k = rtwdev->efuse.thermal_meter_k;
132 dm_info->txagc_remnant_cck = 0;
133 dm_info->txagc_remnant_ofdm = 0;
134 }
135
rtw8723d_phy_set_param(struct rtw_dev * rtwdev)136 static void rtw8723d_phy_set_param(struct rtw_dev *rtwdev)
137 {
138 u8 xtal_cap;
139 u32 val32;
140
141 /* power on BB/RF domain */
142 rtw_write16_set(rtwdev, REG_SYS_FUNC_EN,
143 BIT_FEN_EN_25_1 | BIT_FEN_BB_GLB_RST | BIT_FEN_BB_RSTB);
144 rtw_write8_set(rtwdev, REG_RF_CTRL,
145 BIT_RF_EN | BIT_RF_RSTB | BIT_RF_SDM_RSTB);
146 rtw_write8(rtwdev, REG_AFE_CTRL1 + 1, 0x80);
147
148 rtw_phy_load_tables(rtwdev);
149
150 /* post init after header files config */
151 rtw_write32_clr(rtwdev, REG_RCR, BIT_RCR_ADF);
152 rtw_write8_set(rtwdev, REG_HIQ_NO_LMT_EN, BIT_HIQ_NO_LMT_EN_ROOT);
153 rtw_write16_set(rtwdev, REG_AFE_CTRL_4, BIT_CK320M_AFE_EN | BIT_EN_SYN);
154
155 xtal_cap = rtwdev->efuse.crystal_cap & 0x3F;
156 rtw_write32_mask(rtwdev, REG_AFE_CTRL3, BIT_MASK_XTAL,
157 xtal_cap | (xtal_cap << 6));
158 rtw_write32_set(rtwdev, REG_FPGA0_RFMOD, BIT_CCKEN | BIT_OFDMEN);
159 if ((rtwdev->efuse.afe >> 4) == 14) {
160 rtw_write32_set(rtwdev, REG_AFE_CTRL3, BIT_XTAL_GMP_BIT4);
161 rtw_write32_clr(rtwdev, REG_AFE_CTRL1, BITS_PLL);
162 rtw_write32_set(rtwdev, REG_LDO_SWR_CTRL, BIT_XTA1);
163 rtw_write32_clr(rtwdev, REG_LDO_SWR_CTRL, BIT_XTA0);
164 }
165
166 rtw_write8(rtwdev, REG_SLOT, WLAN_SLOT_TIME);
167 rtw_write8(rtwdev, REG_FWHW_TXQ_CTRL + 1, WLAN_TXQ_RPT_EN);
168 rtw_write16(rtwdev, REG_RETRY_LIMIT, WLAN_RL_VAL);
169 rtw_write32(rtwdev, REG_BAR_MODE_CTRL, WLAN_BAR_VAL);
170 rtw_write8(rtwdev, REG_ATIMWND, 0x2);
171 rtw_write8(rtwdev, REG_BCN_CTRL,
172 BIT_DIS_TSF_UDT | BIT_EN_BCN_FUNCTION | BIT_EN_TXBCN_RPT);
173 val32 = rtw_read32(rtwdev, REG_TBTT_PROHIBIT);
174 val32 &= ~BIT_MASK_TBTT_MASK;
175 val32 |= WLAN_TBTT_TIME_STOP_BCN;
176 rtw_write8(rtwdev, REG_TBTT_PROHIBIT, val32);
177 rtw_write8(rtwdev, REG_PIFS, WLAN_PIFS_VAL);
178 rtw_write8(rtwdev, REG_AGGR_BREAK_TIME, WLAN_AGG_BRK_TIME);
179 rtw_write16(rtwdev, REG_NAV_PROT_LEN, WLAN_NAV_PROT_LEN);
180 rtw_write16(rtwdev, REG_MAC_SPEC_SIFS, WLAN_SPEC_SIFS);
181 rtw_write16(rtwdev, REG_SIFS, WLAN_SPEC_SIFS);
182 rtw_write16(rtwdev, REG_SIFS + 2, WLAN_SPEC_SIFS);
183 rtw_write8(rtwdev, REG_SINGLE_AMPDU_CTRL, BIT_EN_SINGLE_APMDU);
184 rtw_write8(rtwdev, REG_RX_PKT_LIMIT, WLAN_RX_PKT_LIMIT);
185 rtw_write8(rtwdev, REG_MAX_AGGR_NUM, WLAN_MAX_AGG_NR);
186 rtw_write8(rtwdev, REG_AMPDU_MAX_TIME, WLAN_AMPDU_MAX_TIME);
187 rtw_write8(rtwdev, REG_LEDCFG2, WLAN_ANT_SEL);
188
189 rtw_write32(rtwdev, REG_LTR_IDLE_LATENCY, WLAN_LTR_IDLE_LAT);
190 rtw_write32(rtwdev, REG_LTR_ACTIVE_LATENCY, WLAN_LTR_ACT_LAT);
191 rtw_write32(rtwdev, REG_LTR_CTRL_BASIC, WLAN_LTR_CTRL1);
192 rtw_write32(rtwdev, REG_LTR_CTRL_BASIC + 4, WLAN_LTR_CTRL2);
193
194 rtw_phy_init(rtwdev);
195 rtwdev->dm_info.cck_pd_default = rtw_read8(rtwdev, REG_CSRATIO) & 0x1f;
196
197 rtw_write16_set(rtwdev, REG_TXDMA_OFFSET_CHK, BIT_DROP_DATA_EN);
198
199 rtw8723d_lck(rtwdev);
200
201 rtw_write32_mask(rtwdev, REG_OFDM0_XAAGC1, MASKBYTE0, 0x50);
202 rtw_write32_mask(rtwdev, REG_OFDM0_XAAGC1, MASKBYTE0, 0x20);
203
204 rtw8723d_pwrtrack_init(rtwdev);
205 }
206
rtw8723de_efuse_parsing(struct rtw_efuse * efuse,struct rtw8723d_efuse * map)207 static void rtw8723de_efuse_parsing(struct rtw_efuse *efuse,
208 struct rtw8723d_efuse *map)
209 {
210 ether_addr_copy(efuse->addr, map->e.mac_addr);
211 }
212
rtw8723du_efuse_parsing(struct rtw_efuse * efuse,struct rtw8723d_efuse * map)213 static void rtw8723du_efuse_parsing(struct rtw_efuse *efuse,
214 struct rtw8723d_efuse *map)
215 {
216 ether_addr_copy(efuse->addr, map->u.mac_addr);
217 }
218
rtw8723ds_efuse_parsing(struct rtw_efuse * efuse,struct rtw8723d_efuse * map)219 static void rtw8723ds_efuse_parsing(struct rtw_efuse *efuse,
220 struct rtw8723d_efuse *map)
221 {
222 ether_addr_copy(efuse->addr, map->s.mac_addr);
223 }
224
rtw8723d_read_efuse(struct rtw_dev * rtwdev,u8 * log_map)225 static int rtw8723d_read_efuse(struct rtw_dev *rtwdev, u8 *log_map)
226 {
227 struct rtw_efuse *efuse = &rtwdev->efuse;
228 struct rtw8723d_efuse *map;
229 int i;
230
231 map = (struct rtw8723d_efuse *)log_map;
232
233 efuse->rfe_option = 0;
234 efuse->rf_board_option = map->rf_board_option;
235 efuse->crystal_cap = map->xtal_k;
236 efuse->pa_type_2g = map->pa_type;
237 efuse->lna_type_2g = map->lna_type_2g[0];
238 efuse->channel_plan = map->channel_plan;
239 efuse->country_code[0] = map->country_code[0];
240 efuse->country_code[1] = map->country_code[1];
241 efuse->bt_setting = map->rf_bt_setting;
242 efuse->regd = map->rf_board_option & 0x7;
243 efuse->thermal_meter[0] = map->thermal_meter;
244 efuse->thermal_meter_k = map->thermal_meter;
245 efuse->afe = map->afe;
246
247 for (i = 0; i < 4; i++)
248 efuse->txpwr_idx_table[i] = map->txpwr_idx_table[i];
249
250 switch (rtw_hci_type(rtwdev)) {
251 case RTW_HCI_TYPE_PCIE:
252 rtw8723de_efuse_parsing(efuse, map);
253 break;
254 case RTW_HCI_TYPE_USB:
255 rtw8723du_efuse_parsing(efuse, map);
256 break;
257 case RTW_HCI_TYPE_SDIO:
258 rtw8723ds_efuse_parsing(efuse, map);
259 break;
260 default:
261 /* unsupported now */
262 return -ENOTSUPP;
263 }
264
265 return 0;
266 }
267
query_phy_status_page0(struct rtw_dev * rtwdev,u8 * phy_status,struct rtw_rx_pkt_stat * pkt_stat)268 static void query_phy_status_page0(struct rtw_dev *rtwdev, u8 *phy_status,
269 struct rtw_rx_pkt_stat *pkt_stat)
270 {
271 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
272 s8 min_rx_power = -120;
273 u8 pwdb = GET_PHY_STAT_P0_PWDB(phy_status);
274
275 pkt_stat->rx_power[RF_PATH_A] = pwdb - 97;
276 pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 1);
277 pkt_stat->bw = RTW_CHANNEL_WIDTH_20;
278 pkt_stat->signal_power = max(pkt_stat->rx_power[RF_PATH_A],
279 min_rx_power);
280 dm_info->rssi[RF_PATH_A] = pkt_stat->rssi;
281 }
282
query_phy_status_page1(struct rtw_dev * rtwdev,u8 * phy_status,struct rtw_rx_pkt_stat * pkt_stat)283 static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status,
284 struct rtw_rx_pkt_stat *pkt_stat)
285 {
286 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
287 u8 rxsc, bw;
288 s8 min_rx_power = -120;
289 s8 rx_evm;
290
291 if (pkt_stat->rate > DESC_RATE11M && pkt_stat->rate < DESC_RATEMCS0)
292 rxsc = GET_PHY_STAT_P1_L_RXSC(phy_status);
293 else
294 rxsc = GET_PHY_STAT_P1_HT_RXSC(phy_status);
295
296 if (GET_PHY_STAT_P1_RF_MODE(phy_status) == 0)
297 bw = RTW_CHANNEL_WIDTH_20;
298 else if ((rxsc == 1) || (rxsc == 2))
299 bw = RTW_CHANNEL_WIDTH_20;
300 else
301 bw = RTW_CHANNEL_WIDTH_40;
302
303 pkt_stat->rx_power[RF_PATH_A] = GET_PHY_STAT_P1_PWDB_A(phy_status) - 110;
304 pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 1);
305 pkt_stat->bw = bw;
306 pkt_stat->signal_power = max(pkt_stat->rx_power[RF_PATH_A],
307 min_rx_power);
308 pkt_stat->rx_evm[RF_PATH_A] = GET_PHY_STAT_P1_RXEVM_A(phy_status);
309 pkt_stat->rx_snr[RF_PATH_A] = GET_PHY_STAT_P1_RXSNR_A(phy_status);
310 pkt_stat->cfo_tail[RF_PATH_A] = GET_PHY_STAT_P1_CFO_TAIL_A(phy_status);
311
312 dm_info->curr_rx_rate = pkt_stat->rate;
313 dm_info->rssi[RF_PATH_A] = pkt_stat->rssi;
314 dm_info->rx_snr[RF_PATH_A] = pkt_stat->rx_snr[RF_PATH_A] >> 1;
315 dm_info->cfo_tail[RF_PATH_A] = (pkt_stat->cfo_tail[RF_PATH_A] * 5) >> 1;
316
317 rx_evm = clamp_t(s8, -pkt_stat->rx_evm[RF_PATH_A] >> 1, 0, 64);
318 rx_evm &= 0x3F; /* 64->0: second path of 1SS rate is 64 */
319 dm_info->rx_evm_dbm[RF_PATH_A] = rx_evm;
320 }
321
query_phy_status(struct rtw_dev * rtwdev,u8 * phy_status,struct rtw_rx_pkt_stat * pkt_stat)322 static void query_phy_status(struct rtw_dev *rtwdev, u8 *phy_status,
323 struct rtw_rx_pkt_stat *pkt_stat)
324 {
325 u8 page;
326
327 page = *phy_status & 0xf;
328
329 switch (page) {
330 case 0:
331 query_phy_status_page0(rtwdev, phy_status, pkt_stat);
332 break;
333 case 1:
334 query_phy_status_page1(rtwdev, phy_status, pkt_stat);
335 break;
336 default:
337 rtw_warn(rtwdev, "unused phy status page (%d)\n", page);
338 return;
339 }
340 }
341
rtw8723d_query_rx_desc(struct rtw_dev * rtwdev,u8 * rx_desc,struct rtw_rx_pkt_stat * pkt_stat,struct ieee80211_rx_status * rx_status)342 static void rtw8723d_query_rx_desc(struct rtw_dev *rtwdev, u8 *rx_desc,
343 struct rtw_rx_pkt_stat *pkt_stat,
344 struct ieee80211_rx_status *rx_status)
345 {
346 struct ieee80211_hdr *hdr;
347 u32 desc_sz = rtwdev->chip->rx_pkt_desc_sz;
348 u8 *phy_status = NULL;
349
350 memset(pkt_stat, 0, sizeof(*pkt_stat));
351
352 pkt_stat->phy_status = GET_RX_DESC_PHYST(rx_desc);
353 pkt_stat->icv_err = GET_RX_DESC_ICV_ERR(rx_desc);
354 pkt_stat->crc_err = GET_RX_DESC_CRC32(rx_desc);
355 pkt_stat->decrypted = !GET_RX_DESC_SWDEC(rx_desc) &&
356 GET_RX_DESC_ENC_TYPE(rx_desc) != RX_DESC_ENC_NONE;
357 pkt_stat->is_c2h = GET_RX_DESC_C2H(rx_desc);
358 pkt_stat->pkt_len = GET_RX_DESC_PKT_LEN(rx_desc);
359 pkt_stat->drv_info_sz = GET_RX_DESC_DRV_INFO_SIZE(rx_desc);
360 pkt_stat->shift = GET_RX_DESC_SHIFT(rx_desc);
361 pkt_stat->rate = GET_RX_DESC_RX_RATE(rx_desc);
362 pkt_stat->cam_id = GET_RX_DESC_MACID(rx_desc);
363 pkt_stat->ppdu_cnt = 0;
364 pkt_stat->tsf_low = GET_RX_DESC_TSFL(rx_desc);
365
366 /* drv_info_sz is in unit of 8-bytes */
367 pkt_stat->drv_info_sz *= 8;
368
369 /* c2h cmd pkt's rx/phy status is not interested */
370 if (pkt_stat->is_c2h)
371 return;
372
373 hdr = (struct ieee80211_hdr *)(rx_desc + desc_sz + pkt_stat->shift +
374 pkt_stat->drv_info_sz);
375 if (pkt_stat->phy_status) {
376 phy_status = rx_desc + desc_sz + pkt_stat->shift;
377 query_phy_status(rtwdev, phy_status, pkt_stat);
378 }
379
380 rtw_rx_fill_rx_status(rtwdev, pkt_stat, hdr, rx_status, phy_status);
381 }
382
rtw8723d_check_spur_ov_thres(struct rtw_dev * rtwdev,u8 channel,u32 thres)383 static bool rtw8723d_check_spur_ov_thres(struct rtw_dev *rtwdev,
384 u8 channel, u32 thres)
385 {
386 u32 freq;
387 bool ret = false;
388
389 if (channel == 13)
390 freq = FREQ_CH13;
391 else if (channel == 14)
392 freq = FREQ_CH14;
393 else
394 return false;
395
396 rtw_write32(rtwdev, REG_ANALOG_P4, DIS_3WIRE);
397 rtw_write32(rtwdev, REG_PSDFN, freq);
398 rtw_write32(rtwdev, REG_PSDFN, START_PSD | freq);
399
400 msleep(30);
401 if (rtw_read32(rtwdev, REG_PSDRPT) >= thres)
402 ret = true;
403
404 rtw_write32(rtwdev, REG_PSDFN, freq);
405 rtw_write32(rtwdev, REG_ANALOG_P4, EN_3WIRE);
406
407 return ret;
408 }
409
rtw8723d_cfg_notch(struct rtw_dev * rtwdev,u8 channel,bool notch)410 static void rtw8723d_cfg_notch(struct rtw_dev *rtwdev, u8 channel, bool notch)
411 {
412 if (!notch) {
413 rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_MASK_RXDSP, 0x1f);
414 rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_EN_RXDSP, 0x0);
415 rtw_write32(rtwdev, REG_OFDM1_CSI1, 0x00000000);
416 rtw_write32(rtwdev, REG_OFDM1_CSI2, 0x00000000);
417 rtw_write32(rtwdev, REG_OFDM1_CSI3, 0x00000000);
418 rtw_write32(rtwdev, REG_OFDM1_CSI4, 0x00000000);
419 rtw_write32_mask(rtwdev, REG_OFDM1_CFOTRK, BIT_EN_CFOTRK, 0x0);
420 return;
421 }
422
423 switch (channel) {
424 case 13:
425 rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_MASK_RXDSP, 0xb);
426 rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_EN_RXDSP, 0x1);
427 rtw_write32(rtwdev, REG_OFDM1_CSI1, 0x04000000);
428 rtw_write32(rtwdev, REG_OFDM1_CSI2, 0x00000000);
429 rtw_write32(rtwdev, REG_OFDM1_CSI3, 0x00000000);
430 rtw_write32(rtwdev, REG_OFDM1_CSI4, 0x00000000);
431 rtw_write32_mask(rtwdev, REG_OFDM1_CFOTRK, BIT_EN_CFOTRK, 0x1);
432 break;
433 case 14:
434 rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_MASK_RXDSP, 0x5);
435 rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_EN_RXDSP, 0x1);
436 rtw_write32(rtwdev, REG_OFDM1_CSI1, 0x00000000);
437 rtw_write32(rtwdev, REG_OFDM1_CSI2, 0x00000000);
438 rtw_write32(rtwdev, REG_OFDM1_CSI3, 0x00000000);
439 rtw_write32(rtwdev, REG_OFDM1_CSI4, 0x00080000);
440 rtw_write32_mask(rtwdev, REG_OFDM1_CFOTRK, BIT_EN_CFOTRK, 0x1);
441 break;
442 default:
443 rtw_write32_mask(rtwdev, REG_OFDM0_RXDSP, BIT_EN_RXDSP, 0x0);
444 rtw_write32_mask(rtwdev, REG_OFDM1_CFOTRK, BIT_EN_CFOTRK, 0x0);
445 break;
446 }
447 }
448
rtw8723d_spur_cal(struct rtw_dev * rtwdev,u8 channel)449 static void rtw8723d_spur_cal(struct rtw_dev *rtwdev, u8 channel)
450 {
451 bool notch;
452
453 if (channel < 13) {
454 rtw8723d_cfg_notch(rtwdev, channel, false);
455 return;
456 }
457
458 notch = rtw8723d_check_spur_ov_thres(rtwdev, channel, SPUR_THRES);
459 rtw8723d_cfg_notch(rtwdev, channel, notch);
460 }
461
rtw8723d_set_channel_rf(struct rtw_dev * rtwdev,u8 channel,u8 bw)462 static void rtw8723d_set_channel_rf(struct rtw_dev *rtwdev, u8 channel, u8 bw)
463 {
464 u32 rf_cfgch_a, rf_cfgch_b;
465
466 rf_cfgch_a = rtw_read_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK);
467 rf_cfgch_b = rtw_read_rf(rtwdev, RF_PATH_B, RF_CFGCH, RFREG_MASK);
468
469 rf_cfgch_a &= ~RFCFGCH_CHANNEL_MASK;
470 rf_cfgch_b &= ~RFCFGCH_CHANNEL_MASK;
471 rf_cfgch_a |= (channel & RFCFGCH_CHANNEL_MASK);
472 rf_cfgch_b |= (channel & RFCFGCH_CHANNEL_MASK);
473
474 rf_cfgch_a &= ~RFCFGCH_BW_MASK;
475 switch (bw) {
476 case RTW_CHANNEL_WIDTH_20:
477 rf_cfgch_a |= RFCFGCH_BW_20M;
478 break;
479 case RTW_CHANNEL_WIDTH_40:
480 rf_cfgch_a |= RFCFGCH_BW_40M;
481 break;
482 default:
483 break;
484 }
485
486 rtw_write_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK, rf_cfgch_a);
487 rtw_write_rf(rtwdev, RF_PATH_B, RF_CFGCH, RFREG_MASK, rf_cfgch_b);
488
489 rtw8723d_spur_cal(rtwdev, channel);
490 }
491
492 static const struct rtw_backup_info cck_dfir_cfg[][CCK_DFIR_NR] = {
493 [0] = {
494 { .len = 4, .reg = 0xA24, .val = 0x64B80C1C },
495 { .len = 4, .reg = 0xA28, .val = 0x00008810 },
496 { .len = 4, .reg = 0xAAC, .val = 0x01235667 },
497 },
498 [1] = {
499 { .len = 4, .reg = 0xA24, .val = 0x0000B81C },
500 { .len = 4, .reg = 0xA28, .val = 0x00000000 },
501 { .len = 4, .reg = 0xAAC, .val = 0x00003667 },
502 },
503 };
504
rtw8723d_set_channel_bb(struct rtw_dev * rtwdev,u8 channel,u8 bw,u8 primary_ch_idx)505 static void rtw8723d_set_channel_bb(struct rtw_dev *rtwdev, u8 channel, u8 bw,
506 u8 primary_ch_idx)
507 {
508 const struct rtw_backup_info *cck_dfir;
509 int i;
510
511 cck_dfir = channel <= 13 ? cck_dfir_cfg[0] : cck_dfir_cfg[1];
512
513 for (i = 0; i < CCK_DFIR_NR; i++, cck_dfir++)
514 rtw_write32(rtwdev, cck_dfir->reg, cck_dfir->val);
515
516 switch (bw) {
517 case RTW_CHANNEL_WIDTH_20:
518 rtw_write32_mask(rtwdev, REG_FPGA0_RFMOD, BIT_MASK_RFMOD, 0x0);
519 rtw_write32_mask(rtwdev, REG_FPGA1_RFMOD, BIT_MASK_RFMOD, 0x0);
520 rtw_write32_mask(rtwdev, REG_BBRX_DFIR, BIT_RXBB_DFIR_EN, 1);
521 rtw_write32_mask(rtwdev, REG_BBRX_DFIR, BIT_MASK_RXBB_DFIR, 0xa);
522 break;
523 case RTW_CHANNEL_WIDTH_40:
524 rtw_write32_mask(rtwdev, REG_FPGA0_RFMOD, BIT_MASK_RFMOD, 0x1);
525 rtw_write32_mask(rtwdev, REG_FPGA1_RFMOD, BIT_MASK_RFMOD, 0x1);
526 rtw_write32_mask(rtwdev, REG_BBRX_DFIR, BIT_RXBB_DFIR_EN, 0);
527 rtw_write32_mask(rtwdev, REG_CCK0_SYS, BIT_CCK_SIDE_BAND,
528 (primary_ch_idx == RTW_SC_20_UPPER ? 1 : 0));
529 break;
530 default:
531 break;
532 }
533 }
534
rtw8723d_set_channel(struct rtw_dev * rtwdev,u8 channel,u8 bw,u8 primary_chan_idx)535 static void rtw8723d_set_channel(struct rtw_dev *rtwdev, u8 channel, u8 bw,
536 u8 primary_chan_idx)
537 {
538 rtw8723d_set_channel_rf(rtwdev, channel, bw);
539 rtw_set_channel_mac(rtwdev, channel, bw, primary_chan_idx);
540 rtw8723d_set_channel_bb(rtwdev, channel, bw, primary_chan_idx);
541 }
542
543 #define BIT_CFENDFORM BIT(9)
544 #define BIT_WMAC_TCR_ERR0 BIT(12)
545 #define BIT_WMAC_TCR_ERR1 BIT(13)
546 #define BIT_TCR_CFG (BIT_CFENDFORM | BIT_WMAC_TCR_ERR0 | \
547 BIT_WMAC_TCR_ERR1)
548 #define WLAN_RX_FILTER0 0xFFFF
549 #define WLAN_RX_FILTER1 0x400
550 #define WLAN_RX_FILTER2 0xFFFF
551 #define WLAN_RCR_CFG 0x700060CE
552
rtw8723d_mac_init(struct rtw_dev * rtwdev)553 static int rtw8723d_mac_init(struct rtw_dev *rtwdev)
554 {
555 rtw_write8(rtwdev, REG_FWHW_TXQ_CTRL + 1, WLAN_TXQ_RPT_EN);
556 rtw_write32(rtwdev, REG_TCR, BIT_TCR_CFG);
557
558 rtw_write16(rtwdev, REG_RXFLTMAP0, WLAN_RX_FILTER0);
559 rtw_write16(rtwdev, REG_RXFLTMAP1, WLAN_RX_FILTER1);
560 rtw_write16(rtwdev, REG_RXFLTMAP2, WLAN_RX_FILTER2);
561 rtw_write32(rtwdev, REG_RCR, WLAN_RCR_CFG);
562
563 rtw_write32(rtwdev, REG_INT_MIG, 0);
564 rtw_write32(rtwdev, REG_MCUTST_1, 0x0);
565
566 rtw_write8(rtwdev, REG_MISC_CTRL, BIT_DIS_SECOND_CCA);
567 rtw_write8(rtwdev, REG_2ND_CCA_CTRL, 0);
568
569 return 0;
570 }
571
rtw8723d_shutdown(struct rtw_dev * rtwdev)572 static void rtw8723d_shutdown(struct rtw_dev *rtwdev)
573 {
574 rtw_write16_set(rtwdev, REG_HCI_OPT_CTRL, BIT_USB_SUS_DIS);
575 }
576
rtw8723d_cfg_ldo25(struct rtw_dev * rtwdev,bool enable)577 static void rtw8723d_cfg_ldo25(struct rtw_dev *rtwdev, bool enable)
578 {
579 u8 ldo_pwr;
580
581 ldo_pwr = rtw_read8(rtwdev, REG_LDO_EFUSE_CTRL + 3);
582 if (enable) {
583 ldo_pwr &= ~BIT_MASK_LDO25_VOLTAGE;
584 ldo_pwr |= (BIT_LDO25_VOLTAGE_V25 << 4) | BIT_LDO25_EN;
585 } else {
586 ldo_pwr &= ~BIT_LDO25_EN;
587 }
588 rtw_write8(rtwdev, REG_LDO_EFUSE_CTRL + 3, ldo_pwr);
589 }
590
591 static void
rtw8723d_set_tx_power_index_by_rate(struct rtw_dev * rtwdev,u8 path,u8 rs)592 rtw8723d_set_tx_power_index_by_rate(struct rtw_dev *rtwdev, u8 path, u8 rs)
593 {
594 struct rtw_hal *hal = &rtwdev->hal;
595 const struct rtw_hw_reg *txagc;
596 u8 rate, pwr_index;
597 int j;
598
599 for (j = 0; j < rtw_rate_size[rs]; j++) {
600 rate = rtw_rate_section[rs][j];
601 pwr_index = hal->tx_pwr_tbl[path][rate];
602
603 if (rate >= ARRAY_SIZE(rtw8723d_txagc)) {
604 rtw_warn(rtwdev, "rate 0x%x isn't supported\n", rate);
605 continue;
606 }
607 txagc = &rtw8723d_txagc[rate];
608 if (!txagc->addr) {
609 rtw_warn(rtwdev, "rate 0x%x isn't defined\n", rate);
610 continue;
611 }
612
613 rtw_write32_mask(rtwdev, txagc->addr, txagc->mask, pwr_index);
614 }
615 }
616
rtw8723d_set_tx_power_index(struct rtw_dev * rtwdev)617 static void rtw8723d_set_tx_power_index(struct rtw_dev *rtwdev)
618 {
619 struct rtw_hal *hal = &rtwdev->hal;
620 int rs, path;
621
622 for (path = 0; path < hal->rf_path_num; path++) {
623 for (rs = 0; rs <= RTW_RATE_SECTION_HT_1S; rs++)
624 rtw8723d_set_tx_power_index_by_rate(rtwdev, path, rs);
625 }
626 }
627
rtw8723d_efuse_grant(struct rtw_dev * rtwdev,bool on)628 static void rtw8723d_efuse_grant(struct rtw_dev *rtwdev, bool on)
629 {
630 if (on) {
631 rtw_write8(rtwdev, REG_EFUSE_ACCESS, EFUSE_ACCESS_ON);
632
633 rtw_write16_set(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_ELDR);
634 rtw_write16_set(rtwdev, REG_SYS_CLKR, BIT_LOADER_CLK_EN | BIT_ANA8M);
635 } else {
636 rtw_write8(rtwdev, REG_EFUSE_ACCESS, EFUSE_ACCESS_OFF);
637 }
638 }
639
rtw8723d_false_alarm_statistics(struct rtw_dev * rtwdev)640 static void rtw8723d_false_alarm_statistics(struct rtw_dev *rtwdev)
641 {
642 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
643 u32 cck_fa_cnt;
644 u32 ofdm_fa_cnt;
645 u32 crc32_cnt;
646 u32 val32;
647
648 /* hold counter */
649 rtw_write32_mask(rtwdev, REG_OFDM_FA_HOLDC_11N, BIT_MASK_OFDM_FA_KEEP, 1);
650 rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTD_11N, BIT_MASK_OFDM_FA_KEEP1, 1);
651 rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_CNT_KEEP, 1);
652 rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_FA_KEEP, 1);
653
654 cck_fa_cnt = rtw_read32_mask(rtwdev, REG_CCK_FA_LSB_11N, MASKBYTE0);
655 cck_fa_cnt += rtw_read32_mask(rtwdev, REG_CCK_FA_MSB_11N, MASKBYTE3) << 8;
656
657 val32 = rtw_read32(rtwdev, REG_OFDM_FA_TYPE1_11N);
658 ofdm_fa_cnt = u32_get_bits(val32, BIT_MASK_OFDM_FF_CNT);
659 ofdm_fa_cnt += u32_get_bits(val32, BIT_MASK_OFDM_SF_CNT);
660 val32 = rtw_read32(rtwdev, REG_OFDM_FA_TYPE2_11N);
661 dm_info->ofdm_cca_cnt = u32_get_bits(val32, BIT_MASK_OFDM_CCA_CNT);
662 ofdm_fa_cnt += u32_get_bits(val32, BIT_MASK_OFDM_PF_CNT);
663 val32 = rtw_read32(rtwdev, REG_OFDM_FA_TYPE3_11N);
664 ofdm_fa_cnt += u32_get_bits(val32, BIT_MASK_OFDM_RI_CNT);
665 ofdm_fa_cnt += u32_get_bits(val32, BIT_MASK_OFDM_CRC_CNT);
666 val32 = rtw_read32(rtwdev, REG_OFDM_FA_TYPE4_11N);
667 ofdm_fa_cnt += u32_get_bits(val32, BIT_MASK_OFDM_MNS_CNT);
668
669 dm_info->cck_fa_cnt = cck_fa_cnt;
670 dm_info->ofdm_fa_cnt = ofdm_fa_cnt;
671 dm_info->total_fa_cnt = cck_fa_cnt + ofdm_fa_cnt;
672
673 dm_info->cck_err_cnt = rtw_read32(rtwdev, REG_IGI_C_11N);
674 dm_info->cck_ok_cnt = rtw_read32(rtwdev, REG_IGI_D_11N);
675 crc32_cnt = rtw_read32(rtwdev, REG_OFDM_CRC32_CNT_11N);
676 dm_info->ofdm_err_cnt = u32_get_bits(crc32_cnt, BIT_MASK_OFDM_LCRC_ERR);
677 dm_info->ofdm_ok_cnt = u32_get_bits(crc32_cnt, BIT_MASK_OFDM_LCRC_OK);
678 crc32_cnt = rtw_read32(rtwdev, REG_HT_CRC32_CNT_11N);
679 dm_info->ht_err_cnt = u32_get_bits(crc32_cnt, BIT_MASK_HT_CRC_ERR);
680 dm_info->ht_ok_cnt = u32_get_bits(crc32_cnt, BIT_MASK_HT_CRC_OK);
681 dm_info->vht_err_cnt = 0;
682 dm_info->vht_ok_cnt = 0;
683
684 val32 = rtw_read32(rtwdev, REG_CCK_CCA_CNT_11N);
685 dm_info->cck_cca_cnt = (u32_get_bits(val32, BIT_MASK_CCK_FA_MSB) << 8) |
686 u32_get_bits(val32, BIT_MASK_CCK_FA_LSB);
687 dm_info->total_cca_cnt = dm_info->cck_cca_cnt + dm_info->ofdm_cca_cnt;
688
689 /* reset counter */
690 rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTC_11N, BIT_MASK_OFDM_FA_RST, 1);
691 rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTC_11N, BIT_MASK_OFDM_FA_RST, 0);
692 rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTD_11N, BIT_MASK_OFDM_FA_RST1, 1);
693 rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTD_11N, BIT_MASK_OFDM_FA_RST1, 0);
694 rtw_write32_mask(rtwdev, REG_OFDM_FA_HOLDC_11N, BIT_MASK_OFDM_FA_KEEP, 0);
695 rtw_write32_mask(rtwdev, REG_OFDM_FA_RSTD_11N, BIT_MASK_OFDM_FA_KEEP1, 0);
696 rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_CNT_KPEN, 0);
697 rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_CNT_KPEN, 2);
698 rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_FA_KPEN, 0);
699 rtw_write32_mask(rtwdev, REG_CCK_FA_RST_11N, BIT_MASK_CCK_FA_KPEN, 2);
700 rtw_write32_mask(rtwdev, REG_PAGE_F_RST_11N, BIT_MASK_F_RST_ALL, 1);
701 rtw_write32_mask(rtwdev, REG_PAGE_F_RST_11N, BIT_MASK_F_RST_ALL, 0);
702 }
703
704 static const u32 iqk_adda_regs[] = {
705 0x85c, 0xe6c, 0xe70, 0xe74, 0xe78, 0xe7c, 0xe80, 0xe84, 0xe88, 0xe8c,
706 0xed0, 0xed4, 0xed8, 0xedc, 0xee0, 0xeec
707 };
708
709 static const u32 iqk_mac8_regs[] = {0x522, 0x550, 0x551};
710 static const u32 iqk_mac32_regs[] = {0x40};
711
712 static const u32 iqk_bb_regs[] = {
713 0xc04, 0xc08, 0x874, 0xb68, 0xb6c, 0x870, 0x860, 0x864, 0xa04
714 };
715
716 #define IQK_ADDA_REG_NUM ARRAY_SIZE(iqk_adda_regs)
717 #define IQK_MAC8_REG_NUM ARRAY_SIZE(iqk_mac8_regs)
718 #define IQK_MAC32_REG_NUM ARRAY_SIZE(iqk_mac32_regs)
719 #define IQK_BB_REG_NUM ARRAY_SIZE(iqk_bb_regs)
720
721 struct iqk_backup_regs {
722 u32 adda[IQK_ADDA_REG_NUM];
723 u8 mac8[IQK_MAC8_REG_NUM];
724 u32 mac32[IQK_MAC32_REG_NUM];
725 u32 bb[IQK_BB_REG_NUM];
726
727 u32 lte_path;
728 u32 lte_gnt;
729
730 u32 bb_sel_btg;
731 u8 btg_sel;
732
733 u8 igia;
734 u8 igib;
735 };
736
rtw8723d_iqk_backup_regs(struct rtw_dev * rtwdev,struct iqk_backup_regs * backup)737 static void rtw8723d_iqk_backup_regs(struct rtw_dev *rtwdev,
738 struct iqk_backup_regs *backup)
739 {
740 int i;
741
742 for (i = 0; i < IQK_ADDA_REG_NUM; i++)
743 backup->adda[i] = rtw_read32(rtwdev, iqk_adda_regs[i]);
744
745 for (i = 0; i < IQK_MAC8_REG_NUM; i++)
746 backup->mac8[i] = rtw_read8(rtwdev, iqk_mac8_regs[i]);
747 for (i = 0; i < IQK_MAC32_REG_NUM; i++)
748 backup->mac32[i] = rtw_read32(rtwdev, iqk_mac32_regs[i]);
749
750 for (i = 0; i < IQK_BB_REG_NUM; i++)
751 backup->bb[i] = rtw_read32(rtwdev, iqk_bb_regs[i]);
752
753 backup->igia = rtw_read32_mask(rtwdev, REG_OFDM0_XAAGC1, MASKBYTE0);
754 backup->igib = rtw_read32_mask(rtwdev, REG_OFDM0_XBAGC1, MASKBYTE0);
755
756 backup->bb_sel_btg = rtw_read32(rtwdev, REG_BB_SEL_BTG);
757 }
758
rtw8723d_iqk_restore_regs(struct rtw_dev * rtwdev,const struct iqk_backup_regs * backup)759 static void rtw8723d_iqk_restore_regs(struct rtw_dev *rtwdev,
760 const struct iqk_backup_regs *backup)
761 {
762 int i;
763
764 for (i = 0; i < IQK_ADDA_REG_NUM; i++)
765 rtw_write32(rtwdev, iqk_adda_regs[i], backup->adda[i]);
766
767 for (i = 0; i < IQK_MAC8_REG_NUM; i++)
768 rtw_write8(rtwdev, iqk_mac8_regs[i], backup->mac8[i]);
769 for (i = 0; i < IQK_MAC32_REG_NUM; i++)
770 rtw_write32(rtwdev, iqk_mac32_regs[i], backup->mac32[i]);
771
772 for (i = 0; i < IQK_BB_REG_NUM; i++)
773 rtw_write32(rtwdev, iqk_bb_regs[i], backup->bb[i]);
774
775 rtw_write32_mask(rtwdev, REG_OFDM0_XAAGC1, MASKBYTE0, 0x50);
776 rtw_write32_mask(rtwdev, REG_OFDM0_XAAGC1, MASKBYTE0, backup->igia);
777
778 rtw_write32_mask(rtwdev, REG_OFDM0_XBAGC1, MASKBYTE0, 0x50);
779 rtw_write32_mask(rtwdev, REG_OFDM0_XBAGC1, MASKBYTE0, backup->igib);
780
781 rtw_write32(rtwdev, REG_TXIQK_TONE_A_11N, 0x01008c00);
782 rtw_write32(rtwdev, REG_RXIQK_TONE_A_11N, 0x01008c00);
783 }
784
rtw8723d_iqk_backup_path_ctrl(struct rtw_dev * rtwdev,struct iqk_backup_regs * backup)785 static void rtw8723d_iqk_backup_path_ctrl(struct rtw_dev *rtwdev,
786 struct iqk_backup_regs *backup)
787 {
788 backup->btg_sel = rtw_read8(rtwdev, REG_BTG_SEL);
789 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] original 0x67 = 0x%x\n",
790 backup->btg_sel);
791 }
792
rtw8723d_iqk_config_path_ctrl(struct rtw_dev * rtwdev)793 static void rtw8723d_iqk_config_path_ctrl(struct rtw_dev *rtwdev)
794 {
795 rtw_write32_mask(rtwdev, REG_PAD_CTRL1, BIT_BT_BTG_SEL, 0x1);
796 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] set 0x67 = 0x%x\n",
797 rtw_read32_mask(rtwdev, REG_PAD_CTRL1, MASKBYTE3));
798 }
799
rtw8723d_iqk_restore_path_ctrl(struct rtw_dev * rtwdev,const struct iqk_backup_regs * backup)800 static void rtw8723d_iqk_restore_path_ctrl(struct rtw_dev *rtwdev,
801 const struct iqk_backup_regs *backup)
802 {
803 rtw_write8(rtwdev, REG_BTG_SEL, backup->btg_sel);
804 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] restore 0x67 = 0x%x\n",
805 rtw_read32_mask(rtwdev, REG_PAD_CTRL1, MASKBYTE3));
806 }
807
rtw8723d_iqk_backup_lte_path_gnt(struct rtw_dev * rtwdev,struct iqk_backup_regs * backup)808 static void rtw8723d_iqk_backup_lte_path_gnt(struct rtw_dev *rtwdev,
809 struct iqk_backup_regs *backup)
810 {
811 backup->lte_path = rtw_read32(rtwdev, REG_LTECOEX_PATH_CONTROL);
812 rtw_write32(rtwdev, REG_LTECOEX_CTRL, 0x800f0038);
813 mdelay(1);
814 backup->lte_gnt = rtw_read32(rtwdev, REG_LTECOEX_READ_DATA);
815 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] OriginalGNT = 0x%x\n",
816 backup->lte_gnt);
817 }
818
rtw8723d_iqk_config_lte_path_gnt(struct rtw_dev * rtwdev)819 static void rtw8723d_iqk_config_lte_path_gnt(struct rtw_dev *rtwdev)
820 {
821 rtw_write32(rtwdev, REG_LTECOEX_WRITE_DATA, 0x0000ff00);
822 rtw_write32(rtwdev, REG_LTECOEX_CTRL, 0xc0020038);
823 rtw_write32_mask(rtwdev, REG_LTECOEX_PATH_CONTROL, BIT_LTE_MUX_CTRL_PATH, 0x1);
824 }
825
rtw8723d_iqk_restore_lte_path_gnt(struct rtw_dev * rtwdev,const struct iqk_backup_regs * bak)826 static void rtw8723d_iqk_restore_lte_path_gnt(struct rtw_dev *rtwdev,
827 const struct iqk_backup_regs *bak)
828 {
829 rtw_write32(rtwdev, REG_LTECOEX_WRITE_DATA, bak->lte_gnt);
830 rtw_write32(rtwdev, REG_LTECOEX_CTRL, 0xc00f0038);
831 rtw_write32(rtwdev, REG_LTECOEX_PATH_CONTROL, bak->lte_path);
832 }
833
834 struct rtw_8723d_iqk_cfg {
835 const char *name;
836 u32 val_bb_sel_btg;
837 u32 reg_lutwe;
838 u32 val_txiqk_pi;
839 u32 reg_padlut;
840 u32 reg_gaintx;
841 u32 reg_bspad;
842 u32 val_wlint;
843 u32 val_wlsel;
844 u32 val_iqkpts;
845 };
846
847 static const struct rtw_8723d_iqk_cfg iqk_tx_cfg[PATH_NR] = {
848 [PATH_S1] = {
849 .name = "S1",
850 .val_bb_sel_btg = 0x99000000,
851 .reg_lutwe = RF_LUTWE,
852 .val_txiqk_pi = 0x8214019f,
853 .reg_padlut = RF_LUTDBG,
854 .reg_gaintx = RF_GAINTX,
855 .reg_bspad = RF_BSPAD,
856 .val_wlint = 0xe0d,
857 .val_wlsel = 0x60d,
858 .val_iqkpts = 0xfa000000,
859 },
860 [PATH_S0] = {
861 .name = "S0",
862 .val_bb_sel_btg = 0x99000280,
863 .reg_lutwe = RF_LUTWE2,
864 .val_txiqk_pi = 0x8214018a,
865 .reg_padlut = RF_TXADBG,
866 .reg_gaintx = RF_TRXIQ,
867 .reg_bspad = RF_TXATANK,
868 .val_wlint = 0xe6d,
869 .val_wlsel = 0x66d,
870 .val_iqkpts = 0xf9000000,
871 },
872 };
873
rtw8723d_iqk_check_tx_failed(struct rtw_dev * rtwdev,const struct rtw_8723d_iqk_cfg * iqk_cfg)874 static u8 rtw8723d_iqk_check_tx_failed(struct rtw_dev *rtwdev,
875 const struct rtw_8723d_iqk_cfg *iqk_cfg)
876 {
877 s32 tx_x, tx_y;
878 u32 tx_fail;
879
880 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0xeac = 0x%x\n",
881 rtw_read32(rtwdev, REG_IQK_RES_RY));
882 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0xe94 = 0x%x, 0xe9c = 0x%x\n",
883 rtw_read32(rtwdev, REG_IQK_RES_TX),
884 rtw_read32(rtwdev, REG_IQK_RES_TY));
885 rtw_dbg(rtwdev, RTW_DBG_RFK,
886 "[IQK] 0xe90(before IQK)= 0x%x, 0xe98(afer IQK) = 0x%x\n",
887 rtw_read32(rtwdev, 0xe90),
888 rtw_read32(rtwdev, 0xe98));
889
890 tx_fail = rtw_read32_mask(rtwdev, REG_IQK_RES_RY, BIT_IQK_TX_FAIL);
891 tx_x = rtw_read32_mask(rtwdev, REG_IQK_RES_TX, BIT_MASK_RES_TX);
892 tx_y = rtw_read32_mask(rtwdev, REG_IQK_RES_TY, BIT_MASK_RES_TY);
893
894 if (!tx_fail && tx_x != IQK_TX_X_ERR && tx_y != IQK_TX_Y_ERR)
895 return IQK_TX_OK;
896
897 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] %s TXIQK is failed\n",
898 iqk_cfg->name);
899
900 return 0;
901 }
902
rtw8723d_iqk_check_rx_failed(struct rtw_dev * rtwdev,const struct rtw_8723d_iqk_cfg * iqk_cfg)903 static u8 rtw8723d_iqk_check_rx_failed(struct rtw_dev *rtwdev,
904 const struct rtw_8723d_iqk_cfg *iqk_cfg)
905 {
906 s32 rx_x, rx_y;
907 u32 rx_fail;
908
909 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0xea4 = 0x%x, 0xeac = 0x%x\n",
910 rtw_read32(rtwdev, REG_IQK_RES_RX),
911 rtw_read32(rtwdev, REG_IQK_RES_RY));
912
913 rtw_dbg(rtwdev, RTW_DBG_RFK,
914 "[IQK] 0xea0(before IQK)= 0x%x, 0xea8(afer IQK) = 0x%x\n",
915 rtw_read32(rtwdev, 0xea0),
916 rtw_read32(rtwdev, 0xea8));
917
918 rx_fail = rtw_read32_mask(rtwdev, REG_IQK_RES_RY, BIT_IQK_RX_FAIL);
919 rx_x = rtw_read32_mask(rtwdev, REG_IQK_RES_RX, BIT_MASK_RES_RX);
920 rx_y = rtw_read32_mask(rtwdev, REG_IQK_RES_RY, BIT_MASK_RES_RY);
921 rx_y = abs(iqkxy_to_s32(rx_y));
922
923 if (!rx_fail && rx_x < IQK_RX_X_UPPER && rx_x > IQK_RX_X_LOWER &&
924 rx_y < IQK_RX_Y_LMT)
925 return IQK_RX_OK;
926
927 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] %s RXIQK STEP2 is failed\n",
928 iqk_cfg->name);
929
930 return 0;
931 }
932
rtw8723d_iqk_one_shot(struct rtw_dev * rtwdev,bool tx,const struct rtw_8723d_iqk_cfg * iqk_cfg)933 static void rtw8723d_iqk_one_shot(struct rtw_dev *rtwdev, bool tx,
934 const struct rtw_8723d_iqk_cfg *iqk_cfg)
935 {
936 u32 pts = (tx ? iqk_cfg->val_iqkpts : 0xf9000000);
937
938 /* enter IQK mode */
939 rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, EN_IQK);
940 rtw8723d_iqk_config_lte_path_gnt(rtwdev);
941
942 rtw_write32(rtwdev, REG_LTECOEX_CTRL, 0x800f0054);
943 mdelay(1);
944 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] GNT_BT @%s %sIQK1 = 0x%x\n",
945 iqk_cfg->name, tx ? "TX" : "RX",
946 rtw_read32(rtwdev, REG_LTECOEX_READ_DATA));
947 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0x948 @%s %sIQK1 = 0x%x\n",
948 iqk_cfg->name, tx ? "TX" : "RX",
949 rtw_read32(rtwdev, REG_BB_SEL_BTG));
950
951 /* One shot, LOK & IQK */
952 rtw_write32(rtwdev, REG_IQK_AGC_PTS_11N, pts);
953 rtw_write32(rtwdev, REG_IQK_AGC_PTS_11N, 0xf8000000);
954
955 if (!check_hw_ready(rtwdev, REG_IQK_RES_RY, BIT_IQK_DONE, 1))
956 rtw_warn(rtwdev, "%s %s IQK isn't done\n", iqk_cfg->name,
957 tx ? "TX" : "RX");
958 }
959
rtw8723d_iqk_txrx_path_post(struct rtw_dev * rtwdev,const struct rtw_8723d_iqk_cfg * iqk_cfg,const struct iqk_backup_regs * backup)960 static void rtw8723d_iqk_txrx_path_post(struct rtw_dev *rtwdev,
961 const struct rtw_8723d_iqk_cfg *iqk_cfg,
962 const struct iqk_backup_regs *backup)
963 {
964 rtw8723d_iqk_restore_lte_path_gnt(rtwdev, backup);
965 rtw_write32(rtwdev, REG_BB_SEL_BTG, backup->bb_sel_btg);
966
967 /* leave IQK mode */
968 rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK);
969 mdelay(1);
970 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_padlut, 0x800, 0x0);
971 rtw_write_rf(rtwdev, RF_PATH_A, RF_WLINT, BIT(0), 0x0);
972 rtw_write_rf(rtwdev, RF_PATH_A, RF_WLSEL, BIT(0), 0x0);
973 }
974
rtw8723d_iqk_tx_path(struct rtw_dev * rtwdev,const struct rtw_8723d_iqk_cfg * iqk_cfg,const struct iqk_backup_regs * backup)975 static u8 rtw8723d_iqk_tx_path(struct rtw_dev *rtwdev,
976 const struct rtw_8723d_iqk_cfg *iqk_cfg,
977 const struct iqk_backup_regs *backup)
978 {
979 u8 status;
980
981 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path %s TXIQK!!\n", iqk_cfg->name);
982 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0x67 @%s TXIQK = 0x%x\n",
983 iqk_cfg->name,
984 rtw_read32_mask(rtwdev, REG_PAD_CTRL1, MASKBYTE3));
985
986 rtw_write32(rtwdev, REG_BB_SEL_BTG, iqk_cfg->val_bb_sel_btg);
987 rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK);
988 mdelay(1);
989 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, RFREG_MASK, 0x80000);
990 rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWA, RFREG_MASK, 0x00004);
991 rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD1, RFREG_MASK, 0x0005d);
992 rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD0, RFREG_MASK, 0xBFFE0);
993 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, RFREG_MASK, 0x00000);
994
995 /* IQK setting */
996 rtw_write32(rtwdev, REG_TXIQK_TONE_A_11N, 0x08008c0c);
997 rtw_write32(rtwdev, REG_RXIQK_TONE_A_11N, 0x38008c1c);
998 rtw_write32(rtwdev, REG_TXIQK_PI_A_11N, iqk_cfg->val_txiqk_pi);
999 rtw_write32(rtwdev, REG_RXIQK_PI_A_11N, 0x28160200);
1000 rtw_write32(rtwdev, REG_TXIQK_11N, 0x01007c00);
1001 rtw_write32(rtwdev, REG_RXIQK_11N, 0x01004800);
1002
1003 /* LOK setting */
1004 rtw_write32(rtwdev, REG_IQK_AGC_RSP_11N, 0x00462911);
1005
1006 /* PA, PAD setting */
1007 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_padlut, 0x800, 0x1);
1008 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_gaintx, 0x600, 0x0);
1009 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_gaintx, 0x1E0, 0x3);
1010 rtw_write_rf(rtwdev, RF_PATH_A, RF_RXIQGEN, 0x1F, 0xf);
1011
1012 /* LOK setting for 8723D */
1013 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, 0x10, 0x1);
1014 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_bspad, 0x1, 0x1);
1015
1016 rtw_write_rf(rtwdev, RF_PATH_A, RF_WLINT, RFREG_MASK, iqk_cfg->val_wlint);
1017 rtw_write_rf(rtwdev, RF_PATH_A, RF_WLSEL, RFREG_MASK, iqk_cfg->val_wlsel);
1018
1019 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x1 @%s TXIQK = 0x%x\n",
1020 iqk_cfg->name,
1021 rtw_read_rf(rtwdev, RF_PATH_A, RF_WLINT, RFREG_MASK));
1022 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x2 @%s TXIQK = 0x%x\n",
1023 iqk_cfg->name,
1024 rtw_read_rf(rtwdev, RF_PATH_A, RF_WLSEL, RFREG_MASK));
1025
1026 rtw8723d_iqk_one_shot(rtwdev, true, iqk_cfg);
1027 status = rtw8723d_iqk_check_tx_failed(rtwdev, iqk_cfg);
1028
1029 rtw8723d_iqk_txrx_path_post(rtwdev, iqk_cfg, backup);
1030
1031 return status;
1032 }
1033
rtw8723d_iqk_rx_path(struct rtw_dev * rtwdev,const struct rtw_8723d_iqk_cfg * iqk_cfg,const struct iqk_backup_regs * backup)1034 static u8 rtw8723d_iqk_rx_path(struct rtw_dev *rtwdev,
1035 const struct rtw_8723d_iqk_cfg *iqk_cfg,
1036 const struct iqk_backup_regs *backup)
1037 {
1038 u32 tx_x, tx_y;
1039 u8 status;
1040
1041 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path %s RXIQK Step1!!\n",
1042 iqk_cfg->name);
1043 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0x67 @%s RXIQK1 = 0x%x\n",
1044 iqk_cfg->name,
1045 rtw_read32_mask(rtwdev, REG_PAD_CTRL1, MASKBYTE3));
1046 rtw_write32(rtwdev, REG_BB_SEL_BTG, iqk_cfg->val_bb_sel_btg);
1047
1048 rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK);
1049
1050 /* IQK setting */
1051 rtw_write32(rtwdev, REG_TXIQK_11N, 0x01007c00);
1052 rtw_write32(rtwdev, REG_RXIQK_11N, 0x01004800);
1053
1054 /* path IQK setting */
1055 rtw_write32(rtwdev, REG_TXIQK_TONE_A_11N, 0x18008c1c);
1056 rtw_write32(rtwdev, REG_RXIQK_TONE_A_11N, 0x38008c1c);
1057 rtw_write32(rtwdev, REG_TX_IQK_TONE_B, 0x38008c1c);
1058 rtw_write32(rtwdev, REG_RX_IQK_TONE_B, 0x38008c1c);
1059 rtw_write32(rtwdev, REG_TXIQK_PI_A_11N, 0x82160000);
1060 rtw_write32(rtwdev, REG_RXIQK_PI_A_11N, 0x28160000);
1061
1062 /* LOK setting */
1063 rtw_write32(rtwdev, REG_IQK_AGC_RSP_11N, 0x0046a911);
1064
1065 /* RXIQK mode */
1066 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, RFREG_MASK, 0x80000);
1067 rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWA, RFREG_MASK, 0x00006);
1068 rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD1, RFREG_MASK, 0x0005f);
1069 rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD0, RFREG_MASK, 0xa7ffb);
1070 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, RFREG_MASK, 0x00000);
1071
1072 /* PA/PAD=0 */
1073 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_padlut, 0x800, 0x1);
1074 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_gaintx, 0x600, 0x0);
1075 rtw_write_rf(rtwdev, RF_PATH_A, RF_WLINT, RFREG_MASK, iqk_cfg->val_wlint);
1076 rtw_write_rf(rtwdev, RF_PATH_A, RF_WLSEL, RFREG_MASK, iqk_cfg->val_wlsel);
1077
1078 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x1@ path %s RXIQK1 = 0x%x\n",
1079 iqk_cfg->name,
1080 rtw_read_rf(rtwdev, RF_PATH_A, RF_WLINT, RFREG_MASK));
1081 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x2@ path %s RXIQK1 = 0x%x\n",
1082 iqk_cfg->name,
1083 rtw_read_rf(rtwdev, RF_PATH_A, RF_WLSEL, RFREG_MASK));
1084
1085 rtw8723d_iqk_one_shot(rtwdev, false, iqk_cfg);
1086 status = rtw8723d_iqk_check_tx_failed(rtwdev, iqk_cfg);
1087
1088 if (!status)
1089 goto restore;
1090
1091 /* second round */
1092 tx_x = rtw_read32_mask(rtwdev, REG_IQK_RES_TX, BIT_MASK_RES_TX);
1093 tx_y = rtw_read32_mask(rtwdev, REG_IQK_RES_TY, BIT_MASK_RES_TY);
1094
1095 rtw_write32(rtwdev, REG_TXIQK_11N, BIT_SET_TXIQK_11N(tx_x, tx_y));
1096 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0xe40 = 0x%x u4tmp = 0x%x\n",
1097 rtw_read32(rtwdev, REG_TXIQK_11N),
1098 BIT_SET_TXIQK_11N(tx_x, tx_y));
1099
1100 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path %s RXIQK STEP2!!\n",
1101 iqk_cfg->name);
1102 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] 0x67 @%s RXIQK2 = 0x%x\n",
1103 iqk_cfg->name,
1104 rtw_read32_mask(rtwdev, REG_PAD_CTRL1, MASKBYTE3));
1105
1106 rtw_write32(rtwdev, REG_RXIQK_11N, 0x01004800);
1107 rtw_write32(rtwdev, REG_TXIQK_TONE_A_11N, 0x38008c1c);
1108 rtw_write32(rtwdev, REG_RXIQK_TONE_A_11N, 0x18008c1c);
1109 rtw_write32(rtwdev, REG_TX_IQK_TONE_B, 0x38008c1c);
1110 rtw_write32(rtwdev, REG_RX_IQK_TONE_B, 0x38008c1c);
1111 rtw_write32(rtwdev, REG_TXIQK_PI_A_11N, 0x82170000);
1112 rtw_write32(rtwdev, REG_RXIQK_PI_A_11N, 0x28171400);
1113
1114 /* LOK setting */
1115 rtw_write32(rtwdev, REG_IQK_AGC_RSP_11N, 0x0046a8d1);
1116
1117 /* RXIQK mode */
1118 rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK);
1119 mdelay(1);
1120 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, 0x80000, 0x1);
1121 rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWA, RFREG_MASK, 0x00007);
1122 rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD1, RFREG_MASK, 0x0005f);
1123 rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD0, RFREG_MASK, 0xb3fdb);
1124 rtw_write_rf(rtwdev, RF_PATH_A, iqk_cfg->reg_lutwe, RFREG_MASK, 0x00000);
1125
1126 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x1 @%s RXIQK2 = 0x%x\n",
1127 iqk_cfg->name,
1128 rtw_read_rf(rtwdev, RF_PATH_A, RF_WLINT, RFREG_MASK));
1129 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] RF0x2 @%s RXIQK2 = 0x%x\n",
1130 iqk_cfg->name,
1131 rtw_read_rf(rtwdev, RF_PATH_A, RF_WLSEL, RFREG_MASK));
1132
1133 rtw8723d_iqk_one_shot(rtwdev, false, iqk_cfg);
1134 status |= rtw8723d_iqk_check_rx_failed(rtwdev, iqk_cfg);
1135
1136 restore:
1137 rtw8723d_iqk_txrx_path_post(rtwdev, iqk_cfg, backup);
1138
1139 return status;
1140 }
1141
1142 static
rtw8723d_iqk_fill_s1_matrix(struct rtw_dev * rtwdev,const s32 result[])1143 void rtw8723d_iqk_fill_s1_matrix(struct rtw_dev *rtwdev, const s32 result[])
1144 {
1145 s32 oldval_1;
1146 s32 x, y;
1147 s32 tx1_a, tx1_a_ext;
1148 s32 tx1_c, tx1_c_ext;
1149
1150 if (result[IQK_S1_TX_X] == 0)
1151 return;
1152
1153 oldval_1 = rtw_read32_mask(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE,
1154 BIT_MASK_TXIQ_ELM_D);
1155
1156 x = iqkxy_to_s32(result[IQK_S1_TX_X]);
1157 tx1_a = iqk_mult(x, oldval_1, &tx1_a_ext);
1158 rtw_write32_mask(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE,
1159 BIT_MASK_TXIQ_ELM_A, tx1_a);
1160 rtw_write32_mask(rtwdev, REG_OFDM_0_ECCA_THRESHOLD,
1161 BIT_MASK_OFDM0_EXT_A, tx1_a_ext);
1162
1163 y = iqkxy_to_s32(result[IQK_S1_TX_Y]);
1164 tx1_c = iqk_mult(y, oldval_1, &tx1_c_ext);
1165 rtw_write32_mask(rtwdev, REG_TXIQK_MATRIXA_LSB2_11N, MASKH4BITS,
1166 BIT_SET_TXIQ_ELM_C1(tx1_c));
1167 rtw_write32_mask(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE,
1168 BIT_MASK_TXIQ_ELM_C, BIT_SET_TXIQ_ELM_C2(tx1_c));
1169 rtw_write32_mask(rtwdev, REG_OFDM_0_ECCA_THRESHOLD,
1170 BIT_MASK_OFDM0_EXT_C, tx1_c_ext);
1171
1172 rtw_dbg(rtwdev, RTW_DBG_RFK,
1173 "[IQK] X = 0x%x, TX1_A = 0x%x, oldval_1 0x%x\n",
1174 x, tx1_a, oldval_1);
1175 rtw_dbg(rtwdev, RTW_DBG_RFK,
1176 "[IQK] Y = 0x%x, TX1_C = 0x%x\n", y, tx1_c);
1177
1178 if (result[IQK_S1_RX_X] == 0)
1179 return;
1180
1181 rtw_write32_mask(rtwdev, REG_A_RXIQI, BIT_MASK_RXIQ_S1_X,
1182 result[IQK_S1_RX_X]);
1183 rtw_write32_mask(rtwdev, REG_A_RXIQI, BIT_MASK_RXIQ_S1_Y1,
1184 BIT_SET_RXIQ_S1_Y1(result[IQK_S1_RX_Y]));
1185 rtw_write32_mask(rtwdev, REG_RXIQK_MATRIX_LSB_11N, BIT_MASK_RXIQ_S1_Y2,
1186 BIT_SET_RXIQ_S1_Y2(result[IQK_S1_RX_Y]));
1187 }
1188
1189 static
rtw8723d_iqk_fill_s0_matrix(struct rtw_dev * rtwdev,const s32 result[])1190 void rtw8723d_iqk_fill_s0_matrix(struct rtw_dev *rtwdev, const s32 result[])
1191 {
1192 s32 oldval_0;
1193 s32 x, y;
1194 s32 tx0_a, tx0_a_ext;
1195 s32 tx0_c, tx0_c_ext;
1196
1197 if (result[IQK_S0_TX_X] == 0)
1198 return;
1199
1200 oldval_0 = rtw_read32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_D_S0);
1201
1202 x = iqkxy_to_s32(result[IQK_S0_TX_X]);
1203 tx0_a = iqk_mult(x, oldval_0, &tx0_a_ext);
1204
1205 rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_S0, tx0_a);
1206 rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_EXT_S0, tx0_a_ext);
1207
1208 y = iqkxy_to_s32(result[IQK_S0_TX_Y]);
1209 tx0_c = iqk_mult(y, oldval_0, &tx0_c_ext);
1210
1211 rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_S0, tx0_c);
1212 rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_EXT_S0, tx0_c_ext);
1213
1214 if (result[IQK_S0_RX_X] == 0)
1215 return;
1216
1217 rtw_write32_mask(rtwdev, REG_RXIQ_AB_S0, BIT_MASK_RXIQ_X_S0,
1218 result[IQK_S0_RX_X]);
1219 rtw_write32_mask(rtwdev, REG_RXIQ_AB_S0, BIT_MASK_RXIQ_Y_S0,
1220 result[IQK_S0_RX_Y]);
1221 }
1222
rtw8723d_iqk_path_adda_on(struct rtw_dev * rtwdev)1223 static void rtw8723d_iqk_path_adda_on(struct rtw_dev *rtwdev)
1224 {
1225 int i;
1226
1227 for (i = 0; i < IQK_ADDA_REG_NUM; i++)
1228 rtw_write32(rtwdev, iqk_adda_regs[i], 0x03c00016);
1229 }
1230
rtw8723d_iqk_config_mac(struct rtw_dev * rtwdev)1231 static void rtw8723d_iqk_config_mac(struct rtw_dev *rtwdev)
1232 {
1233 rtw_write8(rtwdev, REG_TXPAUSE, 0xff);
1234 }
1235
1236 static
rtw8723d_iqk_rf_standby(struct rtw_dev * rtwdev,enum rtw_rf_path path)1237 void rtw8723d_iqk_rf_standby(struct rtw_dev *rtwdev, enum rtw_rf_path path)
1238 {
1239 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path-%s standby mode!\n",
1240 path == RF_PATH_A ? "S1" : "S0");
1241
1242 rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK);
1243 mdelay(1);
1244 rtw_write_rf(rtwdev, path, RF_MODE, RFREG_MASK, 0x10000);
1245 rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, EN_IQK);
1246 }
1247
1248 static
rtw8723d_iqk_similarity_cmp(struct rtw_dev * rtwdev,s32 result[][IQK_NR],u8 c1,u8 c2)1249 bool rtw8723d_iqk_similarity_cmp(struct rtw_dev *rtwdev, s32 result[][IQK_NR],
1250 u8 c1, u8 c2)
1251 {
1252 u32 i, j, diff;
1253 u32 bitmap = 0;
1254 u8 candidate[PATH_NR] = {IQK_ROUND_INVALID, IQK_ROUND_INVALID};
1255 bool ret = true;
1256
1257 s32 tmp1, tmp2;
1258
1259 for (i = 0; i < IQK_NR; i++) {
1260 tmp1 = iqkxy_to_s32(result[c1][i]);
1261 tmp2 = iqkxy_to_s32(result[c2][i]);
1262
1263 diff = abs(tmp1 - tmp2);
1264
1265 if (diff <= MAX_TOLERANCE)
1266 continue;
1267
1268 if ((i == IQK_S1_RX_X || i == IQK_S0_RX_X) && !bitmap) {
1269 if (result[c1][i] + result[c1][i + 1] == 0)
1270 candidate[i / IQK_SX_NR] = c2;
1271 else if (result[c2][i] + result[c2][i + 1] == 0)
1272 candidate[i / IQK_SX_NR] = c1;
1273 else
1274 bitmap |= BIT(i);
1275 } else {
1276 bitmap |= BIT(i);
1277 }
1278 }
1279
1280 if (bitmap != 0)
1281 goto check_sim;
1282
1283 for (i = 0; i < PATH_NR; i++) {
1284 if (candidate[i] == IQK_ROUND_INVALID)
1285 continue;
1286
1287 for (j = i * IQK_SX_NR; j < i * IQK_SX_NR + 2; j++)
1288 result[IQK_ROUND_HYBRID][j] = result[candidate[i]][j];
1289 ret = false;
1290 }
1291
1292 return ret;
1293
1294 check_sim:
1295 for (i = 0; i < IQK_NR; i++) {
1296 j = i & ~1; /* 2 bits are a pair for IQ[X, Y] */
1297 if (bitmap & GENMASK(j + 1, j))
1298 continue;
1299
1300 result[IQK_ROUND_HYBRID][i] = result[c1][i];
1301 }
1302
1303 return false;
1304 }
1305
1306 static
rtw8723d_iqk_precfg_path(struct rtw_dev * rtwdev,enum rtw8723d_path path)1307 void rtw8723d_iqk_precfg_path(struct rtw_dev *rtwdev, enum rtw8723d_path path)
1308 {
1309 if (path == PATH_S0) {
1310 rtw8723d_iqk_rf_standby(rtwdev, RF_PATH_A);
1311 rtw8723d_iqk_path_adda_on(rtwdev);
1312 }
1313
1314 rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, EN_IQK);
1315 rtw_write32(rtwdev, REG_TXIQK_11N, 0x01007c00);
1316 rtw_write32(rtwdev, REG_RXIQK_11N, 0x01004800);
1317
1318 if (path == PATH_S1) {
1319 rtw8723d_iqk_rf_standby(rtwdev, RF_PATH_B);
1320 rtw8723d_iqk_path_adda_on(rtwdev);
1321 }
1322 }
1323
1324 static
rtw8723d_iqk_one_round(struct rtw_dev * rtwdev,s32 result[][IQK_NR],u8 t,const struct iqk_backup_regs * backup)1325 void rtw8723d_iqk_one_round(struct rtw_dev *rtwdev, s32 result[][IQK_NR], u8 t,
1326 const struct iqk_backup_regs *backup)
1327 {
1328 u32 i;
1329 u8 s1_ok, s0_ok;
1330
1331 rtw_dbg(rtwdev, RTW_DBG_RFK,
1332 "[IQK] IQ Calibration for 1T1R_S0/S1 for %d times\n", t);
1333
1334 rtw8723d_iqk_path_adda_on(rtwdev);
1335 rtw8723d_iqk_config_mac(rtwdev);
1336 rtw_write32_mask(rtwdev, REG_CCK_ANT_SEL_11N, 0x0f000000, 0xf);
1337 rtw_write32(rtwdev, REG_BB_RX_PATH_11N, 0x03a05611);
1338 rtw_write32(rtwdev, REG_TRMUX_11N, 0x000800e4);
1339 rtw_write32(rtwdev, REG_BB_PWR_SAV1_11N, 0x25204200);
1340 rtw8723d_iqk_precfg_path(rtwdev, PATH_S1);
1341
1342 for (i = 0; i < PATH_IQK_RETRY; i++) {
1343 s1_ok = rtw8723d_iqk_tx_path(rtwdev, &iqk_tx_cfg[PATH_S1], backup);
1344 if (s1_ok == IQK_TX_OK) {
1345 rtw_dbg(rtwdev, RTW_DBG_RFK,
1346 "[IQK] path S1 Tx IQK Success!!\n");
1347 result[t][IQK_S1_TX_X] =
1348 rtw_read32_mask(rtwdev, REG_IQK_RES_TX, BIT_MASK_RES_TX);
1349 result[t][IQK_S1_TX_Y] =
1350 rtw_read32_mask(rtwdev, REG_IQK_RES_TY, BIT_MASK_RES_TY);
1351 break;
1352 }
1353
1354 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S1 Tx IQK Fail!!\n");
1355 result[t][IQK_S1_TX_X] = 0x100;
1356 result[t][IQK_S1_TX_Y] = 0x0;
1357 }
1358
1359 for (i = 0; i < PATH_IQK_RETRY; i++) {
1360 s1_ok = rtw8723d_iqk_rx_path(rtwdev, &iqk_tx_cfg[PATH_S1], backup);
1361 if (s1_ok == (IQK_TX_OK | IQK_RX_OK)) {
1362 rtw_dbg(rtwdev, RTW_DBG_RFK,
1363 "[IQK] path S1 Rx IQK Success!!\n");
1364 result[t][IQK_S1_RX_X] =
1365 rtw_read32_mask(rtwdev, REG_IQK_RES_RX, BIT_MASK_RES_RX);
1366 result[t][IQK_S1_RX_Y] =
1367 rtw_read32_mask(rtwdev, REG_IQK_RES_RY, BIT_MASK_RES_RY);
1368 break;
1369 }
1370
1371 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S1 Rx IQK Fail!!\n");
1372 result[t][IQK_S1_RX_X] = 0x100;
1373 result[t][IQK_S1_RX_Y] = 0x0;
1374 }
1375
1376 if (s1_ok == 0x0)
1377 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S1 IQK is failed!!\n");
1378
1379 rtw8723d_iqk_precfg_path(rtwdev, PATH_S0);
1380
1381 for (i = 0; i < PATH_IQK_RETRY; i++) {
1382 s0_ok = rtw8723d_iqk_tx_path(rtwdev, &iqk_tx_cfg[PATH_S0], backup);
1383 if (s0_ok == IQK_TX_OK) {
1384 rtw_dbg(rtwdev, RTW_DBG_RFK,
1385 "[IQK] path S0 Tx IQK Success!!\n");
1386 result[t][IQK_S0_TX_X] =
1387 rtw_read32_mask(rtwdev, REG_IQK_RES_TX, BIT_MASK_RES_TX);
1388 result[t][IQK_S0_TX_Y] =
1389 rtw_read32_mask(rtwdev, REG_IQK_RES_TY, BIT_MASK_RES_TY);
1390 break;
1391 }
1392
1393 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S0 Tx IQK Fail!!\n");
1394 result[t][IQK_S0_TX_X] = 0x100;
1395 result[t][IQK_S0_TX_Y] = 0x0;
1396 }
1397
1398 for (i = 0; i < PATH_IQK_RETRY; i++) {
1399 s0_ok = rtw8723d_iqk_rx_path(rtwdev, &iqk_tx_cfg[PATH_S0], backup);
1400 if (s0_ok == (IQK_TX_OK | IQK_RX_OK)) {
1401 rtw_dbg(rtwdev, RTW_DBG_RFK,
1402 "[IQK] path S0 Rx IQK Success!!\n");
1403
1404 result[t][IQK_S0_RX_X] =
1405 rtw_read32_mask(rtwdev, REG_IQK_RES_RX, BIT_MASK_RES_RX);
1406 result[t][IQK_S0_RX_Y] =
1407 rtw_read32_mask(rtwdev, REG_IQK_RES_RY, BIT_MASK_RES_RY);
1408 break;
1409 }
1410
1411 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S0 Rx IQK Fail!!\n");
1412 result[t][IQK_S0_RX_X] = 0x100;
1413 result[t][IQK_S0_RX_Y] = 0x0;
1414 }
1415
1416 if (s0_ok == 0x0)
1417 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] path S0 IQK is failed!!\n");
1418
1419 rtw_write32_mask(rtwdev, REG_FPGA0_IQK_11N, BIT_MASK_IQK_MOD, RST_IQK);
1420 mdelay(1);
1421
1422 rtw_dbg(rtwdev, RTW_DBG_RFK,
1423 "[IQK] back to BB mode, load original value!\n");
1424 }
1425
rtw8723d_phy_calibration(struct rtw_dev * rtwdev)1426 static void rtw8723d_phy_calibration(struct rtw_dev *rtwdev)
1427 {
1428 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1429 s32 result[IQK_ROUND_SIZE][IQK_NR];
1430 struct iqk_backup_regs backup;
1431 u8 i, j;
1432 u8 final_candidate = IQK_ROUND_INVALID;
1433 bool good;
1434
1435 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] Start!!!\n");
1436
1437 memset(result, 0, sizeof(result));
1438
1439 rtw8723d_iqk_backup_path_ctrl(rtwdev, &backup);
1440 rtw8723d_iqk_backup_lte_path_gnt(rtwdev, &backup);
1441 rtw8723d_iqk_backup_regs(rtwdev, &backup);
1442
1443 for (i = IQK_ROUND_0; i <= IQK_ROUND_2; i++) {
1444 rtw8723d_iqk_config_path_ctrl(rtwdev);
1445 rtw8723d_iqk_config_lte_path_gnt(rtwdev);
1446
1447 rtw8723d_iqk_one_round(rtwdev, result, i, &backup);
1448
1449 if (i > IQK_ROUND_0)
1450 rtw8723d_iqk_restore_regs(rtwdev, &backup);
1451 rtw8723d_iqk_restore_lte_path_gnt(rtwdev, &backup);
1452 rtw8723d_iqk_restore_path_ctrl(rtwdev, &backup);
1453
1454 for (j = IQK_ROUND_0; j < i; j++) {
1455 good = rtw8723d_iqk_similarity_cmp(rtwdev, result, j, i);
1456
1457 if (good) {
1458 final_candidate = j;
1459 rtw_dbg(rtwdev, RTW_DBG_RFK,
1460 "[IQK] cmp %d:%d final_candidate is %x\n",
1461 j, i, final_candidate);
1462 goto iqk_done;
1463 }
1464 }
1465 }
1466
1467 if (final_candidate == IQK_ROUND_INVALID) {
1468 s32 reg_tmp = 0;
1469
1470 for (i = 0; i < IQK_NR; i++)
1471 reg_tmp += result[IQK_ROUND_HYBRID][i];
1472
1473 if (reg_tmp != 0) {
1474 final_candidate = IQK_ROUND_HYBRID;
1475 } else {
1476 WARN(1, "IQK is failed\n");
1477 goto out;
1478 }
1479 }
1480
1481 iqk_done:
1482 rtw8723d_iqk_fill_s1_matrix(rtwdev, result[final_candidate]);
1483 rtw8723d_iqk_fill_s0_matrix(rtwdev, result[final_candidate]);
1484
1485 dm_info->iqk.result.s1_x = result[final_candidate][IQK_S1_TX_X];
1486 dm_info->iqk.result.s1_y = result[final_candidate][IQK_S1_TX_Y];
1487 dm_info->iqk.result.s0_x = result[final_candidate][IQK_S0_TX_X];
1488 dm_info->iqk.result.s0_y = result[final_candidate][IQK_S0_TX_Y];
1489 dm_info->iqk.done = true;
1490
1491 out:
1492 rtw_write32(rtwdev, REG_BB_SEL_BTG, backup.bb_sel_btg);
1493
1494 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] final_candidate is %x\n",
1495 final_candidate);
1496
1497 for (i = IQK_ROUND_0; i < IQK_ROUND_SIZE; i++)
1498 rtw_dbg(rtwdev, RTW_DBG_RFK,
1499 "[IQK] Result %u: rege94_s1=%x rege9c_s1=%x regea4_s1=%x regeac_s1=%x rege94_s0=%x rege9c_s0=%x regea4_s0=%x regeac_s0=%x %s\n",
1500 i,
1501 result[i][0], result[i][1], result[i][2], result[i][3],
1502 result[i][4], result[i][5], result[i][6], result[i][7],
1503 final_candidate == i ? "(final candidate)" : "");
1504
1505 rtw_dbg(rtwdev, RTW_DBG_RFK,
1506 "[IQK]0xc80 = 0x%x 0xc94 = 0x%x 0xc14 = 0x%x 0xca0 = 0x%x\n",
1507 rtw_read32(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE),
1508 rtw_read32(rtwdev, REG_TXIQK_MATRIXA_LSB2_11N),
1509 rtw_read32(rtwdev, REG_A_RXIQI),
1510 rtw_read32(rtwdev, REG_RXIQK_MATRIX_LSB_11N));
1511 rtw_dbg(rtwdev, RTW_DBG_RFK,
1512 "[IQK]0xcd0 = 0x%x 0xcd4 = 0x%x 0xcd8 = 0x%x\n",
1513 rtw_read32(rtwdev, REG_TXIQ_AB_S0),
1514 rtw_read32(rtwdev, REG_TXIQ_CD_S0),
1515 rtw_read32(rtwdev, REG_RXIQ_AB_S0));
1516
1517 rtw_dbg(rtwdev, RTW_DBG_RFK, "[IQK] finished\n");
1518 }
1519
rtw8723d_phy_cck_pd_set(struct rtw_dev * rtwdev,u8 new_lvl)1520 static void rtw8723d_phy_cck_pd_set(struct rtw_dev *rtwdev, u8 new_lvl)
1521 {
1522 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1523 u8 pd[CCK_PD_LV_MAX] = {3, 7, 13, 13, 13};
1524 u8 cck_n_rx;
1525
1526 rtw_dbg(rtwdev, RTW_DBG_PHY, "lv: (%d) -> (%d)\n",
1527 dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A], new_lvl);
1528
1529 if (dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A] == new_lvl)
1530 return;
1531
1532 cck_n_rx = (rtw_read8_mask(rtwdev, REG_CCK0_FAREPORT, BIT_CCK0_2RX) &&
1533 rtw_read8_mask(rtwdev, REG_CCK0_FAREPORT, BIT_CCK0_MRC)) ? 2 : 1;
1534 rtw_dbg(rtwdev, RTW_DBG_PHY,
1535 "is_linked=%d, lv=%d, n_rx=%d, cs_ratio=0x%x, pd_th=0x%x, cck_fa_avg=%d\n",
1536 rtw_is_assoc(rtwdev), new_lvl, cck_n_rx,
1537 dm_info->cck_pd_default + new_lvl * 2,
1538 pd[new_lvl], dm_info->cck_fa_avg);
1539
1540 dm_info->cck_fa_avg = CCK_FA_AVG_RESET;
1541
1542 dm_info->cck_pd_lv[RTW_CHANNEL_WIDTH_20][RF_PATH_A] = new_lvl;
1543 rtw_write32_mask(rtwdev, REG_PWRTH, 0x3f0000, pd[new_lvl]);
1544 rtw_write32_mask(rtwdev, REG_PWRTH2, 0x1f0000,
1545 dm_info->cck_pd_default + new_lvl * 2);
1546 }
1547
1548 /* for coex */
rtw8723d_coex_cfg_init(struct rtw_dev * rtwdev)1549 static void rtw8723d_coex_cfg_init(struct rtw_dev *rtwdev)
1550 {
1551 /* enable TBTT nterrupt */
1552 rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION);
1553
1554 /* BT report packet sample rate */
1555 /* 0x790[5:0]=0x5 */
1556 rtw_write8_mask(rtwdev, REG_BT_TDMA_TIME, BIT_MASK_SAMPLE_RATE, 0x5);
1557
1558 /* enable BT counter statistics */
1559 rtw_write8(rtwdev, REG_BT_STAT_CTRL, 0x1);
1560
1561 /* enable PTA (3-wire function form BT side) */
1562 rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_PTA_EN);
1563 rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_PO_BT_PTA_PINS);
1564
1565 /* enable PTA (tx/rx signal form WiFi side) */
1566 rtw_write8_set(rtwdev, REG_QUEUE_CTRL, BIT_PTA_WL_TX_EN);
1567 }
1568
rtw8723d_coex_cfg_gnt_fix(struct rtw_dev * rtwdev)1569 static void rtw8723d_coex_cfg_gnt_fix(struct rtw_dev *rtwdev)
1570 {
1571 }
1572
rtw8723d_coex_cfg_gnt_debug(struct rtw_dev * rtwdev)1573 static void rtw8723d_coex_cfg_gnt_debug(struct rtw_dev *rtwdev)
1574 {
1575 rtw_write8_mask(rtwdev, REG_LEDCFG2, BIT(6), 0);
1576 rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 3, BIT(0), 0);
1577 rtw_write8_mask(rtwdev, REG_GPIO_INTM + 2, BIT(4), 0);
1578 rtw_write8_mask(rtwdev, REG_GPIO_MUXCFG + 2, BIT(1), 0);
1579 rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 3, BIT(1), 0);
1580 rtw_write8_mask(rtwdev, REG_PAD_CTRL1 + 2, BIT(7), 0);
1581 rtw_write8_mask(rtwdev, REG_SYS_CLKR + 1, BIT(1), 0);
1582 rtw_write8_mask(rtwdev, REG_SYS_SDIO_CTRL + 3, BIT(3), 0);
1583 }
1584
rtw8723d_coex_cfg_rfe_type(struct rtw_dev * rtwdev)1585 static void rtw8723d_coex_cfg_rfe_type(struct rtw_dev *rtwdev)
1586 {
1587 struct rtw_efuse *efuse = &rtwdev->efuse;
1588 struct rtw_coex *coex = &rtwdev->coex;
1589 struct rtw_coex_rfe *coex_rfe = &coex->rfe;
1590 bool aux = efuse->bt_setting & BIT(6);
1591
1592 coex_rfe->rfe_module_type = rtwdev->efuse.rfe_option;
1593 coex_rfe->ant_switch_polarity = 0;
1594 coex_rfe->ant_switch_exist = false;
1595 coex_rfe->ant_switch_with_bt = false;
1596 coex_rfe->ant_switch_diversity = false;
1597 coex_rfe->wlg_at_btg = true;
1598
1599 /* decide antenna at main or aux */
1600 if (efuse->share_ant) {
1601 if (aux)
1602 rtw_write16(rtwdev, REG_BB_SEL_BTG, 0x80);
1603 else
1604 rtw_write16(rtwdev, REG_BB_SEL_BTG, 0x200);
1605 } else {
1606 if (aux)
1607 rtw_write16(rtwdev, REG_BB_SEL_BTG, 0x280);
1608 else
1609 rtw_write16(rtwdev, REG_BB_SEL_BTG, 0x0);
1610 }
1611
1612 /* disable LTE coex in wifi side */
1613 rtw_coex_write_indirect_reg(rtwdev, LTE_COEX_CTRL, BIT_LTE_COEX_EN, 0x0);
1614 rtw_coex_write_indirect_reg(rtwdev, LTE_WL_TRX_CTRL, MASKLWORD, 0xffff);
1615 rtw_coex_write_indirect_reg(rtwdev, LTE_BT_TRX_CTRL, MASKLWORD, 0xffff);
1616 }
1617
rtw8723d_coex_cfg_wl_tx_power(struct rtw_dev * rtwdev,u8 wl_pwr)1618 static void rtw8723d_coex_cfg_wl_tx_power(struct rtw_dev *rtwdev, u8 wl_pwr)
1619 {
1620 struct rtw_coex *coex = &rtwdev->coex;
1621 struct rtw_coex_dm *coex_dm = &coex->dm;
1622 static const u8 wl_tx_power[] = {0xb2, 0x90};
1623 u8 pwr;
1624
1625 if (wl_pwr == coex_dm->cur_wl_pwr_lvl)
1626 return;
1627
1628 coex_dm->cur_wl_pwr_lvl = wl_pwr;
1629
1630 if (coex_dm->cur_wl_pwr_lvl >= ARRAY_SIZE(wl_tx_power))
1631 coex_dm->cur_wl_pwr_lvl = ARRAY_SIZE(wl_tx_power) - 1;
1632
1633 pwr = wl_tx_power[coex_dm->cur_wl_pwr_lvl];
1634
1635 rtw_write8(rtwdev, REG_ANA_PARAM1 + 3, pwr);
1636 }
1637
rtw8723d_coex_cfg_wl_rx_gain(struct rtw_dev * rtwdev,bool low_gain)1638 static void rtw8723d_coex_cfg_wl_rx_gain(struct rtw_dev *rtwdev, bool low_gain)
1639 {
1640 struct rtw_coex *coex = &rtwdev->coex;
1641 struct rtw_coex_dm *coex_dm = &coex->dm;
1642 /* WL Rx Low gain on */
1643 static const u32 wl_rx_low_gain_on[] = {
1644 0xec120101, 0xeb130101, 0xce140101, 0xcd150101, 0xcc160101,
1645 0xcb170101, 0xca180101, 0x8d190101, 0x8c1a0101, 0x8b1b0101,
1646 0x4f1c0101, 0x4e1d0101, 0x4d1e0101, 0x4c1f0101, 0x0e200101,
1647 0x0d210101, 0x0c220101, 0x0b230101, 0xcf240001, 0xce250001,
1648 0xcd260001, 0xcc270001, 0x8f280001
1649 };
1650 /* WL Rx Low gain off */
1651 static const u32 wl_rx_low_gain_off[] = {
1652 0xec120101, 0xeb130101, 0xea140101, 0xe9150101, 0xe8160101,
1653 0xe7170101, 0xe6180101, 0xe5190101, 0xe41a0101, 0xe31b0101,
1654 0xe21c0101, 0xe11d0101, 0xe01e0101, 0x861f0101, 0x85200101,
1655 0x84210101, 0x83220101, 0x82230101, 0x81240101, 0x80250101,
1656 0x44260101, 0x43270101, 0x42280101
1657 };
1658 u8 i;
1659
1660 if (low_gain == coex_dm->cur_wl_rx_low_gain_en)
1661 return;
1662
1663 coex_dm->cur_wl_rx_low_gain_en = low_gain;
1664
1665 if (coex_dm->cur_wl_rx_low_gain_en) {
1666 for (i = 0; i < ARRAY_SIZE(wl_rx_low_gain_on); i++)
1667 rtw_write32(rtwdev, REG_AGCRSSI, wl_rx_low_gain_on[i]);
1668 } else {
1669 for (i = 0; i < ARRAY_SIZE(wl_rx_low_gain_off); i++)
1670 rtw_write32(rtwdev, REG_AGCRSSI, wl_rx_low_gain_off[i]);
1671 }
1672 }
1673
rtw8723d_pwrtrack_get_limit_ofdm(struct rtw_dev * rtwdev)1674 static u8 rtw8723d_pwrtrack_get_limit_ofdm(struct rtw_dev *rtwdev)
1675 {
1676 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1677 u8 tx_rate = dm_info->tx_rate;
1678 u8 limit_ofdm = 30;
1679
1680 switch (tx_rate) {
1681 case DESC_RATE1M...DESC_RATE5_5M:
1682 case DESC_RATE11M:
1683 break;
1684 case DESC_RATE6M...DESC_RATE48M:
1685 limit_ofdm = 36;
1686 break;
1687 case DESC_RATE54M:
1688 limit_ofdm = 34;
1689 break;
1690 case DESC_RATEMCS0...DESC_RATEMCS2:
1691 limit_ofdm = 38;
1692 break;
1693 case DESC_RATEMCS3...DESC_RATEMCS4:
1694 limit_ofdm = 36;
1695 break;
1696 case DESC_RATEMCS5...DESC_RATEMCS7:
1697 limit_ofdm = 34;
1698 break;
1699 default:
1700 rtw_warn(rtwdev, "pwrtrack unhandled tx_rate 0x%x\n", tx_rate);
1701 break;
1702 }
1703
1704 return limit_ofdm;
1705 }
1706
rtw8723d_set_iqk_matrix_by_result(struct rtw_dev * rtwdev,u32 ofdm_swing,u8 rf_path)1707 static void rtw8723d_set_iqk_matrix_by_result(struct rtw_dev *rtwdev,
1708 u32 ofdm_swing, u8 rf_path)
1709 {
1710 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1711 s32 ele_A, ele_D, ele_C;
1712 s32 ele_A_ext, ele_C_ext, ele_D_ext;
1713 s32 iqk_result_x;
1714 s32 iqk_result_y;
1715 s32 value32;
1716
1717 switch (rf_path) {
1718 default:
1719 case RF_PATH_A:
1720 iqk_result_x = dm_info->iqk.result.s1_x;
1721 iqk_result_y = dm_info->iqk.result.s1_y;
1722 break;
1723 case RF_PATH_B:
1724 iqk_result_x = dm_info->iqk.result.s0_x;
1725 iqk_result_y = dm_info->iqk.result.s0_y;
1726 break;
1727 }
1728
1729 /* new element D */
1730 ele_D = OFDM_SWING_D(ofdm_swing);
1731 iqk_mult(iqk_result_x, ele_D, &ele_D_ext);
1732 /* new element A */
1733 iqk_result_x = iqkxy_to_s32(iqk_result_x);
1734 ele_A = iqk_mult(iqk_result_x, ele_D, &ele_A_ext);
1735 /* new element C */
1736 iqk_result_y = iqkxy_to_s32(iqk_result_y);
1737 ele_C = iqk_mult(iqk_result_y, ele_D, &ele_C_ext);
1738
1739 switch (rf_path) {
1740 case RF_PATH_A:
1741 default:
1742 /* write new elements A, C, D, and element B is always 0 */
1743 value32 = BIT_SET_TXIQ_ELM_ACD(ele_A, ele_C, ele_D);
1744 rtw_write32(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE, value32);
1745 value32 = BIT_SET_TXIQ_ELM_C1(ele_C);
1746 rtw_write32_mask(rtwdev, REG_TXIQK_MATRIXA_LSB2_11N, MASKH4BITS,
1747 value32);
1748 value32 = rtw_read32(rtwdev, REG_OFDM_0_ECCA_THRESHOLD);
1749 value32 &= ~BIT_MASK_OFDM0_EXTS;
1750 value32 |= BIT_SET_OFDM0_EXTS(ele_A_ext, ele_C_ext, ele_D_ext);
1751 rtw_write32(rtwdev, REG_OFDM_0_ECCA_THRESHOLD, value32);
1752 break;
1753
1754 case RF_PATH_B:
1755 /* write new elements A, C, D, and element B is always 0 */
1756 rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_D_S0, ele_D);
1757 rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_S0, ele_C);
1758 rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_S0, ele_A);
1759
1760 rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_D_EXT_S0,
1761 ele_D_ext);
1762 rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_EXT_S0,
1763 ele_A_ext);
1764 rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_EXT_S0,
1765 ele_C_ext);
1766 break;
1767 }
1768 }
1769
rtw8723d_set_iqk_matrix(struct rtw_dev * rtwdev,s8 ofdm_index,u8 rf_path)1770 static void rtw8723d_set_iqk_matrix(struct rtw_dev *rtwdev, s8 ofdm_index,
1771 u8 rf_path)
1772 {
1773 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1774 s32 value32;
1775 u32 ofdm_swing;
1776
1777 if (ofdm_index >= RTW_OFDM_SWING_TABLE_SIZE)
1778 ofdm_index = RTW_OFDM_SWING_TABLE_SIZE - 1;
1779 else if (ofdm_index < 0)
1780 ofdm_index = 0;
1781
1782 ofdm_swing = rtw8723d_ofdm_swing_table[ofdm_index];
1783
1784 if (dm_info->iqk.done) {
1785 rtw8723d_set_iqk_matrix_by_result(rtwdev, ofdm_swing, rf_path);
1786 return;
1787 }
1788
1789 switch (rf_path) {
1790 case RF_PATH_A:
1791 default:
1792 rtw_write32(rtwdev, REG_OFDM_0_XA_TX_IQ_IMBALANCE, ofdm_swing);
1793 rtw_write32_mask(rtwdev, REG_TXIQK_MATRIXA_LSB2_11N, MASKH4BITS,
1794 0x00);
1795 value32 = rtw_read32(rtwdev, REG_OFDM_0_ECCA_THRESHOLD);
1796 value32 &= ~BIT_MASK_OFDM0_EXTS;
1797 rtw_write32(rtwdev, REG_OFDM_0_ECCA_THRESHOLD, value32);
1798 break;
1799
1800 case RF_PATH_B:
1801 /* image S1:c80 to S0:Cd0 and Cd4 */
1802 rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_S0,
1803 OFDM_SWING_A(ofdm_swing));
1804 rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_B_S0,
1805 OFDM_SWING_B(ofdm_swing));
1806 rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_S0,
1807 OFDM_SWING_C(ofdm_swing));
1808 rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_D_S0,
1809 OFDM_SWING_D(ofdm_swing));
1810 rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_D_EXT_S0, 0x0);
1811 rtw_write32_mask(rtwdev, REG_TXIQ_CD_S0, BIT_MASK_TXIQ_C_EXT_S0, 0x0);
1812 rtw_write32_mask(rtwdev, REG_TXIQ_AB_S0, BIT_MASK_TXIQ_A_EXT_S0, 0x0);
1813 break;
1814 }
1815 }
1816
rtw8723d_pwrtrack_set_ofdm_pwr(struct rtw_dev * rtwdev,s8 swing_idx,s8 txagc_idx)1817 static void rtw8723d_pwrtrack_set_ofdm_pwr(struct rtw_dev *rtwdev, s8 swing_idx,
1818 s8 txagc_idx)
1819 {
1820 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1821
1822 dm_info->txagc_remnant_ofdm = txagc_idx;
1823
1824 rtw8723d_set_iqk_matrix(rtwdev, swing_idx, RF_PATH_A);
1825 rtw8723d_set_iqk_matrix(rtwdev, swing_idx, RF_PATH_B);
1826 }
1827
rtw8723d_pwrtrack_set_cck_pwr(struct rtw_dev * rtwdev,s8 swing_idx,s8 txagc_idx)1828 static void rtw8723d_pwrtrack_set_cck_pwr(struct rtw_dev *rtwdev, s8 swing_idx,
1829 s8 txagc_idx)
1830 {
1831 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1832
1833 dm_info->txagc_remnant_cck = txagc_idx;
1834
1835 rtw_write32_mask(rtwdev, 0xab4, 0x000007FF,
1836 rtw8723d_cck_swing_table[swing_idx]);
1837 }
1838
rtw8723d_pwrtrack_set(struct rtw_dev * rtwdev,u8 path)1839 static void rtw8723d_pwrtrack_set(struct rtw_dev *rtwdev, u8 path)
1840 {
1841 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1842 struct rtw_hal *hal = &rtwdev->hal;
1843 u8 limit_ofdm;
1844 u8 limit_cck = 40;
1845 s8 final_ofdm_swing_index;
1846 s8 final_cck_swing_index;
1847
1848 limit_ofdm = rtw8723d_pwrtrack_get_limit_ofdm(rtwdev);
1849
1850 final_ofdm_swing_index = RTW_DEF_OFDM_SWING_INDEX +
1851 dm_info->delta_power_index[path];
1852 final_cck_swing_index = RTW_DEF_CCK_SWING_INDEX +
1853 dm_info->delta_power_index[path];
1854
1855 if (final_ofdm_swing_index > limit_ofdm)
1856 rtw8723d_pwrtrack_set_ofdm_pwr(rtwdev, limit_ofdm,
1857 final_ofdm_swing_index - limit_ofdm);
1858 else if (final_ofdm_swing_index < 0)
1859 rtw8723d_pwrtrack_set_ofdm_pwr(rtwdev, 0,
1860 final_ofdm_swing_index);
1861 else
1862 rtw8723d_pwrtrack_set_ofdm_pwr(rtwdev, final_ofdm_swing_index, 0);
1863
1864 if (final_cck_swing_index > limit_cck)
1865 rtw8723d_pwrtrack_set_cck_pwr(rtwdev, limit_cck,
1866 final_cck_swing_index - limit_cck);
1867 else if (final_cck_swing_index < 0)
1868 rtw8723d_pwrtrack_set_cck_pwr(rtwdev, 0,
1869 final_cck_swing_index);
1870 else
1871 rtw8723d_pwrtrack_set_cck_pwr(rtwdev, final_cck_swing_index, 0);
1872
1873 rtw_phy_set_tx_power_level(rtwdev, hal->current_channel);
1874 }
1875
rtw8723d_pwrtrack_set_xtal(struct rtw_dev * rtwdev,u8 therm_path,u8 delta)1876 static void rtw8723d_pwrtrack_set_xtal(struct rtw_dev *rtwdev, u8 therm_path,
1877 u8 delta)
1878 {
1879 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1880 const struct rtw_pwr_track_tbl *tbl = rtwdev->chip->pwr_track_tbl;
1881 const s8 *pwrtrk_xtal;
1882 s8 xtal_cap;
1883
1884 if (dm_info->thermal_avg[therm_path] >
1885 rtwdev->efuse.thermal_meter[therm_path])
1886 pwrtrk_xtal = tbl->pwrtrk_xtal_p;
1887 else
1888 pwrtrk_xtal = tbl->pwrtrk_xtal_n;
1889
1890 xtal_cap = rtwdev->efuse.crystal_cap & 0x3F;
1891 xtal_cap = clamp_t(s8, xtal_cap + pwrtrk_xtal[delta], 0, 0x3F);
1892 rtw_write32_mask(rtwdev, REG_AFE_CTRL3, BIT_MASK_XTAL,
1893 xtal_cap | (xtal_cap << 6));
1894 }
1895
rtw8723d_phy_pwrtrack(struct rtw_dev * rtwdev)1896 static void rtw8723d_phy_pwrtrack(struct rtw_dev *rtwdev)
1897 {
1898 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1899 struct rtw_swing_table swing_table;
1900 u8 thermal_value, delta, path;
1901 bool do_iqk = false;
1902
1903 rtw_phy_config_swing_table(rtwdev, &swing_table);
1904
1905 if (rtwdev->efuse.thermal_meter[0] == 0xff)
1906 return;
1907
1908 thermal_value = rtw_read_rf(rtwdev, RF_PATH_A, RF_T_METER, 0xfc00);
1909
1910 rtw_phy_pwrtrack_avg(rtwdev, thermal_value, RF_PATH_A);
1911
1912 do_iqk = rtw_phy_pwrtrack_need_iqk(rtwdev);
1913
1914 if (do_iqk)
1915 rtw8723d_lck(rtwdev);
1916
1917 if (dm_info->pwr_trk_init_trigger)
1918 dm_info->pwr_trk_init_trigger = false;
1919 else if (!rtw_phy_pwrtrack_thermal_changed(rtwdev, thermal_value,
1920 RF_PATH_A))
1921 goto iqk;
1922
1923 delta = rtw_phy_pwrtrack_get_delta(rtwdev, RF_PATH_A);
1924
1925 delta = min_t(u8, delta, RTW_PWR_TRK_TBL_SZ - 1);
1926
1927 for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
1928 s8 delta_cur, delta_last;
1929
1930 delta_last = dm_info->delta_power_index[path];
1931 delta_cur = rtw_phy_pwrtrack_get_pwridx(rtwdev, &swing_table,
1932 path, RF_PATH_A, delta);
1933 if (delta_last == delta_cur)
1934 continue;
1935
1936 dm_info->delta_power_index[path] = delta_cur;
1937 rtw8723d_pwrtrack_set(rtwdev, path);
1938 }
1939
1940 rtw8723d_pwrtrack_set_xtal(rtwdev, RF_PATH_A, delta);
1941
1942 iqk:
1943 if (do_iqk)
1944 rtw8723d_phy_calibration(rtwdev);
1945 }
1946
rtw8723d_pwr_track(struct rtw_dev * rtwdev)1947 static void rtw8723d_pwr_track(struct rtw_dev *rtwdev)
1948 {
1949 struct rtw_efuse *efuse = &rtwdev->efuse;
1950 struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1951
1952 if (efuse->power_track_type != 0)
1953 return;
1954
1955 if (!dm_info->pwr_trk_triggered) {
1956 rtw_write_rf(rtwdev, RF_PATH_A, RF_T_METER,
1957 GENMASK(17, 16), 0x03);
1958 dm_info->pwr_trk_triggered = true;
1959 return;
1960 }
1961
1962 rtw8723d_phy_pwrtrack(rtwdev);
1963 dm_info->pwr_trk_triggered = false;
1964 }
1965
rtw8723d_fill_txdesc_checksum(struct rtw_dev * rtwdev,struct rtw_tx_pkt_info * pkt_info,u8 * txdesc)1966 static void rtw8723d_fill_txdesc_checksum(struct rtw_dev *rtwdev,
1967 struct rtw_tx_pkt_info *pkt_info,
1968 u8 *txdesc)
1969 {
1970 size_t words = 32 / 2; /* calculate the first 32 bytes (16 words) */
1971 __le16 chksum = 0;
1972 __le16 *data = (__le16 *)(txdesc);
1973 struct rtw_tx_desc *tx_desc = (struct rtw_tx_desc *)txdesc;
1974
1975 le32p_replace_bits(&tx_desc->w7, 0, RTW_TX_DESC_W7_TXDESC_CHECKSUM);
1976
1977 while (words--)
1978 chksum ^= *data++;
1979
1980 chksum = ~chksum;
1981
1982 le32p_replace_bits(&tx_desc->w7, __le16_to_cpu(chksum),
1983 RTW_TX_DESC_W7_TXDESC_CHECKSUM);
1984 }
1985
1986 static struct rtw_chip_ops rtw8723d_ops = {
1987 .phy_set_param = rtw8723d_phy_set_param,
1988 .read_efuse = rtw8723d_read_efuse,
1989 .query_rx_desc = rtw8723d_query_rx_desc,
1990 .set_channel = rtw8723d_set_channel,
1991 .mac_init = rtw8723d_mac_init,
1992 .shutdown = rtw8723d_shutdown,
1993 .read_rf = rtw_phy_read_rf_sipi,
1994 .write_rf = rtw_phy_write_rf_reg_sipi,
1995 .set_tx_power_index = rtw8723d_set_tx_power_index,
1996 .set_antenna = NULL,
1997 .cfg_ldo25 = rtw8723d_cfg_ldo25,
1998 .efuse_grant = rtw8723d_efuse_grant,
1999 .false_alarm_statistics = rtw8723d_false_alarm_statistics,
2000 .phy_calibration = rtw8723d_phy_calibration,
2001 .cck_pd_set = rtw8723d_phy_cck_pd_set,
2002 .pwr_track = rtw8723d_pwr_track,
2003 .config_bfee = NULL,
2004 .set_gid_table = NULL,
2005 .cfg_csi_rate = NULL,
2006 .fill_txdesc_checksum = rtw8723d_fill_txdesc_checksum,
2007
2008 .coex_set_init = rtw8723d_coex_cfg_init,
2009 .coex_set_ant_switch = NULL,
2010 .coex_set_gnt_fix = rtw8723d_coex_cfg_gnt_fix,
2011 .coex_set_gnt_debug = rtw8723d_coex_cfg_gnt_debug,
2012 .coex_set_rfe_type = rtw8723d_coex_cfg_rfe_type,
2013 .coex_set_wl_tx_power = rtw8723d_coex_cfg_wl_tx_power,
2014 .coex_set_wl_rx_gain = rtw8723d_coex_cfg_wl_rx_gain,
2015 };
2016
2017 /* Shared-Antenna Coex Table */
2018 static const struct coex_table_para table_sant_8723d[] = {
2019 {0xffffffff, 0xffffffff}, /* case-0 */
2020 {0x55555555, 0x55555555},
2021 {0x66555555, 0x66555555},
2022 {0xaaaaaaaa, 0xaaaaaaaa},
2023 {0x5a5a5a5a, 0x5a5a5a5a},
2024 {0xfafafafa, 0xfafafafa}, /* case-5 */
2025 {0x6a5a5555, 0xaaaaaaaa},
2026 {0x6a5a56aa, 0x6a5a56aa},
2027 {0x6a5a5a5a, 0x6a5a5a5a},
2028 {0x66555555, 0x5a5a5a5a},
2029 {0x66555555, 0x6a5a5a5a}, /* case-10 */
2030 {0x66555555, 0x6a5a5aaa},
2031 {0x66555555, 0x5a5a5aaa},
2032 {0x66555555, 0x6aaa5aaa},
2033 {0x66555555, 0xaaaa5aaa},
2034 {0x66555555, 0xaaaaaaaa}, /* case-15 */
2035 {0xffff55ff, 0xfafafafa},
2036 {0xffff55ff, 0x6afa5afa},
2037 {0xaaffffaa, 0xfafafafa},
2038 {0xaa5555aa, 0x5a5a5a5a},
2039 {0xaa5555aa, 0x6a5a5a5a}, /* case-20 */
2040 {0xaa5555aa, 0xaaaaaaaa},
2041 {0xffffffff, 0x5a5a5a5a},
2042 {0xffffffff, 0x5a5a5a5a},
2043 {0xffffffff, 0x55555555},
2044 {0xffffffff, 0x5a5a5aaa}, /* case-25 */
2045 {0x55555555, 0x5a5a5a5a},
2046 {0x55555555, 0xaaaaaaaa},
2047 {0x55555555, 0x6a5a6a5a},
2048 {0x66556655, 0x66556655},
2049 {0x66556aaa, 0x6a5a6aaa}, /* case-30 */
2050 {0xffffffff, 0x5aaa5aaa},
2051 {0x56555555, 0x5a5a5aaa},
2052 };
2053
2054 /* Non-Shared-Antenna Coex Table */
2055 static const struct coex_table_para table_nsant_8723d[] = {
2056 {0xffffffff, 0xffffffff}, /* case-100 */
2057 {0x55555555, 0x55555555},
2058 {0x66555555, 0x66555555},
2059 {0xaaaaaaaa, 0xaaaaaaaa},
2060 {0x5a5a5a5a, 0x5a5a5a5a},
2061 {0xfafafafa, 0xfafafafa}, /* case-105 */
2062 {0x5afa5afa, 0x5afa5afa},
2063 {0x55555555, 0xfafafafa},
2064 {0x66555555, 0xfafafafa},
2065 {0x66555555, 0x5a5a5a5a},
2066 {0x66555555, 0x6a5a5a5a}, /* case-110 */
2067 {0x66555555, 0xaaaaaaaa},
2068 {0xffff55ff, 0xfafafafa},
2069 {0xffff55ff, 0x5afa5afa},
2070 {0xffff55ff, 0xaaaaaaaa},
2071 {0xffff55ff, 0xffff55ff}, /* case-115 */
2072 {0xaaffffaa, 0x5afa5afa},
2073 {0xaaffffaa, 0xaaaaaaaa},
2074 {0xffffffff, 0xfafafafa},
2075 {0xffffffff, 0x5afa5afa},
2076 {0xffffffff, 0xaaaaaaaa}, /* case-120 */
2077 {0x55ff55ff, 0x5afa5afa},
2078 {0x55ff55ff, 0xaaaaaaaa},
2079 {0x55ff55ff, 0x55ff55ff}
2080 };
2081
2082 /* Shared-Antenna TDMA */
2083 static const struct coex_tdma_para tdma_sant_8723d[] = {
2084 { {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-0 */
2085 { {0x61, 0x45, 0x03, 0x11, 0x11} }, /* case-1 */
2086 { {0x61, 0x3a, 0x03, 0x11, 0x11} },
2087 { {0x61, 0x30, 0x03, 0x11, 0x11} },
2088 { {0x61, 0x20, 0x03, 0x11, 0x11} },
2089 { {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-5 */
2090 { {0x61, 0x45, 0x03, 0x11, 0x10} },
2091 { {0x61, 0x3a, 0x03, 0x11, 0x10} },
2092 { {0x61, 0x30, 0x03, 0x11, 0x10} },
2093 { {0x61, 0x20, 0x03, 0x11, 0x10} },
2094 { {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-10 */
2095 { {0x61, 0x08, 0x03, 0x11, 0x14} },
2096 { {0x61, 0x08, 0x03, 0x10, 0x14} },
2097 { {0x51, 0x08, 0x03, 0x10, 0x54} },
2098 { {0x51, 0x08, 0x03, 0x10, 0x55} },
2099 { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-15 */
2100 { {0x51, 0x45, 0x03, 0x10, 0x50} },
2101 { {0x51, 0x3a, 0x03, 0x10, 0x50} },
2102 { {0x51, 0x30, 0x03, 0x10, 0x50} },
2103 { {0x51, 0x20, 0x03, 0x10, 0x50} },
2104 { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-20 */
2105 { {0x51, 0x4a, 0x03, 0x10, 0x50} },
2106 { {0x51, 0x0c, 0x03, 0x10, 0x54} },
2107 { {0x55, 0x08, 0x03, 0x10, 0x54} },
2108 { {0x65, 0x10, 0x03, 0x11, 0x10} },
2109 { {0x51, 0x10, 0x03, 0x10, 0x51} }, /* case-25 */
2110 { {0x51, 0x08, 0x03, 0x10, 0x50} },
2111 { {0x61, 0x08, 0x03, 0x11, 0x11} }
2112 };
2113
2114 /* Non-Shared-Antenna TDMA */
2115 static const struct coex_tdma_para tdma_nsant_8723d[] = {
2116 { {0x00, 0x00, 0x00, 0x00, 0x01} }, /* case-100 */
2117 { {0x61, 0x45, 0x03, 0x11, 0x11} }, /* case-101 */
2118 { {0x61, 0x3a, 0x03, 0x11, 0x11} },
2119 { {0x61, 0x30, 0x03, 0x11, 0x11} },
2120 { {0x61, 0x20, 0x03, 0x11, 0x11} },
2121 { {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-105 */
2122 { {0x61, 0x45, 0x03, 0x11, 0x10} },
2123 { {0x61, 0x3a, 0x03, 0x11, 0x10} },
2124 { {0x61, 0x30, 0x03, 0x11, 0x10} },
2125 { {0x61, 0x20, 0x03, 0x11, 0x10} },
2126 { {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-110 */
2127 { {0x61, 0x08, 0x03, 0x11, 0x14} },
2128 { {0x61, 0x08, 0x03, 0x10, 0x14} },
2129 { {0x51, 0x08, 0x03, 0x10, 0x54} },
2130 { {0x51, 0x08, 0x03, 0x10, 0x55} },
2131 { {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-115 */
2132 { {0x51, 0x45, 0x03, 0x10, 0x50} },
2133 { {0x51, 0x3a, 0x03, 0x10, 0x50} },
2134 { {0x51, 0x30, 0x03, 0x10, 0x50} },
2135 { {0x51, 0x20, 0x03, 0x10, 0x50} },
2136 { {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-120 */
2137 { {0x51, 0x08, 0x03, 0x10, 0x50} }
2138 };
2139
2140 /* rssi in percentage % (dbm = % - 100) */
2141 static const u8 wl_rssi_step_8723d[] = {60, 50, 44, 30};
2142 static const u8 bt_rssi_step_8723d[] = {30, 30, 30, 30};
2143 static const struct coex_5g_afh_map afh_5g_8723d[] = { {0, 0, 0} };
2144
2145 static const struct rtw_hw_reg btg_reg_8723d = {
2146 .addr = REG_BTG_SEL, .mask = BIT_MASK_BTG_WL,
2147 };
2148
2149 /* wl_tx_dec_power, bt_tx_dec_power, wl_rx_gain, bt_rx_lna_constrain */
2150 static const struct coex_rf_para rf_para_tx_8723d[] = {
2151 {0, 0, false, 7}, /* for normal */
2152 {0, 10, false, 7}, /* for WL-CPT */
2153 {1, 0, true, 4},
2154 {1, 2, true, 4},
2155 {1, 10, true, 4},
2156 {1, 15, true, 4}
2157 };
2158
2159 static const struct coex_rf_para rf_para_rx_8723d[] = {
2160 {0, 0, false, 7}, /* for normal */
2161 {0, 10, false, 7}, /* for WL-CPT */
2162 {1, 0, true, 5},
2163 {1, 2, true, 5},
2164 {1, 10, true, 5},
2165 {1, 15, true, 5}
2166 };
2167
2168 static const struct rtw_pwr_seq_cmd trans_carddis_to_cardemu_8723d[] = {
2169 {0x0005,
2170 RTW_PWR_CUT_ALL_MSK,
2171 RTW_PWR_INTF_ALL_MSK,
2172 RTW_PWR_ADDR_MAC,
2173 RTW_PWR_CMD_WRITE, BIT(3) | BIT(7), 0},
2174 {0x0086,
2175 RTW_PWR_CUT_ALL_MSK,
2176 RTW_PWR_INTF_SDIO_MSK,
2177 RTW_PWR_ADDR_SDIO,
2178 RTW_PWR_CMD_WRITE, BIT(0), 0},
2179 {0x0086,
2180 RTW_PWR_CUT_ALL_MSK,
2181 RTW_PWR_INTF_SDIO_MSK,
2182 RTW_PWR_ADDR_SDIO,
2183 RTW_PWR_CMD_POLLING, BIT(1), BIT(1)},
2184 {0x004A,
2185 RTW_PWR_CUT_ALL_MSK,
2186 RTW_PWR_INTF_USB_MSK,
2187 RTW_PWR_ADDR_MAC,
2188 RTW_PWR_CMD_WRITE, BIT(0), 0},
2189 {0x0005,
2190 RTW_PWR_CUT_ALL_MSK,
2191 RTW_PWR_INTF_ALL_MSK,
2192 RTW_PWR_ADDR_MAC,
2193 RTW_PWR_CMD_WRITE, BIT(3) | BIT(4), 0},
2194 {0x0023,
2195 RTW_PWR_CUT_ALL_MSK,
2196 RTW_PWR_INTF_SDIO_MSK,
2197 RTW_PWR_ADDR_MAC,
2198 RTW_PWR_CMD_WRITE, BIT(4), 0},
2199 {0x0301,
2200 RTW_PWR_CUT_ALL_MSK,
2201 RTW_PWR_INTF_PCI_MSK,
2202 RTW_PWR_ADDR_MAC,
2203 RTW_PWR_CMD_WRITE, 0xFF, 0},
2204 {0xFFFF,
2205 RTW_PWR_CUT_ALL_MSK,
2206 RTW_PWR_INTF_ALL_MSK,
2207 0,
2208 RTW_PWR_CMD_END, 0, 0},
2209 };
2210
2211 static const struct rtw_pwr_seq_cmd trans_cardemu_to_act_8723d[] = {
2212 {0x0020,
2213 RTW_PWR_CUT_ALL_MSK,
2214 RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK,
2215 RTW_PWR_ADDR_MAC,
2216 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
2217 {0x0001,
2218 RTW_PWR_CUT_ALL_MSK,
2219 RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK,
2220 RTW_PWR_ADDR_MAC,
2221 RTW_PWR_CMD_DELAY, 1, RTW_PWR_DELAY_MS},
2222 {0x0000,
2223 RTW_PWR_CUT_ALL_MSK,
2224 RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK,
2225 RTW_PWR_ADDR_MAC,
2226 RTW_PWR_CMD_WRITE, BIT(5), 0},
2227 {0x0005,
2228 RTW_PWR_CUT_ALL_MSK,
2229 RTW_PWR_INTF_ALL_MSK,
2230 RTW_PWR_ADDR_MAC,
2231 RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3) | BIT(2)), 0},
2232 {0x0075,
2233 RTW_PWR_CUT_ALL_MSK,
2234 RTW_PWR_INTF_PCI_MSK,
2235 RTW_PWR_ADDR_MAC,
2236 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
2237 {0x0006,
2238 RTW_PWR_CUT_ALL_MSK,
2239 RTW_PWR_INTF_ALL_MSK,
2240 RTW_PWR_ADDR_MAC,
2241 RTW_PWR_CMD_POLLING, BIT(1), BIT(1)},
2242 {0x0075,
2243 RTW_PWR_CUT_ALL_MSK,
2244 RTW_PWR_INTF_PCI_MSK,
2245 RTW_PWR_ADDR_MAC,
2246 RTW_PWR_CMD_WRITE, BIT(0), 0},
2247 {0x0006,
2248 RTW_PWR_CUT_ALL_MSK,
2249 RTW_PWR_INTF_ALL_MSK,
2250 RTW_PWR_ADDR_MAC,
2251 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
2252 {0x0005,
2253 RTW_PWR_CUT_ALL_MSK,
2254 RTW_PWR_INTF_ALL_MSK,
2255 RTW_PWR_ADDR_MAC,
2256 RTW_PWR_CMD_POLLING, (BIT(1) | BIT(0)), 0},
2257 {0x0005,
2258 RTW_PWR_CUT_ALL_MSK,
2259 RTW_PWR_INTF_ALL_MSK,
2260 RTW_PWR_ADDR_MAC,
2261 RTW_PWR_CMD_WRITE, BIT(7), 0},
2262 {0x0005,
2263 RTW_PWR_CUT_ALL_MSK,
2264 RTW_PWR_INTF_ALL_MSK,
2265 RTW_PWR_ADDR_MAC,
2266 RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3)), 0},
2267 {0x0005,
2268 RTW_PWR_CUT_ALL_MSK,
2269 RTW_PWR_INTF_ALL_MSK,
2270 RTW_PWR_ADDR_MAC,
2271 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
2272 {0x0005,
2273 RTW_PWR_CUT_ALL_MSK,
2274 RTW_PWR_INTF_ALL_MSK,
2275 RTW_PWR_ADDR_MAC,
2276 RTW_PWR_CMD_POLLING, BIT(0), 0},
2277 {0x0010,
2278 RTW_PWR_CUT_ALL_MSK,
2279 RTW_PWR_INTF_ALL_MSK,
2280 RTW_PWR_ADDR_MAC,
2281 RTW_PWR_CMD_WRITE, BIT(6), BIT(6)},
2282 {0x0049,
2283 RTW_PWR_CUT_ALL_MSK,
2284 RTW_PWR_INTF_ALL_MSK,
2285 RTW_PWR_ADDR_MAC,
2286 RTW_PWR_CMD_WRITE, BIT(1), BIT(1)},
2287 {0x0063,
2288 RTW_PWR_CUT_ALL_MSK,
2289 RTW_PWR_INTF_ALL_MSK,
2290 RTW_PWR_ADDR_MAC,
2291 RTW_PWR_CMD_WRITE, BIT(1), BIT(1)},
2292 {0x0062,
2293 RTW_PWR_CUT_ALL_MSK,
2294 RTW_PWR_INTF_ALL_MSK,
2295 RTW_PWR_ADDR_MAC,
2296 RTW_PWR_CMD_WRITE, BIT(1), 0},
2297 {0x0058,
2298 RTW_PWR_CUT_ALL_MSK,
2299 RTW_PWR_INTF_ALL_MSK,
2300 RTW_PWR_ADDR_MAC,
2301 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
2302 {0x005A,
2303 RTW_PWR_CUT_ALL_MSK,
2304 RTW_PWR_INTF_ALL_MSK,
2305 RTW_PWR_ADDR_MAC,
2306 RTW_PWR_CMD_WRITE, BIT(1), BIT(1)},
2307 {0x0068,
2308 RTW_PWR_CUT_TEST_MSK,
2309 RTW_PWR_INTF_ALL_MSK,
2310 RTW_PWR_ADDR_MAC,
2311 RTW_PWR_CMD_WRITE, BIT(3), BIT(3)},
2312 {0x0069,
2313 RTW_PWR_CUT_ALL_MSK,
2314 RTW_PWR_INTF_ALL_MSK,
2315 RTW_PWR_ADDR_MAC,
2316 RTW_PWR_CMD_WRITE, BIT(6), BIT(6)},
2317 {0x001f,
2318 RTW_PWR_CUT_ALL_MSK,
2319 RTW_PWR_INTF_ALL_MSK,
2320 RTW_PWR_ADDR_MAC,
2321 RTW_PWR_CMD_WRITE, 0xFF, 0x00},
2322 {0x0077,
2323 RTW_PWR_CUT_ALL_MSK,
2324 RTW_PWR_INTF_ALL_MSK,
2325 RTW_PWR_ADDR_MAC,
2326 RTW_PWR_CMD_WRITE, 0xFF, 0x00},
2327 {0x001f,
2328 RTW_PWR_CUT_ALL_MSK,
2329 RTW_PWR_INTF_ALL_MSK,
2330 RTW_PWR_ADDR_MAC,
2331 RTW_PWR_CMD_WRITE, 0xFF, 0x07},
2332 {0x0077,
2333 RTW_PWR_CUT_ALL_MSK,
2334 RTW_PWR_INTF_ALL_MSK,
2335 RTW_PWR_ADDR_MAC,
2336 RTW_PWR_CMD_WRITE, 0xFF, 0x07},
2337 {0xFFFF,
2338 RTW_PWR_CUT_ALL_MSK,
2339 RTW_PWR_INTF_ALL_MSK,
2340 0,
2341 RTW_PWR_CMD_END, 0, 0},
2342 };
2343
2344 static const struct rtw_pwr_seq_cmd *card_enable_flow_8723d[] = {
2345 trans_carddis_to_cardemu_8723d,
2346 trans_cardemu_to_act_8723d,
2347 NULL
2348 };
2349
2350 static const struct rtw_pwr_seq_cmd trans_act_to_lps_8723d[] = {
2351 {0x0301,
2352 RTW_PWR_CUT_ALL_MSK,
2353 RTW_PWR_INTF_PCI_MSK,
2354 RTW_PWR_ADDR_MAC,
2355 RTW_PWR_CMD_WRITE, 0xFF, 0xFF},
2356 {0x0522,
2357 RTW_PWR_CUT_ALL_MSK,
2358 RTW_PWR_INTF_ALL_MSK,
2359 RTW_PWR_ADDR_MAC,
2360 RTW_PWR_CMD_WRITE, 0xFF, 0xFF},
2361 {0x05F8,
2362 RTW_PWR_CUT_ALL_MSK,
2363 RTW_PWR_INTF_ALL_MSK,
2364 RTW_PWR_ADDR_MAC,
2365 RTW_PWR_CMD_POLLING, 0xFF, 0},
2366 {0x05F9,
2367 RTW_PWR_CUT_ALL_MSK,
2368 RTW_PWR_INTF_ALL_MSK,
2369 RTW_PWR_ADDR_MAC,
2370 RTW_PWR_CMD_POLLING, 0xFF, 0},
2371 {0x05FA,
2372 RTW_PWR_CUT_ALL_MSK,
2373 RTW_PWR_INTF_ALL_MSK,
2374 RTW_PWR_ADDR_MAC,
2375 RTW_PWR_CMD_POLLING, 0xFF, 0},
2376 {0x05FB,
2377 RTW_PWR_CUT_ALL_MSK,
2378 RTW_PWR_INTF_ALL_MSK,
2379 RTW_PWR_ADDR_MAC,
2380 RTW_PWR_CMD_POLLING, 0xFF, 0},
2381 {0x0002,
2382 RTW_PWR_CUT_ALL_MSK,
2383 RTW_PWR_INTF_ALL_MSK,
2384 RTW_PWR_ADDR_MAC,
2385 RTW_PWR_CMD_WRITE, BIT(0), 0},
2386 {0x0002,
2387 RTW_PWR_CUT_ALL_MSK,
2388 RTW_PWR_INTF_ALL_MSK,
2389 RTW_PWR_ADDR_MAC,
2390 RTW_PWR_CMD_DELAY, 0, RTW_PWR_DELAY_US},
2391 {0x0002,
2392 RTW_PWR_CUT_ALL_MSK,
2393 RTW_PWR_INTF_ALL_MSK,
2394 RTW_PWR_ADDR_MAC,
2395 RTW_PWR_CMD_WRITE, BIT(1), 0},
2396 {0x0100,
2397 RTW_PWR_CUT_ALL_MSK,
2398 RTW_PWR_INTF_ALL_MSK,
2399 RTW_PWR_ADDR_MAC,
2400 RTW_PWR_CMD_WRITE, 0xFF, 0x03},
2401 {0x0101,
2402 RTW_PWR_CUT_ALL_MSK,
2403 RTW_PWR_INTF_ALL_MSK,
2404 RTW_PWR_ADDR_MAC,
2405 RTW_PWR_CMD_WRITE, BIT(1), 0},
2406 {0x0093,
2407 RTW_PWR_CUT_ALL_MSK,
2408 RTW_PWR_INTF_SDIO_MSK,
2409 RTW_PWR_ADDR_MAC,
2410 RTW_PWR_CMD_WRITE, 0xFF, 0x00},
2411 {0x0553,
2412 RTW_PWR_CUT_ALL_MSK,
2413 RTW_PWR_INTF_ALL_MSK,
2414 RTW_PWR_ADDR_MAC,
2415 RTW_PWR_CMD_WRITE, BIT(5), BIT(5)},
2416 {0xFFFF,
2417 RTW_PWR_CUT_ALL_MSK,
2418 RTW_PWR_INTF_ALL_MSK,
2419 0,
2420 RTW_PWR_CMD_END, 0, 0},
2421 };
2422
2423 static const struct rtw_pwr_seq_cmd trans_act_to_pre_carddis_8723d[] = {
2424 {0x0003,
2425 RTW_PWR_CUT_ALL_MSK,
2426 RTW_PWR_INTF_ALL_MSK,
2427 RTW_PWR_ADDR_MAC,
2428 RTW_PWR_CMD_WRITE, BIT(2), 0},
2429 {0x0080,
2430 RTW_PWR_CUT_ALL_MSK,
2431 RTW_PWR_INTF_ALL_MSK,
2432 RTW_PWR_ADDR_MAC,
2433 RTW_PWR_CMD_WRITE, 0xFF, 0},
2434 {0xFFFF,
2435 RTW_PWR_CUT_ALL_MSK,
2436 RTW_PWR_INTF_ALL_MSK,
2437 0,
2438 RTW_PWR_CMD_END, 0, 0},
2439 };
2440
2441 static const struct rtw_pwr_seq_cmd trans_act_to_cardemu_8723d[] = {
2442 {0x0002,
2443 RTW_PWR_CUT_ALL_MSK,
2444 RTW_PWR_INTF_ALL_MSK,
2445 RTW_PWR_ADDR_MAC,
2446 RTW_PWR_CMD_WRITE, BIT(0), 0},
2447 {0x0049,
2448 RTW_PWR_CUT_ALL_MSK,
2449 RTW_PWR_INTF_ALL_MSK,
2450 RTW_PWR_ADDR_MAC,
2451 RTW_PWR_CMD_WRITE, BIT(1), 0},
2452 {0x0006,
2453 RTW_PWR_CUT_ALL_MSK,
2454 RTW_PWR_INTF_ALL_MSK,
2455 RTW_PWR_ADDR_MAC,
2456 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
2457 {0x0005,
2458 RTW_PWR_CUT_ALL_MSK,
2459 RTW_PWR_INTF_ALL_MSK,
2460 RTW_PWR_ADDR_MAC,
2461 RTW_PWR_CMD_WRITE, BIT(1), BIT(1)},
2462 {0x0005,
2463 RTW_PWR_CUT_ALL_MSK,
2464 RTW_PWR_INTF_ALL_MSK,
2465 RTW_PWR_ADDR_MAC,
2466 RTW_PWR_CMD_POLLING, BIT(1), 0},
2467 {0x0010,
2468 RTW_PWR_CUT_ALL_MSK,
2469 RTW_PWR_INTF_ALL_MSK,
2470 RTW_PWR_ADDR_MAC,
2471 RTW_PWR_CMD_WRITE, BIT(6), 0},
2472 {0x0000,
2473 RTW_PWR_CUT_ALL_MSK,
2474 RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK,
2475 RTW_PWR_ADDR_MAC,
2476 RTW_PWR_CMD_WRITE, BIT(5), BIT(5)},
2477 {0x0020,
2478 RTW_PWR_CUT_ALL_MSK,
2479 RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK,
2480 RTW_PWR_ADDR_MAC,
2481 RTW_PWR_CMD_WRITE, BIT(0), 0},
2482 {0xFFFF,
2483 RTW_PWR_CUT_ALL_MSK,
2484 RTW_PWR_INTF_ALL_MSK,
2485 0,
2486 RTW_PWR_CMD_END, 0, 0},
2487 };
2488
2489 static const struct rtw_pwr_seq_cmd trans_cardemu_to_carddis_8723d[] = {
2490 {0x0007,
2491 RTW_PWR_CUT_ALL_MSK,
2492 RTW_PWR_INTF_SDIO_MSK,
2493 RTW_PWR_ADDR_MAC,
2494 RTW_PWR_CMD_WRITE, 0xFF, 0x20},
2495 {0x0005,
2496 RTW_PWR_CUT_ALL_MSK,
2497 RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK,
2498 RTW_PWR_ADDR_MAC,
2499 RTW_PWR_CMD_WRITE, BIT(3) | BIT(4), BIT(3)},
2500 {0x0005,
2501 RTW_PWR_CUT_ALL_MSK,
2502 RTW_PWR_INTF_PCI_MSK,
2503 RTW_PWR_ADDR_MAC,
2504 RTW_PWR_CMD_WRITE, BIT(2), BIT(2)},
2505 {0x0005,
2506 RTW_PWR_CUT_ALL_MSK,
2507 RTW_PWR_INTF_PCI_MSK,
2508 RTW_PWR_ADDR_MAC,
2509 RTW_PWR_CMD_WRITE, BIT(3) | BIT(4), BIT(3) | BIT(4)},
2510 {0x004A,
2511 RTW_PWR_CUT_ALL_MSK,
2512 RTW_PWR_INTF_USB_MSK,
2513 RTW_PWR_ADDR_MAC,
2514 RTW_PWR_CMD_WRITE, BIT(0), 1},
2515 {0x0023,
2516 RTW_PWR_CUT_ALL_MSK,
2517 RTW_PWR_INTF_SDIO_MSK,
2518 RTW_PWR_ADDR_MAC,
2519 RTW_PWR_CMD_WRITE, BIT(4), BIT(4)},
2520 {0x0086,
2521 RTW_PWR_CUT_ALL_MSK,
2522 RTW_PWR_INTF_SDIO_MSK,
2523 RTW_PWR_ADDR_SDIO,
2524 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
2525 {0x0086,
2526 RTW_PWR_CUT_ALL_MSK,
2527 RTW_PWR_INTF_SDIO_MSK,
2528 RTW_PWR_ADDR_SDIO,
2529 RTW_PWR_CMD_POLLING, BIT(1), 0},
2530 {0xFFFF,
2531 RTW_PWR_CUT_ALL_MSK,
2532 RTW_PWR_INTF_ALL_MSK,
2533 0,
2534 RTW_PWR_CMD_END, 0, 0},
2535 };
2536
2537 static const struct rtw_pwr_seq_cmd trans_act_to_post_carddis_8723d[] = {
2538 {0x001D,
2539 RTW_PWR_CUT_ALL_MSK,
2540 RTW_PWR_INTF_ALL_MSK,
2541 RTW_PWR_ADDR_MAC,
2542 RTW_PWR_CMD_WRITE, BIT(0), 0},
2543 {0x001D,
2544 RTW_PWR_CUT_ALL_MSK,
2545 RTW_PWR_INTF_ALL_MSK,
2546 RTW_PWR_ADDR_MAC,
2547 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
2548 {0x001C,
2549 RTW_PWR_CUT_ALL_MSK,
2550 RTW_PWR_INTF_ALL_MSK,
2551 RTW_PWR_ADDR_MAC,
2552 RTW_PWR_CMD_WRITE, 0xFF, 0x0E},
2553 {0xFFFF,
2554 RTW_PWR_CUT_ALL_MSK,
2555 RTW_PWR_INTF_ALL_MSK,
2556 0,
2557 RTW_PWR_CMD_END, 0, 0},
2558 };
2559
2560 static const struct rtw_pwr_seq_cmd *card_disable_flow_8723d[] = {
2561 trans_act_to_lps_8723d,
2562 trans_act_to_pre_carddis_8723d,
2563 trans_act_to_cardemu_8723d,
2564 trans_cardemu_to_carddis_8723d,
2565 trans_act_to_post_carddis_8723d,
2566 NULL
2567 };
2568
2569 static const struct rtw_page_table page_table_8723d[] = {
2570 {12, 2, 2, 0, 1},
2571 {12, 2, 2, 0, 1},
2572 {12, 2, 2, 0, 1},
2573 {12, 2, 2, 0, 1},
2574 {12, 2, 2, 0, 1},
2575 };
2576
2577 static const struct rtw_rqpn rqpn_table_8723d[] = {
2578 {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL,
2579 RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW,
2580 RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH},
2581 {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL,
2582 RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW,
2583 RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH},
2584 {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL,
2585 RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_HIGH,
2586 RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH},
2587 {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL,
2588 RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW,
2589 RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH},
2590 {RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL,
2591 RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW,
2592 RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH},
2593 };
2594
2595 static const struct rtw_prioq_addrs prioq_addrs_8723d = {
2596 .prio[RTW_DMA_MAPPING_EXTRA] = {
2597 .rsvd = REG_RQPN_NPQ + 2, .avail = REG_RQPN_NPQ + 3,
2598 },
2599 .prio[RTW_DMA_MAPPING_LOW] = {
2600 .rsvd = REG_RQPN + 1, .avail = REG_FIFOPAGE_CTRL_2 + 1,
2601 },
2602 .prio[RTW_DMA_MAPPING_NORMAL] = {
2603 .rsvd = REG_RQPN_NPQ, .avail = REG_RQPN_NPQ + 1,
2604 },
2605 .prio[RTW_DMA_MAPPING_HIGH] = {
2606 .rsvd = REG_RQPN, .avail = REG_FIFOPAGE_CTRL_2,
2607 },
2608 .wsize = false,
2609 };
2610
2611 static const struct rtw_intf_phy_para pcie_gen1_param_8723d[] = {
2612 {0x0008, 0x4a22,
2613 RTW_IP_SEL_PHY,
2614 RTW_INTF_PHY_CUT_ALL,
2615 RTW_INTF_PHY_PLATFORM_ALL},
2616 {0x0009, 0x1000,
2617 RTW_IP_SEL_PHY,
2618 ~(RTW_INTF_PHY_CUT_A | RTW_INTF_PHY_CUT_B),
2619 RTW_INTF_PHY_PLATFORM_ALL},
2620 {0xFFFF, 0x0000,
2621 RTW_IP_SEL_PHY,
2622 RTW_INTF_PHY_CUT_ALL,
2623 RTW_INTF_PHY_PLATFORM_ALL},
2624 };
2625
2626 static const struct rtw_intf_phy_para_table phy_para_table_8723d = {
2627 .gen1_para = pcie_gen1_param_8723d,
2628 .n_gen1_para = ARRAY_SIZE(pcie_gen1_param_8723d),
2629 };
2630
2631 static const struct rtw_hw_reg rtw8723d_dig[] = {
2632 [0] = { .addr = 0xc50, .mask = 0x7f },
2633 [1] = { .addr = 0xc50, .mask = 0x7f },
2634 };
2635
2636 static const struct rtw_hw_reg rtw8723d_dig_cck[] = {
2637 [0] = { .addr = 0xa0c, .mask = 0x3f00 },
2638 };
2639
2640 static const struct rtw_rf_sipi_addr rtw8723d_rf_sipi_addr[] = {
2641 [RF_PATH_A] = { .hssi_1 = 0x820, .lssi_read = 0x8a0,
2642 .hssi_2 = 0x824, .lssi_read_pi = 0x8b8},
2643 [RF_PATH_B] = { .hssi_1 = 0x828, .lssi_read = 0x8a4,
2644 .hssi_2 = 0x82c, .lssi_read_pi = 0x8bc},
2645 };
2646
2647 static const struct rtw_ltecoex_addr rtw8723d_ltecoex_addr = {
2648 .ctrl = REG_LTECOEX_CTRL,
2649 .wdata = REG_LTECOEX_WRITE_DATA,
2650 .rdata = REG_LTECOEX_READ_DATA,
2651 };
2652
2653 static const struct rtw_rfe_def rtw8723d_rfe_defs[] = {
2654 [0] = { .phy_pg_tbl = &rtw8723d_bb_pg_tbl,
2655 .txpwr_lmt_tbl = &rtw8723d_txpwr_lmt_tbl,},
2656 };
2657
2658 static const u8 rtw8723d_pwrtrk_2gb_n[] = {
2659 0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5,
2660 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10
2661 };
2662
2663 static const u8 rtw8723d_pwrtrk_2gb_p[] = {
2664 0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7,
2665 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10
2666 };
2667
2668 static const u8 rtw8723d_pwrtrk_2ga_n[] = {
2669 0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5,
2670 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10
2671 };
2672
2673 static const u8 rtw8723d_pwrtrk_2ga_p[] = {
2674 0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7,
2675 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10
2676 };
2677
2678 static const u8 rtw8723d_pwrtrk_2g_cck_b_n[] = {
2679 0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6,
2680 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11
2681 };
2682
2683 static const u8 rtw8723d_pwrtrk_2g_cck_b_p[] = {
2684 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7,
2685 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11
2686 };
2687
2688 static const u8 rtw8723d_pwrtrk_2g_cck_a_n[] = {
2689 0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6,
2690 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11
2691 };
2692
2693 static const u8 rtw8723d_pwrtrk_2g_cck_a_p[] = {
2694 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7,
2695 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11
2696 };
2697
2698 static const s8 rtw8723d_pwrtrk_xtal_n[] = {
2699 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
2700 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
2701 };
2702
2703 static const s8 rtw8723d_pwrtrk_xtal_p[] = {
2704 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
2705 0, -10, -12, -14, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16
2706 };
2707
2708 static const struct rtw_pwr_track_tbl rtw8723d_rtw_pwr_track_tbl = {
2709 .pwrtrk_2gb_n = rtw8723d_pwrtrk_2gb_n,
2710 .pwrtrk_2gb_p = rtw8723d_pwrtrk_2gb_p,
2711 .pwrtrk_2ga_n = rtw8723d_pwrtrk_2ga_n,
2712 .pwrtrk_2ga_p = rtw8723d_pwrtrk_2ga_p,
2713 .pwrtrk_2g_cckb_n = rtw8723d_pwrtrk_2g_cck_b_n,
2714 .pwrtrk_2g_cckb_p = rtw8723d_pwrtrk_2g_cck_b_p,
2715 .pwrtrk_2g_ccka_n = rtw8723d_pwrtrk_2g_cck_a_n,
2716 .pwrtrk_2g_ccka_p = rtw8723d_pwrtrk_2g_cck_a_p,
2717 .pwrtrk_xtal_p = rtw8723d_pwrtrk_xtal_p,
2718 .pwrtrk_xtal_n = rtw8723d_pwrtrk_xtal_n,
2719 };
2720
2721 static const struct rtw_reg_domain coex_info_hw_regs_8723d[] = {
2722 {0x948, MASKDWORD, RTW_REG_DOMAIN_MAC32},
2723 {0x67, BIT(7), RTW_REG_DOMAIN_MAC8},
2724 {0, 0, RTW_REG_DOMAIN_NL},
2725 {0x964, BIT(1), RTW_REG_DOMAIN_MAC8},
2726 {0x864, BIT(0), RTW_REG_DOMAIN_MAC8},
2727 {0xab7, BIT(5), RTW_REG_DOMAIN_MAC8},
2728 {0xa01, BIT(7), RTW_REG_DOMAIN_MAC8},
2729 {0, 0, RTW_REG_DOMAIN_NL},
2730 {0x430, MASKDWORD, RTW_REG_DOMAIN_MAC32},
2731 {0x434, MASKDWORD, RTW_REG_DOMAIN_MAC32},
2732 {0x42a, MASKLWORD, RTW_REG_DOMAIN_MAC16},
2733 {0x426, MASKBYTE0, RTW_REG_DOMAIN_MAC8},
2734 {0x45e, BIT(3), RTW_REG_DOMAIN_MAC8},
2735 {0, 0, RTW_REG_DOMAIN_NL},
2736 {0x4c6, BIT(4), RTW_REG_DOMAIN_MAC8},
2737 {0x40, BIT(5), RTW_REG_DOMAIN_MAC8},
2738 {0x550, MASKDWORD, RTW_REG_DOMAIN_MAC32},
2739 {0x522, MASKBYTE0, RTW_REG_DOMAIN_MAC8},
2740 {0x953, BIT(1), RTW_REG_DOMAIN_MAC8},
2741 };
2742
2743 const struct rtw_chip_info rtw8723d_hw_spec = {
2744 .ops = &rtw8723d_ops,
2745 .id = RTW_CHIP_TYPE_8723D,
2746 .fw_name = "rtw88/rtw8723d_fw.bin",
2747 .wlan_cpu = RTW_WCPU_11N,
2748 .tx_pkt_desc_sz = 40,
2749 .tx_buf_desc_sz = 16,
2750 .rx_pkt_desc_sz = 24,
2751 .rx_buf_desc_sz = 8,
2752 .phy_efuse_size = 512,
2753 .log_efuse_size = 512,
2754 .ptct_efuse_size = 96 + 1,
2755 .txff_size = 32768,
2756 .rxff_size = 16384,
2757 .rsvd_drv_pg_num = 8,
2758 .txgi_factor = 1,
2759 .is_pwr_by_rate_dec = true,
2760 .max_power_index = 0x3f,
2761 .csi_buf_pg_num = 0,
2762 .band = RTW_BAND_2G,
2763 .page_size = TX_PAGE_SIZE,
2764 .dig_min = 0x20,
2765 .ht_supported = true,
2766 .vht_supported = false,
2767 .lps_deep_mode_supported = 0,
2768 .sys_func_en = 0xFD,
2769 .pwr_on_seq = card_enable_flow_8723d,
2770 .pwr_off_seq = card_disable_flow_8723d,
2771 .page_table = page_table_8723d,
2772 .rqpn_table = rqpn_table_8723d,
2773 .prioq_addrs = &prioq_addrs_8723d,
2774 .intf_table = &phy_para_table_8723d,
2775 .dig = rtw8723d_dig,
2776 .dig_cck = rtw8723d_dig_cck,
2777 .rf_sipi_addr = {0x840, 0x844},
2778 .rf_sipi_read_addr = rtw8723d_rf_sipi_addr,
2779 .fix_rf_phy_num = 2,
2780 .ltecoex_addr = &rtw8723d_ltecoex_addr,
2781 .mac_tbl = &rtw8723d_mac_tbl,
2782 .agc_tbl = &rtw8723d_agc_tbl,
2783 .bb_tbl = &rtw8723d_bb_tbl,
2784 .rf_tbl = {&rtw8723d_rf_a_tbl},
2785 .rfe_defs = rtw8723d_rfe_defs,
2786 .rfe_defs_size = ARRAY_SIZE(rtw8723d_rfe_defs),
2787 .rx_ldpc = false,
2788 .pwr_track_tbl = &rtw8723d_rtw_pwr_track_tbl,
2789 .iqk_threshold = 8,
2790 .ampdu_density = IEEE80211_HT_MPDU_DENSITY_16,
2791 .max_scan_ie_len = IEEE80211_MAX_DATA_LEN,
2792
2793 .coex_para_ver = 0x2007022f,
2794 .bt_desired_ver = 0x2f,
2795 .scbd_support = true,
2796 .new_scbd10_def = true,
2797 .ble_hid_profile_support = false,
2798 .wl_mimo_ps_support = false,
2799 .pstdma_type = COEX_PSTDMA_FORCE_LPSOFF,
2800 .bt_rssi_type = COEX_BTRSSI_RATIO,
2801 .ant_isolation = 15,
2802 .rssi_tolerance = 2,
2803 .wl_rssi_step = wl_rssi_step_8723d,
2804 .bt_rssi_step = bt_rssi_step_8723d,
2805 .table_sant_num = ARRAY_SIZE(table_sant_8723d),
2806 .table_sant = table_sant_8723d,
2807 .table_nsant_num = ARRAY_SIZE(table_nsant_8723d),
2808 .table_nsant = table_nsant_8723d,
2809 .tdma_sant_num = ARRAY_SIZE(tdma_sant_8723d),
2810 .tdma_sant = tdma_sant_8723d,
2811 .tdma_nsant_num = ARRAY_SIZE(tdma_nsant_8723d),
2812 .tdma_nsant = tdma_nsant_8723d,
2813 .wl_rf_para_num = ARRAY_SIZE(rf_para_tx_8723d),
2814 .wl_rf_para_tx = rf_para_tx_8723d,
2815 .wl_rf_para_rx = rf_para_rx_8723d,
2816 .bt_afh_span_bw20 = 0x20,
2817 .bt_afh_span_bw40 = 0x30,
2818 .afh_5g_num = ARRAY_SIZE(afh_5g_8723d),
2819 .afh_5g = afh_5g_8723d,
2820 .btg_reg = &btg_reg_8723d,
2821
2822 .coex_info_hw_regs_num = ARRAY_SIZE(coex_info_hw_regs_8723d),
2823 .coex_info_hw_regs = coex_info_hw_regs_8723d,
2824 };
2825 EXPORT_SYMBOL(rtw8723d_hw_spec);
2826
2827 MODULE_FIRMWARE("rtw88/rtw8723d_fw.bin");
2828
2829 MODULE_AUTHOR("Realtek Corporation");
2830 MODULE_DESCRIPTION("Realtek 802.11n wireless 8723d driver");
2831 MODULE_LICENSE("Dual BSD/GPL");
2832