wifi: ath12k: ACPI SAR support
authorLingbo Kong <quic_lingbok@quicinc.com>
Mon, 22 Apr 2024 13:18:44 +0000 (16:18 +0300)
committerKalle Valo <quic_kvalo@quicinc.com>
Tue, 23 Apr 2024 09:29:14 +0000 (12:29 +0300)
In order to enable ACPI SAR (Specific Absorption Rate), ath12k gets SAR and GEO
offset tables from ACPI and sends the data to firmware using
WMI_PDEV_SET_BIOS_SAR_TABLE_CMDID and WMI_PDEV_SET_BIOS_GEO_TABLE_CMDID
commands.

Tested-on: WCN7850 hw2.0 PCI WLAN.HMT.1.0-03427-QCAHMTSWPL_V1.0_V2.0_SILICONZ-1.15378.4

Signed-off-by: Lingbo Kong <quic_lingbok@quicinc.com>
Signed-off-by: Kalle Valo <quic_kvalo@quicinc.com>
Link: https://msgid.link/20240422033054.979-3-quic_lingbok@quicinc.com
drivers/net/wireless/ath/ath12k/acpi.c
drivers/net/wireless/ath/ath12k/acpi.h
drivers/net/wireless/ath/ath12k/core.h
drivers/net/wireless/ath/ath12k/wmi.c
drivers/net/wireless/ath/ath12k/wmi.h

index dc8135703fc7e38c0d27d2373f62b22390219c97..177babc50f25311242410495a863c133ee7a5777 100644 (file)
@@ -55,6 +55,30 @@ static int ath12k_acpi_dsm_get_data(struct ath12k_base *ab, int func)
                        memcpy(&ab->acpi.tas_sar_power_table, obj->buffer.pointer,
                               obj->buffer.length);
 
+                       break;
+               case ATH12K_ACPI_DSM_FUNC_BIOS_SAR:
+                       if (obj->buffer.length != ATH12K_ACPI_DSM_BIOS_SAR_DATA_SIZE) {
+                               ath12k_warn(ab, "invalid ACPI BIOS SAR data size: %d\n",
+                                           obj->buffer.length);
+                               ret = -EINVAL;
+                               goto out;
+                       }
+
+                       memcpy(&ab->acpi.bios_sar_data, obj->buffer.pointer,
+                              obj->buffer.length);
+
+                       break;
+               case ATH12K_ACPI_DSM_FUNC_GEO_OFFSET:
+                       if (obj->buffer.length != ATH12K_ACPI_DSM_GEO_OFFSET_DATA_SIZE) {
+                               ath12k_warn(ab, "invalid ACPI GEO OFFSET data size: %d\n",
+                                           obj->buffer.length);
+                               ret = -EINVAL;
+                               goto out;
+                       }
+
+                       memcpy(&ab->acpi.geo_offset_data, obj->buffer.pointer,
+                              obj->buffer.length);
+
                        break;
                }
        } else {
@@ -93,6 +117,25 @@ static int ath12k_acpi_set_power_limit(struct ath12k_base *ab)
        return ret;
 }
 
+static int ath12k_acpi_set_bios_sar_power(struct ath12k_base *ab)
+{
+       int ret;
+
+       if (ab->acpi.bios_sar_data[0] != ATH12K_ACPI_POWER_LIMIT_VERSION ||
+           ab->acpi.bios_sar_data[1] != ATH12K_ACPI_POWER_LIMIT_ENABLE_FLAG) {
+               ath12k_warn(ab, "invalid latest ACPI BIOS SAR data\n");
+               return -EINVAL;
+       }
+
+       ret = ath12k_wmi_set_bios_sar_cmd(ab, ab->acpi.bios_sar_data);
+       if (ret) {
+               ath12k_warn(ab, "failed to set ACPI BIOS SAR table: %d\n", ret);
+               return ret;
+       }
+
+       return 0;
+}
+
 static void ath12k_acpi_dsm_notify(acpi_handle handle, u32 event, void *data)
 {
        int ret;
@@ -119,6 +162,40 @@ static void ath12k_acpi_dsm_notify(acpi_handle handle, u32 event, void *data)
                ath12k_warn(ab, "failed to set ACPI TAS power limit data: %d", ret);
                return;
        }
