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

   1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
   2 /* Copyright(c) 2019-2020  Realtek Corporation
   3  */
   4
   5 #include "debug.h"
   6 #include "sar.h"
   7
   8 static int rtw89_query_sar_config_common(struct rtw89_dev *rtwdev, s32 *cfg)
   9 {
  10         struct rtw89_sar_cfg_common *rtwsar = &rtwdev->sar.cfg_common;
  11         enum rtw89_subband subband = rtwdev->hal.current_subband;
  12
  13         if (!rtwsar->set[subband])
  14                 return -ENODATA;
  15
  16         *cfg = rtwsar->cfg[subband];
  17         return 0;
  18 }
  19
  20 static const
  21 struct rtw89_sar_handler rtw89_sar_handlers[RTW89_SAR_SOURCE_NR] = {
  22         [RTW89_SAR_SOURCE_COMMON] = {
  23                 .descr_sar_source = "RTW89_SAR_SOURCE_COMMON",
  24                 .txpwr_factor_sar = 2,
  25                 .query_sar_config = rtw89_query_sar_config_common,
  26         },
  27 };
  28
  29 #define rtw89_sar_set_src(_dev, _src, _cfg_name, _cfg_data)             \
  30         do {                                                            \
  31                 typeof(_src) _s = (_src);                               \
  32                 typeof(_dev) _d = (_dev);                               \
  33                 BUILD_BUG_ON(!rtw89_sar_handlers[_s].descr_sar_source); \
  34                 BUILD_BUG_ON(!rtw89_sar_handlers[_s].query_sar_config); \
  35                 lockdep_assert_held(&_d->mutex);                        \
  36                 _d->sar._cfg_name = *(_cfg_data);                       \
  37                 _d->sar.src = _s;                                       \
  38         } while (0)
  39
  40 static s8 rtw89_txpwr_sar_to_mac(struct rtw89_dev *rtwdev, u8 fct, s32 cfg)
  41 {
  42         const u8 fct_mac = rtwdev->chip->txpwr_factor_mac;
  43         s32 cfg_mac;
  44
  45         cfg_mac = fct > fct_mac ?
  46                   cfg >> (fct - fct_mac) : cfg << (fct_mac - fct);
  47
  48         return (s8)clamp_t(s32, cfg_mac,
  49                            RTW89_SAR_TXPWR_MAC_MIN,
  50                            RTW89_SAR_TXPWR_MAC_MAX);
  51 }
  52
  53 s8 rtw89_query_sar(struct rtw89_dev *rtwdev)
  54 {
  55         const enum rtw89_sar_sources src = rtwdev->sar.src;
  56         /* its members are protected by rtw89_sar_set_src() */
  57         const struct rtw89_sar_handler *sar_hdl = &rtw89_sar_handlers[src];
  58         int ret;
  59         s32 cfg;
  60         u8 fct;
  61
  62         lockdep_assert_held(&rtwdev->mutex);
  63
  64         if (src == RTW89_SAR_SOURCE_NONE)
  65                 return RTW89_SAR_TXPWR_MAC_MAX;
  66
  67         ret = sar_hdl->query_sar_config(rtwdev, &cfg);
  68         if (ret)
  69                 return RTW89_SAR_TXPWR_MAC_MAX;
  70
  71         fct = sar_hdl->txpwr_factor_sar;
  72
  73         return rtw89_txpwr_sar_to_mac(rtwdev, fct, cfg);
  74 }
  75
  76 void rtw89_print_sar(struct seq_file *m, struct rtw89_dev *rtwdev)
  77 {
  78         const enum rtw89_sar_sources src = rtwdev->sar.src;
  79         /* its members are protected by rtw89_sar_set_src() */
  80         const struct rtw89_sar_handler *sar_hdl = &rtw89_sar_handlers[src];
  81         const u8 fct_mac = rtwdev->chip->txpwr_factor_mac;
  82         int ret;
  83         s32 cfg;
  84         u8 fct;
  85
  86         lockdep_assert_held(&rtwdev->mutex);
  87
  88         if (src == RTW89_SAR_SOURCE_NONE) {
  89                 seq_puts(m, "no SAR is applied\n");
  90                 return;
  91         }
  92
  93         seq_printf(m, "source: %d (%s)\n", src, sar_hdl->descr_sar_source);
  94
  95         ret = sar_hdl->query_sar_config(rtwdev, &cfg);
  96         if (ret) {
  97                 seq_printf(m, "config: return code: %d\n", ret);
  98                 seq_printf(m, "assign: max setting: %d (unit: 1/%lu dBm)\n",
  99                            RTW89_SAR_TXPWR_MAC_MAX, BIT(fct_mac));
 100                 return;
 101         }
 102
 103         fct = sar_hdl->txpwr_factor_sar;
 104
 105         seq_printf(m, "config: %d (unit: 1/%lu dBm)\n", cfg, BIT(fct));
 106 }
 107
 108 static int rtw89_apply_sar_common(struct rtw89_dev *rtwdev,
 109                                   const struct rtw89_sar_cfg_common *sar)
 110 {
 111         enum rtw89_sar_sources src;
 112         int ret = 0;
 113
 114         mutex_lock(&rtwdev->mutex);
 115
 116         src = rtwdev->sar.src;
 117         if (src != RTW89_SAR_SOURCE_NONE && src != RTW89_SAR_SOURCE_COMMON) {
 118                 rtw89_warn(rtwdev, "SAR source: %d is in use", src);
 119                 ret = -EBUSY;
 120                 goto exit;
 121         }
 122
 123         rtw89_sar_set_src(rtwdev, RTW89_SAR_SOURCE_COMMON, cfg_common, sar);
 124         rtw89_chip_set_txpwr(rtwdev);
 125
 126 exit:
 127         mutex_unlock(&rtwdev->mutex);
 128         return ret;
 129 }
 130
 131 static const u8 rtw89_common_sar_subband_map[] = {
 132         RTW89_CH_2G,
 133         RTW89_CH_5G_BAND_1,
 134         RTW89_CH_5G_BAND_3,
 135         RTW89_CH_5G_BAND_4,
 136 };
 137
 138 static const struct cfg80211_sar_freq_ranges rtw89_common_sar_freq_ranges[] = {
 139         { .start_freq = 2412, .end_freq = 2484, },
 140         { .start_freq = 5180, .end_freq = 5320, },
 141         { .start_freq = 5500, .end_freq = 5720, },
 142         { .start_freq = 5745, .end_freq = 5825, },
 143 };
 144
 145 static_assert(ARRAY_SIZE(rtw89_common_sar_subband_map) ==
 146               ARRAY_SIZE(rtw89_common_sar_freq_ranges));
 147
 148 const struct cfg80211_sar_capa rtw89_sar_capa = {
 149         .type = NL80211_SAR_TYPE_POWER,
 150         .num_freq_ranges = ARRAY_SIZE(rtw89_common_sar_freq_ranges),
 151         .freq_ranges = rtw89_common_sar_freq_ranges,
 152 };
 153
 154 int rtw89_ops_set_sar_specs(struct ieee80211_hw *hw,
 155                             const struct cfg80211_sar_specs *sar)
 156 {
 157         struct rtw89_dev *rtwdev = hw->priv;
 158         struct rtw89_sar_cfg_common sar_common = {0};
 159         u8 fct;
 160         u32 freq_start;
 161         u32 freq_end;
 162         u32 band;
 163         s32 power;
 164         u32 i, idx;
 165
 166         if (sar->type != NL80211_SAR_TYPE_POWER)
 167                 return -EINVAL;
 168
 169         fct = rtw89_sar_handlers[RTW89_SAR_SOURCE_COMMON].txpwr_factor_sar;
 170
 171         for (i = 0; i < sar->num_sub_specs; i++) {
 172                 idx = sar->sub_specs[i].freq_range_index;
 173                 if (idx >= ARRAY_SIZE(rtw89_common_sar_freq_ranges))
 174                         return -EINVAL;
 175
 176                 freq_start = rtw89_common_sar_freq_ranges[idx].start_freq;
 177                 freq_end = rtw89_common_sar_freq_ranges[idx].end_freq;
 178                 band = rtw89_common_sar_subband_map[idx];
 179                 power = sar->sub_specs[i].power;
 180
 181                 rtw89_info(rtwdev, "On freq %u to %u, ", freq_start, freq_end);
 182                 rtw89_info(rtwdev, "set SAR power limit %d (unit: 1/%lu dBm)\n",
 183                            power, BIT(fct));
 184
 185                 sar_common.set[band] = true;
 186                 sar_common.cfg[band] = power;
 187         }
 188
 189         return rtw89_apply_sar_common(rtwdev, &sar_common);
 190 }