sprom.c 32 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885
  1. /*
  2. * Copyright (C) 2004 Florian Schirmer <jolt@tuxbox.org>
  3. * Copyright (C) 2006 Felix Fietkau <nbd@openwrt.org>
  4. * Copyright (C) 2006 Michael Buesch <m@bues.ch>
  5. * Copyright (C) 2010 Waldemar Brodkorb <wbx@openadk.org>
  6. * Copyright (C) 2010-2012 Hauke Mehrtens <hauke@hauke-m.de>
  7. *
  8. * This program is free software; you can redistribute it and/or modify it
  9. * under the terms of the GNU General Public License as published by the
  10. * Free Software Foundation; either version 2 of the License, or (at your
  11. * option) any later version.
  12. *
  13. * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
  14. * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
  15. * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
  16. * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  17. * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  18. * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
  19. * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
  20. * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  21. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  22. * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  23. *
  24. * You should have received a copy of the GNU General Public License along
  25. * with this program; if not, write to the Free Software Foundation, Inc.,
  26. * 675 Mass Ave, Cambridge, MA 02139, USA.
  27. */
  28. #include <bcm47xx.h>
  29. #include <bcm47xx_nvram.h>
  30. #include <linux/if_ether.h>
  31. #include <linux/etherdevice.h>
  32. static void create_key(const char *prefix, const char *postfix,
  33. const char *name, char *buf, int len)
  34. {
  35. if (prefix && postfix)
  36. snprintf(buf, len, "%s%s%s", prefix, name, postfix);
  37. else if (prefix)
  38. snprintf(buf, len, "%s%s", prefix, name);
  39. else if (postfix)
  40. snprintf(buf, len, "%s%s", name, postfix);
  41. else
  42. snprintf(buf, len, "%s", name);
  43. }
  44. static int get_nvram_var(const char *prefix, const char *postfix,
  45. const char *name, char *buf, int len, bool fallback)
  46. {
  47. char key[40];
  48. int err;
  49. create_key(prefix, postfix, name, key, sizeof(key));
  50. err = bcm47xx_nvram_getenv(key, buf, len);
  51. if (fallback && err == -ENOENT && prefix) {
  52. create_key(NULL, postfix, name, key, sizeof(key));
  53. err = bcm47xx_nvram_getenv(key, buf, len);
  54. }
  55. return err;
  56. }
  57. #define NVRAM_READ_VAL(type) \
  58. static void nvram_read_ ## type (const char *prefix, \
  59. const char *postfix, const char *name, \
  60. type *val, type allset, bool fallback) \
  61. { \
  62. char buf[100]; \
  63. int err; \
  64. type var; \
  65. \
  66. err = get_nvram_var(prefix, postfix, name, buf, sizeof(buf), \
  67. fallback); \
  68. if (err < 0) \
  69. return; \
  70. err = kstrto ## type(strim(buf), 0, &var); \
  71. if (err) { \
  72. pr_warn("can not parse nvram name %s%s%s with value %s got %i\n", \
  73. prefix, name, postfix, buf, err); \
  74. return; \
  75. } \
  76. if (allset && var == allset) \
  77. return; \
  78. *val = var; \
  79. }
  80. NVRAM_READ_VAL(u8)
  81. NVRAM_READ_VAL(s8)
  82. NVRAM_READ_VAL(u16)
  83. NVRAM_READ_VAL(u32)
  84. #undef NVRAM_READ_VAL
  85. static void nvram_read_u32_2(const char *prefix, const char *name,
  86. u16 *val_lo, u16 *val_hi, bool fallback)
  87. {
  88. char buf[100];
  89. int err;
  90. u32 val;
  91. err = get_nvram_var(prefix, NULL, name, buf, sizeof(buf), fallback);
  92. if (err < 0)
  93. return;
  94. err = kstrtou32(strim(buf), 0, &val);
  95. if (err) {
  96. pr_warn("can not parse nvram name %s%s with value %s got %i\n",
  97. prefix, name, buf, err);
  98. return;
  99. }
  100. *val_lo = (val & 0x0000FFFFU);
  101. *val_hi = (val & 0xFFFF0000U) >> 16;
  102. }
  103. static void nvram_read_leddc(const char *prefix, const char *name,
  104. u8 *leddc_on_time, u8 *leddc_off_time,
  105. bool fallback)
  106. {
  107. char buf[100];
  108. int err;
  109. u32 val;
  110. err = get_nvram_var(prefix, NULL, name, buf, sizeof(buf), fallback);
  111. if (err < 0)
  112. return;
  113. err = kstrtou32(strim(buf), 0, &val);
  114. if (err) {
  115. pr_warn("can not parse nvram name %s%s with value %s got %i\n",
  116. prefix, name, buf, err);
  117. return;
  118. }
  119. if (val == 0xffff || val == 0xffffffff)
  120. return;
  121. *leddc_on_time = val & 0xff;
  122. *leddc_off_time = (val >> 16) & 0xff;
  123. }
  124. static void bcm47xx_nvram_parse_macaddr(char *buf, u8 macaddr[6])
  125. {
  126. if (strchr(buf, ':'))
  127. sscanf(buf, "%hhx:%hhx:%hhx:%hhx:%hhx:%hhx", &macaddr[0],
  128. &macaddr[1], &macaddr[2], &macaddr[3], &macaddr[4],
  129. &macaddr[5]);
  130. else if (strchr(buf, '-'))
  131. sscanf(buf, "%hhx-%hhx-%hhx-%hhx-%hhx-%hhx", &macaddr[0],
  132. &macaddr[1], &macaddr[2], &macaddr[3], &macaddr[4],
  133. &macaddr[5]);
  134. else
  135. pr_warn("Can not parse mac address: %s\n", buf);
  136. }
  137. static void nvram_read_macaddr(const char *prefix, const char *name,
  138. u8 val[6], bool fallback)
  139. {
  140. char buf[100];
  141. int err;
  142. err = get_nvram_var(prefix, NULL, name, buf, sizeof(buf), fallback);
  143. if (err < 0)
  144. return;
  145. bcm47xx_nvram_parse_macaddr(buf, val);
  146. }
  147. static void nvram_read_alpha2(const char *prefix, const char *name,
  148. char val[2], bool fallback)
  149. {
  150. char buf[10];
  151. int err;
  152. err = get_nvram_var(prefix, NULL, name, buf, sizeof(buf), fallback);
  153. if (err < 0)
  154. return;
  155. if (buf[0] == '0')
  156. return;
  157. if (strlen(buf) > 2) {
  158. pr_warn("alpha2 is too long %s\n", buf);
  159. return;
  160. }
  161. memcpy(val, buf, 2);
  162. }
  163. static void bcm47xx_fill_sprom_r1234589(struct ssb_sprom *sprom,
  164. const char *prefix, bool fallback)
  165. {
  166. nvram_read_u16(prefix, NULL, "devid", &sprom->dev_id, 0, fallback);
  167. nvram_read_u8(prefix, NULL, "ledbh0", &sprom->gpio0, 0xff, fallback);
  168. nvram_read_u8(prefix, NULL, "ledbh1", &sprom->gpio1, 0xff, fallback);
  169. nvram_read_u8(prefix, NULL, "ledbh2", &sprom->gpio2, 0xff, fallback);
  170. nvram_read_u8(prefix, NULL, "ledbh3", &sprom->gpio3, 0xff, fallback);
  171. nvram_read_u8(prefix, NULL, "aa2g", &sprom->ant_available_bg, 0,
  172. fallback);
  173. nvram_read_u8(prefix, NULL, "aa5g", &sprom->ant_available_a, 0,
  174. fallback);
  175. nvram_read_s8(prefix, NULL, "ag0", &sprom->antenna_gain.a0, 0,
  176. fallback);
  177. nvram_read_s8(prefix, NULL, "ag1", &sprom->antenna_gain.a1, 0,
  178. fallback);
  179. nvram_read_alpha2(prefix, "ccode", sprom->alpha2, fallback);
  180. }
  181. static void bcm47xx_fill_sprom_r12389(struct ssb_sprom *sprom,
  182. const char *prefix, bool fallback)
  183. {
  184. nvram_read_u16(prefix, NULL, "pa0b0", &sprom->pa0b0, 0, fallback);
  185. nvram_read_u16(prefix, NULL, "pa0b1", &sprom->pa0b1, 0, fallback);
  186. nvram_read_u16(prefix, NULL, "pa0b2", &sprom->pa0b2, 0, fallback);
  187. nvram_read_u8(prefix, NULL, "pa0itssit", &sprom->itssi_bg, 0, fallback);
  188. nvram_read_u8(prefix, NULL, "pa0maxpwr", &sprom->maxpwr_bg, 0,
  189. fallback);
  190. nvram_read_u16(prefix, NULL, "pa1b0", &sprom->pa1b0, 0, fallback);
  191. nvram_read_u16(prefix, NULL, "pa1b1", &sprom->pa1b1, 0, fallback);
  192. nvram_read_u16(prefix, NULL, "pa1b2", &sprom->pa1b2, 0, fallback);
  193. nvram_read_u8(prefix, NULL, "pa1itssit", &sprom->itssi_a, 0, fallback);
  194. nvram_read_u8(prefix, NULL, "pa1maxpwr", &sprom->maxpwr_a, 0, fallback);
  195. }
  196. static void bcm47xx_fill_sprom_r1(struct ssb_sprom *sprom, const char *prefix,
  197. bool fallback)
  198. {
  199. nvram_read_u16(prefix, NULL, "boardflags", &sprom->boardflags_lo, 0,
  200. fallback);
  201. nvram_read_u8(prefix, NULL, "cc", &sprom->country_code, 0, fallback);
  202. }
  203. static void bcm47xx_fill_sprom_r2389(struct ssb_sprom *sprom,
  204. const char *prefix, bool fallback)
  205. {
  206. nvram_read_u8(prefix, NULL, "opo", &sprom->opo, 0, fallback);
  207. nvram_read_u16(prefix, NULL, "pa1lob0", &sprom->pa1lob0, 0, fallback);
  208. nvram_read_u16(prefix, NULL, "pa1lob1", &sprom->pa1lob1, 0, fallback);
  209. nvram_read_u16(prefix, NULL, "pa1lob2", &sprom->pa1lob2, 0, fallback);
  210. nvram_read_u16(prefix, NULL, "pa1hib0", &sprom->pa1hib0, 0, fallback);
  211. nvram_read_u16(prefix, NULL, "pa1hib1", &sprom->pa1hib1, 0, fallback);
  212. nvram_read_u16(prefix, NULL, "pa1hib2", &sprom->pa1hib2, 0, fallback);
  213. nvram_read_u8(prefix, NULL, "pa1lomaxpwr", &sprom->maxpwr_al, 0,
  214. fallback);
  215. nvram_read_u8(prefix, NULL, "pa1himaxpwr", &sprom->maxpwr_ah, 0,
  216. fallback);
  217. }
  218. static void bcm47xx_fill_sprom_r389(struct ssb_sprom *sprom, const char *prefix,
  219. bool fallback)
  220. {
  221. nvram_read_u8(prefix, NULL, "bxa2g", &sprom->bxa2g, 0, fallback);
  222. nvram_read_u8(prefix, NULL, "rssisav2g", &sprom->rssisav2g, 0,
  223. fallback);
  224. nvram_read_u8(prefix, NULL, "rssismc2g", &sprom->rssismc2g, 0,
  225. fallback);
  226. nvram_read_u8(prefix, NULL, "rssismf2g", &sprom->rssismf2g, 0,
  227. fallback);
  228. nvram_read_u8(prefix, NULL, "bxa5g", &sprom->bxa5g, 0, fallback);
  229. nvram_read_u8(prefix, NULL, "rssisav5g", &sprom->rssisav5g, 0,
  230. fallback);
  231. nvram_read_u8(prefix, NULL, "rssismc5g", &sprom->rssismc5g, 0,
  232. fallback);
  233. nvram_read_u8(prefix, NULL, "rssismf5g", &sprom->rssismf5g, 0,
  234. fallback);
  235. nvram_read_u8(prefix, NULL, "tri2g", &sprom->tri2g, 0, fallback);
  236. nvram_read_u8(prefix, NULL, "tri5g", &sprom->tri5g, 0, fallback);
  237. nvram_read_u8(prefix, NULL, "tri5gl", &sprom->tri5gl, 0, fallback);
  238. nvram_read_u8(prefix, NULL, "tri5gh", &sprom->tri5gh, 0, fallback);
  239. nvram_read_s8(prefix, NULL, "rxpo2g", &sprom->rxpo2g, 0, fallback);
  240. nvram_read_s8(prefix, NULL, "rxpo5g", &sprom->rxpo5g, 0, fallback);
  241. }
  242. static void bcm47xx_fill_sprom_r3(struct ssb_sprom *sprom, const char *prefix,
  243. bool fallback)
  244. {
  245. nvram_read_u8(prefix, NULL, "regrev", &sprom->regrev, 0, fallback);
  246. nvram_read_leddc(prefix, "leddc", &sprom->leddc_on_time,
  247. &sprom->leddc_off_time, fallback);
  248. }
  249. static void bcm47xx_fill_sprom_r4589(struct ssb_sprom *sprom,
  250. const char *prefix, bool fallback)
  251. {
  252. nvram_read_u8(prefix, NULL, "regrev", &sprom->regrev, 0, fallback);
  253. nvram_read_s8(prefix, NULL, "ag2", &sprom->antenna_gain.a2, 0,
  254. fallback);
  255. nvram_read_s8(prefix, NULL, "ag3", &sprom->antenna_gain.a3, 0,
  256. fallback);
  257. nvram_read_u8(prefix, NULL, "txchain", &sprom->txchain, 0xf, fallback);
  258. nvram_read_u8(prefix, NULL, "rxchain", &sprom->rxchain, 0xf, fallback);
  259. nvram_read_u8(prefix, NULL, "antswitch", &sprom->antswitch, 0xff,
  260. fallback);
  261. nvram_read_leddc(prefix, "leddc", &sprom->leddc_on_time,
  262. &sprom->leddc_off_time, fallback);
  263. }
  264. static void bcm47xx_fill_sprom_r458(struct ssb_sprom *sprom, const char *prefix,
  265. bool fallback)
  266. {
  267. nvram_read_u16(prefix, NULL, "cck2gpo", &sprom->cck2gpo, 0, fallback);
  268. nvram_read_u32(prefix, NULL, "ofdm2gpo", &sprom->ofdm2gpo, 0, fallback);
  269. nvram_read_u32(prefix, NULL, "ofdm5gpo", &sprom->ofdm5gpo, 0, fallback);
  270. nvram_read_u32(prefix, NULL, "ofdm5glpo", &sprom->ofdm5glpo, 0,
  271. fallback);
  272. nvram_read_u32(prefix, NULL, "ofdm5ghpo", &sprom->ofdm5ghpo, 0,
  273. fallback);
  274. nvram_read_u16(prefix, NULL, "cddpo", &sprom->cddpo, 0, fallback);
  275. nvram_read_u16(prefix, NULL, "stbcpo", &sprom->stbcpo, 0, fallback);
  276. nvram_read_u16(prefix, NULL, "bw40po", &sprom->bw40po, 0, fallback);
  277. nvram_read_u16(prefix, NULL, "bwduppo", &sprom->bwduppo, 0, fallback);
  278. nvram_read_u16(prefix, NULL, "mcs2gpo0", &sprom->mcs2gpo[0], 0,
  279. fallback);
  280. nvram_read_u16(prefix, NULL, "mcs2gpo1", &sprom->mcs2gpo[1], 0,
  281. fallback);
  282. nvram_read_u16(prefix, NULL, "mcs2gpo2", &sprom->mcs2gpo[2], 0,
  283. fallback);
  284. nvram_read_u16(prefix, NULL, "mcs2gpo3", &sprom->mcs2gpo[3], 0,
  285. fallback);
  286. nvram_read_u16(prefix, NULL, "mcs2gpo4", &sprom->mcs2gpo[4], 0,
  287. fallback);
  288. nvram_read_u16(prefix, NULL, "mcs2gpo5", &sprom->mcs2gpo[5], 0,
  289. fallback);
  290. nvram_read_u16(prefix, NULL, "mcs2gpo6", &sprom->mcs2gpo[6], 0,
  291. fallback);
  292. nvram_read_u16(prefix, NULL, "mcs2gpo7", &sprom->mcs2gpo[7], 0,
  293. fallback);
  294. nvram_read_u16(prefix, NULL, "mcs5gpo0", &sprom->mcs5gpo[0], 0,
  295. fallback);
  296. nvram_read_u16(prefix, NULL, "mcs5gpo1", &sprom->mcs5gpo[1], 0,
  297. fallback);
  298. nvram_read_u16(prefix, NULL, "mcs5gpo2", &sprom->mcs5gpo[2], 0,
  299. fallback);
  300. nvram_read_u16(prefix, NULL, "mcs5gpo3", &sprom->mcs5gpo[3], 0,
  301. fallback);
  302. nvram_read_u16(prefix, NULL, "mcs5gpo4", &sprom->mcs5gpo[4], 0,
  303. fallback);
  304. nvram_read_u16(prefix, NULL, "mcs5gpo5", &sprom->mcs5gpo[5], 0,
  305. fallback);
  306. nvram_read_u16(prefix, NULL, "mcs5gpo6", &sprom->mcs5gpo[6], 0,
  307. fallback);
  308. nvram_read_u16(prefix, NULL, "mcs5gpo7", &sprom->mcs5gpo[7], 0,
  309. fallback);
  310. nvram_read_u16(prefix, NULL, "mcs5glpo0", &sprom->mcs5glpo[0], 0,
  311. fallback);
  312. nvram_read_u16(prefix, NULL, "mcs5glpo1", &sprom->mcs5glpo[1], 0,
  313. fallback);
  314. nvram_read_u16(prefix, NULL, "mcs5glpo2", &sprom->mcs5glpo[2], 0,
  315. fallback);
  316. nvram_read_u16(prefix, NULL, "mcs5glpo3", &sprom->mcs5glpo[3], 0,
  317. fallback);
  318. nvram_read_u16(prefix, NULL, "mcs5glpo4", &sprom->mcs5glpo[4], 0,
  319. fallback);
  320. nvram_read_u16(prefix, NULL, "mcs5glpo5", &sprom->mcs5glpo[5], 0,
  321. fallback);
  322. nvram_read_u16(prefix, NULL, "mcs5glpo6", &sprom->mcs5glpo[6], 0,
  323. fallback);
  324. nvram_read_u16(prefix, NULL, "mcs5glpo7", &sprom->mcs5glpo[7], 0,
  325. fallback);
  326. nvram_read_u16(prefix, NULL, "mcs5ghpo0", &sprom->mcs5ghpo[0], 0,
  327. fallback);
  328. nvram_read_u16(prefix, NULL, "mcs5ghpo1", &sprom->mcs5ghpo[1], 0,
  329. fallback);
  330. nvram_read_u16(prefix, NULL, "mcs5ghpo2", &sprom->mcs5ghpo[2], 0,
  331. fallback);
  332. nvram_read_u16(prefix, NULL, "mcs5ghpo3", &sprom->mcs5ghpo[3], 0,
  333. fallback);
  334. nvram_read_u16(prefix, NULL, "mcs5ghpo4", &sprom->mcs5ghpo[4], 0,
  335. fallback);
  336. nvram_read_u16(prefix, NULL, "mcs5ghpo5", &sprom->mcs5ghpo[5], 0,
  337. fallback);
  338. nvram_read_u16(prefix, NULL, "mcs5ghpo6", &sprom->mcs5ghpo[6], 0,
  339. fallback);
  340. nvram_read_u16(prefix, NULL, "mcs5ghpo7", &sprom->mcs5ghpo[7], 0,
  341. fallback);
  342. }
  343. static void bcm47xx_fill_sprom_r45(struct ssb_sprom *sprom, const char *prefix,
  344. bool fallback)
  345. {
  346. nvram_read_u8(prefix, NULL, "txpid2ga0", &sprom->txpid2g[0], 0,
  347. fallback);
  348. nvram_read_u8(prefix, NULL, "txpid2ga1", &sprom->txpid2g[1], 0,
  349. fallback);
  350. nvram_read_u8(prefix, NULL, "txpid2ga2", &sprom->txpid2g[2], 0,
  351. fallback);
  352. nvram_read_u8(prefix, NULL, "txpid2ga3", &sprom->txpid2g[3], 0,
  353. fallback);
  354. nvram_read_u8(prefix, NULL, "txpid5ga0", &sprom->txpid5g[0], 0,
  355. fallback);
  356. nvram_read_u8(prefix, NULL, "txpid5ga1", &sprom->txpid5g[1], 0,
  357. fallback);
  358. nvram_read_u8(prefix, NULL, "txpid5ga2", &sprom->txpid5g[2], 0,
  359. fallback);
  360. nvram_read_u8(prefix, NULL, "txpid5ga3", &sprom->txpid5g[3], 0,
  361. fallback);
  362. nvram_read_u8(prefix, NULL, "txpid5gla0", &sprom->txpid5gl[0], 0,
  363. fallback);
  364. nvram_read_u8(prefix, NULL, "txpid5gla1", &sprom->txpid5gl[1], 0,
  365. fallback);
  366. nvram_read_u8(prefix, NULL, "txpid5gla2", &sprom->txpid5gl[2], 0,
  367. fallback);
  368. nvram_read_u8(prefix, NULL, "txpid5gla3", &sprom->txpid5gl[3], 0,
  369. fallback);
  370. nvram_read_u8(prefix, NULL, "txpid5gha0", &sprom->txpid5gh[0], 0,
  371. fallback);
  372. nvram_read_u8(prefix, NULL, "txpid5gha1", &sprom->txpid5gh[1], 0,
  373. fallback);
  374. nvram_read_u8(prefix, NULL, "txpid5gha2", &sprom->txpid5gh[2], 0,
  375. fallback);
  376. nvram_read_u8(prefix, NULL, "txpid5gha3", &sprom->txpid5gh[3], 0,
  377. fallback);
  378. }
  379. static void bcm47xx_fill_sprom_r89(struct ssb_sprom *sprom, const char *prefix,
  380. bool fallback)
  381. {
  382. nvram_read_u8(prefix, NULL, "tssipos2g", &sprom->fem.ghz2.tssipos, 0,
  383. fallback);
  384. nvram_read_u8(prefix, NULL, "extpagain2g",
  385. &sprom->fem.ghz2.extpa_gain, 0, fallback);
  386. nvram_read_u8(prefix, NULL, "pdetrange2g",
  387. &sprom->fem.ghz2.pdet_range, 0, fallback);
  388. nvram_read_u8(prefix, NULL, "triso2g", &sprom->fem.ghz2.tr_iso, 0,
  389. fallback);
  390. nvram_read_u8(prefix, NULL, "antswctl2g", &sprom->fem.ghz2.antswlut, 0,
  391. fallback);
  392. nvram_read_u8(prefix, NULL, "tssipos5g", &sprom->fem.ghz5.tssipos, 0,
  393. fallback);
  394. nvram_read_u8(prefix, NULL, "extpagain5g",
  395. &sprom->fem.ghz5.extpa_gain, 0, fallback);
  396. nvram_read_u8(prefix, NULL, "pdetrange5g",
  397. &sprom->fem.ghz5.pdet_range, 0, fallback);
  398. nvram_read_u8(prefix, NULL, "triso5g", &sprom->fem.ghz5.tr_iso, 0,
  399. fallback);
  400. nvram_read_u8(prefix, NULL, "antswctl5g", &sprom->fem.ghz5.antswlut, 0,
  401. fallback);
  402. nvram_read_u8(prefix, NULL, "tempthresh", &sprom->tempthresh, 0,
  403. fallback);
  404. nvram_read_u8(prefix, NULL, "tempoffset", &sprom->tempoffset, 0,
  405. fallback);
  406. nvram_read_u16(prefix, NULL, "rawtempsense", &sprom->rawtempsense, 0,
  407. fallback);
  408. nvram_read_u8(prefix, NULL, "measpower", &sprom->measpower, 0,
  409. fallback);
  410. nvram_read_u8(prefix, NULL, "tempsense_slope",
  411. &sprom->tempsense_slope, 0, fallback);
  412. nvram_read_u8(prefix, NULL, "tempcorrx", &sprom->tempcorrx, 0,
  413. fallback);
  414. nvram_read_u8(prefix, NULL, "tempsense_option",
  415. &sprom->tempsense_option, 0, fallback);
  416. nvram_read_u8(prefix, NULL, "freqoffset_corr",
  417. &sprom->freqoffset_corr, 0, fallback);
  418. nvram_read_u8(prefix, NULL, "iqcal_swp_dis", &sprom->iqcal_swp_dis, 0,
  419. fallback);
  420. nvram_read_u8(prefix, NULL, "hw_iqcal_en", &sprom->hw_iqcal_en, 0,
  421. fallback);
  422. nvram_read_u8(prefix, NULL, "elna2g", &sprom->elna2g, 0, fallback);
  423. nvram_read_u8(prefix, NULL, "elna5g", &sprom->elna5g, 0, fallback);
  424. nvram_read_u8(prefix, NULL, "phycal_tempdelta",
  425. &sprom->phycal_tempdelta, 0, fallback);
  426. nvram_read_u8(prefix, NULL, "temps_period", &sprom->temps_period, 0,
  427. fallback);
  428. nvram_read_u8(prefix, NULL, "temps_hysteresis",
  429. &sprom->temps_hysteresis, 0, fallback);
  430. nvram_read_u8(prefix, NULL, "measpower1", &sprom->measpower1, 0,
  431. fallback);
  432. nvram_read_u8(prefix, NULL, "measpower2", &sprom->measpower2, 0,
  433. fallback);
  434. nvram_read_u8(prefix, NULL, "rxgainerr2ga0",
  435. &sprom->rxgainerr2ga[0], 0, fallback);
  436. nvram_read_u8(prefix, NULL, "rxgainerr2ga1",
  437. &sprom->rxgainerr2ga[1], 0, fallback);
  438. nvram_read_u8(prefix, NULL, "rxgainerr2ga2",
  439. &sprom->rxgainerr2ga[2], 0, fallback);
  440. nvram_read_u8(prefix, NULL, "rxgainerr5gla0",
  441. &sprom->rxgainerr5gla[0], 0, fallback);
  442. nvram_read_u8(prefix, NULL, "rxgainerr5gla1",
  443. &sprom->rxgainerr5gla[1], 0, fallback);
  444. nvram_read_u8(prefix, NULL, "rxgainerr5gla2",
  445. &sprom->rxgainerr5gla[2], 0, fallback);
  446. nvram_read_u8(prefix, NULL, "rxgainerr5gma0",
  447. &sprom->rxgainerr5gma[0], 0, fallback);
  448. nvram_read_u8(prefix, NULL, "rxgainerr5gma1",
  449. &sprom->rxgainerr5gma[1], 0, fallback);
  450. nvram_read_u8(prefix, NULL, "rxgainerr5gma2",
  451. &sprom->rxgainerr5gma[2], 0, fallback);
  452. nvram_read_u8(prefix, NULL, "rxgainerr5gha0",
  453. &sprom->rxgainerr5gha[0], 0, fallback);
  454. nvram_read_u8(prefix, NULL, "rxgainerr5gha1",
  455. &sprom->rxgainerr5gha[1], 0, fallback);
  456. nvram_read_u8(prefix, NULL, "rxgainerr5gha2",
  457. &sprom->rxgainerr5gha[2], 0, fallback);
  458. nvram_read_u8(prefix, NULL, "rxgainerr5gua0",
  459. &sprom->rxgainerr5gua[0], 0, fallback);
  460. nvram_read_u8(prefix, NULL, "rxgainerr5gua1",
  461. &sprom->rxgainerr5gua[1], 0, fallback);
  462. nvram_read_u8(prefix, NULL, "rxgainerr5gua2",
  463. &sprom->rxgainerr5gua[2], 0, fallback);
  464. nvram_read_u8(prefix, NULL, "noiselvl2ga0", &sprom->noiselvl2ga[0], 0,
  465. fallback);
  466. nvram_read_u8(prefix, NULL, "noiselvl2ga1", &sprom->noiselvl2ga[1], 0,
  467. fallback);
  468. nvram_read_u8(prefix, NULL, "noiselvl2ga2", &sprom->noiselvl2ga[2], 0,
  469. fallback);
  470. nvram_read_u8(prefix, NULL, "noiselvl5gla0",
  471. &sprom->noiselvl5gla[0], 0, fallback);
  472. nvram_read_u8(prefix, NULL, "noiselvl5gla1",
  473. &sprom->noiselvl5gla[1], 0, fallback);
  474. nvram_read_u8(prefix, NULL, "noiselvl5gla2",
  475. &sprom->noiselvl5gla[2], 0, fallback);
  476. nvram_read_u8(prefix, NULL, "noiselvl5gma0",
  477. &sprom->noiselvl5gma[0], 0, fallback);
  478. nvram_read_u8(prefix, NULL, "noiselvl5gma1",
  479. &sprom->noiselvl5gma[1], 0, fallback);
  480. nvram_read_u8(prefix, NULL, "noiselvl5gma2",
  481. &sprom->noiselvl5gma[2], 0, fallback);
  482. nvram_read_u8(prefix, NULL, "noiselvl5gha0",
  483. &sprom->noiselvl5gha[0], 0, fallback);
  484. nvram_read_u8(prefix, NULL, "noiselvl5gha1",
  485. &sprom->noiselvl5gha[1], 0, fallback);
  486. nvram_read_u8(prefix, NULL, "noiselvl5gha2",
  487. &sprom->noiselvl5gha[2], 0, fallback);
  488. nvram_read_u8(prefix, NULL, "noiselvl5gua0",
  489. &sprom->noiselvl5gua[0], 0, fallback);
  490. nvram_read_u8(prefix, NULL, "noiselvl5gua1",
  491. &sprom->noiselvl5gua[1], 0, fallback);
  492. nvram_read_u8(prefix, NULL, "noiselvl5gua2",
  493. &sprom->noiselvl5gua[2], 0, fallback);
  494. nvram_read_u8(prefix, NULL, "pcieingress_war",
  495. &sprom->pcieingress_war, 0, fallback);
  496. }
  497. static void bcm47xx_fill_sprom_r9(struct ssb_sprom *sprom, const char *prefix,
  498. bool fallback)
  499. {
  500. nvram_read_u16(prefix, NULL, "cckbw202gpo", &sprom->cckbw202gpo, 0,
  501. fallback);
  502. nvram_read_u16(prefix, NULL, "cckbw20ul2gpo", &sprom->cckbw20ul2gpo, 0,
  503. fallback);
  504. nvram_read_u32(prefix, NULL, "legofdmbw202gpo",
  505. &sprom->legofdmbw202gpo, 0, fallback);
  506. nvram_read_u32(prefix, NULL, "legofdmbw20ul2gpo",
  507. &sprom->legofdmbw20ul2gpo, 0, fallback);
  508. nvram_read_u32(prefix, NULL, "legofdmbw205glpo",
  509. &sprom->legofdmbw205glpo, 0, fallback);
  510. nvram_read_u32(prefix, NULL, "legofdmbw20ul5glpo",
  511. &sprom->legofdmbw20ul5glpo, 0, fallback);
  512. nvram_read_u32(prefix, NULL, "legofdmbw205gmpo",
  513. &sprom->legofdmbw205gmpo, 0, fallback);
  514. nvram_read_u32(prefix, NULL, "legofdmbw20ul5gmpo",
  515. &sprom->legofdmbw20ul5gmpo, 0, fallback);
  516. nvram_read_u32(prefix, NULL, "legofdmbw205ghpo",
  517. &sprom->legofdmbw205ghpo, 0, fallback);
  518. nvram_read_u32(prefix, NULL, "legofdmbw20ul5ghpo",
  519. &sprom->legofdmbw20ul5ghpo, 0, fallback);
  520. nvram_read_u32(prefix, NULL, "mcsbw202gpo", &sprom->mcsbw202gpo, 0,
  521. fallback);
  522. nvram_read_u32(prefix, NULL, "mcsbw20ul2gpo", &sprom->mcsbw20ul2gpo, 0,
  523. fallback);
  524. nvram_read_u32(prefix, NULL, "mcsbw402gpo", &sprom->mcsbw402gpo, 0,
  525. fallback);
  526. nvram_read_u32(prefix, NULL, "mcsbw205glpo", &sprom->mcsbw205glpo, 0,
  527. fallback);
  528. nvram_read_u32(prefix, NULL, "mcsbw20ul5glpo",
  529. &sprom->mcsbw20ul5glpo, 0, fallback);
  530. nvram_read_u32(prefix, NULL, "mcsbw405glpo", &sprom->mcsbw405glpo, 0,
  531. fallback);
  532. nvram_read_u32(prefix, NULL, "mcsbw205gmpo", &sprom->mcsbw205gmpo, 0,
  533. fallback);
  534. nvram_read_u32(prefix, NULL, "mcsbw20ul5gmpo",
  535. &sprom->mcsbw20ul5gmpo, 0, fallback);
  536. nvram_read_u32(prefix, NULL, "mcsbw405gmpo", &sprom->mcsbw405gmpo, 0,
  537. fallback);
  538. nvram_read_u32(prefix, NULL, "mcsbw205ghpo", &sprom->mcsbw205ghpo, 0,
  539. fallback);
  540. nvram_read_u32(prefix, NULL, "mcsbw20ul5ghpo",
  541. &sprom->mcsbw20ul5ghpo, 0, fallback);
  542. nvram_read_u32(prefix, NULL, "mcsbw405ghpo", &sprom->mcsbw405ghpo, 0,
  543. fallback);
  544. nvram_read_u16(prefix, NULL, "mcs32po", &sprom->mcs32po, 0, fallback);
  545. nvram_read_u16(prefix, NULL, "legofdm40duppo",
  546. &sprom->legofdm40duppo, 0, fallback);
  547. nvram_read_u8(prefix, NULL, "sar2g", &sprom->sar2g, 0, fallback);
  548. nvram_read_u8(prefix, NULL, "sar5g", &sprom->sar5g, 0, fallback);
  549. }
  550. static void bcm47xx_fill_sprom_path_r4589(struct ssb_sprom *sprom,
  551. const char *prefix, bool fallback)
  552. {
  553. char postfix[2];
  554. int i;
  555. for (i = 0; i < ARRAY_SIZE(sprom->core_pwr_info); i++) {
  556. struct ssb_sprom_core_pwr_info *pwr_info = &sprom->core_pwr_info[i];
  557. snprintf(postfix, sizeof(postfix), "%i", i);
  558. nvram_read_u8(prefix, postfix, "maxp2ga",
  559. &pwr_info->maxpwr_2g, 0, fallback);
  560. nvram_read_u8(prefix, postfix, "itt2ga",
  561. &pwr_info->itssi_2g, 0, fallback);
  562. nvram_read_u8(prefix, postfix, "itt5ga",
  563. &pwr_info->itssi_5g, 0, fallback);
  564. nvram_read_u16(prefix, postfix, "pa2gw0a",
  565. &pwr_info->pa_2g[0], 0, fallback);
  566. nvram_read_u16(prefix, postfix, "pa2gw1a",
  567. &pwr_info->pa_2g[1], 0, fallback);
  568. nvram_read_u16(prefix, postfix, "pa2gw2a",
  569. &pwr_info->pa_2g[2], 0, fallback);
  570. nvram_read_u8(prefix, postfix, "maxp5ga",
  571. &pwr_info->maxpwr_5g, 0, fallback);
  572. nvram_read_u8(prefix, postfix, "maxp5gha",
  573. &pwr_info->maxpwr_5gh, 0, fallback);
  574. nvram_read_u8(prefix, postfix, "maxp5gla",
  575. &pwr_info->maxpwr_5gl, 0, fallback);
  576. nvram_read_u16(prefix, postfix, "pa5gw0a",
  577. &pwr_info->pa_5g[0], 0, fallback);
  578. nvram_read_u16(prefix, postfix, "pa5gw1a",
  579. &pwr_info->pa_5g[1], 0, fallback);
  580. nvram_read_u16(prefix, postfix, "pa5gw2a",
  581. &pwr_info->pa_5g[2], 0, fallback);
  582. nvram_read_u16(prefix, postfix, "pa5glw0a",
  583. &pwr_info->pa_5gl[0], 0, fallback);
  584. nvram_read_u16(prefix, postfix, "pa5glw1a",
  585. &pwr_info->pa_5gl[1], 0, fallback);
  586. nvram_read_u16(prefix, postfix, "pa5glw2a",
  587. &pwr_info->pa_5gl[2], 0, fallback);
  588. nvram_read_u16(prefix, postfix, "pa5ghw0a",
  589. &pwr_info->pa_5gh[0], 0, fallback);
  590. nvram_read_u16(prefix, postfix, "pa5ghw1a",
  591. &pwr_info->pa_5gh[1], 0, fallback);
  592. nvram_read_u16(prefix, postfix, "pa5ghw2a",
  593. &pwr_info->pa_5gh[2], 0, fallback);
  594. }
  595. }
  596. static void bcm47xx_fill_sprom_path_r45(struct ssb_sprom *sprom,
  597. const char *prefix, bool fallback)
  598. {
  599. char postfix[2];
  600. int i;
  601. for (i = 0; i < ARRAY_SIZE(sprom->core_pwr_info); i++) {
  602. struct ssb_sprom_core_pwr_info *pwr_info = &sprom->core_pwr_info[i];
  603. snprintf(postfix, sizeof(postfix), "%i", i);
  604. nvram_read_u16(prefix, postfix, "pa2gw3a",
  605. &pwr_info->pa_2g[3], 0, fallback);
  606. nvram_read_u16(prefix, postfix, "pa5gw3a",
  607. &pwr_info->pa_5g[3], 0, fallback);
  608. nvram_read_u16(prefix, postfix, "pa5glw3a",
  609. &pwr_info->pa_5gl[3], 0, fallback);
  610. nvram_read_u16(prefix, postfix, "pa5ghw3a",
  611. &pwr_info->pa_5gh[3], 0, fallback);
  612. }
  613. }
  614. static bool bcm47xx_is_valid_mac(u8 *mac)
  615. {
  616. return mac && !(mac[0] == 0x00 && mac[1] == 0x90 && mac[2] == 0x4c);
  617. }
  618. static int bcm47xx_increase_mac_addr(u8 *mac, u8 num)
  619. {
  620. u8 *oui = mac + ETH_ALEN/2 - 1;
  621. u8 *p = mac + ETH_ALEN - 1;
  622. do {
  623. (*p) += num;
  624. if (*p > num)
  625. break;
  626. p--;
  627. num = 1;
  628. } while (p != oui);
  629. if (p == oui) {
  630. pr_err("unable to fetch mac address\n");
  631. return -ENOENT;
  632. }
  633. return 0;
  634. }
  635. static int mac_addr_used = 2;
  636. static void bcm47xx_fill_sprom_ethernet(struct ssb_sprom *sprom,
  637. const char *prefix, bool fallback)
  638. {
  639. nvram_read_macaddr(prefix, "et0macaddr", sprom->et0mac, fallback);
  640. nvram_read_u8(prefix, NULL, "et0mdcport", &sprom->et0mdcport, 0,
  641. fallback);
  642. nvram_read_u8(prefix, NULL, "et0phyaddr", &sprom->et0phyaddr, 0,
  643. fallback);
  644. nvram_read_macaddr(prefix, "et1macaddr", sprom->et1mac, fallback);
  645. nvram_read_u8(prefix, NULL, "et1mdcport", &sprom->et1mdcport, 0,
  646. fallback);
  647. nvram_read_u8(prefix, NULL, "et1phyaddr", &sprom->et1phyaddr, 0,
  648. fallback);
  649. nvram_read_macaddr(prefix, "macaddr", sprom->il0mac, fallback);
  650. nvram_read_macaddr(prefix, "il0macaddr", sprom->il0mac, fallback);
  651. /* The address prefix 00:90:4C is used by Broadcom in their initial
  652. configuration. When a mac address with the prefix 00:90:4C is used
  653. all devices from the same series are sharing the same mac address.
  654. To prevent mac address collisions we replace them with a mac address
  655. based on the base address. */
  656. if (!bcm47xx_is_valid_mac(sprom->il0mac)) {
  657. u8 mac[6];
  658. nvram_read_macaddr(NULL, "et0macaddr", mac, false);
  659. if (bcm47xx_is_valid_mac(mac)) {
  660. int err = bcm47xx_increase_mac_addr(mac, mac_addr_used);
  661. if (!err) {
  662. ether_addr_copy(sprom->il0mac, mac);
  663. mac_addr_used++;
  664. }
  665. }
  666. }
  667. }
  668. static void bcm47xx_fill_board_data(struct ssb_sprom *sprom, const char *prefix,
  669. bool fallback)
  670. {
  671. nvram_read_u16(prefix, NULL, "boardrev", &sprom->board_rev, 0, true);
  672. nvram_read_u16(prefix, NULL, "boardnum", &sprom->board_num, 0,
  673. fallback);
  674. nvram_read_u16(prefix, NULL, "boardtype", &sprom->board_type, 0, true);
  675. nvram_read_u32_2(prefix, "boardflags", &sprom->boardflags_lo,
  676. &sprom->boardflags_hi, fallback);
  677. nvram_read_u32_2(prefix, "boardflags2", &sprom->boardflags2_lo,
  678. &sprom->boardflags2_hi, fallback);
  679. }
  680. void bcm47xx_fill_sprom(struct ssb_sprom *sprom, const char *prefix,
  681. bool fallback)
  682. {
  683. bcm47xx_fill_sprom_ethernet(sprom, prefix, fallback);
  684. bcm47xx_fill_board_data(sprom, prefix, fallback);
  685. nvram_read_u8(prefix, NULL, "sromrev", &sprom->revision, 0, fallback);
  686. switch (sprom->revision) {
  687. case 1:
  688. bcm47xx_fill_sprom_r1234589(sprom, prefix, fallback);
  689. bcm47xx_fill_sprom_r12389(sprom, prefix, fallback);
  690. bcm47xx_fill_sprom_r1(sprom, prefix, fallback);
  691. break;
  692. case 2:
  693. bcm47xx_fill_sprom_r1234589(sprom, prefix, fallback);
  694. bcm47xx_fill_sprom_r12389(sprom, prefix, fallback);
  695. bcm47xx_fill_sprom_r2389(sprom, prefix, fallback);
  696. break;
  697. case 3:
  698. bcm47xx_fill_sprom_r1234589(sprom, prefix, fallback);
  699. bcm47xx_fill_sprom_r12389(sprom, prefix, fallback);
  700. bcm47xx_fill_sprom_r2389(sprom, prefix, fallback);
  701. bcm47xx_fill_sprom_r389(sprom, prefix, fallback);
  702. bcm47xx_fill_sprom_r3(sprom, prefix, fallback);
  703. break;
  704. case 4:
  705. case 5:
  706. bcm47xx_fill_sprom_r1234589(sprom, prefix, fallback);
  707. bcm47xx_fill_sprom_r4589(sprom, prefix, fallback);
  708. bcm47xx_fill_sprom_r458(sprom, prefix, fallback);
  709. bcm47xx_fill_sprom_r45(sprom, prefix, fallback);
  710. bcm47xx_fill_sprom_path_r4589(sprom, prefix, fallback);
  711. bcm47xx_fill_sprom_path_r45(sprom, prefix, fallback);
  712. break;
  713. case 8:
  714. bcm47xx_fill_sprom_r1234589(sprom, prefix, fallback);
  715. bcm47xx_fill_sprom_r12389(sprom, prefix, fallback);
  716. bcm47xx_fill_sprom_r2389(sprom, prefix, fallback);
  717. bcm47xx_fill_sprom_r389(sprom, prefix, fallback);
  718. bcm47xx_fill_sprom_r4589(sprom, prefix, fallback);
  719. bcm47xx_fill_sprom_r458(sprom, prefix, fallback);
  720. bcm47xx_fill_sprom_r89(sprom, prefix, fallback);
  721. bcm47xx_fill_sprom_path_r4589(sprom, prefix, fallback);
  722. break;
  723. case 9:
  724. bcm47xx_fill_sprom_r1234589(sprom, prefix, fallback);
  725. bcm47xx_fill_sprom_r12389(sprom, prefix, fallback);
  726. bcm47xx_fill_sprom_r2389(sprom, prefix, fallback);
  727. bcm47xx_fill_sprom_r389(sprom, prefix, fallback);
  728. bcm47xx_fill_sprom_r4589(sprom, prefix, fallback);
  729. bcm47xx_fill_sprom_r89(sprom, prefix, fallback);
  730. bcm47xx_fill_sprom_r9(sprom, prefix, fallback);
  731. bcm47xx_fill_sprom_path_r4589(sprom, prefix, fallback);
  732. break;
  733. default:
  734. pr_warn("Unsupported SPROM revision %d detected. Will extract"
  735. " v1\n", sprom->revision);
  736. sprom->revision = 1;
  737. bcm47xx_fill_sprom_r1234589(sprom, prefix, fallback);
  738. bcm47xx_fill_sprom_r12389(sprom, prefix, fallback);
  739. bcm47xx_fill_sprom_r1(sprom, prefix, fallback);
  740. }
  741. }
  742. #ifdef CONFIG_BCM47XX_SSB
  743. void bcm47xx_fill_ssb_boardinfo(struct ssb_boardinfo *boardinfo,
  744. const char *prefix)
  745. {
  746. nvram_read_u16(prefix, NULL, "boardvendor", &boardinfo->vendor, 0,
  747. true);
  748. if (!boardinfo->vendor)
  749. boardinfo->vendor = SSB_BOARDVENDOR_BCM;
  750. nvram_read_u16(prefix, NULL, "boardtype", &boardinfo->type, 0, true);
  751. }
  752. #endif
  753. #ifdef CONFIG_BCM47XX_BCMA
  754. void bcm47xx_fill_bcma_boardinfo(struct bcma_boardinfo *boardinfo,
  755. const char *prefix)
  756. {
  757. nvram_read_u16(prefix, NULL, "boardvendor", &boardinfo->vendor, 0,
  758. true);
  759. if (!boardinfo->vendor)
  760. boardinfo->vendor = SSB_BOARDVENDOR_BCM;
  761. nvram_read_u16(prefix, NULL, "boardtype", &boardinfo->type, 0, true);
  762. }
  763. #endif
  764. #if defined(CONFIG_BCM47XX_SSB)
  765. static int bcm47xx_get_sprom_ssb(struct ssb_bus *bus, struct ssb_sprom *out)
  766. {
  767. char prefix[10];
  768. if (bus->bustype == SSB_BUSTYPE_PCI) {
  769. memset(out, 0, sizeof(struct ssb_sprom));
  770. snprintf(prefix, sizeof(prefix), "pci/%u/%u/",
  771. bus->host_pci->bus->number + 1,
  772. PCI_SLOT(bus->host_pci->devfn));
  773. bcm47xx_fill_sprom(out, prefix, false);
  774. return 0;
  775. } else {
  776. pr_warn("bcm47xx: unable to fill SPROM for given bustype.\n");
  777. return -EINVAL;
  778. }
  779. }
  780. #endif
  781. #if defined(CONFIG_BCM47XX_BCMA)
  782. static int bcm47xx_get_sprom_bcma(struct bcma_bus *bus, struct ssb_sprom *out)
  783. {
  784. char prefix[10];
  785. struct bcma_device *core;
  786. switch (bus->hosttype) {
  787. case BCMA_HOSTTYPE_PCI:
  788. memset(out, 0, sizeof(struct ssb_sprom));
  789. snprintf(prefix, sizeof(prefix), "pci/%u/%u/",
  790. bus->host_pci->bus->number + 1,
  791. PCI_SLOT(bus->host_pci->devfn));
  792. bcm47xx_fill_sprom(out, prefix, false);
  793. return 0;
  794. case BCMA_HOSTTYPE_SOC:
  795. memset(out, 0, sizeof(struct ssb_sprom));
  796. core = bcma_find_core(bus, BCMA_CORE_80211);
  797. if (core) {
  798. snprintf(prefix, sizeof(prefix), "sb/%u/",
  799. core->core_index);
  800. bcm47xx_fill_sprom(out, prefix, true);
  801. } else {
  802. bcm47xx_fill_sprom(out, NULL, false);
  803. }
  804. return 0;
  805. default:
  806. pr_warn("bcm47xx: unable to fill SPROM for given bustype.\n");
  807. return -EINVAL;
  808. }
  809. }
  810. #endif
  811. /*
  812. * On bcm47xx we need to register SPROM fallback handler very early, so we can't
  813. * use anything like platform device / driver for this.
  814. */
  815. void bcm47xx_sprom_register_fallbacks(void)
  816. {
  817. #if defined(CONFIG_BCM47XX_SSB)
  818. if (ssb_arch_register_fallback_sprom(&bcm47xx_get_sprom_ssb))
  819. pr_warn("Failed to registered ssb SPROM handler\n");
  820. #endif
  821. #if defined(CONFIG_BCM47XX_BCMA)
  822. if (bcma_arch_register_fallback_sprom(&bcm47xx_get_sprom_bcma))
  823. pr_warn("Failed to registered bcma SPROM handler\n");
  824. #endif
  825. }