Skip to content

L
linux
Commit 2a9b065c authored by Arend van Spriel's avatar Arend van Spriel Committed by Greg Kroah-Hartman
Browse files
Options

staging: brcm80211: replace string based variable storage by linked list 

The storage of variables obtained from srom are now stored in a linked
list and lookup is done based on the enumerated identifier.
Reported-by: default avatarJohannes Berg <johannes@sipsolutions.net>
Reviewed-by: default avatarRoland Vossen <rvossen@broadcom.com>
Reviewed-by: default avatarAlwin Beukers <alwin@broadcom.com>
Signed-off-by: default avatarArend van Spriel <arend@broadcom.com>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@suse.de>
parent 36bd40db
Hide whitespace changes
Inline Side-by-side
Showing with 124 additions and 431 deletions
drivers/staging/brcm80211/brcmsmac/aiutils.c
View file @ 2a9b065c
......@@ -1210,6 +1210,7 @@ void ai_detach(struct si_pub *sih)
pcicore_deinit(sii->pch);
sii->pch = NULL;
srom_free_vars(sih);
kfree(sii);
}
......
drivers/staging/brcm80211/brcmsmac/aiutils.h
View file @ 2a9b065c
......@@ -266,6 +266,7 @@ struct si_info {
struct pcicore_info *pch; /* PCI/E core handle */
struct list_head var_list; /* list of srom variables */
char *vars;
uint varsz;
......
drivers/staging/brcm80211/brcmsmac/srom.c
View file @ 2a9b065c
......@@ -364,6 +364,36 @@
/* Max. nvram variable table size */
#define MAXSZ_NVRAM_VARS 4096
/*
* indicates type of value.
*/
enum brcms_srom_var_type {
BRCMS_SROM_STRING,
BRCMS_SROM_SNUMBER,
BRCMS_SROM_UNUMBER
};
/*
* storage type for srom variable.
*
* var_list: for linked list operations.
* varid: identifier of the variable.
* var_type: type of variable.
* buf: variable value when var_type == BRCMS_SROM_STRING.
* uval: unsigned variable value when var_type == BRCMS_SROM_UNUMBER.
* sval: signed variable value when var_type == BRCMS_SROM_SNUMBER.
*/
struct brcms_srom_list_head {
struct list_head var_list;
enum brcms_srom_id varid;
enum brcms_srom_var_type var_type;
union {
char buf[0];
u32 uval;
s32 sval;
};
};
struct brcms_sromvar {
enum brcms_srom_id varid;
u32 revmask;
......@@ -834,278 +864,6 @@ static const struct brcms_sromvar perpath_pci_sromvars[] = {
{BRCMS_SROM_NULL, 0, 0, 0, 0}
};
struct srom_id_name {
enum brcms_srom_id id;
const char *name;
};
static const struct srom_id_name srom_id_map[] = {
{ BRCMS_SROM_AA2G, "aa2g" },
{ BRCMS_SROM_AA5G, "aa5g" },
{ BRCMS_SROM_AG0, "ag0" },
{ BRCMS_SROM_AG1, "ag1" },
{ BRCMS_SROM_AG2, "ag2" },
{ BRCMS_SROM_AG3, "ag3" },
{ BRCMS_SROM_ANTSWCTL2G, "antswctl2g" },
{ BRCMS_SROM_ANTSWCTL5G, "antswctl5g" },
{ BRCMS_SROM_ANTSWITCH, "antswitch" },
{ BRCMS_SROM_BOARDFLAGS2, "boardflags2" },
{ BRCMS_SROM_BOARDFLAGS, "boardflags" },
{ BRCMS_SROM_BOARDNUM, "boardnum" },
{ BRCMS_SROM_BOARDREV, "boardrev" },
{ BRCMS_SROM_BOARDTYPE, "boardtype" },
{ BRCMS_SROM_BW40PO, "bw40po" },
{ BRCMS_SROM_BWDUPPO, "bwduppo" },
{ BRCMS_SROM_BXA2G, "bxa2g" },
{ BRCMS_SROM_BXA5G, "bxa5g" },
{ BRCMS_SROM_CC, "cc" },
{ BRCMS_SROM_CCK2GPO, "cck2gpo" },
{ BRCMS_SROM_CCKBW202GPO, "cckbw202gpo" },
{ BRCMS_SROM_CCKBW20UL2GPO, "cckbw20ul2gpo" },
{ BRCMS_SROM_CCODE, "ccode" },
{ BRCMS_SROM_CDDPO, "cddpo" },
{ BRCMS_SROM_DEVID, "devid" },
{ BRCMS_SROM_ET1MACADDR, "et1macaddr" },
{ BRCMS_SROM_EXTPAGAIN2G, "extpagain2g" },
{ BRCMS_SROM_EXTPAGAIN5G, "extpagain5g" },
{ BRCMS_SROM_FREQOFFSET_CORR, "freqoffset_corr" },
{ BRCMS_SROM_HW_IQCAL_EN, "hw_iqcal_en" },
{ BRCMS_SROM_IL0MACADDR, "il0macaddr" },
{ BRCMS_SROM_IQCAL_SWP_DIS, "iqcal_swp_dis" },
{ BRCMS_SROM_LEDBH0, "ledbh0" },
{ BRCMS_SROM_LEDBH1, "ledbh1" },
{ BRCMS_SROM_LEDBH2, "ledbh2" },
{ BRCMS_SROM_LEDBH3, "ledbh3" },
{ BRCMS_SROM_LEDDC, "leddc" },
{ BRCMS_SROM_LEGOFDM40DUPPO, "legofdm40duppo" },
{ BRCMS_SROM_LEGOFDMBW202GPO, "legofdmbw202gpo" },
{ BRCMS_SROM_LEGOFDMBW205GHPO, "legofdmbw205ghpo" },
{ BRCMS_SROM_LEGOFDMBW205GLPO, "legofdmbw205glpo" },
{ BRCMS_SROM_LEGOFDMBW205GMPO, "legofdmbw205gmpo" },
{ BRCMS_SROM_LEGOFDMBW20UL2GPO, "legofdmbw20ul2gpo" },
{ BRCMS_SROM_LEGOFDMBW20UL5GHPO, "legofdmbw20ul5ghpo" },
{ BRCMS_SROM_LEGOFDMBW20UL5GLPO, "legofdmbw20ul5glpo" },
{ BRCMS_SROM_LEGOFDMBW20UL5GMPO, "legofdmbw20ul5gmpo" },
{ BRCMS_SROM_MACADDR, "macaddr" },
{ BRCMS_SROM_MCS2GPO0, "mcs2gpo0" },
{ BRCMS_SROM_MCS2GPO1, "mcs2gpo1" },
{ BRCMS_SROM_MCS2GPO2, "mcs2gpo2" },
{ BRCMS_SROM_MCS2GPO3, "mcs2gpo3" },
{ BRCMS_SROM_MCS2GPO4, "mcs2gpo4" },
{ BRCMS_SROM_MCS2GPO5, "mcs2gpo5" },
{ BRCMS_SROM_MCS2GPO6, "mcs2gpo6" },
{ BRCMS_SROM_MCS2GPO7, "mcs2gpo7" },
{ BRCMS_SROM_MCS32PO, "mcs32po" },
{ BRCMS_SROM_MCS5GHPO0, "mcs5ghpo0" },
{ BRCMS_SROM_MCS5GHPO1, "mcs5ghpo1" },
{ BRCMS_SROM_MCS5GHPO2, "mcs5ghpo2" },
{ BRCMS_SROM_MCS5GHPO3, "mcs5ghpo3" },
{ BRCMS_SROM_MCS5GHPO4, "mcs5ghpo4" },
{ BRCMS_SROM_MCS5GHPO5, "mcs5ghpo5" },
{ BRCMS_SROM_MCS5GHPO6, "mcs5ghpo6" },
{ BRCMS_SROM_MCS5GHPO7, "mcs5ghpo7" },
{ BRCMS_SROM_MCS5GLPO0, "mcs5glpo0" },
{ BRCMS_SROM_MCS5GLPO1, "mcs5glpo1" },
{ BRCMS_SROM_MCS5GLPO2, "mcs5glpo2" },
{ BRCMS_SROM_MCS5GLPO3, "mcs5glpo3" },
{ BRCMS_SROM_MCS5GLPO4, "mcs5glpo4" },
{ BRCMS_SROM_MCS5GLPO5, "mcs5glpo5" },
{ BRCMS_SROM_MCS5GLPO6, "mcs5glpo6" },
{ BRCMS_SROM_MCS5GLPO7, "mcs5glpo7" },
{ BRCMS_SROM_MCS5GPO0, "mcs5gpo0" },
{ BRCMS_SROM_MCS5GPO1, "mcs5gpo1" },
{ BRCMS_SROM_MCS5GPO2, "mcs5gpo2" },
{ BRCMS_SROM_MCS5GPO3, "mcs5gpo3" },
{ BRCMS_SROM_MCS5GPO4, "mcs5gpo4" },
{ BRCMS_SROM_MCS5GPO5, "mcs5gpo5" },
{ BRCMS_SROM_MCS5GPO6, "mcs5gpo6" },
{ BRCMS_SROM_MCS5GPO7, "mcs5gpo7" },
{ BRCMS_SROM_MCSBW202GPO, "mcsbw202gpo" },
{ BRCMS_SROM_MCSBW205GHPO, "mcsbw205ghpo" },
{ BRCMS_SROM_MCSBW205GLPO, "mcsbw205glpo" },
{ BRCMS_SROM_MCSBW205GMPO, "mcsbw205gmpo" },
{ BRCMS_SROM_MCSBW20UL2GPO, "mcsbw20ul2gpo" },
{ BRCMS_SROM_MCSBW20UL5GHPO, "mcsbw20ul5ghpo" },
{ BRCMS_SROM_MCSBW20UL5GLPO, "mcsbw20ul5glpo" },
{ BRCMS_SROM_MCSBW20UL5GMPO, "mcsbw20ul5gmpo" },
{ BRCMS_SROM_MCSBW402GPO, "mcsbw402gpo" },
{ BRCMS_SROM_MCSBW405GHPO, "mcsbw405ghpo" },
{ BRCMS_SROM_MCSBW405GLPO, "mcsbw405glpo" },
{ BRCMS_SROM_MCSBW405GMPO, "mcsbw405gmpo" },
{ BRCMS_SROM_MEASPOWER, "measpower" },
{ BRCMS_SROM_OFDM2GPO, "ofdm2gpo" },
{ BRCMS_SROM_OFDM5GHPO, "ofdm5ghpo" },
{ BRCMS_SROM_OFDM5GLPO, "ofdm5glpo" },
{ BRCMS_SROM_OFDM5GPO, "ofdm5gpo" },
{ BRCMS_SROM_OPO, "opo" },
{ BRCMS_SROM_PA0B0, "pa0b0" },
{ BRCMS_SROM_PA0B1, "pa0b1" },
{ BRCMS_SROM_PA0B2, "pa0b2" },
{ BRCMS_SROM_PA0ITSSIT, "pa0itssit" },
{ BRCMS_SROM_PA0MAXPWR, "pa0maxpwr" },
{ BRCMS_SROM_PA1B0, "pa1b0" },
{ BRCMS_SROM_PA1B1, "pa1b1" },
{ BRCMS_SROM_PA1B2, "pa1b2" },
{ BRCMS_SROM_PA1HIB0, "pa1hib0" },
{ BRCMS_SROM_PA1HIB1, "pa1hib1" },
{ BRCMS_SROM_PA1HIB2, "pa1hib2" },
{ BRCMS_SROM_PA1HIMAXPWR, "pa1himaxpwr" },
{ BRCMS_SROM_PA1ITSSIT, "pa1itssit" },
{ BRCMS_SROM_PA1LOB0, "pa1lob0" },
{ BRCMS_SROM_PA1LOB1, "pa1lob1" },
{ BRCMS_SROM_PA1LOB2, "pa1lob2" },
{ BRCMS_SROM_PA1LOMAXPWR, "pa1lomaxpwr" },
{ BRCMS_SROM_PA1MAXPWR, "pa1maxpwr" },
{ BRCMS_SROM_PDETRANGE2G, "pdetrange2g" },
{ BRCMS_SROM_PDETRANGE5G, "pdetrange5g" },
{ BRCMS_SROM_PHYCAL_TEMPDELTA, "phycal_tempdelta" },
{ BRCMS_SROM_RAWTEMPSENSE, "rawtempsense" },
{ BRCMS_SROM_REV, "sromrev" },
{ BRCMS_SROM_REGREV, "regrev" },
{ BRCMS_SROM_RSSISAV2G, "rssisav2g" },
{ BRCMS_SROM_RSSISAV5G, "rssisav5g" },
{ BRCMS_SROM_RSSISMC2G, "rssismc2g" },
{ BRCMS_SROM_RSSISMC5G, "rssismc5g" },
{ BRCMS_SROM_RSSISMF2G, "rssismf2g" },
{ BRCMS_SROM_RSSISMF5G, "rssismf5g" },
{ BRCMS_SROM_RXCHAIN, "rxchain" },
{ BRCMS_SROM_RXPO2G, "rxpo2g" },
{ BRCMS_SROM_RXPO5G, "rxpo5g" },
{ BRCMS_SROM_STBCPO, "stbcpo" },
{ BRCMS_SROM_TEMPCORRX, "tempcorrx" },
{ BRCMS_SROM_TEMPOFFSET, "tempoffset" },
{ BRCMS_SROM_TEMPSENSE_OPTION, "tempsense_option" },
{ BRCMS_SROM_TEMPSENSE_SLOPE, "tempsense_slope" },
{ BRCMS_SROM_TEMPTHRESH, "tempthresh" },
{ BRCMS_SROM_TRI2G, "tri2g" },
{ BRCMS_SROM_TRI5GH, "tri5gh" },
{ BRCMS_SROM_TRI5GL, "tri5gl" },
{ BRCMS_SROM_TRI5G, "tri5g" },
{ BRCMS_SROM_TRISO2G, "triso2g" },
{ BRCMS_SROM_TRISO5G, "triso5g" },
{ BRCMS_SROM_TSSIPOS2G, "tssipos2g" },
{ BRCMS_SROM_TSSIPOS5G, "tssipos5g" },
{ BRCMS_SROM_TXCHAIN, "txchain" },
{ BRCMS_SROM_TXPID2GA0, "txpid2ga0" },
{ BRCMS_SROM_TXPID2GA1, "txpid2ga1" },
{ BRCMS_SROM_TXPID2GA2, "txpid2ga2" },
{ BRCMS_SROM_TXPID2GA3, "txpid2ga3" },
{ BRCMS_SROM_TXPID5GA0, "txpid5ga0" },
{ BRCMS_SROM_TXPID5GA1, "txpid5ga1" },
{ BRCMS_SROM_TXPID5GA2, "txpid5ga2" },
{ BRCMS_SROM_TXPID5GA3, "txpid5ga3" },
{ BRCMS_SROM_TXPID5GHA0, "txpid5gha0" },
{ BRCMS_SROM_TXPID5GHA1, "txpid5gha1" },
{ BRCMS_SROM_TXPID5GHA2, "txpid5gha2" },
{ BRCMS_SROM_TXPID5GHA3, "txpid5gha3" },
{ BRCMS_SROM_TXPID5GLA0, "txpid5gla0" },
{ BRCMS_SROM_TXPID5GLA1, "txpid5gla1" },
{ BRCMS_SROM_TXPID5GLA2, "txpid5gla2" },
{ BRCMS_SROM_TXPID5GLA3, "txpid5gla3" },
{ BRCMS_SROM_ITT2GA0, "itt2ga0" },
{ BRCMS_SROM_ITT2GA1, "itt2ga1" },
{ BRCMS_SROM_ITT2GA2, "itt2ga2" },
{ BRCMS_SROM_ITT2GA3, "itt2ga3" },
{ BRCMS_SROM_ITT5GA0, "itt5ga0" },
{ BRCMS_SROM_ITT5GA1, "itt5ga1" },
{ BRCMS_SROM_ITT5GA2, "itt5ga2" },
{ BRCMS_SROM_ITT5GA3, "itt5ga3" },
{ BRCMS_SROM_MAXP2GA0, "maxp2ga0" },
{ BRCMS_SROM_MAXP2GA1, "maxp2ga1" },
{ BRCMS_SROM_MAXP2GA2, "maxp2ga2" },
{ BRCMS_SROM_MAXP2GA3, "maxp2ga3" },
{ BRCMS_SROM_MAXP5GA0, "maxp5ga0" },
{ BRCMS_SROM_MAXP5GA1, "maxp5ga1" },
{ BRCMS_SROM_MAXP5GA2, "maxp5ga2" },
{ BRCMS_SROM_MAXP5GA3, "maxp5ga3" },
{ BRCMS_SROM_MAXP5GHA0, "maxp5gha0" },
{ BRCMS_SROM_MAXP5GHA1, "maxp5gha1" },
{ BRCMS_SROM_MAXP5GHA2, "maxp5gha2" },
{ BRCMS_SROM_MAXP5GHA3, "maxp5gha3" },
{ BRCMS_SROM_MAXP5GLA0, "maxp5gla0" },
{ BRCMS_SROM_MAXP5GLA1, "maxp5gla1" },
{ BRCMS_SROM_MAXP5GLA2, "maxp5gla2" },
{ BRCMS_SROM_MAXP5GLA3, "maxp5gla3" },
{ BRCMS_SROM_PA2GW0A0, "pa2gw0a0" },
{ BRCMS_SROM_PA2GW0A1, "pa2gw0a1" },
{ BRCMS_SROM_PA2GW0A2, "pa2gw0a2" },
{ BRCMS_SROM_PA2GW0A3, "pa2gw0a3" },
{ BRCMS_SROM_PA2GW1A0, "pa2gw1a0" },
{ BRCMS_SROM_PA2GW1A1, "pa2gw1a1" },
{ BRCMS_SROM_PA2GW1A2, "pa2gw1a2" },
{ BRCMS_SROM_PA2GW1A3, "pa2gw1a3" },
{ BRCMS_SROM_PA2GW2A0, "pa2gw2a0" },
{ BRCMS_SROM_PA2GW2A1, "pa2gw2a1" },
{ BRCMS_SROM_PA2GW2A2, "pa2gw2a2" },
{ BRCMS_SROM_PA2GW2A3, "pa2gw2a3" },
{ BRCMS_SROM_PA2GW3A0, "pa2gw3a0" },
{ BRCMS_SROM_PA2GW3A1, "pa2gw3a1" },
{ BRCMS_SROM_PA2GW3A2, "pa2gw3a2" },
{ BRCMS_SROM_PA2GW3A3, "pa2gw3a3" },
{ BRCMS_SROM_PA5GHW0A0, "pa5ghw0a0" },
{ BRCMS_SROM_PA5GHW0A1, "pa5ghw0a1" },
{ BRCMS_SROM_PA5GHW0A2, "pa5ghw0a2" },
{ BRCMS_SROM_PA5GHW0A3, "pa5ghw0a3" },
{ BRCMS_SROM_PA5GHW1A0, "pa5ghw1a0" },
{ BRCMS_SROM_PA5GHW1A1, "pa5ghw1a1" },
{ BRCMS_SROM_PA5GHW1A2, "pa5ghw1a2" },
{ BRCMS_SROM_PA5GHW1A3, "pa5ghw1a3" },
{ BRCMS_SROM_PA5GHW2A0, "pa5ghw2a0" },
{ BRCMS_SROM_PA5GHW2A1, "pa5ghw2a1" },
{ BRCMS_SROM_PA5GHW2A2, "pa5ghw2a2" },
{ BRCMS_SROM_PA5GHW2A3, "pa5ghw2a3" },
{ BRCMS_SROM_PA5GHW3A0, "pa5ghw3a0" },
{ BRCMS_SROM_PA5GHW3A1, "pa5ghw3a1" },
{ BRCMS_SROM_PA5GHW3A2, "pa5ghw3a2" },
{ BRCMS_SROM_PA5GHW3A3, "pa5ghw3a3" },
{ BRCMS_SROM_PA5GLW0A0, "pa5glw0a0" },
{ BRCMS_SROM_PA5GLW0A1, "pa5glw0a1" },
{ BRCMS_SROM_PA5GLW0A2, "pa5glw0a2" },
{ BRCMS_SROM_PA5GLW0A3, "pa5glw0a3" },
{ BRCMS_SROM_PA5GLW1A0, "pa5glw1a0" },
{ BRCMS_SROM_PA5GLW1A1, "pa5glw1a1" },
{ BRCMS_SROM_PA5GLW1A2, "pa5glw1a2" },
{ BRCMS_SROM_PA5GLW1A3, "pa5glw1a3" },
{ BRCMS_SROM_PA5GLW2A0, "pa5glw2a0" },
{ BRCMS_SROM_PA5GLW2A1, "pa5glw2a1" },
{ BRCMS_SROM_PA5GLW2A2, "pa5glw2a2" },
{ BRCMS_SROM_PA5GLW2A3, "pa5glw2a3" },
{ BRCMS_SROM_PA5GLW3A0, "pa5glw3a0" },
{ BRCMS_SROM_PA5GLW3A1, "pa5glw3a1" },
{ BRCMS_SROM_PA5GLW3A2, "pa5glw3a2" },
{ BRCMS_SROM_PA5GLW3A3, "pa5glw3a3" },
{ BRCMS_SROM_PA5GW0A0, "pa5gw0a0" },
{ BRCMS_SROM_PA5GW0A1, "pa5gw0a1" },
{ BRCMS_SROM_PA5GW0A2, "pa5gw0a2" },
{ BRCMS_SROM_PA5GW0A3, "pa5gw0a3" },
{ BRCMS_SROM_PA5GW1A0, "pa5gw1a0" },
{ BRCMS_SROM_PA5GW1A1, "pa5gw1a1" },
{ BRCMS_SROM_PA5GW1A2, "pa5gw1a2" },
{ BRCMS_SROM_PA5GW1A3, "pa5gw1a3" },
{ BRCMS_SROM_PA5GW2A0, "pa5gw2a0" },
{ BRCMS_SROM_PA5GW2A1, "pa5gw2a1" },
{ BRCMS_SROM_PA5GW2A2, "pa5gw2a2" },
{ BRCMS_SROM_PA5GW2A3, "pa5gw2a3" },
{ BRCMS_SROM_PA5GW3A0, "pa5gw3a0" },
{ BRCMS_SROM_PA5GW3A1, "pa5gw3a1" },
{ BRCMS_SROM_PA5GW3A2, "pa5gw3a2" },
{ BRCMS_SROM_PA5GW3A3, "pa5gw3a3" },
};
static const char *get_varname(enum brcms_srom_id id)
{
const struct srom_id_name *entry;
int i;
entry = &srom_id_map[0];
for (i = 0; i < ARRAY_SIZE(srom_id_map); i++) {
if (entry->id == id)
return entry->name;
entry++;
}
return NULL;
}
/* crc table has the same contents for every device instance, so it can be
* shared between devices. */
static u8 brcms_srom_crc8_table[CRC8_TABLE_SIZE];
......@@ -1162,70 +920,14 @@ static inline void htol16_buf(u16 *buf, unsigned int size)
*(__le16 *)(buf + size) = cpu_to_le16(*(buf + size));
}
/* Initialization of varbuf structure */
static void varbuf_init(struct brcms_varbuf *b, char *buf, uint size)
{
b->size = size;
b->base = b->buf = buf;
}
/* append a null terminated var=value string */
static int varbuf_append(struct brcms_varbuf *b, const char *fmt, ...)
{
va_list ap;
int r;
size_t len;
char *s;
if (b->size < 2)
return 0;
va_start(ap, fmt);
r = vsnprintf(b->buf, b->size, fmt, ap);
va_end(ap);
/*
* C99 snprintf behavior returns r >= size on overflow,
* others return -1 on overflow. All return -1 on format error.
* We need to leave room for 2 null terminations, one for the current
* var string, and one for final null of the var table. So check that
* the strlen written, r, leaves room for 2 chars.
*/
if ((r == -1) || (r > (int)(b->size - 2))) {
b->size = 0;
return 0;
}
/* Remove any earlier occurrence of the same variable */
s = strchr(b->buf, '=');
if (s != NULL) {
len = (size_t) (s - b->buf);
for (s = b->base; s < b->buf;) {
if ((memcmp(s, b->buf, len) == 0) && s[len] == '=') {
len = strlen(s) + 1;
memmove(s, (s + len),
((b->buf + r + 1) - (s + len)));
b->buf -= len;
b->size += (unsigned int)len;
break;
}
while (*s++)
;
}
}
/* skip over this string's null termination */
r++;
b->size -= r;
b->buf += r;
return r;
}
/*
* convert binary srom data into linked list of srom variable items.
*/
static void
_initvars_srom_pci(u8 sromrev, u16 *srom, uint off, struct brcms_varbuf *b)
_initvars_srom_pci(u8 sromrev, u16 *srom, uint off, struct list_head *var_list)
{
struct brcms_srom_list_head *entry;
enum brcms_srom_id id;
u16 w;
u32 val;
const struct brcms_sromvar *srv;
......@@ -1233,10 +935,17 @@ _initvars_srom_pci(u8 sromrev, u16 *srom, uint off, struct brcms_varbuf *b)
uint flags;
u32 sr = (1 << sromrev);
varbuf_append(b, "sromrev=%d", sromrev);
/* first store the srom revision */
entry = kzalloc(sizeof(struct brcms_srom_list_head), GFP_KERNEL);
entry->varid = BRCMS_SROM_REV;
entry->var_type = BRCMS_SROM_UNUMBER;
entry->uval = sromrev;
list_add(&entry->var_list, var_list);
for (srv = pci_sromvars; srv->varid != BRCMS_SROM_NULL; srv++) {
const char *name;
enum brcms_srom_var_type type;
u8 ea[ETH_ALEN];
u8 extra_space = 0;
if ((srv->revmask & sr) == 0)
continue;
......@@ -1245,23 +954,25 @@ _initvars_srom_pci(u8 sromrev, u16 *srom, uint off, struct brcms_varbuf *b)
continue;
flags = srv->flags;
name = get_varname(srv->varid);
id = srv->varid;
/* This entry is for mfgc only. Don't generate param for it, */
if (flags & SRFL_NOVAR)
continue;
if (flags & SRFL_ETHADDR) {
u8 ea[ETH_ALEN];
/*
* stored in string format XX:XX:XX:XX:XX:XX (17 chars)
*/
ea[0] = (srom[srv->off - off] >> 8) & 0xff;
ea[1] = srom[srv->off - off] & 0xff;
ea[2] = (srom[srv->off + 1 - off] >> 8) & 0xff;
ea[3] = srom[srv->off + 1 - off] & 0xff;
ea[4] = (srom[srv->off + 2 - off] >> 8) & 0xff;
ea[5] = srom[srv->off + 2 - off] & 0xff;
varbuf_append(b, "%s=%pM", name, ea);
/* 17 characters + string terminator - union size */
extra_space = 18 - sizeof(s32);
type = BRCMS_SROM_STRING;
} else {
w = srom[srv->off - off];
val = (w & srv->mask) >> mask_shift(srv->mask);
......@@ -1285,30 +996,42 @@ _initvars_srom_pci(u8 sromrev, u16 *srom, uint off, struct brcms_varbuf *b)
continue;
if (flags & SRFL_CCODE) {
if (val == 0)
varbuf_append(b, "ccode=");
else
varbuf_append(b, "ccode=%c%c",
(val >> 8), (val & 0xff));
}
/* LED Powersave duty cycle has to be scaled:
*(oncount >> 24) (offcount >> 8)
*/
else if (flags & SRFL_LEDDC) {
type = BRCMS_SROM_STRING;
} else if (flags & SRFL_LEDDC) {
/* LED Powersave duty cycle has to be scaled:
*(oncount >> 24) (offcount >> 8)
*/
u32 w32 = /* oncount */
(((val >> 8) & 0xff) << 24) |
/* offcount */
(((val & 0xff)) << 8);
varbuf_append(b, "leddc=%d", w32);
} else if (flags & SRFL_PRHEX)
varbuf_append(b, "%s=0x%x", name, val);
else if ((flags & SRFL_PRSIGN)
&& (val & (1 << (width - 1))))
varbuf_append(b, "%s=%d", name,
(int)(val | (~0 << width)));
type = BRCMS_SROM_UNUMBER;
val = w32;
} else if ((flags & SRFL_PRSIGN)
&& (val & (1 << (width - 1)))) {
type = BRCMS_SROM_SNUMBER;
val |= ~0 << width;
} else
type = BRCMS_SROM_UNUMBER;
}
entry = kzalloc(sizeof(struct brcms_srom_list_head) +
extra_space, GFP_KERNEL);
entry->varid = id;
entry->var_type = type;
if (flags & SRFL_ETHADDR) {
snprintf(entry->buf, 18, "%pM", ea);
} else if (flags & SRFL_CCODE) {
if (val == 0)
entry->buf[0] = '\0';
else
varbuf_append(b, "%s=%u", name, val);
snprintf(entry->buf, 3, "%c%c",
(val >> 8), (val & 0xff));
} else {
entry->uval = val;
}
list_add(&entry->var_list, var_list);
}
if (sromrev >= 4) {
......@@ -1345,14 +1068,13 @@ _initvars_srom_pci(u8 sromrev, u16 *srom, uint off, struct brcms_varbuf *b)
&& ((int)val == (1 << width) - 1))
continue;
if (srv->flags & SRFL_PRHEX)
varbuf_append(b, "%s%d=0x%x",
get_varname(srv->varid),
p, val);
else
varbuf_append(b, "%s%d=%d",
get_varname(srv->varid),
p, val);
entry =
kzalloc(sizeof(struct brcms_srom_list_head),
GFP_KERNEL);
entry->varid = srv->varid+p;
entry->var_type = BRCMS_SROM_UNUMBER;
entry->uval = val;
list_add(&entry->var_list, var_list);
}
pb += psz;
}
......@@ -1434,31 +1156,6 @@ static int otp_read_pci(struct si_pub *sih, u16 *buf, uint bufsz)
return err;
}
/*
* Create variable table from memory.
* Return 0 on success, nonzero on error.
*/
static int initvars_table(char *start, char *end,
char **vars, uint *count)
{
int c = (int)(end - start);
/* do it only when there is more than just the null string */
if (c > 1) {
char *vp = kmalloc(c, GFP_ATOMIC);
if (!vp)
return -ENOMEM;
memcpy(vp, start, c);
*vars = vp;
*count = c;
} else {
*vars = NULL;
*count = 0;
}
return 0;
}
/*
* Initialize nonvolatile variable table from sprom.
* Return 0 on success, nonzero on error.
......@@ -1470,8 +1167,6 @@ static int initvars_srom_pci(struct si_pub *sih, void __iomem *curmap,
u16 __iomem *sromwindow;
u8 sromrev = 0;
u32 sr;
struct brcms_varbuf b;
char *vp, *base = NULL;
int err = 0;
/*
......@@ -1514,6 +1209,8 @@ static int initvars_srom_pci(struct si_pub *sih, void __iomem *curmap,
}
if (!err) {
struct si_info *sii = (struct si_info *)sih;
/* Bitmask for the sromrev */
sr = 1 << sromrev;
......@@ -1526,23 +1223,10 @@ static int initvars_srom_pci(struct si_pub *sih, void __iomem *curmap,
goto errout;
}
base = kmalloc(MAXSZ_NVRAM_VARS, GFP_ATOMIC);
if (!base) {
err = -ENOMEM;
goto errout;
}
varbuf_init(&b, base, MAXSZ_NVRAM_VARS);
INIT_LIST_HEAD(&sii->var_list);
/* parse SROM into name=value pairs. */
_initvars_srom_pci(sromrev, srom, 0, &b);
/* final nullbyte terminator */
vp = b.buf;
*vp++ = '\0';
err = initvars_table(base, vp, vars, count);
kfree(base);
_initvars_srom_pci(sromrev, srom, 0, &sii->var_list);
}
errout:
......@@ -1550,6 +1234,17 @@ static int initvars_srom_pci(struct si_pub *sih, void __iomem *curmap,
return err;
}
void srom_free_vars(struct si_pub *sih)
{
struct si_info *sii;
struct brcms_srom_list_head *entry, *next;
sii = (struct si_info *)sih;
list_for_each_entry_safe(entry, next, &sii->var_list, var_list) {
list_del(&entry->var_list);
kfree(entry);
}
}
/*
* Initialize local vars from the right source for this platform.
* Return 0 on success, nonzero on error.
......@@ -1579,44 +1274,39 @@ int srom_var_init(struct si_pub *sih, void __iomem *curmap, char **vars,
*/
char *getvar(struct si_pub *sih, enum brcms_srom_id id)
{
const char *name = get_varname(id);
char *s;
int len;
struct si_info *sii;
if (!name)
return NULL;
len = strlen(name);
if (len == 0)
return NULL;
struct brcms_srom_list_head *entry;
sii = (struct si_info *)sih;
/* first look in vars[] */
for (s = sii->vars; s && *s;) {
if ((memcmp(s, name, len) == 0) && (s[len] == '='))
return &s[len + 1];
list_for_each_entry(entry, &sii->var_list, var_list)
if (entry->varid == id)
return &entry->buf[0];
while (*s++)
;
}
/* nothing found */
return NULL;
}
/*
* Search the vars for a specific one and return its value as
* an integer. Returns 0 if not found.
* an integer. Returns 0 if not found.-
*/
int getintvar(struct si_pub *sih, enum brcms_srom_id id)
{
char *val;
struct si_info *sii;
struct brcms_srom_list_head *entry;
unsigned long res;
val = getvar(sih, id);
if (val && !kstrtoul(val, 0, &res))
return res;
sii = (struct si_info *)sih;
list_for_each_entry(entry, &sii->var_list, var_list)
if (entry->varid == id) {
if (entry->var_type == BRCMS_SROM_SNUMBER ||
entry->var_type == BRCMS_SROM_UNUMBER)
return (int)entry->sval;
else if (!kstrtoul(&entry->buf[0], 0, &res))
return (int)res;
}
return 0;
}
drivers/staging/brcm80211/brcmsmac/srom.h
View file @ 2a9b065c
......@@ -22,6 +22,7 @@
/* Prototypes */
extern int srom_var_init(struct si_pub *sih, void __iomem *curmap, char **vars,
uint *count);
extern void srom_free_vars(struct si_pub *sih);
extern int srom_read(struct si_pub *sih, uint bus, void *curmap,
uint byteoff, uint nbytes, u16 *buf, bool check_crc);
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7