Quelle  acpi.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
/* Copyright(c) 2021-2023  Realtek Corporation
 */

#include <linux/acpi.h>
#include <linux/uuid.h>

#include "acpi.h"
#include "debug.h"

static const guid_t rtw89_guid = GUID_INIT(0xD2A8C3E8, 0x4B69, 0x4F00,
        0x82, 0xBD, 0xFE, 0x86,
        0x07, 0x80, 0x3A, 0xA7);

static u32 rtw89_acpi_traversal_object(struct rtw89_dev *rtwdev,
           const union acpi_object *obj, u8 *pos)
{
 const union acpi_object *elm;
 unsigned int i;
 u32 sub_len;
 u32 len = 0;
 u8 *tmp;

 switch (obj->type) {
 case ACPI_TYPE_INTEGER:
  if (pos)
   pos[len] = obj->integer.value;

  len++;
  break;
 case ACPI_TYPE_BUFFER:
  if (unlikely(obj->buffer.length == 0)) {
   rtw89_debug(rtwdev, RTW89_DBG_ACPI,
        "%s: invalid buffer type\n", __func__);
   goto err;
  }

  if (pos)
   memcpy(pos, obj->buffer.pointer, obj->buffer.length);

  len += obj->buffer.length;
  break;
 case ACPI_TYPE_PACKAGE:
  if (unlikely(obj->package.count == 0)) {
   rtw89_debug(rtwdev, RTW89_DBG_ACPI,
        "%s: invalid package type\n", __func__);
   goto err;
  }

  for (i = 0; i < obj->package.count; i++) {
   elm = &obj->package.elements[i];
   tmp = pos ? pos + len : NULL;

   sub_len = rtw89_acpi_traversal_object(rtwdev, elm, tmp);
   if (unlikely(sub_len == 0))
    goto err;

   len += sub_len;
  }
  break;
 default:
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: unhandled type: %d\n",
       __func__, obj->type);
  goto err;
 }

 return len;

err:
 return 0;
}

static u32 rtw89_acpi_calculate_object_length(struct rtw89_dev *rtwdev,
           const union acpi_object *obj)
{
 return rtw89_acpi_traversal_object(rtwdev, obj, NULL);
}

static struct rtw89_acpi_data *
rtw89_acpi_evaluate_method(struct rtw89_dev *rtwdev, const char *method)
{
 struct acpi_buffer buf = {ACPI_ALLOCATE_BUFFER, NULL};
 struct rtw89_acpi_data *data = NULL;
 acpi_handle root, handle;
 union acpi_object *obj;
 acpi_status status;
 u32 len;

 root = ACPI_HANDLE(rtwdev->dev);
 if (!root) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "acpi (%s): failed to get root\n", method);
  return NULL;
 }

 status = acpi_get_handle(root, (acpi_string)method, &handle);
 if (ACPI_FAILURE(status)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "acpi (%s): failed to get handle\n", method);
  return NULL;
 }

 status = acpi_evaluate_object(handle, NULL, NULL, &buf);
 if (ACPI_FAILURE(status)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "acpi (%s): failed to evaluate object\n", method);
  return NULL;
 }

 obj = buf.pointer;
 len = rtw89_acpi_calculate_object_length(rtwdev, obj);
 if (unlikely(len == 0)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "acpi (%s): failed to traversal obj len\n", method);
  goto out;
 }

 data = kzalloc(struct_size(data, buf, len), GFP_KERNEL);
 if (!data)
  goto out;

 data->len = len;
 rtw89_acpi_traversal_object(rtwdev, obj, data->buf);

out:
 ACPI_FREE(obj);
 return data;
}

static
int rtw89_acpi_dsm_get_value(struct rtw89_dev *rtwdev, union acpi_object *obj,
        u8 *value)
{
 if (obj->type != ACPI_TYPE_INTEGER) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "acpi: expect integer but type: %d\n", obj->type);
  return -EINVAL;
 }

 *value = (u8)obj->integer.value;
 return 0;
}

static bool chk_acpi_policy_6ghz_sig(const struct rtw89_acpi_policy_6ghz *p)
{
 return p->signature[0] == 0x00 &&
        p->signature[1] == 0xE0 &&
        p->signature[2] == 0x4C;
}

static
int rtw89_acpi_dsm_get_policy_6ghz(struct rtw89_dev *rtwdev,
       union acpi_object *obj,
       struct rtw89_acpi_policy_6ghz **policy_6ghz)
{
 const struct rtw89_acpi_policy_6ghz *ptr;
 u32 expect_len;
 u32 len;

 if (obj->type != ACPI_TYPE_BUFFER) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "acpi: expect buffer but type: %d\n", obj->type);
  return -EINVAL;
 }

 len = obj->buffer.length;
 if (len < sizeof(*ptr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: invalid buffer length: %u\n",
       __func__, len);
  return -EINVAL;
 }

 ptr = (typeof(ptr))obj->buffer.pointer;
 if (!chk_acpi_policy_6ghz_sig(ptr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: bad signature\n", __func__);
  return -EINVAL;
 }

 expect_len = struct_size(ptr, country_list, ptr->country_count);
 if (len < expect_len) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: expect %u but length: %u\n",
       __func__, expect_len, len);
  return -EINVAL;
 }

 *policy_6ghz = kmemdup(ptr, expect_len, GFP_KERNEL);
 if (!*policy_6ghz)
  return -ENOMEM;

 rtw89_hex_dump(rtwdev, RTW89_DBG_ACPI, "policy_6ghz: ", *policy_6ghz,
         expect_len);
 return 0;
}

static bool chk_acpi_policy_6ghz_sp_sig(const struct rtw89_acpi_policy_6ghz_sp *p)
{
 return p->signature[0] == 0x52 &&
        p->signature[1] == 0x54 &&
        p->signature[2] == 0x4B &&
        p->signature[3] == 0x07;
}

