sdio: pass whitelisted cis funce tuples to sdio drivers

Some manufacturers provide vendor information in non-vendor specific CIS
tuples.  For example, Broadcom uses an Extended Function tuple to provide
the MAC address on some of their network cards, as in the case of the
Nintendo Wii WLAN daughter card.

This patch allows passing whitelisted FUNCE tuples unknown to the SDIO
core to a matching SDIO driver instead of rejecting them and failing.

Signed-off-by: Albert Herranz <albert_herranz@yahoo.es>
Cc: <linux-mmc@vger.kernel.org>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
This commit is contained in:
Albert Herranz 2009-10-01 15:44:05 -07:00 committed by Linus Torvalds
parent bf89c8c867
commit ed9935f4f9
1 changed files with 51 additions and 18 deletions

View File

@ -98,6 +98,22 @@ static const unsigned char speed_val[16] =
static const unsigned int speed_unit[8] =
{ 10000, 100000, 1000000, 10000000, 0, 0, 0, 0 };
/* FUNCE tuples with these types get passed to SDIO drivers */
static const unsigned char funce_type_whitelist[] = {
4 /* CISTPL_FUNCE_LAN_NODE_ID used in Broadcom cards */
};
static int cistpl_funce_whitelisted(unsigned char type)
{
int i;
for (i = 0; i < ARRAY_SIZE(funce_type_whitelist); i++) {
if (funce_type_whitelist[i] == type)
return 1;
}
return 0;
}
static int cistpl_funce_common(struct mmc_card *card,
const unsigned char *buf, unsigned size)
{
@ -120,6 +136,10 @@ static int cistpl_funce_func(struct sdio_func *func,
unsigned vsn;
unsigned min_size;
/* let SDIO drivers take care of whitelisted FUNCE tuples */
if (cistpl_funce_whitelisted(buf[0]))
return -EILSEQ;
vsn = func->card->cccr.sdio_vsn;
min_size = (vsn == SDIO_SDIO_REV_1_00) ? 28 : 42;
@ -154,13 +174,12 @@ static int cistpl_funce(struct mmc_card *card, struct sdio_func *func,
else
ret = cistpl_funce_common(card, buf, size);
if (ret) {
if (ret && ret != -EILSEQ) {
printk(KERN_ERR "%s: bad CISTPL_FUNCE size %u "
"type %u\n", mmc_hostname(card->host), size, buf[0]);
return ret;
}
return 0;
return ret;
}
typedef int (tpl_parse_t)(struct mmc_card *, struct sdio_func *,
@ -253,8 +272,33 @@ static int sdio_read_cis(struct mmc_card *card, struct sdio_func *func)
for (i = 0; i < ARRAY_SIZE(cis_tpl_list); i++)
if (cis_tpl_list[i].code == tpl_code)
break;
if (i >= ARRAY_SIZE(cis_tpl_list)) {
/* this tuple is unknown to the core */
if (i < ARRAY_SIZE(cis_tpl_list)) {
const struct cis_tpl *tpl = cis_tpl_list + i;
if (tpl_link < tpl->min_size) {
printk(KERN_ERR
"%s: bad CIS tuple 0x%02x"
" (length = %u, expected >= %u)\n",
mmc_hostname(card->host),
tpl_code, tpl_link, tpl->min_size);
ret = -EINVAL;
} else if (tpl->parse) {
ret = tpl->parse(card, func,
this->data, tpl_link);
}
/*
* We don't need the tuple anymore if it was
* successfully parsed by the SDIO core or if it is
* not going to be parsed by SDIO drivers.
*/
if (!ret || ret != -EILSEQ)
kfree(this);
} else {
/* unknown tuple */
ret = -EILSEQ;
}
if (ret == -EILSEQ) {
/* this tuple is unknown to the core or whitelisted */
this->next = NULL;
this->code = tpl_code;
this->size = tpl_link;
@ -263,19 +307,8 @@ static int sdio_read_cis(struct mmc_card *card, struct sdio_func *func)
printk(KERN_DEBUG
"%s: queuing CIS tuple 0x%02x length %u\n",
mmc_hostname(card->host), tpl_code, tpl_link);
} else {
const struct cis_tpl *tpl = cis_tpl_list + i;
if (tpl_link < tpl->min_size) {
printk(KERN_ERR
"%s: bad CIS tuple 0x%02x (length = %u, expected >= %u)\n",
mmc_hostname(card->host),
tpl_code, tpl_link, tpl->min_size);
ret = -EINVAL;
} else if (tpl->parse) {
ret = tpl->parse(card, func,
this->data, tpl_link);
}
kfree(this);
/* keep on analyzing tuples */
ret = 0;
}
ptr += tpl_link;