2 * BCM47xx/BCM53xx nvram variable access
4 * Copyright (C) 2005 Broadcom Corporation
5 * Copyright (C) 2004 Florian Schirmer <jolt@tuxbox.org>
6 * Copyright (C) 2006 Michael Buesch <m@bues.ch>
7 * Copyright (C) 2010 Waldemar Brodkorb <wbx@openadk.org>
8 * Copyright (C) 2006 Felix Fietkau <nbd@openwrt.org>
9 * Copyright (C) 2010-2014 Hauke Mehrtens <hauke@hauke-m.de>
11 * This program is free software; you can redistribute it and/or modify it
12 * under the terms of the GNU General Public License as published by the
13 * Free Software Foundation; either version 2 of the License, or (at your
14 * option) any later version.
17 #include <linux/types.h>
18 #include <linux/module.h>
19 #include <linux/kernel.h>
20 #include <linux/string.h>
21 #include <linux/of_address.h>
22 #include <linux/device.h>
23 #include <linux/platform_device.h>
24 #include <linux/of_platform.h>
26 #include <linux/ssb/ssb.h>
27 #include <linux/bcm47xx_nvram.h>
28 #include <linux/if_ether.h>
29 #include <linux/etherdevice.h>
31 struct bcm47xx_sprom_fill
{
34 int (*getenv
)(const struct bcm47xx_sprom_fill
*fill
, const char *name
,
35 char *val
, size_t val_len
);
39 static void create_key(const char *prefix
, const char *postfix
,
40 const char *name
, char *buf
, int len
)
42 if (prefix
&& postfix
)
43 snprintf(buf
, len
, "%s%s%s", prefix
, name
, postfix
);
45 snprintf(buf
, len
, "%s%s", prefix
, name
);
47 snprintf(buf
, len
, "%s%s", name
, postfix
);
49 snprintf(buf
, len
, "%s", name
);
52 static int get_nvram_var(const struct bcm47xx_sprom_fill
*fill
,
53 const char *postfix
, const char *name
, char *buf
,
59 create_key(fill
->prefix
, postfix
, name
, key
, sizeof(key
));
61 err
= fill
->getenv(fill
, key
, buf
, len
);
62 if (fill
->fallback
&& err
== -ENOENT
&& fill
->prefix
) {
63 create_key(NULL
, postfix
, name
, key
, sizeof(key
));
64 err
= fill
->getenv(fill
, key
, buf
, len
);
69 #define NVRAM_READ_VAL(type) \
70 static void nvram_read_ ## type (const struct bcm47xx_sprom_fill *fill, \
71 const char *postfix, const char *name, \
72 type *val, type allset) \
78 err = get_nvram_var(fill, postfix, name, buf, sizeof(buf)); \
81 err = kstrto ## type(strim(buf), 0, &var); \
83 pr_warn("can not parse nvram name %s%s%s with value %s got %i\n", \
84 fill->prefix, name, postfix, buf, err); \
87 if (allset && var == allset) \
99 static void nvram_read_u32_2(const struct bcm47xx_sprom_fill
*fill
,
100 const char *name
, u16
*val_lo
, u16
*val_hi
)
106 err
= get_nvram_var(fill
, NULL
, name
, buf
, sizeof(buf
));
109 err
= kstrtou32(strim(buf
), 0, &val
);
111 pr_warn("can not parse nvram name %s%s with value %s got %i\n",
112 fill
->prefix
, name
, buf
, err
);
115 *val_lo
= (val
& 0x0000FFFFU
);
116 *val_hi
= (val
& 0xFFFF0000U
) >> 16;
119 static void nvram_read_leddc(const struct bcm47xx_sprom_fill
*fill
,
120 const char *name
, u8
*leddc_on_time
,
127 err
= get_nvram_var(fill
, NULL
, name
, buf
, sizeof(buf
));
130 err
= kstrtou32(strim(buf
), 0, &val
);
132 pr_warn("can not parse nvram name %s%s with value %s got %i\n",
133 fill
->prefix
, name
, buf
, err
);
137 if (val
== 0xffff || val
== 0xffffffff)
140 *leddc_on_time
= val
& 0xff;
141 *leddc_off_time
= (val
>> 16) & 0xff;
144 static void nvram_read_macaddr(const struct bcm47xx_sprom_fill
*fill
,
145 const char *name
, u8 val
[6])
150 err
= get_nvram_var(fill
, NULL
, name
, buf
, sizeof(buf
));
154 bcm47xx_nvram_parse_macaddr(buf
, val
);
157 static void nvram_read_alpha2(const struct bcm47xx_sprom_fill
*fill
,
158 const char *name
, char val
[2])
163 err
= get_nvram_var(fill
, NULL
, name
, buf
, sizeof(buf
));
168 if (strlen(buf
) > 2) {
169 pr_warn("alpha2 is too long %s\n", buf
);
175 static void bcm47xx_sprom_fill_r1234589(struct ssb_sprom
*sprom
,
176 const struct bcm47xx_sprom_fill
*fill
)
178 nvram_read_u16(fill
, NULL
, "devid", &sprom
->dev_id
, 0);
179 nvram_read_u8(fill
, NULL
, "ledbh0", &sprom
->gpio0
, 0xff);
180 nvram_read_u8(fill
, NULL
, "ledbh1", &sprom
->gpio1
, 0xff);
181 nvram_read_u8(fill
, NULL
, "ledbh2", &sprom
->gpio2
, 0xff);
182 nvram_read_u8(fill
, NULL
, "ledbh3", &sprom
->gpio3
, 0xff);
183 nvram_read_u8(fill
, NULL
, "aa2g", &sprom
->ant_available_bg
, 0);
184 nvram_read_u8(fill
, NULL
, "aa5g", &sprom
->ant_available_a
, 0);
185 nvram_read_s8(fill
, NULL
, "ag0", &sprom
->antenna_gain
.a0
, 0);
186 nvram_read_s8(fill
, NULL
, "ag1", &sprom
->antenna_gain
.a1
, 0);
187 nvram_read_alpha2(fill
, "ccode", sprom
->alpha2
);
190 static void bcm47xx_sprom_fill_r12389(struct ssb_sprom
*sprom
,
191 const struct bcm47xx_sprom_fill
*fill
)
193 nvram_read_u16(fill
, NULL
, "pa0b0", &sprom
->pa0b0
, 0);
194 nvram_read_u16(fill
, NULL
, "pa0b1", &sprom
->pa0b1
, 0);
195 nvram_read_u16(fill
, NULL
, "pa0b2", &sprom
->pa0b2
, 0);
196 nvram_read_u8(fill
, NULL
, "pa0itssit", &sprom
->itssi_bg
, 0);
197 nvram_read_u8(fill
, NULL
, "pa0maxpwr", &sprom
->maxpwr_bg
, 0);
198 nvram_read_u16(fill
, NULL
, "pa1b0", &sprom
->pa1b0
, 0);
199 nvram_read_u16(fill
, NULL
, "pa1b1", &sprom
->pa1b1
, 0);
200 nvram_read_u16(fill
, NULL
, "pa1b2", &sprom
->pa1b2
, 0);
201 nvram_read_u8(fill
, NULL
, "pa1itssit", &sprom
->itssi_a
, 0);
202 nvram_read_u8(fill
, NULL
, "pa1maxpwr", &sprom
->maxpwr_a
, 0);
205 static void bcm47xx_sprom_fill_r1(struct ssb_sprom
*sprom
,
206 const struct bcm47xx_sprom_fill
*fill
)
208 nvram_read_u16(fill
, NULL
, "boardflags", &sprom
->boardflags_lo
, 0);
209 nvram_read_u8(fill
, NULL
, "cc", &sprom
->country_code
, 0);
212 static void bcm47xx_sprom_fill_r2389(struct ssb_sprom
*sprom
,
213 const struct bcm47xx_sprom_fill
*fill
)
215 nvram_read_u8(fill
, NULL
, "opo", &sprom
->opo
, 0);
216 nvram_read_u16(fill
, NULL
, "pa1lob0", &sprom
->pa1lob0
, 0);
217 nvram_read_u16(fill
, NULL
, "pa1lob1", &sprom
->pa1lob1
, 0);
218 nvram_read_u16(fill
, NULL
, "pa1lob2", &sprom
->pa1lob2
, 0);
219 nvram_read_u16(fill
, NULL
, "pa1hib0", &sprom
->pa1hib0
, 0);
220 nvram_read_u16(fill
, NULL
, "pa1hib1", &sprom
->pa1hib1
, 0);
221 nvram_read_u16(fill
, NULL
, "pa1hib2", &sprom
->pa1hib2
, 0);
222 nvram_read_u8(fill
, NULL
, "pa1lomaxpwr", &sprom
->maxpwr_al
, 0);
223 nvram_read_u8(fill
, NULL
, "pa1himaxpwr", &sprom
->maxpwr_ah
, 0);
226 static void bcm47xx_sprom_fill_r389(struct ssb_sprom
*sprom
,
227 const struct bcm47xx_sprom_fill
*fill
)
229 nvram_read_u8(fill
, NULL
, "bxa2g", &sprom
->bxa2g
, 0);
230 nvram_read_u8(fill
, NULL
, "rssisav2g", &sprom
->rssisav2g
, 0);
231 nvram_read_u8(fill
, NULL
, "rssismc2g", &sprom
->rssismc2g
, 0);
232 nvram_read_u8(fill
, NULL
, "rssismf2g", &sprom
->rssismf2g
, 0);
233 nvram_read_u8(fill
, NULL
, "bxa5g", &sprom
->bxa5g
, 0);
234 nvram_read_u8(fill
, NULL
, "rssisav5g", &sprom
->rssisav5g
, 0);
235 nvram_read_u8(fill
, NULL
, "rssismc5g", &sprom
->rssismc5g
, 0);
236 nvram_read_u8(fill
, NULL
, "rssismf5g", &sprom
->rssismf5g
, 0);
237 nvram_read_u8(fill
, NULL
, "tri2g", &sprom
->tri2g
, 0);
238 nvram_read_u8(fill
, NULL
, "tri5g", &sprom
->tri5g
, 0);
239 nvram_read_u8(fill
, NULL
, "tri5gl", &sprom
->tri5gl
, 0);
240 nvram_read_u8(fill
, NULL
, "tri5gh", &sprom
->tri5gh
, 0);
241 nvram_read_s8(fill
, NULL
, "rxpo2g", &sprom
->rxpo2g
, 0);
242 nvram_read_s8(fill
, NULL
, "rxpo5g", &sprom
->rxpo5g
, 0);
245 static void bcm47xx_sprom_fill_r3(struct ssb_sprom
*sprom
,
246 const struct bcm47xx_sprom_fill
*fill
)
248 nvram_read_u8(fill
, NULL
, "regrev", &sprom
->regrev
, 0);
249 nvram_read_leddc(fill
, "leddc", &sprom
->leddc_on_time
,
250 &sprom
->leddc_off_time
);
253 static void bcm47xx_sprom_fill_r4589(struct ssb_sprom
*sprom
,
254 const struct bcm47xx_sprom_fill
*fill
)
256 nvram_read_u8(fill
, NULL
, "regrev", &sprom
->regrev
, 0);
257 nvram_read_s8(fill
, NULL
, "ag2", &sprom
->antenna_gain
.a2
, 0);
258 nvram_read_s8(fill
, NULL
, "ag3", &sprom
->antenna_gain
.a3
, 0);
259 nvram_read_u8(fill
, NULL
, "txchain", &sprom
->txchain
, 0xf);
260 nvram_read_u8(fill
, NULL
, "rxchain", &sprom
->rxchain
, 0xf);
261 nvram_read_u8(fill
, NULL
, "antswitch", &sprom
->antswitch
, 0xff);
262 nvram_read_leddc(fill
, "leddc", &sprom
->leddc_on_time
,
263 &sprom
->leddc_off_time
);
266 static void bcm47xx_sprom_fill_r458(struct ssb_sprom
*sprom
,
267 const struct bcm47xx_sprom_fill
*fill
)
269 nvram_read_u16(fill
, NULL
, "cck2gpo", &sprom
->cck2gpo
, 0);
270 nvram_read_u32(fill
, NULL
, "ofdm2gpo", &sprom
->ofdm2gpo
, 0);
271 nvram_read_u32(fill
, NULL
, "ofdm5gpo", &sprom
->ofdm5gpo
, 0);
272 nvram_read_u32(fill
, NULL
, "ofdm5glpo", &sprom
->ofdm5glpo
, 0);
273 nvram_read_u32(fill
, NULL
, "ofdm5ghpo", &sprom
->ofdm5ghpo
, 0);
274 nvram_read_u16(fill
, NULL
, "cddpo", &sprom
->cddpo
, 0);
275 nvram_read_u16(fill
, NULL
, "stbcpo", &sprom
->stbcpo
, 0);
276 nvram_read_u16(fill
, NULL
, "bw40po", &sprom
->bw40po
, 0);
277 nvram_read_u16(fill
, NULL
, "bwduppo", &sprom
->bwduppo
, 0);
278 nvram_read_u16(fill
, NULL
, "mcs2gpo0", &sprom
->mcs2gpo
[0], 0);
279 nvram_read_u16(fill
, NULL
, "mcs2gpo1", &sprom
->mcs2gpo
[1], 0);
280 nvram_read_u16(fill
, NULL
, "mcs2gpo2", &sprom
->mcs2gpo
[2], 0);
281 nvram_read_u16(fill
, NULL
, "mcs2gpo3", &sprom
->mcs2gpo
[3], 0);
282 nvram_read_u16(fill
, NULL
, "mcs2gpo4", &sprom
->mcs2gpo
[4], 0);
283 nvram_read_u16(fill
, NULL
, "mcs2gpo5", &sprom
->mcs2gpo
[5], 0);
284 nvram_read_u16(fill
, NULL
, "mcs2gpo6", &sprom
->mcs2gpo
[6], 0);
285 nvram_read_u16(fill
, NULL
, "mcs2gpo7", &sprom
->mcs2gpo
[7], 0);
286 nvram_read_u16(fill
, NULL
, "mcs5gpo0", &sprom
->mcs5gpo
[0], 0);
287 nvram_read_u16(fill
, NULL
, "mcs5gpo1", &sprom
->mcs5gpo
[1], 0);
288 nvram_read_u16(fill
, NULL
, "mcs5gpo2", &sprom
->mcs5gpo
[2], 0);
289 nvram_read_u16(fill
, NULL
, "mcs5gpo3", &sprom
->mcs5gpo
[3], 0);
290 nvram_read_u16(fill
, NULL
, "mcs5gpo4", &sprom
->mcs5gpo
[4], 0);
291 nvram_read_u16(fill
, NULL
, "mcs5gpo5", &sprom
->mcs5gpo
[5], 0);
292 nvram_read_u16(fill
, NULL
, "mcs5gpo6", &sprom
->mcs5gpo
[6], 0);
293 nvram_read_u16(fill
, NULL
, "mcs5gpo7", &sprom
->mcs5gpo
[7], 0);
294 nvram_read_u16(fill
, NULL
, "mcs5glpo0", &sprom
->mcs5glpo
[0], 0);
295 nvram_read_u16(fill
, NULL
, "mcs5glpo1", &sprom
->mcs5glpo
[1], 0);
296 nvram_read_u16(fill
, NULL
, "mcs5glpo2", &sprom
->mcs5glpo
[2], 0);
297 nvram_read_u16(fill
, NULL
, "mcs5glpo3", &sprom
->mcs5glpo
[3], 0);
298 nvram_read_u16(fill
, NULL
, "mcs5glpo4", &sprom
->mcs5glpo
[4], 0);
299 nvram_read_u16(fill
, NULL
, "mcs5glpo5", &sprom
->mcs5glpo
[5], 0);
300 nvram_read_u16(fill
, NULL
, "mcs5glpo6", &sprom
->mcs5glpo
[6], 0);
301 nvram_read_u16(fill
, NULL
, "mcs5glpo7", &sprom
->mcs5glpo
[7], 0);
302 nvram_read_u16(fill
, NULL
, "mcs5ghpo0", &sprom
->mcs5ghpo
[0], 0);
303 nvram_read_u16(fill
, NULL
, "mcs5ghpo1", &sprom
->mcs5ghpo
[1], 0);
304 nvram_read_u16(fill
, NULL
, "mcs5ghpo2", &sprom
->mcs5ghpo
[2], 0);
305 nvram_read_u16(fill
, NULL
, "mcs5ghpo3", &sprom
->mcs5ghpo
[3], 0);
306 nvram_read_u16(fill
, NULL
, "mcs5ghpo4", &sprom
->mcs5ghpo
[4], 0);
307 nvram_read_u16(fill
, NULL
, "mcs5ghpo5", &sprom
->mcs5ghpo
[5], 0);
308 nvram_read_u16(fill
, NULL
, "mcs5ghpo6", &sprom
->mcs5ghpo
[6], 0);
309 nvram_read_u16(fill
, NULL
, "mcs5ghpo7", &sprom
->mcs5ghpo
[7], 0);
312 static void bcm47xx_sprom_fill_r45(struct ssb_sprom
*sprom
,
313 const struct bcm47xx_sprom_fill
*fill
)
315 nvram_read_u8(fill
, NULL
, "txpid2ga0", &sprom
->txpid2g
[0], 0);
316 nvram_read_u8(fill
, NULL
, "txpid2ga1", &sprom
->txpid2g
[1], 0);
317 nvram_read_u8(fill
, NULL
, "txpid2ga2", &sprom
->txpid2g
[2], 0);
318 nvram_read_u8(fill
, NULL
, "txpid2ga3", &sprom
->txpid2g
[3], 0);
319 nvram_read_u8(fill
, NULL
, "txpid5ga0", &sprom
->txpid5g
[0], 0);
320 nvram_read_u8(fill
, NULL
, "txpid5ga1", &sprom
->txpid5g
[1], 0);
321 nvram_read_u8(fill
, NULL
, "txpid5ga2", &sprom
->txpid5g
[2], 0);
322 nvram_read_u8(fill
, NULL
, "txpid5ga3", &sprom
->txpid5g
[3], 0);
323 nvram_read_u8(fill
, NULL
, "txpid5gla0", &sprom
->txpid5gl
[0], 0);
324 nvram_read_u8(fill
, NULL
, "txpid5gla1", &sprom
->txpid5gl
[1], 0);
325 nvram_read_u8(fill
, NULL
, "txpid5gla2", &sprom
->txpid5gl
[2], 0);
326 nvram_read_u8(fill
, NULL
, "txpid5gla3", &sprom
->txpid5gl
[3], 0);
327 nvram_read_u8(fill
, NULL
, "txpid5gha0", &sprom
->txpid5gh
[0], 0);
328 nvram_read_u8(fill
, NULL
, "txpid5gha1", &sprom
->txpid5gh
[1], 0);
329 nvram_read_u8(fill
, NULL
, "txpid5gha2", &sprom
->txpid5gh
[2], 0);
330 nvram_read_u8(fill
, NULL
, "txpid5gha3", &sprom
->txpid5gh
[3], 0);
333 static void bcm47xx_sprom_fill_r89(struct ssb_sprom
*sprom
,
334 const struct bcm47xx_sprom_fill
*fill
)
336 nvram_read_u8(fill
, NULL
, "tssipos2g", &sprom
->fem
.ghz2
.tssipos
, 0);
337 nvram_read_u8(fill
, NULL
, "extpagain2g", &sprom
->fem
.ghz2
.extpa_gain
, 0);
338 nvram_read_u8(fill
, NULL
, "pdetrange2g", &sprom
->fem
.ghz2
.pdet_range
, 0);
339 nvram_read_u8(fill
, NULL
, "triso2g", &sprom
->fem
.ghz2
.tr_iso
, 0);
340 nvram_read_u8(fill
, NULL
, "antswctl2g", &sprom
->fem
.ghz2
.antswlut
, 0);
341 nvram_read_u8(fill
, NULL
, "tssipos5g", &sprom
->fem
.ghz5
.tssipos
, 0);
342 nvram_read_u8(fill
, NULL
, "extpagain5g", &sprom
->fem
.ghz5
.extpa_gain
, 0);
343 nvram_read_u8(fill
, NULL
, "pdetrange5g", &sprom
->fem
.ghz5
.pdet_range
, 0);
344 nvram_read_u8(fill
, NULL
, "triso5g", &sprom
->fem
.ghz5
.tr_iso
, 0);
345 nvram_read_u8(fill
, NULL
, "antswctl5g", &sprom
->fem
.ghz5
.antswlut
, 0);
346 nvram_read_u8(fill
, NULL
, "tempthresh", &sprom
->tempthresh
, 0);
347 nvram_read_u8(fill
, NULL
, "tempoffset", &sprom
->tempoffset
, 0);
348 nvram_read_u16(fill
, NULL
, "rawtempsense", &sprom
->rawtempsense
, 0);
349 nvram_read_u8(fill
, NULL
, "measpower", &sprom
->measpower
, 0);
350 nvram_read_u8(fill
, NULL
, "tempsense_slope", &sprom
->tempsense_slope
, 0);
351 nvram_read_u8(fill
, NULL
, "tempcorrx", &sprom
->tempcorrx
, 0);
352 nvram_read_u8(fill
, NULL
, "tempsense_option", &sprom
->tempsense_option
, 0);
353 nvram_read_u8(fill
, NULL
, "freqoffset_corr", &sprom
->freqoffset_corr
, 0);
354 nvram_read_u8(fill
, NULL
, "iqcal_swp_dis", &sprom
->iqcal_swp_dis
, 0);
355 nvram_read_u8(fill
, NULL
, "hw_iqcal_en", &sprom
->hw_iqcal_en
, 0);
356 nvram_read_u8(fill
, NULL
, "elna2g", &sprom
->elna2g
, 0);
357 nvram_read_u8(fill
, NULL
, "elna5g", &sprom
->elna5g
, 0);
358 nvram_read_u8(fill
, NULL
, "phycal_tempdelta", &sprom
->phycal_tempdelta
, 0);
359 nvram_read_u8(fill
, NULL
, "temps_period", &sprom
->temps_period
, 0);
360 nvram_read_u8(fill
, NULL
, "temps_hysteresis", &sprom
->temps_hysteresis
, 0);
361 nvram_read_u8(fill
, NULL
, "measpower1", &sprom
->measpower1
, 0);
362 nvram_read_u8(fill
, NULL
, "measpower2", &sprom
->measpower2
, 0);
363 nvram_read_u8(fill
, NULL
, "rxgainerr2ga0", &sprom
->rxgainerr2ga
[0], 0);
364 nvram_read_u8(fill
, NULL
, "rxgainerr2ga1", &sprom
->rxgainerr2ga
[1], 0);
365 nvram_read_u8(fill
, NULL
, "rxgainerr2ga2", &sprom
->rxgainerr2ga
[2], 0);
366 nvram_read_u8(fill
, NULL
, "rxgainerr5gla0", &sprom
->rxgainerr5gla
[0], 0);
367 nvram_read_u8(fill
, NULL
, "rxgainerr5gla1", &sprom
->rxgainerr5gla
[1], 0);
368 nvram_read_u8(fill
, NULL
, "rxgainerr5gla2", &sprom
->rxgainerr5gla
[2], 0);
369 nvram_read_u8(fill
, NULL
, "rxgainerr5gma0", &sprom
->rxgainerr5gma
[0], 0);
370 nvram_read_u8(fill
, NULL
, "rxgainerr5gma1", &sprom
->rxgainerr5gma
[1], 0);
371 nvram_read_u8(fill
, NULL
, "rxgainerr5gma2", &sprom
->rxgainerr5gma
[2], 0);
372 nvram_read_u8(fill
, NULL
, "rxgainerr5gha0", &sprom
->rxgainerr5gha
[0], 0);
373 nvram_read_u8(fill
, NULL
, "rxgainerr5gha1", &sprom
->rxgainerr5gha
[1], 0);
374 nvram_read_u8(fill
, NULL
, "rxgainerr5gha2", &sprom
->rxgainerr5gha
[2], 0);
375 nvram_read_u8(fill
, NULL
, "rxgainerr5gua0", &sprom
->rxgainerr5gua
[0], 0);
376 nvram_read_u8(fill
, NULL
, "rxgainerr5gua1", &sprom
->rxgainerr5gua
[1], 0);
377 nvram_read_u8(fill
, NULL
, "rxgainerr5gua2", &sprom
->rxgainerr5gua
[2], 0);
378 nvram_read_u8(fill
, NULL
, "noiselvl2ga0", &sprom
->noiselvl2ga
[0], 0);
379 nvram_read_u8(fill
, NULL
, "noiselvl2ga1", &sprom
->noiselvl2ga
[1], 0);
380 nvram_read_u8(fill
, NULL
, "noiselvl2ga2", &sprom
->noiselvl2ga
[2], 0);
381 nvram_read_u8(fill
, NULL
, "noiselvl5gla0", &sprom
->noiselvl5gla
[0], 0);
382 nvram_read_u8(fill
, NULL
, "noiselvl5gla1", &sprom
->noiselvl5gla
[1], 0);
383 nvram_read_u8(fill
, NULL
, "noiselvl5gla2", &sprom
->noiselvl5gla
[2], 0);
384 nvram_read_u8(fill
, NULL
, "noiselvl5gma0", &sprom
->noiselvl5gma
[0], 0);
385 nvram_read_u8(fill
, NULL
, "noiselvl5gma1", &sprom
->noiselvl5gma
[1], 0);
386 nvram_read_u8(fill
, NULL
, "noiselvl5gma2", &sprom
->noiselvl5gma
[2], 0);
387 nvram_read_u8(fill
, NULL
, "noiselvl5gha0", &sprom
->noiselvl5gha
[0], 0);
388 nvram_read_u8(fill
, NULL
, "noiselvl5gha1", &sprom
->noiselvl5gha
[1], 0);
389 nvram_read_u8(fill
, NULL
, "noiselvl5gha2", &sprom
->noiselvl5gha
[2], 0);
390 nvram_read_u8(fill
, NULL
, "noiselvl5gua0", &sprom
->noiselvl5gua
[0], 0);
391 nvram_read_u8(fill
, NULL
, "noiselvl5gua1", &sprom
->noiselvl5gua
[1], 0);
392 nvram_read_u8(fill
, NULL
, "noiselvl5gua2", &sprom
->noiselvl5gua
[2], 0);
393 nvram_read_u8(fill
, NULL
, "pcieingress_war", &sprom
->pcieingress_war
, 0);
396 static void bcm47xx_sprom_fill_r9(struct ssb_sprom
*sprom
,
397 const struct bcm47xx_sprom_fill
*fill
)
399 nvram_read_u16(fill
, NULL
, "cckbw202gpo", &sprom
->cckbw202gpo
, 0);
400 nvram_read_u16(fill
, NULL
, "cckbw20ul2gpo", &sprom
->cckbw20ul2gpo
, 0);
401 nvram_read_u32(fill
, NULL
, "legofdmbw202gpo", &sprom
->legofdmbw202gpo
, 0);
402 nvram_read_u32(fill
, NULL
, "legofdmbw20ul2gpo", &sprom
->legofdmbw20ul2gpo
, 0);
403 nvram_read_u32(fill
, NULL
, "legofdmbw205glpo", &sprom
->legofdmbw205glpo
, 0);
404 nvram_read_u32(fill
, NULL
, "legofdmbw20ul5glpo", &sprom
->legofdmbw20ul5glpo
, 0);
405 nvram_read_u32(fill
, NULL
, "legofdmbw205gmpo", &sprom
->legofdmbw205gmpo
, 0);
406 nvram_read_u32(fill
, NULL
, "legofdmbw20ul5gmpo", &sprom
->legofdmbw20ul5gmpo
, 0);
407 nvram_read_u32(fill
, NULL
, "legofdmbw205ghpo", &sprom
->legofdmbw205ghpo
, 0);
408 nvram_read_u32(fill
, NULL
, "legofdmbw20ul5ghpo", &sprom
->legofdmbw20ul5ghpo
, 0);
409 nvram_read_u32(fill
, NULL
, "mcsbw202gpo", &sprom
->mcsbw202gpo
, 0);
410 nvram_read_u32(fill
, NULL
, "mcsbw20ul2gpo", &sprom
->mcsbw20ul2gpo
, 0);
411 nvram_read_u32(fill
, NULL
, "mcsbw402gpo", &sprom
->mcsbw402gpo
, 0);
412 nvram_read_u32(fill
, NULL
, "mcsbw205glpo", &sprom
->mcsbw205glpo
, 0);
413 nvram_read_u32(fill
, NULL
, "mcsbw20ul5glpo", &sprom
->mcsbw20ul5glpo
, 0);
414 nvram_read_u32(fill
, NULL
, "mcsbw405glpo", &sprom
->mcsbw405glpo
, 0);
415 nvram_read_u32(fill
, NULL
, "mcsbw205gmpo", &sprom
->mcsbw205gmpo
, 0);
416 nvram_read_u32(fill
, NULL
, "mcsbw20ul5gmpo", &sprom
->mcsbw20ul5gmpo
, 0);
417 nvram_read_u32(fill
, NULL
, "mcsbw405gmpo", &sprom
->mcsbw405gmpo
, 0);
418 nvram_read_u32(fill
, NULL
, "mcsbw205ghpo", &sprom
->mcsbw205ghpo
, 0);
419 nvram_read_u32(fill
, NULL
, "mcsbw20ul5ghpo", &sprom
->mcsbw20ul5ghpo
, 0);
420 nvram_read_u32(fill
, NULL
, "mcsbw405ghpo", &sprom
->mcsbw405ghpo
, 0);
421 nvram_read_u16(fill
, NULL
, "mcs32po", &sprom
->mcs32po
, 0);
422 nvram_read_u16(fill
, NULL
, "legofdm40duppo", &sprom
->legofdm40duppo
, 0);
423 nvram_read_u8(fill
, NULL
, "sar2g", &sprom
->sar2g
, 0);
424 nvram_read_u8(fill
, NULL
, "sar5g", &sprom
->sar5g
, 0);
427 static void bcm47xx_sprom_fill_path_r4589(struct ssb_sprom
*sprom
,
428 const struct bcm47xx_sprom_fill
*fill
)
433 for (i
= 0; i
< ARRAY_SIZE(sprom
->core_pwr_info
); i
++) {
434 struct ssb_sprom_core_pwr_info
*pwr_info
= &sprom
->core_pwr_info
[i
];
436 snprintf(postfix
, sizeof(postfix
), "%i", i
);
437 nvram_read_u8(fill
, postfix
, "maxp2ga", &pwr_info
->maxpwr_2g
, 0);
438 nvram_read_u8(fill
, postfix
, "itt2ga", &pwr_info
->itssi_2g
, 0);
439 nvram_read_u8(fill
, postfix
, "itt5ga", &pwr_info
->itssi_5g
, 0);
440 nvram_read_u16(fill
, postfix
, "pa2gw0a", &pwr_info
->pa_2g
[0], 0);
441 nvram_read_u16(fill
, postfix
, "pa2gw1a", &pwr_info
->pa_2g
[1], 0);
442 nvram_read_u16(fill
, postfix
, "pa2gw2a", &pwr_info
->pa_2g
[2], 0);
443 nvram_read_u8(fill
, postfix
, "maxp5ga", &pwr_info
->maxpwr_5g
, 0);
444 nvram_read_u8(fill
, postfix
, "maxp5gha", &pwr_info
->maxpwr_5gh
, 0);
445 nvram_read_u8(fill
, postfix
, "maxp5gla", &pwr_info
->maxpwr_5gl
, 0);
446 nvram_read_u16(fill
, postfix
, "pa5gw0a", &pwr_info
->pa_5g
[0], 0);
447 nvram_read_u16(fill
, postfix
, "pa5gw1a", &pwr_info
->pa_5g
[1], 0);
448 nvram_read_u16(fill
, postfix
, "pa5gw2a", &pwr_info
->pa_5g
[2], 0);
449 nvram_read_u16(fill
, postfix
, "pa5glw0a", &pwr_info
->pa_5gl
[0], 0);
450 nvram_read_u16(fill
, postfix
, "pa5glw1a", &pwr_info
->pa_5gl
[1], 0);
451 nvram_read_u16(fill
, postfix
, "pa5glw2a", &pwr_info
->pa_5gl
[2], 0);
452 nvram_read_u16(fill
, postfix
, "pa5ghw0a", &pwr_info
->pa_5gh
[0], 0);
453 nvram_read_u16(fill
, postfix
, "pa5ghw1a", &pwr_info
->pa_5gh
[1], 0);
454 nvram_read_u16(fill
, postfix
, "pa5ghw2a", &pwr_info
->pa_5gh
[2], 0);
458 static void bcm47xx_sprom_fill_path_r45(struct ssb_sprom
*sprom
,
459 const struct bcm47xx_sprom_fill
*fill
)
464 for (i
= 0; i
< ARRAY_SIZE(sprom
->core_pwr_info
); i
++) {
465 struct ssb_sprom_core_pwr_info
*pwr_info
= &sprom
->core_pwr_info
[i
];
467 snprintf(postfix
, sizeof(postfix
), "%i", i
);
468 nvram_read_u16(fill
, postfix
, "pa2gw3a", &pwr_info
->pa_2g
[3], 0);
469 nvram_read_u16(fill
, postfix
, "pa5gw3a", &pwr_info
->pa_5g
[3], 0);
470 nvram_read_u16(fill
, postfix
, "pa5glw3a", &pwr_info
->pa_5gl
[3], 0);
471 nvram_read_u16(fill
, postfix
, "pa5ghw3a", &pwr_info
->pa_5gh
[3], 0);
475 static bool bcm47xx_is_valid_mac(u8
*mac
)
477 return mac
&& !(mac
[0] == 0x00 && mac
[1] == 0x90 && mac
[2] == 0x4c);
480 static int bcm47xx_increase_mac_addr(u8
*mac
, u8 num
)
482 u8
*oui
= mac
+ ETH_ALEN
/2 - 1;
483 u8
*p
= mac
+ ETH_ALEN
- 1;
494 pr_err("unable to fetch mac address\n");
501 * This is a global counter because different instances of sprom will
502 * access the same nvram.
504 static int mac_addr_used
= 2;
506 static void bcm47xx_sprom_fill_ethernet(struct ssb_sprom
*sprom
,
507 const struct bcm47xx_sprom_fill
*fill
)
509 nvram_read_macaddr(fill
, "et0macaddr", sprom
->et0mac
);
510 nvram_read_u8(fill
, NULL
, "et0mdcport", &sprom
->et0mdcport
, 0);
511 nvram_read_u8(fill
, NULL
, "et0phyaddr", &sprom
->et0phyaddr
, 0);
513 nvram_read_macaddr(fill
, "et1macaddr", sprom
->et1mac
);
514 nvram_read_u8(fill
, NULL
, "et1mdcport", &sprom
->et1mdcport
, 0);
515 nvram_read_u8(fill
, NULL
, "et1phyaddr", &sprom
->et1phyaddr
, 0);
517 nvram_read_macaddr(fill
, "macaddr", sprom
->il0mac
);
518 nvram_read_macaddr(fill
, "il0macaddr", sprom
->il0mac
);
521 * The address prefix 00:90:4C is used by Broadcom in their initial
522 * configuration. When a mac address with the prefix 00:90:4C is used
523 * all devices from the same series are sharing the same mac address.
524 * To prevent mac address collisions we replace them with a mac address
525 * based on the base address.
527 if (!bcm47xx_is_valid_mac(sprom
->il0mac
)) {
529 struct bcm47xx_sprom_fill fill_no_prefix
;
531 memcpy(&fill_no_prefix
, fill
, sizeof(fill_no_prefix
));
532 fill_no_prefix
.prefix
= NULL
;
534 nvram_read_macaddr(&fill_no_prefix
, "et0macaddr", mac
);
535 if (bcm47xx_is_valid_mac(mac
)) {
536 int err
= bcm47xx_increase_mac_addr(mac
, mac_addr_used
);
539 ether_addr_copy(sprom
->il0mac
, mac
);
546 static void bcm47xx_sprom_fill_board_data(struct ssb_sprom
*sprom
,
547 const struct bcm47xx_sprom_fill
*fill
)
549 nvram_read_u16(fill
, NULL
, "boardrev", &sprom
->board_rev
, 0);
550 nvram_read_u16(fill
, NULL
, "boardnum", &sprom
->board_num
, 0);
551 nvram_read_u16(fill
, NULL
, "boardtype", &sprom
->board_type
, 0);
552 nvram_read_u32_2(fill
, "boardflags", &sprom
->boardflags_lo
,
553 &sprom
->boardflags_hi
);
554 nvram_read_u32_2(fill
, "boardflags2", &sprom
->boardflags2_lo
,
555 &sprom
->boardflags2_hi
);
558 static void bcm47xx_sprom_fill(struct ssb_sprom
*sprom
,
559 const struct bcm47xx_sprom_fill
*fill
)
561 bcm47xx_sprom_fill_ethernet(sprom
, fill
);
562 bcm47xx_sprom_fill_board_data(sprom
, fill
);
564 nvram_read_u8(fill
, NULL
, "sromrev", &sprom
->revision
, 0);
566 switch (sprom
->revision
) {
568 bcm47xx_sprom_fill_r1234589(sprom
, fill
);
569 bcm47xx_sprom_fill_r12389(sprom
, fill
);
570 bcm47xx_sprom_fill_r1(sprom
, fill
);
573 bcm47xx_sprom_fill_r1234589(sprom
, fill
);
574 bcm47xx_sprom_fill_r12389(sprom
, fill
);
575 bcm47xx_sprom_fill_r2389(sprom
, fill
);
578 bcm47xx_sprom_fill_r1234589(sprom
, fill
);
579 bcm47xx_sprom_fill_r12389(sprom
, fill
);
580 bcm47xx_sprom_fill_r2389(sprom
, fill
);
581 bcm47xx_sprom_fill_r389(sprom
, fill
);
582 bcm47xx_sprom_fill_r3(sprom
, fill
);
586 bcm47xx_sprom_fill_r1234589(sprom
, fill
);
587 bcm47xx_sprom_fill_r4589(sprom
, fill
);
588 bcm47xx_sprom_fill_r458(sprom
, fill
);
589 bcm47xx_sprom_fill_r45(sprom
, fill
);
590 bcm47xx_sprom_fill_path_r4589(sprom
, fill
);
591 bcm47xx_sprom_fill_path_r45(sprom
, fill
);
594 bcm47xx_sprom_fill_r1234589(sprom
, fill
);
595 bcm47xx_sprom_fill_r12389(sprom
, fill
);
596 bcm47xx_sprom_fill_r2389(sprom
, fill
);
597 bcm47xx_sprom_fill_r389(sprom
, fill
);
598 bcm47xx_sprom_fill_r4589(sprom
, fill
);
599 bcm47xx_sprom_fill_r458(sprom
, fill
);
600 bcm47xx_sprom_fill_r89(sprom
, fill
);
601 bcm47xx_sprom_fill_path_r4589(sprom
, fill
);
604 bcm47xx_sprom_fill_r1234589(sprom
, fill
);
605 bcm47xx_sprom_fill_r12389(sprom
, fill
);
606 bcm47xx_sprom_fill_r2389(sprom
, fill
);
607 bcm47xx_sprom_fill_r389(sprom
, fill
);
608 bcm47xx_sprom_fill_r4589(sprom
, fill
);
609 bcm47xx_sprom_fill_r89(sprom
, fill
);
610 bcm47xx_sprom_fill_r9(sprom
, fill
);
611 bcm47xx_sprom_fill_path_r4589(sprom
, fill
);
614 pr_warn("Unsupported SPROM revision %d detected. Will extract v1\n",
617 bcm47xx_sprom_fill_r1234589(sprom
, fill
);
618 bcm47xx_sprom_fill_r12389(sprom
, fill
);
619 bcm47xx_sprom_fill_r1(sprom
, fill
);
623 static int bcm47xx_sprom_getenv(const struct bcm47xx_sprom_fill
*fill
,
624 const char *name
, char *val
, size_t val_len
)
626 const struct platform_device
*nvram_dev
= fill
->priv
;
628 return bcm47xx_nvram_getenv(&nvram_dev
->dev
, name
, val
, val_len
);
631 static int bcm47xx_sprom_probe(struct platform_device
*pdev
)
633 struct device
*dev
= &pdev
->dev
;
634 struct device_node
*np
= dev
->of_node
;
635 struct ssb_sprom
*sprom
;
636 const __be32
*handle
;
637 struct device_node
*nvram_node
;
638 struct platform_device
*nvram_dev
;
639 struct bcm47xx_sprom_fill fill
;
642 sprom
= devm_kzalloc(dev
, sizeof(*sprom
), GFP_KERNEL
);
646 handle
= of_get_property(np
, "nvram", NULL
);
650 nvram_node
= of_find_node_by_phandle(be32_to_cpup(handle
));
654 nvram_dev
= of_find_device_by_node(nvram_node
);
658 fill
.prefix
= of_get_property(np
, "prefix", NULL
);
660 fill
.fallback
= false;
661 fill
.getenv
= bcm47xx_sprom_getenv
;
662 fill
.priv
= nvram_dev
;
664 bcm47xx_sprom_fill(sprom
, &fill
);
666 platform_set_drvdata(pdev
, sprom
);
671 static const struct of_device_id bcm47xx_sprom_of_match_table
[] = {
672 { .compatible
= "brcm,bcm47xx-sprom", },
675 MODULE_DEVICE_TABLE(of
, mvebu_pcie_of_match_table
);
677 static struct platform_driver bcm47xx_sprom_driver
= {
679 .owner
= THIS_MODULE
,
680 .name
= "bcm47xx-sprom",
681 .of_match_table
= bcm47xx_sprom_of_match_table
,
682 /* driver unloading/unbinding currently not supported */
683 .suppress_bind_attrs
= true,
685 .probe
= bcm47xx_sprom_probe
,
687 module_platform_driver(bcm47xx_sprom_driver
);
689 MODULE_AUTHOR("Hauke Mehrtens <hauke@hauke-m.de>");
690 MODULE_LICENSE("GPL v2");