xref: /OK3568_Linux_fs/kernel/drivers/net/wireless/realtek/rtw88/rtw8822c.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2*4882a593Smuzhiyun /* Copyright(c) 2018-2019  Realtek Corporation
3*4882a593Smuzhiyun  */
4*4882a593Smuzhiyun 
5*4882a593Smuzhiyun #include <linux/module.h>
6*4882a593Smuzhiyun #include "main.h"
7*4882a593Smuzhiyun #include "coex.h"
8*4882a593Smuzhiyun #include "fw.h"
9*4882a593Smuzhiyun #include "tx.h"
10*4882a593Smuzhiyun #include "rx.h"
11*4882a593Smuzhiyun #include "phy.h"
12*4882a593Smuzhiyun #include "rtw8822c.h"
13*4882a593Smuzhiyun #include "rtw8822c_table.h"
14*4882a593Smuzhiyun #include "mac.h"
15*4882a593Smuzhiyun #include "reg.h"
16*4882a593Smuzhiyun #include "debug.h"
17*4882a593Smuzhiyun #include "util.h"
18*4882a593Smuzhiyun #include "bf.h"
19*4882a593Smuzhiyun #include "efuse.h"
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun static void rtw8822c_config_trx_mode(struct rtw_dev *rtwdev, u8 tx_path,
22*4882a593Smuzhiyun 				     u8 rx_path, bool is_tx2_path);
23*4882a593Smuzhiyun 
rtw8822ce_efuse_parsing(struct rtw_efuse * efuse,struct rtw8822c_efuse * map)24*4882a593Smuzhiyun static void rtw8822ce_efuse_parsing(struct rtw_efuse *efuse,
25*4882a593Smuzhiyun 				    struct rtw8822c_efuse *map)
26*4882a593Smuzhiyun {
27*4882a593Smuzhiyun 	ether_addr_copy(efuse->addr, map->e.mac_addr);
28*4882a593Smuzhiyun }
29*4882a593Smuzhiyun 
rtw8822c_read_efuse(struct rtw_dev * rtwdev,u8 * log_map)30*4882a593Smuzhiyun static int rtw8822c_read_efuse(struct rtw_dev *rtwdev, u8 *log_map)
31*4882a593Smuzhiyun {
32*4882a593Smuzhiyun 	struct rtw_efuse *efuse = &rtwdev->efuse;
33*4882a593Smuzhiyun 	struct rtw8822c_efuse *map;
34*4882a593Smuzhiyun 	int i;
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun 	map = (struct rtw8822c_efuse *)log_map;
37*4882a593Smuzhiyun 
38*4882a593Smuzhiyun 	efuse->rfe_option = map->rfe_option;
39*4882a593Smuzhiyun 	efuse->rf_board_option = map->rf_board_option;
40*4882a593Smuzhiyun 	efuse->crystal_cap = map->xtal_k;
41*4882a593Smuzhiyun 	efuse->channel_plan = map->channel_plan;
42*4882a593Smuzhiyun 	efuse->country_code[0] = map->country_code[0];
43*4882a593Smuzhiyun 	efuse->country_code[1] = map->country_code[1];
44*4882a593Smuzhiyun 	efuse->bt_setting = map->rf_bt_setting;
45*4882a593Smuzhiyun 	efuse->regd = map->rf_board_option & 0x7;
46*4882a593Smuzhiyun 	efuse->thermal_meter[RF_PATH_A] = map->path_a_thermal;
47*4882a593Smuzhiyun 	efuse->thermal_meter[RF_PATH_B] = map->path_b_thermal;
48*4882a593Smuzhiyun 	efuse->thermal_meter_k =
49*4882a593Smuzhiyun 			(map->path_a_thermal + map->path_b_thermal) >> 1;
50*4882a593Smuzhiyun 	efuse->power_track_type = (map->tx_pwr_calibrate_rate >> 4) & 0xf;
51*4882a593Smuzhiyun 
52*4882a593Smuzhiyun 	for (i = 0; i < 4; i++)
53*4882a593Smuzhiyun 		efuse->txpwr_idx_table[i] = map->txpwr_idx_table[i];
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun 	switch (rtw_hci_type(rtwdev)) {
56*4882a593Smuzhiyun 	case RTW_HCI_TYPE_PCIE:
57*4882a593Smuzhiyun 		rtw8822ce_efuse_parsing(efuse, map);
58*4882a593Smuzhiyun 		break;
59*4882a593Smuzhiyun 	default:
60*4882a593Smuzhiyun 		/* unsupported now */
61*4882a593Smuzhiyun 		return -ENOTSUPP;
62*4882a593Smuzhiyun 	}
63*4882a593Smuzhiyun 
64*4882a593Smuzhiyun 	return 0;
65*4882a593Smuzhiyun }
66*4882a593Smuzhiyun 
rtw8822c_header_file_init(struct rtw_dev * rtwdev,bool pre)67*4882a593Smuzhiyun static void rtw8822c_header_file_init(struct rtw_dev *rtwdev, bool pre)
68*4882a593Smuzhiyun {
69*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_3WIRE, BIT_3WIRE_TX_EN | BIT_3WIRE_RX_EN);
70*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_3WIRE, BIT_3WIRE_PI_ON);
71*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_3WIRE2, BIT_3WIRE_TX_EN | BIT_3WIRE_RX_EN);
72*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_3WIRE2, BIT_3WIRE_PI_ON);
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun 	if (pre)
75*4882a593Smuzhiyun 		rtw_write32_clr(rtwdev, REG_ENCCK, BIT_CCK_OFDM_BLK_EN);
76*4882a593Smuzhiyun 	else
77*4882a593Smuzhiyun 		rtw_write32_set(rtwdev, REG_ENCCK, BIT_CCK_OFDM_BLK_EN);
78*4882a593Smuzhiyun }
79*4882a593Smuzhiyun 
rtw8822c_dac_backup_reg(struct rtw_dev * rtwdev,struct rtw_backup_info * backup,struct rtw_backup_info * backup_rf)80*4882a593Smuzhiyun static void rtw8822c_dac_backup_reg(struct rtw_dev *rtwdev,
81*4882a593Smuzhiyun 				    struct rtw_backup_info *backup,
82*4882a593Smuzhiyun 				    struct rtw_backup_info *backup_rf)
83*4882a593Smuzhiyun {
84*4882a593Smuzhiyun 	u32 path, i;
85*4882a593Smuzhiyun 	u32 val;
86*4882a593Smuzhiyun 	u32 reg;
87*4882a593Smuzhiyun 	u32 rf_addr[DACK_RF_8822C] = {0x8f};
88*4882a593Smuzhiyun 	u32 addrs[DACK_REG_8822C] = {0x180c, 0x1810, 0x410c, 0x4110,
89*4882a593Smuzhiyun 				     0x1c3c, 0x1c24, 0x1d70, 0x9b4,
90*4882a593Smuzhiyun 				     0x1a00, 0x1a14, 0x1d58, 0x1c38,
91*4882a593Smuzhiyun 				     0x1e24, 0x1e28, 0x1860, 0x4160};
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun 	for (i = 0; i < DACK_REG_8822C; i++) {
94*4882a593Smuzhiyun 		backup[i].len = 4;
95*4882a593Smuzhiyun 		backup[i].reg = addrs[i];
96*4882a593Smuzhiyun 		backup[i].val = rtw_read32(rtwdev, addrs[i]);
97*4882a593Smuzhiyun 	}
98*4882a593Smuzhiyun 
99*4882a593Smuzhiyun 	for (path = 0; path < DACK_PATH_8822C; path++) {
100*4882a593Smuzhiyun 		for (i = 0; i < DACK_RF_8822C; i++) {
101*4882a593Smuzhiyun 			reg = rf_addr[i];
102*4882a593Smuzhiyun 			val = rtw_read_rf(rtwdev, path, reg, RFREG_MASK);
103*4882a593Smuzhiyun 			backup_rf[path * i + i].reg = reg;
104*4882a593Smuzhiyun 			backup_rf[path * i + i].val = val;
105*4882a593Smuzhiyun 		}
106*4882a593Smuzhiyun 	}
107*4882a593Smuzhiyun }
108*4882a593Smuzhiyun 
rtw8822c_dac_restore_reg(struct rtw_dev * rtwdev,struct rtw_backup_info * backup,struct rtw_backup_info * backup_rf)109*4882a593Smuzhiyun static void rtw8822c_dac_restore_reg(struct rtw_dev *rtwdev,
110*4882a593Smuzhiyun 				     struct rtw_backup_info *backup,
111*4882a593Smuzhiyun 				     struct rtw_backup_info *backup_rf)
112*4882a593Smuzhiyun {
113*4882a593Smuzhiyun 	u32 path, i;
114*4882a593Smuzhiyun 	u32 val;
115*4882a593Smuzhiyun 	u32 reg;
116*4882a593Smuzhiyun 
117*4882a593Smuzhiyun 	rtw_restore_reg(rtwdev, backup, DACK_REG_8822C);
118*4882a593Smuzhiyun 
119*4882a593Smuzhiyun 	for (path = 0; path < DACK_PATH_8822C; path++) {
120*4882a593Smuzhiyun 		for (i = 0; i < DACK_RF_8822C; i++) {
121*4882a593Smuzhiyun 			val = backup_rf[path * i + i].val;
122*4882a593Smuzhiyun 			reg = backup_rf[path * i + i].reg;
123*4882a593Smuzhiyun 			rtw_write_rf(rtwdev, path, reg, RFREG_MASK, val);
124*4882a593Smuzhiyun 		}
125*4882a593Smuzhiyun 	}
126*4882a593Smuzhiyun }
127*4882a593Smuzhiyun 
rtw8822c_rf_minmax_cmp(struct rtw_dev * rtwdev,u32 value,u32 * min,u32 * max)128*4882a593Smuzhiyun static void rtw8822c_rf_minmax_cmp(struct rtw_dev *rtwdev, u32 value,
129*4882a593Smuzhiyun 				   u32 *min, u32 *max)
130*4882a593Smuzhiyun {
131*4882a593Smuzhiyun 	if (value >= 0x200) {
132*4882a593Smuzhiyun 		if (*min >= 0x200) {
133*4882a593Smuzhiyun 			if (*min > value)
134*4882a593Smuzhiyun 				*min = value;
135*4882a593Smuzhiyun 		} else {
136*4882a593Smuzhiyun 			*min = value;
137*4882a593Smuzhiyun 		}
138*4882a593Smuzhiyun 		if (*max >= 0x200) {
139*4882a593Smuzhiyun 			if (*max < value)
140*4882a593Smuzhiyun 				*max = value;
141*4882a593Smuzhiyun 		}
142*4882a593Smuzhiyun 	} else {
143*4882a593Smuzhiyun 		if (*min < 0x200) {
144*4882a593Smuzhiyun 			if (*min > value)
145*4882a593Smuzhiyun 				*min = value;
146*4882a593Smuzhiyun 		}
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun 		if (*max  >= 0x200) {
149*4882a593Smuzhiyun 			*max = value;
150*4882a593Smuzhiyun 		} else {
151*4882a593Smuzhiyun 			if (*max < value)
152*4882a593Smuzhiyun 				*max = value;
153*4882a593Smuzhiyun 		}
154*4882a593Smuzhiyun 	}
155*4882a593Smuzhiyun }
156*4882a593Smuzhiyun 
__rtw8822c_dac_iq_sort(struct rtw_dev * rtwdev,u32 * v1,u32 * v2)157*4882a593Smuzhiyun static void __rtw8822c_dac_iq_sort(struct rtw_dev *rtwdev, u32 *v1, u32 *v2)
158*4882a593Smuzhiyun {
159*4882a593Smuzhiyun 	if (*v1 >= 0x200 && *v2 >= 0x200) {
160*4882a593Smuzhiyun 		if (*v1 > *v2)
161*4882a593Smuzhiyun 			swap(*v1, *v2);
162*4882a593Smuzhiyun 	} else if (*v1 < 0x200 && *v2 < 0x200) {
163*4882a593Smuzhiyun 		if (*v1 > *v2)
164*4882a593Smuzhiyun 			swap(*v1, *v2);
165*4882a593Smuzhiyun 	} else if (*v1 < 0x200 && *v2 >= 0x200) {
166*4882a593Smuzhiyun 		swap(*v1, *v2);
167*4882a593Smuzhiyun 	}
168*4882a593Smuzhiyun }
169*4882a593Smuzhiyun 
rtw8822c_dac_iq_sort(struct rtw_dev * rtwdev,u32 * iv,u32 * qv)170*4882a593Smuzhiyun static void rtw8822c_dac_iq_sort(struct rtw_dev *rtwdev, u32 *iv, u32 *qv)
171*4882a593Smuzhiyun {
172*4882a593Smuzhiyun 	u32 i, j;
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun 	for (i = 0; i < DACK_SN_8822C - 1; i++) {
175*4882a593Smuzhiyun 		for (j = 0; j < (DACK_SN_8822C - 1 - i) ; j++) {
176*4882a593Smuzhiyun 			__rtw8822c_dac_iq_sort(rtwdev, &iv[j], &iv[j + 1]);
177*4882a593Smuzhiyun 			__rtw8822c_dac_iq_sort(rtwdev, &qv[j], &qv[j + 1]);
178*4882a593Smuzhiyun 		}
179*4882a593Smuzhiyun 	}
180*4882a593Smuzhiyun }
181*4882a593Smuzhiyun 
rtw8822c_dac_iq_offset(struct rtw_dev * rtwdev,u32 * vec,u32 * val)182*4882a593Smuzhiyun static void rtw8822c_dac_iq_offset(struct rtw_dev *rtwdev, u32 *vec, u32 *val)
183*4882a593Smuzhiyun {
184*4882a593Smuzhiyun 	u32 p, m, t, i;
185*4882a593Smuzhiyun 
186*4882a593Smuzhiyun 	m = 0;
187*4882a593Smuzhiyun 	p = 0;
188*4882a593Smuzhiyun 	for (i = 10; i < DACK_SN_8822C - 10; i++) {
189*4882a593Smuzhiyun 		if (vec[i] > 0x200)
190*4882a593Smuzhiyun 			m = (0x400 - vec[i]) + m;
191*4882a593Smuzhiyun 		else
192*4882a593Smuzhiyun 			p = vec[i] + p;
193*4882a593Smuzhiyun 	}
194*4882a593Smuzhiyun 
195*4882a593Smuzhiyun 	if (p > m) {
196*4882a593Smuzhiyun 		t = p - m;
197*4882a593Smuzhiyun 		t = t / (DACK_SN_8822C - 20);
198*4882a593Smuzhiyun 	} else {
199*4882a593Smuzhiyun 		t = m - p;
200*4882a593Smuzhiyun 		t = t / (DACK_SN_8822C - 20);
201*4882a593Smuzhiyun 		if (t != 0x0)
202*4882a593Smuzhiyun 			t = 0x400 - t;
203*4882a593Smuzhiyun 	}
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun 	*val = t;
206*4882a593Smuzhiyun }
207*4882a593Smuzhiyun 
rtw8822c_get_path_write_addr(u8 path)208*4882a593Smuzhiyun static u32 rtw8822c_get_path_write_addr(u8 path)
209*4882a593Smuzhiyun {
210*4882a593Smuzhiyun 	u32 base_addr;
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	switch (path) {
213*4882a593Smuzhiyun 	case RF_PATH_A:
214*4882a593Smuzhiyun 		base_addr = 0x1800;
215*4882a593Smuzhiyun 		break;
216*4882a593Smuzhiyun 	case RF_PATH_B:
217*4882a593Smuzhiyun 		base_addr = 0x4100;
218*4882a593Smuzhiyun 		break;
219*4882a593Smuzhiyun 	default:
220*4882a593Smuzhiyun 		WARN_ON(1);
221*4882a593Smuzhiyun 		return -1;
222*4882a593Smuzhiyun 	}
223*4882a593Smuzhiyun 
224*4882a593Smuzhiyun 	return base_addr;
225*4882a593Smuzhiyun }
226*4882a593Smuzhiyun 
rtw8822c_get_path_read_addr(u8 path)227*4882a593Smuzhiyun static u32 rtw8822c_get_path_read_addr(u8 path)
228*4882a593Smuzhiyun {
229*4882a593Smuzhiyun 	u32 base_addr;
230*4882a593Smuzhiyun 
231*4882a593Smuzhiyun 	switch (path) {
232*4882a593Smuzhiyun 	case RF_PATH_A:
233*4882a593Smuzhiyun 		base_addr = 0x2800;
234*4882a593Smuzhiyun 		break;
235*4882a593Smuzhiyun 	case RF_PATH_B:
236*4882a593Smuzhiyun 		base_addr = 0x4500;
237*4882a593Smuzhiyun 		break;
238*4882a593Smuzhiyun 	default:
239*4882a593Smuzhiyun 		WARN_ON(1);
240*4882a593Smuzhiyun 		return -1;
241*4882a593Smuzhiyun 	}
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun 	return base_addr;
244*4882a593Smuzhiyun }
245*4882a593Smuzhiyun 
rtw8822c_dac_iq_check(struct rtw_dev * rtwdev,u32 value)246*4882a593Smuzhiyun static bool rtw8822c_dac_iq_check(struct rtw_dev *rtwdev, u32 value)
247*4882a593Smuzhiyun {
248*4882a593Smuzhiyun 	bool ret = true;
249*4882a593Smuzhiyun 
250*4882a593Smuzhiyun 	if ((value >= 0x200 && (0x400 - value) > 0x64) ||
251*4882a593Smuzhiyun 	    (value < 0x200 && value > 0x64)) {
252*4882a593Smuzhiyun 		ret = false;
253*4882a593Smuzhiyun 		rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] Error overflow\n");
254*4882a593Smuzhiyun 	}
255*4882a593Smuzhiyun 
256*4882a593Smuzhiyun 	return ret;
257*4882a593Smuzhiyun }
258*4882a593Smuzhiyun 
rtw8822c_dac_cal_iq_sample(struct rtw_dev * rtwdev,u32 * iv,u32 * qv)259*4882a593Smuzhiyun static void rtw8822c_dac_cal_iq_sample(struct rtw_dev *rtwdev, u32 *iv, u32 *qv)
260*4882a593Smuzhiyun {
261*4882a593Smuzhiyun 	u32 temp;
262*4882a593Smuzhiyun 	int i = 0, cnt = 0;
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	while (i < DACK_SN_8822C && cnt < 10000) {
265*4882a593Smuzhiyun 		cnt++;
266*4882a593Smuzhiyun 		temp = rtw_read32_mask(rtwdev, 0x2dbc, 0x3fffff);
267*4882a593Smuzhiyun 		iv[i] = (temp & 0x3ff000) >> 12;
268*4882a593Smuzhiyun 		qv[i] = temp & 0x3ff;
269*4882a593Smuzhiyun 
270*4882a593Smuzhiyun 		if (rtw8822c_dac_iq_check(rtwdev, iv[i]) &&
271*4882a593Smuzhiyun 		    rtw8822c_dac_iq_check(rtwdev, qv[i]))
272*4882a593Smuzhiyun 			i++;
273*4882a593Smuzhiyun 	}
274*4882a593Smuzhiyun }
275*4882a593Smuzhiyun 
rtw8822c_dac_cal_iq_search(struct rtw_dev * rtwdev,u32 * iv,u32 * qv,u32 * i_value,u32 * q_value)276*4882a593Smuzhiyun static void rtw8822c_dac_cal_iq_search(struct rtw_dev *rtwdev,
277*4882a593Smuzhiyun 				       u32 *iv, u32 *qv,
278*4882a593Smuzhiyun 				       u32 *i_value, u32 *q_value)
279*4882a593Smuzhiyun {
280*4882a593Smuzhiyun 	u32 i_max = 0, q_max = 0, i_min = 0, q_min = 0;
281*4882a593Smuzhiyun 	u32 i_delta, q_delta;
282*4882a593Smuzhiyun 	u32 temp;
283*4882a593Smuzhiyun 	int i, cnt = 0;
284*4882a593Smuzhiyun 
285*4882a593Smuzhiyun 	do {
286*4882a593Smuzhiyun 		i_min = iv[0];
287*4882a593Smuzhiyun 		i_max = iv[0];
288*4882a593Smuzhiyun 		q_min = qv[0];
289*4882a593Smuzhiyun 		q_max = qv[0];
290*4882a593Smuzhiyun 		for (i = 0; i < DACK_SN_8822C; i++) {
291*4882a593Smuzhiyun 			rtw8822c_rf_minmax_cmp(rtwdev, iv[i], &i_min, &i_max);
292*4882a593Smuzhiyun 			rtw8822c_rf_minmax_cmp(rtwdev, qv[i], &q_min, &q_max);
293*4882a593Smuzhiyun 		}
294*4882a593Smuzhiyun 
295*4882a593Smuzhiyun 		if (i_max < 0x200 && i_min < 0x200)
296*4882a593Smuzhiyun 			i_delta = i_max - i_min;
297*4882a593Smuzhiyun 		else if (i_max >= 0x200 && i_min >= 0x200)
298*4882a593Smuzhiyun 			i_delta = i_max - i_min;
299*4882a593Smuzhiyun 		else
300*4882a593Smuzhiyun 			i_delta = i_max + (0x400 - i_min);
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun 		if (q_max < 0x200 && q_min < 0x200)
303*4882a593Smuzhiyun 			q_delta = q_max - q_min;
304*4882a593Smuzhiyun 		else if (q_max >= 0x200 && q_min >= 0x200)
305*4882a593Smuzhiyun 			q_delta = q_max - q_min;
306*4882a593Smuzhiyun 		else
307*4882a593Smuzhiyun 			q_delta = q_max + (0x400 - q_min);
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 		rtw_dbg(rtwdev, RTW_DBG_RFK,
310*4882a593Smuzhiyun 			"[DACK] i: min=0x%08x, max=0x%08x, delta=0x%08x\n",
311*4882a593Smuzhiyun 			i_min, i_max, i_delta);
312*4882a593Smuzhiyun 		rtw_dbg(rtwdev, RTW_DBG_RFK,
313*4882a593Smuzhiyun 			"[DACK] q: min=0x%08x, max=0x%08x, delta=0x%08x\n",
314*4882a593Smuzhiyun 			q_min, q_max, q_delta);
315*4882a593Smuzhiyun 
316*4882a593Smuzhiyun 		rtw8822c_dac_iq_sort(rtwdev, iv, qv);
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun 		if (i_delta > 5 || q_delta > 5) {
319*4882a593Smuzhiyun 			temp = rtw_read32_mask(rtwdev, 0x2dbc, 0x3fffff);
320*4882a593Smuzhiyun 			iv[0] = (temp & 0x3ff000) >> 12;
321*4882a593Smuzhiyun 			qv[0] = temp & 0x3ff;
322*4882a593Smuzhiyun 			temp = rtw_read32_mask(rtwdev, 0x2dbc, 0x3fffff);
323*4882a593Smuzhiyun 			iv[DACK_SN_8822C - 1] = (temp & 0x3ff000) >> 12;
324*4882a593Smuzhiyun 			qv[DACK_SN_8822C - 1] = temp & 0x3ff;
325*4882a593Smuzhiyun 		} else {
326*4882a593Smuzhiyun 			break;
327*4882a593Smuzhiyun 		}
328*4882a593Smuzhiyun 	} while (cnt++ < 100);
329*4882a593Smuzhiyun 
330*4882a593Smuzhiyun 	rtw8822c_dac_iq_offset(rtwdev, iv, i_value);
331*4882a593Smuzhiyun 	rtw8822c_dac_iq_offset(rtwdev, qv, q_value);
332*4882a593Smuzhiyun }
333*4882a593Smuzhiyun 
rtw8822c_dac_cal_rf_mode(struct rtw_dev * rtwdev,u32 * i_value,u32 * q_value)334*4882a593Smuzhiyun static void rtw8822c_dac_cal_rf_mode(struct rtw_dev *rtwdev,
335*4882a593Smuzhiyun 				     u32 *i_value, u32 *q_value)
336*4882a593Smuzhiyun {
337*4882a593Smuzhiyun 	u32 iv[DACK_SN_8822C], qv[DACK_SN_8822C];
338*4882a593Smuzhiyun 	u32 rf_a, rf_b;
339*4882a593Smuzhiyun 
340*4882a593Smuzhiyun 	rf_a = rtw_read_rf(rtwdev, RF_PATH_A, 0x0, RFREG_MASK);
341*4882a593Smuzhiyun 	rf_b = rtw_read_rf(rtwdev, RF_PATH_B, 0x0, RFREG_MASK);
342*4882a593Smuzhiyun 
343*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] RF path-A=0x%05x\n", rf_a);
344*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] RF path-B=0x%05x\n", rf_b);
345*4882a593Smuzhiyun 
346*4882a593Smuzhiyun 	rtw8822c_dac_cal_iq_sample(rtwdev, iv, qv);
347*4882a593Smuzhiyun 	rtw8822c_dac_cal_iq_search(rtwdev, iv, qv, i_value, q_value);
348*4882a593Smuzhiyun }
349*4882a593Smuzhiyun 
rtw8822c_dac_bb_setting(struct rtw_dev * rtwdev)350*4882a593Smuzhiyun static void rtw8822c_dac_bb_setting(struct rtw_dev *rtwdev)
351*4882a593Smuzhiyun {
352*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1d58, 0xff8, 0x1ff);
353*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1a00, 0x3, 0x2);
354*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1a14, 0x300, 0x3);
355*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1d70, 0x7e7e7e7e);
356*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x180c, 0x3, 0x0);
357*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x410c, 0x3, 0x0);
358*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1b00, 0x00000008);
359*4882a593Smuzhiyun 	rtw_write8(rtwdev, 0x1bcc, 0x3f);
360*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1b00, 0x0000000a);
361*4882a593Smuzhiyun 	rtw_write8(rtwdev, 0x1bcc, 0x3f);
362*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1e24, BIT(31), 0x0);
363*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1e28, 0xf, 0x3);
364*4882a593Smuzhiyun }
365*4882a593Smuzhiyun 
rtw8822c_dac_cal_adc(struct rtw_dev * rtwdev,u8 path,u32 * adc_ic,u32 * adc_qc)366*4882a593Smuzhiyun static void rtw8822c_dac_cal_adc(struct rtw_dev *rtwdev,
367*4882a593Smuzhiyun 				 u8 path, u32 *adc_ic, u32 *adc_qc)
368*4882a593Smuzhiyun {
369*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
370*4882a593Smuzhiyun 	u32 ic = 0, qc = 0, temp = 0;
371*4882a593Smuzhiyun 	u32 base_addr;
372*4882a593Smuzhiyun 	u32 path_sel;
373*4882a593Smuzhiyun 	int i;
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] ADCK path(%d)\n", path);
376*4882a593Smuzhiyun 
377*4882a593Smuzhiyun 	base_addr = rtw8822c_get_path_write_addr(path);
378*4882a593Smuzhiyun 	switch (path) {
379*4882a593Smuzhiyun 	case RF_PATH_A:
380*4882a593Smuzhiyun 		path_sel = 0xa0000;
381*4882a593Smuzhiyun 		break;
382*4882a593Smuzhiyun 	case RF_PATH_B:
383*4882a593Smuzhiyun 		path_sel = 0x80000;
384*4882a593Smuzhiyun 		break;
385*4882a593Smuzhiyun 	default:
386*4882a593Smuzhiyun 		WARN_ON(1);
387*4882a593Smuzhiyun 		return;
388*4882a593Smuzhiyun 	}
389*4882a593Smuzhiyun 
390*4882a593Smuzhiyun 	/* ADCK step1 */
391*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0x30, BIT(30), 0x0);
392*4882a593Smuzhiyun 	if (path == RF_PATH_B)
393*4882a593Smuzhiyun 		rtw_write32(rtwdev, base_addr + 0x30, 0x30db8041);
394*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x60, 0xf0040ff0);
395*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x0c, 0xdff00220);
396*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x10, 0x02dd08c4);
397*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x0c, 0x10000260);
398*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, 0x0, RFREG_MASK, 0x10000);
399*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_B, 0x0, RFREG_MASK, 0x10000);
400*4882a593Smuzhiyun 	for (i = 0; i < 10; i++) {
401*4882a593Smuzhiyun 		rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] ADCK count=%d\n", i);
402*4882a593Smuzhiyun 		rtw_write32(rtwdev, 0x1c3c, path_sel + 0x8003);
403*4882a593Smuzhiyun 		rtw_write32(rtwdev, 0x1c24, 0x00010002);
404*4882a593Smuzhiyun 		rtw8822c_dac_cal_rf_mode(rtwdev, &ic, &qc);
405*4882a593Smuzhiyun 		rtw_dbg(rtwdev, RTW_DBG_RFK,
406*4882a593Smuzhiyun 			"[DACK] before: i=0x%x, q=0x%x\n", ic, qc);
407*4882a593Smuzhiyun 
408*4882a593Smuzhiyun 		/* compensation value */
409*4882a593Smuzhiyun 		if (ic != 0x0) {
410*4882a593Smuzhiyun 			ic = 0x400 - ic;
411*4882a593Smuzhiyun 			*adc_ic = ic;
412*4882a593Smuzhiyun 		}
413*4882a593Smuzhiyun 		if (qc != 0x0) {
414*4882a593Smuzhiyun 			qc = 0x400 - qc;
415*4882a593Smuzhiyun 			*adc_qc = qc;
416*4882a593Smuzhiyun 		}
417*4882a593Smuzhiyun 		temp = (ic & 0x3ff) | ((qc & 0x3ff) << 10);
418*4882a593Smuzhiyun 		rtw_write32(rtwdev, base_addr + 0x68, temp);
419*4882a593Smuzhiyun 		dm_info->dack_adck[path] = temp;
420*4882a593Smuzhiyun 		rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] ADCK 0x%08x=0x08%x\n",
421*4882a593Smuzhiyun 			base_addr + 0x68, temp);
422*4882a593Smuzhiyun 		/* check ADC DC offset */
423*4882a593Smuzhiyun 		rtw_write32(rtwdev, 0x1c3c, path_sel + 0x8103);
424*4882a593Smuzhiyun 		rtw8822c_dac_cal_rf_mode(rtwdev, &ic, &qc);
425*4882a593Smuzhiyun 		rtw_dbg(rtwdev, RTW_DBG_RFK,
426*4882a593Smuzhiyun 			"[DACK] after:  i=0x%08x, q=0x%08x\n", ic, qc);
427*4882a593Smuzhiyun 		if (ic >= 0x200)
428*4882a593Smuzhiyun 			ic = 0x400 - ic;
429*4882a593Smuzhiyun 		if (qc >= 0x200)
430*4882a593Smuzhiyun 			qc = 0x400 - qc;
431*4882a593Smuzhiyun 		if (ic < 5 && qc < 5)
432*4882a593Smuzhiyun 			break;
433*4882a593Smuzhiyun 	}
434*4882a593Smuzhiyun 
435*4882a593Smuzhiyun 	/* ADCK step2 */
436*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1c3c, 0x00000003);
437*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x0c, 0x10000260);
438*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c4);
439*4882a593Smuzhiyun 
440*4882a593Smuzhiyun 	/* release pull low switch on IQ path */
441*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, 0x8f, BIT(13), 0x1);
442*4882a593Smuzhiyun }
443*4882a593Smuzhiyun 
rtw8822c_dac_cal_step1(struct rtw_dev * rtwdev,u8 path)444*4882a593Smuzhiyun static void rtw8822c_dac_cal_step1(struct rtw_dev *rtwdev, u8 path)
445*4882a593Smuzhiyun {
446*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
447*4882a593Smuzhiyun 	u32 base_addr;
448*4882a593Smuzhiyun 	u32 read_addr;
449*4882a593Smuzhiyun 
450*4882a593Smuzhiyun 	base_addr = rtw8822c_get_path_write_addr(path);
451*4882a593Smuzhiyun 	read_addr = rtw8822c_get_path_read_addr(path);
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x68, dm_info->dack_adck[path]);
454*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x0c, 0xdff00220);
455*4882a593Smuzhiyun 	if (path == RF_PATH_A) {
456*4882a593Smuzhiyun 		rtw_write32(rtwdev, base_addr + 0x60, 0xf0040ff0);
457*4882a593Smuzhiyun 		rtw_write32(rtwdev, 0x1c38, 0xffffffff);
458*4882a593Smuzhiyun 	}
459*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c5);
460*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x9b4, 0xdb66db00);
461*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xb0, 0x0a11fb88);
462*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xbc, 0x0008ff81);
463*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xc0, 0x0003d208);
464*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xcc, 0x0a11fb88);
465*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xd8, 0x0008ff81);
466*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xdc, 0x0003d208);
467*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xb8, 0x60000000);
468*4882a593Smuzhiyun 	mdelay(2);
469*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xbc, 0x000aff8d);
470*4882a593Smuzhiyun 	mdelay(2);
471*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xb0, 0x0a11fb89);
472*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xcc, 0x0a11fb89);
473*4882a593Smuzhiyun 	mdelay(1);
474*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xb8, 0x62000000);
475*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xd4, 0x62000000);
476*4882a593Smuzhiyun 	mdelay(20);
477*4882a593Smuzhiyun 	if (!check_hw_ready(rtwdev, read_addr + 0x08, 0x7fff80, 0xffff) ||
478*4882a593Smuzhiyun 	    !check_hw_ready(rtwdev, read_addr + 0x34, 0x7fff80, 0xffff))
479*4882a593Smuzhiyun 		rtw_err(rtwdev, "failed to wait for dack ready\n");
480*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xb8, 0x02000000);
481*4882a593Smuzhiyun 	mdelay(1);
482*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xbc, 0x0008ff87);
483*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x9b4, 0xdb6db600);
484*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c5);
485*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xbc, 0x0008ff87);
486*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x60, 0xf0000000);
487*4882a593Smuzhiyun }
488*4882a593Smuzhiyun 
rtw8822c_dac_cal_step2(struct rtw_dev * rtwdev,u8 path,u32 * ic_out,u32 * qc_out)489*4882a593Smuzhiyun static void rtw8822c_dac_cal_step2(struct rtw_dev *rtwdev,
490*4882a593Smuzhiyun 				   u8 path, u32 *ic_out, u32 *qc_out)
491*4882a593Smuzhiyun {
492*4882a593Smuzhiyun 	u32 base_addr;
493*4882a593Smuzhiyun 	u32 ic, qc, ic_in, qc_in;
494*4882a593Smuzhiyun 
495*4882a593Smuzhiyun 	base_addr = rtw8822c_get_path_write_addr(path);
496*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0xbc, 0xf0000000, 0x0);
497*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0xc0, 0xf, 0x8);
498*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0xd8, 0xf0000000, 0x0);
499*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0xdc, 0xf, 0x8);
500*4882a593Smuzhiyun 
501*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1b00, 0x00000008);
502*4882a593Smuzhiyun 	rtw_write8(rtwdev, 0x1bcc, 0x03f);
503*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x0c, 0xdff00220);
504*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c5);
505*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1c3c, 0x00088103);
506*4882a593Smuzhiyun 
507*4882a593Smuzhiyun 	rtw8822c_dac_cal_rf_mode(rtwdev, &ic_in, &qc_in);
508*4882a593Smuzhiyun 	ic = ic_in;
509*4882a593Smuzhiyun 	qc = qc_in;
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun 	/* compensation value */
512*4882a593Smuzhiyun 	if (ic != 0x0)
513*4882a593Smuzhiyun 		ic = 0x400 - ic;
514*4882a593Smuzhiyun 	if (qc != 0x0)
515*4882a593Smuzhiyun 		qc = 0x400 - qc;
516*4882a593Smuzhiyun 	if (ic < 0x300) {
517*4882a593Smuzhiyun 		ic = ic * 2 * 6 / 5;
518*4882a593Smuzhiyun 		ic = ic + 0x80;
519*4882a593Smuzhiyun 	} else {
520*4882a593Smuzhiyun 		ic = (0x400 - ic) * 2 * 6 / 5;
521*4882a593Smuzhiyun 		ic = 0x7f - ic;
522*4882a593Smuzhiyun 	}
523*4882a593Smuzhiyun 	if (qc < 0x300) {
524*4882a593Smuzhiyun 		qc = qc * 2 * 6 / 5;
525*4882a593Smuzhiyun 		qc = qc + 0x80;
526*4882a593Smuzhiyun 	} else {
527*4882a593Smuzhiyun 		qc = (0x400 - qc) * 2 * 6 / 5;
528*4882a593Smuzhiyun 		qc = 0x7f - qc;
529*4882a593Smuzhiyun 	}
530*4882a593Smuzhiyun 
531*4882a593Smuzhiyun 	*ic_out = ic;
532*4882a593Smuzhiyun 	*qc_out = qc;
533*4882a593Smuzhiyun 
534*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] before i=0x%x, q=0x%x\n", ic_in, qc_in);
535*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] after  i=0x%x, q=0x%x\n", ic, qc);
536*4882a593Smuzhiyun }
537*4882a593Smuzhiyun 
rtw8822c_dac_cal_step3(struct rtw_dev * rtwdev,u8 path,u32 adc_ic,u32 adc_qc,u32 * ic_in,u32 * qc_in,u32 * i_out,u32 * q_out)538*4882a593Smuzhiyun static void rtw8822c_dac_cal_step3(struct rtw_dev *rtwdev, u8 path,
539*4882a593Smuzhiyun 				   u32 adc_ic, u32 adc_qc,
540*4882a593Smuzhiyun 				   u32 *ic_in, u32 *qc_in,
541*4882a593Smuzhiyun 				   u32 *i_out, u32 *q_out)
542*4882a593Smuzhiyun {
543*4882a593Smuzhiyun 	u32 base_addr;
544*4882a593Smuzhiyun 	u32 read_addr;
545*4882a593Smuzhiyun 	u32 ic, qc;
546*4882a593Smuzhiyun 	u32 temp;
547*4882a593Smuzhiyun 
548*4882a593Smuzhiyun 	base_addr = rtw8822c_get_path_write_addr(path);
549*4882a593Smuzhiyun 	read_addr = rtw8822c_get_path_read_addr(path);
550*4882a593Smuzhiyun 	ic = *ic_in;
551*4882a593Smuzhiyun 	qc = *qc_in;
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x0c, 0xdff00220);
554*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c5);
555*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x9b4, 0xdb66db00);
556*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xb0, 0x0a11fb88);
557*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xbc, 0xc008ff81);
558*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xc0, 0x0003d208);
559*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0xbc, 0xf0000000, ic & 0xf);
560*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0xc0, 0xf, (ic & 0xf0) >> 4);
561*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xcc, 0x0a11fb88);
562*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xd8, 0xe008ff81);
563*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xdc, 0x0003d208);
564*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0xd8, 0xf0000000, qc & 0xf);
565*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0xdc, 0xf, (qc & 0xf0) >> 4);
566*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xb8, 0x60000000);
567*4882a593Smuzhiyun 	mdelay(2);
568*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0xbc, 0xe, 0x6);
569*4882a593Smuzhiyun 	mdelay(2);
570*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xb0, 0x0a11fb89);
571*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xcc, 0x0a11fb89);
572*4882a593Smuzhiyun 	mdelay(1);
573*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xb8, 0x62000000);
574*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xd4, 0x62000000);
575*4882a593Smuzhiyun 	mdelay(20);
576*4882a593Smuzhiyun 	if (!check_hw_ready(rtwdev, read_addr + 0x24, 0x07f80000, ic) ||
577*4882a593Smuzhiyun 	    !check_hw_ready(rtwdev, read_addr + 0x50, 0x07f80000, qc))
578*4882a593Smuzhiyun 		rtw_err(rtwdev, "failed to write IQ vector to hardware\n");
579*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0xb8, 0x02000000);
580*4882a593Smuzhiyun 	mdelay(1);
581*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0xbc, 0xe, 0x3);
582*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x9b4, 0xdb6db600);
583*4882a593Smuzhiyun 
584*4882a593Smuzhiyun 	/* check DAC DC offset */
585*4882a593Smuzhiyun 	temp = ((adc_ic + 0x10) & 0x3ff) | (((adc_qc + 0x10) & 0x3ff) << 10);
586*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x68, temp);
587*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c5);
588*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x60, 0xf0000000);
589*4882a593Smuzhiyun 	rtw8822c_dac_cal_rf_mode(rtwdev, &ic, &qc);
590*4882a593Smuzhiyun 	if (ic >= 0x10)
591*4882a593Smuzhiyun 		ic = ic - 0x10;
592*4882a593Smuzhiyun 	else
593*4882a593Smuzhiyun 		ic = 0x400 - (0x10 - ic);
594*4882a593Smuzhiyun 
595*4882a593Smuzhiyun 	if (qc >= 0x10)
596*4882a593Smuzhiyun 		qc = qc - 0x10;
597*4882a593Smuzhiyun 	else
598*4882a593Smuzhiyun 		qc = 0x400 - (0x10 - qc);
599*4882a593Smuzhiyun 
600*4882a593Smuzhiyun 	*i_out = ic;
601*4882a593Smuzhiyun 	*q_out = qc;
602*4882a593Smuzhiyun 
603*4882a593Smuzhiyun 	if (ic >= 0x200)
604*4882a593Smuzhiyun 		ic = 0x400 - ic;
605*4882a593Smuzhiyun 	if (qc >= 0x200)
606*4882a593Smuzhiyun 		qc = 0x400 - qc;
607*4882a593Smuzhiyun 
608*4882a593Smuzhiyun 	*ic_in = ic;
609*4882a593Smuzhiyun 	*qc_in = qc;
610*4882a593Smuzhiyun 
611*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK,
612*4882a593Smuzhiyun 		"[DACK] after  DACK i=0x%x, q=0x%x\n", *i_out, *q_out);
613*4882a593Smuzhiyun }
614*4882a593Smuzhiyun 
rtw8822c_dac_cal_step4(struct rtw_dev * rtwdev,u8 path)615*4882a593Smuzhiyun static void rtw8822c_dac_cal_step4(struct rtw_dev *rtwdev, u8 path)
616*4882a593Smuzhiyun {
617*4882a593Smuzhiyun 	u32 base_addr = rtw8822c_get_path_write_addr(path);
618*4882a593Smuzhiyun 
619*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x68, 0x0);
620*4882a593Smuzhiyun 	rtw_write32(rtwdev, base_addr + 0x10, 0x02d508c4);
621*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0xbc, 0x1, 0x0);
622*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, base_addr + 0x30, BIT(30), 0x1);
623*4882a593Smuzhiyun }
624*4882a593Smuzhiyun 
rtw8822c_dac_cal_backup_vec(struct rtw_dev * rtwdev,u8 path,u8 vec,u32 w_addr,u32 r_addr)625*4882a593Smuzhiyun static void rtw8822c_dac_cal_backup_vec(struct rtw_dev *rtwdev,
626*4882a593Smuzhiyun 					u8 path, u8 vec, u32 w_addr, u32 r_addr)
627*4882a593Smuzhiyun {
628*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
629*4882a593Smuzhiyun 	u16 val;
630*4882a593Smuzhiyun 	u32 i;
631*4882a593Smuzhiyun 
632*4882a593Smuzhiyun 	if (WARN_ON(vec >= 2))
633*4882a593Smuzhiyun 		return;
634*4882a593Smuzhiyun 
635*4882a593Smuzhiyun 	for (i = 0; i < DACK_MSBK_BACKUP_NUM; i++) {
636*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, w_addr, 0xf0000000, i);
637*4882a593Smuzhiyun 		val = (u16)rtw_read32_mask(rtwdev, r_addr, 0x7fc0000);
638*4882a593Smuzhiyun 		dm_info->dack_msbk[path][vec][i] = val;
639*4882a593Smuzhiyun 	}
640*4882a593Smuzhiyun }
641*4882a593Smuzhiyun 
rtw8822c_dac_cal_backup_path(struct rtw_dev * rtwdev,u8 path)642*4882a593Smuzhiyun static void rtw8822c_dac_cal_backup_path(struct rtw_dev *rtwdev, u8 path)
643*4882a593Smuzhiyun {
644*4882a593Smuzhiyun 	u32 w_off = 0x1c;
645*4882a593Smuzhiyun 	u32 r_off = 0x2c;
646*4882a593Smuzhiyun 	u32 w_addr, r_addr;
647*4882a593Smuzhiyun 
648*4882a593Smuzhiyun 	if (WARN_ON(path >= 2))
649*4882a593Smuzhiyun 		return;
650*4882a593Smuzhiyun 
651*4882a593Smuzhiyun 	/* backup I vector */
652*4882a593Smuzhiyun 	w_addr = rtw8822c_get_path_write_addr(path) + 0xb0;
653*4882a593Smuzhiyun 	r_addr = rtw8822c_get_path_read_addr(path) + 0x10;
654*4882a593Smuzhiyun 	rtw8822c_dac_cal_backup_vec(rtwdev, path, 0, w_addr, r_addr);
655*4882a593Smuzhiyun 
656*4882a593Smuzhiyun 	/* backup Q vector */
657*4882a593Smuzhiyun 	w_addr = rtw8822c_get_path_write_addr(path) + 0xb0 + w_off;
658*4882a593Smuzhiyun 	r_addr = rtw8822c_get_path_read_addr(path) + 0x10 + r_off;
659*4882a593Smuzhiyun 	rtw8822c_dac_cal_backup_vec(rtwdev, path, 1, w_addr, r_addr);
660*4882a593Smuzhiyun }
661*4882a593Smuzhiyun 
rtw8822c_dac_cal_backup_dck(struct rtw_dev * rtwdev)662*4882a593Smuzhiyun static void rtw8822c_dac_cal_backup_dck(struct rtw_dev *rtwdev)
663*4882a593Smuzhiyun {
664*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
665*4882a593Smuzhiyun 	u8 val;
666*4882a593Smuzhiyun 
667*4882a593Smuzhiyun 	val = (u8)rtw_read32_mask(rtwdev, REG_DCKA_I_0, 0xf0000000);
668*4882a593Smuzhiyun 	dm_info->dack_dck[RF_PATH_A][0][0] = val;
669*4882a593Smuzhiyun 	val = (u8)rtw_read32_mask(rtwdev, REG_DCKA_I_1, 0xf);
670*4882a593Smuzhiyun 	dm_info->dack_dck[RF_PATH_A][0][1] = val;
671*4882a593Smuzhiyun 	val = (u8)rtw_read32_mask(rtwdev, REG_DCKA_Q_0, 0xf0000000);
672*4882a593Smuzhiyun 	dm_info->dack_dck[RF_PATH_A][1][0] = val;
673*4882a593Smuzhiyun 	val = (u8)rtw_read32_mask(rtwdev, REG_DCKA_Q_1, 0xf);
674*4882a593Smuzhiyun 	dm_info->dack_dck[RF_PATH_A][1][1] = val;
675*4882a593Smuzhiyun 
676*4882a593Smuzhiyun 	val = (u8)rtw_read32_mask(rtwdev, REG_DCKB_I_0, 0xf0000000);
677*4882a593Smuzhiyun 	dm_info->dack_dck[RF_PATH_B][0][0] = val;
678*4882a593Smuzhiyun 	val = (u8)rtw_read32_mask(rtwdev, REG_DCKB_I_1, 0xf);
679*4882a593Smuzhiyun 	dm_info->dack_dck[RF_PATH_B][1][0] = val;
680*4882a593Smuzhiyun 	val = (u8)rtw_read32_mask(rtwdev, REG_DCKB_Q_0, 0xf0000000);
681*4882a593Smuzhiyun 	dm_info->dack_dck[RF_PATH_B][0][1] = val;
682*4882a593Smuzhiyun 	val = (u8)rtw_read32_mask(rtwdev, REG_DCKB_Q_1, 0xf);
683*4882a593Smuzhiyun 	dm_info->dack_dck[RF_PATH_B][1][1] = val;
684*4882a593Smuzhiyun }
685*4882a593Smuzhiyun 
rtw8822c_dac_cal_backup(struct rtw_dev * rtwdev)686*4882a593Smuzhiyun static void rtw8822c_dac_cal_backup(struct rtw_dev *rtwdev)
687*4882a593Smuzhiyun {
688*4882a593Smuzhiyun 	u32 temp[3];
689*4882a593Smuzhiyun 
690*4882a593Smuzhiyun 	temp[0] = rtw_read32(rtwdev, 0x1860);
691*4882a593Smuzhiyun 	temp[1] = rtw_read32(rtwdev, 0x4160);
692*4882a593Smuzhiyun 	temp[2] = rtw_read32(rtwdev, 0x9b4);
693*4882a593Smuzhiyun 
694*4882a593Smuzhiyun 	/* set clock */
695*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x9b4, 0xdb66db00);
696*4882a593Smuzhiyun 
697*4882a593Smuzhiyun 	/* backup path-A I/Q */
698*4882a593Smuzhiyun 	rtw_write32_clr(rtwdev, 0x1830, BIT(30));
699*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1860, 0xfc000000, 0x3c);
700*4882a593Smuzhiyun 	rtw8822c_dac_cal_backup_path(rtwdev, RF_PATH_A);
701*4882a593Smuzhiyun 
702*4882a593Smuzhiyun 	/* backup path-B I/Q */
703*4882a593Smuzhiyun 	rtw_write32_clr(rtwdev, 0x4130, BIT(30));
704*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x4160, 0xfc000000, 0x3c);
705*4882a593Smuzhiyun 	rtw8822c_dac_cal_backup_path(rtwdev, RF_PATH_B);
706*4882a593Smuzhiyun 
707*4882a593Smuzhiyun 	rtw8822c_dac_cal_backup_dck(rtwdev);
708*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, 0x1830, BIT(30));
709*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, 0x4130, BIT(30));
710*4882a593Smuzhiyun 
711*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1860, temp[0]);
712*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x4160, temp[1]);
713*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x9b4, temp[2]);
714*4882a593Smuzhiyun }
715*4882a593Smuzhiyun 
rtw8822c_dac_cal_restore_dck(struct rtw_dev * rtwdev)716*4882a593Smuzhiyun static void rtw8822c_dac_cal_restore_dck(struct rtw_dev *rtwdev)
717*4882a593Smuzhiyun {
718*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
719*4882a593Smuzhiyun 	u8 val;
720*4882a593Smuzhiyun 
721*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_DCKA_I_0, BIT(19));
722*4882a593Smuzhiyun 	val = dm_info->dack_dck[RF_PATH_A][0][0];
723*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DCKA_I_0, 0xf0000000, val);
724*4882a593Smuzhiyun 	val = dm_info->dack_dck[RF_PATH_A][0][1];
725*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DCKA_I_1, 0xf, val);
726*4882a593Smuzhiyun 
727*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_DCKA_Q_0, BIT(19));
728*4882a593Smuzhiyun 	val = dm_info->dack_dck[RF_PATH_A][1][0];
729*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DCKA_Q_0, 0xf0000000, val);
730*4882a593Smuzhiyun 	val = dm_info->dack_dck[RF_PATH_A][1][1];
731*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DCKA_Q_1, 0xf, val);
732*4882a593Smuzhiyun 
733*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_DCKB_I_0, BIT(19));
734*4882a593Smuzhiyun 	val = dm_info->dack_dck[RF_PATH_B][0][0];
735*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DCKB_I_0, 0xf0000000, val);
736*4882a593Smuzhiyun 	val = dm_info->dack_dck[RF_PATH_B][0][1];
737*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DCKB_I_1, 0xf, val);
738*4882a593Smuzhiyun 
739*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_DCKB_Q_0, BIT(19));
740*4882a593Smuzhiyun 	val = dm_info->dack_dck[RF_PATH_B][1][0];
741*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DCKB_Q_0, 0xf0000000, val);
742*4882a593Smuzhiyun 	val = dm_info->dack_dck[RF_PATH_B][1][1];
743*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DCKB_Q_1, 0xf, val);
744*4882a593Smuzhiyun }
745*4882a593Smuzhiyun 
rtw8822c_dac_cal_restore_prepare(struct rtw_dev * rtwdev)746*4882a593Smuzhiyun static void rtw8822c_dac_cal_restore_prepare(struct rtw_dev *rtwdev)
747*4882a593Smuzhiyun {
748*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x9b4, 0xdb66db00);
749*4882a593Smuzhiyun 
750*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18b0, BIT(27), 0x0);
751*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18cc, BIT(27), 0x0);
752*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41b0, BIT(27), 0x0);
753*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41cc, BIT(27), 0x0);
754*4882a593Smuzhiyun 
755*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1830, BIT(30), 0x0);
756*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1860, 0xfc000000, 0x3c);
757*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18b4, BIT(0), 0x1);
758*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18d0, BIT(0), 0x1);
759*4882a593Smuzhiyun 
760*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x4130, BIT(30), 0x0);
761*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x4160, 0xfc000000, 0x3c);
762*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41b4, BIT(0), 0x1);
763*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41d0, BIT(0), 0x1);
764*4882a593Smuzhiyun 
765*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18b0, 0xf00, 0x0);
766*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18c0, BIT(14), 0x0);
767*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18cc, 0xf00, 0x0);
768*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18dc, BIT(14), 0x0);
769*4882a593Smuzhiyun 
770*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18b0, BIT(0), 0x0);
771*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18cc, BIT(0), 0x0);
772*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18b0, BIT(0), 0x1);
773*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18cc, BIT(0), 0x1);
774*4882a593Smuzhiyun 
775*4882a593Smuzhiyun 	rtw8822c_dac_cal_restore_dck(rtwdev);
776*4882a593Smuzhiyun 
777*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18c0, 0x38000, 0x7);
778*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18dc, 0x38000, 0x7);
779*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41c0, 0x38000, 0x7);
780*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41dc, 0x38000, 0x7);
781*4882a593Smuzhiyun 
782*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18b8, BIT(26) | BIT(25), 0x1);
783*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18d4, BIT(26) | BIT(25), 0x1);
784*4882a593Smuzhiyun 
785*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41b0, 0xf00, 0x0);
786*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41c0, BIT(14), 0x0);
787*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41cc, 0xf00, 0x0);
788*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41dc, BIT(14), 0x0);
789*4882a593Smuzhiyun 
790*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41b0, BIT(0), 0x0);
791*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41cc, BIT(0), 0x0);
792*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41b0, BIT(0), 0x1);
793*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41cc, BIT(0), 0x1);
794*4882a593Smuzhiyun 
795*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41b8, BIT(26) | BIT(25), 0x1);
796*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41d4, BIT(26) | BIT(25), 0x1);
797*4882a593Smuzhiyun }
798*4882a593Smuzhiyun 
rtw8822c_dac_cal_restore_wait(struct rtw_dev * rtwdev,u32 target_addr,u32 toggle_addr)799*4882a593Smuzhiyun static bool rtw8822c_dac_cal_restore_wait(struct rtw_dev *rtwdev,
800*4882a593Smuzhiyun 					  u32 target_addr, u32 toggle_addr)
801*4882a593Smuzhiyun {
802*4882a593Smuzhiyun 	u32 cnt = 0;
803*4882a593Smuzhiyun 
804*4882a593Smuzhiyun 	do {
805*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, toggle_addr, BIT(26) | BIT(25), 0x0);
806*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, toggle_addr, BIT(26) | BIT(25), 0x2);
807*4882a593Smuzhiyun 
808*4882a593Smuzhiyun 		if (rtw_read32_mask(rtwdev, target_addr, 0xf) == 0x6)
809*4882a593Smuzhiyun 			return true;
810*4882a593Smuzhiyun 
811*4882a593Smuzhiyun 	} while (cnt++ < 100);
812*4882a593Smuzhiyun 
813*4882a593Smuzhiyun 	return false;
814*4882a593Smuzhiyun }
815*4882a593Smuzhiyun 
rtw8822c_dac_cal_restore_path(struct rtw_dev * rtwdev,u8 path)816*4882a593Smuzhiyun static bool rtw8822c_dac_cal_restore_path(struct rtw_dev *rtwdev, u8 path)
817*4882a593Smuzhiyun {
818*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
819*4882a593Smuzhiyun 	u32 w_off = 0x1c;
820*4882a593Smuzhiyun 	u32 r_off = 0x2c;
821*4882a593Smuzhiyun 	u32 w_i, r_i, w_q, r_q;
822*4882a593Smuzhiyun 	u32 value;
823*4882a593Smuzhiyun 	u32 i;
824*4882a593Smuzhiyun 
825*4882a593Smuzhiyun 	w_i = rtw8822c_get_path_write_addr(path) + 0xb0;
826*4882a593Smuzhiyun 	r_i = rtw8822c_get_path_read_addr(path) + 0x08;
827*4882a593Smuzhiyun 	w_q = rtw8822c_get_path_write_addr(path) + 0xb0 + w_off;
828*4882a593Smuzhiyun 	r_q = rtw8822c_get_path_read_addr(path) + 0x08 + r_off;
829*4882a593Smuzhiyun 
830*4882a593Smuzhiyun 	if (!rtw8822c_dac_cal_restore_wait(rtwdev, r_i, w_i + 0x8))
831*4882a593Smuzhiyun 		return false;
832*4882a593Smuzhiyun 
833*4882a593Smuzhiyun 	for (i = 0; i < DACK_MSBK_BACKUP_NUM; i++) {
834*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, w_i + 0x4, BIT(2), 0x0);
835*4882a593Smuzhiyun 		value = dm_info->dack_msbk[path][0][i];
836*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, w_i + 0x4, 0xff8, value);
837*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, w_i, 0xf0000000, i);
838*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, w_i + 0x4, BIT(2), 0x1);
839*4882a593Smuzhiyun 	}
840*4882a593Smuzhiyun 
841*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, w_i + 0x4, BIT(2), 0x0);
842*4882a593Smuzhiyun 
843*4882a593Smuzhiyun 	if (!rtw8822c_dac_cal_restore_wait(rtwdev, r_q, w_q + 0x8))
844*4882a593Smuzhiyun 		return false;
845*4882a593Smuzhiyun 
846*4882a593Smuzhiyun 	for (i = 0; i < DACK_MSBK_BACKUP_NUM; i++) {
847*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, w_q + 0x4, BIT(2), 0x0);
848*4882a593Smuzhiyun 		value = dm_info->dack_msbk[path][1][i];
849*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, w_q + 0x4, 0xff8, value);
850*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, w_q, 0xf0000000, i);
851*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, w_q + 0x4, BIT(2), 0x1);
852*4882a593Smuzhiyun 	}
853*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, w_q + 0x4, BIT(2), 0x0);
854*4882a593Smuzhiyun 
855*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, w_i + 0x8, BIT(26) | BIT(25), 0x0);
856*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, w_q + 0x8, BIT(26) | BIT(25), 0x0);
857*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, w_i + 0x4, BIT(0), 0x0);
858*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, w_q + 0x4, BIT(0), 0x0);
859*4882a593Smuzhiyun 
860*4882a593Smuzhiyun 	return true;
861*4882a593Smuzhiyun }
862*4882a593Smuzhiyun 
__rtw8822c_dac_cal_restore(struct rtw_dev * rtwdev)863*4882a593Smuzhiyun static bool __rtw8822c_dac_cal_restore(struct rtw_dev *rtwdev)
864*4882a593Smuzhiyun {
865*4882a593Smuzhiyun 	if (!rtw8822c_dac_cal_restore_path(rtwdev, RF_PATH_A))
866*4882a593Smuzhiyun 		return false;
867*4882a593Smuzhiyun 
868*4882a593Smuzhiyun 	if (!rtw8822c_dac_cal_restore_path(rtwdev, RF_PATH_B))
869*4882a593Smuzhiyun 		return false;
870*4882a593Smuzhiyun 
871*4882a593Smuzhiyun 	return true;
872*4882a593Smuzhiyun }
873*4882a593Smuzhiyun 
rtw8822c_dac_cal_restore(struct rtw_dev * rtwdev)874*4882a593Smuzhiyun static bool rtw8822c_dac_cal_restore(struct rtw_dev *rtwdev)
875*4882a593Smuzhiyun {
876*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
877*4882a593Smuzhiyun 	u32 temp[3];
878*4882a593Smuzhiyun 
879*4882a593Smuzhiyun 	/* sample the first element for both path's IQ vector */
880*4882a593Smuzhiyun 	if (dm_info->dack_msbk[RF_PATH_A][0][0] == 0 &&
881*4882a593Smuzhiyun 	    dm_info->dack_msbk[RF_PATH_A][1][0] == 0 &&
882*4882a593Smuzhiyun 	    dm_info->dack_msbk[RF_PATH_B][0][0] == 0 &&
883*4882a593Smuzhiyun 	    dm_info->dack_msbk[RF_PATH_B][1][0] == 0)
884*4882a593Smuzhiyun 		return false;
885*4882a593Smuzhiyun 
886*4882a593Smuzhiyun 	temp[0] = rtw_read32(rtwdev, 0x1860);
887*4882a593Smuzhiyun 	temp[1] = rtw_read32(rtwdev, 0x4160);
888*4882a593Smuzhiyun 	temp[2] = rtw_read32(rtwdev, 0x9b4);
889*4882a593Smuzhiyun 
890*4882a593Smuzhiyun 	rtw8822c_dac_cal_restore_prepare(rtwdev);
891*4882a593Smuzhiyun 	if (!check_hw_ready(rtwdev, 0x2808, 0x7fff80, 0xffff) ||
892*4882a593Smuzhiyun 	    !check_hw_ready(rtwdev, 0x2834, 0x7fff80, 0xffff) ||
893*4882a593Smuzhiyun 	    !check_hw_ready(rtwdev, 0x4508, 0x7fff80, 0xffff) ||
894*4882a593Smuzhiyun 	    !check_hw_ready(rtwdev, 0x4534, 0x7fff80, 0xffff))
895*4882a593Smuzhiyun 		return false;
896*4882a593Smuzhiyun 
897*4882a593Smuzhiyun 	if (!__rtw8822c_dac_cal_restore(rtwdev)) {
898*4882a593Smuzhiyun 		rtw_err(rtwdev, "failed to restore dack vectors\n");
899*4882a593Smuzhiyun 		return false;
900*4882a593Smuzhiyun 	}
901*4882a593Smuzhiyun 
902*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1830, BIT(30), 0x1);
903*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x4130, BIT(30), 0x1);
904*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1860, temp[0]);
905*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x4160, temp[1]);
906*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18b0, BIT(27), 0x1);
907*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x18cc, BIT(27), 0x1);
908*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41b0, BIT(27), 0x1);
909*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x41cc, BIT(27), 0x1);
910*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x9b4, temp[2]);
911*4882a593Smuzhiyun 
912*4882a593Smuzhiyun 	return true;
913*4882a593Smuzhiyun }
914*4882a593Smuzhiyun 
rtw8822c_rf_dac_cal(struct rtw_dev * rtwdev)915*4882a593Smuzhiyun static void rtw8822c_rf_dac_cal(struct rtw_dev *rtwdev)
916*4882a593Smuzhiyun {
917*4882a593Smuzhiyun 	struct rtw_backup_info backup_rf[DACK_RF_8822C * DACK_PATH_8822C];
918*4882a593Smuzhiyun 	struct rtw_backup_info backup[DACK_REG_8822C];
919*4882a593Smuzhiyun 	u32 ic = 0, qc = 0, i;
920*4882a593Smuzhiyun 	u32 i_a = 0x0, q_a = 0x0, i_b = 0x0, q_b = 0x0;
921*4882a593Smuzhiyun 	u32 ic_a = 0x0, qc_a = 0x0, ic_b = 0x0, qc_b = 0x0;
922*4882a593Smuzhiyun 	u32 adc_ic_a = 0x0, adc_qc_a = 0x0, adc_ic_b = 0x0, adc_qc_b = 0x0;
923*4882a593Smuzhiyun 
924*4882a593Smuzhiyun 	if (rtw8822c_dac_cal_restore(rtwdev))
925*4882a593Smuzhiyun 		return;
926*4882a593Smuzhiyun 
927*4882a593Smuzhiyun 	/* not able to restore, do it */
928*4882a593Smuzhiyun 
929*4882a593Smuzhiyun 	rtw8822c_dac_backup_reg(rtwdev, backup, backup_rf);
930*4882a593Smuzhiyun 
931*4882a593Smuzhiyun 	rtw8822c_dac_bb_setting(rtwdev);
932*4882a593Smuzhiyun 
933*4882a593Smuzhiyun 	/* path-A */
934*4882a593Smuzhiyun 	rtw8822c_dac_cal_adc(rtwdev, RF_PATH_A, &adc_ic_a, &adc_qc_a);
935*4882a593Smuzhiyun 	for (i = 0; i < 10; i++) {
936*4882a593Smuzhiyun 		rtw8822c_dac_cal_step1(rtwdev, RF_PATH_A);
937*4882a593Smuzhiyun 		rtw8822c_dac_cal_step2(rtwdev, RF_PATH_A, &ic, &qc);
938*4882a593Smuzhiyun 		ic_a = ic;
939*4882a593Smuzhiyun 		qc_a = qc;
940*4882a593Smuzhiyun 
941*4882a593Smuzhiyun 		rtw8822c_dac_cal_step3(rtwdev, RF_PATH_A, adc_ic_a, adc_qc_a,
942*4882a593Smuzhiyun 				       &ic, &qc, &i_a, &q_a);
943*4882a593Smuzhiyun 
944*4882a593Smuzhiyun 		if (ic < 5 && qc < 5)
945*4882a593Smuzhiyun 			break;
946*4882a593Smuzhiyun 	}
947*4882a593Smuzhiyun 	rtw8822c_dac_cal_step4(rtwdev, RF_PATH_A);
948*4882a593Smuzhiyun 
949*4882a593Smuzhiyun 	/* path-B */
950*4882a593Smuzhiyun 	rtw8822c_dac_cal_adc(rtwdev, RF_PATH_B, &adc_ic_b, &adc_qc_b);
951*4882a593Smuzhiyun 	for (i = 0; i < 10; i++) {
952*4882a593Smuzhiyun 		rtw8822c_dac_cal_step1(rtwdev, RF_PATH_B);
953*4882a593Smuzhiyun 		rtw8822c_dac_cal_step2(rtwdev, RF_PATH_B, &ic, &qc);
954*4882a593Smuzhiyun 		ic_b = ic;
955*4882a593Smuzhiyun 		qc_b = qc;
956*4882a593Smuzhiyun 
957*4882a593Smuzhiyun 		rtw8822c_dac_cal_step3(rtwdev, RF_PATH_B, adc_ic_b, adc_qc_b,
958*4882a593Smuzhiyun 				       &ic, &qc, &i_b, &q_b);
959*4882a593Smuzhiyun 
960*4882a593Smuzhiyun 		if (ic < 5 && qc < 5)
961*4882a593Smuzhiyun 			break;
962*4882a593Smuzhiyun 	}
963*4882a593Smuzhiyun 	rtw8822c_dac_cal_step4(rtwdev, RF_PATH_B);
964*4882a593Smuzhiyun 
965*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1b00, 0x00000008);
966*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x4130, BIT(30), 0x1);
967*4882a593Smuzhiyun 	rtw_write8(rtwdev, 0x1bcc, 0x0);
968*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1b00, 0x0000000a);
969*4882a593Smuzhiyun 	rtw_write8(rtwdev, 0x1bcc, 0x0);
970*4882a593Smuzhiyun 
971*4882a593Smuzhiyun 	rtw8822c_dac_restore_reg(rtwdev, backup, backup_rf);
972*4882a593Smuzhiyun 
973*4882a593Smuzhiyun 	/* backup results to restore, saving a lot of time */
974*4882a593Smuzhiyun 	rtw8822c_dac_cal_backup(rtwdev);
975*4882a593Smuzhiyun 
976*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] path A: ic=0x%x, qc=0x%x\n", ic_a, qc_a);
977*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] path B: ic=0x%x, qc=0x%x\n", ic_b, qc_b);
978*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] path A: i=0x%x, q=0x%x\n", i_a, q_a);
979*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "[DACK] path B: i=0x%x, q=0x%x\n", i_b, q_b);
980*4882a593Smuzhiyun }
981*4882a593Smuzhiyun 
rtw8822c_rf_x2_check(struct rtw_dev * rtwdev)982*4882a593Smuzhiyun static void rtw8822c_rf_x2_check(struct rtw_dev *rtwdev)
983*4882a593Smuzhiyun {
984*4882a593Smuzhiyun 	u8 x2k_busy;
985*4882a593Smuzhiyun 
986*4882a593Smuzhiyun 	mdelay(1);
987*4882a593Smuzhiyun 	x2k_busy = rtw_read_rf(rtwdev, RF_PATH_A, 0xb8, BIT(15));
988*4882a593Smuzhiyun 	if (x2k_busy == 1) {
989*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_A, 0xb8, RFREG_MASK, 0xC4440);
990*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_A, 0xba, RFREG_MASK, 0x6840D);
991*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_A, 0xb8, RFREG_MASK, 0x80440);
992*4882a593Smuzhiyun 		mdelay(1);
993*4882a593Smuzhiyun 	}
994*4882a593Smuzhiyun }
995*4882a593Smuzhiyun 
rtw8822c_set_power_trim(struct rtw_dev * rtwdev,s8 bb_gain[2][8])996*4882a593Smuzhiyun static void rtw8822c_set_power_trim(struct rtw_dev *rtwdev, s8 bb_gain[2][8])
997*4882a593Smuzhiyun {
998*4882a593Smuzhiyun #define RF_SET_POWER_TRIM(_path, _seq, _idx)					\
999*4882a593Smuzhiyun 		do {								\
1000*4882a593Smuzhiyun 			rtw_write_rf(rtwdev, _path, 0x33, RFREG_MASK, _seq);	\
1001*4882a593Smuzhiyun 			rtw_write_rf(rtwdev, _path, 0x3f, RFREG_MASK,		\
1002*4882a593Smuzhiyun 				     bb_gain[_path][_idx]);			\
1003*4882a593Smuzhiyun 		} while (0)
1004*4882a593Smuzhiyun 	u8 path;
1005*4882a593Smuzhiyun 
1006*4882a593Smuzhiyun 	for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
1007*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, 0xee, BIT(19), 1);
1008*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0x0, 0);
1009*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0x1, 1);
1010*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0x2, 2);
1011*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0x3, 2);
1012*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0x4, 3);
1013*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0x5, 4);
1014*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0x6, 5);
1015*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0x7, 6);
1016*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0x8, 7);
1017*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0x9, 3);
1018*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0xa, 4);
1019*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0xb, 5);
1020*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0xc, 6);
1021*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0xd, 7);
1022*4882a593Smuzhiyun 		RF_SET_POWER_TRIM(path, 0xe, 7);
1023*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, 0xee, BIT(19), 0);
1024*4882a593Smuzhiyun 	}
1025*4882a593Smuzhiyun #undef RF_SET_POWER_TRIM
1026*4882a593Smuzhiyun }
1027*4882a593Smuzhiyun 
rtw8822c_power_trim(struct rtw_dev * rtwdev)1028*4882a593Smuzhiyun static void rtw8822c_power_trim(struct rtw_dev *rtwdev)
1029*4882a593Smuzhiyun {
1030*4882a593Smuzhiyun 	u8 pg_pwr = 0xff, i, path, idx;
1031*4882a593Smuzhiyun 	s8 bb_gain[2][8] = {};
1032*4882a593Smuzhiyun 	u16 rf_efuse_2g[3] = {PPG_2GL_TXAB, PPG_2GM_TXAB, PPG_2GH_TXAB};
1033*4882a593Smuzhiyun 	u16 rf_efuse_5g[2][5] = {{PPG_5GL1_TXA, PPG_5GL2_TXA, PPG_5GM1_TXA,
1034*4882a593Smuzhiyun 				  PPG_5GM2_TXA, PPG_5GH1_TXA},
1035*4882a593Smuzhiyun 				 {PPG_5GL1_TXB, PPG_5GL2_TXB, PPG_5GM1_TXB,
1036*4882a593Smuzhiyun 				  PPG_5GM2_TXB, PPG_5GH1_TXB} };
1037*4882a593Smuzhiyun 	bool set = false;
1038*4882a593Smuzhiyun 
1039*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(rf_efuse_2g); i++) {
1040*4882a593Smuzhiyun 		rtw_read8_physical_efuse(rtwdev, rf_efuse_2g[i], &pg_pwr);
1041*4882a593Smuzhiyun 		if (pg_pwr == EFUSE_READ_FAIL)
1042*4882a593Smuzhiyun 			continue;
1043*4882a593Smuzhiyun 		set = true;
1044*4882a593Smuzhiyun 		bb_gain[RF_PATH_A][i] = FIELD_GET(PPG_2G_A_MASK, pg_pwr);
1045*4882a593Smuzhiyun 		bb_gain[RF_PATH_B][i] = FIELD_GET(PPG_2G_B_MASK, pg_pwr);
1046*4882a593Smuzhiyun 	}
1047*4882a593Smuzhiyun 
1048*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(rf_efuse_5g[0]); i++) {
1049*4882a593Smuzhiyun 		for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
1050*4882a593Smuzhiyun 			rtw_read8_physical_efuse(rtwdev, rf_efuse_5g[path][i],
1051*4882a593Smuzhiyun 						 &pg_pwr);
1052*4882a593Smuzhiyun 			if (pg_pwr == EFUSE_READ_FAIL)
1053*4882a593Smuzhiyun 				continue;
1054*4882a593Smuzhiyun 			set = true;
1055*4882a593Smuzhiyun 			idx = i + ARRAY_SIZE(rf_efuse_2g);
1056*4882a593Smuzhiyun 			bb_gain[path][idx] = FIELD_GET(PPG_5G_MASK, pg_pwr);
1057*4882a593Smuzhiyun 		}
1058*4882a593Smuzhiyun 	}
1059*4882a593Smuzhiyun 	if (set)
1060*4882a593Smuzhiyun 		rtw8822c_set_power_trim(rtwdev, bb_gain);
1061*4882a593Smuzhiyun 
1062*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DIS_DPD, DIS_DPD_MASK, DIS_DPD_RATEALL);
1063*4882a593Smuzhiyun }
1064*4882a593Smuzhiyun 
rtw8822c_thermal_trim(struct rtw_dev * rtwdev)1065*4882a593Smuzhiyun static void rtw8822c_thermal_trim(struct rtw_dev *rtwdev)
1066*4882a593Smuzhiyun {
1067*4882a593Smuzhiyun 	u16 rf_efuse[2] = {PPG_THERMAL_A, PPG_THERMAL_B};
1068*4882a593Smuzhiyun 	u8 pg_therm = 0xff, thermal[2] = {0}, path;
1069*4882a593Smuzhiyun 
1070*4882a593Smuzhiyun 	for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
1071*4882a593Smuzhiyun 		rtw_read8_physical_efuse(rtwdev, rf_efuse[path], &pg_therm);
1072*4882a593Smuzhiyun 		if (pg_therm == EFUSE_READ_FAIL)
1073*4882a593Smuzhiyun 			return;
1074*4882a593Smuzhiyun 		/* Efuse value of BIT(0) shall be move to BIT(3), and the value
1075*4882a593Smuzhiyun 		 * of BIT(1) to BIT(3) should be right shifted 1 bit.
1076*4882a593Smuzhiyun 		 */
1077*4882a593Smuzhiyun 		thermal[path] = FIELD_GET(GENMASK(3, 1), pg_therm);
1078*4882a593Smuzhiyun 		thermal[path] |= FIELD_PREP(BIT(3), pg_therm & BIT(0));
1079*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, 0x43, RF_THEMAL_MASK, thermal[path]);
1080*4882a593Smuzhiyun 	}
1081*4882a593Smuzhiyun }
1082*4882a593Smuzhiyun 
rtw8822c_pa_bias(struct rtw_dev * rtwdev)1083*4882a593Smuzhiyun static void rtw8822c_pa_bias(struct rtw_dev *rtwdev)
1084*4882a593Smuzhiyun {
1085*4882a593Smuzhiyun 	u16 rf_efuse_2g[2] = {PPG_PABIAS_2GA, PPG_PABIAS_2GB};
1086*4882a593Smuzhiyun 	u16 rf_efuse_5g[2] = {PPG_PABIAS_5GA, PPG_PABIAS_5GB};
1087*4882a593Smuzhiyun 	u8 pg_pa_bias = 0xff, path;
1088*4882a593Smuzhiyun 
1089*4882a593Smuzhiyun 	for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
1090*4882a593Smuzhiyun 		rtw_read8_physical_efuse(rtwdev, rf_efuse_2g[path],
1091*4882a593Smuzhiyun 					 &pg_pa_bias);
1092*4882a593Smuzhiyun 		if (pg_pa_bias == EFUSE_READ_FAIL)
1093*4882a593Smuzhiyun 			return;
1094*4882a593Smuzhiyun 		pg_pa_bias = FIELD_GET(PPG_PABIAS_MASK, pg_pa_bias);
1095*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, 0x60, RF_PABIAS_2G_MASK, pg_pa_bias);
1096*4882a593Smuzhiyun 	}
1097*4882a593Smuzhiyun 	for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
1098*4882a593Smuzhiyun 		rtw_read8_physical_efuse(rtwdev, rf_efuse_5g[path],
1099*4882a593Smuzhiyun 					 &pg_pa_bias);
1100*4882a593Smuzhiyun 		pg_pa_bias = FIELD_GET(PPG_PABIAS_MASK, pg_pa_bias);
1101*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, 0x60, RF_PABIAS_5G_MASK, pg_pa_bias);
1102*4882a593Smuzhiyun 	}
1103*4882a593Smuzhiyun }
1104*4882a593Smuzhiyun 
rtw8822c_rf_init(struct rtw_dev * rtwdev)1105*4882a593Smuzhiyun static void rtw8822c_rf_init(struct rtw_dev *rtwdev)
1106*4882a593Smuzhiyun {
1107*4882a593Smuzhiyun 	rtw8822c_rf_dac_cal(rtwdev);
1108*4882a593Smuzhiyun 	rtw8822c_rf_x2_check(rtwdev);
1109*4882a593Smuzhiyun 	rtw8822c_thermal_trim(rtwdev);
1110*4882a593Smuzhiyun 	rtw8822c_power_trim(rtwdev);
1111*4882a593Smuzhiyun 	rtw8822c_pa_bias(rtwdev);
1112*4882a593Smuzhiyun }
1113*4882a593Smuzhiyun 
rtw8822c_pwrtrack_init(struct rtw_dev * rtwdev)1114*4882a593Smuzhiyun static void rtw8822c_pwrtrack_init(struct rtw_dev *rtwdev)
1115*4882a593Smuzhiyun {
1116*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1117*4882a593Smuzhiyun 	u8 path;
1118*4882a593Smuzhiyun 
1119*4882a593Smuzhiyun 	for (path = RF_PATH_A; path < RTW_RF_PATH_MAX; path++) {
1120*4882a593Smuzhiyun 		dm_info->delta_power_index[path] = 0;
1121*4882a593Smuzhiyun 		ewma_thermal_init(&dm_info->avg_thermal[path]);
1122*4882a593Smuzhiyun 		dm_info->thermal_avg[path] = 0xff;
1123*4882a593Smuzhiyun 	}
1124*4882a593Smuzhiyun 
1125*4882a593Smuzhiyun 	dm_info->pwr_trk_triggered = false;
1126*4882a593Smuzhiyun 	dm_info->thermal_meter_k = rtwdev->efuse.thermal_meter_k;
1127*4882a593Smuzhiyun 	dm_info->thermal_meter_lck = rtwdev->efuse.thermal_meter_k;
1128*4882a593Smuzhiyun }
1129*4882a593Smuzhiyun 
rtw8822c_phy_set_param(struct rtw_dev * rtwdev)1130*4882a593Smuzhiyun static void rtw8822c_phy_set_param(struct rtw_dev *rtwdev)
1131*4882a593Smuzhiyun {
1132*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1133*4882a593Smuzhiyun 	struct rtw_hal *hal = &rtwdev->hal;
1134*4882a593Smuzhiyun 	u8 crystal_cap;
1135*4882a593Smuzhiyun 	u8 cck_gi_u_bnd_msb = 0;
1136*4882a593Smuzhiyun 	u8 cck_gi_u_bnd_lsb = 0;
1137*4882a593Smuzhiyun 	u8 cck_gi_l_bnd_msb = 0;
1138*4882a593Smuzhiyun 	u8 cck_gi_l_bnd_lsb = 0;
1139*4882a593Smuzhiyun 	bool is_tx2_path;
1140*4882a593Smuzhiyun 
1141*4882a593Smuzhiyun 	/* power on BB/RF domain */
1142*4882a593Smuzhiyun 	rtw_write8_set(rtwdev, REG_SYS_FUNC_EN,
1143*4882a593Smuzhiyun 		       BIT_FEN_BB_GLB_RST | BIT_FEN_BB_RSTB);
1144*4882a593Smuzhiyun 	rtw_write8_set(rtwdev, REG_RF_CTRL,
1145*4882a593Smuzhiyun 		       BIT_RF_EN | BIT_RF_RSTB | BIT_RF_SDM_RSTB);
1146*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_WLRF1, BIT_WLRF1_BBRF_EN);
1147*4882a593Smuzhiyun 
1148*4882a593Smuzhiyun 	/* disable low rate DPD */
1149*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DIS_DPD, DIS_DPD_MASK, DIS_DPD_RATEALL);
1150*4882a593Smuzhiyun 
1151*4882a593Smuzhiyun 	/* pre init before header files config */
1152*4882a593Smuzhiyun 	rtw8822c_header_file_init(rtwdev, true);
1153*4882a593Smuzhiyun 
1154*4882a593Smuzhiyun 	rtw_phy_load_tables(rtwdev);
1155*4882a593Smuzhiyun 
1156*4882a593Smuzhiyun 	crystal_cap = rtwdev->efuse.crystal_cap & 0x7f;
1157*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_ANAPAR_XTAL_0, 0xfffc00,
1158*4882a593Smuzhiyun 			 crystal_cap | (crystal_cap << 7));
1159*4882a593Smuzhiyun 
1160*4882a593Smuzhiyun 	/* post init after header files config */
1161*4882a593Smuzhiyun 	rtw8822c_header_file_init(rtwdev, false);
1162*4882a593Smuzhiyun 
1163*4882a593Smuzhiyun 	is_tx2_path = false;
1164*4882a593Smuzhiyun 	rtw8822c_config_trx_mode(rtwdev, hal->antenna_tx, hal->antenna_rx,
1165*4882a593Smuzhiyun 				 is_tx2_path);
1166*4882a593Smuzhiyun 	rtw_phy_init(rtwdev);
1167*4882a593Smuzhiyun 
1168*4882a593Smuzhiyun 	cck_gi_u_bnd_msb = (u8)rtw_read32_mask(rtwdev, 0x1a98, 0xc000);
1169*4882a593Smuzhiyun 	cck_gi_u_bnd_lsb = (u8)rtw_read32_mask(rtwdev, 0x1aa8, 0xf0000);
1170*4882a593Smuzhiyun 	cck_gi_l_bnd_msb = (u8)rtw_read32_mask(rtwdev, 0x1a98, 0xc0);
1171*4882a593Smuzhiyun 	cck_gi_l_bnd_lsb = (u8)rtw_read32_mask(rtwdev, 0x1a70, 0x0f000000);
1172*4882a593Smuzhiyun 
1173*4882a593Smuzhiyun 	dm_info->cck_gi_u_bnd = ((cck_gi_u_bnd_msb << 4) | (cck_gi_u_bnd_lsb));
1174*4882a593Smuzhiyun 	dm_info->cck_gi_l_bnd = ((cck_gi_l_bnd_msb << 4) | (cck_gi_l_bnd_lsb));
1175*4882a593Smuzhiyun 
1176*4882a593Smuzhiyun 	rtw8822c_rf_init(rtwdev);
1177*4882a593Smuzhiyun 	rtw8822c_pwrtrack_init(rtwdev);
1178*4882a593Smuzhiyun 
1179*4882a593Smuzhiyun 	rtw_bf_phy_init(rtwdev);
1180*4882a593Smuzhiyun }
1181*4882a593Smuzhiyun 
1182*4882a593Smuzhiyun #define WLAN_TXQ_RPT_EN		0x1F
1183*4882a593Smuzhiyun #define WLAN_SLOT_TIME		0x09
1184*4882a593Smuzhiyun #define WLAN_PIFS_TIME		0x1C
1185*4882a593Smuzhiyun #define WLAN_SIFS_CCK_CONT_TX	0x0A
1186*4882a593Smuzhiyun #define WLAN_SIFS_OFDM_CONT_TX	0x0E
1187*4882a593Smuzhiyun #define WLAN_SIFS_CCK_TRX	0x0A
1188*4882a593Smuzhiyun #define WLAN_SIFS_OFDM_TRX	0x10
1189*4882a593Smuzhiyun #define WLAN_NAV_MAX		0xC8
1190*4882a593Smuzhiyun #define WLAN_RDG_NAV		0x05
1191*4882a593Smuzhiyun #define WLAN_TXOP_NAV		0x1B
1192*4882a593Smuzhiyun #define WLAN_CCK_RX_TSF		0x30
1193*4882a593Smuzhiyun #define WLAN_OFDM_RX_TSF	0x30
1194*4882a593Smuzhiyun #define WLAN_TBTT_PROHIBIT	0x04 /* unit : 32us */
1195*4882a593Smuzhiyun #define WLAN_TBTT_HOLD_TIME	0x064 /* unit : 32us */
1196*4882a593Smuzhiyun #define WLAN_DRV_EARLY_INT	0x04
1197*4882a593Smuzhiyun #define WLAN_BCN_CTRL_CLT0	0x10
1198*4882a593Smuzhiyun #define WLAN_BCN_DMA_TIME	0x02
1199*4882a593Smuzhiyun #define WLAN_BCN_MAX_ERR	0xFF
1200*4882a593Smuzhiyun #define WLAN_SIFS_CCK_DUR_TUNE	0x0A
1201*4882a593Smuzhiyun #define WLAN_SIFS_OFDM_DUR_TUNE	0x10
1202*4882a593Smuzhiyun #define WLAN_SIFS_CCK_CTX	0x0A
1203*4882a593Smuzhiyun #define WLAN_SIFS_CCK_IRX	0x0A
1204*4882a593Smuzhiyun #define WLAN_SIFS_OFDM_CTX	0x0E
1205*4882a593Smuzhiyun #define WLAN_SIFS_OFDM_IRX	0x0E
1206*4882a593Smuzhiyun #define WLAN_EIFS_DUR_TUNE	0x40
1207*4882a593Smuzhiyun #define WLAN_EDCA_VO_PARAM	0x002FA226
1208*4882a593Smuzhiyun #define WLAN_EDCA_VI_PARAM	0x005EA328
1209*4882a593Smuzhiyun #define WLAN_EDCA_BE_PARAM	0x005EA42B
1210*4882a593Smuzhiyun #define WLAN_EDCA_BK_PARAM	0x0000A44F
1211*4882a593Smuzhiyun 
1212*4882a593Smuzhiyun #define WLAN_RX_FILTER0		0xFFFFFFFF
1213*4882a593Smuzhiyun #define WLAN_RX_FILTER2		0xFFFF
1214*4882a593Smuzhiyun #define WLAN_RCR_CFG		0xE400220E
1215*4882a593Smuzhiyun #define WLAN_RXPKT_MAX_SZ	12288
1216*4882a593Smuzhiyun #define WLAN_RXPKT_MAX_SZ_512	(WLAN_RXPKT_MAX_SZ >> 9)
1217*4882a593Smuzhiyun 
1218*4882a593Smuzhiyun #define WLAN_AMPDU_MAX_TIME		0x70
1219*4882a593Smuzhiyun #define WLAN_RTS_LEN_TH			0xFF
1220*4882a593Smuzhiyun #define WLAN_RTS_TX_TIME_TH		0x08
1221*4882a593Smuzhiyun #define WLAN_MAX_AGG_PKT_LIMIT		0x3f
1222*4882a593Smuzhiyun #define WLAN_RTS_MAX_AGG_PKT_LIMIT	0x3f
1223*4882a593Smuzhiyun #define WLAN_PRE_TXCNT_TIME_TH		0x1E0
1224*4882a593Smuzhiyun #define FAST_EDCA_VO_TH		0x06
1225*4882a593Smuzhiyun #define FAST_EDCA_VI_TH		0x06
1226*4882a593Smuzhiyun #define FAST_EDCA_BE_TH		0x06
1227*4882a593Smuzhiyun #define FAST_EDCA_BK_TH		0x06
1228*4882a593Smuzhiyun #define WLAN_BAR_RETRY_LIMIT		0x01
1229*4882a593Smuzhiyun #define WLAN_BAR_ACK_TYPE		0x05
1230*4882a593Smuzhiyun #define WLAN_RA_TRY_RATE_AGG_LIMIT	0x08
1231*4882a593Smuzhiyun #define WLAN_RESP_TXRATE		0x84
1232*4882a593Smuzhiyun #define WLAN_ACK_TO			0x21
1233*4882a593Smuzhiyun #define WLAN_ACK_TO_CCK			0x6A
1234*4882a593Smuzhiyun #define WLAN_DATA_RATE_FB_CNT_1_4	0x01000000
1235*4882a593Smuzhiyun #define WLAN_DATA_RATE_FB_CNT_5_8	0x08070504
1236*4882a593Smuzhiyun #define WLAN_RTS_RATE_FB_CNT_5_8	0x08070504
1237*4882a593Smuzhiyun #define WLAN_DATA_RATE_FB_RATE0		0xFE01F010
1238*4882a593Smuzhiyun #define WLAN_DATA_RATE_FB_RATE0_H	0x40000000
1239*4882a593Smuzhiyun #define WLAN_RTS_RATE_FB_RATE1		0x003FF010
1240*4882a593Smuzhiyun #define WLAN_RTS_RATE_FB_RATE1_H	0x40000000
1241*4882a593Smuzhiyun #define WLAN_RTS_RATE_FB_RATE4		0x0600F010
1242*4882a593Smuzhiyun #define WLAN_RTS_RATE_FB_RATE4_H	0x400003E0
1243*4882a593Smuzhiyun #define WLAN_RTS_RATE_FB_RATE5		0x0600F015
1244*4882a593Smuzhiyun #define WLAN_RTS_RATE_FB_RATE5_H	0x000000E0
1245*4882a593Smuzhiyun #define WLAN_MULTI_ADDR			0xFFFFFFFF
1246*4882a593Smuzhiyun 
1247*4882a593Smuzhiyun #define WLAN_TX_FUNC_CFG1		0x30
1248*4882a593Smuzhiyun #define WLAN_TX_FUNC_CFG2		0x30
1249*4882a593Smuzhiyun #define WLAN_MAC_OPT_NORM_FUNC1		0x98
1250*4882a593Smuzhiyun #define WLAN_MAC_OPT_LB_FUNC1		0x80
1251*4882a593Smuzhiyun #define WLAN_MAC_OPT_FUNC2		0xb0810041
1252*4882a593Smuzhiyun #define WLAN_MAC_INT_MIG_CFG		0x33330000
1253*4882a593Smuzhiyun 
1254*4882a593Smuzhiyun #define WLAN_SIFS_CFG	(WLAN_SIFS_CCK_CONT_TX | \
1255*4882a593Smuzhiyun 			(WLAN_SIFS_OFDM_CONT_TX << BIT_SHIFT_SIFS_OFDM_CTX) | \
1256*4882a593Smuzhiyun 			(WLAN_SIFS_CCK_TRX << BIT_SHIFT_SIFS_CCK_TRX) | \
1257*4882a593Smuzhiyun 			(WLAN_SIFS_OFDM_TRX << BIT_SHIFT_SIFS_OFDM_TRX))
1258*4882a593Smuzhiyun 
1259*4882a593Smuzhiyun #define WLAN_SIFS_DUR_TUNE	(WLAN_SIFS_CCK_DUR_TUNE | \
1260*4882a593Smuzhiyun 				(WLAN_SIFS_OFDM_DUR_TUNE << 8))
1261*4882a593Smuzhiyun 
1262*4882a593Smuzhiyun #define WLAN_TBTT_TIME	(WLAN_TBTT_PROHIBIT |\
1263*4882a593Smuzhiyun 			(WLAN_TBTT_HOLD_TIME << BIT_SHIFT_TBTT_HOLD_TIME_AP))
1264*4882a593Smuzhiyun 
1265*4882a593Smuzhiyun #define WLAN_NAV_CFG		(WLAN_RDG_NAV | (WLAN_TXOP_NAV << 16))
1266*4882a593Smuzhiyun #define WLAN_RX_TSF_CFG		(WLAN_CCK_RX_TSF | (WLAN_OFDM_RX_TSF) << 8)
1267*4882a593Smuzhiyun 
1268*4882a593Smuzhiyun #define MAC_CLK_SPEED	80 /* 80M */
1269*4882a593Smuzhiyun #define EFUSE_PCB_INFO_OFFSET	0xCA
1270*4882a593Smuzhiyun 
rtw8822c_mac_init(struct rtw_dev * rtwdev)1271*4882a593Smuzhiyun static int rtw8822c_mac_init(struct rtw_dev *rtwdev)
1272*4882a593Smuzhiyun {
1273*4882a593Smuzhiyun 	u8 value8;
1274*4882a593Smuzhiyun 	u16 value16;
1275*4882a593Smuzhiyun 	u32 value32;
1276*4882a593Smuzhiyun 	u16 pre_txcnt;
1277*4882a593Smuzhiyun 
1278*4882a593Smuzhiyun 	/* txq control */
1279*4882a593Smuzhiyun 	value8 = rtw_read8(rtwdev, REG_FWHW_TXQ_CTRL);
1280*4882a593Smuzhiyun 	value8 |= (BIT(7) & ~BIT(1) & ~BIT(2));
1281*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_FWHW_TXQ_CTRL, value8);
1282*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_FWHW_TXQ_CTRL + 1, WLAN_TXQ_RPT_EN);
1283*4882a593Smuzhiyun 	/* sifs control */
1284*4882a593Smuzhiyun 	rtw_write16(rtwdev, REG_SPEC_SIFS, WLAN_SIFS_DUR_TUNE);
1285*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_SIFS, WLAN_SIFS_CFG);
1286*4882a593Smuzhiyun 	rtw_write16(rtwdev, REG_RESP_SIFS_CCK,
1287*4882a593Smuzhiyun 		    WLAN_SIFS_CCK_CTX | WLAN_SIFS_CCK_IRX << 8);
1288*4882a593Smuzhiyun 	rtw_write16(rtwdev, REG_RESP_SIFS_OFDM,
1289*4882a593Smuzhiyun 		    WLAN_SIFS_OFDM_CTX | WLAN_SIFS_OFDM_IRX << 8);
1290*4882a593Smuzhiyun 	/* rate fallback control */
1291*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_DARFRC, WLAN_DATA_RATE_FB_CNT_1_4);
1292*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_DARFRCH, WLAN_DATA_RATE_FB_CNT_5_8);
1293*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_RARFRCH, WLAN_RTS_RATE_FB_CNT_5_8);
1294*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_ARFR0, WLAN_DATA_RATE_FB_RATE0);
1295*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_ARFRH0, WLAN_DATA_RATE_FB_RATE0_H);
1296*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_ARFR1_V1, WLAN_RTS_RATE_FB_RATE1);
1297*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_ARFRH1_V1, WLAN_RTS_RATE_FB_RATE1_H);
1298*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_ARFR4, WLAN_RTS_RATE_FB_RATE4);
1299*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_ARFRH4, WLAN_RTS_RATE_FB_RATE4_H);
1300*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_ARFR5, WLAN_RTS_RATE_FB_RATE5);
1301*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_ARFRH5, WLAN_RTS_RATE_FB_RATE5_H);
1302*4882a593Smuzhiyun 	/* protocol configuration */
1303*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_AMPDU_MAX_TIME_V1, WLAN_AMPDU_MAX_TIME);
1304*4882a593Smuzhiyun 	rtw_write8_set(rtwdev, REG_TX_HANG_CTRL, BIT_EN_EOF_V1);
1305*4882a593Smuzhiyun 	pre_txcnt = WLAN_PRE_TXCNT_TIME_TH | BIT_EN_PRECNT;
1306*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_PRECNT_CTRL, (u8)(pre_txcnt & 0xFF));
1307*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_PRECNT_CTRL + 1, (u8)(pre_txcnt >> 8));
1308*4882a593Smuzhiyun 	value32 = WLAN_RTS_LEN_TH | (WLAN_RTS_TX_TIME_TH << 8) |
1309*4882a593Smuzhiyun 		  (WLAN_MAX_AGG_PKT_LIMIT << 16) |
1310*4882a593Smuzhiyun 		  (WLAN_RTS_MAX_AGG_PKT_LIMIT << 24);
1311*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_PROT_MODE_CTRL, value32);
1312*4882a593Smuzhiyun 	rtw_write16(rtwdev, REG_BAR_MODE_CTRL + 2,
1313*4882a593Smuzhiyun 		    WLAN_BAR_RETRY_LIMIT | WLAN_RA_TRY_RATE_AGG_LIMIT << 8);
1314*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_FAST_EDCA_VOVI_SETTING, FAST_EDCA_VO_TH);
1315*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_FAST_EDCA_VOVI_SETTING + 2, FAST_EDCA_VI_TH);
1316*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_FAST_EDCA_BEBK_SETTING, FAST_EDCA_BE_TH);
1317*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_FAST_EDCA_BEBK_SETTING + 2, FAST_EDCA_BK_TH);
1318*4882a593Smuzhiyun 	/* close BA parser */
1319*4882a593Smuzhiyun 	rtw_write8_clr(rtwdev, REG_LIFETIME_EN, BIT_BA_PARSER_EN);
1320*4882a593Smuzhiyun 	rtw_write32_clr(rtwdev, REG_RRSR, BITS_RRSR_RSC);
1321*4882a593Smuzhiyun 
1322*4882a593Smuzhiyun 	/* EDCA configuration */
1323*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_EDCA_VO_PARAM, WLAN_EDCA_VO_PARAM);
1324*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_EDCA_VI_PARAM, WLAN_EDCA_VI_PARAM);
1325*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_EDCA_BE_PARAM, WLAN_EDCA_BE_PARAM);
1326*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_EDCA_BK_PARAM, WLAN_EDCA_BK_PARAM);
1327*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_PIFS, WLAN_PIFS_TIME);
1328*4882a593Smuzhiyun 	rtw_write8_clr(rtwdev, REG_TX_PTCL_CTRL + 1, BIT_SIFS_BK_EN >> 8);
1329*4882a593Smuzhiyun 	rtw_write8_set(rtwdev, REG_RD_CTRL + 1,
1330*4882a593Smuzhiyun 		       (BIT_DIS_TXOP_CFE | BIT_DIS_LSIG_CFE |
1331*4882a593Smuzhiyun 			BIT_DIS_STBC_CFE) >> 8);
1332*4882a593Smuzhiyun 
1333*4882a593Smuzhiyun 	/* MAC clock configuration */
1334*4882a593Smuzhiyun 	rtw_write32_clr(rtwdev, REG_AFE_CTRL1, BIT_MAC_CLK_SEL);
1335*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_USTIME_TSF, MAC_CLK_SPEED);
1336*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_USTIME_EDCA, MAC_CLK_SPEED);
1337*4882a593Smuzhiyun 
1338*4882a593Smuzhiyun 	rtw_write8_set(rtwdev, REG_MISC_CTRL,
1339*4882a593Smuzhiyun 		       BIT_EN_FREE_CNT | BIT_DIS_SECOND_CCA);
1340*4882a593Smuzhiyun 	rtw_write8_clr(rtwdev, REG_TIMER0_SRC_SEL, BIT_TSFT_SEL_TIMER0);
1341*4882a593Smuzhiyun 	rtw_write16(rtwdev, REG_TXPAUSE, 0x0000);
1342*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_SLOT, WLAN_SLOT_TIME);
1343*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_RD_NAV_NXT, WLAN_NAV_CFG);
1344*4882a593Smuzhiyun 	rtw_write16(rtwdev, REG_RXTSF_OFFSET_CCK, WLAN_RX_TSF_CFG);
1345*4882a593Smuzhiyun 	/* Set beacon cotnrol - enable TSF and other related functions */
1346*4882a593Smuzhiyun 	rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION);
1347*4882a593Smuzhiyun 	/* Set send beacon related registers */
1348*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_TBTT_PROHIBIT, WLAN_TBTT_TIME);
1349*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_DRVERLYINT, WLAN_DRV_EARLY_INT);
1350*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_BCN_CTRL_CLINT0, WLAN_BCN_CTRL_CLT0);
1351*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_BCNDMATIM, WLAN_BCN_DMA_TIME);
1352*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_BCN_MAX_ERR, WLAN_BCN_MAX_ERR);
1353*4882a593Smuzhiyun 
1354*4882a593Smuzhiyun 	/* WMAC configuration */
1355*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_MAR, WLAN_MULTI_ADDR);
1356*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_MAR + 4, WLAN_MULTI_ADDR);
1357*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_BBPSF_CTRL + 2, WLAN_RESP_TXRATE);
1358*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_ACKTO, WLAN_ACK_TO);
1359*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_ACKTO_CCK, WLAN_ACK_TO_CCK);
1360*4882a593Smuzhiyun 	rtw_write16(rtwdev, REG_EIFS, WLAN_EIFS_DUR_TUNE);
1361*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_NAV_CTRL + 2, WLAN_NAV_MAX);
1362*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_WMAC_TRXPTCL_CTL_H  + 2, WLAN_BAR_ACK_TYPE);
1363*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_RXFLTMAP0, WLAN_RX_FILTER0);
1364*4882a593Smuzhiyun 	rtw_write16(rtwdev, REG_RXFLTMAP2, WLAN_RX_FILTER2);
1365*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_RCR, WLAN_RCR_CFG);
1366*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_RX_PKT_LIMIT, WLAN_RXPKT_MAX_SZ_512);
1367*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_TCR + 2, WLAN_TX_FUNC_CFG2);
1368*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_TCR + 1, WLAN_TX_FUNC_CFG1);
1369*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_GENERAL_OPTION, BIT_DUMMY_FCS_READY_MASK_EN);
1370*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_WMAC_OPTION_FUNCTION + 8, WLAN_MAC_OPT_FUNC2);
1371*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_WMAC_OPTION_FUNCTION_1, WLAN_MAC_OPT_NORM_FUNC1);
1372*4882a593Smuzhiyun 
1373*4882a593Smuzhiyun 	/* init low power */
1374*4882a593Smuzhiyun 	value16 = rtw_read16(rtwdev, REG_RXPSF_CTRL + 2) & 0xF00F;
1375*4882a593Smuzhiyun 	value16 |= (BIT_RXGCK_VHT_FIFOTHR(1) | BIT_RXGCK_HT_FIFOTHR(1) |
1376*4882a593Smuzhiyun 		    BIT_RXGCK_OFDM_FIFOTHR(1) | BIT_RXGCK_CCK_FIFOTHR(1)) >> 16;
1377*4882a593Smuzhiyun 	rtw_write16(rtwdev, REG_RXPSF_CTRL + 2, value16);
1378*4882a593Smuzhiyun 	value16 = 0;
1379*4882a593Smuzhiyun 	value16 = BIT_SET_RXPSF_PKTLENTHR(value16, 1);
1380*4882a593Smuzhiyun 	value16 |= BIT_RXPSF_CTRLEN | BIT_RXPSF_VHTCHKEN | BIT_RXPSF_HTCHKEN
1381*4882a593Smuzhiyun 		| BIT_RXPSF_OFDMCHKEN | BIT_RXPSF_CCKCHKEN
1382*4882a593Smuzhiyun 		| BIT_RXPSF_OFDMRST;
1383*4882a593Smuzhiyun 	rtw_write16(rtwdev, REG_RXPSF_CTRL, value16);
1384*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_RXPSF_TYPE_CTRL, 0xFFFFFFFF);
1385*4882a593Smuzhiyun 	/* rx ignore configuration */
1386*4882a593Smuzhiyun 	value16 = rtw_read16(rtwdev, REG_RXPSF_CTRL);
1387*4882a593Smuzhiyun 	value16 &= ~(BIT_RXPSF_MHCHKEN | BIT_RXPSF_CCKRST |
1388*4882a593Smuzhiyun 		     BIT_RXPSF_CONT_ERRCHKEN);
1389*4882a593Smuzhiyun 	value16 = BIT_SET_RXPSF_ERRTHR(value16, 0x07);
1390*4882a593Smuzhiyun 	rtw_write16(rtwdev, REG_RXPSF_CTRL, value16);
1391*4882a593Smuzhiyun 
1392*4882a593Smuzhiyun 	/* Interrupt migration configuration */
1393*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_INT_MIG, WLAN_MAC_INT_MIG_CFG);
1394*4882a593Smuzhiyun 
1395*4882a593Smuzhiyun 	return 0;
1396*4882a593Smuzhiyun }
1397*4882a593Smuzhiyun 
rtw8822c_rstb_3wire(struct rtw_dev * rtwdev,bool enable)1398*4882a593Smuzhiyun static void rtw8822c_rstb_3wire(struct rtw_dev *rtwdev, bool enable)
1399*4882a593Smuzhiyun {
1400*4882a593Smuzhiyun 	if (enable) {
1401*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RSTB, BIT_RSTB_3WIRE, 0x1);
1402*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_ANAPAR_A, BIT_ANAPAR_UPDATE, 0x1);
1403*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_ANAPAR_B, BIT_ANAPAR_UPDATE, 0x1);
1404*4882a593Smuzhiyun 	} else {
1405*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RSTB, BIT_RSTB_3WIRE, 0x0);
1406*4882a593Smuzhiyun 	}
1407*4882a593Smuzhiyun }
1408*4882a593Smuzhiyun 
rtw8822c_set_channel_rf(struct rtw_dev * rtwdev,u8 channel,u8 bw)1409*4882a593Smuzhiyun static void rtw8822c_set_channel_rf(struct rtw_dev *rtwdev, u8 channel, u8 bw)
1410*4882a593Smuzhiyun {
1411*4882a593Smuzhiyun #define RF18_BAND_MASK		(BIT(16) | BIT(9) | BIT(8))
1412*4882a593Smuzhiyun #define RF18_BAND_2G		(0)
1413*4882a593Smuzhiyun #define RF18_BAND_5G		(BIT(16) | BIT(8))
1414*4882a593Smuzhiyun #define RF18_CHANNEL_MASK	(MASKBYTE0)
1415*4882a593Smuzhiyun #define RF18_RFSI_MASK		(BIT(18) | BIT(17))
1416*4882a593Smuzhiyun #define RF18_RFSI_GE_CH80	(BIT(17))
1417*4882a593Smuzhiyun #define RF18_RFSI_GT_CH140	(BIT(18))
1418*4882a593Smuzhiyun #define RF18_BW_MASK		(BIT(13) | BIT(12))
1419*4882a593Smuzhiyun #define RF18_BW_20M		(BIT(13) | BIT(12))
1420*4882a593Smuzhiyun #define RF18_BW_40M		(BIT(13))
1421*4882a593Smuzhiyun #define RF18_BW_80M		(BIT(12))
1422*4882a593Smuzhiyun 
1423*4882a593Smuzhiyun 	u32 rf_reg18 = 0;
1424*4882a593Smuzhiyun 	u32 rf_rxbb = 0;
1425*4882a593Smuzhiyun 
1426*4882a593Smuzhiyun 	rf_reg18 = rtw_read_rf(rtwdev, RF_PATH_A, 0x18, RFREG_MASK);
1427*4882a593Smuzhiyun 
1428*4882a593Smuzhiyun 	rf_reg18 &= ~(RF18_BAND_MASK | RF18_CHANNEL_MASK | RF18_RFSI_MASK |
1429*4882a593Smuzhiyun 		      RF18_BW_MASK);
1430*4882a593Smuzhiyun 
1431*4882a593Smuzhiyun 	rf_reg18 |= (IS_CH_2G_BAND(channel) ? RF18_BAND_2G : RF18_BAND_5G);
1432*4882a593Smuzhiyun 	rf_reg18 |= (channel & RF18_CHANNEL_MASK);
1433*4882a593Smuzhiyun 	if (IS_CH_5G_BAND_4(channel))
1434*4882a593Smuzhiyun 		rf_reg18 |= RF18_RFSI_GT_CH140;
1435*4882a593Smuzhiyun 	else if (IS_CH_5G_BAND_3(channel))
1436*4882a593Smuzhiyun 		rf_reg18 |= RF18_RFSI_GE_CH80;
1437*4882a593Smuzhiyun 
1438*4882a593Smuzhiyun 	switch (bw) {
1439*4882a593Smuzhiyun 	case RTW_CHANNEL_WIDTH_5:
1440*4882a593Smuzhiyun 	case RTW_CHANNEL_WIDTH_10:
1441*4882a593Smuzhiyun 	case RTW_CHANNEL_WIDTH_20:
1442*4882a593Smuzhiyun 	default:
1443*4882a593Smuzhiyun 		rf_reg18 |= RF18_BW_20M;
1444*4882a593Smuzhiyun 		rf_rxbb = 0x18;
1445*4882a593Smuzhiyun 		break;
1446*4882a593Smuzhiyun 	case RTW_CHANNEL_WIDTH_40:
1447*4882a593Smuzhiyun 		/* RF bandwidth */
1448*4882a593Smuzhiyun 		rf_reg18 |= RF18_BW_40M;
1449*4882a593Smuzhiyun 		rf_rxbb = 0x10;
1450*4882a593Smuzhiyun 		break;
1451*4882a593Smuzhiyun 	case RTW_CHANNEL_WIDTH_80:
1452*4882a593Smuzhiyun 		rf_reg18 |= RF18_BW_80M;
1453*4882a593Smuzhiyun 		rf_rxbb = 0x8;
1454*4882a593Smuzhiyun 		break;
1455*4882a593Smuzhiyun 	}
1456*4882a593Smuzhiyun 
1457*4882a593Smuzhiyun 	rtw8822c_rstb_3wire(rtwdev, false);
1458*4882a593Smuzhiyun 
1459*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWE2, 0x04, 0x01);
1460*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWA, 0x1f, 0x12);
1461*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWD0, 0xfffff, rf_rxbb);
1462*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_LUTWE2, 0x04, 0x00);
1463*4882a593Smuzhiyun 
1464*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_B, RF_LUTWE2, 0x04, 0x01);
1465*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_B, RF_LUTWA, 0x1f, 0x12);
1466*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_B, RF_LUTWD0, 0xfffff, rf_rxbb);
1467*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_B, RF_LUTWE2, 0x04, 0x00);
1468*4882a593Smuzhiyun 
1469*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_CFGCH, RFREG_MASK, rf_reg18);
1470*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_B, RF_CFGCH, RFREG_MASK, rf_reg18);
1471*4882a593Smuzhiyun 
1472*4882a593Smuzhiyun 	rtw8822c_rstb_3wire(rtwdev, true);
1473*4882a593Smuzhiyun }
1474*4882a593Smuzhiyun 
rtw8822c_toggle_igi(struct rtw_dev * rtwdev)1475*4882a593Smuzhiyun static void rtw8822c_toggle_igi(struct rtw_dev *rtwdev)
1476*4882a593Smuzhiyun {
1477*4882a593Smuzhiyun 	u32 igi;
1478*4882a593Smuzhiyun 
1479*4882a593Smuzhiyun 	igi = rtw_read32_mask(rtwdev, REG_RXIGI, 0x7f);
1480*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_RXIGI, 0x7f, igi - 2);
1481*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_RXIGI, 0x7f00, igi - 2);
1482*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_RXIGI, 0x7f, igi);
1483*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_RXIGI, 0x7f00, igi);
1484*4882a593Smuzhiyun }
1485*4882a593Smuzhiyun 
rtw8822c_set_channel_bb(struct rtw_dev * rtwdev,u8 channel,u8 bw,u8 primary_ch_idx)1486*4882a593Smuzhiyun static void rtw8822c_set_channel_bb(struct rtw_dev *rtwdev, u8 channel, u8 bw,
1487*4882a593Smuzhiyun 				    u8 primary_ch_idx)
1488*4882a593Smuzhiyun {
1489*4882a593Smuzhiyun 	if (IS_CH_2G_BAND(channel)) {
1490*4882a593Smuzhiyun 		rtw_write32_clr(rtwdev, REG_BGCTRL, BITS_RX_IQ_WEIGHT);
1491*4882a593Smuzhiyun 		rtw_write32_set(rtwdev, REG_TXF4, BIT(20));
1492*4882a593Smuzhiyun 		rtw_write32_clr(rtwdev, REG_CCK_CHECK, BIT_CHECK_CCK_EN);
1493*4882a593Smuzhiyun 		rtw_write32_clr(rtwdev, REG_CCKTXONLY, BIT_BB_CCK_CHECK_EN);
1494*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_CCAMSK, 0x3F000000, 0xF);
1495*4882a593Smuzhiyun 
1496*4882a593Smuzhiyun 		switch (bw) {
1497*4882a593Smuzhiyun 		case RTW_CHANNEL_WIDTH_20:
1498*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_CCK,
1499*4882a593Smuzhiyun 					 0x5);
1500*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_CCK,
1501*4882a593Smuzhiyun 					 0x5);
1502*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_OFDM,
1503*4882a593Smuzhiyun 					 0x6);
1504*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_OFDM,
1505*4882a593Smuzhiyun 					 0x6);
1506*4882a593Smuzhiyun 			break;
1507*4882a593Smuzhiyun 		case RTW_CHANNEL_WIDTH_40:
1508*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_CCK,
1509*4882a593Smuzhiyun 					 0x4);
1510*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_CCK,
1511*4882a593Smuzhiyun 					 0x4);
1512*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_OFDM,
1513*4882a593Smuzhiyun 					 0x0);
1514*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_OFDM,
1515*4882a593Smuzhiyun 					 0x0);
1516*4882a593Smuzhiyun 			break;
1517*4882a593Smuzhiyun 		}
1518*4882a593Smuzhiyun 		if (channel == 13 || channel == 14)
1519*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x969);
1520*4882a593Smuzhiyun 		else if (channel == 11 || channel == 12)
1521*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x96a);
1522*4882a593Smuzhiyun 		else
1523*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x9aa);
1524*4882a593Smuzhiyun 		if (channel == 14) {
1525*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF0, MASKHWORD, 0x3da0);
1526*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF1, MASKDWORD,
1527*4882a593Smuzhiyun 					 0x4962c931);
1528*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF2, MASKLWORD, 0x6aa3);
1529*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF3, MASKHWORD, 0xaa7b);
1530*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF4, MASKLWORD, 0xf3d7);
1531*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF5, MASKDWORD, 0x0);
1532*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF6, MASKDWORD,
1533*4882a593Smuzhiyun 					 0xff012455);
1534*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF7, MASKDWORD, 0xffff);
1535*4882a593Smuzhiyun 		} else {
1536*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF0, MASKHWORD, 0x5284);
1537*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF1, MASKDWORD,
1538*4882a593Smuzhiyun 					 0x3e18fec8);
1539*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF2, MASKLWORD, 0x0a88);
1540*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF3, MASKHWORD, 0xacc4);
1541*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF4, MASKLWORD, 0xc8b2);
1542*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF5, MASKDWORD,
1543*4882a593Smuzhiyun 					 0x00faf0de);
1544*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF6, MASKDWORD,
1545*4882a593Smuzhiyun 					 0x00122344);
1546*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXF7, MASKDWORD,
1547*4882a593Smuzhiyun 					 0x0fffffff);
1548*4882a593Smuzhiyun 		}
1549*4882a593Smuzhiyun 		if (channel == 13)
1550*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXDFIR0, 0x70, 0x3);
1551*4882a593Smuzhiyun 		else
1552*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXDFIR0, 0x70, 0x1);
1553*4882a593Smuzhiyun 	} else if (IS_CH_5G_BAND(channel)) {
1554*4882a593Smuzhiyun 		rtw_write32_set(rtwdev, REG_CCKTXONLY, BIT_BB_CCK_CHECK_EN);
1555*4882a593Smuzhiyun 		rtw_write32_set(rtwdev, REG_CCK_CHECK, BIT_CHECK_CCK_EN);
1556*4882a593Smuzhiyun 		rtw_write32_set(rtwdev, REG_BGCTRL, BITS_RX_IQ_WEIGHT);
1557*4882a593Smuzhiyun 		rtw_write32_clr(rtwdev, REG_TXF4, BIT(20));
1558*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_CCAMSK, 0x3F000000, 0x22);
1559*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXDFIR0, 0x70, 0x3);
1560*4882a593Smuzhiyun 		if (IS_CH_5G_BAND_1(channel) || IS_CH_5G_BAND_2(channel)) {
1561*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_OFDM,
1562*4882a593Smuzhiyun 					 0x1);
1563*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_OFDM,
1564*4882a593Smuzhiyun 					 0x1);
1565*4882a593Smuzhiyun 		} else if (IS_CH_5G_BAND_3(channel)) {
1566*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_OFDM,
1567*4882a593Smuzhiyun 					 0x2);
1568*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_OFDM,
1569*4882a593Smuzhiyun 					 0x2);
1570*4882a593Smuzhiyun 		} else if (IS_CH_5G_BAND_4(channel)) {
1571*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL0, BITS_RXAGC_OFDM,
1572*4882a593Smuzhiyun 					 0x3);
1573*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXAGCCTL, BITS_RXAGC_OFDM,
1574*4882a593Smuzhiyun 					 0x3);
1575*4882a593Smuzhiyun 		}
1576*4882a593Smuzhiyun 
1577*4882a593Smuzhiyun 		if (channel >= 36 && channel <= 51)
1578*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x494);
1579*4882a593Smuzhiyun 		else if (channel >= 52 && channel <= 55)
1580*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x493);
1581*4882a593Smuzhiyun 		else if (channel >= 56 && channel <= 111)
1582*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x453);
1583*4882a593Smuzhiyun 		else if (channel >= 112 && channel <= 119)
1584*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x452);
1585*4882a593Smuzhiyun 		else if (channel >= 120 && channel <= 172)
1586*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x412);
1587*4882a593Smuzhiyun 		else if (channel >= 173 && channel <= 177)
1588*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_SCOTRK, 0xfff, 0x411);
1589*4882a593Smuzhiyun 	}
1590*4882a593Smuzhiyun 
1591*4882a593Smuzhiyun 	switch (bw) {
1592*4882a593Smuzhiyun 	case RTW_CHANNEL_WIDTH_20:
1593*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DFIRBW, 0x3FF0, 0x19B);
1594*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xf, 0x0);
1595*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xffc0, 0x0);
1596*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXCLK, 0x700, 0x7);
1597*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXCLK, 0x700000, 0x6);
1598*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_CCK_SOURCE, BIT_NBI_EN, 0x0);
1599*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_SBD, BITS_SUBTUNE, 0x1);
1600*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_PT_CHSMO, BIT_PT_OPT, 0x0);
1601*4882a593Smuzhiyun 		break;
1602*4882a593Smuzhiyun 	case RTW_CHANNEL_WIDTH_40:
1603*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_CCKSB, BIT(4),
1604*4882a593Smuzhiyun 				 (primary_ch_idx == RTW_SC_20_UPPER ? 1 : 0));
1605*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xf, 0x5);
1606*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xc0, 0x0);
1607*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xff00,
1608*4882a593Smuzhiyun 				 (primary_ch_idx | (primary_ch_idx << 4)));
1609*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_CCK_SOURCE, BIT_NBI_EN, 0x1);
1610*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_SBD, BITS_SUBTUNE, 0x1);
1611*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_PT_CHSMO, BIT_PT_OPT, 0x1);
1612*4882a593Smuzhiyun 		break;
1613*4882a593Smuzhiyun 	case RTW_CHANNEL_WIDTH_80:
1614*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xf, 0xa);
1615*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xc0, 0x0);
1616*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xff00,
1617*4882a593Smuzhiyun 				 (primary_ch_idx | (primary_ch_idx << 4)));
1618*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_SBD, BITS_SUBTUNE, 0x6);
1619*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_PT_CHSMO, BIT_PT_OPT, 0x1);
1620*4882a593Smuzhiyun 		break;
1621*4882a593Smuzhiyun 	case RTW_CHANNEL_WIDTH_5:
1622*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DFIRBW, 0x3FF0, 0x2AB);
1623*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xf, 0x0);
1624*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xffc0, 0x1);
1625*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXCLK, 0x700, 0x4);
1626*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXCLK, 0x700000, 0x4);
1627*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_CCK_SOURCE, BIT_NBI_EN, 0x0);
1628*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_SBD, BITS_SUBTUNE, 0x1);
1629*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_PT_CHSMO, BIT_PT_OPT, 0x0);
1630*4882a593Smuzhiyun 		break;
1631*4882a593Smuzhiyun 	case RTW_CHANNEL_WIDTH_10:
1632*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DFIRBW, 0x3FF0, 0x2AB);
1633*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xf, 0x0);
1634*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXBWCTL, 0xffc0, 0x2);
1635*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXCLK, 0x700, 0x6);
1636*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXCLK, 0x700000, 0x5);
1637*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_CCK_SOURCE, BIT_NBI_EN, 0x0);
1638*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_SBD, BITS_SUBTUNE, 0x1);
1639*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_PT_CHSMO, BIT_PT_OPT, 0x0);
1640*4882a593Smuzhiyun 		break;
1641*4882a593Smuzhiyun 	}
1642*4882a593Smuzhiyun }
1643*4882a593Smuzhiyun 
rtw8822c_set_channel(struct rtw_dev * rtwdev,u8 channel,u8 bw,u8 primary_chan_idx)1644*4882a593Smuzhiyun static void rtw8822c_set_channel(struct rtw_dev *rtwdev, u8 channel, u8 bw,
1645*4882a593Smuzhiyun 				 u8 primary_chan_idx)
1646*4882a593Smuzhiyun {
1647*4882a593Smuzhiyun 	rtw8822c_set_channel_bb(rtwdev, channel, bw, primary_chan_idx);
1648*4882a593Smuzhiyun 	rtw_set_channel_mac(rtwdev, channel, bw, primary_chan_idx);
1649*4882a593Smuzhiyun 	rtw8822c_set_channel_rf(rtwdev, channel, bw);
1650*4882a593Smuzhiyun 	rtw8822c_toggle_igi(rtwdev);
1651*4882a593Smuzhiyun }
1652*4882a593Smuzhiyun 
rtw8822c_config_cck_rx_path(struct rtw_dev * rtwdev,u8 rx_path)1653*4882a593Smuzhiyun static void rtw8822c_config_cck_rx_path(struct rtw_dev *rtwdev, u8 rx_path)
1654*4882a593Smuzhiyun {
1655*4882a593Smuzhiyun 	if (rx_path == BB_PATH_A || rx_path == BB_PATH_B) {
1656*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_CCANRX, 0x00060000, 0x0);
1657*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_CCANRX, 0x00600000, 0x0);
1658*4882a593Smuzhiyun 	} else if (rx_path == BB_PATH_AB) {
1659*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_CCANRX, 0x00600000, 0x1);
1660*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_CCANRX, 0x00060000, 0x1);
1661*4882a593Smuzhiyun 	}
1662*4882a593Smuzhiyun 
1663*4882a593Smuzhiyun 	if (rx_path == BB_PATH_A)
1664*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0x0f000000, 0x0);
1665*4882a593Smuzhiyun 	else if (rx_path == BB_PATH_B)
1666*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0x0f000000, 0x5);
1667*4882a593Smuzhiyun 	else if (rx_path == BB_PATH_AB)
1668*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0x0f000000, 0x1);
1669*4882a593Smuzhiyun }
1670*4882a593Smuzhiyun 
rtw8822c_config_ofdm_rx_path(struct rtw_dev * rtwdev,u8 rx_path)1671*4882a593Smuzhiyun static void rtw8822c_config_ofdm_rx_path(struct rtw_dev *rtwdev, u8 rx_path)
1672*4882a593Smuzhiyun {
1673*4882a593Smuzhiyun 	if (rx_path == BB_PATH_A || rx_path == BB_PATH_B) {
1674*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RXFNCTL, 0x300, 0x0);
1675*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RXFNCTL, 0x600000, 0x0);
1676*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_AGCSWSH, BIT(17), 0x0);
1677*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_ANTWTPD, BIT(20), 0x0);
1678*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_MRCM, BIT(24), 0x0);
1679*4882a593Smuzhiyun 	} else if (rx_path == BB_PATH_AB) {
1680*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RXFNCTL, 0x300, 0x1);
1681*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RXFNCTL, 0x600000, 0x1);
1682*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_AGCSWSH, BIT(17), 0x1);
1683*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_ANTWTPD, BIT(20), 0x1);
1684*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_MRCM, BIT(24), 0x1);
1685*4882a593Smuzhiyun 	}
1686*4882a593Smuzhiyun 
1687*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x824, 0x0f000000, rx_path);
1688*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x824, 0x000f0000, rx_path);
1689*4882a593Smuzhiyun }
1690*4882a593Smuzhiyun 
rtw8822c_config_rx_path(struct rtw_dev * rtwdev,u8 rx_path)1691*4882a593Smuzhiyun static void rtw8822c_config_rx_path(struct rtw_dev *rtwdev, u8 rx_path)
1692*4882a593Smuzhiyun {
1693*4882a593Smuzhiyun 	rtw8822c_config_cck_rx_path(rtwdev, rx_path);
1694*4882a593Smuzhiyun 	rtw8822c_config_ofdm_rx_path(rtwdev, rx_path);
1695*4882a593Smuzhiyun }
1696*4882a593Smuzhiyun 
rtw8822c_config_cck_tx_path(struct rtw_dev * rtwdev,u8 tx_path,bool is_tx2_path)1697*4882a593Smuzhiyun static void rtw8822c_config_cck_tx_path(struct rtw_dev *rtwdev, u8 tx_path,
1698*4882a593Smuzhiyun 					bool is_tx2_path)
1699*4882a593Smuzhiyun {
1700*4882a593Smuzhiyun 	if (tx_path == BB_PATH_A) {
1701*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0xf0000000, 0x8);
1702*4882a593Smuzhiyun 	} else if (tx_path == BB_PATH_B) {
1703*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0xf0000000, 0x4);
1704*4882a593Smuzhiyun 	} else {
1705*4882a593Smuzhiyun 		if (is_tx2_path)
1706*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0xf0000000, 0xc);
1707*4882a593Smuzhiyun 		else
1708*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_RXCCKSEL, 0xf0000000, 0x8);
1709*4882a593Smuzhiyun 	}
1710*4882a593Smuzhiyun }
1711*4882a593Smuzhiyun 
rtw8822c_config_ofdm_tx_path(struct rtw_dev * rtwdev,u8 tx_path,bool is_tx2_path)1712*4882a593Smuzhiyun static void rtw8822c_config_ofdm_tx_path(struct rtw_dev *rtwdev, u8 tx_path,
1713*4882a593Smuzhiyun 					 bool is_tx2_path)
1714*4882a593Smuzhiyun {
1715*4882a593Smuzhiyun 	if (tx_path == BB_PATH_A) {
1716*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x11);
1717*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xff, 0x0);
1718*4882a593Smuzhiyun 	} else if (tx_path == BB_PATH_B) {
1719*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x12);
1720*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xff, 0x0);
1721*4882a593Smuzhiyun 	} else {
1722*4882a593Smuzhiyun 		if (is_tx2_path) {
1723*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x33);
1724*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xffff, 0x0404);
1725*4882a593Smuzhiyun 		} else {
1726*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_ANTMAP0, 0xff, 0x31);
1727*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_TXLGMAP, 0xffff, 0x0400);
1728*4882a593Smuzhiyun 		}
1729*4882a593Smuzhiyun 	}
1730*4882a593Smuzhiyun }
1731*4882a593Smuzhiyun 
rtw8822c_config_tx_path(struct rtw_dev * rtwdev,u8 tx_path,bool is_tx2_path)1732*4882a593Smuzhiyun static void rtw8822c_config_tx_path(struct rtw_dev *rtwdev, u8 tx_path,
1733*4882a593Smuzhiyun 				    bool is_tx2_path)
1734*4882a593Smuzhiyun {
1735*4882a593Smuzhiyun 	rtw8822c_config_cck_tx_path(rtwdev, tx_path, is_tx2_path);
1736*4882a593Smuzhiyun 	rtw8822c_config_ofdm_tx_path(rtwdev, tx_path, is_tx2_path);
1737*4882a593Smuzhiyun }
1738*4882a593Smuzhiyun 
rtw8822c_config_trx_mode(struct rtw_dev * rtwdev,u8 tx_path,u8 rx_path,bool is_tx2_path)1739*4882a593Smuzhiyun static void rtw8822c_config_trx_mode(struct rtw_dev *rtwdev, u8 tx_path,
1740*4882a593Smuzhiyun 				     u8 rx_path, bool is_tx2_path)
1741*4882a593Smuzhiyun {
1742*4882a593Smuzhiyun 	if ((tx_path | rx_path) & BB_PATH_A)
1743*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_ORITXCODE, MASK20BITS, 0x33312);
1744*4882a593Smuzhiyun 	else
1745*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_ORITXCODE, MASK20BITS, 0x11111);
1746*4882a593Smuzhiyun 	if ((tx_path | rx_path) & BB_PATH_B)
1747*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_ORITXCODE2, MASK20BITS, 0x33312);
1748*4882a593Smuzhiyun 	else
1749*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_ORITXCODE2, MASK20BITS, 0x11111);
1750*4882a593Smuzhiyun 
1751*4882a593Smuzhiyun 	rtw8822c_config_rx_path(rtwdev, rx_path);
1752*4882a593Smuzhiyun 	rtw8822c_config_tx_path(rtwdev, tx_path, is_tx2_path);
1753*4882a593Smuzhiyun 
1754*4882a593Smuzhiyun 	rtw8822c_toggle_igi(rtwdev);
1755*4882a593Smuzhiyun }
1756*4882a593Smuzhiyun 
query_phy_status_page0(struct rtw_dev * rtwdev,u8 * phy_status,struct rtw_rx_pkt_stat * pkt_stat)1757*4882a593Smuzhiyun static void query_phy_status_page0(struct rtw_dev *rtwdev, u8 *phy_status,
1758*4882a593Smuzhiyun 				   struct rtw_rx_pkt_stat *pkt_stat)
1759*4882a593Smuzhiyun {
1760*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1761*4882a593Smuzhiyun 	u8 l_bnd, u_bnd;
1762*4882a593Smuzhiyun 	u8 gain_a, gain_b;
1763*4882a593Smuzhiyun 	s8 rx_power[RTW_RF_PATH_MAX];
1764*4882a593Smuzhiyun 	s8 min_rx_power = -120;
1765*4882a593Smuzhiyun 	u8 rssi;
1766*4882a593Smuzhiyun 	int path;
1767*4882a593Smuzhiyun 
1768*4882a593Smuzhiyun 	rx_power[RF_PATH_A] = GET_PHY_STAT_P0_PWDB_A(phy_status);
1769*4882a593Smuzhiyun 	rx_power[RF_PATH_B] = GET_PHY_STAT_P0_PWDB_B(phy_status);
1770*4882a593Smuzhiyun 	l_bnd = dm_info->cck_gi_l_bnd;
1771*4882a593Smuzhiyun 	u_bnd = dm_info->cck_gi_u_bnd;
1772*4882a593Smuzhiyun 	gain_a = GET_PHY_STAT_P0_GAIN_A(phy_status);
1773*4882a593Smuzhiyun 	gain_b = GET_PHY_STAT_P0_GAIN_B(phy_status);
1774*4882a593Smuzhiyun 	if (gain_a < l_bnd)
1775*4882a593Smuzhiyun 		rx_power[RF_PATH_A] += (l_bnd - gain_a) << 1;
1776*4882a593Smuzhiyun 	else if (gain_a > u_bnd)
1777*4882a593Smuzhiyun 		rx_power[RF_PATH_A] -= (gain_a - u_bnd) << 1;
1778*4882a593Smuzhiyun 	if (gain_b < l_bnd)
1779*4882a593Smuzhiyun 		rx_power[RF_PATH_B] += (l_bnd - gain_b) << 1;
1780*4882a593Smuzhiyun 	else if (gain_b > u_bnd)
1781*4882a593Smuzhiyun 		rx_power[RF_PATH_B] -= (gain_b - u_bnd) << 1;
1782*4882a593Smuzhiyun 
1783*4882a593Smuzhiyun 	rx_power[RF_PATH_A] -= 110;
1784*4882a593Smuzhiyun 	rx_power[RF_PATH_B] -= 110;
1785*4882a593Smuzhiyun 
1786*4882a593Smuzhiyun 	pkt_stat->rx_power[RF_PATH_A] = rx_power[RF_PATH_A];
1787*4882a593Smuzhiyun 	pkt_stat->rx_power[RF_PATH_B] = rx_power[RF_PATH_B];
1788*4882a593Smuzhiyun 
1789*4882a593Smuzhiyun 	for (path = 0; path <= rtwdev->hal.rf_path_num; path++) {
1790*4882a593Smuzhiyun 		rssi = rtw_phy_rf_power_2_rssi(&pkt_stat->rx_power[path], 1);
1791*4882a593Smuzhiyun 		dm_info->rssi[path] = rssi;
1792*4882a593Smuzhiyun 	}
1793*4882a593Smuzhiyun 
1794*4882a593Smuzhiyun 	pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 1);
1795*4882a593Smuzhiyun 	pkt_stat->bw = RTW_CHANNEL_WIDTH_20;
1796*4882a593Smuzhiyun 	pkt_stat->signal_power = max(pkt_stat->rx_power[RF_PATH_A],
1797*4882a593Smuzhiyun 				     min_rx_power);
1798*4882a593Smuzhiyun }
1799*4882a593Smuzhiyun 
query_phy_status_page1(struct rtw_dev * rtwdev,u8 * phy_status,struct rtw_rx_pkt_stat * pkt_stat)1800*4882a593Smuzhiyun static void query_phy_status_page1(struct rtw_dev *rtwdev, u8 *phy_status,
1801*4882a593Smuzhiyun 				   struct rtw_rx_pkt_stat *pkt_stat)
1802*4882a593Smuzhiyun {
1803*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
1804*4882a593Smuzhiyun 	u8 rxsc, bw;
1805*4882a593Smuzhiyun 	s8 min_rx_power = -120;
1806*4882a593Smuzhiyun 	s8 rx_evm;
1807*4882a593Smuzhiyun 	u8 evm_dbm = 0;
1808*4882a593Smuzhiyun 	u8 rssi;
1809*4882a593Smuzhiyun 	int path;
1810*4882a593Smuzhiyun 
1811*4882a593Smuzhiyun 	if (pkt_stat->rate > DESC_RATE11M && pkt_stat->rate < DESC_RATEMCS0)
1812*4882a593Smuzhiyun 		rxsc = GET_PHY_STAT_P1_L_RXSC(phy_status);
1813*4882a593Smuzhiyun 	else
1814*4882a593Smuzhiyun 		rxsc = GET_PHY_STAT_P1_HT_RXSC(phy_status);
1815*4882a593Smuzhiyun 
1816*4882a593Smuzhiyun 	if (rxsc >= 9 && rxsc <= 12)
1817*4882a593Smuzhiyun 		bw = RTW_CHANNEL_WIDTH_40;
1818*4882a593Smuzhiyun 	else if (rxsc >= 13)
1819*4882a593Smuzhiyun 		bw = RTW_CHANNEL_WIDTH_80;
1820*4882a593Smuzhiyun 	else
1821*4882a593Smuzhiyun 		bw = RTW_CHANNEL_WIDTH_20;
1822*4882a593Smuzhiyun 
1823*4882a593Smuzhiyun 	pkt_stat->rx_power[RF_PATH_A] = GET_PHY_STAT_P1_PWDB_A(phy_status) - 110;
1824*4882a593Smuzhiyun 	pkt_stat->rx_power[RF_PATH_B] = GET_PHY_STAT_P1_PWDB_B(phy_status) - 110;
1825*4882a593Smuzhiyun 	pkt_stat->rssi = rtw_phy_rf_power_2_rssi(pkt_stat->rx_power, 2);
1826*4882a593Smuzhiyun 	pkt_stat->bw = bw;
1827*4882a593Smuzhiyun 	pkt_stat->signal_power = max3(pkt_stat->rx_power[RF_PATH_A],
1828*4882a593Smuzhiyun 				      pkt_stat->rx_power[RF_PATH_B],
1829*4882a593Smuzhiyun 				      min_rx_power);
1830*4882a593Smuzhiyun 
1831*4882a593Smuzhiyun 	dm_info->curr_rx_rate = pkt_stat->rate;
1832*4882a593Smuzhiyun 
1833*4882a593Smuzhiyun 	pkt_stat->rx_evm[RF_PATH_A] = GET_PHY_STAT_P1_RXEVM_A(phy_status);
1834*4882a593Smuzhiyun 	pkt_stat->rx_evm[RF_PATH_B] = GET_PHY_STAT_P1_RXEVM_B(phy_status);
1835*4882a593Smuzhiyun 
1836*4882a593Smuzhiyun 	pkt_stat->rx_snr[RF_PATH_A] = GET_PHY_STAT_P1_RXSNR_A(phy_status);
1837*4882a593Smuzhiyun 	pkt_stat->rx_snr[RF_PATH_B] = GET_PHY_STAT_P1_RXSNR_B(phy_status);
1838*4882a593Smuzhiyun 
1839*4882a593Smuzhiyun 	pkt_stat->cfo_tail[RF_PATH_A] = GET_PHY_STAT_P1_CFO_TAIL_A(phy_status);
1840*4882a593Smuzhiyun 	pkt_stat->cfo_tail[RF_PATH_B] = GET_PHY_STAT_P1_CFO_TAIL_B(phy_status);
1841*4882a593Smuzhiyun 
1842*4882a593Smuzhiyun 	for (path = 0; path <= rtwdev->hal.rf_path_num; path++) {
1843*4882a593Smuzhiyun 		rssi = rtw_phy_rf_power_2_rssi(&pkt_stat->rx_power[path], 1);
1844*4882a593Smuzhiyun 		dm_info->rssi[path] = rssi;
1845*4882a593Smuzhiyun 		dm_info->rx_snr[path] = pkt_stat->rx_snr[path] >> 1;
1846*4882a593Smuzhiyun 		dm_info->cfo_tail[path] = (pkt_stat->cfo_tail[path] * 5) >> 1;
1847*4882a593Smuzhiyun 
1848*4882a593Smuzhiyun 		rx_evm = pkt_stat->rx_evm[path];
1849*4882a593Smuzhiyun 
1850*4882a593Smuzhiyun 		if (rx_evm < 0) {
1851*4882a593Smuzhiyun 			if (rx_evm == S8_MIN)
1852*4882a593Smuzhiyun 				evm_dbm = 0;
1853*4882a593Smuzhiyun 			else
1854*4882a593Smuzhiyun 				evm_dbm = ((u8)-rx_evm >> 1);
1855*4882a593Smuzhiyun 		}
1856*4882a593Smuzhiyun 		dm_info->rx_evm_dbm[path] = evm_dbm;
1857*4882a593Smuzhiyun 	}
1858*4882a593Smuzhiyun }
1859*4882a593Smuzhiyun 
query_phy_status(struct rtw_dev * rtwdev,u8 * phy_status,struct rtw_rx_pkt_stat * pkt_stat)1860*4882a593Smuzhiyun static void query_phy_status(struct rtw_dev *rtwdev, u8 *phy_status,
1861*4882a593Smuzhiyun 			     struct rtw_rx_pkt_stat *pkt_stat)
1862*4882a593Smuzhiyun {
1863*4882a593Smuzhiyun 	u8 page;
1864*4882a593Smuzhiyun 
1865*4882a593Smuzhiyun 	page = *phy_status & 0xf;
1866*4882a593Smuzhiyun 
1867*4882a593Smuzhiyun 	switch (page) {
1868*4882a593Smuzhiyun 	case 0:
1869*4882a593Smuzhiyun 		query_phy_status_page0(rtwdev, phy_status, pkt_stat);
1870*4882a593Smuzhiyun 		break;
1871*4882a593Smuzhiyun 	case 1:
1872*4882a593Smuzhiyun 		query_phy_status_page1(rtwdev, phy_status, pkt_stat);
1873*4882a593Smuzhiyun 		break;
1874*4882a593Smuzhiyun 	default:
1875*4882a593Smuzhiyun 		rtw_warn(rtwdev, "unused phy status page (%d)\n", page);
1876*4882a593Smuzhiyun 		return;
1877*4882a593Smuzhiyun 	}
1878*4882a593Smuzhiyun }
1879*4882a593Smuzhiyun 
rtw8822c_query_rx_desc(struct rtw_dev * rtwdev,u8 * rx_desc,struct rtw_rx_pkt_stat * pkt_stat,struct ieee80211_rx_status * rx_status)1880*4882a593Smuzhiyun static void rtw8822c_query_rx_desc(struct rtw_dev *rtwdev, u8 *rx_desc,
1881*4882a593Smuzhiyun 				   struct rtw_rx_pkt_stat *pkt_stat,
1882*4882a593Smuzhiyun 				   struct ieee80211_rx_status *rx_status)
1883*4882a593Smuzhiyun {
1884*4882a593Smuzhiyun 	struct ieee80211_hdr *hdr;
1885*4882a593Smuzhiyun 	u32 desc_sz = rtwdev->chip->rx_pkt_desc_sz;
1886*4882a593Smuzhiyun 	u8 *phy_status = NULL;
1887*4882a593Smuzhiyun 
1888*4882a593Smuzhiyun 	memset(pkt_stat, 0, sizeof(*pkt_stat));
1889*4882a593Smuzhiyun 
1890*4882a593Smuzhiyun 	pkt_stat->phy_status = GET_RX_DESC_PHYST(rx_desc);
1891*4882a593Smuzhiyun 	pkt_stat->icv_err = GET_RX_DESC_ICV_ERR(rx_desc);
1892*4882a593Smuzhiyun 	pkt_stat->crc_err = GET_RX_DESC_CRC32(rx_desc);
1893*4882a593Smuzhiyun 	pkt_stat->decrypted = !GET_RX_DESC_SWDEC(rx_desc) &&
1894*4882a593Smuzhiyun 			      GET_RX_DESC_ENC_TYPE(rx_desc) != RX_DESC_ENC_NONE;
1895*4882a593Smuzhiyun 	pkt_stat->is_c2h = GET_RX_DESC_C2H(rx_desc);
1896*4882a593Smuzhiyun 	pkt_stat->pkt_len = GET_RX_DESC_PKT_LEN(rx_desc);
1897*4882a593Smuzhiyun 	pkt_stat->drv_info_sz = GET_RX_DESC_DRV_INFO_SIZE(rx_desc);
1898*4882a593Smuzhiyun 	pkt_stat->shift = GET_RX_DESC_SHIFT(rx_desc);
1899*4882a593Smuzhiyun 	pkt_stat->rate = GET_RX_DESC_RX_RATE(rx_desc);
1900*4882a593Smuzhiyun 	pkt_stat->cam_id = GET_RX_DESC_MACID(rx_desc);
1901*4882a593Smuzhiyun 	pkt_stat->ppdu_cnt = GET_RX_DESC_PPDU_CNT(rx_desc);
1902*4882a593Smuzhiyun 	pkt_stat->tsf_low = GET_RX_DESC_TSFL(rx_desc);
1903*4882a593Smuzhiyun 
1904*4882a593Smuzhiyun 	/* drv_info_sz is in unit of 8-bytes */
1905*4882a593Smuzhiyun 	pkt_stat->drv_info_sz *= 8;
1906*4882a593Smuzhiyun 
1907*4882a593Smuzhiyun 	/* c2h cmd pkt's rx/phy status is not interested */
1908*4882a593Smuzhiyun 	if (pkt_stat->is_c2h)
1909*4882a593Smuzhiyun 		return;
1910*4882a593Smuzhiyun 
1911*4882a593Smuzhiyun 	hdr = (struct ieee80211_hdr *)(rx_desc + desc_sz + pkt_stat->shift +
1912*4882a593Smuzhiyun 				       pkt_stat->drv_info_sz);
1913*4882a593Smuzhiyun 	if (pkt_stat->phy_status) {
1914*4882a593Smuzhiyun 		phy_status = rx_desc + desc_sz + pkt_stat->shift;
1915*4882a593Smuzhiyun 		query_phy_status(rtwdev, phy_status, pkt_stat);
1916*4882a593Smuzhiyun 	}
1917*4882a593Smuzhiyun 
1918*4882a593Smuzhiyun 	rtw_rx_fill_rx_status(rtwdev, pkt_stat, hdr, rx_status, phy_status);
1919*4882a593Smuzhiyun }
1920*4882a593Smuzhiyun 
1921*4882a593Smuzhiyun static void
rtw8822c_set_write_tx_power_ref(struct rtw_dev * rtwdev,u8 * tx_pwr_ref_cck,u8 * tx_pwr_ref_ofdm)1922*4882a593Smuzhiyun rtw8822c_set_write_tx_power_ref(struct rtw_dev *rtwdev, u8 *tx_pwr_ref_cck,
1923*4882a593Smuzhiyun 				u8 *tx_pwr_ref_ofdm)
1924*4882a593Smuzhiyun {
1925*4882a593Smuzhiyun 	struct rtw_hal *hal = &rtwdev->hal;
1926*4882a593Smuzhiyun 	u32 txref_cck[2] = {0x18a0, 0x41a0};
1927*4882a593Smuzhiyun 	u32 txref_ofdm[2] = {0x18e8, 0x41e8};
1928*4882a593Smuzhiyun 	u8 path;
1929*4882a593Smuzhiyun 
1930*4882a593Smuzhiyun 	for (path = 0; path < hal->rf_path_num; path++) {
1931*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, 0x1c90, BIT(15), 0);
1932*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, txref_cck[path], 0x7f0000,
1933*4882a593Smuzhiyun 				 tx_pwr_ref_cck[path]);
1934*4882a593Smuzhiyun 	}
1935*4882a593Smuzhiyun 	for (path = 0; path < hal->rf_path_num; path++) {
1936*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, 0x1c90, BIT(15), 0);
1937*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, txref_ofdm[path], 0x1fc00,
1938*4882a593Smuzhiyun 				 tx_pwr_ref_ofdm[path]);
1939*4882a593Smuzhiyun 	}
1940*4882a593Smuzhiyun }
1941*4882a593Smuzhiyun 
rtw8822c_set_tx_power_diff(struct rtw_dev * rtwdev,u8 rate,s8 * diff_idx)1942*4882a593Smuzhiyun static void rtw8822c_set_tx_power_diff(struct rtw_dev *rtwdev, u8 rate,
1943*4882a593Smuzhiyun 				       s8 *diff_idx)
1944*4882a593Smuzhiyun {
1945*4882a593Smuzhiyun 	u32 offset_txagc = 0x3a00;
1946*4882a593Smuzhiyun 	u8 rate_idx = rate & 0xfc;
1947*4882a593Smuzhiyun 	u8 pwr_idx[4];
1948*4882a593Smuzhiyun 	u32 phy_pwr_idx;
1949*4882a593Smuzhiyun 	int i;
1950*4882a593Smuzhiyun 
1951*4882a593Smuzhiyun 	for (i = 0; i < 4; i++)
1952*4882a593Smuzhiyun 		pwr_idx[i] = diff_idx[i] & 0x7f;
1953*4882a593Smuzhiyun 
1954*4882a593Smuzhiyun 	phy_pwr_idx = pwr_idx[0] |
1955*4882a593Smuzhiyun 		      (pwr_idx[1] << 8) |
1956*4882a593Smuzhiyun 		      (pwr_idx[2] << 16) |
1957*4882a593Smuzhiyun 		      (pwr_idx[3] << 24);
1958*4882a593Smuzhiyun 
1959*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1c90, BIT(15), 0x0);
1960*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, offset_txagc + rate_idx, MASKDWORD,
1961*4882a593Smuzhiyun 			 phy_pwr_idx);
1962*4882a593Smuzhiyun }
1963*4882a593Smuzhiyun 
rtw8822c_set_tx_power_index(struct rtw_dev * rtwdev)1964*4882a593Smuzhiyun static void rtw8822c_set_tx_power_index(struct rtw_dev *rtwdev)
1965*4882a593Smuzhiyun {
1966*4882a593Smuzhiyun 	struct rtw_hal *hal = &rtwdev->hal;
1967*4882a593Smuzhiyun 	u8 rs, rate, j;
1968*4882a593Smuzhiyun 	u8 pwr_ref_cck[2] = {hal->tx_pwr_tbl[RF_PATH_A][DESC_RATE11M],
1969*4882a593Smuzhiyun 			     hal->tx_pwr_tbl[RF_PATH_B][DESC_RATE11M]};
1970*4882a593Smuzhiyun 	u8 pwr_ref_ofdm[2] = {hal->tx_pwr_tbl[RF_PATH_A][DESC_RATEMCS7],
1971*4882a593Smuzhiyun 			      hal->tx_pwr_tbl[RF_PATH_B][DESC_RATEMCS7]};
1972*4882a593Smuzhiyun 	s8 diff_a, diff_b;
1973*4882a593Smuzhiyun 	u8 pwr_a, pwr_b;
1974*4882a593Smuzhiyun 	s8 diff_idx[4];
1975*4882a593Smuzhiyun 
1976*4882a593Smuzhiyun 	rtw8822c_set_write_tx_power_ref(rtwdev, pwr_ref_cck, pwr_ref_ofdm);
1977*4882a593Smuzhiyun 	for (rs = 0; rs < RTW_RATE_SECTION_MAX; rs++) {
1978*4882a593Smuzhiyun 		for (j = 0; j < rtw_rate_size[rs]; j++) {
1979*4882a593Smuzhiyun 			rate = rtw_rate_section[rs][j];
1980*4882a593Smuzhiyun 			pwr_a = hal->tx_pwr_tbl[RF_PATH_A][rate];
1981*4882a593Smuzhiyun 			pwr_b = hal->tx_pwr_tbl[RF_PATH_B][rate];
1982*4882a593Smuzhiyun 			if (rs == 0) {
1983*4882a593Smuzhiyun 				diff_a = (s8)pwr_a - (s8)pwr_ref_cck[0];
1984*4882a593Smuzhiyun 				diff_b = (s8)pwr_b - (s8)pwr_ref_cck[1];
1985*4882a593Smuzhiyun 			} else {
1986*4882a593Smuzhiyun 				diff_a = (s8)pwr_a - (s8)pwr_ref_ofdm[0];
1987*4882a593Smuzhiyun 				diff_b = (s8)pwr_b - (s8)pwr_ref_ofdm[1];
1988*4882a593Smuzhiyun 			}
1989*4882a593Smuzhiyun 			diff_idx[rate % 4] = min(diff_a, diff_b);
1990*4882a593Smuzhiyun 			if (rate % 4 == 3)
1991*4882a593Smuzhiyun 				rtw8822c_set_tx_power_diff(rtwdev, rate - 3,
1992*4882a593Smuzhiyun 							   diff_idx);
1993*4882a593Smuzhiyun 		}
1994*4882a593Smuzhiyun 	}
1995*4882a593Smuzhiyun }
1996*4882a593Smuzhiyun 
rtw8822c_set_antenna(struct rtw_dev * rtwdev,u32 antenna_tx,u32 antenna_rx)1997*4882a593Smuzhiyun static int rtw8822c_set_antenna(struct rtw_dev *rtwdev,
1998*4882a593Smuzhiyun 				u32 antenna_tx,
1999*4882a593Smuzhiyun 				u32 antenna_rx)
2000*4882a593Smuzhiyun {
2001*4882a593Smuzhiyun 	struct rtw_hal *hal = &rtwdev->hal;
2002*4882a593Smuzhiyun 
2003*4882a593Smuzhiyun 	switch (antenna_tx) {
2004*4882a593Smuzhiyun 	case BB_PATH_A:
2005*4882a593Smuzhiyun 	case BB_PATH_B:
2006*4882a593Smuzhiyun 	case BB_PATH_AB:
2007*4882a593Smuzhiyun 		break;
2008*4882a593Smuzhiyun 	default:
2009*4882a593Smuzhiyun 		rtw_info(rtwdev, "unsupported tx path 0x%x\n", antenna_tx);
2010*4882a593Smuzhiyun 		return -EINVAL;
2011*4882a593Smuzhiyun 	}
2012*4882a593Smuzhiyun 
2013*4882a593Smuzhiyun 	/* path B only is not available for RX */
2014*4882a593Smuzhiyun 	switch (antenna_rx) {
2015*4882a593Smuzhiyun 	case BB_PATH_A:
2016*4882a593Smuzhiyun 	case BB_PATH_AB:
2017*4882a593Smuzhiyun 		break;
2018*4882a593Smuzhiyun 	default:
2019*4882a593Smuzhiyun 		rtw_info(rtwdev, "unsupported rx path 0x%x\n", antenna_rx);
2020*4882a593Smuzhiyun 		return -EINVAL;
2021*4882a593Smuzhiyun 	}
2022*4882a593Smuzhiyun 
2023*4882a593Smuzhiyun 	hal->antenna_tx = antenna_tx;
2024*4882a593Smuzhiyun 	hal->antenna_rx = antenna_rx;
2025*4882a593Smuzhiyun 
2026*4882a593Smuzhiyun 	rtw8822c_config_trx_mode(rtwdev, antenna_tx, antenna_rx, false);
2027*4882a593Smuzhiyun 
2028*4882a593Smuzhiyun 	return 0;
2029*4882a593Smuzhiyun }
2030*4882a593Smuzhiyun 
rtw8822c_cfg_ldo25(struct rtw_dev * rtwdev,bool enable)2031*4882a593Smuzhiyun static void rtw8822c_cfg_ldo25(struct rtw_dev *rtwdev, bool enable)
2032*4882a593Smuzhiyun {
2033*4882a593Smuzhiyun 	u8 ldo_pwr;
2034*4882a593Smuzhiyun 
2035*4882a593Smuzhiyun 	ldo_pwr = rtw_read8(rtwdev, REG_ANAPARLDO_POW_MAC);
2036*4882a593Smuzhiyun 	ldo_pwr = enable ? ldo_pwr | BIT_LDOE25_PON : ldo_pwr & ~BIT_LDOE25_PON;
2037*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_ANAPARLDO_POW_MAC, ldo_pwr);
2038*4882a593Smuzhiyun }
2039*4882a593Smuzhiyun 
rtw8822c_false_alarm_statistics(struct rtw_dev * rtwdev)2040*4882a593Smuzhiyun static void rtw8822c_false_alarm_statistics(struct rtw_dev *rtwdev)
2041*4882a593Smuzhiyun {
2042*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
2043*4882a593Smuzhiyun 	u32 cck_enable;
2044*4882a593Smuzhiyun 	u32 cck_fa_cnt;
2045*4882a593Smuzhiyun 	u32 crc32_cnt;
2046*4882a593Smuzhiyun 	u32 cca32_cnt;
2047*4882a593Smuzhiyun 	u32 ofdm_fa_cnt;
2048*4882a593Smuzhiyun 	u32 ofdm_fa_cnt1, ofdm_fa_cnt2, ofdm_fa_cnt3, ofdm_fa_cnt4, ofdm_fa_cnt5;
2049*4882a593Smuzhiyun 	u16 parity_fail, rate_illegal, crc8_fail, mcs_fail, sb_search_fail,
2050*4882a593Smuzhiyun 	    fast_fsync, crc8_fail_vhta, mcs_fail_vht;
2051*4882a593Smuzhiyun 
2052*4882a593Smuzhiyun 	cck_enable = rtw_read32(rtwdev, REG_ENCCK) & BIT_CCK_BLK_EN;
2053*4882a593Smuzhiyun 	cck_fa_cnt = rtw_read16(rtwdev, REG_CCK_FACNT);
2054*4882a593Smuzhiyun 
2055*4882a593Smuzhiyun 	ofdm_fa_cnt1 = rtw_read32(rtwdev, REG_OFDM_FACNT1);
2056*4882a593Smuzhiyun 	ofdm_fa_cnt2 = rtw_read32(rtwdev, REG_OFDM_FACNT2);
2057*4882a593Smuzhiyun 	ofdm_fa_cnt3 = rtw_read32(rtwdev, REG_OFDM_FACNT3);
2058*4882a593Smuzhiyun 	ofdm_fa_cnt4 = rtw_read32(rtwdev, REG_OFDM_FACNT4);
2059*4882a593Smuzhiyun 	ofdm_fa_cnt5 = rtw_read32(rtwdev, REG_OFDM_FACNT5);
2060*4882a593Smuzhiyun 
2061*4882a593Smuzhiyun 	parity_fail	= FIELD_GET(GENMASK(31, 16), ofdm_fa_cnt1);
2062*4882a593Smuzhiyun 	rate_illegal	= FIELD_GET(GENMASK(15, 0), ofdm_fa_cnt2);
2063*4882a593Smuzhiyun 	crc8_fail	= FIELD_GET(GENMASK(31, 16), ofdm_fa_cnt2);
2064*4882a593Smuzhiyun 	crc8_fail_vhta	= FIELD_GET(GENMASK(15, 0), ofdm_fa_cnt3);
2065*4882a593Smuzhiyun 	mcs_fail	= FIELD_GET(GENMASK(15, 0), ofdm_fa_cnt4);
2066*4882a593Smuzhiyun 	mcs_fail_vht	= FIELD_GET(GENMASK(31, 16), ofdm_fa_cnt4);
2067*4882a593Smuzhiyun 	fast_fsync	= FIELD_GET(GENMASK(15, 0), ofdm_fa_cnt5);
2068*4882a593Smuzhiyun 	sb_search_fail	= FIELD_GET(GENMASK(31, 16), ofdm_fa_cnt5);
2069*4882a593Smuzhiyun 
2070*4882a593Smuzhiyun 	ofdm_fa_cnt = parity_fail + rate_illegal + crc8_fail + crc8_fail_vhta +
2071*4882a593Smuzhiyun 		      mcs_fail + mcs_fail_vht + fast_fsync + sb_search_fail;
2072*4882a593Smuzhiyun 
2073*4882a593Smuzhiyun 	dm_info->cck_fa_cnt = cck_fa_cnt;
2074*4882a593Smuzhiyun 	dm_info->ofdm_fa_cnt = ofdm_fa_cnt;
2075*4882a593Smuzhiyun 	dm_info->total_fa_cnt = ofdm_fa_cnt;
2076*4882a593Smuzhiyun 	dm_info->total_fa_cnt += cck_enable ? cck_fa_cnt : 0;
2077*4882a593Smuzhiyun 
2078*4882a593Smuzhiyun 	crc32_cnt = rtw_read32(rtwdev, 0x2c04);
2079*4882a593Smuzhiyun 	dm_info->cck_ok_cnt = crc32_cnt & 0xffff;
2080*4882a593Smuzhiyun 	dm_info->cck_err_cnt = (crc32_cnt & 0xffff0000) >> 16;
2081*4882a593Smuzhiyun 	crc32_cnt = rtw_read32(rtwdev, 0x2c14);
2082*4882a593Smuzhiyun 	dm_info->ofdm_ok_cnt = crc32_cnt & 0xffff;
2083*4882a593Smuzhiyun 	dm_info->ofdm_err_cnt = (crc32_cnt & 0xffff0000) >> 16;
2084*4882a593Smuzhiyun 	crc32_cnt = rtw_read32(rtwdev, 0x2c10);
2085*4882a593Smuzhiyun 	dm_info->ht_ok_cnt = crc32_cnt & 0xffff;
2086*4882a593Smuzhiyun 	dm_info->ht_err_cnt = (crc32_cnt & 0xffff0000) >> 16;
2087*4882a593Smuzhiyun 	crc32_cnt = rtw_read32(rtwdev, 0x2c0c);
2088*4882a593Smuzhiyun 	dm_info->vht_ok_cnt = crc32_cnt & 0xffff;
2089*4882a593Smuzhiyun 	dm_info->vht_err_cnt = (crc32_cnt & 0xffff0000) >> 16;
2090*4882a593Smuzhiyun 
2091*4882a593Smuzhiyun 	cca32_cnt = rtw_read32(rtwdev, 0x2c08);
2092*4882a593Smuzhiyun 	dm_info->ofdm_cca_cnt = ((cca32_cnt & 0xffff0000) >> 16);
2093*4882a593Smuzhiyun 	dm_info->cck_cca_cnt = cca32_cnt & 0xffff;
2094*4882a593Smuzhiyun 	dm_info->total_cca_cnt = dm_info->ofdm_cca_cnt;
2095*4882a593Smuzhiyun 	if (cck_enable)
2096*4882a593Smuzhiyun 		dm_info->total_cca_cnt += dm_info->cck_cca_cnt;
2097*4882a593Smuzhiyun 
2098*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_CCANRX, BIT_CCK_FA_RST, 0);
2099*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_CCANRX, BIT_CCK_FA_RST, 2);
2100*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_CCANRX, BIT_OFDM_FA_RST, 0);
2101*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_CCANRX, BIT_OFDM_FA_RST, 2);
2102*4882a593Smuzhiyun 
2103*4882a593Smuzhiyun 	/* disable rx clk gating to reset counters */
2104*4882a593Smuzhiyun 	rtw_write32_clr(rtwdev, REG_RX_BREAK, BIT_COM_RX_GCK_EN);
2105*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_CNT_CTRL, BIT_ALL_CNT_RST);
2106*4882a593Smuzhiyun 	rtw_write32_clr(rtwdev, REG_CNT_CTRL, BIT_ALL_CNT_RST);
2107*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_RX_BREAK, BIT_COM_RX_GCK_EN);
2108*4882a593Smuzhiyun }
2109*4882a593Smuzhiyun 
rtw8822c_do_lck(struct rtw_dev * rtwdev)2110*4882a593Smuzhiyun static void rtw8822c_do_lck(struct rtw_dev *rtwdev)
2111*4882a593Smuzhiyun {
2112*4882a593Smuzhiyun 	u32 val;
2113*4882a593Smuzhiyun 
2114*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_SYN_CTRL, RFREG_MASK, 0x80010);
2115*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_SYN_PFD, RFREG_MASK, 0x1F0FA);
2116*4882a593Smuzhiyun 	fsleep(1);
2117*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_AAC_CTRL, RFREG_MASK, 0x80000);
2118*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_SYN_AAC, RFREG_MASK, 0x80001);
2119*4882a593Smuzhiyun 	read_poll_timeout(rtw_read_rf, val, val != 0x1, 1000, 100000,
2120*4882a593Smuzhiyun 			  true, rtwdev, RF_PATH_A, RF_AAC_CTRL, 0x1000);
2121*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_SYN_PFD, RFREG_MASK, 0x1F0F8);
2122*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_B, RF_SYN_CTRL, RFREG_MASK, 0x80010);
2123*4882a593Smuzhiyun 
2124*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_FAST_LCK, RFREG_MASK, 0x0f000);
2125*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_FAST_LCK, RFREG_MASK, 0x4f000);
2126*4882a593Smuzhiyun 	fsleep(1);
2127*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_A, RF_FAST_LCK, RFREG_MASK, 0x0f000);
2128*4882a593Smuzhiyun }
2129*4882a593Smuzhiyun 
rtw8822c_do_iqk(struct rtw_dev * rtwdev)2130*4882a593Smuzhiyun static void rtw8822c_do_iqk(struct rtw_dev *rtwdev)
2131*4882a593Smuzhiyun {
2132*4882a593Smuzhiyun 	struct rtw_iqk_para para = {0};
2133*4882a593Smuzhiyun 	u8 iqk_chk;
2134*4882a593Smuzhiyun 	int counter;
2135*4882a593Smuzhiyun 
2136*4882a593Smuzhiyun 	para.clear = 1;
2137*4882a593Smuzhiyun 	rtw_fw_do_iqk(rtwdev, &para);
2138*4882a593Smuzhiyun 
2139*4882a593Smuzhiyun 	for (counter = 0; counter < 300; counter++) {
2140*4882a593Smuzhiyun 		iqk_chk = rtw_read8(rtwdev, REG_RPT_CIP);
2141*4882a593Smuzhiyun 		if (iqk_chk == 0xaa)
2142*4882a593Smuzhiyun 			break;
2143*4882a593Smuzhiyun 		msleep(20);
2144*4882a593Smuzhiyun 	}
2145*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_IQKSTAT, 0x0);
2146*4882a593Smuzhiyun 
2147*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "iqk counter=%d\n", counter);
2148*4882a593Smuzhiyun }
2149*4882a593Smuzhiyun 
2150*4882a593Smuzhiyun /* for coex */
rtw8822c_coex_cfg_init(struct rtw_dev * rtwdev)2151*4882a593Smuzhiyun static void rtw8822c_coex_cfg_init(struct rtw_dev *rtwdev)
2152*4882a593Smuzhiyun {
2153*4882a593Smuzhiyun 	/* enable TBTT nterrupt */
2154*4882a593Smuzhiyun 	rtw_write8_set(rtwdev, REG_BCN_CTRL, BIT_EN_BCN_FUNCTION);
2155*4882a593Smuzhiyun 
2156*4882a593Smuzhiyun 	/* BT report packet sample rate	 */
2157*4882a593Smuzhiyun 	/* 0x790[5:0]=0x5 */
2158*4882a593Smuzhiyun 	rtw_write8_set(rtwdev, REG_BT_TDMA_TIME, 0x05);
2159*4882a593Smuzhiyun 
2160*4882a593Smuzhiyun 	/* enable BT counter statistics */
2161*4882a593Smuzhiyun 	rtw_write8(rtwdev, REG_BT_STAT_CTRL, 0x1);
2162*4882a593Smuzhiyun 
2163*4882a593Smuzhiyun 	/* enable PTA (3-wire function form BT side) */
2164*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_PTA_EN);
2165*4882a593Smuzhiyun 	rtw_write32_set(rtwdev, REG_GPIO_MUXCFG, BIT_BT_AOD_GPIO3);
2166*4882a593Smuzhiyun 
2167*4882a593Smuzhiyun 	/* enable PTA (tx/rx signal form WiFi side) */
2168*4882a593Smuzhiyun 	rtw_write8_set(rtwdev, REG_QUEUE_CTRL, BIT_PTA_WL_TX_EN);
2169*4882a593Smuzhiyun 	/* wl tx signal to PTA not case EDCCA */
2170*4882a593Smuzhiyun 	rtw_write8_clr(rtwdev, REG_QUEUE_CTRL, BIT_PTA_EDCCA_EN);
2171*4882a593Smuzhiyun 	/* GNT_BT=1 while select both */
2172*4882a593Smuzhiyun 	rtw_write8_set(rtwdev, REG_BT_COEX_V2, BIT_GNT_BT_POLARITY);
2173*4882a593Smuzhiyun 	/* BT_CCA = ~GNT_WL_BB, (not or GNT_BT_BB, LTE_Rx */
2174*4882a593Smuzhiyun 	rtw_write8_clr(rtwdev, REG_DUMMY_PAGE4_V1, BIT_BTCCA_CTRL);
2175*4882a593Smuzhiyun 
2176*4882a593Smuzhiyun 	/* to avoid RF parameter error */
2177*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_B, 0x1, 0xfffff, 0x40000);
2178*4882a593Smuzhiyun }
2179*4882a593Smuzhiyun 
rtw8822c_coex_cfg_gnt_fix(struct rtw_dev * rtwdev)2180*4882a593Smuzhiyun static void rtw8822c_coex_cfg_gnt_fix(struct rtw_dev *rtwdev)
2181*4882a593Smuzhiyun {
2182*4882a593Smuzhiyun 	struct rtw_coex *coex = &rtwdev->coex;
2183*4882a593Smuzhiyun 	struct rtw_coex_stat *coex_stat = &coex->stat;
2184*4882a593Smuzhiyun 	struct rtw_efuse *efuse = &rtwdev->efuse;
2185*4882a593Smuzhiyun 	u32 rf_0x1;
2186*4882a593Smuzhiyun 
2187*4882a593Smuzhiyun 	if (coex_stat->gnt_workaround_state == coex_stat->wl_coex_mode)
2188*4882a593Smuzhiyun 		return;
2189*4882a593Smuzhiyun 
2190*4882a593Smuzhiyun 	coex_stat->gnt_workaround_state = coex_stat->wl_coex_mode;
2191*4882a593Smuzhiyun 
2192*4882a593Smuzhiyun 	if ((coex_stat->kt_ver == 0 && coex->under_5g) || coex->freerun)
2193*4882a593Smuzhiyun 		rf_0x1 = 0x40021;
2194*4882a593Smuzhiyun 	else
2195*4882a593Smuzhiyun 		rf_0x1 = 0x40000;
2196*4882a593Smuzhiyun 
2197*4882a593Smuzhiyun 	/* BT at S1 for Shared-Ant */
2198*4882a593Smuzhiyun 	if (efuse->share_ant)
2199*4882a593Smuzhiyun 		rf_0x1 |= BIT(13);
2200*4882a593Smuzhiyun 
2201*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, RF_PATH_B, 0x1, 0xfffff, rf_0x1);
2202*4882a593Smuzhiyun 
2203*4882a593Smuzhiyun 	/* WL-S0 2G RF TRX cannot be masked by GNT_BT
2204*4882a593Smuzhiyun 	 * enable "WLS0 BB chage RF mode if GNT_BT = 1" for shared-antenna type
2205*4882a593Smuzhiyun 	 * disable:0x1860[3] = 1, enable:0x1860[3] = 0
2206*4882a593Smuzhiyun 	 *
2207*4882a593Smuzhiyun 	 * enable "DAC off if GNT_WL = 0" for non-shared-antenna
2208*4882a593Smuzhiyun 	 * disable 0x1c30[22] = 0,
2209*4882a593Smuzhiyun 	 * enable: 0x1c30[22] = 1, 0x1c38[12] = 0, 0x1c38[28] = 1
2210*4882a593Smuzhiyun 	 *
2211*4882a593Smuzhiyun 	 * disable WL-S1 BB chage RF mode if GNT_BT
2212*4882a593Smuzhiyun 	 * since RF TRx mask can do it
2213*4882a593Smuzhiyun 	 */
2214*4882a593Smuzhiyun 	rtw_write8_mask(rtwdev, 0x1c32, BIT(6), 1);
2215*4882a593Smuzhiyun 	rtw_write8_mask(rtwdev, 0x1c39, BIT(4), 0);
2216*4882a593Smuzhiyun 	rtw_write8_mask(rtwdev, 0x1c3b, BIT(4), 1);
2217*4882a593Smuzhiyun 	rtw_write8_mask(rtwdev, 0x4160, BIT(3), 1);
2218*4882a593Smuzhiyun 
2219*4882a593Smuzhiyun 	/* disable WL-S0 BB chage RF mode if wifi is at 5G,
2220*4882a593Smuzhiyun 	 * or antenna path is separated
2221*4882a593Smuzhiyun 	 */
2222*4882a593Smuzhiyun 	if (coex_stat->wl_coex_mode == COEX_WLINK_5G ||
2223*4882a593Smuzhiyun 	    coex->under_5g || !efuse->share_ant) {
2224*4882a593Smuzhiyun 		if (coex_stat->kt_ver >= 3) {
2225*4882a593Smuzhiyun 			rtw_write8_mask(rtwdev, 0x1860, BIT(3), 0);
2226*4882a593Smuzhiyun 			rtw_write8_mask(rtwdev, 0x1ca7, BIT(3), 1);
2227*4882a593Smuzhiyun 		} else {
2228*4882a593Smuzhiyun 			rtw_write8_mask(rtwdev, 0x1860, BIT(3), 1);
2229*4882a593Smuzhiyun 		}
2230*4882a593Smuzhiyun 	} else {
2231*4882a593Smuzhiyun 		/* shared-antenna */
2232*4882a593Smuzhiyun 		rtw_write8_mask(rtwdev, 0x1860, BIT(3), 0);
2233*4882a593Smuzhiyun 		if (coex_stat->kt_ver >= 3)
2234*4882a593Smuzhiyun 			rtw_write8_mask(rtwdev, 0x1ca7, BIT(3), 0);
2235*4882a593Smuzhiyun 	}
2236*4882a593Smuzhiyun }
2237*4882a593Smuzhiyun 
rtw8822c_coex_cfg_gnt_debug(struct rtw_dev * rtwdev)2238*4882a593Smuzhiyun static void rtw8822c_coex_cfg_gnt_debug(struct rtw_dev *rtwdev)
2239*4882a593Smuzhiyun {
2240*4882a593Smuzhiyun 	rtw_write8_mask(rtwdev, 0x66, BIT(4), 0);
2241*4882a593Smuzhiyun 	rtw_write8_mask(rtwdev, 0x67, BIT(0), 0);
2242*4882a593Smuzhiyun 	rtw_write8_mask(rtwdev, 0x42, BIT(3), 0);
2243*4882a593Smuzhiyun 	rtw_write8_mask(rtwdev, 0x65, BIT(7), 0);
2244*4882a593Smuzhiyun 	rtw_write8_mask(rtwdev, 0x73, BIT(3), 0);
2245*4882a593Smuzhiyun }
2246*4882a593Smuzhiyun 
rtw8822c_coex_cfg_rfe_type(struct rtw_dev * rtwdev)2247*4882a593Smuzhiyun static void rtw8822c_coex_cfg_rfe_type(struct rtw_dev *rtwdev)
2248*4882a593Smuzhiyun {
2249*4882a593Smuzhiyun 	struct rtw_coex *coex = &rtwdev->coex;
2250*4882a593Smuzhiyun 	struct rtw_coex_rfe *coex_rfe = &coex->rfe;
2251*4882a593Smuzhiyun 	struct rtw_efuse *efuse = &rtwdev->efuse;
2252*4882a593Smuzhiyun 
2253*4882a593Smuzhiyun 	coex_rfe->rfe_module_type = rtwdev->efuse.rfe_option;
2254*4882a593Smuzhiyun 	coex_rfe->ant_switch_polarity = 0;
2255*4882a593Smuzhiyun 	coex_rfe->ant_switch_exist = false;
2256*4882a593Smuzhiyun 	coex_rfe->ant_switch_with_bt = false;
2257*4882a593Smuzhiyun 	coex_rfe->ant_switch_diversity = false;
2258*4882a593Smuzhiyun 
2259*4882a593Smuzhiyun 	if (efuse->share_ant)
2260*4882a593Smuzhiyun 		coex_rfe->wlg_at_btg = true;
2261*4882a593Smuzhiyun 	else
2262*4882a593Smuzhiyun 		coex_rfe->wlg_at_btg = false;
2263*4882a593Smuzhiyun 
2264*4882a593Smuzhiyun 	/* disable LTE coex in wifi side */
2265*4882a593Smuzhiyun 	rtw_coex_write_indirect_reg(rtwdev, 0x38, BIT_LTE_COEX_EN, 0x0);
2266*4882a593Smuzhiyun 	rtw_coex_write_indirect_reg(rtwdev, 0xa0, MASKLWORD, 0xffff);
2267*4882a593Smuzhiyun 	rtw_coex_write_indirect_reg(rtwdev, 0xa4, MASKLWORD, 0xffff);
2268*4882a593Smuzhiyun }
2269*4882a593Smuzhiyun 
rtw8822c_coex_cfg_wl_tx_power(struct rtw_dev * rtwdev,u8 wl_pwr)2270*4882a593Smuzhiyun static void rtw8822c_coex_cfg_wl_tx_power(struct rtw_dev *rtwdev, u8 wl_pwr)
2271*4882a593Smuzhiyun {
2272*4882a593Smuzhiyun 	struct rtw_coex *coex = &rtwdev->coex;
2273*4882a593Smuzhiyun 	struct rtw_coex_dm *coex_dm = &coex->dm;
2274*4882a593Smuzhiyun 
2275*4882a593Smuzhiyun 	if (wl_pwr == coex_dm->cur_wl_pwr_lvl)
2276*4882a593Smuzhiyun 		return;
2277*4882a593Smuzhiyun 
2278*4882a593Smuzhiyun 	coex_dm->cur_wl_pwr_lvl = wl_pwr;
2279*4882a593Smuzhiyun }
2280*4882a593Smuzhiyun 
rtw8822c_coex_cfg_wl_rx_gain(struct rtw_dev * rtwdev,bool low_gain)2281*4882a593Smuzhiyun static void rtw8822c_coex_cfg_wl_rx_gain(struct rtw_dev *rtwdev, bool low_gain)
2282*4882a593Smuzhiyun {
2283*4882a593Smuzhiyun 	struct rtw_coex *coex = &rtwdev->coex;
2284*4882a593Smuzhiyun 	struct rtw_coex_dm *coex_dm = &coex->dm;
2285*4882a593Smuzhiyun 
2286*4882a593Smuzhiyun 	if (low_gain == coex_dm->cur_wl_rx_low_gain_en)
2287*4882a593Smuzhiyun 		return;
2288*4882a593Smuzhiyun 
2289*4882a593Smuzhiyun 	coex_dm->cur_wl_rx_low_gain_en = low_gain;
2290*4882a593Smuzhiyun 
2291*4882a593Smuzhiyun 	if (coex_dm->cur_wl_rx_low_gain_en) {
2292*4882a593Smuzhiyun 		/* set Rx filter corner RCK offset */
2293*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_A, 0xde, 0xfffff, 0x22);
2294*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_A, 0x1d, 0xfffff, 0x36);
2295*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_B, 0xde, 0xfffff, 0x22);
2296*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_B, 0x1d, 0xfffff, 0x36);
2297*4882a593Smuzhiyun 	} else {
2298*4882a593Smuzhiyun 		/* set Rx filter corner RCK offset */
2299*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_A, 0xde, 0xfffff, 0x20);
2300*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_A, 0x1d, 0xfffff, 0x0);
2301*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_B, 0x1d, 0xfffff, 0x0);
2302*4882a593Smuzhiyun 	}
2303*4882a593Smuzhiyun }
2304*4882a593Smuzhiyun 
rtw8822c_bf_enable_bfee_su(struct rtw_dev * rtwdev,struct rtw_vif * vif,struct rtw_bfee * bfee)2305*4882a593Smuzhiyun static void rtw8822c_bf_enable_bfee_su(struct rtw_dev *rtwdev,
2306*4882a593Smuzhiyun 				       struct rtw_vif *vif,
2307*4882a593Smuzhiyun 				       struct rtw_bfee *bfee)
2308*4882a593Smuzhiyun {
2309*4882a593Smuzhiyun 	u8 csi_rsc = 0;
2310*4882a593Smuzhiyun 	u32 tmp6dc;
2311*4882a593Smuzhiyun 
2312*4882a593Smuzhiyun 	rtw_bf_enable_bfee_su(rtwdev, vif, bfee);
2313*4882a593Smuzhiyun 
2314*4882a593Smuzhiyun 	tmp6dc = rtw_read32(rtwdev, REG_BBPSF_CTRL) |
2315*4882a593Smuzhiyun 			    BIT_WMAC_USE_NDPARATE |
2316*4882a593Smuzhiyun 			    (csi_rsc << 13);
2317*4882a593Smuzhiyun 	if (vif->net_type == RTW_NET_AP_MODE)
2318*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_BBPSF_CTRL, tmp6dc | BIT(12));
2319*4882a593Smuzhiyun 	else
2320*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_BBPSF_CTRL, tmp6dc & ~BIT(12));
2321*4882a593Smuzhiyun 
2322*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_CSI_RRSR, 0x550);
2323*4882a593Smuzhiyun }
2324*4882a593Smuzhiyun 
rtw8822c_bf_config_bfee_su(struct rtw_dev * rtwdev,struct rtw_vif * vif,struct rtw_bfee * bfee,bool enable)2325*4882a593Smuzhiyun static void rtw8822c_bf_config_bfee_su(struct rtw_dev *rtwdev,
2326*4882a593Smuzhiyun 				       struct rtw_vif *vif,
2327*4882a593Smuzhiyun 				       struct rtw_bfee *bfee, bool enable)
2328*4882a593Smuzhiyun {
2329*4882a593Smuzhiyun 	if (enable)
2330*4882a593Smuzhiyun 		rtw8822c_bf_enable_bfee_su(rtwdev, vif, bfee);
2331*4882a593Smuzhiyun 	else
2332*4882a593Smuzhiyun 		rtw_bf_remove_bfee_su(rtwdev, bfee);
2333*4882a593Smuzhiyun }
2334*4882a593Smuzhiyun 
rtw8822c_bf_config_bfee_mu(struct rtw_dev * rtwdev,struct rtw_vif * vif,struct rtw_bfee * bfee,bool enable)2335*4882a593Smuzhiyun static void rtw8822c_bf_config_bfee_mu(struct rtw_dev *rtwdev,
2336*4882a593Smuzhiyun 				       struct rtw_vif *vif,
2337*4882a593Smuzhiyun 				       struct rtw_bfee *bfee, bool enable)
2338*4882a593Smuzhiyun {
2339*4882a593Smuzhiyun 	if (enable)
2340*4882a593Smuzhiyun 		rtw_bf_enable_bfee_mu(rtwdev, vif, bfee);
2341*4882a593Smuzhiyun 	else
2342*4882a593Smuzhiyun 		rtw_bf_remove_bfee_mu(rtwdev, bfee);
2343*4882a593Smuzhiyun }
2344*4882a593Smuzhiyun 
rtw8822c_bf_config_bfee(struct rtw_dev * rtwdev,struct rtw_vif * vif,struct rtw_bfee * bfee,bool enable)2345*4882a593Smuzhiyun static void rtw8822c_bf_config_bfee(struct rtw_dev *rtwdev, struct rtw_vif *vif,
2346*4882a593Smuzhiyun 				    struct rtw_bfee *bfee, bool enable)
2347*4882a593Smuzhiyun {
2348*4882a593Smuzhiyun 	if (bfee->role == RTW_BFEE_SU)
2349*4882a593Smuzhiyun 		rtw8822c_bf_config_bfee_su(rtwdev, vif, bfee, enable);
2350*4882a593Smuzhiyun 	else if (bfee->role == RTW_BFEE_MU)
2351*4882a593Smuzhiyun 		rtw8822c_bf_config_bfee_mu(rtwdev, vif, bfee, enable);
2352*4882a593Smuzhiyun 	else
2353*4882a593Smuzhiyun 		rtw_warn(rtwdev, "wrong bfee role\n");
2354*4882a593Smuzhiyun }
2355*4882a593Smuzhiyun 
2356*4882a593Smuzhiyun struct dpk_cfg_pair {
2357*4882a593Smuzhiyun 	u32 addr;
2358*4882a593Smuzhiyun 	u32 bitmask;
2359*4882a593Smuzhiyun 	u32 data;
2360*4882a593Smuzhiyun };
2361*4882a593Smuzhiyun 
rtw8822c_parse_tbl_dpk(struct rtw_dev * rtwdev,const struct rtw_table * tbl)2362*4882a593Smuzhiyun void rtw8822c_parse_tbl_dpk(struct rtw_dev *rtwdev,
2363*4882a593Smuzhiyun 			    const struct rtw_table *tbl)
2364*4882a593Smuzhiyun {
2365*4882a593Smuzhiyun 	const struct dpk_cfg_pair *p = tbl->data;
2366*4882a593Smuzhiyun 	const struct dpk_cfg_pair *end = p + tbl->size / 3;
2367*4882a593Smuzhiyun 
2368*4882a593Smuzhiyun 	BUILD_BUG_ON(sizeof(struct dpk_cfg_pair) != sizeof(u32) * 3);
2369*4882a593Smuzhiyun 
2370*4882a593Smuzhiyun 	for (; p < end; p++)
2371*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, p->addr, p->bitmask, p->data);
2372*4882a593Smuzhiyun }
2373*4882a593Smuzhiyun 
rtw8822c_dpk_set_gnt_wl(struct rtw_dev * rtwdev,bool is_before_k)2374*4882a593Smuzhiyun static void rtw8822c_dpk_set_gnt_wl(struct rtw_dev *rtwdev, bool is_before_k)
2375*4882a593Smuzhiyun {
2376*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
2377*4882a593Smuzhiyun 
2378*4882a593Smuzhiyun 	if (is_before_k) {
2379*4882a593Smuzhiyun 		dpk_info->gnt_control = rtw_read32(rtwdev, 0x70);
2380*4882a593Smuzhiyun 		dpk_info->gnt_value = rtw_coex_read_indirect_reg(rtwdev, 0x38);
2381*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, 0x70, BIT(26), 0x1);
2382*4882a593Smuzhiyun 		rtw_coex_write_indirect_reg(rtwdev, 0x38, MASKBYTE1, 0x77);
2383*4882a593Smuzhiyun 	} else {
2384*4882a593Smuzhiyun 		rtw_coex_write_indirect_reg(rtwdev, 0x38, MASKDWORD,
2385*4882a593Smuzhiyun 					    dpk_info->gnt_value);
2386*4882a593Smuzhiyun 		rtw_write32(rtwdev, 0x70, dpk_info->gnt_control);
2387*4882a593Smuzhiyun 	}
2388*4882a593Smuzhiyun }
2389*4882a593Smuzhiyun 
2390*4882a593Smuzhiyun static void
rtw8822c_dpk_restore_registers(struct rtw_dev * rtwdev,u32 reg_num,struct rtw_backup_info * bckp)2391*4882a593Smuzhiyun rtw8822c_dpk_restore_registers(struct rtw_dev *rtwdev, u32 reg_num,
2392*4882a593Smuzhiyun 			       struct rtw_backup_info *bckp)
2393*4882a593Smuzhiyun {
2394*4882a593Smuzhiyun 	rtw_restore_reg(rtwdev, bckp, reg_num);
2395*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc);
2396*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_DPD_CLK, 0x4);
2397*4882a593Smuzhiyun }
2398*4882a593Smuzhiyun 
2399*4882a593Smuzhiyun static void
rtw8822c_dpk_backup_registers(struct rtw_dev * rtwdev,u32 * reg,u32 reg_num,struct rtw_backup_info * bckp)2400*4882a593Smuzhiyun rtw8822c_dpk_backup_registers(struct rtw_dev *rtwdev, u32 *reg,
2401*4882a593Smuzhiyun 			      u32 reg_num, struct rtw_backup_info *bckp)
2402*4882a593Smuzhiyun {
2403*4882a593Smuzhiyun 	u32 i;
2404*4882a593Smuzhiyun 
2405*4882a593Smuzhiyun 	for (i = 0; i < reg_num; i++) {
2406*4882a593Smuzhiyun 		bckp[i].len = 4;
2407*4882a593Smuzhiyun 		bckp[i].reg = reg[i];
2408*4882a593Smuzhiyun 		bckp[i].val = rtw_read32(rtwdev, reg[i]);
2409*4882a593Smuzhiyun 	}
2410*4882a593Smuzhiyun }
2411*4882a593Smuzhiyun 
rtw8822c_dpk_backup_rf_registers(struct rtw_dev * rtwdev,u32 * rf_reg,u32 rf_reg_bak[][2])2412*4882a593Smuzhiyun static void rtw8822c_dpk_backup_rf_registers(struct rtw_dev *rtwdev,
2413*4882a593Smuzhiyun 					     u32 *rf_reg,
2414*4882a593Smuzhiyun 					     u32 rf_reg_bak[][2])
2415*4882a593Smuzhiyun {
2416*4882a593Smuzhiyun 	u32 i;
2417*4882a593Smuzhiyun 
2418*4882a593Smuzhiyun 	for (i = 0; i < DPK_RF_REG_NUM; i++) {
2419*4882a593Smuzhiyun 		rf_reg_bak[i][RF_PATH_A] = rtw_read_rf(rtwdev, RF_PATH_A,
2420*4882a593Smuzhiyun 						       rf_reg[i], RFREG_MASK);
2421*4882a593Smuzhiyun 		rf_reg_bak[i][RF_PATH_B] = rtw_read_rf(rtwdev, RF_PATH_B,
2422*4882a593Smuzhiyun 						       rf_reg[i], RFREG_MASK);
2423*4882a593Smuzhiyun 	}
2424*4882a593Smuzhiyun }
2425*4882a593Smuzhiyun 
rtw8822c_dpk_reload_rf_registers(struct rtw_dev * rtwdev,u32 * rf_reg,u32 rf_reg_bak[][2])2426*4882a593Smuzhiyun static void rtw8822c_dpk_reload_rf_registers(struct rtw_dev *rtwdev,
2427*4882a593Smuzhiyun 					     u32 *rf_reg,
2428*4882a593Smuzhiyun 					     u32 rf_reg_bak[][2])
2429*4882a593Smuzhiyun {
2430*4882a593Smuzhiyun 	u32 i;
2431*4882a593Smuzhiyun 
2432*4882a593Smuzhiyun 	for (i = 0; i < DPK_RF_REG_NUM; i++) {
2433*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_A, rf_reg[i], RFREG_MASK,
2434*4882a593Smuzhiyun 			     rf_reg_bak[i][RF_PATH_A]);
2435*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_B, rf_reg[i], RFREG_MASK,
2436*4882a593Smuzhiyun 			     rf_reg_bak[i][RF_PATH_B]);
2437*4882a593Smuzhiyun 	}
2438*4882a593Smuzhiyun }
2439*4882a593Smuzhiyun 
rtw8822c_dpk_information(struct rtw_dev * rtwdev)2440*4882a593Smuzhiyun static void rtw8822c_dpk_information(struct rtw_dev *rtwdev)
2441*4882a593Smuzhiyun {
2442*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
2443*4882a593Smuzhiyun 	u32  reg;
2444*4882a593Smuzhiyun 	u8 band_shift;
2445*4882a593Smuzhiyun 
2446*4882a593Smuzhiyun 	reg = rtw_read_rf(rtwdev, RF_PATH_A, 0x18, RFREG_MASK);
2447*4882a593Smuzhiyun 
2448*4882a593Smuzhiyun 	band_shift = FIELD_GET(BIT(16), reg);
2449*4882a593Smuzhiyun 	dpk_info->dpk_band = 1 << band_shift;
2450*4882a593Smuzhiyun 	dpk_info->dpk_ch = FIELD_GET(0xff, reg);
2451*4882a593Smuzhiyun 	dpk_info->dpk_bw = FIELD_GET(0x3000, reg);
2452*4882a593Smuzhiyun }
2453*4882a593Smuzhiyun 
rtw8822c_dpk_rxbb_dc_cal(struct rtw_dev * rtwdev,u8 path)2454*4882a593Smuzhiyun static void rtw8822c_dpk_rxbb_dc_cal(struct rtw_dev *rtwdev, u8 path)
2455*4882a593Smuzhiyun {
2456*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, 0x92, RFREG_MASK, 0x84800);
2457*4882a593Smuzhiyun 	udelay(5);
2458*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, 0x92, RFREG_MASK, 0x84801);
2459*4882a593Smuzhiyun 	usleep_range(600, 610);
2460*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, 0x92, RFREG_MASK, 0x84800);
2461*4882a593Smuzhiyun }
2462*4882a593Smuzhiyun 
rtw8822c_dpk_dc_corr_check(struct rtw_dev * rtwdev,u8 path)2463*4882a593Smuzhiyun static u8 rtw8822c_dpk_dc_corr_check(struct rtw_dev *rtwdev, u8 path)
2464*4882a593Smuzhiyun {
2465*4882a593Smuzhiyun 	u16 dc_i, dc_q;
2466*4882a593Smuzhiyun 	u8 corr_val, corr_idx;
2467*4882a593Smuzhiyun 
2468*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x000900f0);
2469*4882a593Smuzhiyun 	dc_i = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(27, 16));
2470*4882a593Smuzhiyun 	dc_q = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(11, 0));
2471*4882a593Smuzhiyun 
2472*4882a593Smuzhiyun 	if (dc_i & BIT(11))
2473*4882a593Smuzhiyun 		dc_i = 0x1000 - dc_i;
2474*4882a593Smuzhiyun 	if (dc_q & BIT(11))
2475*4882a593Smuzhiyun 		dc_q = 0x1000 - dc_q;
2476*4882a593Smuzhiyun 
2477*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x000000f0);
2478*4882a593Smuzhiyun 	corr_idx = (u8)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(7, 0));
2479*4882a593Smuzhiyun 	corr_val = (u8)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(15, 8));
2480*4882a593Smuzhiyun 
2481*4882a593Smuzhiyun 	if (dc_i > 200 || dc_q > 200 || corr_idx < 40 || corr_idx > 65)
2482*4882a593Smuzhiyun 		return 1;
2483*4882a593Smuzhiyun 	else
2484*4882a593Smuzhiyun 		return 0;
2485*4882a593Smuzhiyun 
2486*4882a593Smuzhiyun }
2487*4882a593Smuzhiyun 
rtw8822c_dpk_tx_pause(struct rtw_dev * rtwdev)2488*4882a593Smuzhiyun static void rtw8822c_dpk_tx_pause(struct rtw_dev *rtwdev)
2489*4882a593Smuzhiyun {
2490*4882a593Smuzhiyun 	u8 reg_a, reg_b;
2491*4882a593Smuzhiyun 	u16 count = 0;
2492*4882a593Smuzhiyun 
2493*4882a593Smuzhiyun 	rtw_write8(rtwdev, 0x522, 0xff);
2494*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1e70, 0xf, 0x2);
2495*4882a593Smuzhiyun 
2496*4882a593Smuzhiyun 	do {
2497*4882a593Smuzhiyun 		reg_a = (u8)rtw_read_rf(rtwdev, RF_PATH_A, 0x00, 0xf0000);
2498*4882a593Smuzhiyun 		reg_b = (u8)rtw_read_rf(rtwdev, RF_PATH_B, 0x00, 0xf0000);
2499*4882a593Smuzhiyun 		udelay(2);
2500*4882a593Smuzhiyun 		count++;
2501*4882a593Smuzhiyun 	} while ((reg_a == 2 || reg_b == 2) && count < 2500);
2502*4882a593Smuzhiyun }
2503*4882a593Smuzhiyun 
rtw8822c_dpk_mac_bb_setting(struct rtw_dev * rtwdev)2504*4882a593Smuzhiyun static void rtw8822c_dpk_mac_bb_setting(struct rtw_dev *rtwdev)
2505*4882a593Smuzhiyun {
2506*4882a593Smuzhiyun 	rtw8822c_dpk_tx_pause(rtwdev);
2507*4882a593Smuzhiyun 	rtw_load_table(rtwdev, &rtw8822c_dpk_mac_bb_tbl);
2508*4882a593Smuzhiyun }
2509*4882a593Smuzhiyun 
rtw8822c_dpk_afe_setting(struct rtw_dev * rtwdev,bool is_do_dpk)2510*4882a593Smuzhiyun static void rtw8822c_dpk_afe_setting(struct rtw_dev *rtwdev, bool is_do_dpk)
2511*4882a593Smuzhiyun {
2512*4882a593Smuzhiyun 	if (is_do_dpk)
2513*4882a593Smuzhiyun 		rtw_load_table(rtwdev, &rtw8822c_dpk_afe_is_dpk_tbl);
2514*4882a593Smuzhiyun 	else
2515*4882a593Smuzhiyun 		rtw_load_table(rtwdev, &rtw8822c_dpk_afe_no_dpk_tbl);
2516*4882a593Smuzhiyun }
2517*4882a593Smuzhiyun 
rtw8822c_dpk_pre_setting(struct rtw_dev * rtwdev)2518*4882a593Smuzhiyun static void rtw8822c_dpk_pre_setting(struct rtw_dev *rtwdev)
2519*4882a593Smuzhiyun {
2520*4882a593Smuzhiyun 	u8 path;
2521*4882a593Smuzhiyun 
2522*4882a593Smuzhiyun 	for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
2523*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, RF_RXAGC_OFFSET, RFREG_MASK, 0x0);
2524*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_NCTL0, 0x8 | (path << 1));
2525*4882a593Smuzhiyun 		if (rtwdev->dm_info.dpk_info.dpk_band == RTW_BAND_2G)
2526*4882a593Smuzhiyun 			rtw_write32(rtwdev, REG_DPD_LUT3, 0x1f100000);
2527*4882a593Smuzhiyun 		else
2528*4882a593Smuzhiyun 			rtw_write32(rtwdev, REG_DPD_LUT3, 0x1f0d0000);
2529*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_LUT0, BIT_GLOSS_DB, 0x4);
2530*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x3);
2531*4882a593Smuzhiyun 	}
2532*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc);
2533*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_DPD_CTL11, 0x3b23170b);
2534*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_DPD_CTL12, 0x775f5347);
2535*4882a593Smuzhiyun }
2536*4882a593Smuzhiyun 
rtw8822c_dpk_rf_setting(struct rtw_dev * rtwdev,u8 path)2537*4882a593Smuzhiyun static u32 rtw8822c_dpk_rf_setting(struct rtw_dev *rtwdev, u8 path)
2538*4882a593Smuzhiyun {
2539*4882a593Smuzhiyun 	u32 ori_txbb;
2540*4882a593Smuzhiyun 
2541*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, RFREG_MASK, 0x50017);
2542*4882a593Smuzhiyun 	ori_txbb = rtw_read_rf(rtwdev, path, RF_TX_GAIN, RFREG_MASK);
2543*4882a593Smuzhiyun 
2544*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TX_GAIN, 0x1);
2545*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_PWR_TRIM, 0x1);
2546*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_TX_GAIN_OFFSET, BIT_TX_OFFSET_VAL, 0x0);
2547*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_TX_GAIN, RFREG_MASK, ori_txbb);
2548*4882a593Smuzhiyun 
2549*4882a593Smuzhiyun 	if (rtwdev->dm_info.dpk_info.dpk_band == RTW_BAND_2G) {
2550*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, RF_TX_GAIN_OFFSET, BIT_LB_ATT, 0x1);
2551*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, RF_RXG_GAIN, BIT_RXG_GAIN, 0x0);
2552*4882a593Smuzhiyun 	} else {
2553*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_TXA_LB_ATT, 0x0);
2554*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_LB_ATT, 0x6);
2555*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, RF_TXA_LB_SW, BIT_LB_SW, 0x1);
2556*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, RF_RXA_MIX_GAIN, BIT_RXA_MIX_GAIN, 0);
2557*4882a593Smuzhiyun 	}
2558*4882a593Smuzhiyun 
2559*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_RXAGC, 0xf);
2560*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_DEBUG, BIT_DE_TRXBW, 0x1);
2561*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_RXBB, 0x0);
2562*4882a593Smuzhiyun 
2563*4882a593Smuzhiyun 	if (rtwdev->dm_info.dpk_info.dpk_bw == DPK_CHANNEL_WIDTH_80)
2564*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_TXBB, 0x2);
2565*4882a593Smuzhiyun 	else
2566*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, path, RF_BW_TRXBB, BIT_BW_TXBB, 0x1);
2567*4882a593Smuzhiyun 
2568*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_EXT_TIA_BW, BIT(1), 0x1);
2569*4882a593Smuzhiyun 
2570*4882a593Smuzhiyun 	usleep_range(100, 110);
2571*4882a593Smuzhiyun 
2572*4882a593Smuzhiyun 	return ori_txbb & 0x1f;
2573*4882a593Smuzhiyun }
2574*4882a593Smuzhiyun 
rtw8822c_dpk_get_cmd(struct rtw_dev * rtwdev,u8 action,u8 path)2575*4882a593Smuzhiyun static u16 rtw8822c_dpk_get_cmd(struct rtw_dev *rtwdev, u8 action, u8 path)
2576*4882a593Smuzhiyun {
2577*4882a593Smuzhiyun 	u16 cmd;
2578*4882a593Smuzhiyun 	u8 bw = rtwdev->dm_info.dpk_info.dpk_bw == DPK_CHANNEL_WIDTH_80 ? 2 : 0;
2579*4882a593Smuzhiyun 
2580*4882a593Smuzhiyun 	switch (action) {
2581*4882a593Smuzhiyun 	case RTW_DPK_GAIN_LOSS:
2582*4882a593Smuzhiyun 		cmd = 0x14 + path;
2583*4882a593Smuzhiyun 		break;
2584*4882a593Smuzhiyun 	case RTW_DPK_DO_DPK:
2585*4882a593Smuzhiyun 		cmd = 0x16 + path + bw;
2586*4882a593Smuzhiyun 		break;
2587*4882a593Smuzhiyun 	case RTW_DPK_DPK_ON:
2588*4882a593Smuzhiyun 		cmd = 0x1a + path;
2589*4882a593Smuzhiyun 		break;
2590*4882a593Smuzhiyun 	case RTW_DPK_DAGC:
2591*4882a593Smuzhiyun 		cmd = 0x1c + path + bw;
2592*4882a593Smuzhiyun 		break;
2593*4882a593Smuzhiyun 	default:
2594*4882a593Smuzhiyun 		return 0;
2595*4882a593Smuzhiyun 	}
2596*4882a593Smuzhiyun 
2597*4882a593Smuzhiyun 	return (cmd << 8) | 0x48;
2598*4882a593Smuzhiyun }
2599*4882a593Smuzhiyun 
rtw8822c_dpk_one_shot(struct rtw_dev * rtwdev,u8 path,u8 action)2600*4882a593Smuzhiyun static u8 rtw8822c_dpk_one_shot(struct rtw_dev *rtwdev, u8 path, u8 action)
2601*4882a593Smuzhiyun {
2602*4882a593Smuzhiyun 	u16 dpk_cmd;
2603*4882a593Smuzhiyun 	u8 result = 0;
2604*4882a593Smuzhiyun 
2605*4882a593Smuzhiyun 	rtw8822c_dpk_set_gnt_wl(rtwdev, true);
2606*4882a593Smuzhiyun 
2607*4882a593Smuzhiyun 	if (action == RTW_DPK_CAL_PWR) {
2608*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0, BIT(12), 0x1);
2609*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0, BIT(12), 0x0);
2610*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_RPT_SEL, 0x0);
2611*4882a593Smuzhiyun 		msleep(10);
2612*4882a593Smuzhiyun 		if (!check_hw_ready(rtwdev, REG_STAT_RPT, BIT(31), 0x1)) {
2613*4882a593Smuzhiyun 			result = 1;
2614*4882a593Smuzhiyun 			rtw_dbg(rtwdev, RTW_DBG_RFK, "[DPK] one-shot over 20ms\n");
2615*4882a593Smuzhiyun 		}
2616*4882a593Smuzhiyun 	} else {
2617*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE,
2618*4882a593Smuzhiyun 				 0x8 | (path << 1));
2619*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x9);
2620*4882a593Smuzhiyun 
2621*4882a593Smuzhiyun 		dpk_cmd = rtw8822c_dpk_get_cmd(rtwdev, action, path);
2622*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_NCTL0, dpk_cmd);
2623*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_NCTL0, dpk_cmd + 1);
2624*4882a593Smuzhiyun 		msleep(10);
2625*4882a593Smuzhiyun 		if (!check_hw_ready(rtwdev, 0x2d9c, 0xff, 0x55)) {
2626*4882a593Smuzhiyun 			result = 1;
2627*4882a593Smuzhiyun 			rtw_dbg(rtwdev, RTW_DBG_RFK, "[DPK] one-shot over 20ms\n");
2628*4882a593Smuzhiyun 		}
2629*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE,
2630*4882a593Smuzhiyun 				 0x8 | (path << 1));
2631*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x0);
2632*4882a593Smuzhiyun 	}
2633*4882a593Smuzhiyun 
2634*4882a593Smuzhiyun 	rtw8822c_dpk_set_gnt_wl(rtwdev, false);
2635*4882a593Smuzhiyun 
2636*4882a593Smuzhiyun 	rtw_write8(rtwdev, 0x1b10, 0x0);
2637*4882a593Smuzhiyun 
2638*4882a593Smuzhiyun 	return result;
2639*4882a593Smuzhiyun }
2640*4882a593Smuzhiyun 
rtw8822c_dpk_dgain_read(struct rtw_dev * rtwdev,u8 path)2641*4882a593Smuzhiyun static u16 rtw8822c_dpk_dgain_read(struct rtw_dev *rtwdev, u8 path)
2642*4882a593Smuzhiyun {
2643*4882a593Smuzhiyun 	u16 dgain;
2644*4882a593Smuzhiyun 
2645*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc);
2646*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, 0x00ff0000, 0x0);
2647*4882a593Smuzhiyun 
2648*4882a593Smuzhiyun 	dgain = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, GENMASK(27, 16));
2649*4882a593Smuzhiyun 
2650*4882a593Smuzhiyun 	return dgain;
2651*4882a593Smuzhiyun }
2652*4882a593Smuzhiyun 
rtw8822c_dpk_thermal_read(struct rtw_dev * rtwdev,u8 path)2653*4882a593Smuzhiyun static u8 rtw8822c_dpk_thermal_read(struct rtw_dev *rtwdev, u8 path)
2654*4882a593Smuzhiyun {
2655*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_T_METER, BIT(19), 0x1);
2656*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_T_METER, BIT(19), 0x0);
2657*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_T_METER, BIT(19), 0x1);
2658*4882a593Smuzhiyun 	udelay(15);
2659*4882a593Smuzhiyun 
2660*4882a593Smuzhiyun 	return (u8)rtw_read_rf(rtwdev, path, RF_T_METER, 0x0007e);
2661*4882a593Smuzhiyun }
2662*4882a593Smuzhiyun 
rtw8822c_dpk_pas_read(struct rtw_dev * rtwdev,u8 path)2663*4882a593Smuzhiyun static u32 rtw8822c_dpk_pas_read(struct rtw_dev *rtwdev, u8 path)
2664*4882a593Smuzhiyun {
2665*4882a593Smuzhiyun 	u32 i_val, q_val;
2666*4882a593Smuzhiyun 
2667*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_NCTL0, 0x8 | (path << 1));
2668*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1b48, BIT(14), 0x0);
2669*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x00060001);
2670*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1b4c, 0x00000000);
2671*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1b4c, 0x00080000);
2672*4882a593Smuzhiyun 
2673*4882a593Smuzhiyun 	q_val = rtw_read32_mask(rtwdev, REG_STAT_RPT, MASKHWORD);
2674*4882a593Smuzhiyun 	i_val = rtw_read32_mask(rtwdev, REG_STAT_RPT, MASKLWORD);
2675*4882a593Smuzhiyun 
2676*4882a593Smuzhiyun 	if (i_val & BIT(15))
2677*4882a593Smuzhiyun 		i_val = 0x10000 - i_val;
2678*4882a593Smuzhiyun 	if (q_val & BIT(15))
2679*4882a593Smuzhiyun 		q_val = 0x10000 - q_val;
2680*4882a593Smuzhiyun 
2681*4882a593Smuzhiyun 	rtw_write32(rtwdev, 0x1b4c, 0x00000000);
2682*4882a593Smuzhiyun 
2683*4882a593Smuzhiyun 	return i_val * i_val + q_val * q_val;
2684*4882a593Smuzhiyun }
2685*4882a593Smuzhiyun 
rtw8822c_psd_log2base(u32 val)2686*4882a593Smuzhiyun static u32 rtw8822c_psd_log2base(u32 val)
2687*4882a593Smuzhiyun {
2688*4882a593Smuzhiyun 	u32 tmp, val_integerd_b, tindex;
2689*4882a593Smuzhiyun 	u32 result, val_fractiond_b;
2690*4882a593Smuzhiyun 	u32 table_fraction[21] = {0, 432, 332, 274, 232, 200, 174,
2691*4882a593Smuzhiyun 				  151, 132, 115, 100, 86, 74, 62, 51,
2692*4882a593Smuzhiyun 				  42, 32, 23, 15, 7, 0};
2693*4882a593Smuzhiyun 
2694*4882a593Smuzhiyun 	if (val == 0)
2695*4882a593Smuzhiyun 		return 0;
2696*4882a593Smuzhiyun 
2697*4882a593Smuzhiyun 	val_integerd_b = __fls(val) + 1;
2698*4882a593Smuzhiyun 
2699*4882a593Smuzhiyun 	tmp = (val * 100) / (1 << val_integerd_b);
2700*4882a593Smuzhiyun 	tindex = tmp / 5;
2701*4882a593Smuzhiyun 
2702*4882a593Smuzhiyun 	if (tindex >= ARRAY_SIZE(table_fraction))
2703*4882a593Smuzhiyun 		tindex = ARRAY_SIZE(table_fraction) - 1;
2704*4882a593Smuzhiyun 
2705*4882a593Smuzhiyun 	val_fractiond_b = table_fraction[tindex];
2706*4882a593Smuzhiyun 
2707*4882a593Smuzhiyun 	result = val_integerd_b * 100 - val_fractiond_b;
2708*4882a593Smuzhiyun 
2709*4882a593Smuzhiyun 	return result;
2710*4882a593Smuzhiyun }
2711*4882a593Smuzhiyun 
rtw8822c_dpk_gainloss_result(struct rtw_dev * rtwdev,u8 path)2712*4882a593Smuzhiyun static u8 rtw8822c_dpk_gainloss_result(struct rtw_dev *rtwdev, u8 path)
2713*4882a593Smuzhiyun {
2714*4882a593Smuzhiyun 	u8 result;
2715*4882a593Smuzhiyun 
2716*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1));
2717*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1b48, BIT(14), 0x1);
2718*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x00060000);
2719*4882a593Smuzhiyun 
2720*4882a593Smuzhiyun 	result = (u8)rtw_read32_mask(rtwdev, REG_STAT_RPT, 0x000000f0);
2721*4882a593Smuzhiyun 
2722*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, 0x1b48, BIT(14), 0x0);
2723*4882a593Smuzhiyun 
2724*4882a593Smuzhiyun 	return result;
2725*4882a593Smuzhiyun }
2726*4882a593Smuzhiyun 
rtw8822c_dpk_agc_gain_chk(struct rtw_dev * rtwdev,u8 path,u8 limited_pga)2727*4882a593Smuzhiyun static u8 rtw8822c_dpk_agc_gain_chk(struct rtw_dev *rtwdev, u8 path,
2728*4882a593Smuzhiyun 				    u8 limited_pga)
2729*4882a593Smuzhiyun {
2730*4882a593Smuzhiyun 	u8 result = 0;
2731*4882a593Smuzhiyun 	u16 dgain;
2732*4882a593Smuzhiyun 
2733*4882a593Smuzhiyun 	rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DAGC);
2734*4882a593Smuzhiyun 	dgain = rtw8822c_dpk_dgain_read(rtwdev, path);
2735*4882a593Smuzhiyun 
2736*4882a593Smuzhiyun 	if (dgain > 1535 && !limited_pga)
2737*4882a593Smuzhiyun 		return RTW_DPK_GAIN_LESS;
2738*4882a593Smuzhiyun 	else if (dgain < 768 && !limited_pga)
2739*4882a593Smuzhiyun 		return RTW_DPK_GAIN_LARGE;
2740*4882a593Smuzhiyun 	else
2741*4882a593Smuzhiyun 		return result;
2742*4882a593Smuzhiyun }
2743*4882a593Smuzhiyun 
rtw8822c_dpk_agc_loss_chk(struct rtw_dev * rtwdev,u8 path)2744*4882a593Smuzhiyun static u8 rtw8822c_dpk_agc_loss_chk(struct rtw_dev *rtwdev, u8 path)
2745*4882a593Smuzhiyun {
2746*4882a593Smuzhiyun 	u32 loss, loss_db;
2747*4882a593Smuzhiyun 
2748*4882a593Smuzhiyun 	loss = rtw8822c_dpk_pas_read(rtwdev, path);
2749*4882a593Smuzhiyun 	if (loss < 0x4000000)
2750*4882a593Smuzhiyun 		return RTW_DPK_GL_LESS;
2751*4882a593Smuzhiyun 	loss_db = 3 * rtw8822c_psd_log2base(loss >> 13) - 3870;
2752*4882a593Smuzhiyun 
2753*4882a593Smuzhiyun 	if (loss_db > 1000)
2754*4882a593Smuzhiyun 		return RTW_DPK_GL_LARGE;
2755*4882a593Smuzhiyun 	else if (loss_db < 250)
2756*4882a593Smuzhiyun 		return RTW_DPK_GL_LESS;
2757*4882a593Smuzhiyun 	else
2758*4882a593Smuzhiyun 		return RTW_DPK_AGC_OUT;
2759*4882a593Smuzhiyun }
2760*4882a593Smuzhiyun 
2761*4882a593Smuzhiyun struct rtw8822c_dpk_data {
2762*4882a593Smuzhiyun 	u8 txbb;
2763*4882a593Smuzhiyun 	u8 pga;
2764*4882a593Smuzhiyun 	u8 limited_pga;
2765*4882a593Smuzhiyun 	u8 agc_cnt;
2766*4882a593Smuzhiyun 	bool loss_only;
2767*4882a593Smuzhiyun 	bool gain_only;
2768*4882a593Smuzhiyun 	u8 path;
2769*4882a593Smuzhiyun };
2770*4882a593Smuzhiyun 
rtw8822c_gain_check_state(struct rtw_dev * rtwdev,struct rtw8822c_dpk_data * data)2771*4882a593Smuzhiyun static u8 rtw8822c_gain_check_state(struct rtw_dev *rtwdev,
2772*4882a593Smuzhiyun 				    struct rtw8822c_dpk_data *data)
2773*4882a593Smuzhiyun {
2774*4882a593Smuzhiyun 	u8 state;
2775*4882a593Smuzhiyun 
2776*4882a593Smuzhiyun 	data->txbb = (u8)rtw_read_rf(rtwdev, data->path, RF_TX_GAIN,
2777*4882a593Smuzhiyun 				     BIT_GAIN_TXBB);
2778*4882a593Smuzhiyun 	data->pga = (u8)rtw_read_rf(rtwdev, data->path, RF_MODE_TRXAGC,
2779*4882a593Smuzhiyun 				    BIT_RXAGC);
2780*4882a593Smuzhiyun 
2781*4882a593Smuzhiyun 	if (data->loss_only) {
2782*4882a593Smuzhiyun 		state = RTW_DPK_LOSS_CHECK;
2783*4882a593Smuzhiyun 		goto check_end;
2784*4882a593Smuzhiyun 	}
2785*4882a593Smuzhiyun 
2786*4882a593Smuzhiyun 	state = rtw8822c_dpk_agc_gain_chk(rtwdev, data->path,
2787*4882a593Smuzhiyun 					  data->limited_pga);
2788*4882a593Smuzhiyun 	if (state == RTW_DPK_GAIN_CHECK && data->gain_only)
2789*4882a593Smuzhiyun 		state = RTW_DPK_AGC_OUT;
2790*4882a593Smuzhiyun 	else if (state == RTW_DPK_GAIN_CHECK)
2791*4882a593Smuzhiyun 		state = RTW_DPK_LOSS_CHECK;
2792*4882a593Smuzhiyun 
2793*4882a593Smuzhiyun check_end:
2794*4882a593Smuzhiyun 	data->agc_cnt++;
2795*4882a593Smuzhiyun 	if (data->agc_cnt >= 6)
2796*4882a593Smuzhiyun 		state = RTW_DPK_AGC_OUT;
2797*4882a593Smuzhiyun 
2798*4882a593Smuzhiyun 	return state;
2799*4882a593Smuzhiyun }
2800*4882a593Smuzhiyun 
rtw8822c_gain_large_state(struct rtw_dev * rtwdev,struct rtw8822c_dpk_data * data)2801*4882a593Smuzhiyun static u8 rtw8822c_gain_large_state(struct rtw_dev *rtwdev,
2802*4882a593Smuzhiyun 				    struct rtw8822c_dpk_data *data)
2803*4882a593Smuzhiyun {
2804*4882a593Smuzhiyun 	u8 pga = data->pga;
2805*4882a593Smuzhiyun 
2806*4882a593Smuzhiyun 	if (pga > 0xe)
2807*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, data->path, RF_MODE_TRXAGC, BIT_RXAGC, 0xc);
2808*4882a593Smuzhiyun 	else if (pga > 0xb && pga < 0xf)
2809*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, data->path, RF_MODE_TRXAGC, BIT_RXAGC, 0x0);
2810*4882a593Smuzhiyun 	else if (pga < 0xc)
2811*4882a593Smuzhiyun 		data->limited_pga = 1;
2812*4882a593Smuzhiyun 
2813*4882a593Smuzhiyun 	return RTW_DPK_GAIN_CHECK;
2814*4882a593Smuzhiyun }
2815*4882a593Smuzhiyun 
rtw8822c_gain_less_state(struct rtw_dev * rtwdev,struct rtw8822c_dpk_data * data)2816*4882a593Smuzhiyun static u8 rtw8822c_gain_less_state(struct rtw_dev *rtwdev,
2817*4882a593Smuzhiyun 				   struct rtw8822c_dpk_data *data)
2818*4882a593Smuzhiyun {
2819*4882a593Smuzhiyun 	u8 pga = data->pga;
2820*4882a593Smuzhiyun 
2821*4882a593Smuzhiyun 	if (pga < 0xc)
2822*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, data->path, RF_MODE_TRXAGC, BIT_RXAGC, 0xc);
2823*4882a593Smuzhiyun 	else if (pga > 0xb && pga < 0xf)
2824*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, data->path, RF_MODE_TRXAGC, BIT_RXAGC, 0xf);
2825*4882a593Smuzhiyun 	else if (pga > 0xe)
2826*4882a593Smuzhiyun 		data->limited_pga = 1;
2827*4882a593Smuzhiyun 
2828*4882a593Smuzhiyun 	return RTW_DPK_GAIN_CHECK;
2829*4882a593Smuzhiyun }
2830*4882a593Smuzhiyun 
rtw8822c_gl_state(struct rtw_dev * rtwdev,struct rtw8822c_dpk_data * data,u8 is_large)2831*4882a593Smuzhiyun static u8 rtw8822c_gl_state(struct rtw_dev *rtwdev,
2832*4882a593Smuzhiyun 			    struct rtw8822c_dpk_data *data, u8 is_large)
2833*4882a593Smuzhiyun {
2834*4882a593Smuzhiyun 	u8 txbb_bound[] = {0x1f, 0};
2835*4882a593Smuzhiyun 
2836*4882a593Smuzhiyun 	if (data->txbb == txbb_bound[is_large])
2837*4882a593Smuzhiyun 		return RTW_DPK_AGC_OUT;
2838*4882a593Smuzhiyun 
2839*4882a593Smuzhiyun 	if (is_large == 1)
2840*4882a593Smuzhiyun 		data->txbb -= 2;
2841*4882a593Smuzhiyun 	else
2842*4882a593Smuzhiyun 		data->txbb += 3;
2843*4882a593Smuzhiyun 
2844*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, data->path, RF_TX_GAIN, BIT_GAIN_TXBB, data->txbb);
2845*4882a593Smuzhiyun 	data->limited_pga = 0;
2846*4882a593Smuzhiyun 
2847*4882a593Smuzhiyun 	return RTW_DPK_GAIN_CHECK;
2848*4882a593Smuzhiyun }
2849*4882a593Smuzhiyun 
rtw8822c_gl_large_state(struct rtw_dev * rtwdev,struct rtw8822c_dpk_data * data)2850*4882a593Smuzhiyun static u8 rtw8822c_gl_large_state(struct rtw_dev *rtwdev,
2851*4882a593Smuzhiyun 				  struct rtw8822c_dpk_data *data)
2852*4882a593Smuzhiyun {
2853*4882a593Smuzhiyun 	return rtw8822c_gl_state(rtwdev, data, 1);
2854*4882a593Smuzhiyun }
2855*4882a593Smuzhiyun 
rtw8822c_gl_less_state(struct rtw_dev * rtwdev,struct rtw8822c_dpk_data * data)2856*4882a593Smuzhiyun static u8 rtw8822c_gl_less_state(struct rtw_dev *rtwdev,
2857*4882a593Smuzhiyun 				 struct rtw8822c_dpk_data *data)
2858*4882a593Smuzhiyun {
2859*4882a593Smuzhiyun 	return rtw8822c_gl_state(rtwdev, data, 0);
2860*4882a593Smuzhiyun }
2861*4882a593Smuzhiyun 
rtw8822c_loss_check_state(struct rtw_dev * rtwdev,struct rtw8822c_dpk_data * data)2862*4882a593Smuzhiyun static u8 rtw8822c_loss_check_state(struct rtw_dev *rtwdev,
2863*4882a593Smuzhiyun 				    struct rtw8822c_dpk_data *data)
2864*4882a593Smuzhiyun {
2865*4882a593Smuzhiyun 	u8 path = data->path;
2866*4882a593Smuzhiyun 	u8 state;
2867*4882a593Smuzhiyun 
2868*4882a593Smuzhiyun 	rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_GAIN_LOSS);
2869*4882a593Smuzhiyun 	state = rtw8822c_dpk_agc_loss_chk(rtwdev, path);
2870*4882a593Smuzhiyun 
2871*4882a593Smuzhiyun 	return state;
2872*4882a593Smuzhiyun }
2873*4882a593Smuzhiyun 
2874*4882a593Smuzhiyun static u8 (*dpk_state[])(struct rtw_dev *rtwdev,
2875*4882a593Smuzhiyun 			  struct rtw8822c_dpk_data *data) = {
2876*4882a593Smuzhiyun 	rtw8822c_gain_check_state, rtw8822c_gain_large_state,
2877*4882a593Smuzhiyun 	rtw8822c_gain_less_state, rtw8822c_gl_large_state,
2878*4882a593Smuzhiyun 	rtw8822c_gl_less_state, rtw8822c_loss_check_state };
2879*4882a593Smuzhiyun 
rtw8822c_dpk_pas_agc(struct rtw_dev * rtwdev,u8 path,bool gain_only,bool loss_only)2880*4882a593Smuzhiyun static u8 rtw8822c_dpk_pas_agc(struct rtw_dev *rtwdev, u8 path,
2881*4882a593Smuzhiyun 			       bool gain_only, bool loss_only)
2882*4882a593Smuzhiyun {
2883*4882a593Smuzhiyun 	struct rtw8822c_dpk_data data = {0};
2884*4882a593Smuzhiyun 	u8 (*func)(struct rtw_dev *rtwdev, struct rtw8822c_dpk_data *data);
2885*4882a593Smuzhiyun 	u8 state = RTW_DPK_GAIN_CHECK;
2886*4882a593Smuzhiyun 
2887*4882a593Smuzhiyun 	data.loss_only = loss_only;
2888*4882a593Smuzhiyun 	data.gain_only = gain_only;
2889*4882a593Smuzhiyun 	data.path = path;
2890*4882a593Smuzhiyun 
2891*4882a593Smuzhiyun 	for (;;) {
2892*4882a593Smuzhiyun 		func = dpk_state[state];
2893*4882a593Smuzhiyun 		state = func(rtwdev, &data);
2894*4882a593Smuzhiyun 		if (state == RTW_DPK_AGC_OUT)
2895*4882a593Smuzhiyun 			break;
2896*4882a593Smuzhiyun 	}
2897*4882a593Smuzhiyun 
2898*4882a593Smuzhiyun 	return data.txbb;
2899*4882a593Smuzhiyun }
2900*4882a593Smuzhiyun 
rtw8822c_dpk_coef_iq_check(struct rtw_dev * rtwdev,u16 coef_i,u16 coef_q)2901*4882a593Smuzhiyun static bool rtw8822c_dpk_coef_iq_check(struct rtw_dev *rtwdev,
2902*4882a593Smuzhiyun 				       u16 coef_i, u16 coef_q)
2903*4882a593Smuzhiyun {
2904*4882a593Smuzhiyun 	if (coef_i == 0x1000 || coef_i == 0x0fff ||
2905*4882a593Smuzhiyun 	    coef_q == 0x1000 || coef_q == 0x0fff)
2906*4882a593Smuzhiyun 		return true;
2907*4882a593Smuzhiyun 
2908*4882a593Smuzhiyun 	return false;
2909*4882a593Smuzhiyun }
2910*4882a593Smuzhiyun 
rtw8822c_dpk_coef_transfer(struct rtw_dev * rtwdev)2911*4882a593Smuzhiyun static u32 rtw8822c_dpk_coef_transfer(struct rtw_dev *rtwdev)
2912*4882a593Smuzhiyun {
2913*4882a593Smuzhiyun 	u32 reg = 0;
2914*4882a593Smuzhiyun 	u16 coef_i = 0, coef_q = 0;
2915*4882a593Smuzhiyun 
2916*4882a593Smuzhiyun 	reg = rtw_read32(rtwdev, REG_STAT_RPT);
2917*4882a593Smuzhiyun 
2918*4882a593Smuzhiyun 	coef_i = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, MASKHWORD) & 0x1fff;
2919*4882a593Smuzhiyun 	coef_q = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, MASKLWORD) & 0x1fff;
2920*4882a593Smuzhiyun 
2921*4882a593Smuzhiyun 	coef_q = ((0x2000 - coef_q) & 0x1fff) - 1;
2922*4882a593Smuzhiyun 
2923*4882a593Smuzhiyun 	reg = (coef_i << 16) | coef_q;
2924*4882a593Smuzhiyun 
2925*4882a593Smuzhiyun 	return reg;
2926*4882a593Smuzhiyun }
2927*4882a593Smuzhiyun 
2928*4882a593Smuzhiyun static const u32 rtw8822c_dpk_get_coef_tbl[] = {
2929*4882a593Smuzhiyun 	0x000400f0, 0x040400f0, 0x080400f0, 0x010400f0, 0x050400f0,
2930*4882a593Smuzhiyun 	0x090400f0, 0x020400f0, 0x060400f0, 0x0a0400f0, 0x030400f0,
2931*4882a593Smuzhiyun 	0x070400f0, 0x0b0400f0, 0x0c0400f0, 0x100400f0, 0x0d0400f0,
2932*4882a593Smuzhiyun 	0x110400f0, 0x0e0400f0, 0x120400f0, 0x0f0400f0, 0x130400f0,
2933*4882a593Smuzhiyun };
2934*4882a593Smuzhiyun 
rtw8822c_dpk_coef_tbl_apply(struct rtw_dev * rtwdev,u8 path)2935*4882a593Smuzhiyun static void rtw8822c_dpk_coef_tbl_apply(struct rtw_dev *rtwdev, u8 path)
2936*4882a593Smuzhiyun {
2937*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
2938*4882a593Smuzhiyun 	int i;
2939*4882a593Smuzhiyun 
2940*4882a593Smuzhiyun 	for (i = 0; i < 20; i++) {
2941*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_RXSRAM_CTL,
2942*4882a593Smuzhiyun 			    rtw8822c_dpk_get_coef_tbl[i]);
2943*4882a593Smuzhiyun 		dpk_info->coef[path][i] = rtw8822c_dpk_coef_transfer(rtwdev);
2944*4882a593Smuzhiyun 	}
2945*4882a593Smuzhiyun }
2946*4882a593Smuzhiyun 
rtw8822c_dpk_get_coef(struct rtw_dev * rtwdev,u8 path)2947*4882a593Smuzhiyun static void rtw8822c_dpk_get_coef(struct rtw_dev *rtwdev, u8 path)
2948*4882a593Smuzhiyun {
2949*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_NCTL0, 0x0000000c);
2950*4882a593Smuzhiyun 
2951*4882a593Smuzhiyun 	if (path == RF_PATH_A) {
2952*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0, BIT(24), 0x0);
2953*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL0_S0, 0x30000080);
2954*4882a593Smuzhiyun 	} else if (path == RF_PATH_B) {
2955*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0, BIT(24), 0x1);
2956*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL0_S1, 0x30000080);
2957*4882a593Smuzhiyun 	}
2958*4882a593Smuzhiyun 
2959*4882a593Smuzhiyun 	rtw8822c_dpk_coef_tbl_apply(rtwdev, path);
2960*4882a593Smuzhiyun }
2961*4882a593Smuzhiyun 
rtw8822c_dpk_coef_read(struct rtw_dev * rtwdev,u8 path)2962*4882a593Smuzhiyun static u8 rtw8822c_dpk_coef_read(struct rtw_dev *rtwdev, u8 path)
2963*4882a593Smuzhiyun {
2964*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
2965*4882a593Smuzhiyun 	u8 addr, result = 1;
2966*4882a593Smuzhiyun 	u16 coef_i, coef_q;
2967*4882a593Smuzhiyun 
2968*4882a593Smuzhiyun 	for (addr = 0; addr < 20; addr++) {
2969*4882a593Smuzhiyun 		coef_i = FIELD_GET(0x1fff0000, dpk_info->coef[path][addr]);
2970*4882a593Smuzhiyun 		coef_q = FIELD_GET(0x1fff, dpk_info->coef[path][addr]);
2971*4882a593Smuzhiyun 
2972*4882a593Smuzhiyun 		if (rtw8822c_dpk_coef_iq_check(rtwdev, coef_i, coef_q)) {
2973*4882a593Smuzhiyun 			result = 0;
2974*4882a593Smuzhiyun 			break;
2975*4882a593Smuzhiyun 		}
2976*4882a593Smuzhiyun 	}
2977*4882a593Smuzhiyun 	return result;
2978*4882a593Smuzhiyun }
2979*4882a593Smuzhiyun 
rtw8822c_dpk_coef_write(struct rtw_dev * rtwdev,u8 path,u8 result)2980*4882a593Smuzhiyun static void rtw8822c_dpk_coef_write(struct rtw_dev *rtwdev, u8 path, u8 result)
2981*4882a593Smuzhiyun {
2982*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
2983*4882a593Smuzhiyun 	u16 reg[DPK_RF_PATH_NUM] = {0x1b0c, 0x1b64};
2984*4882a593Smuzhiyun 	u32 coef;
2985*4882a593Smuzhiyun 	u8 addr;
2986*4882a593Smuzhiyun 
2987*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_NCTL0, 0x0000000c);
2988*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x000000f0);
2989*4882a593Smuzhiyun 
2990*4882a593Smuzhiyun 	for (addr = 0; addr < 20; addr++) {
2991*4882a593Smuzhiyun 		if (result == 0) {
2992*4882a593Smuzhiyun 			if (addr == 3)
2993*4882a593Smuzhiyun 				coef = 0x04001fff;
2994*4882a593Smuzhiyun 			else
2995*4882a593Smuzhiyun 				coef = 0x00001fff;
2996*4882a593Smuzhiyun 		} else {
2997*4882a593Smuzhiyun 			coef = dpk_info->coef[path][addr];
2998*4882a593Smuzhiyun 		}
2999*4882a593Smuzhiyun 		rtw_write32(rtwdev, reg[path] + addr * 4, coef);
3000*4882a593Smuzhiyun 	}
3001*4882a593Smuzhiyun }
3002*4882a593Smuzhiyun 
rtw8822c_dpk_fill_result(struct rtw_dev * rtwdev,u32 dpk_txagc,u8 path,u8 result)3003*4882a593Smuzhiyun static void rtw8822c_dpk_fill_result(struct rtw_dev *rtwdev, u32 dpk_txagc,
3004*4882a593Smuzhiyun 				     u8 path, u8 result)
3005*4882a593Smuzhiyun {
3006*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3007*4882a593Smuzhiyun 
3008*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1));
3009*4882a593Smuzhiyun 
3010*4882a593Smuzhiyun 	if (result)
3011*4882a593Smuzhiyun 		rtw_write8(rtwdev, REG_DPD_AGC, (u8)(dpk_txagc - 6));
3012*4882a593Smuzhiyun 	else
3013*4882a593Smuzhiyun 		rtw_write8(rtwdev, REG_DPD_AGC, 0x00);
3014*4882a593Smuzhiyun 
3015*4882a593Smuzhiyun 	dpk_info->result[path] = result;
3016*4882a593Smuzhiyun 	dpk_info->dpk_txagc[path] = rtw_read8(rtwdev, REG_DPD_AGC);
3017*4882a593Smuzhiyun 
3018*4882a593Smuzhiyun 	rtw8822c_dpk_coef_write(rtwdev, path, result);
3019*4882a593Smuzhiyun }
3020*4882a593Smuzhiyun 
rtw8822c_dpk_gainloss(struct rtw_dev * rtwdev,u8 path)3021*4882a593Smuzhiyun static u32 rtw8822c_dpk_gainloss(struct rtw_dev *rtwdev, u8 path)
3022*4882a593Smuzhiyun {
3023*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3024*4882a593Smuzhiyun 	u8 tx_agc, tx_bb, ori_txbb, ori_txagc, tx_agc_search, t1, t2;
3025*4882a593Smuzhiyun 
3026*4882a593Smuzhiyun 	ori_txbb = rtw8822c_dpk_rf_setting(rtwdev, path);
3027*4882a593Smuzhiyun 	ori_txagc = (u8)rtw_read_rf(rtwdev, path, RF_MODE_TRXAGC, BIT_TXAGC);
3028*4882a593Smuzhiyun 
3029*4882a593Smuzhiyun 	rtw8822c_dpk_rxbb_dc_cal(rtwdev, path);
3030*4882a593Smuzhiyun 	rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DAGC);
3031*4882a593Smuzhiyun 	rtw8822c_dpk_dgain_read(rtwdev, path);
3032*4882a593Smuzhiyun 
3033*4882a593Smuzhiyun 	if (rtw8822c_dpk_dc_corr_check(rtwdev, path)) {
3034*4882a593Smuzhiyun 		rtw8822c_dpk_rxbb_dc_cal(rtwdev, path);
3035*4882a593Smuzhiyun 		rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DAGC);
3036*4882a593Smuzhiyun 		rtw8822c_dpk_dc_corr_check(rtwdev, path);
3037*4882a593Smuzhiyun 	}
3038*4882a593Smuzhiyun 
3039*4882a593Smuzhiyun 	t1 = rtw8822c_dpk_thermal_read(rtwdev, path);
3040*4882a593Smuzhiyun 	tx_bb = rtw8822c_dpk_pas_agc(rtwdev, path, false, true);
3041*4882a593Smuzhiyun 	tx_agc_search = rtw8822c_dpk_gainloss_result(rtwdev, path);
3042*4882a593Smuzhiyun 
3043*4882a593Smuzhiyun 	if (tx_bb < tx_agc_search)
3044*4882a593Smuzhiyun 		tx_bb = 0;
3045*4882a593Smuzhiyun 	else
3046*4882a593Smuzhiyun 		tx_bb = tx_bb - tx_agc_search;
3047*4882a593Smuzhiyun 
3048*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_TX_GAIN, BIT_GAIN_TXBB, tx_bb);
3049*4882a593Smuzhiyun 
3050*4882a593Smuzhiyun 	tx_agc = ori_txagc - (ori_txbb - tx_bb);
3051*4882a593Smuzhiyun 
3052*4882a593Smuzhiyun 	t2 = rtw8822c_dpk_thermal_read(rtwdev, path);
3053*4882a593Smuzhiyun 
3054*4882a593Smuzhiyun 	dpk_info->thermal_dpk_delta[path] = abs(t2 - t1);
3055*4882a593Smuzhiyun 
3056*4882a593Smuzhiyun 	return tx_agc;
3057*4882a593Smuzhiyun }
3058*4882a593Smuzhiyun 
rtw8822c_dpk_by_path(struct rtw_dev * rtwdev,u32 tx_agc,u8 path)3059*4882a593Smuzhiyun static u8 rtw8822c_dpk_by_path(struct rtw_dev *rtwdev, u32 tx_agc, u8 path)
3060*4882a593Smuzhiyun {
3061*4882a593Smuzhiyun 	u8 result;
3062*4882a593Smuzhiyun 
3063*4882a593Smuzhiyun 	result = rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DO_DPK);
3064*4882a593Smuzhiyun 
3065*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1));
3066*4882a593Smuzhiyun 
3067*4882a593Smuzhiyun 	result = result | (u8)rtw_read32_mask(rtwdev, REG_DPD_CTL1_S0, BIT(26));
3068*4882a593Smuzhiyun 
3069*4882a593Smuzhiyun 	rtw_write_rf(rtwdev, path, RF_MODE_TRXAGC, RFREG_MASK, 0x33e14);
3070*4882a593Smuzhiyun 
3071*4882a593Smuzhiyun 	rtw8822c_dpk_get_coef(rtwdev, path);
3072*4882a593Smuzhiyun 
3073*4882a593Smuzhiyun 	return result;
3074*4882a593Smuzhiyun }
3075*4882a593Smuzhiyun 
rtw8822c_dpk_cal_gs(struct rtw_dev * rtwdev,u8 path)3076*4882a593Smuzhiyun static void rtw8822c_dpk_cal_gs(struct rtw_dev *rtwdev, u8 path)
3077*4882a593Smuzhiyun {
3078*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3079*4882a593Smuzhiyun 	u32 tmp_gs = 0;
3080*4882a593Smuzhiyun 
3081*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1));
3082*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_BYPASS_DPD, 0x0);
3083*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0);
3084*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x9);
3085*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_INNER_LB, 0x1);
3086*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc);
3087*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_DPD_CLK, 0xf);
3088*4882a593Smuzhiyun 
3089*4882a593Smuzhiyun 	if (path == RF_PATH_A) {
3090*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0, BIT_GS_PWSF,
3091*4882a593Smuzhiyun 				 0x1066680);
3092*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL1_S0, BIT_DPD_EN, 0x1);
3093*4882a593Smuzhiyun 	} else {
3094*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0_S1, BIT_GS_PWSF,
3095*4882a593Smuzhiyun 				 0x1066680);
3096*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL1_S1, BIT_DPD_EN, 0x1);
3097*4882a593Smuzhiyun 	}
3098*4882a593Smuzhiyun 
3099*4882a593Smuzhiyun 	if (dpk_info->dpk_bw == DPK_CHANNEL_WIDTH_80) {
3100*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL16, 0x80001310);
3101*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL16, 0x00001310);
3102*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL16, 0x810000db);
3103*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL16, 0x010000db);
3104*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL16, 0x0000b428);
3105*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL15,
3106*4882a593Smuzhiyun 			    0x05020000 | (BIT(path) << 28));
3107*4882a593Smuzhiyun 	} else {
3108*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL16, 0x8200190c);
3109*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL16, 0x0200190c);
3110*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL16, 0x8301ee14);
3111*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL16, 0x0301ee14);
3112*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL16, 0x0000b428);
3113*4882a593Smuzhiyun 		rtw_write32(rtwdev, REG_DPD_CTL15,
3114*4882a593Smuzhiyun 			    0x05020008 | (BIT(path) << 28));
3115*4882a593Smuzhiyun 	}
3116*4882a593Smuzhiyun 
3117*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DPD_CTL0, MASKBYTE3, 0x8 | path);
3118*4882a593Smuzhiyun 
3119*4882a593Smuzhiyun 	rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_CAL_PWR);
3120*4882a593Smuzhiyun 
3121*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DPD_CTL15, MASKBYTE3, 0x0);
3122*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1));
3123*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_IQ_SWITCH, 0x0);
3124*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_R_CONFIG, BIT_INNER_LB, 0x0);
3125*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc);
3126*4882a593Smuzhiyun 
3127*4882a593Smuzhiyun 	if (path == RF_PATH_A)
3128*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0, BIT_GS_PWSF, 0x5b);
3129*4882a593Smuzhiyun 	else
3130*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0_S1, BIT_GS_PWSF, 0x5b);
3131*4882a593Smuzhiyun 
3132*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_RXSRAM_CTL, BIT_RPT_SEL, 0x0);
3133*4882a593Smuzhiyun 
3134*4882a593Smuzhiyun 	tmp_gs = (u16)rtw_read32_mask(rtwdev, REG_STAT_RPT, BIT_RPT_DGAIN);
3135*4882a593Smuzhiyun 	tmp_gs = (tmp_gs * 910) >> 10;
3136*4882a593Smuzhiyun 	tmp_gs = DIV_ROUND_CLOSEST(tmp_gs, 10);
3137*4882a593Smuzhiyun 
3138*4882a593Smuzhiyun 	if (path == RF_PATH_A)
3139*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0, BIT_GS_PWSF, tmp_gs);
3140*4882a593Smuzhiyun 	else
3141*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0_S1, BIT_GS_PWSF, tmp_gs);
3142*4882a593Smuzhiyun 
3143*4882a593Smuzhiyun 	dpk_info->dpk_gs[path] = tmp_gs;
3144*4882a593Smuzhiyun }
3145*4882a593Smuzhiyun 
rtw8822c_dpk_cal_coef1(struct rtw_dev * rtwdev)3146*4882a593Smuzhiyun static void rtw8822c_dpk_cal_coef1(struct rtw_dev *rtwdev)
3147*4882a593Smuzhiyun {
3148*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3149*4882a593Smuzhiyun 	u32 offset[DPK_RF_PATH_NUM] = {0, 0x58};
3150*4882a593Smuzhiyun 	u32 i_scaling;
3151*4882a593Smuzhiyun 	u8 path;
3152*4882a593Smuzhiyun 
3153*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x0000000c);
3154*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_RXSRAM_CTL, 0x000000f0);
3155*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_NCTL0, 0x00001148);
3156*4882a593Smuzhiyun 	rtw_write32(rtwdev, REG_NCTL0, 0x00001149);
3157*4882a593Smuzhiyun 
3158*4882a593Smuzhiyun 	check_hw_ready(rtwdev, 0x2d9c, MASKBYTE0, 0x55);
3159*4882a593Smuzhiyun 
3160*4882a593Smuzhiyun 	rtw_write8(rtwdev, 0x1b10, 0x0);
3161*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x0000000c);
3162*4882a593Smuzhiyun 
3163*4882a593Smuzhiyun 	for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
3164*4882a593Smuzhiyun 		i_scaling = 0x16c00 / dpk_info->dpk_gs[path];
3165*4882a593Smuzhiyun 
3166*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, 0x1b18 + offset[path], MASKHWORD,
3167*4882a593Smuzhiyun 				 i_scaling);
3168*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0 + offset[path],
3169*4882a593Smuzhiyun 				 GENMASK(31, 28), 0x9);
3170*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0 + offset[path],
3171*4882a593Smuzhiyun 				 GENMASK(31, 28), 0x1);
3172*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0 + offset[path],
3173*4882a593Smuzhiyun 				 GENMASK(31, 28), 0x0);
3174*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL1_S0 + offset[path],
3175*4882a593Smuzhiyun 				 BIT(14), 0x0);
3176*4882a593Smuzhiyun 	}
3177*4882a593Smuzhiyun }
3178*4882a593Smuzhiyun 
rtw8822c_dpk_on(struct rtw_dev * rtwdev,u8 path)3179*4882a593Smuzhiyun static void rtw8822c_dpk_on(struct rtw_dev *rtwdev, u8 path)
3180*4882a593Smuzhiyun {
3181*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3182*4882a593Smuzhiyun 
3183*4882a593Smuzhiyun 	rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DPK_ON);
3184*4882a593Smuzhiyun 
3185*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0x8 | (path << 1));
3186*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_IQK_CTL1, BIT_TX_CFIR, 0x0);
3187*4882a593Smuzhiyun 
3188*4882a593Smuzhiyun 	if (test_bit(path, dpk_info->dpk_path_ok))
3189*4882a593Smuzhiyun 		rtw8822c_dpk_cal_gs(rtwdev, path);
3190*4882a593Smuzhiyun }
3191*4882a593Smuzhiyun 
rtw8822c_dpk_check_pass(struct rtw_dev * rtwdev,bool is_fail,u32 dpk_txagc,u8 path)3192*4882a593Smuzhiyun static bool rtw8822c_dpk_check_pass(struct rtw_dev *rtwdev, bool is_fail,
3193*4882a593Smuzhiyun 				    u32 dpk_txagc, u8 path)
3194*4882a593Smuzhiyun {
3195*4882a593Smuzhiyun 	bool result;
3196*4882a593Smuzhiyun 
3197*4882a593Smuzhiyun 	if (!is_fail) {
3198*4882a593Smuzhiyun 		if (rtw8822c_dpk_coef_read(rtwdev, path))
3199*4882a593Smuzhiyun 			result = true;
3200*4882a593Smuzhiyun 		else
3201*4882a593Smuzhiyun 			result = false;
3202*4882a593Smuzhiyun 	} else {
3203*4882a593Smuzhiyun 		result = false;
3204*4882a593Smuzhiyun 	}
3205*4882a593Smuzhiyun 
3206*4882a593Smuzhiyun 	rtw8822c_dpk_fill_result(rtwdev, dpk_txagc, path, result);
3207*4882a593Smuzhiyun 
3208*4882a593Smuzhiyun 	return result;
3209*4882a593Smuzhiyun }
3210*4882a593Smuzhiyun 
rtw8822c_dpk_result_reset(struct rtw_dev * rtwdev)3211*4882a593Smuzhiyun static void rtw8822c_dpk_result_reset(struct rtw_dev *rtwdev)
3212*4882a593Smuzhiyun {
3213*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3214*4882a593Smuzhiyun 	u8 path;
3215*4882a593Smuzhiyun 
3216*4882a593Smuzhiyun 	for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
3217*4882a593Smuzhiyun 		clear_bit(path, dpk_info->dpk_path_ok);
3218*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE,
3219*4882a593Smuzhiyun 				 0x8 | (path << 1));
3220*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, 0x1b58, 0x0000007f, 0x0);
3221*4882a593Smuzhiyun 
3222*4882a593Smuzhiyun 		dpk_info->dpk_txagc[path] = 0;
3223*4882a593Smuzhiyun 		dpk_info->result[path] = 0;
3224*4882a593Smuzhiyun 		dpk_info->dpk_gs[path] = 0x5b;
3225*4882a593Smuzhiyun 		dpk_info->pre_pwsf[path] = 0;
3226*4882a593Smuzhiyun 		dpk_info->thermal_dpk[path] = rtw8822c_dpk_thermal_read(rtwdev,
3227*4882a593Smuzhiyun 									path);
3228*4882a593Smuzhiyun 	}
3229*4882a593Smuzhiyun }
3230*4882a593Smuzhiyun 
rtw8822c_dpk_calibrate(struct rtw_dev * rtwdev,u8 path)3231*4882a593Smuzhiyun static void rtw8822c_dpk_calibrate(struct rtw_dev *rtwdev, u8 path)
3232*4882a593Smuzhiyun {
3233*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3234*4882a593Smuzhiyun 	u32 dpk_txagc;
3235*4882a593Smuzhiyun 	u8 dpk_fail;
3236*4882a593Smuzhiyun 
3237*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "[DPK] s%d dpk start\n", path);
3238*4882a593Smuzhiyun 
3239*4882a593Smuzhiyun 	dpk_txagc = rtw8822c_dpk_gainloss(rtwdev, path);
3240*4882a593Smuzhiyun 
3241*4882a593Smuzhiyun 	dpk_fail = rtw8822c_dpk_by_path(rtwdev, dpk_txagc, path);
3242*4882a593Smuzhiyun 
3243*4882a593Smuzhiyun 	if (!rtw8822c_dpk_check_pass(rtwdev, dpk_fail, dpk_txagc, path))
3244*4882a593Smuzhiyun 		rtw_err(rtwdev, "failed to do dpk calibration\n");
3245*4882a593Smuzhiyun 
3246*4882a593Smuzhiyun 	rtw_dbg(rtwdev, RTW_DBG_RFK, "[DPK] s%d dpk finish\n", path);
3247*4882a593Smuzhiyun 
3248*4882a593Smuzhiyun 	if (dpk_info->result[path])
3249*4882a593Smuzhiyun 		set_bit(path, dpk_info->dpk_path_ok);
3250*4882a593Smuzhiyun }
3251*4882a593Smuzhiyun 
rtw8822c_dpk_path_select(struct rtw_dev * rtwdev)3252*4882a593Smuzhiyun static void rtw8822c_dpk_path_select(struct rtw_dev *rtwdev)
3253*4882a593Smuzhiyun {
3254*4882a593Smuzhiyun 	rtw8822c_dpk_calibrate(rtwdev, RF_PATH_A);
3255*4882a593Smuzhiyun 	rtw8822c_dpk_calibrate(rtwdev, RF_PATH_B);
3256*4882a593Smuzhiyun 	rtw8822c_dpk_on(rtwdev, RF_PATH_A);
3257*4882a593Smuzhiyun 	rtw8822c_dpk_on(rtwdev, RF_PATH_B);
3258*4882a593Smuzhiyun 	rtw8822c_dpk_cal_coef1(rtwdev);
3259*4882a593Smuzhiyun }
3260*4882a593Smuzhiyun 
rtw8822c_dpk_enable_disable(struct rtw_dev * rtwdev)3261*4882a593Smuzhiyun static void rtw8822c_dpk_enable_disable(struct rtw_dev *rtwdev)
3262*4882a593Smuzhiyun {
3263*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3264*4882a593Smuzhiyun 	u32 mask = BIT(15) | BIT(14);
3265*4882a593Smuzhiyun 
3266*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc);
3267*4882a593Smuzhiyun 
3268*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DPD_CTL1_S0, BIT_DPD_EN,
3269*4882a593Smuzhiyun 			 dpk_info->is_dpk_pwr_on);
3270*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev, REG_DPD_CTL1_S1, BIT_DPD_EN,
3271*4882a593Smuzhiyun 			 dpk_info->is_dpk_pwr_on);
3272*4882a593Smuzhiyun 
3273*4882a593Smuzhiyun 	if (test_bit(RF_PATH_A, dpk_info->dpk_path_ok)) {
3274*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL1_S0, mask, 0x0);
3275*4882a593Smuzhiyun 		rtw_write8(rtwdev, REG_DPD_CTL0_S0, dpk_info->dpk_gs[RF_PATH_A]);
3276*4882a593Smuzhiyun 	}
3277*4882a593Smuzhiyun 	if (test_bit(RF_PATH_B, dpk_info->dpk_path_ok)) {
3278*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_DPD_CTL1_S1, mask, 0x0);
3279*4882a593Smuzhiyun 		rtw_write8(rtwdev, REG_DPD_CTL0_S1, dpk_info->dpk_gs[RF_PATH_B]);
3280*4882a593Smuzhiyun 	}
3281*4882a593Smuzhiyun }
3282*4882a593Smuzhiyun 
rtw8822c_dpk_reload_data(struct rtw_dev * rtwdev)3283*4882a593Smuzhiyun static void rtw8822c_dpk_reload_data(struct rtw_dev *rtwdev)
3284*4882a593Smuzhiyun {
3285*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3286*4882a593Smuzhiyun 	u8 path;
3287*4882a593Smuzhiyun 
3288*4882a593Smuzhiyun 	if (!test_bit(RF_PATH_A, dpk_info->dpk_path_ok) &&
3289*4882a593Smuzhiyun 	    !test_bit(RF_PATH_B, dpk_info->dpk_path_ok) &&
3290*4882a593Smuzhiyun 	    dpk_info->dpk_ch == 0)
3291*4882a593Smuzhiyun 		return;
3292*4882a593Smuzhiyun 
3293*4882a593Smuzhiyun 	for (path = 0; path < rtwdev->hal.rf_path_num; path++) {
3294*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE,
3295*4882a593Smuzhiyun 				 0x8 | (path << 1));
3296*4882a593Smuzhiyun 		if (dpk_info->dpk_band == RTW_BAND_2G)
3297*4882a593Smuzhiyun 			rtw_write32(rtwdev, REG_DPD_LUT3, 0x1f100000);
3298*4882a593Smuzhiyun 		else
3299*4882a593Smuzhiyun 			rtw_write32(rtwdev, REG_DPD_LUT3, 0x1f0d0000);
3300*4882a593Smuzhiyun 
3301*4882a593Smuzhiyun 		rtw_write8(rtwdev, REG_DPD_AGC, dpk_info->dpk_txagc[path]);
3302*4882a593Smuzhiyun 
3303*4882a593Smuzhiyun 		rtw8822c_dpk_coef_write(rtwdev, path,
3304*4882a593Smuzhiyun 					test_bit(path, dpk_info->dpk_path_ok));
3305*4882a593Smuzhiyun 
3306*4882a593Smuzhiyun 		rtw8822c_dpk_one_shot(rtwdev, path, RTW_DPK_DPK_ON);
3307*4882a593Smuzhiyun 
3308*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE, 0xc);
3309*4882a593Smuzhiyun 
3310*4882a593Smuzhiyun 		if (path == RF_PATH_A)
3311*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_DPD_CTL0_S0, BIT_GS_PWSF,
3312*4882a593Smuzhiyun 					 dpk_info->dpk_gs[path]);
3313*4882a593Smuzhiyun 		else
3314*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_DPD_CTL0_S1, BIT_GS_PWSF,
3315*4882a593Smuzhiyun 					 dpk_info->dpk_gs[path]);
3316*4882a593Smuzhiyun 	}
3317*4882a593Smuzhiyun 	rtw8822c_dpk_cal_coef1(rtwdev);
3318*4882a593Smuzhiyun }
3319*4882a593Smuzhiyun 
rtw8822c_dpk_reload(struct rtw_dev * rtwdev)3320*4882a593Smuzhiyun static bool rtw8822c_dpk_reload(struct rtw_dev *rtwdev)
3321*4882a593Smuzhiyun {
3322*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3323*4882a593Smuzhiyun 	u8 channel;
3324*4882a593Smuzhiyun 
3325*4882a593Smuzhiyun 	dpk_info->is_reload = false;
3326*4882a593Smuzhiyun 
3327*4882a593Smuzhiyun 	channel = (u8)(rtw_read_rf(rtwdev, RF_PATH_A, 0x18, RFREG_MASK) & 0xff);
3328*4882a593Smuzhiyun 
3329*4882a593Smuzhiyun 	if (channel == dpk_info->dpk_ch) {
3330*4882a593Smuzhiyun 		rtw_dbg(rtwdev, RTW_DBG_RFK,
3331*4882a593Smuzhiyun 			"[DPK] DPK reload for CH%d!!\n", dpk_info->dpk_ch);
3332*4882a593Smuzhiyun 		rtw8822c_dpk_reload_data(rtwdev);
3333*4882a593Smuzhiyun 		dpk_info->is_reload = true;
3334*4882a593Smuzhiyun 	}
3335*4882a593Smuzhiyun 
3336*4882a593Smuzhiyun 	return dpk_info->is_reload;
3337*4882a593Smuzhiyun }
3338*4882a593Smuzhiyun 
rtw8822c_do_dpk(struct rtw_dev * rtwdev)3339*4882a593Smuzhiyun static void rtw8822c_do_dpk(struct rtw_dev *rtwdev)
3340*4882a593Smuzhiyun {
3341*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3342*4882a593Smuzhiyun 	struct rtw_backup_info bckp[DPK_BB_REG_NUM];
3343*4882a593Smuzhiyun 	u32 rf_reg_backup[DPK_RF_REG_NUM][DPK_RF_PATH_NUM];
3344*4882a593Smuzhiyun 	u32 bb_reg[DPK_BB_REG_NUM] = {
3345*4882a593Smuzhiyun 		0x520, 0x820, 0x824, 0x1c3c, 0x1d58, 0x1864,
3346*4882a593Smuzhiyun 		0x4164, 0x180c, 0x410c, 0x186c, 0x416c,
3347*4882a593Smuzhiyun 		0x1a14, 0x1e70, 0x80c, 0x1d70, 0x1e7c, 0x18a4, 0x41a4};
3348*4882a593Smuzhiyun 	u32 rf_reg[DPK_RF_REG_NUM] = {
3349*4882a593Smuzhiyun 		0x0, 0x1a, 0x55, 0x63, 0x87, 0x8f, 0xde};
3350*4882a593Smuzhiyun 	u8 path;
3351*4882a593Smuzhiyun 
3352*4882a593Smuzhiyun 	if (!dpk_info->is_dpk_pwr_on) {
3353*4882a593Smuzhiyun 		rtw_dbg(rtwdev, RTW_DBG_RFK, "[DPK] Skip DPK due to DPD PWR off\n");
3354*4882a593Smuzhiyun 		return;
3355*4882a593Smuzhiyun 	} else if (rtw8822c_dpk_reload(rtwdev)) {
3356*4882a593Smuzhiyun 		return;
3357*4882a593Smuzhiyun 	}
3358*4882a593Smuzhiyun 
3359*4882a593Smuzhiyun 	for (path = RF_PATH_A; path < DPK_RF_PATH_NUM; path++)
3360*4882a593Smuzhiyun 		ewma_thermal_init(&dpk_info->avg_thermal[path]);
3361*4882a593Smuzhiyun 
3362*4882a593Smuzhiyun 	rtw8822c_dpk_information(rtwdev);
3363*4882a593Smuzhiyun 
3364*4882a593Smuzhiyun 	rtw8822c_dpk_backup_registers(rtwdev, bb_reg, DPK_BB_REG_NUM, bckp);
3365*4882a593Smuzhiyun 	rtw8822c_dpk_backup_rf_registers(rtwdev, rf_reg, rf_reg_backup);
3366*4882a593Smuzhiyun 
3367*4882a593Smuzhiyun 	rtw8822c_dpk_mac_bb_setting(rtwdev);
3368*4882a593Smuzhiyun 	rtw8822c_dpk_afe_setting(rtwdev, true);
3369*4882a593Smuzhiyun 	rtw8822c_dpk_pre_setting(rtwdev);
3370*4882a593Smuzhiyun 	rtw8822c_dpk_result_reset(rtwdev);
3371*4882a593Smuzhiyun 	rtw8822c_dpk_path_select(rtwdev);
3372*4882a593Smuzhiyun 	rtw8822c_dpk_afe_setting(rtwdev, false);
3373*4882a593Smuzhiyun 	rtw8822c_dpk_enable_disable(rtwdev);
3374*4882a593Smuzhiyun 
3375*4882a593Smuzhiyun 	rtw8822c_dpk_reload_rf_registers(rtwdev, rf_reg, rf_reg_backup);
3376*4882a593Smuzhiyun 	for (path = 0; path < rtwdev->hal.rf_path_num; path++)
3377*4882a593Smuzhiyun 		rtw8822c_dpk_rxbb_dc_cal(rtwdev, path);
3378*4882a593Smuzhiyun 	rtw8822c_dpk_restore_registers(rtwdev, DPK_BB_REG_NUM, bckp);
3379*4882a593Smuzhiyun }
3380*4882a593Smuzhiyun 
rtw8822c_phy_calibration(struct rtw_dev * rtwdev)3381*4882a593Smuzhiyun static void rtw8822c_phy_calibration(struct rtw_dev *rtwdev)
3382*4882a593Smuzhiyun {
3383*4882a593Smuzhiyun 	rtw8822c_do_iqk(rtwdev);
3384*4882a593Smuzhiyun 	rtw8822c_do_dpk(rtwdev);
3385*4882a593Smuzhiyun }
3386*4882a593Smuzhiyun 
rtw8822c_dpk_track(struct rtw_dev * rtwdev)3387*4882a593Smuzhiyun static void rtw8822c_dpk_track(struct rtw_dev *rtwdev)
3388*4882a593Smuzhiyun {
3389*4882a593Smuzhiyun 	struct rtw_dpk_info *dpk_info = &rtwdev->dm_info.dpk_info;
3390*4882a593Smuzhiyun 	u8 path;
3391*4882a593Smuzhiyun 	u8 thermal_value[DPK_RF_PATH_NUM] = {0};
3392*4882a593Smuzhiyun 	s8 offset[DPK_RF_PATH_NUM], delta_dpk[DPK_RF_PATH_NUM];
3393*4882a593Smuzhiyun 
3394*4882a593Smuzhiyun 	if (dpk_info->thermal_dpk[0] == 0 && dpk_info->thermal_dpk[1] == 0)
3395*4882a593Smuzhiyun 		return;
3396*4882a593Smuzhiyun 
3397*4882a593Smuzhiyun 	for (path = 0; path < DPK_RF_PATH_NUM; path++) {
3398*4882a593Smuzhiyun 		thermal_value[path] = rtw8822c_dpk_thermal_read(rtwdev, path);
3399*4882a593Smuzhiyun 		ewma_thermal_add(&dpk_info->avg_thermal[path],
3400*4882a593Smuzhiyun 				 thermal_value[path]);
3401*4882a593Smuzhiyun 		thermal_value[path] =
3402*4882a593Smuzhiyun 			ewma_thermal_read(&dpk_info->avg_thermal[path]);
3403*4882a593Smuzhiyun 		delta_dpk[path] = dpk_info->thermal_dpk[path] -
3404*4882a593Smuzhiyun 				  thermal_value[path];
3405*4882a593Smuzhiyun 		offset[path] = delta_dpk[path] -
3406*4882a593Smuzhiyun 			       dpk_info->thermal_dpk_delta[path];
3407*4882a593Smuzhiyun 		offset[path] &= 0x7f;
3408*4882a593Smuzhiyun 
3409*4882a593Smuzhiyun 		if (offset[path] != dpk_info->pre_pwsf[path]) {
3410*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, REG_NCTL0, BIT_SUBPAGE,
3411*4882a593Smuzhiyun 					 0x8 | (path << 1));
3412*4882a593Smuzhiyun 			rtw_write32_mask(rtwdev, 0x1b58, GENMASK(6, 0),
3413*4882a593Smuzhiyun 					 offset[path]);
3414*4882a593Smuzhiyun 			dpk_info->pre_pwsf[path] = offset[path];
3415*4882a593Smuzhiyun 		}
3416*4882a593Smuzhiyun 	}
3417*4882a593Smuzhiyun }
3418*4882a593Smuzhiyun 
3419*4882a593Smuzhiyun static const struct rtw_phy_cck_pd_reg
3420*4882a593Smuzhiyun rtw8822c_cck_pd_reg[RTW_CHANNEL_WIDTH_40 + 1][RTW_RF_PATH_MAX] = {
3421*4882a593Smuzhiyun 	{
3422*4882a593Smuzhiyun 		{0x1ac8, 0x00ff, 0x1ad0, 0x01f},
3423*4882a593Smuzhiyun 		{0x1ac8, 0xff00, 0x1ad0, 0x3e0}
3424*4882a593Smuzhiyun 	},
3425*4882a593Smuzhiyun 	{
3426*4882a593Smuzhiyun 		{0x1acc, 0x00ff, 0x1ad0, 0x01F00000},
3427*4882a593Smuzhiyun 		{0x1acc, 0xff00, 0x1ad0, 0x3E000000}
3428*4882a593Smuzhiyun 	},
3429*4882a593Smuzhiyun };
3430*4882a593Smuzhiyun 
3431*4882a593Smuzhiyun #define RTW_CCK_PD_MAX 255
3432*4882a593Smuzhiyun #define RTW_CCK_CS_MAX 31
3433*4882a593Smuzhiyun #define RTW_CCK_CS_ERR1 27
3434*4882a593Smuzhiyun #define RTW_CCK_CS_ERR2 29
3435*4882a593Smuzhiyun static void
rtw8822c_phy_cck_pd_set_reg(struct rtw_dev * rtwdev,s8 pd_diff,s8 cs_diff,u8 bw,u8 nrx)3436*4882a593Smuzhiyun rtw8822c_phy_cck_pd_set_reg(struct rtw_dev *rtwdev,
3437*4882a593Smuzhiyun 			    s8 pd_diff, s8 cs_diff, u8 bw, u8 nrx)
3438*4882a593Smuzhiyun {
3439*4882a593Smuzhiyun 	u32 pd, cs;
3440*4882a593Smuzhiyun 
3441*4882a593Smuzhiyun 	if (WARN_ON(bw > RTW_CHANNEL_WIDTH_40 || nrx >= RTW_RF_PATH_MAX))
3442*4882a593Smuzhiyun 		return;
3443*4882a593Smuzhiyun 
3444*4882a593Smuzhiyun 	pd = rtw_read32_mask(rtwdev,
3445*4882a593Smuzhiyun 			     rtw8822c_cck_pd_reg[bw][nrx].reg_pd,
3446*4882a593Smuzhiyun 			     rtw8822c_cck_pd_reg[bw][nrx].mask_pd);
3447*4882a593Smuzhiyun 	cs = rtw_read32_mask(rtwdev,
3448*4882a593Smuzhiyun 			     rtw8822c_cck_pd_reg[bw][nrx].reg_cs,
3449*4882a593Smuzhiyun 			     rtw8822c_cck_pd_reg[bw][nrx].mask_cs);
3450*4882a593Smuzhiyun 	pd += pd_diff;
3451*4882a593Smuzhiyun 	cs += cs_diff;
3452*4882a593Smuzhiyun 	if (pd > RTW_CCK_PD_MAX)
3453*4882a593Smuzhiyun 		pd = RTW_CCK_PD_MAX;
3454*4882a593Smuzhiyun 	if (cs == RTW_CCK_CS_ERR1 || cs == RTW_CCK_CS_ERR2)
3455*4882a593Smuzhiyun 		cs++;
3456*4882a593Smuzhiyun 	else if (cs > RTW_CCK_CS_MAX)
3457*4882a593Smuzhiyun 		cs = RTW_CCK_CS_MAX;
3458*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev,
3459*4882a593Smuzhiyun 			 rtw8822c_cck_pd_reg[bw][nrx].reg_pd,
3460*4882a593Smuzhiyun 			 rtw8822c_cck_pd_reg[bw][nrx].mask_pd,
3461*4882a593Smuzhiyun 			 pd);
3462*4882a593Smuzhiyun 	rtw_write32_mask(rtwdev,
3463*4882a593Smuzhiyun 			 rtw8822c_cck_pd_reg[bw][nrx].reg_cs,
3464*4882a593Smuzhiyun 			 rtw8822c_cck_pd_reg[bw][nrx].mask_cs,
3465*4882a593Smuzhiyun 			 cs);
3466*4882a593Smuzhiyun }
3467*4882a593Smuzhiyun 
rtw8822c_phy_cck_pd_set(struct rtw_dev * rtwdev,u8 new_lvl)3468*4882a593Smuzhiyun static void rtw8822c_phy_cck_pd_set(struct rtw_dev *rtwdev, u8 new_lvl)
3469*4882a593Smuzhiyun {
3470*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
3471*4882a593Smuzhiyun 	s8 pd_lvl[CCK_PD_LV_MAX] = {0, 2, 4, 6, 8};
3472*4882a593Smuzhiyun 	s8 cs_lvl[CCK_PD_LV_MAX] = {0, 2, 2, 2, 4};
3473*4882a593Smuzhiyun 	u8 cur_lvl;
3474*4882a593Smuzhiyun 	u8 nrx, bw;
3475*4882a593Smuzhiyun 
3476*4882a593Smuzhiyun 	nrx = (u8)rtw_read32_mask(rtwdev, 0x1a2c, 0x60000);
3477*4882a593Smuzhiyun 	bw = (u8)rtw_read32_mask(rtwdev, 0x9b0, 0xc);
3478*4882a593Smuzhiyun 
3479*4882a593Smuzhiyun 	if (dm_info->cck_pd_lv[bw][nrx] == new_lvl)
3480*4882a593Smuzhiyun 		return;
3481*4882a593Smuzhiyun 
3482*4882a593Smuzhiyun 	cur_lvl = dm_info->cck_pd_lv[bw][nrx];
3483*4882a593Smuzhiyun 
3484*4882a593Smuzhiyun 	/* update cck pd info */
3485*4882a593Smuzhiyun 	dm_info->cck_fa_avg = CCK_FA_AVG_RESET;
3486*4882a593Smuzhiyun 
3487*4882a593Smuzhiyun 	rtw8822c_phy_cck_pd_set_reg(rtwdev,
3488*4882a593Smuzhiyun 				    pd_lvl[new_lvl] - pd_lvl[cur_lvl],
3489*4882a593Smuzhiyun 				    cs_lvl[new_lvl] - cs_lvl[cur_lvl],
3490*4882a593Smuzhiyun 				    bw, nrx);
3491*4882a593Smuzhiyun 	dm_info->cck_pd_lv[bw][nrx] = new_lvl;
3492*4882a593Smuzhiyun }
3493*4882a593Smuzhiyun 
3494*4882a593Smuzhiyun #define PWR_TRACK_MASK 0x7f
rtw8822c_pwrtrack_set(struct rtw_dev * rtwdev,u8 rf_path)3495*4882a593Smuzhiyun static void rtw8822c_pwrtrack_set(struct rtw_dev *rtwdev, u8 rf_path)
3496*4882a593Smuzhiyun {
3497*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
3498*4882a593Smuzhiyun 
3499*4882a593Smuzhiyun 	switch (rf_path) {
3500*4882a593Smuzhiyun 	case RF_PATH_A:
3501*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, 0x18a0, PWR_TRACK_MASK,
3502*4882a593Smuzhiyun 				 dm_info->delta_power_index[rf_path]);
3503*4882a593Smuzhiyun 		break;
3504*4882a593Smuzhiyun 	case RF_PATH_B:
3505*4882a593Smuzhiyun 		rtw_write32_mask(rtwdev, 0x41a0, PWR_TRACK_MASK,
3506*4882a593Smuzhiyun 				 dm_info->delta_power_index[rf_path]);
3507*4882a593Smuzhiyun 		break;
3508*4882a593Smuzhiyun 	default:
3509*4882a593Smuzhiyun 		break;
3510*4882a593Smuzhiyun 	}
3511*4882a593Smuzhiyun }
3512*4882a593Smuzhiyun 
rtw8822c_pwr_track_stats(struct rtw_dev * rtwdev,u8 path)3513*4882a593Smuzhiyun static void rtw8822c_pwr_track_stats(struct rtw_dev *rtwdev, u8 path)
3514*4882a593Smuzhiyun {
3515*4882a593Smuzhiyun 	u8 thermal_value;
3516*4882a593Smuzhiyun 
3517*4882a593Smuzhiyun 	if (rtwdev->efuse.thermal_meter[path] == 0xff)
3518*4882a593Smuzhiyun 		return;
3519*4882a593Smuzhiyun 
3520*4882a593Smuzhiyun 	thermal_value = rtw_read_rf(rtwdev, path, RF_T_METER, 0x7e);
3521*4882a593Smuzhiyun 	rtw_phy_pwrtrack_avg(rtwdev, thermal_value, path);
3522*4882a593Smuzhiyun }
3523*4882a593Smuzhiyun 
rtw8822c_pwr_track_path(struct rtw_dev * rtwdev,struct rtw_swing_table * swing_table,u8 path)3524*4882a593Smuzhiyun static void rtw8822c_pwr_track_path(struct rtw_dev *rtwdev,
3525*4882a593Smuzhiyun 				    struct rtw_swing_table *swing_table,
3526*4882a593Smuzhiyun 				    u8 path)
3527*4882a593Smuzhiyun {
3528*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
3529*4882a593Smuzhiyun 	u8 delta;
3530*4882a593Smuzhiyun 
3531*4882a593Smuzhiyun 	delta = rtw_phy_pwrtrack_get_delta(rtwdev, path);
3532*4882a593Smuzhiyun 	dm_info->delta_power_index[path] =
3533*4882a593Smuzhiyun 		rtw_phy_pwrtrack_get_pwridx(rtwdev, swing_table, path, path,
3534*4882a593Smuzhiyun 					    delta);
3535*4882a593Smuzhiyun 	rtw8822c_pwrtrack_set(rtwdev, path);
3536*4882a593Smuzhiyun }
3537*4882a593Smuzhiyun 
__rtw8822c_pwr_track(struct rtw_dev * rtwdev)3538*4882a593Smuzhiyun static void __rtw8822c_pwr_track(struct rtw_dev *rtwdev)
3539*4882a593Smuzhiyun {
3540*4882a593Smuzhiyun 	struct rtw_swing_table swing_table;
3541*4882a593Smuzhiyun 	u8 i;
3542*4882a593Smuzhiyun 
3543*4882a593Smuzhiyun 	rtw_phy_config_swing_table(rtwdev, &swing_table);
3544*4882a593Smuzhiyun 
3545*4882a593Smuzhiyun 	for (i = 0; i < rtwdev->hal.rf_path_num; i++)
3546*4882a593Smuzhiyun 		rtw8822c_pwr_track_stats(rtwdev, i);
3547*4882a593Smuzhiyun 	if (rtw_phy_pwrtrack_need_lck(rtwdev))
3548*4882a593Smuzhiyun 		rtw8822c_do_lck(rtwdev);
3549*4882a593Smuzhiyun 	for (i = 0; i < rtwdev->hal.rf_path_num; i++)
3550*4882a593Smuzhiyun 		rtw8822c_pwr_track_path(rtwdev, &swing_table, i);
3551*4882a593Smuzhiyun }
3552*4882a593Smuzhiyun 
rtw8822c_pwr_track(struct rtw_dev * rtwdev)3553*4882a593Smuzhiyun static void rtw8822c_pwr_track(struct rtw_dev *rtwdev)
3554*4882a593Smuzhiyun {
3555*4882a593Smuzhiyun 	struct rtw_efuse *efuse = &rtwdev->efuse;
3556*4882a593Smuzhiyun 	struct rtw_dm_info *dm_info = &rtwdev->dm_info;
3557*4882a593Smuzhiyun 
3558*4882a593Smuzhiyun 	if (efuse->power_track_type != 0)
3559*4882a593Smuzhiyun 		return;
3560*4882a593Smuzhiyun 
3561*4882a593Smuzhiyun 	if (!dm_info->pwr_trk_triggered) {
3562*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_A, RF_T_METER, BIT(19), 0x01);
3563*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_A, RF_T_METER, BIT(19), 0x00);
3564*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_A, RF_T_METER, BIT(19), 0x01);
3565*4882a593Smuzhiyun 
3566*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_B, RF_T_METER, BIT(19), 0x01);
3567*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_B, RF_T_METER, BIT(19), 0x00);
3568*4882a593Smuzhiyun 		rtw_write_rf(rtwdev, RF_PATH_B, RF_T_METER, BIT(19), 0x01);
3569*4882a593Smuzhiyun 
3570*4882a593Smuzhiyun 		dm_info->pwr_trk_triggered = true;
3571*4882a593Smuzhiyun 		return;
3572*4882a593Smuzhiyun 	}
3573*4882a593Smuzhiyun 
3574*4882a593Smuzhiyun 	__rtw8822c_pwr_track(rtwdev);
3575*4882a593Smuzhiyun 	dm_info->pwr_trk_triggered = false;
3576*4882a593Smuzhiyun }
3577*4882a593Smuzhiyun 
3578*4882a593Smuzhiyun static const struct rtw_pwr_seq_cmd trans_carddis_to_cardemu_8822c[] = {
3579*4882a593Smuzhiyun 	{0x0086,
3580*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3581*4882a593Smuzhiyun 	 RTW_PWR_INTF_SDIO_MSK,
3582*4882a593Smuzhiyun 	 RTW_PWR_ADDR_SDIO,
3583*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(0), 0},
3584*4882a593Smuzhiyun 	{0x0086,
3585*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3586*4882a593Smuzhiyun 	 RTW_PWR_INTF_SDIO_MSK,
3587*4882a593Smuzhiyun 	 RTW_PWR_ADDR_SDIO,
3588*4882a593Smuzhiyun 	 RTW_PWR_CMD_POLLING, BIT(1), BIT(1)},
3589*4882a593Smuzhiyun 	{0x002E,
3590*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3591*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3592*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3593*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(2), BIT(2)},
3594*4882a593Smuzhiyun 	{0x002D,
3595*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3596*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3597*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3598*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(0), 0},
3599*4882a593Smuzhiyun 	{0x007F,
3600*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3601*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3602*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3603*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(7), 0},
3604*4882a593Smuzhiyun 	{0x004A,
3605*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3606*4882a593Smuzhiyun 	 RTW_PWR_INTF_USB_MSK,
3607*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3608*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(0), 0},
3609*4882a593Smuzhiyun 	{0x0005,
3610*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3611*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3612*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3613*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(3) | BIT(4) | BIT(7), 0},
3614*4882a593Smuzhiyun 	{0xFFFF,
3615*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3616*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3617*4882a593Smuzhiyun 	 0,
3618*4882a593Smuzhiyun 	 RTW_PWR_CMD_END, 0, 0},
3619*4882a593Smuzhiyun };
3620*4882a593Smuzhiyun 
3621*4882a593Smuzhiyun static const struct rtw_pwr_seq_cmd trans_cardemu_to_act_8822c[] = {
3622*4882a593Smuzhiyun 	{0x0000,
3623*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3624*4882a593Smuzhiyun 	 RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK,
3625*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3626*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(5), 0},
3627*4882a593Smuzhiyun 	{0x0005,
3628*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3629*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3630*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3631*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3) | BIT(2)), 0},
3632*4882a593Smuzhiyun 	{0x0075,
3633*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3634*4882a593Smuzhiyun 	 RTW_PWR_INTF_PCI_MSK,
3635*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3636*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
3637*4882a593Smuzhiyun 	{0x0006,
3638*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3639*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3640*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3641*4882a593Smuzhiyun 	 RTW_PWR_CMD_POLLING, BIT(1), BIT(1)},
3642*4882a593Smuzhiyun 	{0x0075,
3643*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3644*4882a593Smuzhiyun 	 RTW_PWR_INTF_PCI_MSK,
3645*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3646*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(0), 0},
3647*4882a593Smuzhiyun 	{0xFF1A,
3648*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3649*4882a593Smuzhiyun 	 RTW_PWR_INTF_USB_MSK,
3650*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3651*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, 0xFF, 0},
3652*4882a593Smuzhiyun 	{0x002E,
3653*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3654*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3655*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3656*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(3), 0},
3657*4882a593Smuzhiyun 	{0x0006,
3658*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3659*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3660*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3661*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
3662*4882a593Smuzhiyun 	{0x0005,
3663*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3664*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3665*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3666*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, (BIT(4) | BIT(3)), 0},
3667*4882a593Smuzhiyun 	{0x1018,
3668*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3669*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3670*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3671*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(2), BIT(2)},
3672*4882a593Smuzhiyun 	{0x0005,
3673*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3674*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3675*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3676*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
3677*4882a593Smuzhiyun 	{0x0005,
3678*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3679*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3680*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3681*4882a593Smuzhiyun 	 RTW_PWR_CMD_POLLING, BIT(0), 0},
3682*4882a593Smuzhiyun 	{0x0074,
3683*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3684*4882a593Smuzhiyun 	 RTW_PWR_INTF_PCI_MSK,
3685*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3686*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(5), BIT(5)},
3687*4882a593Smuzhiyun 	{0x0071,
3688*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3689*4882a593Smuzhiyun 	 RTW_PWR_INTF_PCI_MSK,
3690*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3691*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(4), 0},
3692*4882a593Smuzhiyun 	{0x0062,
3693*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3694*4882a593Smuzhiyun 	 RTW_PWR_INTF_PCI_MSK,
3695*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3696*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, (BIT(7) | BIT(6) | BIT(5)),
3697*4882a593Smuzhiyun 	 (BIT(7) | BIT(6) | BIT(5))},
3698*4882a593Smuzhiyun 	{0x0061,
3699*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3700*4882a593Smuzhiyun 	 RTW_PWR_INTF_PCI_MSK,
3701*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3702*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, (BIT(7) | BIT(6) | BIT(5)), 0},
3703*4882a593Smuzhiyun 	{0x001F,
3704*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3705*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3706*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3707*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, (BIT(7) | BIT(6)), BIT(7)},
3708*4882a593Smuzhiyun 	{0x00EF,
3709*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3710*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3711*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3712*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, (BIT(7) | BIT(6)), BIT(7)},
3713*4882a593Smuzhiyun 	{0x1045,
3714*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3715*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3716*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3717*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(4), BIT(4)},
3718*4882a593Smuzhiyun 	{0x0010,
3719*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3720*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3721*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3722*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(2), BIT(2)},
3723*4882a593Smuzhiyun 	{0x1064,
3724*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3725*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3726*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3727*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(1), BIT(1)},
3728*4882a593Smuzhiyun 	{0xFFFF,
3729*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3730*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3731*4882a593Smuzhiyun 	 0,
3732*4882a593Smuzhiyun 	 RTW_PWR_CMD_END, 0, 0},
3733*4882a593Smuzhiyun };
3734*4882a593Smuzhiyun 
3735*4882a593Smuzhiyun static const struct rtw_pwr_seq_cmd trans_act_to_cardemu_8822c[] = {
3736*4882a593Smuzhiyun 	{0x0093,
3737*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3738*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3739*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3740*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(3), 0},
3741*4882a593Smuzhiyun 	{0x001F,
3742*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3743*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3744*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3745*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, 0xFF, 0},
3746*4882a593Smuzhiyun 	{0x00EF,
3747*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3748*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3749*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3750*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, 0xFF, 0},
3751*4882a593Smuzhiyun 	{0x1045,
3752*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3753*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3754*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3755*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(4), 0},
3756*4882a593Smuzhiyun 	{0xFF1A,
3757*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3758*4882a593Smuzhiyun 	 RTW_PWR_INTF_USB_MSK,
3759*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3760*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, 0xFF, 0x30},
3761*4882a593Smuzhiyun 	{0x0049,
3762*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3763*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3764*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3765*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(1), 0},
3766*4882a593Smuzhiyun 	{0x0006,
3767*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3768*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3769*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3770*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
3771*4882a593Smuzhiyun 	{0x0002,
3772*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3773*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3774*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3775*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(1), 0},
3776*4882a593Smuzhiyun 	{0x0005,
3777*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3778*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3779*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3780*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(1), BIT(1)},
3781*4882a593Smuzhiyun 	{0x0005,
3782*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3783*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3784*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3785*4882a593Smuzhiyun 	 RTW_PWR_CMD_POLLING, BIT(1), 0},
3786*4882a593Smuzhiyun 	{0x0000,
3787*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3788*4882a593Smuzhiyun 	 RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK,
3789*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3790*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(5), BIT(5)},
3791*4882a593Smuzhiyun 	{0xFFFF,
3792*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3793*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3794*4882a593Smuzhiyun 	 0,
3795*4882a593Smuzhiyun 	 RTW_PWR_CMD_END, 0, 0},
3796*4882a593Smuzhiyun };
3797*4882a593Smuzhiyun 
3798*4882a593Smuzhiyun static const struct rtw_pwr_seq_cmd trans_cardemu_to_carddis_8822c[] = {
3799*4882a593Smuzhiyun 	{0x0005,
3800*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3801*4882a593Smuzhiyun 	 RTW_PWR_INTF_SDIO_MSK,
3802*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3803*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(7), BIT(7)},
3804*4882a593Smuzhiyun 	{0x0007,
3805*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3806*4882a593Smuzhiyun 	 RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK,
3807*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3808*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, 0xFF, 0x00},
3809*4882a593Smuzhiyun 	{0x0067,
3810*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3811*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3812*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3813*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(5), 0},
3814*4882a593Smuzhiyun 	{0x004A,
3815*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3816*4882a593Smuzhiyun 	 RTW_PWR_INTF_USB_MSK,
3817*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3818*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(0), 0},
3819*4882a593Smuzhiyun 	{0x0081,
3820*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3821*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3822*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3823*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(7) | BIT(6), 0},
3824*4882a593Smuzhiyun 	{0x0090,
3825*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3826*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3827*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3828*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(1), 0},
3829*4882a593Smuzhiyun 	{0x0092,
3830*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3831*4882a593Smuzhiyun 	 RTW_PWR_INTF_PCI_MSK,
3832*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3833*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, 0xFF, 0x20},
3834*4882a593Smuzhiyun 	{0x0093,
3835*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3836*4882a593Smuzhiyun 	 RTW_PWR_INTF_PCI_MSK,
3837*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3838*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, 0xFF, 0x04},
3839*4882a593Smuzhiyun 	{0x0005,
3840*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3841*4882a593Smuzhiyun 	 RTW_PWR_INTF_USB_MSK | RTW_PWR_INTF_SDIO_MSK,
3842*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3843*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(3) | BIT(4), BIT(3)},
3844*4882a593Smuzhiyun 	{0x0005,
3845*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3846*4882a593Smuzhiyun 	 RTW_PWR_INTF_PCI_MSK,
3847*4882a593Smuzhiyun 	 RTW_PWR_ADDR_MAC,
3848*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(2), BIT(2)},
3849*4882a593Smuzhiyun 	{0x0086,
3850*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3851*4882a593Smuzhiyun 	 RTW_PWR_INTF_SDIO_MSK,
3852*4882a593Smuzhiyun 	 RTW_PWR_ADDR_SDIO,
3853*4882a593Smuzhiyun 	 RTW_PWR_CMD_WRITE, BIT(0), BIT(0)},
3854*4882a593Smuzhiyun 	{0xFFFF,
3855*4882a593Smuzhiyun 	 RTW_PWR_CUT_ALL_MSK,
3856*4882a593Smuzhiyun 	 RTW_PWR_INTF_ALL_MSK,
3857*4882a593Smuzhiyun 	 0,
3858*4882a593Smuzhiyun 	 RTW_PWR_CMD_END, 0, 0},
3859*4882a593Smuzhiyun };
3860*4882a593Smuzhiyun 
3861*4882a593Smuzhiyun static const struct rtw_pwr_seq_cmd *card_enable_flow_8822c[] = {
3862*4882a593Smuzhiyun 	trans_carddis_to_cardemu_8822c,
3863*4882a593Smuzhiyun 	trans_cardemu_to_act_8822c,
3864*4882a593Smuzhiyun 	NULL
3865*4882a593Smuzhiyun };
3866*4882a593Smuzhiyun 
3867*4882a593Smuzhiyun static const struct rtw_pwr_seq_cmd *card_disable_flow_8822c[] = {
3868*4882a593Smuzhiyun 	trans_act_to_cardemu_8822c,
3869*4882a593Smuzhiyun 	trans_cardemu_to_carddis_8822c,
3870*4882a593Smuzhiyun 	NULL
3871*4882a593Smuzhiyun };
3872*4882a593Smuzhiyun 
3873*4882a593Smuzhiyun static const struct rtw_intf_phy_para usb2_param_8822c[] = {
3874*4882a593Smuzhiyun 	{0xFFFF, 0x00,
3875*4882a593Smuzhiyun 	 RTW_IP_SEL_PHY,
3876*4882a593Smuzhiyun 	 RTW_INTF_PHY_CUT_ALL,
3877*4882a593Smuzhiyun 	 RTW_INTF_PHY_PLATFORM_ALL},
3878*4882a593Smuzhiyun };
3879*4882a593Smuzhiyun 
3880*4882a593Smuzhiyun static const struct rtw_intf_phy_para usb3_param_8822c[] = {
3881*4882a593Smuzhiyun 	{0xFFFF, 0x0000,
3882*4882a593Smuzhiyun 	 RTW_IP_SEL_PHY,
3883*4882a593Smuzhiyun 	 RTW_INTF_PHY_CUT_ALL,
3884*4882a593Smuzhiyun 	 RTW_INTF_PHY_PLATFORM_ALL},
3885*4882a593Smuzhiyun };
3886*4882a593Smuzhiyun 
3887*4882a593Smuzhiyun static const struct rtw_intf_phy_para pcie_gen1_param_8822c[] = {
3888*4882a593Smuzhiyun 	{0xFFFF, 0x0000,
3889*4882a593Smuzhiyun 	 RTW_IP_SEL_PHY,
3890*4882a593Smuzhiyun 	 RTW_INTF_PHY_CUT_ALL,
3891*4882a593Smuzhiyun 	 RTW_INTF_PHY_PLATFORM_ALL},
3892*4882a593Smuzhiyun };
3893*4882a593Smuzhiyun 
3894*4882a593Smuzhiyun static const struct rtw_intf_phy_para pcie_gen2_param_8822c[] = {
3895*4882a593Smuzhiyun 	{0xFFFF, 0x0000,
3896*4882a593Smuzhiyun 	 RTW_IP_SEL_PHY,
3897*4882a593Smuzhiyun 	 RTW_INTF_PHY_CUT_ALL,
3898*4882a593Smuzhiyun 	 RTW_INTF_PHY_PLATFORM_ALL},
3899*4882a593Smuzhiyun };
3900*4882a593Smuzhiyun 
3901*4882a593Smuzhiyun static const struct rtw_intf_phy_para_table phy_para_table_8822c = {
3902*4882a593Smuzhiyun 	.usb2_para	= usb2_param_8822c,
3903*4882a593Smuzhiyun 	.usb3_para	= usb3_param_8822c,
3904*4882a593Smuzhiyun 	.gen1_para	= pcie_gen1_param_8822c,
3905*4882a593Smuzhiyun 	.gen2_para	= pcie_gen2_param_8822c,
3906*4882a593Smuzhiyun 	.n_usb2_para	= ARRAY_SIZE(usb2_param_8822c),
3907*4882a593Smuzhiyun 	.n_usb3_para	= ARRAY_SIZE(usb2_param_8822c),
3908*4882a593Smuzhiyun 	.n_gen1_para	= ARRAY_SIZE(pcie_gen1_param_8822c),
3909*4882a593Smuzhiyun 	.n_gen2_para	= ARRAY_SIZE(pcie_gen2_param_8822c),
3910*4882a593Smuzhiyun };
3911*4882a593Smuzhiyun 
3912*4882a593Smuzhiyun static const struct rtw_rfe_def rtw8822c_rfe_defs[] = {
3913*4882a593Smuzhiyun 	[0] = RTW_DEF_RFE(8822c, 0, 0),
3914*4882a593Smuzhiyun 	[1] = RTW_DEF_RFE(8822c, 0, 0),
3915*4882a593Smuzhiyun 	[2] = RTW_DEF_RFE(8822c, 0, 0),
3916*4882a593Smuzhiyun 	[5] = RTW_DEF_RFE(8822c, 0, 5),
3917*4882a593Smuzhiyun 	[6] = RTW_DEF_RFE(8822c, 0, 0),
3918*4882a593Smuzhiyun };
3919*4882a593Smuzhiyun 
3920*4882a593Smuzhiyun static const struct rtw_hw_reg rtw8822c_dig[] = {
3921*4882a593Smuzhiyun 	[0] = { .addr = 0x1d70, .mask = 0x7f },
3922*4882a593Smuzhiyun 	[1] = { .addr = 0x1d70, .mask = 0x7f00 },
3923*4882a593Smuzhiyun };
3924*4882a593Smuzhiyun 
3925*4882a593Smuzhiyun static const struct rtw_ltecoex_addr rtw8822c_ltecoex_addr = {
3926*4882a593Smuzhiyun 	.ctrl = LTECOEX_ACCESS_CTRL,
3927*4882a593Smuzhiyun 	.wdata = LTECOEX_WRITE_DATA,
3928*4882a593Smuzhiyun 	.rdata = LTECOEX_READ_DATA,
3929*4882a593Smuzhiyun };
3930*4882a593Smuzhiyun 
3931*4882a593Smuzhiyun static const struct rtw_page_table page_table_8822c[] = {
3932*4882a593Smuzhiyun 	{64, 64, 64, 64, 1},
3933*4882a593Smuzhiyun 	{64, 64, 64, 64, 1},
3934*4882a593Smuzhiyun 	{64, 64, 0, 0, 1},
3935*4882a593Smuzhiyun 	{64, 64, 64, 0, 1},
3936*4882a593Smuzhiyun 	{64, 64, 64, 64, 1},
3937*4882a593Smuzhiyun };
3938*4882a593Smuzhiyun 
3939*4882a593Smuzhiyun static const struct rtw_rqpn rqpn_table_8822c[] = {
3940*4882a593Smuzhiyun 	{RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL,
3941*4882a593Smuzhiyun 	 RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW,
3942*4882a593Smuzhiyun 	 RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH},
3943*4882a593Smuzhiyun 	{RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL,
3944*4882a593Smuzhiyun 	 RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW,
3945*4882a593Smuzhiyun 	 RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH},
3946*4882a593Smuzhiyun 	{RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL,
3947*4882a593Smuzhiyun 	 RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_HIGH,
3948*4882a593Smuzhiyun 	 RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH},
3949*4882a593Smuzhiyun 	{RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL,
3950*4882a593Smuzhiyun 	 RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW,
3951*4882a593Smuzhiyun 	 RTW_DMA_MAPPING_HIGH, RTW_DMA_MAPPING_HIGH},
3952*4882a593Smuzhiyun 	{RTW_DMA_MAPPING_NORMAL, RTW_DMA_MAPPING_NORMAL,
3953*4882a593Smuzhiyun 	 RTW_DMA_MAPPING_LOW, RTW_DMA_MAPPING_LOW,
3954*4882a593Smuzhiyun 	 RTW_DMA_MAPPING_EXTRA, RTW_DMA_MAPPING_HIGH},
3955*4882a593Smuzhiyun };
3956*4882a593Smuzhiyun 
3957*4882a593Smuzhiyun static struct rtw_prioq_addrs prioq_addrs_8822c = {
3958*4882a593Smuzhiyun 	.prio[RTW_DMA_MAPPING_EXTRA] = {
3959*4882a593Smuzhiyun 		.rsvd = REG_FIFOPAGE_INFO_4, .avail = REG_FIFOPAGE_INFO_4 + 2,
3960*4882a593Smuzhiyun 	},
3961*4882a593Smuzhiyun 	.prio[RTW_DMA_MAPPING_LOW] = {
3962*4882a593Smuzhiyun 		.rsvd = REG_FIFOPAGE_INFO_2, .avail = REG_FIFOPAGE_INFO_2 + 2,
3963*4882a593Smuzhiyun 	},
3964*4882a593Smuzhiyun 	.prio[RTW_DMA_MAPPING_NORMAL] = {
3965*4882a593Smuzhiyun 		.rsvd = REG_FIFOPAGE_INFO_3, .avail = REG_FIFOPAGE_INFO_3 + 2,
3966*4882a593Smuzhiyun 	},
3967*4882a593Smuzhiyun 	.prio[RTW_DMA_MAPPING_HIGH] = {
3968*4882a593Smuzhiyun 		.rsvd = REG_FIFOPAGE_INFO_1, .avail = REG_FIFOPAGE_INFO_1 + 2,
3969*4882a593Smuzhiyun 	},
3970*4882a593Smuzhiyun 	.wsize = true,
3971*4882a593Smuzhiyun };
3972*4882a593Smuzhiyun 
3973*4882a593Smuzhiyun static struct rtw_chip_ops rtw8822c_ops = {
3974*4882a593Smuzhiyun 	.phy_set_param		= rtw8822c_phy_set_param,
3975*4882a593Smuzhiyun 	.read_efuse		= rtw8822c_read_efuse,
3976*4882a593Smuzhiyun 	.query_rx_desc		= rtw8822c_query_rx_desc,
3977*4882a593Smuzhiyun 	.set_channel		= rtw8822c_set_channel,
3978*4882a593Smuzhiyun 	.mac_init		= rtw8822c_mac_init,
3979*4882a593Smuzhiyun 	.read_rf		= rtw_phy_read_rf,
3980*4882a593Smuzhiyun 	.write_rf		= rtw_phy_write_rf_reg_mix,
3981*4882a593Smuzhiyun 	.set_tx_power_index	= rtw8822c_set_tx_power_index,
3982*4882a593Smuzhiyun 	.set_antenna		= rtw8822c_set_antenna,
3983*4882a593Smuzhiyun 	.cfg_ldo25		= rtw8822c_cfg_ldo25,
3984*4882a593Smuzhiyun 	.false_alarm_statistics	= rtw8822c_false_alarm_statistics,
3985*4882a593Smuzhiyun 	.dpk_track		= rtw8822c_dpk_track,
3986*4882a593Smuzhiyun 	.phy_calibration	= rtw8822c_phy_calibration,
3987*4882a593Smuzhiyun 	.cck_pd_set		= rtw8822c_phy_cck_pd_set,
3988*4882a593Smuzhiyun 	.pwr_track		= rtw8822c_pwr_track,
3989*4882a593Smuzhiyun 	.config_bfee		= rtw8822c_bf_config_bfee,
3990*4882a593Smuzhiyun 	.set_gid_table		= rtw_bf_set_gid_table,
3991*4882a593Smuzhiyun 	.cfg_csi_rate		= rtw_bf_cfg_csi_rate,
3992*4882a593Smuzhiyun 
3993*4882a593Smuzhiyun 	.coex_set_init		= rtw8822c_coex_cfg_init,
3994*4882a593Smuzhiyun 	.coex_set_ant_switch	= NULL,
3995*4882a593Smuzhiyun 	.coex_set_gnt_fix	= rtw8822c_coex_cfg_gnt_fix,
3996*4882a593Smuzhiyun 	.coex_set_gnt_debug	= rtw8822c_coex_cfg_gnt_debug,
3997*4882a593Smuzhiyun 	.coex_set_rfe_type	= rtw8822c_coex_cfg_rfe_type,
3998*4882a593Smuzhiyun 	.coex_set_wl_tx_power	= rtw8822c_coex_cfg_wl_tx_power,
3999*4882a593Smuzhiyun 	.coex_set_wl_rx_gain	= rtw8822c_coex_cfg_wl_rx_gain,
4000*4882a593Smuzhiyun };
4001*4882a593Smuzhiyun 
4002*4882a593Smuzhiyun /* Shared-Antenna Coex Table */
4003*4882a593Smuzhiyun static const struct coex_table_para table_sant_8822c[] = {
4004*4882a593Smuzhiyun 	{0xffffffff, 0xffffffff}, /* case-0 */
4005*4882a593Smuzhiyun 	{0x55555555, 0x55555555},
4006*4882a593Smuzhiyun 	{0x66555555, 0x66555555},
4007*4882a593Smuzhiyun 	{0xaaaaaaaa, 0xaaaaaaaa},
4008*4882a593Smuzhiyun 	{0x5a5a5a5a, 0x5a5a5a5a},
4009*4882a593Smuzhiyun 	{0xfafafafa, 0xfafafafa}, /* case-5 */
4010*4882a593Smuzhiyun 	{0x6a5a6a5a, 0xaaaaaaaa},
4011*4882a593Smuzhiyun 	{0x6a5a56aa, 0x6a5a56aa},
4012*4882a593Smuzhiyun 	{0x6a5a5a5a, 0x6a5a5a5a},
4013*4882a593Smuzhiyun 	{0x66555555, 0x5a5a5a5a},
4014*4882a593Smuzhiyun 	{0x66555555, 0x6a5a5a5a}, /* case-10 */
4015*4882a593Smuzhiyun 	{0x66555555, 0xfafafafa},
4016*4882a593Smuzhiyun 	{0x66555555, 0x5a5a5aaa},
4017*4882a593Smuzhiyun 	{0x66555555, 0x5aaa5aaa},
4018*4882a593Smuzhiyun 	{0x66555555, 0xaaaa5aaa},
4019*4882a593Smuzhiyun 	{0x66555555, 0xaaaaaaaa}, /* case-15 */
4020*4882a593Smuzhiyun 	{0xffff55ff, 0xfafafafa},
4021*4882a593Smuzhiyun 	{0xffff55ff, 0x6afa5afa},
4022*4882a593Smuzhiyun 	{0xaaffffaa, 0xfafafafa},
4023*4882a593Smuzhiyun 	{0xaa5555aa, 0x5a5a5a5a},
4024*4882a593Smuzhiyun 	{0xaa5555aa, 0x6a5a5a5a}, /* case-20 */
4025*4882a593Smuzhiyun 	{0xaa5555aa, 0xaaaaaaaa},
4026*4882a593Smuzhiyun 	{0xffffffff, 0x5a5a5a5a},
4027*4882a593Smuzhiyun 	{0xffffffff, 0x6a5a5a5a},
4028*4882a593Smuzhiyun 	{0xffffffff, 0x55555555},
4029*4882a593Smuzhiyun 	{0xffffffff, 0x6a5a5aaa}, /* case-25 */
4030*4882a593Smuzhiyun 	{0x55555555, 0x5a5a5a5a},
4031*4882a593Smuzhiyun 	{0x55555555, 0xaaaaaaaa},
4032*4882a593Smuzhiyun 	{0x55555555, 0x6a5a6a5a},
4033*4882a593Smuzhiyun 	{0x66556655, 0x66556655}
4034*4882a593Smuzhiyun };
4035*4882a593Smuzhiyun 
4036*4882a593Smuzhiyun /* Non-Shared-Antenna Coex Table */
4037*4882a593Smuzhiyun static const struct coex_table_para table_nsant_8822c[] = {
4038*4882a593Smuzhiyun 	{0xffffffff, 0xffffffff}, /* case-100 */
4039*4882a593Smuzhiyun 	{0x55555555, 0x55555555},
4040*4882a593Smuzhiyun 	{0x66555555, 0x66555555},
4041*4882a593Smuzhiyun 	{0xaaaaaaaa, 0xaaaaaaaa},
4042*4882a593Smuzhiyun 	{0x5a5a5a5a, 0x5a5a5a5a},
4043*4882a593Smuzhiyun 	{0xfafafafa, 0xfafafafa}, /* case-105 */
4044*4882a593Smuzhiyun 	{0x5afa5afa, 0x5afa5afa},
4045*4882a593Smuzhiyun 	{0x55555555, 0xfafafafa},
4046*4882a593Smuzhiyun 	{0x66555555, 0xfafafafa},
4047*4882a593Smuzhiyun 	{0x66555555, 0x5a5a5a5a},
4048*4882a593Smuzhiyun 	{0x66555555, 0x6a5a5a5a}, /* case-110 */
4049*4882a593Smuzhiyun 	{0x66555555, 0xaaaaaaaa},
4050*4882a593Smuzhiyun 	{0xffff55ff, 0xfafafafa},
4051*4882a593Smuzhiyun 	{0xffff55ff, 0x5afa5afa},
4052*4882a593Smuzhiyun 	{0xffff55ff, 0xaaaaaaaa},
4053*4882a593Smuzhiyun 	{0xaaffffaa, 0xfafafafa}, /* case-115 */
4054*4882a593Smuzhiyun 	{0xaaffffaa, 0x5afa5afa},
4055*4882a593Smuzhiyun 	{0xaaffffaa, 0xaaaaaaaa},
4056*4882a593Smuzhiyun 	{0xffffffff, 0xfafafafa},
4057*4882a593Smuzhiyun 	{0xffffffff, 0x5afa5afa},
4058*4882a593Smuzhiyun 	{0xffffffff, 0xaaaaaaaa},/* case-120 */
4059*4882a593Smuzhiyun 	{0x55ff55ff, 0x5afa5afa},
4060*4882a593Smuzhiyun 	{0x55ff55ff, 0xaaaaaaaa},
4061*4882a593Smuzhiyun 	{0x55ff55ff, 0x55ff55ff}
4062*4882a593Smuzhiyun };
4063*4882a593Smuzhiyun 
4064*4882a593Smuzhiyun /* Shared-Antenna TDMA */
4065*4882a593Smuzhiyun static const struct coex_tdma_para tdma_sant_8822c[] = {
4066*4882a593Smuzhiyun 	{ {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-0 */
4067*4882a593Smuzhiyun 	{ {0x61, 0x45, 0x03, 0x11, 0x11} },
4068*4882a593Smuzhiyun 	{ {0x61, 0x3a, 0x03, 0x11, 0x11} },
4069*4882a593Smuzhiyun 	{ {0x61, 0x30, 0x03, 0x11, 0x11} },
4070*4882a593Smuzhiyun 	{ {0x61, 0x20, 0x03, 0x11, 0x11} },
4071*4882a593Smuzhiyun 	{ {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-5 */
4072*4882a593Smuzhiyun 	{ {0x61, 0x45, 0x03, 0x11, 0x10} },
4073*4882a593Smuzhiyun 	{ {0x61, 0x3a, 0x03, 0x11, 0x10} },
4074*4882a593Smuzhiyun 	{ {0x61, 0x30, 0x03, 0x11, 0x10} },
4075*4882a593Smuzhiyun 	{ {0x61, 0x20, 0x03, 0x11, 0x10} },
4076*4882a593Smuzhiyun 	{ {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-10 */
4077*4882a593Smuzhiyun 	{ {0x61, 0x08, 0x03, 0x11, 0x14} },
4078*4882a593Smuzhiyun 	{ {0x61, 0x08, 0x03, 0x10, 0x14} },
4079*4882a593Smuzhiyun 	{ {0x51, 0x08, 0x03, 0x10, 0x54} },
4080*4882a593Smuzhiyun 	{ {0x51, 0x08, 0x03, 0x10, 0x55} },
4081*4882a593Smuzhiyun 	{ {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-15 */
4082*4882a593Smuzhiyun 	{ {0x51, 0x45, 0x03, 0x10, 0x10} },
4083*4882a593Smuzhiyun 	{ {0x51, 0x3a, 0x03, 0x10, 0x50} },
4084*4882a593Smuzhiyun 	{ {0x51, 0x30, 0x03, 0x10, 0x50} },
4085*4882a593Smuzhiyun 	{ {0x51, 0x20, 0x03, 0x10, 0x50} },
4086*4882a593Smuzhiyun 	{ {0x51, 0x10, 0x03, 0x10, 0x50} }, /* case-20 */
4087*4882a593Smuzhiyun 	{ {0x51, 0x4a, 0x03, 0x10, 0x50} },
4088*4882a593Smuzhiyun 	{ {0x51, 0x0c, 0x03, 0x10, 0x54} },
4089*4882a593Smuzhiyun 	{ {0x55, 0x08, 0x03, 0x10, 0x54} },
4090*4882a593Smuzhiyun 	{ {0x65, 0x10, 0x03, 0x11, 0x11} },
4091*4882a593Smuzhiyun 	{ {0x51, 0x10, 0x03, 0x10, 0x51} }, /* case-25 */
4092*4882a593Smuzhiyun 	{ {0x51, 0x08, 0x03, 0x10, 0x50} },
4093*4882a593Smuzhiyun 	{ {0x61, 0x08, 0x03, 0x11, 0x11} }
4094*4882a593Smuzhiyun };
4095*4882a593Smuzhiyun 
4096*4882a593Smuzhiyun /* Non-Shared-Antenna TDMA */
4097*4882a593Smuzhiyun static const struct coex_tdma_para tdma_nsant_8822c[] = {
4098*4882a593Smuzhiyun 	{ {0x00, 0x00, 0x00, 0x00, 0x00} }, /* case-100 */
4099*4882a593Smuzhiyun 	{ {0x61, 0x45, 0x03, 0x11, 0x11} },
4100*4882a593Smuzhiyun 	{ {0x61, 0x3a, 0x03, 0x11, 0x11} },
4101*4882a593Smuzhiyun 	{ {0x61, 0x30, 0x03, 0x11, 0x11} },
4102*4882a593Smuzhiyun 	{ {0x61, 0x20, 0x03, 0x11, 0x11} },
4103*4882a593Smuzhiyun 	{ {0x61, 0x10, 0x03, 0x11, 0x11} }, /* case-105 */
4104*4882a593Smuzhiyun 	{ {0x61, 0x45, 0x03, 0x11, 0x10} },
4105*4882a593Smuzhiyun 	{ {0x61, 0x3a, 0x03, 0x11, 0x10} },
4106*4882a593Smuzhiyun 	{ {0x61, 0x30, 0x03, 0x11, 0x10} },
4107*4882a593Smuzhiyun 	{ {0x61, 0x20, 0x03, 0x11, 0x10} },
4108*4882a593Smuzhiyun 	{ {0x61, 0x10, 0x03, 0x11, 0x10} }, /* case-110 */
4109*4882a593Smuzhiyun 	{ {0x61, 0x08, 0x03, 0x11, 0x14} },
4110*4882a593Smuzhiyun 	{ {0x61, 0x08, 0x03, 0x10, 0x14} },
4111*4882a593Smuzhiyun 	{ {0x51, 0x08, 0x03, 0x10, 0x54} },
4112*4882a593Smuzhiyun 	{ {0x51, 0x08, 0x03, 0x10, 0x55} },
4113*4882a593Smuzhiyun 	{ {0x51, 0x08, 0x07, 0x10, 0x54} }, /* case-115 */
4114*4882a593Smuzhiyun 	{ {0x51, 0x45, 0x03, 0x10, 0x50} },
4115*4882a593Smuzhiyun 	{ {0x51, 0x3a, 0x03, 0x10, 0x50} },
4116*4882a593Smuzhiyun 	{ {0x51, 0x30, 0x03, 0x10, 0x50} },
4117*4882a593Smuzhiyun 	{ {0x51, 0x20, 0x03, 0x10, 0x50} },
4118*4882a593Smuzhiyun 	{ {0x51, 0x10, 0x03, 0x10, 0x50} }  /* case-120 */
4119*4882a593Smuzhiyun };
4120*4882a593Smuzhiyun 
4121*4882a593Smuzhiyun /* rssi in percentage % (dbm = % - 100) */
4122*4882a593Smuzhiyun static const u8 wl_rssi_step_8822c[] = {60, 50, 44, 30};
4123*4882a593Smuzhiyun static const u8 bt_rssi_step_8822c[] = {8, 15, 20, 25};
4124*4882a593Smuzhiyun static const struct coex_5g_afh_map afh_5g_8822c[] = { {0, 0, 0} };
4125*4882a593Smuzhiyun 
4126*4882a593Smuzhiyun /* wl_tx_dec_power, bt_tx_dec_power, wl_rx_gain, bt_rx_lna_constrain */
4127*4882a593Smuzhiyun static const struct coex_rf_para rf_para_tx_8822c[] = {
4128*4882a593Smuzhiyun 	{0, 0, false, 7},  /* for normal */
4129*4882a593Smuzhiyun 	{0, 16, false, 7}, /* for WL-CPT */
4130*4882a593Smuzhiyun 	{8, 17, true, 4},
4131*4882a593Smuzhiyun 	{7, 18, true, 4},
4132*4882a593Smuzhiyun 	{6, 19, true, 4},
4133*4882a593Smuzhiyun 	{5, 20, true, 4}
4134*4882a593Smuzhiyun };
4135*4882a593Smuzhiyun 
4136*4882a593Smuzhiyun static const struct coex_rf_para rf_para_rx_8822c[] = {
4137*4882a593Smuzhiyun 	{0, 0, false, 7},  /* for normal */
4138*4882a593Smuzhiyun 	{0, 16, false, 7}, /* for WL-CPT */
4139*4882a593Smuzhiyun 	{3, 24, true, 5},
4140*4882a593Smuzhiyun 	{2, 26, true, 5},
4141*4882a593Smuzhiyun 	{1, 27, true, 5},
4142*4882a593Smuzhiyun 	{0, 28, true, 5}
4143*4882a593Smuzhiyun };
4144*4882a593Smuzhiyun 
4145*4882a593Smuzhiyun static_assert(ARRAY_SIZE(rf_para_tx_8822c) == ARRAY_SIZE(rf_para_rx_8822c));
4146*4882a593Smuzhiyun 
4147*4882a593Smuzhiyun static const u8
4148*4882a593Smuzhiyun rtw8822c_pwrtrk_5gb_n[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = {
4149*4882a593Smuzhiyun 	{ 0,  1,  2,  3,  5,  6,  7,  8,  9, 10,
4150*4882a593Smuzhiyun 	 11, 12, 13, 14, 15, 16, 18, 19, 20, 21,
4151*4882a593Smuzhiyun 	 22, 23, 24, 25, 26, 27, 28, 29, 30, 32 },
4152*4882a593Smuzhiyun 	{ 0,  1,  2,  3,  5,  6,  7,  8,  9, 10,
4153*4882a593Smuzhiyun 	 11, 12, 13, 14, 15, 16, 18, 19, 20, 21,
4154*4882a593Smuzhiyun 	 22, 23, 24, 25, 26, 27, 28, 29, 30, 32 },
4155*4882a593Smuzhiyun 	{ 0,  1,  2,  3,  5,  6,  7,  8,  9, 10,
4156*4882a593Smuzhiyun 	 11, 12, 13, 14, 15, 16, 18, 19, 20, 21,
4157*4882a593Smuzhiyun 	 22, 23, 24, 25, 26, 27, 28, 29, 30, 32 },
4158*4882a593Smuzhiyun };
4159*4882a593Smuzhiyun 
4160*4882a593Smuzhiyun static const u8
4161*4882a593Smuzhiyun rtw8822c_pwrtrk_5gb_p[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = {
4162*4882a593Smuzhiyun 	{ 0,  1,  2,  3,  4,  5,  6,  7,  8,  9,
4163*4882a593Smuzhiyun 	 10, 10, 11, 12, 13, 14, 15, 16, 17, 18,
4164*4882a593Smuzhiyun 	 19, 20, 21, 22, 22, 23, 24, 25, 26, 27 },
4165*4882a593Smuzhiyun 	{ 0,  1,  2,  3,  4,  5,  6,  7,  8,  9,
4166*4882a593Smuzhiyun 	 10, 10, 11, 12, 13, 14, 15, 16, 17, 18,
4167*4882a593Smuzhiyun 	 19, 20, 21, 22, 22, 23, 24, 25, 26, 27 },
4168*4882a593Smuzhiyun 	{ 0,  1,  2,  3,  4,  5,  6,  7,  8,  9,
4169*4882a593Smuzhiyun 	 10, 10, 11, 12, 13, 14, 15, 16, 17, 18,
4170*4882a593Smuzhiyun 	 19, 20, 21, 22, 22, 23, 24, 25, 26, 27 },
4171*4882a593Smuzhiyun };
4172*4882a593Smuzhiyun 
4173*4882a593Smuzhiyun static const u8
4174*4882a593Smuzhiyun rtw8822c_pwrtrk_5ga_n[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = {
4175*4882a593Smuzhiyun 	{ 0,  1,  2,  4,  5,  6,  7,  8,  9, 10,
4176*4882a593Smuzhiyun 	 11, 13, 14, 15, 16, 17, 18, 19, 20, 21,
4177*4882a593Smuzhiyun 	 23, 24, 25, 26, 27, 28, 29, 30, 31, 33 },
4178*4882a593Smuzhiyun 	{ 0,  1,  2,  4,  5,  6,  7,  8,  9, 10,
4179*4882a593Smuzhiyun 	 11, 13, 14, 15, 16, 17, 18, 19, 20, 21,
4180*4882a593Smuzhiyun 	 23, 24, 25, 26, 27, 28, 29, 30, 31, 33 },
4181*4882a593Smuzhiyun 	{ 0,  1,  2,  4,  5,  6,  7,  8,  9, 10,
4182*4882a593Smuzhiyun 	 11, 13, 14, 15, 16, 17, 18, 19, 20, 21,
4183*4882a593Smuzhiyun 	 23, 24, 25, 26, 27, 28, 29, 30, 31, 33 },
4184*4882a593Smuzhiyun };
4185*4882a593Smuzhiyun 
4186*4882a593Smuzhiyun static const u8
4187*4882a593Smuzhiyun rtw8822c_pwrtrk_5ga_p[RTW_PWR_TRK_5G_NUM][RTW_PWR_TRK_TBL_SZ] = {
4188*4882a593Smuzhiyun 	{ 0,  1,  2,  3,  4,  5,  6,  7,  8,  9,
4189*4882a593Smuzhiyun 	 10, 11, 12, 13, 14, 15, 16, 17, 18, 20,
4190*4882a593Smuzhiyun 	 21, 22, 23, 24, 25, 26, 27, 28, 29, 30 },
4191*4882a593Smuzhiyun 	{ 0,  1,  2,  3,  4,  5,  6,  7,  8,  9,
4192*4882a593Smuzhiyun 	 10, 11, 12, 13, 14, 15, 16, 17, 18, 20,
4193*4882a593Smuzhiyun 	 21, 22, 23, 24, 25, 26, 27, 28, 29, 30 },
4194*4882a593Smuzhiyun 	{ 0,  1,  2,  3,  4,  5,  6,  7,  8,  9,
4195*4882a593Smuzhiyun 	 10, 11, 12, 13, 14, 15, 16, 17, 18, 20,
4196*4882a593Smuzhiyun 	 21, 22, 23, 24, 25, 26, 27, 28, 29, 30 },
4197*4882a593Smuzhiyun };
4198*4882a593Smuzhiyun 
4199*4882a593Smuzhiyun static const u8 rtw8822c_pwrtrk_2gb_n[RTW_PWR_TRK_TBL_SZ] = {
4200*4882a593Smuzhiyun 	 0,  1,  2,  3,  4,  4,  5,  6,  7,  8,
4201*4882a593Smuzhiyun 	 9,  9, 10, 11, 12, 13, 14, 15, 15, 16,
4202*4882a593Smuzhiyun 	17, 18, 19, 20, 20, 21, 22, 23, 24, 25
4203*4882a593Smuzhiyun };
4204*4882a593Smuzhiyun 
4205*4882a593Smuzhiyun static const u8 rtw8822c_pwrtrk_2gb_p[RTW_PWR_TRK_TBL_SZ] = {
4206*4882a593Smuzhiyun 	 0,  1,  2,  3,  4,  5,  6,  7,  8,  9,
4207*4882a593Smuzhiyun 	10, 11, 12, 13, 14, 14, 15, 16, 17, 18,
4208*4882a593Smuzhiyun 	19, 20, 21, 22, 23, 24, 25, 26, 27, 28
4209*4882a593Smuzhiyun };
4210*4882a593Smuzhiyun 
4211*4882a593Smuzhiyun static const u8 rtw8822c_pwrtrk_2ga_n[RTW_PWR_TRK_TBL_SZ] = {
4212*4882a593Smuzhiyun 	 0,  1,  2,  2,  3,  4,  4,  5,  6,  6,
4213*4882a593Smuzhiyun 	 7,  8,  8,  9,  9, 10, 11, 11, 12, 13,
4214*4882a593Smuzhiyun 	13, 14, 15, 15, 16, 17, 17, 18, 19, 19
4215*4882a593Smuzhiyun };
4216*4882a593Smuzhiyun 
4217*4882a593Smuzhiyun static const u8 rtw8822c_pwrtrk_2ga_p[RTW_PWR_TRK_TBL_SZ] = {
4218*4882a593Smuzhiyun 	 0,  1,  2,  3,  4,  5,  6,  7,  8,  9,
4219*4882a593Smuzhiyun 	10, 11, 11, 12, 13, 14, 15, 16, 17, 18,
4220*4882a593Smuzhiyun 	19, 20, 21, 22, 23, 24, 25, 25, 26, 27
4221*4882a593Smuzhiyun };
4222*4882a593Smuzhiyun 
4223*4882a593Smuzhiyun static const u8 rtw8822c_pwrtrk_2g_cck_b_n[RTW_PWR_TRK_TBL_SZ] = {
4224*4882a593Smuzhiyun 	 0,  1,  2,  3,  4,  5,  5,  6,  7,  8,
4225*4882a593Smuzhiyun 	 9, 10, 11, 11, 12, 13, 14, 15, 16, 17,
4226*4882a593Smuzhiyun 	17, 18, 19, 20, 21, 22, 23, 23, 24, 25
4227*4882a593Smuzhiyun };
4228*4882a593Smuzhiyun 
4229*4882a593Smuzhiyun static const u8 rtw8822c_pwrtrk_2g_cck_b_p[RTW_PWR_TRK_TBL_SZ] = {
4230*4882a593Smuzhiyun 	 0,  1,  2,  3,  4,  5,  6,  7,  8,  9,
4231*4882a593Smuzhiyun 	10, 11, 12, 13, 14, 15, 16, 17, 18, 19,
4232*4882a593Smuzhiyun 	20, 21, 22, 23, 24, 25, 26, 27, 28, 29
4233*4882a593Smuzhiyun };
4234*4882a593Smuzhiyun 
4235*4882a593Smuzhiyun static const u8 rtw8822c_pwrtrk_2g_cck_a_n[RTW_PWR_TRK_TBL_SZ] = {
4236*4882a593Smuzhiyun 	 0,  1,  2,  3,  3,  4,  5,  6,  6,  7,
4237*4882a593Smuzhiyun 	 8,  9,  9, 10, 11, 12, 12, 13, 14, 15,
4238*4882a593Smuzhiyun 	15, 16, 17, 18, 18, 19, 20, 21, 21, 22
4239*4882a593Smuzhiyun };
4240*4882a593Smuzhiyun 
4241*4882a593Smuzhiyun static const u8 rtw8822c_pwrtrk_2g_cck_a_p[RTW_PWR_TRK_TBL_SZ] = {
4242*4882a593Smuzhiyun 	 0,  1,  2,  3,  4,  5,  5,  6,  7,  8,
4243*4882a593Smuzhiyun 	 9, 10, 11, 11, 12, 13, 14, 15, 16, 17,
4244*4882a593Smuzhiyun 	18, 18, 19, 20, 21, 22, 23, 24, 24, 25
4245*4882a593Smuzhiyun };
4246*4882a593Smuzhiyun 
4247*4882a593Smuzhiyun static const struct rtw_pwr_track_tbl rtw8822c_rtw_pwr_track_tbl = {
4248*4882a593Smuzhiyun 	.pwrtrk_5gb_n[RTW_PWR_TRK_5G_1] = rtw8822c_pwrtrk_5gb_n[RTW_PWR_TRK_5G_1],
4249*4882a593Smuzhiyun 	.pwrtrk_5gb_n[RTW_PWR_TRK_5G_2] = rtw8822c_pwrtrk_5gb_n[RTW_PWR_TRK_5G_2],
4250*4882a593Smuzhiyun 	.pwrtrk_5gb_n[RTW_PWR_TRK_5G_3] = rtw8822c_pwrtrk_5gb_n[RTW_PWR_TRK_5G_3],
4251*4882a593Smuzhiyun 	.pwrtrk_5gb_p[RTW_PWR_TRK_5G_1] = rtw8822c_pwrtrk_5gb_p[RTW_PWR_TRK_5G_1],
4252*4882a593Smuzhiyun 	.pwrtrk_5gb_p[RTW_PWR_TRK_5G_2] = rtw8822c_pwrtrk_5gb_p[RTW_PWR_TRK_5G_2],
4253*4882a593Smuzhiyun 	.pwrtrk_5gb_p[RTW_PWR_TRK_5G_3] = rtw8822c_pwrtrk_5gb_p[RTW_PWR_TRK_5G_3],
4254*4882a593Smuzhiyun 	.pwrtrk_5ga_n[RTW_PWR_TRK_5G_1] = rtw8822c_pwrtrk_5ga_n[RTW_PWR_TRK_5G_1],
4255*4882a593Smuzhiyun 	.pwrtrk_5ga_n[RTW_PWR_TRK_5G_2] = rtw8822c_pwrtrk_5ga_n[RTW_PWR_TRK_5G_2],
4256*4882a593Smuzhiyun 	.pwrtrk_5ga_n[RTW_PWR_TRK_5G_3] = rtw8822c_pwrtrk_5ga_n[RTW_PWR_TRK_5G_3],
4257*4882a593Smuzhiyun 	.pwrtrk_5ga_p[RTW_PWR_TRK_5G_1] = rtw8822c_pwrtrk_5ga_p[RTW_PWR_TRK_5G_1],
4258*4882a593Smuzhiyun 	.pwrtrk_5ga_p[RTW_PWR_TRK_5G_2] = rtw8822c_pwrtrk_5ga_p[RTW_PWR_TRK_5G_2],
4259*4882a593Smuzhiyun 	.pwrtrk_5ga_p[RTW_PWR_TRK_5G_3] = rtw8822c_pwrtrk_5ga_p[RTW_PWR_TRK_5G_3],
4260*4882a593Smuzhiyun 	.pwrtrk_2gb_n = rtw8822c_pwrtrk_2gb_n,
4261*4882a593Smuzhiyun 	.pwrtrk_2gb_p = rtw8822c_pwrtrk_2gb_p,
4262*4882a593Smuzhiyun 	.pwrtrk_2ga_n = rtw8822c_pwrtrk_2ga_n,
4263*4882a593Smuzhiyun 	.pwrtrk_2ga_p = rtw8822c_pwrtrk_2ga_p,
4264*4882a593Smuzhiyun 	.pwrtrk_2g_cckb_n = rtw8822c_pwrtrk_2g_cck_b_n,
4265*4882a593Smuzhiyun 	.pwrtrk_2g_cckb_p = rtw8822c_pwrtrk_2g_cck_b_p,
4266*4882a593Smuzhiyun 	.pwrtrk_2g_ccka_n = rtw8822c_pwrtrk_2g_cck_a_n,
4267*4882a593Smuzhiyun 	.pwrtrk_2g_ccka_p = rtw8822c_pwrtrk_2g_cck_a_p,
4268*4882a593Smuzhiyun };
4269*4882a593Smuzhiyun 
4270*4882a593Smuzhiyun #ifdef CONFIG_PM
4271*4882a593Smuzhiyun static const struct wiphy_wowlan_support rtw_wowlan_stub_8822c = {
4272*4882a593Smuzhiyun 	.flags = WIPHY_WOWLAN_MAGIC_PKT | WIPHY_WOWLAN_GTK_REKEY_FAILURE |
4273*4882a593Smuzhiyun 		 WIPHY_WOWLAN_DISCONNECT | WIPHY_WOWLAN_SUPPORTS_GTK_REKEY |
4274*4882a593Smuzhiyun 		 WIPHY_WOWLAN_NET_DETECT,
4275*4882a593Smuzhiyun 	.n_patterns = RTW_MAX_PATTERN_NUM,
4276*4882a593Smuzhiyun 	.pattern_max_len = RTW_MAX_PATTERN_SIZE,
4277*4882a593Smuzhiyun 	.pattern_min_len = 1,
4278*4882a593Smuzhiyun 	.max_nd_match_sets = 4,
4279*4882a593Smuzhiyun };
4280*4882a593Smuzhiyun #endif
4281*4882a593Smuzhiyun 
4282*4882a593Smuzhiyun static const struct rtw_reg_domain coex_info_hw_regs_8822c[] = {
4283*4882a593Smuzhiyun 	{0x1860, BIT(3), RTW_REG_DOMAIN_MAC8},
4284*4882a593Smuzhiyun 	{0x4160, BIT(3), RTW_REG_DOMAIN_MAC8},
4285*4882a593Smuzhiyun 	{0x1c32, BIT(6), RTW_REG_DOMAIN_MAC8},
4286*4882a593Smuzhiyun 	{0x1c38, BIT(28), RTW_REG_DOMAIN_MAC32},
4287*4882a593Smuzhiyun 	{0, 0, RTW_REG_DOMAIN_NL},
4288*4882a593Smuzhiyun 	{0x430, MASKDWORD, RTW_REG_DOMAIN_MAC32},
4289*4882a593Smuzhiyun 	{0x434, MASKDWORD, RTW_REG_DOMAIN_MAC32},
4290*4882a593Smuzhiyun 	{0x42a, MASKLWORD, RTW_REG_DOMAIN_MAC16},
4291*4882a593Smuzhiyun 	{0x426, MASKBYTE0, RTW_REG_DOMAIN_MAC8},
4292*4882a593Smuzhiyun 	{0x45e, BIT(3), RTW_REG_DOMAIN_MAC8},
4293*4882a593Smuzhiyun 	{0x454, MASKLWORD, RTW_REG_DOMAIN_MAC16},
4294*4882a593Smuzhiyun 	{0, 0, RTW_REG_DOMAIN_NL},
4295*4882a593Smuzhiyun 	{0x4c, BIT(24) | BIT(23), RTW_REG_DOMAIN_MAC32},
4296*4882a593Smuzhiyun 	{0x64, BIT(0), RTW_REG_DOMAIN_MAC8},
4297*4882a593Smuzhiyun 	{0x4c6, BIT(4), RTW_REG_DOMAIN_MAC8},
4298*4882a593Smuzhiyun 	{0x40, BIT(5), RTW_REG_DOMAIN_MAC8},
4299*4882a593Smuzhiyun 	{0x1, RFREG_MASK, RTW_REG_DOMAIN_RF_B},
4300*4882a593Smuzhiyun 	{0, 0, RTW_REG_DOMAIN_NL},
4301*4882a593Smuzhiyun 	{0x550, MASKDWORD, RTW_REG_DOMAIN_MAC32},
4302*4882a593Smuzhiyun 	{0x522, MASKBYTE0, RTW_REG_DOMAIN_MAC8},
4303*4882a593Smuzhiyun 	{0x953, BIT(1), RTW_REG_DOMAIN_MAC8},
4304*4882a593Smuzhiyun 	{0xc50, MASKBYTE0, RTW_REG_DOMAIN_MAC8},
4305*4882a593Smuzhiyun };
4306*4882a593Smuzhiyun 
4307*4882a593Smuzhiyun struct rtw_chip_info rtw8822c_hw_spec = {
4308*4882a593Smuzhiyun 	.ops = &rtw8822c_ops,
4309*4882a593Smuzhiyun 	.id = RTW_CHIP_TYPE_8822C,
4310*4882a593Smuzhiyun 	.fw_name = "rtw88/rtw8822c_fw.bin",
4311*4882a593Smuzhiyun 	.wlan_cpu = RTW_WCPU_11AC,
4312*4882a593Smuzhiyun 	.tx_pkt_desc_sz = 48,
4313*4882a593Smuzhiyun 	.tx_buf_desc_sz = 16,
4314*4882a593Smuzhiyun 	.rx_pkt_desc_sz = 24,
4315*4882a593Smuzhiyun 	.rx_buf_desc_sz = 8,
4316*4882a593Smuzhiyun 	.phy_efuse_size = 512,
4317*4882a593Smuzhiyun 	.log_efuse_size = 768,
4318*4882a593Smuzhiyun 	.ptct_efuse_size = 124,
4319*4882a593Smuzhiyun 	.txff_size = 262144,
4320*4882a593Smuzhiyun 	.rxff_size = 24576,
4321*4882a593Smuzhiyun 	.fw_rxff_size = 12288,
4322*4882a593Smuzhiyun 	.txgi_factor = 2,
4323*4882a593Smuzhiyun 	.is_pwr_by_rate_dec = false,
4324*4882a593Smuzhiyun 	.max_power_index = 0x7f,
4325*4882a593Smuzhiyun 	.csi_buf_pg_num = 50,
4326*4882a593Smuzhiyun 	.band = RTW_BAND_2G | RTW_BAND_5G,
4327*4882a593Smuzhiyun 	.page_size = 128,
4328*4882a593Smuzhiyun 	.dig_min = 0x20,
4329*4882a593Smuzhiyun 	.ht_supported = true,
4330*4882a593Smuzhiyun 	.vht_supported = true,
4331*4882a593Smuzhiyun 	.lps_deep_mode_supported = BIT(LPS_DEEP_MODE_LCLK) | BIT(LPS_DEEP_MODE_PG),
4332*4882a593Smuzhiyun 	.sys_func_en = 0xD8,
4333*4882a593Smuzhiyun 	.pwr_on_seq = card_enable_flow_8822c,
4334*4882a593Smuzhiyun 	.pwr_off_seq = card_disable_flow_8822c,
4335*4882a593Smuzhiyun 	.page_table = page_table_8822c,
4336*4882a593Smuzhiyun 	.rqpn_table = rqpn_table_8822c,
4337*4882a593Smuzhiyun 	.prioq_addrs = &prioq_addrs_8822c,
4338*4882a593Smuzhiyun 	.intf_table = &phy_para_table_8822c,
4339*4882a593Smuzhiyun 	.dig = rtw8822c_dig,
4340*4882a593Smuzhiyun 	.dig_cck = NULL,
4341*4882a593Smuzhiyun 	.rf_base_addr = {0x3c00, 0x4c00},
4342*4882a593Smuzhiyun 	.rf_sipi_addr = {0x1808, 0x4108},
4343*4882a593Smuzhiyun 	.ltecoex_addr = &rtw8822c_ltecoex_addr,
4344*4882a593Smuzhiyun 	.mac_tbl = &rtw8822c_mac_tbl,
4345*4882a593Smuzhiyun 	.agc_tbl = &rtw8822c_agc_tbl,
4346*4882a593Smuzhiyun 	.bb_tbl = &rtw8822c_bb_tbl,
4347*4882a593Smuzhiyun 	.rfk_init_tbl = &rtw8822c_array_mp_cal_init_tbl,
4348*4882a593Smuzhiyun 	.rf_tbl = {&rtw8822c_rf_b_tbl, &rtw8822c_rf_a_tbl},
4349*4882a593Smuzhiyun 	.rfe_defs = rtw8822c_rfe_defs,
4350*4882a593Smuzhiyun 	.rfe_defs_size = ARRAY_SIZE(rtw8822c_rfe_defs),
4351*4882a593Smuzhiyun 	.en_dis_dpd = true,
4352*4882a593Smuzhiyun 	.dpd_ratemask = DIS_DPD_RATEALL,
4353*4882a593Smuzhiyun 	.pwr_track_tbl = &rtw8822c_rtw_pwr_track_tbl,
4354*4882a593Smuzhiyun 	.iqk_threshold = 8,
4355*4882a593Smuzhiyun 	.lck_threshold = 8,
4356*4882a593Smuzhiyun 	.bfer_su_max_num = 2,
4357*4882a593Smuzhiyun 	.bfer_mu_max_num = 1,
4358*4882a593Smuzhiyun 	.rx_ldpc = true,
4359*4882a593Smuzhiyun 
4360*4882a593Smuzhiyun #ifdef CONFIG_PM
4361*4882a593Smuzhiyun 	.wow_fw_name = "rtw88/rtw8822c_wow_fw.bin",
4362*4882a593Smuzhiyun 	.wowlan_stub = &rtw_wowlan_stub_8822c,
4363*4882a593Smuzhiyun 	.max_sched_scan_ssids = 4,
4364*4882a593Smuzhiyun #endif
4365*4882a593Smuzhiyun 	.coex_para_ver = 0x20070217,
4366*4882a593Smuzhiyun 	.bt_desired_ver = 0x17,
4367*4882a593Smuzhiyun 	.scbd_support = true,
4368*4882a593Smuzhiyun 	.new_scbd10_def = true,
4369*4882a593Smuzhiyun 	.pstdma_type = COEX_PSTDMA_FORCE_LPSOFF,
4370*4882a593Smuzhiyun 	.bt_rssi_type = COEX_BTRSSI_DBM,
4371*4882a593Smuzhiyun 	.ant_isolation = 15,
4372*4882a593Smuzhiyun 	.rssi_tolerance = 2,
4373*4882a593Smuzhiyun 	.wl_rssi_step = wl_rssi_step_8822c,
4374*4882a593Smuzhiyun 	.bt_rssi_step = bt_rssi_step_8822c,
4375*4882a593Smuzhiyun 	.table_sant_num = ARRAY_SIZE(table_sant_8822c),
4376*4882a593Smuzhiyun 	.table_sant = table_sant_8822c,
4377*4882a593Smuzhiyun 	.table_nsant_num = ARRAY_SIZE(table_nsant_8822c),
4378*4882a593Smuzhiyun 	.table_nsant = table_nsant_8822c,
4379*4882a593Smuzhiyun 	.tdma_sant_num = ARRAY_SIZE(tdma_sant_8822c),
4380*4882a593Smuzhiyun 	.tdma_sant = tdma_sant_8822c,
4381*4882a593Smuzhiyun 	.tdma_nsant_num = ARRAY_SIZE(tdma_nsant_8822c),
4382*4882a593Smuzhiyun 	.tdma_nsant = tdma_nsant_8822c,
4383*4882a593Smuzhiyun 	.wl_rf_para_num = ARRAY_SIZE(rf_para_tx_8822c),
4384*4882a593Smuzhiyun 	.wl_rf_para_tx = rf_para_tx_8822c,
4385*4882a593Smuzhiyun 	.wl_rf_para_rx = rf_para_rx_8822c,
4386*4882a593Smuzhiyun 	.bt_afh_span_bw20 = 0x24,
4387*4882a593Smuzhiyun 	.bt_afh_span_bw40 = 0x36,
4388*4882a593Smuzhiyun 	.afh_5g_num = ARRAY_SIZE(afh_5g_8822c),
4389*4882a593Smuzhiyun 	.afh_5g = afh_5g_8822c,
4390*4882a593Smuzhiyun 
4391*4882a593Smuzhiyun 	.coex_info_hw_regs_num = ARRAY_SIZE(coex_info_hw_regs_8822c),
4392*4882a593Smuzhiyun 	.coex_info_hw_regs = coex_info_hw_regs_8822c,
4393*4882a593Smuzhiyun 
4394*4882a593Smuzhiyun 	.fw_fifo_addr = {0x780, 0x700, 0x780, 0x660, 0x650, 0x680},
4395*4882a593Smuzhiyun };
4396*4882a593Smuzhiyun EXPORT_SYMBOL(rtw8822c_hw_spec);
4397*4882a593Smuzhiyun 
4398*4882a593Smuzhiyun MODULE_FIRMWARE("rtw88/rtw8822c_fw.bin");
4399*4882a593Smuzhiyun MODULE_FIRMWARE("rtw88/rtw8822c_wow_fw.bin");
4400*4882a593Smuzhiyun 
4401*4882a593Smuzhiyun MODULE_AUTHOR("Realtek Corporation");
4402*4882a593Smuzhiyun MODULE_DESCRIPTION("Realtek 802.11ac wireless 8822c driver");
4403*4882a593Smuzhiyun MODULE_LICENSE("Dual BSD/GPL");
4404