Commit 8379fa61 authored by Yuan-Han Zhang's avatar Yuan-Han Zhang Committed by Kalle Valo
Browse files

rtw89: 8852c: add write/read crystal function in CFO tracking 



The CFO tracking algorithm is the same, but control methods are different.
Set parameters via xtal serial interfaces (SI).

Signed-off-by: default avatarYuan-Han Zhang <yuanhan1020@realtek.com>
Signed-off-by: default avatarPing-Ke Shih <pkshih@realtek.com>
Signed-off-by: default avatarKalle Valo <kvalo@kernel.org>
Link: https://lore.kernel.org/r/20220317055543.40514-3-pkshih@realtek.com
parent b7379148

drivers/net/wireless/realtek/rtw89/mac.h

+2 −0
Original line number Diff line number Diff line
@@ -884,7 +884,9 @@ int rtw89_mac_get_tx_retry_limit(struct rtw89_dev *rtwdev, 


enum rtw89_mac_xtal_si_offset {

	XTAL_SI_XTAL_SC_XI = 0x04,

#define XTAL_SC_XI_MASK		GENMASK(7, 0)

	XTAL_SI_XTAL_SC_XO = 0x05,

#define XTAL_SC_XO_MASK		GENMASK(7, 0)

	XTAL_SI_PWR_CUT = 0x10,

#define XTAL_SI_SMALL_PWR_CUT	BIT(0)

#define XTAL_SI_BIG_PWR_CUT	BIT(1)

drivers/net/wireless/realtek/rtw89/phy.c

+15 −4
Original line number Diff line number Diff line
@@ -4,6 +4,7 @@ 


#include "debug.h"

#include "fw.h"

#include "mac.h"

#include "phy.h"

#include "ps.h"

#include "reg.h"
@@ -1667,15 +1668,25 @@ static void rtw89_phy_cfo_set_crystal_cap(struct rtw89_dev *rtwdev, 
					  u8 crystal_cap, bool force)

{

	struct rtw89_cfo_tracking_info *cfo = &rtwdev->cfo_tracking;

	const struct rtw89_chip_info *chip = rtwdev->chip;

	u8 sc_xi_val, sc_xo_val;



	if (!force && cfo->crystal_cap == crystal_cap)

		return;

	crystal_cap = clamp_t(u8, crystal_cap, 0, 127);

	if (chip->chip_id == RTL8852A) {

		rtw89_phy_cfo_set_xcap_reg(rtwdev, true, crystal_cap);

		rtw89_phy_cfo_set_xcap_reg(rtwdev, false, crystal_cap);

		sc_xo_val = rtw89_phy_cfo_get_xcap_reg(rtwdev, true);

		sc_xi_val = rtw89_phy_cfo_get_xcap_reg(rtwdev, false);

	} else {

		rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_XTAL_SC_XO,

					crystal_cap, XTAL_SC_XO_MASK);

		rtw89_mac_write_xtal_si(rtwdev, XTAL_SI_XTAL_SC_XI,

					crystal_cap, XTAL_SC_XI_MASK);

		rtw89_mac_read_xtal_si(rtwdev, XTAL_SI_XTAL_SC_XO, &sc_xo_val);

		rtw89_mac_read_xtal_si(rtwdev, XTAL_SI_XTAL_SC_XI, &sc_xi_val);

	}

	cfo->crystal_cap = sc_xi_val;

	cfo->x_cap_ofst = (s8)((int)cfo->crystal_cap - cfo->def_x_cap);