static
int rtw89_acpi_dsm_get_policy_6ghz_sp(struct rtw89_dev *rtwdev,
          union acpi_object *obj,
          struct rtw89_acpi_policy_6ghz_sp **policy)
{
 const struct rtw89_acpi_policy_6ghz_sp *ptr;
 u32 buf_len;

 if (obj->type != ACPI_TYPE_BUFFER) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "acpi: expect buffer but type: %d\n", obj->type);
  return -EINVAL;
 }

 buf_len = obj->buffer.length;
 if (buf_len < sizeof(*ptr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: invalid buffer length: %u\n",
       __func__, buf_len);
  return -EINVAL;
 }

 ptr = (typeof(ptr))obj->buffer.pointer;
 if (!chk_acpi_policy_6ghz_sp_sig(ptr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: bad signature\n", __func__);
  return -EINVAL;
 }

 *policy = kmemdup(ptr, sizeof(*ptr), GFP_KERNEL);
 if (!*policy)
  return -ENOMEM;

 rtw89_hex_dump(rtwdev, RTW89_DBG_ACPI, "policy_6ghz_sp: ", *policy,
         sizeof(*ptr));
 return 0;
}

static bool chk_acpi_policy_6ghz_vlp_sig(const struct rtw89_acpi_policy_6ghz_vlp *p)
{
 return p->signature[0] == 0x52 &&
        p->signature[1] == 0x54 &&
        p->signature[2] == 0x4B &&
        p->signature[3] == 0x0B;
}

static
int rtw89_acpi_dsm_get_policy_6ghz_vlp(struct rtw89_dev *rtwdev,
           union acpi_object *obj,
           struct rtw89_acpi_policy_6ghz_vlp **policy)
{
 const struct rtw89_acpi_policy_6ghz_vlp *ptr;
 u32 buf_len;

 if (obj->type != ACPI_TYPE_BUFFER) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "acpi: expect buffer but type: %d\n", obj->type);
  return -EINVAL;
 }

 buf_len = obj->buffer.length;
 if (buf_len < sizeof(*ptr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: invalid buffer length: %u\n",
       __func__, buf_len);
  return -EINVAL;
 }

 ptr = (typeof(ptr))obj->buffer.pointer;
 if (!chk_acpi_policy_6ghz_vlp_sig(ptr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: bad signature\n", __func__);
  return -EINVAL;
 }

 *policy = kmemdup(ptr, sizeof(*ptr), GFP_KERNEL);
 if (!*policy)
  return -ENOMEM;

 rtw89_hex_dump(rtwdev, RTW89_DBG_ACPI, "policy_6ghz_vlp: ", *policy,
         sizeof(*ptr));
 return 0;
}

static bool chk_acpi_policy_tas_sig(const struct rtw89_acpi_policy_tas *p)
{
 return p->signature[0] == 0x52 &&
        p->signature[1] == 0x54 &&
        p->signature[2] == 0x4B &&
        p->signature[3] == 0x05;
}

static int rtw89_acpi_dsm_get_policy_tas(struct rtw89_dev *rtwdev,
      union acpi_object *obj,
      struct rtw89_acpi_policy_tas **policy)
{
 const struct rtw89_acpi_policy_tas *ptr;
 u32 buf_len;

 if (obj->type != ACPI_TYPE_BUFFER) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "acpi: expect buffer but type: %d\n", obj->type);
  return -EINVAL;
 }

 buf_len = obj->buffer.length;
 if (buf_len < sizeof(*ptr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: invalid buffer length: %u\n",
       __func__, buf_len);
  return -EINVAL;
 }

 ptr = (typeof(ptr))obj->buffer.pointer;
 if (!chk_acpi_policy_tas_sig(ptr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: bad signature\n", __func__);
  return -EINVAL;
 }

 *policy = kmemdup(ptr, sizeof(*ptr), GFP_KERNEL);
 if (!*policy)
  return -ENOMEM;

 rtw89_hex_dump(rtwdev, RTW89_DBG_ACPI, "policy_tas: ", *policy,
         sizeof(*ptr));
 return 0;
}

static
bool chk_acpi_policy_reg_rules_sig(const struct rtw89_acpi_policy_reg_rules *p)
{
 return p->signature[0] == 0x52 &&
        p->signature[1] == 0x54 &&
        p->signature[2] == 0x4B &&
        p->signature[3] == 0x0A;
}

static
int rtw89_acpi_dsm_get_policy_reg_rules(struct rtw89_dev *rtwdev,
     union acpi_object *obj,
     struct rtw89_acpi_policy_reg_rules **policy)
{
 const struct rtw89_acpi_policy_reg_rules *ptr;
 u32 buf_len;

 if (obj->type != ACPI_TYPE_BUFFER) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "acpi: expect buffer but type: %d\n", obj->type);
  return -EINVAL;
 }

 buf_len = obj->buffer.length;
 if (buf_len < sizeof(*ptr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: invalid buffer length: %u\n",
       __func__, buf_len);
  return -EINVAL;
 }

 ptr = (typeof(ptr))obj->buffer.pointer;
 if (!chk_acpi_policy_reg_rules_sig(ptr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: bad signature\n", __func__);
  return -EINVAL;
 }

 *policy = kmemdup(ptr, sizeof(*ptr), GFP_KERNEL);
 if (!*policy)
  return -ENOMEM;

 rtw89_hex_dump(rtwdev, RTW89_DBG_ACPI, "policy_reg_rules: ", *policy,
         sizeof(*ptr));
 return 0;
}

int rtw89_acpi_evaluate_dsm(struct rtw89_dev *rtwdev,
       enum rtw89_acpi_dsm_func func,
       struct rtw89_acpi_dsm_result *res)
{
 union acpi_object *obj;
 int ret;

