sprom.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620
  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 <nvram.h>
  30. static void create_key(const char *prefix, const char *postfix,
  31. const char *name, char *buf, int len)
  32. {
  33. if (prefix && postfix)
  34. snprintf(buf, len, "%s%s%s", prefix, name, postfix);
  35. else if (prefix)
  36. snprintf(buf, len, "%s%s", prefix, name);
  37. else if (postfix)
  38. snprintf(buf, len, "%s%s", name, postfix);
  39. else
  40. snprintf(buf, len, "%s", name);
  41. }
  42. #define NVRAM_READ_VAL(type) \
  43. static void nvram_read_ ## type (const char *prefix, \
  44. const char *postfix, const char *name, \
  45. type *val, type allset) \
  46. { \
  47. char buf[100]; \
  48. char key[40]; \
  49. int err; \
  50. type var; \
  51. \
  52. create_key(prefix, postfix, name, key, sizeof(key)); \
  53. \
  54. err = nvram_getenv(key, buf, sizeof(buf)); \
  55. if (err < 0) \
  56. return; \
  57. err = kstrto ## type (buf, 0, &var); \
  58. if (err) { \
  59. pr_warn("can not parse nvram name %s with value %s" \
  60. " got %i", key, buf, err); \
  61. return; \
  62. } \
  63. if (allset && var == allset) \
  64. return; \
  65. *val = var; \
  66. }
  67. NVRAM_READ_VAL(u8)
  68. NVRAM_READ_VAL(s8)
  69. NVRAM_READ_VAL(u16)
  70. NVRAM_READ_VAL(u32)
  71. #undef NVRAM_READ_VAL
  72. static void nvram_read_u32_2(const char *prefix, const char *name,
  73. u16 *val_lo, u16 *val_hi)
  74. {
  75. char buf[100];
  76. char key[40];
  77. int err;
  78. u32 val;
  79. create_key(prefix, NULL, name, key, sizeof(key));
  80. err = nvram_getenv(key, buf, sizeof(buf));
  81. if (err < 0)
  82. return;
  83. err = kstrtou32(buf, 0, &val);
  84. if (err) {
  85. pr_warn("can not parse nvram name %s with value %s got %i",
  86. key, buf, err);
  87. return;
  88. }
  89. *val_lo = (val & 0x0000FFFFU);
  90. *val_hi = (val & 0xFFFF0000U) >> 16;
  91. }
  92. static void nvram_read_leddc(const char *prefix, const char *name,
  93. u8 *leddc_on_time, u8 *leddc_off_time)
  94. {
  95. char buf[100];
  96. char key[40];
  97. int err;
  98. u32 val;
  99. create_key(prefix, NULL, name, key, sizeof(key));
  100. err = nvram_getenv(key, buf, sizeof(buf));
  101. if (err < 0)
  102. return;
  103. err = kstrtou32(buf, 0, &val);
  104. if (err) {
  105. pr_warn("can not parse nvram name %s with value %s got %i",
  106. key, buf, err);
  107. return;
  108. }
  109. if (val == 0xffff || val == 0xffffffff)
  110. return;
  111. *leddc_on_time = val & 0xff;
  112. *leddc_off_time = (val >> 16) & 0xff;
  113. }
  114. static void nvram_read_macaddr(const char *prefix, const char *name,
  115. u8 (*val)[6])
  116. {
  117. char buf[100];
  118. char key[40];
  119. int err;
  120. create_key(prefix, NULL, name, key, sizeof(key));
  121. err = nvram_getenv(key, buf, sizeof(buf));
  122. if (err < 0)
  123. return;
  124. nvram_parse_macaddr(buf, *val);
  125. }
  126. static void nvram_read_alpha2(const char *prefix, const char *name,
  127. char (*val)[2])
  128. {
  129. char buf[10];
  130. char key[40];
  131. int err;
  132. create_key(prefix, NULL, name, key, sizeof(key));
  133. err = nvram_getenv(key, buf, sizeof(buf));
  134. if (err < 0)
  135. return;
  136. if (buf[0] == '0')
  137. return;
  138. if (strlen(buf) > 2) {
  139. pr_warn("alpha2 is too long %s", buf);
  140. return;
  141. }
  142. memcpy(val, buf, sizeof(val));
  143. }
  144. static void bcm47xx_fill_sprom_r1234589(struct ssb_sprom *sprom,
  145. const char *prefix)
  146. {
  147. nvram_read_u16(prefix, NULL, "boardrev", &sprom->board_rev, 0);
  148. nvram_read_u16(prefix, NULL, "boardnum", &sprom->board_num, 0);
  149. nvram_read_u8(prefix, NULL, "ledbh0", &sprom->gpio0, 0xff);
  150. nvram_read_u8(prefix, NULL, "ledbh1", &sprom->gpio1, 0xff);
  151. nvram_read_u8(prefix, NULL, "ledbh2", &sprom->gpio2, 0xff);
  152. nvram_read_u8(prefix, NULL, "ledbh3", &sprom->gpio3, 0xff);
  153. nvram_read_u8(prefix, NULL, "aa2g", &sprom->ant_available_bg, 0);
  154. nvram_read_u8(prefix, NULL, "aa5g", &sprom->ant_available_a, 0);
  155. nvram_read_s8(prefix, NULL, "ag0", &sprom->antenna_gain.a0, 0);
  156. nvram_read_s8(prefix, NULL, "ag1", &sprom->antenna_gain.a1, 0);
  157. nvram_read_alpha2(prefix, "ccode", &sprom->alpha2);
  158. }
  159. static void bcm47xx_fill_sprom_r12389(struct ssb_sprom *sprom,
  160. const char *prefix)
  161. {
  162. nvram_read_u16(prefix, NULL, "pa0b0", &sprom->pa0b0, 0);
  163. nvram_read_u16(prefix, NULL, "pa0b1", &sprom->pa0b1, 0);
  164. nvram_read_u16(prefix, NULL, "pa0b2", &sprom->pa0b2, 0);
  165. nvram_read_u8(prefix, NULL, "pa0itssit", &sprom->itssi_bg, 0);
  166. nvram_read_u8(prefix, NULL, "pa0maxpwr", &sprom->maxpwr_bg, 0);
  167. nvram_read_u16(prefix, NULL, "pa1b0", &sprom->pa1b0, 0);
  168. nvram_read_u16(prefix, NULL, "pa1b1", &sprom->pa1b1, 0);
  169. nvram_read_u16(prefix, NULL, "pa1b2", &sprom->pa1b2, 0);
  170. nvram_read_u8(prefix, NULL, "pa1itssit", &sprom->itssi_a, 0);
  171. nvram_read_u8(prefix, NULL, "pa1maxpwr", &sprom->maxpwr_a, 0);
  172. }
  173. static void bcm47xx_fill_sprom_r1(struct ssb_sprom *sprom, const char *prefix)
  174. {
  175. nvram_read_u16(prefix, NULL, "boardflags", &sprom->boardflags_lo, 0);
  176. nvram_read_u8(prefix, NULL, "cc", &sprom->country_code, 0);
  177. }
  178. static void bcm47xx_fill_sprom_r2389(struct ssb_sprom *sprom,
  179. const char *prefix)
  180. {
  181. nvram_read_u8(prefix, NULL, "opo", &sprom->opo, 0);
  182. nvram_read_u16(prefix, NULL, "pa1lob0", &sprom->pa1lob0, 0);
  183. nvram_read_u16(prefix, NULL, "pa1lob1", &sprom->pa1lob1, 0);
  184. nvram_read_u16(prefix, NULL, "pa1lob2", &sprom->pa1lob2, 0);
  185. nvram_read_u16(prefix, NULL, "pa1hib0", &sprom->pa1hib0, 0);
  186. nvram_read_u16(prefix, NULL, "pa1hib1", &sprom->pa1hib1, 0);
  187. nvram_read_u16(prefix, NULL, "pa1hib2", &sprom->pa1hib2, 0);
  188. nvram_read_u8(prefix, NULL, "pa1lomaxpwr", &sprom->maxpwr_al, 0);
  189. nvram_read_u8(prefix, NULL, "pa1himaxpwr", &sprom->maxpwr_ah, 0);
  190. }
  191. static void bcm47xx_fill_sprom_r2(struct ssb_sprom *sprom, const char *prefix)
  192. {
  193. nvram_read_u32_2(prefix, "boardflags", &sprom->boardflags_lo,
  194. &sprom->boardflags_hi);
  195. nvram_read_u16(prefix, NULL, "boardtype", &sprom->board_type, 0);
  196. }
  197. static void bcm47xx_fill_sprom_r389(struct ssb_sprom *sprom, const char *prefix)
  198. {
  199. nvram_read_u8(prefix, NULL, "bxa2g", &sprom->bxa2g, 0);
  200. nvram_read_u8(prefix, NULL, "rssisav2g", &sprom->rssisav2g, 0);
  201. nvram_read_u8(prefix, NULL, "rssismc2g", &sprom->rssismc2g, 0);
  202. nvram_read_u8(prefix, NULL, "rssismf2g", &sprom->rssismf2g, 0);
  203. nvram_read_u8(prefix, NULL, "bxa5g", &sprom->bxa5g, 0);
  204. nvram_read_u8(prefix, NULL, "rssisav5g", &sprom->rssisav5g, 0);
  205. nvram_read_u8(prefix, NULL, "rssismc5g", &sprom->rssismc5g, 0);
  206. nvram_read_u8(prefix, NULL, "rssismf5g", &sprom->rssismf5g, 0);
  207. nvram_read_u8(prefix, NULL, "tri2g", &sprom->tri2g, 0);
  208. nvram_read_u8(prefix, NULL, "tri5g", &sprom->tri5g, 0);
  209. nvram_read_u8(prefix, NULL, "tri5gl", &sprom->tri5gl, 0);
  210. nvram_read_u8(prefix, NULL, "tri5gh", &sprom->tri5gh, 0);
  211. nvram_read_s8(prefix, NULL, "rxpo2g", &sprom->rxpo2g, 0);
  212. nvram_read_s8(prefix, NULL, "rxpo5g", &sprom->rxpo5g, 0);
  213. }
  214. static void bcm47xx_fill_sprom_r3(struct ssb_sprom *sprom, const char *prefix)
  215. {
  216. nvram_read_u32_2(prefix, "boardflags", &sprom->boardflags_lo,
  217. &sprom->boardflags_hi);
  218. nvram_read_u16(prefix, NULL, "boardtype", &sprom->board_type, 0);
  219. nvram_read_u8(prefix, NULL, "regrev", &sprom->regrev, 0);
  220. nvram_read_leddc(prefix, "leddc", &sprom->leddc_on_time,
  221. &sprom->leddc_off_time);
  222. }
  223. static void bcm47xx_fill_sprom_r4589(struct ssb_sprom *sprom,
  224. const char *prefix)
  225. {
  226. nvram_read_u32_2(prefix, "boardflags", &sprom->boardflags_lo,
  227. &sprom->boardflags_hi);
  228. nvram_read_u32_2(prefix, "boardflags2", &sprom->boardflags2_lo,
  229. &sprom->boardflags2_hi);
  230. nvram_read_u16(prefix, NULL, "boardtype", &sprom->board_type, 0);
  231. nvram_read_u8(prefix, NULL, "regrev", &sprom->regrev, 0);
  232. nvram_read_s8(prefix, NULL, "ag2", &sprom->antenna_gain.a2, 0);
  233. nvram_read_s8(prefix, NULL, "ag3", &sprom->antenna_gain.a3, 0);
  234. nvram_read_u8(prefix, NULL, "txchain", &sprom->txchain, 0xf);
  235. nvram_read_u8(prefix, NULL, "rxchain", &sprom->rxchain, 0xf);
  236. nvram_read_u8(prefix, NULL, "antswitch", &sprom->antswitch, 0xff);
  237. nvram_read_leddc(prefix, "leddc", &sprom->leddc_on_time,
  238. &sprom->leddc_off_time);
  239. }
  240. static void bcm47xx_fill_sprom_r458(struct ssb_sprom *sprom, const char *prefix)
  241. {
  242. nvram_read_u16(prefix, NULL, "cck2gpo", &sprom->cck2gpo, 0);
  243. nvram_read_u32(prefix, NULL, "ofdm2gpo", &sprom->ofdm2gpo, 0);
  244. nvram_read_u32(prefix, NULL, "ofdm5gpo", &sprom->ofdm5gpo, 0);
  245. nvram_read_u32(prefix, NULL, "ofdm5glpo", &sprom->ofdm5glpo, 0);
  246. nvram_read_u32(prefix, NULL, "ofdm5ghpo", &sprom->ofdm5ghpo, 0);
  247. nvram_read_u16(prefix, NULL, "cddpo", &sprom->cddpo, 0);
  248. nvram_read_u16(prefix, NULL, "stbcpo", &sprom->stbcpo, 0);
  249. nvram_read_u16(prefix, NULL, "bw40po", &sprom->bw40po, 0);
  250. nvram_read_u16(prefix, NULL, "bwduppo", &sprom->bwduppo, 0);
  251. nvram_read_u16(prefix, NULL, "mcs2gpo0", &sprom->mcs2gpo[0], 0);
  252. nvram_read_u16(prefix, NULL, "mcs2gpo1", &sprom->mcs2gpo[1], 0);
  253. nvram_read_u16(prefix, NULL, "mcs2gpo2", &sprom->mcs2gpo[2], 0);
  254. nvram_read_u16(prefix, NULL, "mcs2gpo3", &sprom->mcs2gpo[3], 0);
  255. nvram_read_u16(prefix, NULL, "mcs2gpo4", &sprom->mcs2gpo[4], 0);
  256. nvram_read_u16(prefix, NULL, "mcs2gpo5", &sprom->mcs2gpo[5], 0);
  257. nvram_read_u16(prefix, NULL, "mcs2gpo6", &sprom->mcs2gpo[6], 0);
  258. nvram_read_u16(prefix, NULL, "mcs2gpo7", &sprom->mcs2gpo[7], 0);
  259. nvram_read_u16(prefix, NULL, "mcs5gpo0", &sprom->mcs5gpo[0], 0);
  260. nvram_read_u16(prefix, NULL, "mcs5gpo1", &sprom->mcs5gpo[1], 0);
  261. nvram_read_u16(prefix, NULL, "mcs5gpo2", &sprom->mcs5gpo[2], 0);
  262. nvram_read_u16(prefix, NULL, "mcs5gpo3", &sprom->mcs5gpo[3], 0);
  263. nvram_read_u16(prefix, NULL, "mcs5gpo4", &sprom->mcs5gpo[4], 0);
  264. nvram_read_u16(prefix, NULL, "mcs5gpo5", &sprom->mcs5gpo[5], 0);
  265. nvram_read_u16(prefix, NULL, "mcs5gpo6", &sprom->mcs5gpo[6], 0);
  266. nvram_read_u16(prefix, NULL, "mcs5gpo7", &sprom->mcs5gpo[7], 0);
  267. nvram_read_u16(prefix, NULL, "mcs5glpo0", &sprom->mcs5glpo[0], 0);
  268. nvram_read_u16(prefix, NULL, "mcs5glpo1", &sprom->mcs5glpo[1], 0);
  269. nvram_read_u16(prefix, NULL, "mcs5glpo2", &sprom->mcs5glpo[2], 0);
  270. nvram_read_u16(prefix, NULL, "mcs5glpo3", &sprom->mcs5glpo[3], 0);
  271. nvram_read_u16(prefix, NULL, "mcs5glpo4", &sprom->mcs5glpo[4], 0);
  272. nvram_read_u16(prefix, NULL, "mcs5glpo5", &sprom->mcs5glpo[5], 0);
  273. nvram_read_u16(prefix, NULL, "mcs5glpo6", &sprom->mcs5glpo[6], 0);
  274. nvram_read_u16(prefix, NULL, "mcs5glpo7", &sprom->mcs5glpo[7], 0);
  275. nvram_read_u16(prefix, NULL, "mcs5ghpo0", &sprom->mcs5ghpo[0], 0);
  276. nvram_read_u16(prefix, NULL, "mcs5ghpo1", &sprom->mcs5ghpo[1], 0);
  277. nvram_read_u16(prefix, NULL, "mcs5ghpo2", &sprom->mcs5ghpo[2], 0);
  278. nvram_read_u16(prefix, NULL, "mcs5ghpo3", &sprom->mcs5ghpo[3], 0);
  279. nvram_read_u16(prefix, NULL, "mcs5ghpo4", &sprom->mcs5ghpo[4], 0);
  280. nvram_read_u16(prefix, NULL, "mcs5ghpo5", &sprom->mcs5ghpo[5], 0);
  281. nvram_read_u16(prefix, NULL, "mcs5ghpo6", &sprom->mcs5ghpo[6], 0);
  282. nvram_read_u16(prefix, NULL, "mcs5ghpo7", &sprom->mcs5ghpo[7], 0);
  283. }
  284. static void bcm47xx_fill_sprom_r45(struct ssb_sprom *sprom, const char *prefix)
  285. {
  286. nvram_read_u8(prefix, NULL, "txpid2ga0", &sprom->txpid2g[0], 0);
  287. nvram_read_u8(prefix, NULL, "txpid2ga1", &sprom->txpid2g[1], 0);
  288. nvram_read_u8(prefix, NULL, "txpid2ga2", &sprom->txpid2g[2], 0);
  289. nvram_read_u8(prefix, NULL, "txpid2ga3", &sprom->txpid2g[3], 0);
  290. nvram_read_u8(prefix, NULL, "txpid5ga0", &sprom->txpid5g[0], 0);
  291. nvram_read_u8(prefix, NULL, "txpid5ga1", &sprom->txpid5g[1], 0);
  292. nvram_read_u8(prefix, NULL, "txpid5ga2", &sprom->txpid5g[2], 0);
  293. nvram_read_u8(prefix, NULL, "txpid5ga3", &sprom->txpid5g[3], 0);
  294. nvram_read_u8(prefix, NULL, "txpid5gla0", &sprom->txpid5gl[0], 0);
  295. nvram_read_u8(prefix, NULL, "txpid5gla1", &sprom->txpid5gl[1], 0);
  296. nvram_read_u8(prefix, NULL, "txpid5gla2", &sprom->txpid5gl[2], 0);
  297. nvram_read_u8(prefix, NULL, "txpid5gla3", &sprom->txpid5gl[3], 0);
  298. nvram_read_u8(prefix, NULL, "txpid5gha0", &sprom->txpid5gh[0], 0);
  299. nvram_read_u8(prefix, NULL, "txpid5gha1", &sprom->txpid5gh[1], 0);
  300. nvram_read_u8(prefix, NULL, "txpid5gha2", &sprom->txpid5gh[2], 0);
  301. nvram_read_u8(prefix, NULL, "txpid5gha3", &sprom->txpid5gh[3], 0);
  302. }
  303. static void bcm47xx_fill_sprom_r89(struct ssb_sprom *sprom, const char *prefix)
  304. {
  305. nvram_read_u8(prefix, NULL, "tssipos2g", &sprom->fem.ghz2.tssipos, 0);
  306. nvram_read_u8(prefix, NULL, "extpagain2g",
  307. &sprom->fem.ghz2.extpa_gain, 0);
  308. nvram_read_u8(prefix, NULL, "pdetrange2g",
  309. &sprom->fem.ghz2.pdet_range, 0);
  310. nvram_read_u8(prefix, NULL, "triso2g", &sprom->fem.ghz2.tr_iso, 0);
  311. nvram_read_u8(prefix, NULL, "antswctl2g", &sprom->fem.ghz2.antswlut, 0);
  312. nvram_read_u8(prefix, NULL, "tssipos5g", &sprom->fem.ghz5.tssipos, 0);
  313. nvram_read_u8(prefix, NULL, "extpagain5g",
  314. &sprom->fem.ghz5.extpa_gain, 0);
  315. nvram_read_u8(prefix, NULL, "pdetrange5g",
  316. &sprom->fem.ghz5.pdet_range, 0);
  317. nvram_read_u8(prefix, NULL, "triso5g", &sprom->fem.ghz5.tr_iso, 0);
  318. nvram_read_u8(prefix, NULL, "antswctl5g", &sprom->fem.ghz5.antswlut, 0);
  319. nvram_read_u8(prefix, NULL, "tempthresh", &sprom->tempthresh, 0);
  320. nvram_read_u8(prefix, NULL, "tempoffset", &sprom->tempoffset, 0);
  321. nvram_read_u16(prefix, NULL, "rawtempsense", &sprom->rawtempsense, 0);
  322. nvram_read_u8(prefix, NULL, "measpower", &sprom->measpower, 0);
  323. nvram_read_u8(prefix, NULL, "tempsense_slope",
  324. &sprom->tempsense_slope, 0);
  325. nvram_read_u8(prefix, NULL, "tempcorrx", &sprom->tempcorrx, 0);
  326. nvram_read_u8(prefix, NULL, "tempsense_option",
  327. &sprom->tempsense_option, 0);
  328. nvram_read_u8(prefix, NULL, "freqoffset_corr",
  329. &sprom->freqoffset_corr, 0);
  330. nvram_read_u8(prefix, NULL, "iqcal_swp_dis", &sprom->iqcal_swp_dis, 0);
  331. nvram_read_u8(prefix, NULL, "hw_iqcal_en", &sprom->hw_iqcal_en, 0);
  332. nvram_read_u8(prefix, NULL, "elna2g", &sprom->elna2g, 0);
  333. nvram_read_u8(prefix, NULL, "elna5g", &sprom->elna5g, 0);
  334. nvram_read_u8(prefix, NULL, "phycal_tempdelta",
  335. &sprom->phycal_tempdelta, 0);
  336. nvram_read_u8(prefix, NULL, "temps_period", &sprom->temps_period, 0);
  337. nvram_read_u8(prefix, NULL, "temps_hysteresis",
  338. &sprom->temps_hysteresis, 0);
  339. nvram_read_u8(prefix, NULL, "measpower1", &sprom->measpower1, 0);
  340. nvram_read_u8(prefix, NULL, "measpower2", &sprom->measpower2, 0);
  341. nvram_read_u8(prefix, NULL, "rxgainerr2ga0",
  342. &sprom->rxgainerr2ga[0], 0);
  343. nvram_read_u8(prefix, NULL, "rxgainerr2ga1",
  344. &sprom->rxgainerr2ga[1], 0);
  345. nvram_read_u8(prefix, NULL, "rxgainerr2ga2",
  346. &sprom->rxgainerr2ga[2], 0);
  347. nvram_read_u8(prefix, NULL, "rxgainerr5gla0",
  348. &sprom->rxgainerr5gla[0], 0);
  349. nvram_read_u8(prefix, NULL, "rxgainerr5gla1",
  350. &sprom->rxgainerr5gla[1], 0);
  351. nvram_read_u8(prefix, NULL, "rxgainerr5gla2",
  352. &sprom->rxgainerr5gla[2], 0);
  353. nvram_read_u8(prefix, NULL, "rxgainerr5gma0",
  354. &sprom->rxgainerr5gma[0], 0);
  355. nvram_read_u8(prefix, NULL, "rxgainerr5gma1",
  356. &sprom->rxgainerr5gma[1], 0);
  357. nvram_read_u8(prefix, NULL, "rxgainerr5gma2",
  358. &sprom->rxgainerr5gma[2], 0);
  359. nvram_read_u8(prefix, NULL, "rxgainerr5gha0",
  360. &sprom->rxgainerr5gha[0], 0);
  361. nvram_read_u8(prefix, NULL, "rxgainerr5gha1",
  362. &sprom->rxgainerr5gha[1], 0);
  363. nvram_read_u8(prefix, NULL, "rxgainerr5gha2",
  364. &sprom->rxgainerr5gha[2], 0);
  365. nvram_read_u8(prefix, NULL, "rxgainerr5gua0",
  366. &sprom->rxgainerr5gua[0], 0);
  367. nvram_read_u8(prefix, NULL, "rxgainerr5gua1",
  368. &sprom->rxgainerr5gua[1], 0);
  369. nvram_read_u8(prefix, NULL, "rxgainerr5gua2",
  370. &sprom->rxgainerr5gua[2], 0);
  371. nvram_read_u8(prefix, NULL, "noiselvl2ga0", &sprom->noiselvl2ga[0], 0);
  372. nvram_read_u8(prefix, NULL, "noiselvl2ga1", &sprom->noiselvl2ga[1], 0);
  373. nvram_read_u8(prefix, NULL, "noiselvl2ga2", &sprom->noiselvl2ga[2], 0);
  374. nvram_read_u8(prefix, NULL, "noiselvl5gla0",
  375. &sprom->noiselvl5gla[0], 0);
  376. nvram_read_u8(prefix, NULL, "noiselvl5gla1",
  377. &sprom->noiselvl5gla[1], 0);
  378. nvram_read_u8(prefix, NULL, "noiselvl5gla2",
  379. &sprom->noiselvl5gla[2], 0);
  380. nvram_read_u8(prefix, NULL, "noiselvl5gma0",
  381. &sprom->noiselvl5gma[0], 0);
  382. nvram_read_u8(prefix, NULL, "noiselvl5gma1",
  383. &sprom->noiselvl5gma[1], 0);
  384. nvram_read_u8(prefix, NULL, "noiselvl5gma2",
  385. &sprom->noiselvl5gma[2], 0);
  386. nvram_read_u8(prefix, NULL, "noiselvl5gha0",
  387. &sprom->noiselvl5gha[0], 0);
  388. nvram_read_u8(prefix, NULL, "noiselvl5gha1",
  389. &sprom->noiselvl5gha[1], 0);
  390. nvram_read_u8(prefix, NULL, "noiselvl5gha2",
  391. &sprom->noiselvl5gha[2], 0);
  392. nvram_read_u8(prefix, NULL, "noiselvl5gua0",
  393. &sprom->noiselvl5gua[0], 0);
  394. nvram_read_u8(prefix, NULL, "noiselvl5gua1",
  395. &sprom->noiselvl5gua[1], 0);
  396. nvram_read_u8(prefix, NULL, "noiselvl5gua2",
  397. &sprom->noiselvl5gua[2], 0);
  398. nvram_read_u8(prefix, NULL, "pcieingress_war",
  399. &sprom->pcieingress_war, 0);
  400. }
  401. static void bcm47xx_fill_sprom_r9(struct ssb_sprom *sprom, const char *prefix)
  402. {
  403. nvram_read_u16(prefix, NULL, "cckbw202gpo", &sprom->cckbw202gpo, 0);
  404. nvram_read_u16(prefix, NULL, "cckbw20ul2gpo", &sprom->cckbw20ul2gpo, 0);
  405. nvram_read_u32(prefix, NULL, "legofdmbw202gpo",
  406. &sprom->legofdmbw202gpo, 0);
  407. nvram_read_u32(prefix, NULL, "legofdmbw20ul2gpo",
  408. &sprom->legofdmbw20ul2gpo, 0);
  409. nvram_read_u32(prefix, NULL, "legofdmbw205glpo",
  410. &sprom->legofdmbw205glpo, 0);
  411. nvram_read_u32(prefix, NULL, "legofdmbw20ul5glpo",
  412. &sprom->legofdmbw20ul5glpo, 0);
  413. nvram_read_u32(prefix, NULL, "legofdmbw205gmpo",
  414. &sprom->legofdmbw205gmpo, 0);
  415. nvram_read_u32(prefix, NULL, "legofdmbw20ul5gmpo",
  416. &sprom->legofdmbw20ul5gmpo, 0);
  417. nvram_read_u32(prefix, NULL, "legofdmbw205ghpo",
  418. &sprom->legofdmbw205ghpo, 0);
  419. nvram_read_u32(prefix, NULL, "legofdmbw20ul5ghpo",
  420. &sprom->legofdmbw20ul5ghpo, 0);
  421. nvram_read_u32(prefix, NULL, "mcsbw202gpo", &sprom->mcsbw202gpo, 0);
  422. nvram_read_u32(prefix, NULL, "mcsbw20ul2gpo", &sprom->mcsbw20ul2gpo, 0);
  423. nvram_read_u32(prefix, NULL, "mcsbw402gpo", &sprom->mcsbw402gpo, 0);
  424. nvram_read_u32(prefix, NULL, "mcsbw205glpo", &sprom->mcsbw205glpo, 0);
  425. nvram_read_u32(prefix, NULL, "mcsbw20ul5glpo",
  426. &sprom->mcsbw20ul5glpo, 0);
  427. nvram_read_u32(prefix, NULL, "mcsbw405glpo", &sprom->mcsbw405glpo, 0);
  428. nvram_read_u32(prefix, NULL, "mcsbw205gmpo", &sprom->mcsbw205gmpo, 0);
  429. nvram_read_u32(prefix, NULL, "mcsbw20ul5gmpo",
  430. &sprom->mcsbw20ul5gmpo, 0);
  431. nvram_read_u32(prefix, NULL, "mcsbw405gmpo", &sprom->mcsbw405gmpo, 0);
  432. nvram_read_u32(prefix, NULL, "mcsbw205ghpo", &sprom->mcsbw205ghpo, 0);
  433. nvram_read_u32(prefix, NULL, "mcsbw20ul5ghpo",
  434. &sprom->mcsbw20ul5ghpo, 0);
  435. nvram_read_u32(prefix, NULL, "mcsbw405ghpo", &sprom->mcsbw405ghpo, 0);
  436. nvram_read_u16(prefix, NULL, "mcs32po", &sprom->mcs32po, 0);
  437. nvram_read_u16(prefix, NULL, "legofdm40duppo",
  438. &sprom->legofdm40duppo, 0);
  439. nvram_read_u8(prefix, NULL, "sar2g", &sprom->sar2g, 0);
  440. nvram_read_u8(prefix, NULL, "sar5g", &sprom->sar5g, 0);
  441. }
  442. static void bcm47xx_fill_sprom_path_r4589(struct ssb_sprom *sprom,
  443. const char *prefix)
  444. {
  445. char postfix[2];
  446. int i;
  447. for (i = 0; i < ARRAY_SIZE(sprom->core_pwr_info); i++) {
  448. struct ssb_sprom_core_pwr_info *pwr_info = &sprom->core_pwr_info[i];
  449. snprintf(postfix, sizeof(postfix), "%i", i);
  450. nvram_read_u8(prefix, postfix, "maxp2ga",
  451. &pwr_info->maxpwr_2g, 0);
  452. nvram_read_u8(prefix, postfix, "itt2ga",
  453. &pwr_info->itssi_2g, 0);
  454. nvram_read_u8(prefix, postfix, "itt5ga",
  455. &pwr_info->itssi_5g, 0);
  456. nvram_read_u16(prefix, postfix, "pa2gw0a",
  457. &pwr_info->pa_2g[0], 0);
  458. nvram_read_u16(prefix, postfix, "pa2gw1a",
  459. &pwr_info->pa_2g[1], 0);
  460. nvram_read_u16(prefix, postfix, "pa2gw2a",
  461. &pwr_info->pa_2g[2], 0);
  462. nvram_read_u8(prefix, postfix, "maxp5ga",
  463. &pwr_info->maxpwr_5g, 0);
  464. nvram_read_u8(prefix, postfix, "maxp5gha",
  465. &pwr_info->maxpwr_5gh, 0);
  466. nvram_read_u8(prefix, postfix, "maxp5gla",
  467. &pwr_info->maxpwr_5gl, 0);
  468. nvram_read_u16(prefix, postfix, "pa5gw0a",
  469. &pwr_info->pa_5g[0], 0);
  470. nvram_read_u16(prefix, postfix, "pa5gw1a",
  471. &pwr_info->pa_5g[1], 0);
  472. nvram_read_u16(prefix, postfix, "pa5gw2a",
  473. &pwr_info->pa_5g[2], 0);
  474. nvram_read_u16(prefix, postfix, "pa5glw0a",
  475. &pwr_info->pa_5gl[0], 0);
  476. nvram_read_u16(prefix, postfix, "pa5glw1a",
  477. &pwr_info->pa_5gl[1], 0);
  478. nvram_read_u16(prefix, postfix, "pa5glw2a",
  479. &pwr_info->pa_5gl[2], 0);
  480. nvram_read_u16(prefix, postfix, "pa5ghw0a",
  481. &pwr_info->pa_5gh[0], 0);
  482. nvram_read_u16(prefix, postfix, "pa5ghw1a",
  483. &pwr_info->pa_5gh[1], 0);
  484. nvram_read_u16(prefix, postfix, "pa5ghw2a",
  485. &pwr_info->pa_5gh[2], 0);
  486. }
  487. }
  488. static void bcm47xx_fill_sprom_path_r45(struct ssb_sprom *sprom,
  489. const char *prefix)
  490. {
  491. char postfix[2];
  492. int i;
  493. for (i = 0; i < ARRAY_SIZE(sprom->core_pwr_info); i++) {
  494. struct ssb_sprom_core_pwr_info *pwr_info = &sprom->core_pwr_info[i];
  495. snprintf(postfix, sizeof(postfix), "%i", i);
  496. nvram_read_u16(prefix, postfix, "pa2gw3a",
  497. &pwr_info->pa_2g[3], 0);
  498. nvram_read_u16(prefix, postfix, "pa5gw3a",
  499. &pwr_info->pa_5g[3], 0);
  500. nvram_read_u16(prefix, postfix, "pa5glw3a",
  501. &pwr_info->pa_5gl[3], 0);
  502. nvram_read_u16(prefix, postfix, "pa5ghw3a",
  503. &pwr_info->pa_5gh[3], 0);
  504. }
  505. }
  506. void bcm47xx_fill_sprom_ethernet(struct ssb_sprom *sprom, const char *prefix)
  507. {
  508. nvram_read_macaddr(prefix, "et0macaddr", &sprom->et0mac);
  509. nvram_read_u8(prefix, NULL, "et0mdcport", &sprom->et0mdcport, 0);
  510. nvram_read_u8(prefix, NULL, "et0phyaddr", &sprom->et0phyaddr, 0);
  511. nvram_read_macaddr(prefix, "et1macaddr", &sprom->et1mac);
  512. nvram_read_u8(prefix, NULL, "et1mdcport", &sprom->et1mdcport, 0);
  513. nvram_read_u8(prefix, NULL, "et1phyaddr", &sprom->et1phyaddr, 0);
  514. nvram_read_macaddr(prefix, "macaddr", &sprom->il0mac);
  515. nvram_read_macaddr(prefix, "il0macaddr", &sprom->il0mac);
  516. }
  517. void bcm47xx_fill_sprom(struct ssb_sprom *sprom, const char *prefix)
  518. {
  519. memset(sprom, 0, sizeof(struct ssb_sprom));
  520. bcm47xx_fill_sprom_ethernet(sprom, prefix);
  521. nvram_read_u8(prefix, NULL, "sromrev", &sprom->revision, 0);
  522. switch (sprom->revision) {
  523. case 1:
  524. bcm47xx_fill_sprom_r1234589(sprom, prefix);
  525. bcm47xx_fill_sprom_r12389(sprom, prefix);
  526. bcm47xx_fill_sprom_r1(sprom, prefix);
  527. break;
  528. case 2:
  529. bcm47xx_fill_sprom_r1234589(sprom, prefix);
  530. bcm47xx_fill_sprom_r12389(sprom, prefix);
  531. bcm47xx_fill_sprom_r2389(sprom, prefix);
  532. bcm47xx_fill_sprom_r2(sprom, prefix);
  533. break;
  534. case 3:
  535. bcm47xx_fill_sprom_r1234589(sprom, prefix);
  536. bcm47xx_fill_sprom_r12389(sprom, prefix);
  537. bcm47xx_fill_sprom_r2389(sprom, prefix);
  538. bcm47xx_fill_sprom_r389(sprom, prefix);
  539. bcm47xx_fill_sprom_r3(sprom, prefix);
  540. break;
  541. case 4:
  542. case 5:
  543. bcm47xx_fill_sprom_r1234589(sprom, prefix);
  544. bcm47xx_fill_sprom_r4589(sprom, prefix);
  545. bcm47xx_fill_sprom_r458(sprom, prefix);
  546. bcm47xx_fill_sprom_r45(sprom, prefix);
  547. bcm47xx_fill_sprom_path_r4589(sprom, prefix);
  548. bcm47xx_fill_sprom_path_r45(sprom, prefix);
  549. break;
  550. case 8:
  551. bcm47xx_fill_sprom_r1234589(sprom, prefix);
  552. bcm47xx_fill_sprom_r12389(sprom, prefix);
  553. bcm47xx_fill_sprom_r2389(sprom, prefix);
  554. bcm47xx_fill_sprom_r389(sprom, prefix);
  555. bcm47xx_fill_sprom_r4589(sprom, prefix);
  556. bcm47xx_fill_sprom_r458(sprom, prefix);
  557. bcm47xx_fill_sprom_r89(sprom, prefix);
  558. bcm47xx_fill_sprom_path_r4589(sprom, prefix);
  559. break;
  560. case 9:
  561. bcm47xx_fill_sprom_r1234589(sprom, prefix);
  562. bcm47xx_fill_sprom_r12389(sprom, prefix);
  563. bcm47xx_fill_sprom_r2389(sprom, prefix);
  564. bcm47xx_fill_sprom_r389(sprom, prefix);
  565. bcm47xx_fill_sprom_r4589(sprom, prefix);
  566. bcm47xx_fill_sprom_r89(sprom, prefix);
  567. bcm47xx_fill_sprom_r9(sprom, prefix);
  568. bcm47xx_fill_sprom_path_r4589(sprom, prefix);
  569. break;
  570. default:
  571. pr_warn("Unsupported SPROM revision %d detected. Will extract"
  572. " v1\n", sprom->revision);
  573. sprom->revision = 1;
  574. bcm47xx_fill_sprom_r1234589(sprom, prefix);
  575. bcm47xx_fill_sprom_r12389(sprom, prefix);
  576. bcm47xx_fill_sprom_r1(sprom, prefix);
  577. }
  578. }