wifi: rtw89: 8922a: read efuse content from physical map

The calibration values of thermal and bias are programmed in invariable
physical map. Read them into driver and will set them to registers later.

Signed-off-by: Ping-Ke Shih <pkshih@realtek.com>
Signed-off-by: Kalle Valo <kvalo@kernel.org>
Link: https://lore.kernel.org/r/20231117024029.113845-7-pkshih@realtek.com

diff --git a/drivers/net/wireless/realtek/rtw89/core.h b/drivers/net/wireless/realtek/rtw89/core.h
index 73b2e74885d0a7fc7ae1f555e6a2e40c8aff8803..6948ffe0f2061024eff36f9a21af03b7af53ec9c 100644 (file)
--- a/drivers/net/wireless/realtek/rtw89/core.h
+++ b/drivers/net/wireless/realtek/rtw89/core.h
@@ -4345,6 +4345,7 @@ struct rtw89_power_trim_info {
        bool pg_pa_bias_trim;
        u8 thermal_trim[RF_PATH_MAX];
        u8 pa_bias_trim[RF_PATH_MAX];
+       u8 pad_bias_trim[RF_PATH_MAX];
 };
 
 struct rtw89_regd {

diff --git a/drivers/net/wireless/realtek/rtw89/rtw8922a.c b/drivers/net/wireless/realtek/rtw89/rtw8922a.c
index bed74ab4a7c22de3d77d9358a379bc552b9fd9e5..d190f095a5a8f48f31289b97b07da7ece6909d4e 100644 (file)
--- a/drivers/net/wireless/realtek/rtw89/rtw8922a.c
+++ b/drivers/net/wireless/realtek/rtw89/rtw8922a.c
@@ -175,6 +175,92 @@ static int rtw8922a_read_efuse(struct rtw89_dev *rtwdev, u8 *log_map,
        }
 }
 
+#define THM_TRIM_POSITIVE_MASK BIT(6)
+#define THM_TRIM_MAGNITUDE_MASK GENMASK(5, 0)
+
+static void rtw8922a_phycap_parsing_thermal_trim(struct rtw89_dev *rtwdev,
+                                                u8 *phycap_map)
+{
+       static const u32 thm_trim_addr[RF_PATH_NUM_8922A] = {0x1706, 0x1733};
+       struct rtw89_power_trim_info *info = &rtwdev->pwr_trim;
+       u32 addr = rtwdev->chip->phycap_addr;
+       bool pg = true;
+       u8 pg_th;
+       s8 val;
+       u8 i;
+
+       for (i = 0; i < RF_PATH_NUM_8922A; i++) {
+               pg_th = phycap_map[thm_trim_addr[i] - addr];
+               if (pg_th == 0xff) {
+                       info->thermal_trim[i] = 0;
+                       pg = false;
+                       break;
+               }
+
+               val = u8_get_bits(pg_th, THM_TRIM_MAGNITUDE_MASK);
+
+               if (!(pg_th & THM_TRIM_POSITIVE_MASK))
+                       val *= -1;
+
+               info->thermal_trim[i] = val;
+
+               rtw89_debug(rtwdev, RTW89_DBG_RFK,
+                           "[THERMAL][TRIM] path=%d thermal_trim=0x%x (%d)\n",
+                           i, pg_th, val);
+       }
+
+       info->pg_thermal_trim = pg;
+}
+
+static void rtw8922a_phycap_parsing_pa_bias_trim(struct rtw89_dev *rtwdev,
+                                                u8 *phycap_map)
+{
+       static const u32 pabias_trim_addr[RF_PATH_NUM_8922A] = {0x1707, 0x1734};
+       static const u32 check_pa_pad_trim_addr = 0x1700;
+       struct rtw89_power_trim_info *info = &rtwdev->pwr_trim;
+       u32 addr = rtwdev->chip->phycap_addr;
+       u8 val;
+       u8 i;
+
+       val = phycap_map[check_pa_pad_trim_addr - addr];
+       if (val != 0xff)
+               info->pg_pa_bias_trim = true;
+
+       for (i = 0; i < RF_PATH_NUM_8922A; i++) {
+               info->pa_bias_trim[i] = phycap_map[pabias_trim_addr[i] - addr];
+
+               rtw89_debug(rtwdev, RTW89_DBG_RFK,
+                           "[PA_BIAS][TRIM] path=%d pa_bias_trim=0x%x\n",
+                           i, info->pa_bias_trim[i]);
+       }
+}
+
+static void rtw8922a_phycap_parsing_pad_bias_trim(struct rtw89_dev *rtwdev,
+                                                 u8 *phycap_map)
+{
+       static const u32 pad_bias_trim_addr[RF_PATH_NUM_8922A] = {0x1708, 0x1735};
+       struct rtw89_power_trim_info *info = &rtwdev->pwr_trim;
+       u32 addr = rtwdev->chip->phycap_addr;
+       u8 i;
+
+       for (i = 0; i < RF_PATH_NUM_8922A; i++) {
+               info->pad_bias_trim[i] = phycap_map[pad_bias_trim_addr[i] - addr];
+
+               rtw89_debug(rtwdev, RTW89_DBG_RFK,
+                           "[PAD_BIAS][TRIM] path=%d pad_bias_trim=0x%x\n",
+                           i, info->pad_bias_trim[i]);
+       }
+}
+
+static int rtw8922a_read_phycap(struct rtw89_dev *rtwdev, u8 *phycap_map)
+{
+       rtw8922a_phycap_parsing_thermal_trim(rtwdev, phycap_map);
+       rtw8922a_phycap_parsing_pa_bias_trim(rtwdev, phycap_map);
+       rtw8922a_phycap_parsing_pad_bias_trim(rtwdev, phycap_map);
+
+       return 0;
+}
+
 #ifdef CONFIG_PM
 static const struct wiphy_wowlan_support rtw_wowlan_stub_8922a = {
        .flags = WIPHY_WOWLAN_MAGIC_PKT | WIPHY_WOWLAN_DISCONNECT,
@@ -186,6 +272,7 @@ static const struct wiphy_wowlan_support rtw_wowlan_stub_8922a = {
 
 static const struct rtw89_chip_ops rtw8922a_chip_ops = {
        .read_efuse             = rtw8922a_read_efuse,
+       .read_phycap            = rtw8922a_read_phycap,
 };
 
 const struct rtw89_chip_info rtw8922a_chip_info = {