 obj = acpi_evaluate_dsm(ACPI_HANDLE(rtwdev->dev), &rtw89_guid,
    0, func, NULL);
 if (!obj) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "acpi dsm fail to evaluate func: %d\n", func);
  return -ENOENT;
 }

 if (func == RTW89_ACPI_DSM_FUNC_6G_BP)
  ret = rtw89_acpi_dsm_get_policy_6ghz(rtwdev, obj,
           &res->u.policy_6ghz);
 else if (func == RTW89_ACPI_DSM_FUNC_6GHZ_SP_SUP)
  ret = rtw89_acpi_dsm_get_policy_6ghz_sp(rtwdev, obj,
       &res->u.policy_6ghz_sp);
 else if (func == RTW89_ACPI_DSM_FUNC_6GHZ_VLP_SUP)
  ret = rtw89_acpi_dsm_get_policy_6ghz_vlp(rtwdev, obj,
        &res->u.policy_6ghz_vlp);
 else if (func == RTW89_ACPI_DSM_FUNC_TAS_EN)
  ret = rtw89_acpi_dsm_get_policy_tas(rtwdev, obj, &res->u.policy_tas);
 else if (func == RTW89_ACPI_DSM_FUNC_REG_RULES_EN)
  ret = rtw89_acpi_dsm_get_policy_reg_rules(rtwdev, obj,
         &res->u.policy_reg_rules);
 else
  ret = rtw89_acpi_dsm_get_value(rtwdev, obj, &res->u.value);

 ACPI_FREE(obj);
 return ret;
}

int rtw89_acpi_evaluate_rtag(struct rtw89_dev *rtwdev,
        struct rtw89_acpi_rtag_result *res)
{
 const struct rtw89_acpi_data *data;
 u32 buf_len;
 int ret = 0;

 data = rtw89_acpi_evaluate_method(rtwdev, "RTAG");
 if (!data)
  return -EIO;

 buf_len = data->len;
 if (buf_len != sizeof(*res)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "%s: invalid buffer length: %u\n",
       __func__, buf_len);
  ret = -EINVAL;
  goto out;
 }

 *res = *(struct rtw89_acpi_rtag_result *)data->buf;

 rtw89_hex_dump(rtwdev, RTW89_DBG_ACPI, "antenna_gain: ", res, sizeof(*res));

out:
 kfree(data);
 return ret;
}

enum rtw89_acpi_sar_subband rtw89_acpi_sar_get_subband(struct rtw89_dev *rtwdev,
             u32 center_freq)
{
 switch (center_freq) {
 default:
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "center freq %u to ACPI SAR subband is unhandled\n",
       center_freq);
  fallthrough;
 case 2412 ... 2484:
  return RTW89_ACPI_SAR_2GHZ_SUBBAND;
 case 5180 ... 5240:
  return RTW89_ACPI_SAR_5GHZ_SUBBAND_1;
 case 5250 ... 5320:
  return RTW89_ACPI_SAR_5GHZ_SUBBAND_2;
 case 5500 ... 5720:
  return RTW89_ACPI_SAR_5GHZ_SUBBAND_2E;
 case 5745 ... 5885:
  return RTW89_ACPI_SAR_5GHZ_SUBBAND_3_4;
 case 5955 ... 6155:
  return RTW89_ACPI_SAR_6GHZ_SUBBAND_5_L;
 case 6175 ... 6415:
  return RTW89_ACPI_SAR_6GHZ_SUBBAND_5_H;
 case 6435 ... 6515:
  return RTW89_ACPI_SAR_6GHZ_SUBBAND_6;
 case 6535 ... 6695:
  return RTW89_ACPI_SAR_6GHZ_SUBBAND_7_L;
 case 6715 ... 6855:
  return RTW89_ACPI_SAR_6GHZ_SUBBAND_7_H;

 /* freq 6875 (ch 185, 20MHz) spans RTW89_ACPI_SAR_6GHZ_SUBBAND_7_H
 * and RTW89_ACPI_SAR_6GHZ_SUBBAND_8, so directly describe it with
 * struct rtw89_6ghz_span.
 */

 case 6895 ... 7115:
  return RTW89_ACPI_SAR_6GHZ_SUBBAND_8;
 }
}

enum rtw89_band rtw89_acpi_sar_subband_to_band(struct rtw89_dev *rtwdev,
            enum rtw89_acpi_sar_subband subband)
{
 switch (subband) {
 default:
  rtw89_debug(rtwdev, RTW89_DBG_ACPI,
       "ACPI SAR subband %u to band is unhandled\n", subband);
  fallthrough;
 case RTW89_ACPI_SAR_2GHZ_SUBBAND:
  return RTW89_BAND_2G;
 case RTW89_ACPI_SAR_5GHZ_SUBBAND_1:
  return RTW89_BAND_5G;
 case RTW89_ACPI_SAR_5GHZ_SUBBAND_2:
  return RTW89_BAND_5G;
 case RTW89_ACPI_SAR_5GHZ_SUBBAND_2E:
  return RTW89_BAND_5G;
 case RTW89_ACPI_SAR_5GHZ_SUBBAND_3_4:
  return RTW89_BAND_5G;
 case RTW89_ACPI_SAR_6GHZ_SUBBAND_5_L:
  return RTW89_BAND_6G;
 case RTW89_ACPI_SAR_6GHZ_SUBBAND_5_H:
  return RTW89_BAND_6G;
 case RTW89_ACPI_SAR_6GHZ_SUBBAND_6:
  return RTW89_BAND_6G;
 case RTW89_ACPI_SAR_6GHZ_SUBBAND_7_L:
  return RTW89_BAND_6G;
 case RTW89_ACPI_SAR_6GHZ_SUBBAND_7_H:
  return RTW89_BAND_6G;
 case RTW89_ACPI_SAR_6GHZ_SUBBAND_8:
  return RTW89_BAND_6G;
 }
}

static u8 rtw89_acpi_sar_rfpath_to_hp_antidx(enum rtw89_rf_path rfpath)
{
 switch (rfpath) {
 default:
 case RF_PATH_B:
  return 0;
 case RF_PATH_A:
  return 1;
 }
}

static u8 rtw89_acpi_sar_rfpath_to_rt_antidx(enum rtw89_rf_path rfpath)
{
 switch (rfpath) {
 default:
 case RF_PATH_A:
  return 0;
 case RF_PATH_B:
  return 1;
 }
}