+
+       if (!ab->acpi.acpi_bios_sar_enable)
+               return;
+
+       ret = ath12k_acpi_dsm_get_data(ab, ATH12K_ACPI_DSM_FUNC_BIOS_SAR);
+       if (ret) {
+               ath12k_warn(ab, "failed to update BIOS SAR: %d\n", ret);
+               return;
+       }
+
+       ret = ath12k_acpi_set_bios_sar_power(ab);
+       if (ret) {
+               ath12k_warn(ab, "failed to set BIOS SAR power limit: %d\n", ret);
+               return;
+       }
+}
+
+static int ath12k_acpi_set_bios_sar_params(struct ath12k_base *ab)
+{
+       int ret;
+
+       ret = ath12k_wmi_set_bios_sar_cmd(ab, ab->acpi.bios_sar_data);
+       if (ret) {
+               ath12k_warn(ab, "failed to set ACPI BIOS SAR table: %d\n", ret);
+               return ret;
+       }
+
+       ret = ath12k_wmi_set_bios_geo_cmd(ab, ab->acpi.geo_offset_data);
+       if (ret) {
+               ath12k_warn(ab, "failed to set ACPI BIOS GEO table: %d\n", ret);
+               return ret;
+       }
+
+       return 0;
 }
 
 static int ath12k_acpi_set_tas_params(struct ath12k_base *ab)
@@ -184,6 +261,28 @@ int ath12k_acpi_start(struct ath12k_base *ab)
                        ab->acpi.acpi_tas_enable = true;
        }
 
+       if (ATH12K_ACPI_FUNC_BIT_VALID(ab->acpi, ATH12K_ACPI_FUNC_BIT_BIOS_SAR)) {
+               ret = ath12k_acpi_dsm_get_data(ab, ATH12K_ACPI_DSM_FUNC_BIOS_SAR);
+               if (ret) {
+                       ath12k_warn(ab, "failed to get ACPI bios sar data: %d\n", ret);
+                       return ret;
+               }
+       }
+
+       if (ATH12K_ACPI_FUNC_BIT_VALID(ab->acpi, ATH12K_ACPI_FUNC_BIT_GEO_OFFSET)) {
+               ret = ath12k_acpi_dsm_get_data(ab, ATH12K_ACPI_DSM_FUNC_GEO_OFFSET);
+               if (ret) {
+                       ath12k_warn(ab, "failed to get ACPI geo offset data: %d\n", ret);
+                       return ret;
+               }
+
+               if (ATH12K_ACPI_FUNC_BIT_VALID(ab->acpi, ATH12K_ACPI_FUNC_BIT_BIOS_SAR) &&
+                   ab->acpi.bios_sar_data[0] == ATH12K_ACPI_POWER_LIMIT_VERSION &&
+                   ab->acpi.bios_sar_data[1] == ATH12K_ACPI_POWER_LIMIT_ENABLE_FLAG &&
+                   !ab->acpi.acpi_tas_enable)
+                       ab->acpi.acpi_bios_sar_enable = true;
+       }
+
        if (ab->acpi.acpi_tas_enable) {
                ret = ath12k_acpi_set_tas_params(ab);
                if (ret) {
@@ -192,6 +291,12 @@ int ath12k_acpi_start(struct ath12k_base *ab)
                }
        }
 
+       if (ab->acpi.acpi_bios_sar_enable) {
+               ret = ath12k_acpi_set_bios_sar_params(ab);
+               if (ret)
+                       return ret;
+       }
+
        status = acpi_install_notify_handler(ACPI_HANDLE(ab->dev),
                                             ACPI_DEVICE_NOTIFY,
                                             ath12k_acpi_dsm_notify, ab);
index be7d1d9b0d283454529a31f13f98cd888b2e62d2..7ade8b3f640d3bd05c4dbe394cc5f24152edaf7d 100644 (file)
@@ -9,9 +9,13 @@
 #include <linux/acpi.h>
 
 #define ATH12K_ACPI_DSM_FUNC_SUPPORT_FUNCS     0
+#define ATH12K_ACPI_DSM_FUNC_BIOS_SAR          4
+#define ATH12K_ACPI_DSM_FUNC_GEO_OFFSET                5
 #define ATH12K_ACPI_DSM_FUNC_TAS_CFG           8
 #define ATH12K_ACPI_DSM_FUNC_TAS_DATA          9
 
