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