static s16 rtw89_acpi_sar_normalize_hp_val(u8 v)
{
 static const u8 bias = 10;
 static const u8 fct = 1;
 u16 res;

 BUILD_BUG_ON(fct > TXPWR_FACTOR_OF_RTW89_ACPI_SAR);

 res = (bias << TXPWR_FACTOR_OF_RTW89_ACPI_SAR) +
       (v << (TXPWR_FACTOR_OF_RTW89_ACPI_SAR - fct));

 return min_t(s32, res, MAX_VAL_OF_RTW89_ACPI_SAR);
}

static s16 rtw89_acpi_sar_normalize_rt_val(u8 v)
{
 static const u8 fct = 3;
 u16 res;

 BUILD_BUG_ON(fct > TXPWR_FACTOR_OF_RTW89_ACPI_SAR);

 res = v << (TXPWR_FACTOR_OF_RTW89_ACPI_SAR - fct);

 return min_t(s32, res, MAX_VAL_OF_RTW89_ACPI_SAR);
}

static
void rtw89_acpi_sar_load_std_legacy(struct rtw89_dev *rtwdev,
        const struct rtw89_acpi_sar_recognition *rec,
        const void *content,
        struct rtw89_sar_entry_from_acpi *ent)
{
 const struct rtw89_acpi_sar_std_legacy *ptr = content;
 enum rtw89_acpi_sar_subband subband;
 enum rtw89_rf_path path;

 for (subband = 0; subband < NUM_OF_RTW89_ACPI_SAR_SUBBAND; subband++) {
  for (path = 0; path < NUM_OF_RTW89_ACPI_SAR_RF_PATH; path++) {
   u8 antidx = rec->rfpath_to_antidx(path);

   if (subband < RTW89_ACPI_SAR_SUBBAND_NR_LEGACY)
    ent->v[subband][path] =
     rec->normalize(ptr->v[antidx][subband]);
   else
    ent->v[subband][path] = MAX_VAL_OF_RTW89_ACPI_SAR;
  }
 }
}

static
void rtw89_acpi_sar_load_std_has_6ghz(struct rtw89_dev *rtwdev,
          const struct rtw89_acpi_sar_recognition *rec,
          const void *content,
          struct rtw89_sar_entry_from_acpi *ent)
{
 const struct rtw89_acpi_sar_std_has_6ghz *ptr = content;
 enum rtw89_acpi_sar_subband subband;
 enum rtw89_rf_path path;

 BUILD_BUG_ON(RTW89_ACPI_SAR_SUBBAND_NR_HAS_6GHZ != NUM_OF_RTW89_ACPI_SAR_SUBBAND);

 for (subband = 0; subband < NUM_OF_RTW89_ACPI_SAR_SUBBAND; subband++) {
  for (path = 0; path < NUM_OF_RTW89_ACPI_SAR_RF_PATH; path++) {
   u8 antidx = rec->rfpath_to_antidx(path);

   ent->v[subband][path] = rec->normalize(ptr->v[antidx][subband]);
  }
 }
}

static
void rtw89_acpi_sar_load_sml_legacy(struct rtw89_dev *rtwdev,
        const struct rtw89_acpi_sar_recognition *rec,
        const void *content,
        struct rtw89_sar_entry_from_acpi *ent)
{
 const struct rtw89_acpi_sar_sml_legacy *ptr = content;
 enum rtw89_acpi_sar_subband subband;
 enum rtw89_rf_path path;

 for (subband = 0; subband < NUM_OF_RTW89_ACPI_SAR_SUBBAND; subband++) {
  for (path = 0; path < NUM_OF_RTW89_ACPI_SAR_RF_PATH; path++) {
   u8 antidx = rec->rfpath_to_antidx(path);

   if (subband < RTW89_ACPI_SAR_SUBBAND_NR_LEGACY)
    ent->v[subband][path] =
     rec->normalize(ptr->v[antidx][subband]);
   else
    ent->v[subband][path] = MAX_VAL_OF_RTW89_ACPI_SAR;
  }
 }
}

static
void rtw89_acpi_sar_load_sml_has_6ghz(struct rtw89_dev *rtwdev,
          const struct rtw89_acpi_sar_recognition *rec,
          const void *content,
          struct rtw89_sar_entry_from_acpi *ent)
{
 const struct rtw89_acpi_sar_sml_has_6ghz *ptr = content;
 enum rtw89_acpi_sar_subband subband;
 enum rtw89_rf_path path;

 BUILD_BUG_ON(RTW89_ACPI_SAR_SUBBAND_NR_HAS_6GHZ != NUM_OF_RTW89_ACPI_SAR_SUBBAND);

 for (subband = 0; subband < NUM_OF_RTW89_ACPI_SAR_SUBBAND; subband++) {
  for (path = 0; path < NUM_OF_RTW89_ACPI_SAR_RF_PATH; path++) {
   u8 antidx = rec->rfpath_to_antidx(path);

   ent->v[subband][path] = rec->normalize(ptr->v[antidx][subband]);
  }
 }
}

static s16 rtw89_acpi_geo_sar_normalize_delta(s8 delta)
{
 static const u8 fct = 1;

 BUILD_BUG_ON(fct > TXPWR_FACTOR_OF_RTW89_ACPI_SAR);

 return delta << (TXPWR_FACTOR_OF_RTW89_ACPI_SAR - fct);
}

static enum rtw89_acpi_geo_sar_regd_hp
rtw89_acpi_geo_sar_regd_convert_hp_idx(enum rtw89_regulation_type regd)
{
 switch (regd) {
 case RTW89_FCC:
 case RTW89_IC:
 case RTW89_NCC:
 case RTW89_CHILE:
 case RTW89_MEXICO:
  return RTW89_ACPI_GEO_SAR_REGD_HP_FCC;
 case RTW89_ETSI:
 case RTW89_MKK:
 case RTW89_ACMA:
  return RTW89_ACPI_GEO_SAR_REGD_HP_ETSI;
 default:
 case RTW89_WW:
 case RTW89_NA:
 case RTW89_KCC:
  return RTW89_ACPI_GEO_SAR_REGD_HP_WW;
 }
}