+#define ATH12K_ACPI_FUNC_BIT_BIOS_SAR                  BIT(3)
+#define ATH12K_ACPI_FUNC_BIT_GEO_OFFSET                        BIT(4)
 #define ATH12K_ACPI_FUNC_BIT_TAS_CFG                   BIT(7)
 #define ATH12K_ACPI_FUNC_BIT_TAS_DATA                  BIT(8)
 
 
 #define ATH12K_ACPI_TAS_DATA_VERSION           0x1
 #define ATH12K_ACPI_TAS_DATA_ENABLE            0x1
+#define ATH12K_ACPI_POWER_LIMIT_VERSION                0x1
+#define ATH12K_ACPI_POWER_LIMIT_ENABLE_FLAG    0x1
+
+#define ATH12K_ACPI_GEO_OFFSET_DATA_OFFSET     1
+#define ATH12K_ACPI_DBS_BACKOFF_DATA_OFFSET    2
+#define ATH12K_ACPI_BIOS_SAR_DBS_BACKOFF_LEN   10
+#define ATH12K_ACPI_POWER_LIMIT_DATA_OFFSET    12
+#define ATH12K_ACPI_BIOS_SAR_GEO_OFFSET_LEN    18
+#define ATH12K_ACPI_BIOS_SAR_TABLE_LEN         22
 
 #define ATH12K_ACPI_DSM_TAS_DATA_SIZE                  69
 #define ATH12K_ACPI_DSM_TAS_CFG_SIZE                   108
 
+#define ATH12K_ACPI_DSM_GEO_OFFSET_DATA_SIZE (ATH12K_ACPI_GEO_OFFSET_DATA_OFFSET + \
+                                             ATH12K_ACPI_BIOS_SAR_GEO_OFFSET_LEN)
+#define ATH12K_ACPI_DSM_BIOS_SAR_DATA_SIZE (ATH12K_ACPI_POWER_LIMIT_DATA_OFFSET + \
+                                           ATH12K_ACPI_BIOS_SAR_TABLE_LEN)
+
 #ifdef CONFIG_ACPI
 
 int ath12k_acpi_start(struct ath12k_base *ab);
index 465d7decb8106ceb560d728a853147b10b219f19..40ace809554a6e8363751791a4e1194d1e2d7d15 100644 (file)
@@ -910,8 +910,11 @@ struct ath12k_base {
                bool started;
                u32 func_bit;
                bool acpi_tas_enable;
+               bool acpi_bios_sar_enable;
                u8 tas_cfg[ATH12K_ACPI_DSM_TAS_CFG_SIZE];
                u8 tas_sar_power_table[ATH12K_ACPI_DSM_TAS_DATA_SIZE];
+               u8 bios_sar_data[ATH12K_ACPI_DSM_BIOS_SAR_DATA_SIZE];
+               u8 geo_offset_data[ATH12K_ACPI_DSM_GEO_OFFSET_DATA_SIZE];
        } acpi;
 
 #endif /* CONFIG_ACPI */
index 511c1e9a2d8947ef1318810eb6d44502eeba4652..c2fb977d33f6443fc48f6c2222ed6be3d53ad8cb 100644 (file)
@@ -2767,6 +2767,105 @@ int ath12k_wmi_set_bios_cmd(struct ath12k_base *ab, u32 param_id,
        return 0;
 }
 
