1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29#include <linux/bcm47xx_nvram.h>
30#include <linux/bcm47xx_sprom.h>
31#include <linux/bcma/bcma.h>
32#include <linux/etherdevice.h>
33#include <linux/if_ether.h>
34#include <linux/ssb/ssb.h>
35
36static void create_key(const char *prefix, const char *postfix,
37 const char *name, char *buf, int len)
38{
39 if (prefix && postfix)
40 snprintf(buf, len, "%s%s%s", prefix, name, postfix);
41 else if (prefix)
42 snprintf(buf, len, "%s%s", prefix, name);
43 else if (postfix)
44 snprintf(buf, len, "%s%s", name, postfix);
45 else
46 snprintf(buf, len, "%s", name);
47}
48
49static int get_nvram_var(const char *prefix, const char *postfix,
50 const char *name, char *buf, int len, bool fallback)
51{
52 char key[40];
53 int err;
54
55 create_key(prefix, postfix, name, key, sizeof(key));
56
57 err = bcm47xx_nvram_getenv(key, buf, len);
58 if (fallback && err == -ENOENT && prefix) {
59 create_key(NULL, postfix, name, key, sizeof(key));
60 err = bcm47xx_nvram_getenv(key, buf, len);
61 }
62 return err;
63}
64
65#define NVRAM_READ_VAL(type) \
66static void nvram_read_ ## type(const char *prefix, \
67 const char *postfix, const char *name, \
68 type *val, type allset, bool fallback) \
69{ \
70 char buf[100]; \
71 int err; \
72 type var; \
73 \
74 err = get_nvram_var(prefix, postfix, name, buf, sizeof(buf), \
75 fallback); \
76 if (err < 0) \
77 return; \
78 err = kstrto ## type(strim(buf), 0, &var); \
79 if (err) { \
80 pr_warn("can not parse nvram name %s%s%s with value %s got %i\n", \
81 prefix, name, postfix, buf, err); \
82 return; \
83 } \
84 if (allset && var == allset) \
85 return; \
86 *val = var; \
87}
88
89NVRAM_READ_VAL(u8)
90NVRAM_READ_VAL(s8)
91NVRAM_READ_VAL(u16)
92NVRAM_READ_VAL(u32)
93
94#undef NVRAM_READ_VAL
95
96static void nvram_read_u32_2(const char *prefix, const char *name,
97 u16 *val_lo, u16 *val_hi, bool fallback)
98{
99 char buf[100];
100 int err;
101 u32 val;
102
103 err = get_nvram_var(prefix, NULL, name, buf, sizeof(buf), fallback);
104 if (err < 0)
105 return;
106 err = kstrtou32(strim(buf), 0, &val);
107 if (err) {
108 pr_warn("can not parse nvram name %s%s with value %s got %i\n",
109 prefix, name, buf, err);
110 return;
111 }
112 *val_lo = (val & 0x0000FFFFU);
113 *val_hi = (val & 0xFFFF0000U) >> 16;
114}
115
116static void nvram_read_leddc(const char *prefix, const char *name,
117 u8 *leddc_on_time, u8 *leddc_off_time,
118 bool fallback)
119{
120 char buf[100];
121 int err;
122 u32 val;
123
124 err = get_nvram_var(prefix, NULL, name, buf, sizeof(buf), fallback);
125 if (err < 0)
126 return;
127 err = kstrtou32(strim(buf), 0, &val);
128 if (err) {
129 pr_warn("can not parse nvram name %s%s with value %s got %i\n",
130 prefix, name, buf, err);
131 return;
132 }
133
134 if (val == 0xffff || val == 0xffffffff)
135 return;
136
137 *leddc_on_time = val & 0xff;
138 *leddc_off_time = (val >> 16) & 0xff;
139}
140
141static void nvram_read_macaddr(const char *prefix, const char *name,
142 u8 val[6], bool fallback)
143{
144 char buf[100];
145 int err;
146
147 err = get_nvram_var(prefix, NULL, name, buf, sizeof(buf), fallback);
148 if (err < 0)
149 return;
150
151 strreplace(buf, '-', ':');
152 if (!mac_pton(buf, val))
153 pr_warn("Can not parse mac address: %s\n", buf);
154}
155
156static void nvram_read_alpha2(const char *prefix, const char *name,
157 char val[2], bool fallback)
158{
159 char buf[10];
160 int err;
161
162 err = get_nvram_var(prefix, NULL, name, buf, sizeof(buf), fallback);
163 if (err < 0)
164 return;
165 if (buf[0] == '0')
166 return;
167 if (strlen(buf) > 2) {
168 pr_warn("alpha2 is too long %s\n", buf);
169 return;
170 }
171 memcpy(val, buf, 2);
172}
173
174
175#define ENTRY(_revmask, _type, _prefix, _name, _val, _allset, _fallback) \
176 if (_revmask & BIT(sprom->revision)) \
177 nvram_read_ ## _type(_prefix, NULL, _name, &sprom->_val, \
178 _allset, _fallback)
179
180
181
182
183
184
185
186
187
188static void bcm47xx_sprom_fill_auto(struct ssb_sprom *sprom,
189 const char *prefix, bool fallback)
190{
191 const char *pre = prefix;
192 bool fb = fallback;
193
194
195 ENTRY(0xfffffffe, u16, pre, "devid", dev_id, 0, fallback);
196
197 ENTRY(0xfffffffe, u16, pre, "boardrev", board_rev, 0, true);
198 ENTRY(0xfffffffe, u32, pre, "boardflags", boardflags, 0, fb);
199 ENTRY(0xfffffff0, u32, pre, "boardflags2", boardflags2, 0, fb);
200 ENTRY(0xfffff800, u32, pre, "boardflags3", boardflags3, 0, fb);
201 ENTRY(0x00000002, u16, pre, "boardflags", boardflags_lo, 0, fb);
202 ENTRY(0xfffffffc, u16, pre, "boardtype", board_type, 0, true);
203 ENTRY(0xfffffffe, u16, pre, "boardnum", board_num, 0, fb);
204 ENTRY(0x00000002, u8, pre, "cc", country_code, 0, fb);
205 ENTRY(0xfffffff8, u8, pre, "regrev", regrev, 0, fb);
206
207 ENTRY(0xfffffffe, u8, pre, "ledbh0", gpio0, 0xff, fb);
208 ENTRY(0xfffffffe, u8, pre, "ledbh1", gpio1, 0xff, fb);
209 ENTRY(0xfffffffe, u8, pre, "ledbh2", gpio2, 0xff, fb);
210 ENTRY(0xfffffffe, u8, pre, "ledbh3", gpio3, 0xff, fb);
211
212 ENTRY(0x0000070e, u16, pre, "pa0b0", pa0b0, 0, fb);
213 ENTRY(0x0000070e, u16, pre, "pa0b1", pa0b1, 0, fb);
214 ENTRY(0x0000070e, u16, pre, "pa0b2", pa0b2, 0, fb);
215 ENTRY(0x0000070e, u8, pre, "pa0itssit", itssi_bg, 0, fb);
216 ENTRY(0x0000070e, u8, pre, "pa0maxpwr", maxpwr_bg, 0, fb);
217
218 ENTRY(0x0000070c, u8, pre, "opo", opo, 0, fb);
219 ENTRY(0xfffffffe, u8, pre, "aa2g", ant_available_bg, 0, fb);
220 ENTRY(0xfffffffe, u8, pre, "aa5g", ant_available_a, 0, fb);
221 ENTRY(0x000007fe, s8, pre, "ag0", antenna_gain.a0, 0, fb);
222 ENTRY(0x000007fe, s8, pre, "ag1", antenna_gain.a1, 0, fb);
223 ENTRY(0x000007f0, s8, pre, "ag2", antenna_gain.a2, 0, fb);
224 ENTRY(0x000007f0, s8, pre, "ag3", antenna_gain.a3, 0, fb);
225
226 ENTRY(0x0000070e, u16, pre, "pa1b0", pa1b0, 0, fb);
227 ENTRY(0x0000070e, u16, pre, "pa1b1", pa1b1, 0, fb);
228 ENTRY(0x0000070e, u16, pre, "pa1b2", pa1b2, 0, fb);
229 ENTRY(0x0000070c, u16, pre, "pa1lob0", pa1lob0, 0, fb);
230 ENTRY(0x0000070c, u16, pre, "pa1lob1", pa1lob1, 0, fb);
231 ENTRY(0x0000070c, u16, pre, "pa1lob2", pa1lob2, 0, fb);
232 ENTRY(0x0000070c, u16, pre, "pa1hib0", pa1hib0, 0, fb);
233 ENTRY(0x0000070c, u16, pre, "pa1hib1", pa1hib1, 0, fb);
234 ENTRY(0x0000070c, u16, pre, "pa1hib2", pa1hib2, 0, fb);
235 ENTRY(0x0000070e, u8, pre, "pa1itssit", itssi_a, 0, fb);
236 ENTRY(0x0000070e, u8, pre, "pa1maxpwr", maxpwr_a, 0, fb);
237 ENTRY(0x0000070c, u8, pre, "pa1lomaxpwr", maxpwr_al, 0, fb);
238 ENTRY(0x0000070c, u8, pre, "pa1himaxpwr", maxpwr_ah, 0, fb);
239
240 ENTRY(0x00000708, u8, pre, "bxa2g", bxa2g, 0, fb);
241 ENTRY(0x00000708, u8, pre, "rssisav2g", rssisav2g, 0, fb);
242 ENTRY(0x00000708, u8, pre, "rssismc2g", rssismc2g, 0, fb);
243 ENTRY(0x00000708, u8, pre, "rssismf2g", rssismf2g, 0, fb);
244 ENTRY(0x00000708, u8, pre, "bxa5g", bxa5g, 0, fb);
245 ENTRY(0x00000708, u8, pre, "rssisav5g", rssisav5g, 0, fb);
246 ENTRY(0x00000708, u8, pre, "rssismc5g", rssismc5g, 0, fb);
247 ENTRY(0x00000708, u8, pre, "rssismf5g", rssismf5g, 0, fb);
248 ENTRY(0x00000708, u8, pre, "tri2g", tri2g, 0, fb);
249 ENTRY(0x00000708, u8, pre, "tri5g", tri5g, 0, fb);
250 ENTRY(0x00000708, u8, pre, "tri5gl", tri5gl, 0, fb);
251 ENTRY(0x00000708, u8, pre, "tri5gh", tri5gh, 0, fb);
252 ENTRY(0x00000708, s8, pre, "rxpo2g", rxpo2g, 0, fb);
253 ENTRY(0x00000708, s8, pre, "rxpo5g", rxpo5g, 0, fb);
254 ENTRY(0xfffffff0, u8, pre, "txchain", txchain, 0xf, fb);
255 ENTRY(0xfffffff0, u8, pre, "rxchain", rxchain, 0xf, fb);
256 ENTRY(0xfffffff0, u8, pre, "antswitch", antswitch, 0xff, fb);
257 ENTRY(0x00000700, u8, pre, "tssipos2g", fem.ghz2.tssipos, 0, fb);
258 ENTRY(0x00000700, u8, pre, "extpagain2g", fem.ghz2.extpa_gain, 0, fb);
259 ENTRY(0x00000700, u8, pre, "pdetrange2g", fem.ghz2.pdet_range, 0, fb);
260 ENTRY(0x00000700, u8, pre, "triso2g", fem.ghz2.tr_iso, 0, fb);
261 ENTRY(0x00000700, u8, pre, "antswctl2g", fem.ghz2.antswlut, 0, fb);
262 ENTRY(0x00000700, u8, pre, "tssipos5g", fem.ghz5.tssipos, 0, fb);
263 ENTRY(0x00000700, u8, pre, "extpagain5g", fem.ghz5.extpa_gain, 0, fb);
264 ENTRY(0x00000700, u8, pre, "pdetrange5g", fem.ghz5.pdet_range, 0, fb);
265 ENTRY(0x00000700, u8, pre, "triso5g", fem.ghz5.tr_iso, 0, fb);
266 ENTRY(0x00000700, u8, pre, "antswctl5g", fem.ghz5.antswlut, 0, fb);
267 ENTRY(0x000000f0, u8, pre, "txpid2ga0", txpid2g[0], 0, fb);
268 ENTRY(0x000000f0, u8, pre, "txpid2ga1", txpid2g[1], 0, fb);
269 ENTRY(0x000000f0, u8, pre, "txpid2ga2", txpid2g[2], 0, fb);
270 ENTRY(0x000000f0, u8, pre, "txpid2ga3", txpid2g[3], 0, fb);
271 ENTRY(0x000000f0, u8, pre, "txpid5ga0", txpid5g[0], 0, fb);
272 ENTRY(0x000000f0, u8, pre, "txpid5ga1", txpid5g[1], 0, fb);
273 ENTRY(0x000000f0, u8, pre, "txpid5ga2", txpid5g[2], 0, fb);
274 ENTRY(0x000000f0, u8, pre, "txpid5ga3", txpid5g[3], 0, fb);
275 ENTRY(0x000000f0, u8, pre, "txpid5gla0", txpid5gl[0], 0, fb);
276 ENTRY(0x000000f0, u8, pre, "txpid5gla1", txpid5gl[1], 0, fb);
277 ENTRY(0x000000f0, u8, pre, "txpid5gla2", txpid5gl[2], 0, fb);
278 ENTRY(0x000000f0, u8, pre, "txpid5gla3", txpid5gl[3], 0, fb);
279 ENTRY(0x000000f0, u8, pre, "txpid5gha0", txpid5gh[0], 0, fb);
280 ENTRY(0x000000f0, u8, pre, "txpid5gha1", txpid5gh[1], 0, fb);
281 ENTRY(0x000000f0, u8, pre, "txpid5gha2", txpid5gh[2], 0, fb);
282 ENTRY(0x000000f0, u8, pre, "txpid5gha3", txpid5gh[3], 0, fb);
283
284 ENTRY(0xffffff00, u8, pre, "tempthresh", tempthresh, 0, fb);
285 ENTRY(0xffffff00, u8, pre, "tempoffset", tempoffset, 0, fb);
286 ENTRY(0xffffff00, u16, pre, "rawtempsense", rawtempsense, 0, fb);
287 ENTRY(0xffffff00, u8, pre, "measpower", measpower, 0, fb);
288 ENTRY(0xffffff00, u8, pre, "tempsense_slope", tempsense_slope, 0, fb);
289 ENTRY(0xffffff00, u8, pre, "tempcorrx", tempcorrx, 0, fb);
290 ENTRY(0xffffff00, u8, pre, "tempsense_option", tempsense_option, 0, fb);
291 ENTRY(0x00000700, u8, pre, "freqoffset_corr", freqoffset_corr, 0, fb);
292 ENTRY(0x00000700, u8, pre, "iqcal_swp_dis", iqcal_swp_dis, 0, fb);
293 ENTRY(0x00000700, u8, pre, "hw_iqcal_en", hw_iqcal_en, 0, fb);
294 ENTRY(0x00000700, u8, pre, "elna2g", elna2g, 0, fb);
295 ENTRY(0x00000700, u8, pre, "elna5g", elna5g, 0, fb);
296 ENTRY(0xffffff00, u8, pre, "phycal_tempdelta", phycal_tempdelta, 0, fb);
297 ENTRY(0xffffff00, u8, pre, "temps_period", temps_period, 0, fb);
298 ENTRY(0xffffff00, u8, pre, "temps_hysteresis", temps_hysteresis, 0, fb);
299 ENTRY(0xffffff00, u8, pre, "measpower1", measpower1, 0, fb);
300 ENTRY(0xffffff00, u8, pre, "measpower2", measpower2, 0, fb);
301
302 ENTRY(0x000001f0, u16, pre, "cck2gpo", cck2gpo, 0, fb);
303 ENTRY(0x000001f0, u32, pre, "ofdm2gpo", ofdm2gpo, 0, fb);
304 ENTRY(0x000001f0, u32, pre, "ofdm5gpo", ofdm5gpo, 0, fb);
305 ENTRY(0x000001f0, u32, pre, "ofdm5glpo", ofdm5glpo, 0, fb);
306 ENTRY(0x000001f0, u32, pre, "ofdm5ghpo", ofdm5ghpo, 0, fb);
307 ENTRY(0x000001f0, u16, pre, "mcs2gpo0", mcs2gpo[0], 0, fb);
308 ENTRY(0x000001f0, u16, pre, "mcs2gpo1", mcs2gpo[1], 0, fb);
309 ENTRY(0x000001f0, u16, pre, "mcs2gpo2", mcs2gpo[2], 0, fb);
310 ENTRY(0x000001f0, u16, pre, "mcs2gpo3", mcs2gpo[3], 0, fb);
311 ENTRY(0x000001f0, u16, pre, "mcs2gpo4", mcs2gpo[4], 0, fb);
312 ENTRY(0x000001f0, u16, pre, "mcs2gpo5", mcs2gpo[5], 0, fb);
313 ENTRY(0x000001f0, u16, pre, "mcs2gpo6", mcs2gpo[6], 0, fb);
314 ENTRY(0x000001f0, u16, pre, "mcs2gpo7", mcs2gpo[7], 0, fb);
315 ENTRY(0x000001f0, u16, pre, "mcs5gpo0", mcs5gpo[0], 0, fb);
316 ENTRY(0x000001f0, u16, pre, "mcs5gpo1", mcs5gpo[1], 0, fb);
317 ENTRY(0x000001f0, u16, pre, "mcs5gpo2", mcs5gpo[2], 0, fb);
318 ENTRY(0x000001f0, u16, pre, "mcs5gpo3", mcs5gpo[3], 0, fb);
319 ENTRY(0x000001f0, u16, pre, "mcs5gpo4", mcs5gpo[4], 0, fb);
320 ENTRY(0x000001f0, u16, pre, "mcs5gpo5", mcs5gpo[5], 0, fb);
321 ENTRY(0x000001f0, u16, pre, "mcs5gpo6", mcs5gpo[6], 0, fb);
322 ENTRY(0x000001f0, u16, pre, "mcs5gpo7", mcs5gpo[7], 0, fb);
323 ENTRY(0x000001f0, u16, pre, "mcs5glpo0", mcs5glpo[0], 0, fb);
324 ENTRY(0x000001f0, u16, pre, "mcs5glpo1", mcs5glpo[1], 0, fb);
325 ENTRY(0x000001f0, u16, pre, "mcs5glpo2", mcs5glpo[2], 0, fb);
326 ENTRY(0x000001f0, u16, pre, "mcs5glpo3", mcs5glpo[3], 0, fb);
327 ENTRY(0x000001f0, u16, pre, "mcs5glpo4", mcs5glpo[4], 0, fb);
328 ENTRY(0x000001f0, u16, pre, "mcs5glpo5", mcs5glpo[5], 0, fb);
329 ENTRY(0x000001f0, u16, pre, "mcs5glpo6", mcs5glpo[6], 0, fb);
330 ENTRY(0x000001f0, u16, pre, "mcs5glpo7", mcs5glpo[7], 0, fb);
331 ENTRY(0x000001f0, u16, pre, "mcs5ghpo0", mcs5ghpo[0], 0, fb);
332 ENTRY(0x000001f0, u16, pre, "mcs5ghpo1", mcs5ghpo[1], 0, fb);
333 ENTRY(0x000001f0, u16, pre, "mcs5ghpo2", mcs5ghpo[2], 0, fb);
334 ENTRY(0x000001f0, u16, pre, "mcs5ghpo3", mcs5ghpo[3], 0, fb);
335 ENTRY(0x000001f0, u16, pre, "mcs5ghpo4", mcs5ghpo[4], 0, fb);
336 ENTRY(0x000001f0, u16, pre, "mcs5ghpo5", mcs5ghpo[5], 0, fb);
337 ENTRY(0x000001f0, u16, pre, "mcs5ghpo6", mcs5ghpo[6], 0, fb);
338 ENTRY(0x000001f0, u16, pre, "mcs5ghpo7", mcs5ghpo[7], 0, fb);
339 ENTRY(0x000001f0, u16, pre, "cddpo", cddpo, 0, fb);
340 ENTRY(0x000001f0, u16, pre, "stbcpo", stbcpo, 0, fb);
341 ENTRY(0x000001f0, u16, pre, "bw40po", bw40po, 0, fb);
342 ENTRY(0x000001f0, u16, pre, "bwduppo", bwduppo, 0, fb);
343
344 ENTRY(0xfffffe00, u16, pre, "cckbw202gpo", cckbw202gpo, 0, fb);
345 ENTRY(0xfffffe00, u16, pre, "cckbw20ul2gpo", cckbw20ul2gpo, 0, fb);
346 ENTRY(0x00000600, u32, pre, "legofdmbw202gpo", legofdmbw202gpo, 0, fb);
347 ENTRY(0x00000600, u32, pre, "legofdmbw20ul2gpo", legofdmbw20ul2gpo, 0, fb);
348 ENTRY(0x00000600, u32, pre, "legofdmbw205glpo", legofdmbw205glpo, 0, fb);
349 ENTRY(0x00000600, u32, pre, "legofdmbw20ul5glpo", legofdmbw20ul5glpo, 0, fb);
350 ENTRY(0x00000600, u32, pre, "legofdmbw205gmpo", legofdmbw205gmpo, 0, fb);
351 ENTRY(0x00000600, u32, pre, "legofdmbw20ul5gmpo", legofdmbw20ul5gmpo, 0, fb);
352 ENTRY(0x00000600, u32, pre, "legofdmbw205ghpo", legofdmbw205ghpo, 0, fb);
353 ENTRY(0x00000600, u32, pre, "legofdmbw20ul5ghpo", legofdmbw20ul5ghpo, 0, fb);
354 ENTRY(0xfffffe00, u32, pre, "mcsbw202gpo", mcsbw202gpo, 0, fb);
355 ENTRY(0x00000600, u32, pre, "mcsbw20ul2gpo", mcsbw20ul2gpo, 0, fb);
356 ENTRY(0xfffffe00, u32, pre, "mcsbw402gpo", mcsbw402gpo, 0, fb);
357 ENTRY(0xfffffe00, u32, pre, "mcsbw205glpo", mcsbw205glpo, 0, fb);
358 ENTRY(0x00000600, u32, pre, "mcsbw20ul5glpo", mcsbw20ul5glpo, 0, fb);
359 ENTRY(0xfffffe00, u32, pre, "mcsbw405glpo", mcsbw405glpo, 0, fb);
360 ENTRY(0xfffffe00, u32, pre, "mcsbw205gmpo", mcsbw205gmpo, 0, fb);
361 ENTRY(0x00000600, u32, pre, "mcsbw20ul5gmpo", mcsbw20ul5gmpo, 0, fb);
362 ENTRY(0xfffffe00, u32, pre, "mcsbw405gmpo", mcsbw405gmpo, 0, fb);
363 ENTRY(0xfffffe00, u32, pre, "mcsbw205ghpo", mcsbw205ghpo, 0, fb);
364 ENTRY(0x00000600, u32, pre, "mcsbw20ul5ghpo", mcsbw20ul5ghpo, 0, fb);
365 ENTRY(0xfffffe00, u32, pre, "mcsbw405ghpo", mcsbw405ghpo, 0, fb);
366 ENTRY(0x00000600, u16, pre, "mcs32po", mcs32po, 0, fb);
367 ENTRY(0x00000600, u16, pre, "legofdm40duppo", legofdm40duppo, 0, fb);
368 ENTRY(0x00000700, u8, pre, "pcieingress_war", pcieingress_war, 0, fb);
369
370
371 ENTRY(0x00000700, u8, pre, "rxgainerr2ga0", rxgainerr2ga[0], 0, fb);
372 ENTRY(0x00000700, u8, pre, "rxgainerr2ga1", rxgainerr2ga[1], 0, fb);
373 ENTRY(0x00000700, u8, pre, "rxgainerr2ga2", rxgainerr2ga[2], 0, fb);
374 ENTRY(0x00000700, u8, pre, "rxgainerr5gla0", rxgainerr5gla[0], 0, fb);
375 ENTRY(0x00000700, u8, pre, "rxgainerr5gla1", rxgainerr5gla[1], 0, fb);
376 ENTRY(0x00000700, u8, pre, "rxgainerr5gla2", rxgainerr5gla[2], 0, fb);
377 ENTRY(0x00000700, u8, pre, "rxgainerr5gma0", rxgainerr5gma[0], 0, fb);
378 ENTRY(0x00000700, u8, pre, "rxgainerr5gma1", rxgainerr5gma[1], 0, fb);
379 ENTRY(0x00000700, u8, pre, "rxgainerr5gma2", rxgainerr5gma[2], 0, fb);
380 ENTRY(0x00000700, u8, pre, "rxgainerr5gha0", rxgainerr5gha[0], 0, fb);
381 ENTRY(0x00000700, u8, pre, "rxgainerr5gha1", rxgainerr5gha[1], 0, fb);
382 ENTRY(0x00000700, u8, pre, "rxgainerr5gha2", rxgainerr5gha[2], 0, fb);
383 ENTRY(0x00000700, u8, pre, "rxgainerr5gua0", rxgainerr5gua[0], 0, fb);
384 ENTRY(0x00000700, u8, pre, "rxgainerr5gua1", rxgainerr5gua[1], 0, fb);
385 ENTRY(0x00000700, u8, pre, "rxgainerr5gua2", rxgainerr5gua[2], 0, fb);
386
387 ENTRY(0xfffffe00, u8, pre, "sar2g", sar2g, 0, fb);
388 ENTRY(0xfffffe00, u8, pre, "sar5g", sar5g, 0, fb);
389
390
391 ENTRY(0x00000700, u8, pre, "noiselvl2ga0", noiselvl2ga[0], 0, fb);
392 ENTRY(0x00000700, u8, pre, "noiselvl2ga1", noiselvl2ga[1], 0, fb);
393 ENTRY(0x00000700, u8, pre, "noiselvl2ga2", noiselvl2ga[2], 0, fb);
394 ENTRY(0x00000700, u8, pre, "noiselvl5gla0", noiselvl5gla[0], 0, fb);
395 ENTRY(0x00000700, u8, pre, "noiselvl5gla1", noiselvl5gla[1], 0, fb);
396 ENTRY(0x00000700, u8, pre, "noiselvl5gla2", noiselvl5gla[2], 0, fb);
397 ENTRY(0x00000700, u8, pre, "noiselvl5gma0", noiselvl5gma[0], 0, fb);
398 ENTRY(0x00000700, u8, pre, "noiselvl5gma1", noiselvl5gma[1], 0, fb);
399 ENTRY(0x00000700, u8, pre, "noiselvl5gma2", noiselvl5gma[2], 0, fb);
400 ENTRY(0x00000700, u8, pre, "noiselvl5gha0", noiselvl5gha[0], 0, fb);
401 ENTRY(0x00000700, u8, pre, "noiselvl5gha1", noiselvl5gha[1], 0, fb);
402 ENTRY(0x00000700, u8, pre, "noiselvl5gha2", noiselvl5gha[2], 0, fb);
403 ENTRY(0x00000700, u8, pre, "noiselvl5gua0", noiselvl5gua[0], 0, fb);
404 ENTRY(0x00000700, u8, pre, "noiselvl5gua1", noiselvl5gua[1], 0, fb);
405 ENTRY(0x00000700, u8, pre, "noiselvl5gua2", noiselvl5gua[2], 0, fb);
406}
407#undef ENTRY
408
409static void bcm47xx_fill_sprom_path_r4589(struct ssb_sprom *sprom,
410 const char *prefix, bool fallback)
411{
412 char postfix[2];
413 int i;
414
415 for (i = 0; i < ARRAY_SIZE(sprom->core_pwr_info); i++) {
416 struct ssb_sprom_core_pwr_info *pwr_info;
417
418 pwr_info = &sprom->core_pwr_info[i];
419
420 snprintf(postfix, sizeof(postfix), "%i", i);
421 nvram_read_u8(prefix, postfix, "maxp2ga",
422 &pwr_info->maxpwr_2g, 0, fallback);
423 nvram_read_u8(prefix, postfix, "itt2ga",
424 &pwr_info->itssi_2g, 0, fallback);
425 nvram_read_u8(prefix, postfix, "itt5ga",
426 &pwr_info->itssi_5g, 0, fallback);
427 nvram_read_u16(prefix, postfix, "pa2gw0a",
428 &pwr_info->pa_2g[0], 0, fallback);
429 nvram_read_u16(prefix, postfix, "pa2gw1a",
430 &pwr_info->pa_2g[1], 0, fallback);
431 nvram_read_u16(prefix, postfix, "pa2gw2a",
432 &pwr_info->pa_2g[2], 0, fallback);
433 nvram_read_u8(prefix, postfix, "maxp5ga",
434 &pwr_info->maxpwr_5g, 0, fallback);
435 nvram_read_u8(prefix, postfix, "maxp5gha",
436 &pwr_info->maxpwr_5gh, 0, fallback);
437 nvram_read_u8(prefix, postfix, "maxp5gla",
438 &pwr_info->maxpwr_5gl, 0, fallback);
439 nvram_read_u16(prefix, postfix, "pa5gw0a",
440 &pwr_info->pa_5g[0], 0, fallback);
441 nvram_read_u16(prefix, postfix, "pa5gw1a",
442 &pwr_info->pa_5g[1], 0, fallback);
443 nvram_read_u16(prefix, postfix, "pa5gw2a",
444 &pwr_info->pa_5g[2], 0, fallback);
445 nvram_read_u16(prefix, postfix, "pa5glw0a",
446 &pwr_info->pa_5gl[0], 0, fallback);
447 nvram_read_u16(prefix, postfix, "pa5glw1a",
448 &pwr_info->pa_5gl[1], 0, fallback);
449 nvram_read_u16(prefix, postfix, "pa5glw2a",
450 &pwr_info->pa_5gl[2], 0, fallback);
451 nvram_read_u16(prefix, postfix, "pa5ghw0a",
452 &pwr_info->pa_5gh[0], 0, fallback);
453 nvram_read_u16(prefix, postfix, "pa5ghw1a",
454 &pwr_info->pa_5gh[1], 0, fallback);
455 nvram_read_u16(prefix, postfix, "pa5ghw2a",
456 &pwr_info->pa_5gh[2], 0, fallback);
457 }
458}
459
460static void bcm47xx_fill_sprom_path_r45(struct ssb_sprom *sprom,
461 const char *prefix, bool fallback)
462{
463 char postfix[2];
464 int i;
465
466 for (i = 0; i < ARRAY_SIZE(sprom->core_pwr_info); i++) {
467 struct ssb_sprom_core_pwr_info *pwr_info;
468
469 pwr_info = &sprom->core_pwr_info[i];
470
471 snprintf(postfix, sizeof(postfix), "%i", i);
472 nvram_read_u16(prefix, postfix, "pa2gw3a",
473 &pwr_info->pa_2g[3], 0, fallback);
474 nvram_read_u16(prefix, postfix, "pa5gw3a",
475 &pwr_info->pa_5g[3], 0, fallback);
476 nvram_read_u16(prefix, postfix, "pa5glw3a",
477 &pwr_info->pa_5gl[3], 0, fallback);
478 nvram_read_u16(prefix, postfix, "pa5ghw3a",
479 &pwr_info->pa_5gh[3], 0, fallback);
480 }
481}
482
483static bool bcm47xx_is_valid_mac(u8 *mac)
484{
485 return mac && !(mac[0] == 0x00 && mac[1] == 0x90 && mac[2] == 0x4c);
486}
487
488static int bcm47xx_increase_mac_addr(u8 *mac, u8 num)
489{
490 u8 *oui = mac + ETH_ALEN/2 - 1;
491 u8 *p = mac + ETH_ALEN - 1;
492
493 do {
494 (*p) += num;
495 if (*p > num)
496 break;
497 p--;
498 num = 1;
499 } while (p != oui);
500
501 if (p == oui) {
502 pr_err("unable to fetch mac address\n");
503 return -ENOENT;
504 }
505 return 0;
506}
507
508static int mac_addr_used = 2;
509
510static void bcm47xx_fill_sprom_ethernet(struct ssb_sprom *sprom,
511 const char *prefix, bool fallback)
512{
513 bool fb = fallback;
514
515 nvram_read_macaddr(prefix, "et0macaddr", sprom->et0mac, fallback);
516 nvram_read_u8(prefix, NULL, "et0mdcport", &sprom->et0mdcport, 0,
517 fallback);
518 nvram_read_u8(prefix, NULL, "et0phyaddr", &sprom->et0phyaddr, 0,
519 fallback);
520
521 nvram_read_macaddr(prefix, "et1macaddr", sprom->et1mac, fallback);
522 nvram_read_u8(prefix, NULL, "et1mdcport", &sprom->et1mdcport, 0,
523 fallback);
524 nvram_read_u8(prefix, NULL, "et1phyaddr", &sprom->et1phyaddr, 0,
525 fallback);
526
527 nvram_read_macaddr(prefix, "et2macaddr", sprom->et2mac, fb);
528 nvram_read_u8(prefix, NULL, "et2mdcport", &sprom->et2mdcport, 0, fb);
529 nvram_read_u8(prefix, NULL, "et2phyaddr", &sprom->et2phyaddr, 0, fb);
530
531 nvram_read_macaddr(prefix, "macaddr", sprom->il0mac, fallback);
532 nvram_read_macaddr(prefix, "il0macaddr", sprom->il0mac, fallback);
533
534
535
536
537
538
539
540 if (!bcm47xx_is_valid_mac(sprom->il0mac)) {
541 u8 mac[6];
542
543 nvram_read_macaddr(NULL, "et0macaddr", mac, false);
544 if (bcm47xx_is_valid_mac(mac)) {
545 int err = bcm47xx_increase_mac_addr(mac, mac_addr_used);
546
547 if (!err) {
548 ether_addr_copy(sprom->il0mac, mac);
549 mac_addr_used++;
550 }
551 }
552 }
553}
554
555static void bcm47xx_fill_board_data(struct ssb_sprom *sprom, const char *prefix,
556 bool fallback)
557{
558 nvram_read_u32_2(prefix, "boardflags", &sprom->boardflags_lo,
559 &sprom->boardflags_hi, fallback);
560 nvram_read_u32_2(prefix, "boardflags2", &sprom->boardflags2_lo,
561 &sprom->boardflags2_hi, fallback);
562}
563
564void bcm47xx_fill_sprom(struct ssb_sprom *sprom, const char *prefix,
565 bool fallback)
566{
567 bcm47xx_fill_sprom_ethernet(sprom, prefix, fallback);
568 bcm47xx_fill_board_data(sprom, prefix, fallback);
569
570 nvram_read_u8(prefix, NULL, "sromrev", &sprom->revision, 0, fallback);
571
572
573 nvram_read_alpha2(prefix, "ccode", sprom->alpha2, fallback);
574 if (sprom->revision >= 3)
575 nvram_read_leddc(prefix, "leddc", &sprom->leddc_on_time,
576 &sprom->leddc_off_time, fallback);
577
578 switch (sprom->revision) {
579 case 4:
580 case 5:
581 bcm47xx_fill_sprom_path_r4589(sprom, prefix, fallback);
582 bcm47xx_fill_sprom_path_r45(sprom, prefix, fallback);
583 break;
584 case 8:
585 case 9:
586 bcm47xx_fill_sprom_path_r4589(sprom, prefix, fallback);
587 break;
588 }
589
590 bcm47xx_sprom_fill_auto(sprom, prefix, fallback);
591}
592
593#if IS_BUILTIN(CONFIG_SSB) && IS_ENABLED(CONFIG_SSB_SPROM)
594static int bcm47xx_get_sprom_ssb(struct ssb_bus *bus, struct ssb_sprom *out)
595{
596 char prefix[10];
597
598 switch (bus->bustype) {
599 case SSB_BUSTYPE_SSB:
600 bcm47xx_fill_sprom(out, NULL, false);
601 return 0;
602 case SSB_BUSTYPE_PCI:
603 memset(out, 0, sizeof(struct ssb_sprom));
604 snprintf(prefix, sizeof(prefix), "pci/%u/%u/",
605 bus->host_pci->bus->number + 1,
606 PCI_SLOT(bus->host_pci->devfn));
607 bcm47xx_fill_sprom(out, prefix, false);
608 return 0;
609 default:
610 pr_warn("Unable to fill SPROM for given bustype.\n");
611 return -EINVAL;
612 }
613}
614#endif
615
616#if IS_BUILTIN(CONFIG_BCMA)
617
618
619
620
621
622
623
624static void bcm47xx_sprom_apply_prefix_alias(char *prefix, size_t prefix_size)
625{
626 size_t prefix_len = strlen(prefix);
627 size_t short_len = prefix_len - 1;
628 char nvram_var[10];
629 char buf[20];
630 int i;
631
632
633 if (prefix_len <= 0 || prefix[prefix_len - 1] != '/')
634 return;
635
636 for (i = 0; i < 3; i++) {
637 if (snprintf(nvram_var, sizeof(nvram_var), "devpath%d", i) <= 0)
638 continue;
639 if (bcm47xx_nvram_getenv(nvram_var, buf, sizeof(buf)) < 0)
640 continue;
641 if (!strcmp(buf, prefix) ||
642 (short_len && strlen(buf) == short_len && !strncmp(buf, prefix, short_len))) {
643 snprintf(prefix, prefix_size, "%d:", i);
644 return;
645 }
646 }
647}
648
649static int bcm47xx_get_sprom_bcma(struct bcma_bus *bus, struct ssb_sprom *out)
650{
651 struct bcma_boardinfo *binfo = &bus->boardinfo;
652 struct bcma_device *core;
653 char buf[10];
654 char *prefix;
655 bool fallback = false;
656
657 switch (bus->hosttype) {
658 case BCMA_HOSTTYPE_PCI:
659 memset(out, 0, sizeof(struct ssb_sprom));
660
661 if (IS_ENABLED(CONFIG_BCM47XX))
662 snprintf(buf, sizeof(buf), "pci/%u/%u/",
663 bus->host_pci->bus->number + 1,
664 PCI_SLOT(bus->host_pci->devfn));
665 else
666 snprintf(buf, sizeof(buf), "pci/%u/%u/",
667 pci_domain_nr(bus->host_pci->bus) + 1,
668 bus->host_pci->bus->number);
669 bcm47xx_sprom_apply_prefix_alias(buf, sizeof(buf));
670 prefix = buf;
671 break;
672 case BCMA_HOSTTYPE_SOC:
673 memset(out, 0, sizeof(struct ssb_sprom));
674 core = bcma_find_core(bus, BCMA_CORE_80211);
675 if (core) {
676 snprintf(buf, sizeof(buf), "sb/%u/",
677 core->core_index);
678 prefix = buf;
679 fallback = true;
680 } else {
681 prefix = NULL;
682 }
683 break;
684 default:
685 pr_warn("Unable to fill SPROM for given bustype.\n");
686 return -EINVAL;
687 }
688
689 nvram_read_u16(prefix, NULL, "boardvendor", &binfo->vendor, 0, true);
690 if (!binfo->vendor)
691 binfo->vendor = SSB_BOARDVENDOR_BCM;
692 nvram_read_u16(prefix, NULL, "boardtype", &binfo->type, 0, true);
693
694 bcm47xx_fill_sprom(out, prefix, fallback);
695
696 return 0;
697}
698#endif
699
700static unsigned int bcm47xx_sprom_registered;
701
702
703
704
705
706int bcm47xx_sprom_register_fallbacks(void)
707{
708 if (bcm47xx_sprom_registered)
709 return 0;
710
711#if IS_BUILTIN(CONFIG_SSB) && IS_ENABLED(CONFIG_SSB_SPROM)
712 if (ssb_arch_register_fallback_sprom(&bcm47xx_get_sprom_ssb))
713 pr_warn("Failed to register ssb SPROM handler\n");
714#endif
715
716#if IS_BUILTIN(CONFIG_BCMA)
717 if (bcma_arch_register_fallback_sprom(&bcm47xx_get_sprom_bcma))
718 pr_warn("Failed to register bcma SPROM handler\n");
719#endif
720
721 bcm47xx_sprom_registered = 1;
722
723 return 0;
724}
725
726fs_initcall(bcm47xx_sprom_register_fallbacks);
727