static enum rtw89_acpi_geo_sar_regd_rt
rtw89_acpi_geo_sar_regd_convert_rt_idx(enum rtw89_regulation_type regd)
{
 switch (regd) {
 case RTW89_FCC:
 case RTW89_NCC:
 case RTW89_CHILE:
 case RTW89_MEXICO:
  return RTW89_ACPI_GEO_SAR_REGD_RT_FCC;
 case RTW89_ETSI:
 case RTW89_ACMA:
  return RTW89_ACPI_GEO_SAR_REGD_RT_ETSI;
 case RTW89_MKK:
  return RTW89_ACPI_GEO_SAR_REGD_RT_MKK;
 case RTW89_IC:
  return RTW89_ACPI_GEO_SAR_REGD_RT_IC;
 case RTW89_KCC:
  return RTW89_ACPI_GEO_SAR_REGD_RT_KCC;
 default:
 case RTW89_WW:
 case RTW89_NA:
  return RTW89_ACPI_GEO_SAR_REGD_RT_WW;
 }
}

static
void rtw89_acpi_geo_sar_load_by_hp(struct rtw89_dev *rtwdev,
       const struct rtw89_acpi_geo_sar_hp_val *ptr,
       enum rtw89_rf_path path, s16 *val)
{
 u8 antidx = rtw89_acpi_sar_rfpath_to_hp_antidx(path);
 s16 delta = rtw89_acpi_geo_sar_normalize_delta(ptr->delta[antidx]);
 s16 max = rtw89_acpi_sar_normalize_hp_val(ptr->max);

 *val = clamp_t(s32, (*val) + delta, MIN_VAL_OF_RTW89_ACPI_SAR, max);
}

static
void rtw89_acpi_geo_sar_load_by_rt(struct rtw89_dev *rtwdev,
       const struct rtw89_acpi_geo_sar_rt_val *ptr,
       s16 *val)
{
 s16 delta = rtw89_acpi_geo_sar_normalize_delta(ptr->delta);
 s16 max = rtw89_acpi_sar_normalize_rt_val(ptr->max);

 *val = clamp_t(s32, (*val) + delta, MIN_VAL_OF_RTW89_ACPI_SAR, max);
}

static
void rtw89_acpi_geo_sar_load_hp_legacy(struct rtw89_dev *rtwdev,
           const void *content,
           enum rtw89_regulation_type regd,
           struct rtw89_sar_entry_from_acpi *ent)
{
 const struct rtw89_acpi_geo_sar_hp_legacy *ptr = content;
 const struct rtw89_acpi_geo_sar_hp_legacy_entry *ptr_ent;
 const struct rtw89_acpi_geo_sar_hp_val *ptr_ent_val;
 enum rtw89_acpi_geo_sar_regd_hp geo_idx =
  rtw89_acpi_geo_sar_regd_convert_hp_idx(regd);
 enum rtw89_acpi_sar_subband subband;
 enum rtw89_rf_path path;
 enum rtw89_band band;

 ptr_ent = &ptr->entries[geo_idx];

 for (subband = 0; subband < NUM_OF_RTW89_ACPI_SAR_SUBBAND; subband++) {
  band = rtw89_acpi_sar_subband_to_band(rtwdev, subband);
  switch (band) {
  case RTW89_BAND_2G:
   ptr_ent_val = &ptr_ent->val_2ghz;
   break;
  case RTW89_BAND_5G:
   ptr_ent_val = &ptr_ent->val_5ghz;
   break;
  default:
  case RTW89_BAND_6G:
   ptr_ent_val = NULL;
   break;
  }

  if (!ptr_ent_val)
   continue;

  for (path = 0; path < NUM_OF_RTW89_ACPI_SAR_RF_PATH; path++)
   rtw89_acpi_geo_sar_load_by_hp(rtwdev, ptr_ent_val, path,
            &ent->v[subband][path]);
 }
}

static
void rtw89_acpi_geo_sar_load_hp_has_6ghz(struct rtw89_dev *rtwdev,
      const void *content,
      enum rtw89_regulation_type regd,
      struct rtw89_sar_entry_from_acpi *ent)
{
 const struct rtw89_acpi_geo_sar_hp_has_6ghz *ptr = content;
 const struct rtw89_acpi_geo_sar_hp_has_6ghz_entry *ptr_ent;
 const struct rtw89_acpi_geo_sar_hp_val *ptr_ent_val;
 enum rtw89_acpi_geo_sar_regd_hp geo_idx =
  rtw89_acpi_geo_sar_regd_convert_hp_idx(regd);
 enum rtw89_acpi_sar_subband subband;
 enum rtw89_rf_path path;
 enum rtw89_band band;

 ptr_ent = &ptr->entries[geo_idx];

 for (subband = 0; subband < NUM_OF_RTW89_ACPI_SAR_SUBBAND; subband++) {
  band = rtw89_acpi_sar_subband_to_band(rtwdev, subband);
  switch (band) {
  case RTW89_BAND_2G:
   ptr_ent_val = &ptr_ent->val_2ghz;
   break;
  case RTW89_BAND_5G:
   ptr_ent_val = &ptr_ent->val_5ghz;
   break;
  case RTW89_BAND_6G:
   ptr_ent_val = &ptr_ent->val_6ghz;
   break;
  default:
   ptr_ent_val = NULL;
   break;
  }

  if (!ptr_ent_val)
   continue;

  for (path = 0; path < NUM_OF_RTW89_ACPI_SAR_RF_PATH; path++)
   rtw89_acpi_geo_sar_load_by_hp(rtwdev, ptr_ent_val, path,
            &ent->v[subband][path]);
 }
}