+int ath12k_wmi_set_bios_sar_cmd(struct ath12k_base *ab, const u8 *psar_table)
+{
+       struct ath12k_wmi_base *wmi_ab = &ab->wmi_ab;
+       struct wmi_pdev_set_bios_sar_table_cmd *cmd;
+       struct wmi_tlv *tlv;
+       struct sk_buff *skb;
+       int ret;
+       u8 *buf_ptr;
+       u32 len, sar_table_len_aligned, sar_dbs_backoff_len_aligned;
+       const u8 *psar_value = psar_table + ATH12K_ACPI_POWER_LIMIT_DATA_OFFSET;
+       const u8 *pdbs_value = psar_table + ATH12K_ACPI_DBS_BACKOFF_DATA_OFFSET;
+
+       sar_table_len_aligned = roundup(ATH12K_ACPI_BIOS_SAR_TABLE_LEN, sizeof(u32));
+       sar_dbs_backoff_len_aligned = roundup(ATH12K_ACPI_BIOS_SAR_DBS_BACKOFF_LEN,
+                                             sizeof(u32));
+       len = sizeof(*cmd) + TLV_HDR_SIZE + sar_table_len_aligned +
+               TLV_HDR_SIZE + sar_dbs_backoff_len_aligned;
+
+       skb = ath12k_wmi_alloc_skb(wmi_ab, len);
+       if (!skb)
+               return -ENOMEM;
+
+       cmd = (struct wmi_pdev_set_bios_sar_table_cmd *)skb->data;
+       cmd->tlv_header = ath12k_wmi_tlv_cmd_hdr(WMI_TAG_PDEV_SET_BIOS_SAR_TABLE_CMD,
+                                                sizeof(*cmd));
+       cmd->pdev_id = cpu_to_le32(WMI_PDEV_ID_SOC);
+       cmd->sar_len = cpu_to_le32(ATH12K_ACPI_BIOS_SAR_TABLE_LEN);
+       cmd->dbs_backoff_len = cpu_to_le32(ATH12K_ACPI_BIOS_SAR_DBS_BACKOFF_LEN);
+
+       buf_ptr = skb->data + sizeof(*cmd);
+       tlv = (struct wmi_tlv *)buf_ptr;
+       tlv->header = ath12k_wmi_tlv_hdr(WMI_TAG_ARRAY_BYTE,
+                                        sar_table_len_aligned);
+       buf_ptr += TLV_HDR_SIZE;
+       memcpy(buf_ptr, psar_value, ATH12K_ACPI_BIOS_SAR_TABLE_LEN);
+
+       buf_ptr += sar_table_len_aligned;
+       tlv = (struct wmi_tlv *)buf_ptr;
+       tlv->header = ath12k_wmi_tlv_hdr(WMI_TAG_ARRAY_BYTE,
+                                        sar_dbs_backoff_len_aligned);
+       buf_ptr += TLV_HDR_SIZE;
+       memcpy(buf_ptr, pdbs_value, ATH12K_ACPI_BIOS_SAR_DBS_BACKOFF_LEN);
+
+       ret = ath12k_wmi_cmd_send(&wmi_ab->wmi[0],
+                                 skb,
+                                 WMI_PDEV_SET_BIOS_SAR_TABLE_CMDID);
+       if (ret) {
+               ath12k_warn(ab,
+                           "failed to send WMI_PDEV_SET_BIOS_INTERFACE_CMDID %d\n",
+                           ret);
+               dev_kfree_skb(skb);
+       }
+
+       return ret;
+}
+
+int ath12k_wmi_set_bios_geo_cmd(struct ath12k_base *ab, const u8 *pgeo_table)
+{
+       struct ath12k_wmi_base *wmi_ab = &ab->wmi_ab;
+       struct wmi_pdev_set_bios_geo_table_cmd *cmd;
+       struct wmi_tlv *tlv;
+       struct sk_buff *skb;
+       int ret;
+       u8 *buf_ptr;
+       u32 len, sar_geo_len_aligned;
+       const u8 *pgeo_value = pgeo_table + ATH12K_ACPI_GEO_OFFSET_DATA_OFFSET;
+
+       sar_geo_len_aligned = roundup(ATH12K_ACPI_BIOS_SAR_GEO_OFFSET_LEN, sizeof(u32));
+       len = sizeof(*cmd) + TLV_HDR_SIZE + sar_geo_len_aligned;
+
+       skb = ath12k_wmi_alloc_skb(wmi_ab, len);
+       if (!skb)
+               return -ENOMEM;
+
+       cmd = (struct wmi_pdev_set_bios_geo_table_cmd *)skb->data;
+       cmd->tlv_header = ath12k_wmi_tlv_cmd_hdr(WMI_TAG_PDEV_SET_BIOS_GEO_TABLE_CMD,
+                                                sizeof(*cmd));
+       cmd->pdev_id = cpu_to_le32(WMI_PDEV_ID_SOC);
+       cmd->geo_len = cpu_to_le32(ATH12K_ACPI_BIOS_SAR_GEO_OFFSET_LEN);
+
+       buf_ptr = skb->data + sizeof(*cmd);
+       tlv = (struct wmi_tlv *)buf_ptr;
+       tlv->header = ath12k_wmi_tlv_hdr(WMI_TAG_ARRAY_BYTE, sar_geo_len_aligned);
+       buf_ptr += TLV_HDR_SIZE;
+       memcpy(buf_ptr, pgeo_value, ATH12K_ACPI_BIOS_SAR_GEO_OFFSET_LEN);
+
+       ret = ath12k_wmi_cmd_send(&wmi_ab->wmi[0],
+                                 skb,
+                                 WMI_PDEV_SET_BIOS_GEO_TABLE_CMDID);
+       if (ret) {
+               ath12k_warn(ab,
+                           "failed to send WMI_PDEV_SET_BIOS_GEO_TABLE_CMDID %d\n",
+                           ret);
+               dev_kfree_skb(skb);
+       }
+
+       return ret;
+}
+
 int ath12k_wmi_delba_send(struct ath12k *ar, u32 vdev_id, const u8 *mac,
                          u32 tid, u32 initiator, u32 reason)
 {
index ad9cdd3d69aac9c2300c562c3ce141c432d22c9a..8ace566f7eb573c0a9ac9da0fd1afe123a52f4db 100644 (file)
@@ -353,6 +353,8 @@ enum wmi_tlv_cmd_id {
        WMI_PDEV_DMA_RING_CFG_REQ_CMDID,
        WMI_PDEV_HE_TB_ACTION_FRM_CMDID,
        WMI_PDEV_PKTLOG_FILTER_CMDID,
+       WMI_PDEV_SET_BIOS_SAR_TABLE_CMDID = 0x4044,
+       WMI_PDEV_SET_BIOS_GEO_TABLE_CMDID = 0x4045,
        WMI_PDEV_SET_BIOS_INTERFACE_CMDID = 0x404A,
        WMI_VDEV_CREATE_CMDID = WMI_TLV_CMD(WMI_GRP_VDEV),
        WMI_VDEV_DELETE_CMDID,
@@ -1926,6 +1928,8 @@ enum wmi_tlv_tag {
        WMI_TAG_REGULATORY_RULE_EXT_STRUCT = 0x3A9,
        WMI_TAG_REG_CHAN_LIST_CC_EXT_EVENT,
        WMI_TAG_EHT_RATE_SET = 0x3C4,
+       WMI_TAG_PDEV_SET_BIOS_SAR_TABLE_CMD = 0x3D8,
+       WMI_TAG_PDEV_SET_BIOS_GEO_TABLE_CMD = 0x3D9,
        WMI_TAG_PDEV_SET_BIOS_INTERFACE_CMD = 0x3FB,
        WMI_TAG_MAX
 };
@@ -4806,6 +4810,19 @@ enum wmi_bios_param_type {
        WMI_BIOS_PARAM_TYPE_MAX,
 };
 
+struct wmi_pdev_set_bios_sar_table_cmd {
+       __le32 tlv_header;
+       __le32 pdev_id;
+       __le32 sar_len;
+       __le32 dbs_backoff_len;
+} __packed;
+
+struct wmi_pdev_set_bios_geo_table_cmd {
+       __le32 tlv_header;
+       __le32 pdev_id;
+       __le32 geo_len;
+} __packed;
+
 #define ATH12K_FW_STATS_BUF_SIZE (1024 * 1024)
 
 enum wmi_sys_cap_info_flags {
@@ -4966,6 +4983,8 @@ int ath12k_wmi_set_hw_mode(struct ath12k_base *ab,
                           enum wmi_host_hw_mode_config_type mode);
 int ath12k_wmi_set_bios_cmd(struct ath12k_base *ab, u32 param_id,
                            const u8 *buf, size_t buf_len);
+int ath12k_wmi_set_bios_sar_cmd(struct ath12k_base *ab, const u8 *psar_table);
+int ath12k_wmi_set_bios_geo_cmd(struct ath12k_base *ab, const u8 *pgeo_table);
 
 static inline u32
 ath12k_wmi_caps_ext_get_pdev_id(const struct ath12k_wmi_caps_ext_params *param)