910-fallback-sprom.patch 2.3 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788
  1. --- a/driver/bcmsrom.c
  2. +++ b/driver/bcmsrom.c
  3. @@ -39,6 +39,10 @@
  4. #include <sbsdpcmdev.h>
  5. #endif
  6. +#ifdef CONFIG_SSB
  7. +#include <linux/ssb/ssb.h>
  8. +#endif
  9. +
  10. #ifdef WLTEST
  11. #include <sbsprom.h>
  12. #endif /* WLTEST */
  13. @@ -2058,6 +2062,11 @@ BCMATTACHFN(initvars_srom_pci)(si_t *sih
  14. bool flash = FALSE;
  15. int err = 0;
  16. +#ifdef CONFIG_SSB
  17. + struct ssb_sprom *fbrom;
  18. + char eabuf[18];
  19. +#endif
  20. +
  21. /*
  22. * Apply CRC over SROM content regardless SROM is present or not,
  23. * and use variable <devpath>sromrev's existance in flash to decide
  24. @@ -2120,6 +2129,62 @@ BCMATTACHFN(initvars_srom_pci)(si_t *sih
  25. goto varscont;
  26. }
  27. +#ifdef CONFIG_SSB
  28. + base = vp = MALLOC(osh, MAXSZ_NVRAM_VARS);
  29. +
  30. + if( base != NULL )
  31. + {
  32. + varbuf_init(&b, base, MAXSZ_NVRAM_VARS);
  33. +
  34. + /* Try to load ssb fallback sprom */
  35. + if ((fbrom = ssb_get_fallback_sprom()) != NULL)
  36. + {
  37. + printk("Got version %i SPROM from SSB\n", fbrom->revision);
  38. +
  39. + varbuf_append(&b, vstr_sromrev, fbrom->revision);
  40. + varbuf_append(&b, vstr_boardrev, fbrom->board_rev);
  41. +
  42. + /* ToDo: map fbrom->country_code */
  43. + varbuf_append(&b, vstr_noccode);
  44. +
  45. + varbuf_append(&b, vstr_aa2g, fbrom->ant_available_bg);
  46. +
  47. + varbuf_append(&b, vstr_pa0b[0], fbrom->pa0b0);
  48. + varbuf_append(&b, vstr_pa1b[0], fbrom->pa1b0);
  49. + varbuf_append(&b, vstr_pa0b[1], fbrom->pa0b1);
  50. + varbuf_append(&b, vstr_pa1b[1], fbrom->pa1b1);
  51. + varbuf_append(&b, vstr_pa0b[2], fbrom->pa0b2);
  52. + varbuf_append(&b, vstr_pa1b[2], fbrom->pa1b2);
  53. +
  54. + varbuf_append(&b, vstr_pa0maxpwr, fbrom->maxpwr_bg);
  55. + varbuf_append(&b, vstr_pa0itssit, fbrom->itssi_bg);
  56. +
  57. + varbuf_append(&b, vstr_boardflags, (fbrom->boardflags_hi << 16) | fbrom->boardflags_lo);
  58. + varbuf_append(&b, vstr_boardflags2, (fbrom->boardflags2_hi << 16) | fbrom->boardflags2_lo);
  59. +
  60. + snprintf(eabuf, sizeof(eabuf), "%02x:%02x:%02x:%02x:%02x:%02x",
  61. + fbrom->il0mac[0], fbrom->il0mac[1], fbrom->il0mac[2],
  62. + fbrom->il0mac[3], fbrom->il0mac[4], fbrom->il0mac[5]
  63. + );
  64. +
  65. + varbuf_append(&b, vstr_macaddr, eabuf);
  66. + }
  67. +
  68. + /* final nullbyte terminator */
  69. + ASSERT(b.size >= 1);
  70. + vp = b.buf;
  71. + *vp++ = '\0';
  72. +
  73. + ASSERT((vp - base) <= MAXSZ_NVRAM_VARS);
  74. + goto varsdone;
  75. + }
  76. + else
  77. + {
  78. + err = -2;
  79. + goto errout;
  80. + }
  81. +#endif
  82. +
  83. BS_ERROR(("SROM CRC Error\n"));
  84. #if defined(WLTEST)