static
void rtw89_acpi_geo_sar_load_rt_legacy(struct rtw89_dev *rtwdev,
           const void *content,
           enum rtw89_regulation_type regd,
           struct rtw89_sar_entry_from_acpi *ent)
{
 const struct rtw89_acpi_geo_sar_rt_legacy *ptr = content;
 const struct rtw89_acpi_geo_sar_rt_legacy_entry *ptr_ent;
 const struct rtw89_acpi_geo_sar_rt_val *ptr_ent_val;
 enum rtw89_acpi_geo_sar_regd_rt geo_idx =
  rtw89_acpi_geo_sar_regd_convert_rt_idx(regd);
 enum rtw89_acpi_sar_subband subband;
 enum rtw89_rf_path path;
 enum rtw89_band band;

 ptr_ent = &ptr->entries[geo_idx];

 for (subband = 0; subband < NUM_OF_RTW89_ACPI_SAR_SUBBAND; subband++) {
  band = rtw89_acpi_sar_subband_to_band(rtwdev, subband);
  switch (band) {
  case RTW89_BAND_2G:
   ptr_ent_val = &ptr_ent->val_2ghz;
   break;
  case RTW89_BAND_5G:
   ptr_ent_val = &ptr_ent->val_5ghz;
   break;
  default:
  case RTW89_BAND_6G:
   ptr_ent_val = NULL;
   break;
  }

  if (!ptr_ent_val)
   continue;

  for (path = 0; path < NUM_OF_RTW89_ACPI_SAR_RF_PATH; path++)
   rtw89_acpi_geo_sar_load_by_rt(rtwdev, ptr_ent_val,
            &ent->v[subband][path]);
 }
}

static
void rtw89_acpi_geo_sar_load_rt_has_6ghz(struct rtw89_dev *rtwdev,
      const void *content,
      enum rtw89_regulation_type regd,
      struct rtw89_sar_entry_from_acpi *ent)
{
 const struct rtw89_acpi_geo_sar_rt_has_6ghz *ptr = content;
 const struct rtw89_acpi_geo_sar_rt_has_6ghz_entry *ptr_ent;
 const struct rtw89_acpi_geo_sar_rt_val *ptr_ent_val;
 enum rtw89_acpi_geo_sar_regd_rt geo_idx =
  rtw89_acpi_geo_sar_regd_convert_rt_idx(regd);
 enum rtw89_acpi_sar_subband subband;
 enum rtw89_rf_path path;
 enum rtw89_band band;

 ptr_ent = &ptr->entries[geo_idx];

 for (subband = 0; subband < NUM_OF_RTW89_ACPI_SAR_SUBBAND; subband++) {
  band = rtw89_acpi_sar_subband_to_band(rtwdev, subband);
  switch (band) {
  case RTW89_BAND_2G:
   ptr_ent_val = &ptr_ent->val_2ghz;
   break;
  case RTW89_BAND_5G:
   ptr_ent_val = &ptr_ent->val_5ghz;
   break;
  case RTW89_BAND_6G:
   ptr_ent_val = &ptr_ent->val_6ghz;
   break;
  default:
   ptr_ent_val = NULL;
   break;
  }

  if (!ptr_ent_val)
   continue;

  for (path = 0; path < NUM_OF_RTW89_ACPI_SAR_RF_PATH; path++)
   rtw89_acpi_geo_sar_load_by_rt(rtwdev, ptr_ent_val,
            &ent->v[subband][path]);
 }
}

#define RTW89_ACPI_GEO_SAR_DECL_HANDLER(type) \
static const struct rtw89_acpi_geo_sar_handler \
rtw89_acpi_geo_sar_handler_ ## type = { \
 .data_size = RTW89_ACPI_GEO_SAR_SIZE_OF(type), \
 .load = rtw89_acpi_geo_sar_load_ ## type, \
}

RTW89_ACPI_GEO_SAR_DECL_HANDLER(hp_legacy);
RTW89_ACPI_GEO_SAR_DECL_HANDLER(hp_has_6ghz);
RTW89_ACPI_GEO_SAR_DECL_HANDLER(rt_legacy);
RTW89_ACPI_GEO_SAR_DECL_HANDLER(rt_has_6ghz);

static const struct rtw89_acpi_sar_recognition rtw89_acpi_sar_recs[] = {
 {
  .id = {
   .cid = RTW89_ACPI_SAR_CID_HP,
   .rev = RTW89_ACPI_SAR_REV_LEGACY,
   .size = RTW89_ACPI_SAR_SIZE_OF(std_legacy),
  },
  .geo = &rtw89_acpi_geo_sar_handler_hp_legacy,

  .rfpath_to_antidx = rtw89_acpi_sar_rfpath_to_hp_antidx,
  .normalize = rtw89_acpi_sar_normalize_hp_val,
  .load = rtw89_acpi_sar_load_std_legacy,
 },
 {
  .id = {
   .cid = RTW89_ACPI_SAR_CID_HP,
   .rev = RTW89_ACPI_SAR_REV_HAS_6GHZ,
   .size = RTW89_ACPI_SAR_SIZE_OF(std_has_6ghz),
  },
  .geo = &rtw89_acpi_geo_sar_handler_hp_has_6ghz,

  .rfpath_to_antidx = rtw89_acpi_sar_rfpath_to_hp_antidx,
  .normalize = rtw89_acpi_sar_normalize_hp_val,
  .load = rtw89_acpi_sar_load_std_has_6ghz,
 },
 {
  .id = {
   .cid = RTW89_ACPI_SAR_CID_RT,
   .rev = RTW89_ACPI_SAR_REV_LEGACY,
   .size = RTW89_ACPI_SAR_SIZE_OF(std_legacy),
  },
  .geo = &rtw89_acpi_geo_sar_handler_rt_legacy,

  .rfpath_to_antidx = rtw89_acpi_sar_rfpath_to_rt_antidx,
  .normalize = rtw89_acpi_sar_normalize_rt_val,
  .load = rtw89_acpi_sar_load_std_legacy,
 },
 {
  .id = {
   .cid = RTW89_ACPI_SAR_CID_RT,
   .rev = RTW89_ACPI_SAR_REV_HAS_6GHZ,
   .size = RTW89_ACPI_SAR_SIZE_OF(std_has_6ghz),
  },
  .geo = &rtw89_acpi_geo_sar_handler_rt_has_6ghz,

  .rfpath_to_antidx = rtw89_acpi_sar_rfpath_to_rt_antidx,
  .normalize = rtw89_acpi_sar_normalize_rt_val,
  .load = rtw89_acpi_sar_load_std_has_6ghz,
 },
 {
  .id = {
   .cid = RTW89_ACPI_SAR_CID_RT,
   .rev = RTW89_ACPI_SAR_REV_LEGACY,
   .size = RTW89_ACPI_SAR_SIZE_OF(sml_legacy),
  },
  .geo = &rtw89_acpi_geo_sar_handler_rt_legacy,

  .rfpath_to_antidx = rtw89_acpi_sar_rfpath_to_rt_antidx,
  .normalize = rtw89_acpi_sar_normalize_rt_val,
  .load = rtw89_acpi_sar_load_sml_legacy,
 },
 {
  .id = {
   .cid = RTW89_ACPI_SAR_CID_RT,
   .rev = RTW89_ACPI_SAR_REV_HAS_6GHZ,
   .size = RTW89_ACPI_SAR_SIZE_OF(sml_has_6ghz),
  },
  .geo = &rtw89_acpi_geo_sar_handler_rt_has_6ghz,

  .rfpath_to_antidx = rtw89_acpi_sar_rfpath_to_rt_antidx,
  .normalize = rtw89_acpi_sar_normalize_rt_val,
  .load = rtw89_acpi_sar_load_sml_has_6ghz,
 },
};

