developer | b11a539 | 2022-03-31 00:34:47 +0800 | [diff] [blame] | 1 | // SPDX-License-Identifier: ISC |
| 2 | /* |
| 3 | * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name> |
| 4 | */ |
| 5 | #include <linux/of.h> |
| 6 | #include <linux/of_net.h> |
| 7 | #include <linux/mtd/mtd.h> |
| 8 | #include <linux/mtd/partitions.h> |
| 9 | #include <linux/etherdevice.h> |
| 10 | #include "mt76.h" |
| 11 | |
| 12 | int mt76_get_of_eeprom(struct mt76_dev *dev, void *eep, int offset, int len) |
| 13 | { |
| 14 | #if defined(CONFIG_OF) && defined(CONFIG_MTD) |
| 15 | struct device_node *np = dev->dev->of_node; |
| 16 | struct mtd_info *mtd; |
| 17 | const __be32 *list; |
| 18 | const void *data; |
| 19 | const char *part; |
| 20 | phandle phandle; |
| 21 | int size; |
| 22 | size_t retlen; |
| 23 | int ret; |
| 24 | |
| 25 | if (!np) |
| 26 | return -ENOENT; |
| 27 | |
| 28 | data = of_get_property(np, "mediatek,eeprom-data", &size); |
| 29 | if (data) { |
| 30 | if (size > len) |
| 31 | return -EINVAL; |
| 32 | |
| 33 | memcpy(eep, data, size); |
| 34 | |
| 35 | return 0; |
| 36 | } |
| 37 | |
| 38 | list = of_get_property(np, "mediatek,mtd-eeprom", &size); |
| 39 | if (!list) |
| 40 | return -ENOENT; |
| 41 | |
| 42 | phandle = be32_to_cpup(list++); |
| 43 | if (!phandle) |
| 44 | return -ENOENT; |
| 45 | |
| 46 | np = of_find_node_by_phandle(phandle); |
| 47 | if (!np) |
| 48 | return -EINVAL; |
| 49 | |
| 50 | part = of_get_property(np, "label", NULL); |
| 51 | if (!part) |
| 52 | part = np->name; |
| 53 | |
| 54 | mtd = get_mtd_device_nm(part); |
| 55 | if (IS_ERR(mtd)) { |
| 56 | ret = PTR_ERR(mtd); |
| 57 | goto out_put_node; |
| 58 | } |
| 59 | |
| 60 | if (size <= sizeof(*list)) { |
| 61 | ret = -EINVAL; |
| 62 | goto out_put_node; |
| 63 | } |
| 64 | |
| 65 | offset += be32_to_cpup(list); |
| 66 | ret = mtd_read(mtd, offset, len, &retlen, eep); |
| 67 | put_mtd_device(mtd); |
| 68 | if (mtd_is_bitflip(ret)) |
| 69 | ret = 0; |
| 70 | if (ret) { |
| 71 | dev_err(dev->dev, "reading EEPROM from mtd %s failed: %i\n", |
| 72 | part, ret); |
| 73 | goto out_put_node; |
| 74 | } |
| 75 | |
| 76 | if (retlen < len) { |
| 77 | ret = -EINVAL; |
| 78 | goto out_put_node; |
| 79 | } |
| 80 | |
| 81 | if (of_property_read_bool(dev->dev->of_node, "big-endian")) { |
| 82 | u8 *data = (u8 *)eep; |
| 83 | int i; |
| 84 | |
| 85 | /* convert eeprom data in Little Endian */ |
| 86 | for (i = 0; i < round_down(len, 2); i += 2) |
| 87 | put_unaligned_le16(get_unaligned_be16(&data[i]), |
| 88 | &data[i]); |
| 89 | } |
| 90 | |
| 91 | #ifdef CONFIG_NL80211_TESTMODE |
| 92 | dev->test_mtd.name = devm_kstrdup(dev->dev, part, GFP_KERNEL); |
| 93 | dev->test_mtd.offset = offset; |
| 94 | #endif |
| 95 | |
| 96 | out_put_node: |
| 97 | of_node_put(np); |
| 98 | return ret; |
| 99 | #else |
| 100 | return -ENOENT; |
| 101 | #endif |
| 102 | } |
| 103 | EXPORT_SYMBOL_GPL(mt76_get_of_eeprom); |
| 104 | |
| 105 | void |
| 106 | mt76_eeprom_override(struct mt76_phy *phy) |
| 107 | { |
| 108 | struct mt76_dev *dev = phy->dev; |
| 109 | |
| 110 | struct device_node *np = dev->dev->of_node; |
| 111 | |
| 112 | of_get_mac_address(np, phy->macaddr); |
| 113 | |
| 114 | if (!is_valid_ether_addr(phy->macaddr)) { |
| 115 | eth_random_addr(phy->macaddr); |
| 116 | dev_info(dev->dev, |
| 117 | "Invalid MAC address, using random address %pM\n", |
| 118 | phy->macaddr); |
| 119 | } |
| 120 | } |
| 121 | EXPORT_SYMBOL_GPL(mt76_eeprom_override); |
| 122 | |
| 123 | static bool mt76_string_prop_find(struct property *prop, const char *str) |
| 124 | { |
| 125 | const char *cp = NULL; |
| 126 | |
| 127 | if (!prop || !str || !str[0]) |
| 128 | return false; |
| 129 | |
| 130 | while ((cp = of_prop_next_string(prop, cp)) != NULL) |
| 131 | if (!strcasecmp(cp, str)) |
| 132 | return true; |
| 133 | |
| 134 | return false; |
| 135 | } |
| 136 | |
| 137 | static struct device_node * |
| 138 | mt76_find_power_limits_node(struct mt76_dev *dev) |
| 139 | { |
| 140 | struct device_node *np = dev->dev->of_node; |
| 141 | const char *const region_names[] = { |
| 142 | [NL80211_DFS_ETSI] = "etsi", |
| 143 | [NL80211_DFS_FCC] = "fcc", |
| 144 | [NL80211_DFS_JP] = "jp", |
| 145 | }; |
| 146 | struct device_node *cur, *fallback = NULL; |
| 147 | const char *region_name = NULL; |
| 148 | |
| 149 | if (dev->region < ARRAY_SIZE(region_names)) |
| 150 | region_name = region_names[dev->region]; |
| 151 | |
| 152 | np = of_get_child_by_name(np, "power-limits"); |
| 153 | if (!np) |
| 154 | return NULL; |
| 155 | |
| 156 | for_each_child_of_node(np, cur) { |
| 157 | struct property *country = of_find_property(cur, "country", NULL); |
| 158 | struct property *regd = of_find_property(cur, "regdomain", NULL); |
| 159 | |
| 160 | if (!country && !regd) { |
| 161 | fallback = cur; |
| 162 | continue; |
| 163 | } |
| 164 | |
| 165 | if (mt76_string_prop_find(country, dev->alpha2) || |
| 166 | mt76_string_prop_find(regd, region_name)) |
| 167 | return cur; |
| 168 | } |
| 169 | |
| 170 | return fallback; |
| 171 | } |
| 172 | |
| 173 | static const __be32 * |
| 174 | mt76_get_of_array(struct device_node *np, char *name, size_t *len, int min) |
| 175 | { |
| 176 | struct property *prop = of_find_property(np, name, NULL); |
| 177 | |
| 178 | if (!prop || !prop->value || prop->length < min * 4) |
| 179 | return NULL; |
| 180 | |
| 181 | *len = prop->length; |
| 182 | |
| 183 | return prop->value; |
| 184 | } |
| 185 | |
| 186 | static struct device_node * |
| 187 | mt76_find_channel_node(struct device_node *np, struct ieee80211_channel *chan) |
| 188 | { |
| 189 | struct device_node *cur; |
| 190 | const __be32 *val; |
| 191 | size_t len; |
| 192 | |
| 193 | for_each_child_of_node(np, cur) { |
| 194 | val = mt76_get_of_array(cur, "channels", &len, 2); |
| 195 | if (!val) |
| 196 | continue; |
| 197 | |
| 198 | while (len >= 2 * sizeof(*val)) { |
| 199 | if (chan->hw_value >= be32_to_cpu(val[0]) && |
| 200 | chan->hw_value <= be32_to_cpu(val[1])) |
| 201 | return cur; |
| 202 | |
| 203 | val += 2; |
| 204 | len -= 2 * sizeof(*val); |
| 205 | } |
| 206 | } |
| 207 | |
| 208 | return NULL; |
| 209 | } |
| 210 | |
| 211 | static s8 |
| 212 | mt76_get_txs_delta(struct device_node *np, u8 nss) |
| 213 | { |
| 214 | const __be32 *val; |
| 215 | size_t len; |
| 216 | |
| 217 | val = mt76_get_of_array(np, "txs-delta", &len, nss); |
| 218 | if (!val) |
| 219 | return 0; |
| 220 | |
| 221 | return be32_to_cpu(val[nss - 1]); |
| 222 | } |
| 223 | |
| 224 | static void |
| 225 | mt76_apply_array_limit(s8 *pwr, size_t pwr_len, const __be32 *data, |
| 226 | s8 target_power, s8 nss_delta, s8 *max_power) |
| 227 | { |
| 228 | int i; |
| 229 | |
| 230 | if (!data) |
| 231 | return; |
| 232 | |
| 233 | for (i = 0; i < pwr_len; i++) { |
| 234 | pwr[i] = min_t(s8, target_power, |
| 235 | be32_to_cpu(data[i]) + nss_delta); |
| 236 | *max_power = max(*max_power, pwr[i]); |
| 237 | } |
| 238 | } |
| 239 | |
| 240 | static void |
| 241 | mt76_apply_multi_array_limit(s8 *pwr, size_t pwr_len, s8 pwr_num, |
| 242 | const __be32 *data, size_t len, s8 target_power, |
| 243 | s8 nss_delta, s8 *max_power) |
| 244 | { |
| 245 | int i, cur; |
| 246 | |
| 247 | if (!data) |
| 248 | return; |
| 249 | |
| 250 | len /= 4; |
| 251 | cur = be32_to_cpu(data[0]); |
| 252 | for (i = 0; i < pwr_num; i++) { |
| 253 | if (len < pwr_len + 1) |
| 254 | break; |
| 255 | |
| 256 | mt76_apply_array_limit(pwr + pwr_len * i, pwr_len, data + 1, |
| 257 | target_power, nss_delta, max_power); |
| 258 | if (--cur > 0) |
| 259 | continue; |
| 260 | |
| 261 | data += pwr_len + 1; |
| 262 | len -= pwr_len + 1; |
| 263 | if (!len) |
| 264 | break; |
| 265 | |
| 266 | cur = be32_to_cpu(data[0]); |
| 267 | } |
| 268 | } |
| 269 | |
| 270 | s8 mt76_get_rate_power_limits(struct mt76_phy *phy, |
| 271 | struct ieee80211_channel *chan, |
| 272 | struct mt76_power_limits *dest, |
| 273 | s8 target_power) |
| 274 | { |
| 275 | struct mt76_dev *dev = phy->dev; |
| 276 | struct device_node *np; |
| 277 | const __be32 *val; |
| 278 | char name[16]; |
| 279 | u32 mcs_rates = dev->drv->mcs_rates; |
| 280 | u32 ru_rates = ARRAY_SIZE(dest->ru[0]); |
| 281 | char band; |
| 282 | size_t len; |
| 283 | s8 max_power = 0; |
| 284 | s8 txs_delta; |
| 285 | |
| 286 | if (!mcs_rates) |
| 287 | mcs_rates = 10; |
| 288 | |
| 289 | memset(dest, target_power, sizeof(*dest)); |
| 290 | |
| 291 | if (!IS_ENABLED(CONFIG_OF)) |
| 292 | return target_power; |
| 293 | |
| 294 | np = mt76_find_power_limits_node(dev); |
| 295 | if (!np) |
| 296 | return target_power; |
| 297 | |
| 298 | switch (chan->band) { |
| 299 | case NL80211_BAND_2GHZ: |
| 300 | band = '2'; |
| 301 | break; |
| 302 | case NL80211_BAND_5GHZ: |
| 303 | band = '5'; |
| 304 | break; |
| 305 | case NL80211_BAND_6GHZ: |
| 306 | band = '6'; |
| 307 | break; |
| 308 | default: |
| 309 | return target_power; |
| 310 | } |
| 311 | |
| 312 | snprintf(name, sizeof(name), "txpower-%cg", band); |
| 313 | np = of_get_child_by_name(np, name); |
| 314 | if (!np) |
| 315 | return target_power; |
| 316 | |
| 317 | np = mt76_find_channel_node(np, chan); |
| 318 | if (!np) |
| 319 | return target_power; |
| 320 | |
| 321 | txs_delta = mt76_get_txs_delta(np, hweight8(phy->antenna_mask)); |
| 322 | |
| 323 | val = mt76_get_of_array(np, "rates-cck", &len, ARRAY_SIZE(dest->cck)); |
| 324 | mt76_apply_array_limit(dest->cck, ARRAY_SIZE(dest->cck), val, |
| 325 | target_power, txs_delta, &max_power); |
| 326 | |
| 327 | val = mt76_get_of_array(np, "rates-ofdm", |
| 328 | &len, ARRAY_SIZE(dest->ofdm)); |
| 329 | mt76_apply_array_limit(dest->ofdm, ARRAY_SIZE(dest->ofdm), val, |
| 330 | target_power, txs_delta, &max_power); |
| 331 | |
| 332 | val = mt76_get_of_array(np, "rates-mcs", &len, mcs_rates + 1); |
| 333 | mt76_apply_multi_array_limit(dest->mcs[0], ARRAY_SIZE(dest->mcs[0]), |
| 334 | ARRAY_SIZE(dest->mcs), val, len, |
| 335 | target_power, txs_delta, &max_power); |
| 336 | |
| 337 | val = mt76_get_of_array(np, "rates-ru", &len, ru_rates + 1); |
| 338 | mt76_apply_multi_array_limit(dest->ru[0], ARRAY_SIZE(dest->ru[0]), |
| 339 | ARRAY_SIZE(dest->ru), val, len, |
| 340 | target_power, txs_delta, &max_power); |
| 341 | |
| 342 | return max_power; |
| 343 | } |
| 344 | EXPORT_SYMBOL_GPL(mt76_get_rate_power_limits); |
| 345 | |
| 346 | int |
| 347 | mt76_eeprom_init(struct mt76_dev *dev, int len) |
| 348 | { |
| 349 | dev->eeprom.size = len; |
| 350 | dev->eeprom.data = devm_kzalloc(dev->dev, len, GFP_KERNEL); |
| 351 | if (!dev->eeprom.data) |
| 352 | return -ENOMEM; |
| 353 | |
| 354 | return !mt76_get_of_eeprom(dev, dev->eeprom.data, 0, len); |
| 355 | } |
| 356 | EXPORT_SYMBOL_GPL(mt76_eeprom_init); |