struct rtw89_acpi_sar_rec_parm {
 u32 pld_len;
 u8 tbl_cnt;
 u16 cid;
 u8 rev;
};

static const struct rtw89_acpi_sar_recognition *
rtw89_acpi_sar_recognize(struct rtw89_dev *rtwdev,
    const struct rtw89_acpi_sar_rec_parm *parm)
{
 const u32 tbl_len = parm->pld_len / parm->tbl_cnt;
 const struct rtw89_acpi_sar_recognition *rec;
 struct rtw89_acpi_sar_identifier id = {};

 rtw89_debug(rtwdev, RTW89_DBG_ACPI,
      "%s: cid %u, rev %u, tbl len %u, tbl cnt %u\n",
      __func__, parm->cid, parm->rev, tbl_len, parm->tbl_cnt);

 if (unlikely(parm->pld_len % parm->tbl_cnt)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "invalid pld len %u\n",
       parm->pld_len);
  return NULL;
 }

 if (unlikely(tbl_len > RTW89_ACPI_SAR_SIZE_MAX)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "invalid tbl len %u\n",
       tbl_len);
  return NULL;
 }

 if (unlikely(parm->tbl_cnt > MAX_NUM_OF_RTW89_ACPI_SAR_TBL)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "invalid tbl cnt %u\n",
       parm->tbl_cnt);
  return NULL;
 }

 switch (parm->cid) {
 case RTW89_ACPI_SAR_CID_HP:
 case RTW89_ACPI_SAR_CID_RT:
  id.cid = parm->cid;
  break;
 default:
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "invalid cid 0x%x\n",
       parm->cid);
  return NULL;
 }

 switch (parm->rev) {
 case RTW89_ACPI_SAR_REV_LEGACY:
 case RTW89_ACPI_SAR_REV_HAS_6GHZ:
  id.rev = parm->rev;
  break;
 default:
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "invalid rev %u\n",
       parm->rev);
  return NULL;
 }

 id.size = tbl_len;
 for (unsigned int i = 0; i < ARRAY_SIZE(rtw89_acpi_sar_recs); i++) {
  rec = &rtw89_acpi_sar_recs[i];
  if (memcmp(&rec->id, &id, sizeof(rec->id)) == 0)
   return rec;
 }

 rtw89_debug(rtwdev, RTW89_DBG_ACPI, "failed to recognize\n");
 return NULL;
}

static const struct rtw89_acpi_sar_recognition *
rtw89_acpi_evaluate_static_sar(struct rtw89_dev *rtwdev,
          struct rtw89_sar_cfg_acpi *cfg)
{
 const struct rtw89_acpi_sar_recognition *rec = NULL;
 const struct rtw89_acpi_static_sar_hdr *hdr;
 struct rtw89_sar_entry_from_acpi tmp = {};
 struct rtw89_acpi_sar_rec_parm parm = {};
 struct rtw89_sar_table_from_acpi *tbl;
 const struct rtw89_acpi_data *data;
 u32 len;

 data = rtw89_acpi_evaluate_method(rtwdev, RTW89_ACPI_METHOD_STATIC_SAR);
 if (!data)
  return NULL;

 rtw89_debug(rtwdev, RTW89_DBG_ACPI, "acpi load static sar\n");

 len = data->len;
 if (len <= sizeof(*hdr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "invalid buf len %u\n", len);
  goto out;
 }

 hdr = (typeof(hdr))data->buf;

 parm.cid = le16_to_cpu(hdr->cid);
 parm.rev = hdr->rev;
 parm.tbl_cnt = 1;
 parm.pld_len = len - sizeof(*hdr);

 rec = rtw89_acpi_sar_recognize(rtwdev, &parm);
 if (!rec)
  goto out;

 rec->load(rtwdev, rec, hdr->content, &tmp);

 tbl = &cfg->tables[0];
 for (u8 regd = 0; regd < RTW89_REGD_NUM; regd++)
  tbl->entries[regd] = tmp;

 cfg->valid_num = 1;

out:
 kfree(data);
 return rec;
}

static const struct rtw89_acpi_sar_recognition *
rtw89_acpi_evaluate_dynamic_sar(struct rtw89_dev *rtwdev,
    struct rtw89_sar_cfg_acpi *cfg)
{
 const struct rtw89_acpi_sar_recognition *rec = NULL;
 const struct rtw89_acpi_dynamic_sar_hdr *hdr;
 struct rtw89_acpi_sar_rec_parm parm = {};
 struct rtw89_sar_table_from_acpi *tbl;
 const struct rtw89_acpi_data *data;
 u32 len;

 data = rtw89_acpi_evaluate_method(rtwdev, RTW89_ACPI_METHOD_DYNAMIC_SAR);
 if (!data)
  return NULL;

 rtw89_debug(rtwdev, RTW89_DBG_ACPI, "acpi load dynamic sar\n");

 len = data->len;
 if (len <= sizeof(*hdr)) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "invalid buf len %u\n", len);
  goto out;
 }

 hdr = (typeof(hdr))data->buf;

 parm.cid = le16_to_cpu(hdr->cid);
 parm.rev = hdr->rev;
 parm.tbl_cnt = hdr->cnt;
 parm.pld_len = len - sizeof(*hdr);

 rec = rtw89_acpi_sar_recognize(rtwdev, &parm);
 if (!rec)
  goto out;

 for (unsigned int i = 0; i < hdr->cnt; i++) {
  const u8 *content = hdr->content + rec->id.size * i;
  struct rtw89_sar_entry_from_acpi tmp = {};

  rec->load(rtwdev, rec, content, &tmp);

  tbl = &cfg->tables[i];
  for (u8 regd = 0; regd < RTW89_REGD_NUM; regd++)
   tbl->entries[regd] = tmp;
 }

 cfg->valid_num = hdr->cnt;

out:
 kfree(data);
 return rec;
}

int rtw89_acpi_evaluate_dynamic_sar_indicator(struct rtw89_dev *rtwdev,
           struct rtw89_sar_cfg_acpi *cfg,
           bool *poll_changed)
{
 struct rtw89_sar_indicator_from_acpi *ind = &cfg->indicator;
 struct rtw89_sar_indicator_from_acpi tmp = *ind;
 const struct rtw89_acpi_data *data;
 const u8 *tbl_base1_by_ant;
 enum rtw89_rf_path path;
 int ret = 0;
 u32 len;

 data = rtw89_acpi_evaluate_method(rtwdev, RTW89_ACPI_METHOD_DYNAMIC_SAR_INDICATOR);
 if (!data)
  return -EFAULT;

 if (!poll_changed)
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "acpi load dynamic sar indicator\n");

 len = data->len;
 if (len != ind->fields) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "invalid buf len %u\n", len);
  ret = -EINVAL;
  goto out;
 }

 tbl_base1_by_ant = data->buf;

 for (path = 0; path < NUM_OF_RTW89_ACPI_SAR_RF_PATH; path++) {
  u8 antidx = ind->rfpath_to_antidx(path);
  u8 sel;

  if (antidx >= ind->fields)
   antidx = 0;

  /* convert the table index from 1-based to 0-based */
  sel = tbl_base1_by_ant[antidx] - 1;
  if (sel >= cfg->valid_num)
   sel = 0;

  tmp.tblsel[path] = sel;
 }

 if (memcmp(ind, &tmp, sizeof(*ind)) == 0) {
  if (poll_changed)
   *poll_changed = false;
 } else {
  if (poll_changed)
   *poll_changed = true;

  *ind = tmp;
 }

out:
 kfree(data);
 return ret;
}

static
void rtw89_acpi_evaluate_geo_sar(struct rtw89_dev *rtwdev,
     const struct rtw89_acpi_geo_sar_handler *hdl,
     struct rtw89_sar_cfg_acpi *cfg)
{
 const struct rtw89_acpi_data *data;
 u32 len;

 data = rtw89_acpi_evaluate_method(rtwdev, RTW89_ACPI_METHOD_GEO_SAR);
 if (!data)
  return;

 rtw89_debug(rtwdev, RTW89_DBG_ACPI, "acpi load geo sar\n");

 len = data->len;
 if (len != hdl->data_size) {
  rtw89_debug(rtwdev, RTW89_DBG_ACPI, "invalid buf len %u (expected %u)\n",
       len, hdl->data_size);
  goto out;
 }

 for (unsigned int i = 0; i < cfg->valid_num; i++)
  for (u8 regd = 0; regd < RTW89_REGD_NUM; regd++)
   hdl->load(rtwdev, data->buf, regd, &cfg->tables[i].entries[regd]);

out:
 kfree(data);
}

int rtw89_acpi_evaluate_sar(struct rtw89_dev *rtwdev,
       struct rtw89_sar_cfg_acpi *cfg)
{
 struct rtw89_sar_indicator_from_acpi *ind = &cfg->indicator;
 const struct rtw89_acpi_sar_recognition *rec;
 bool fetch_indicator = false;
 int ret;

 rec = rtw89_acpi_evaluate_static_sar(rtwdev, cfg);
 if (rec)
  goto recognized;

 rec = rtw89_acpi_evaluate_dynamic_sar(rtwdev, cfg);
 if (!rec)
  return -ENOENT;

 fetch_indicator = true;

recognized:
 rtw89_acpi_evaluate_geo_sar(rtwdev, rec->geo, cfg);

 switch (rec->id.cid) {
 case RTW89_ACPI_SAR_CID_HP:
  cfg->downgrade_2tx = 3 << TXPWR_FACTOR_OF_RTW89_ACPI_SAR;
  ind->fields = RTW89_ACPI_SAR_ANT_NR_STD;
  break;
 case RTW89_ACPI_SAR_CID_RT:
  cfg->downgrade_2tx = 0;
  ind->fields = 1;
  break;
 default:
  return -EFAULT;
 }

 if (fetch_indicator) {
  ind->rfpath_to_antidx = rec->rfpath_to_antidx;
  ret = rtw89_acpi_evaluate_dynamic_sar_indicator(rtwdev, cfg, NULL);
  if (ret)
   fetch_indicator = false;
 }

 if (!fetch_indicator)
  memset(ind->tblsel, 0, sizeof(ind->tblsel));

 ind->enable_sync = fetch_indicator;
 return 0;
}