Commit ed9935f4 authored by Albert Herranz's avatar Albert Herranz Committed by Linus Torvalds

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: default avatarAlbert Herranz <albert_herranz@yahoo.es>
Cc: <linux-mmc@vger.kernel.org>
Signed-off-by: default avatarAndrew Morton <akpm@linux-foundation.org>
Signed-off-by: default avatarLinus Torvalds <torvalds@linux-foundation.org>
parent bf89c8c8
...@@ -98,6 +98,22 @@ static const unsigned char speed_val[16] = ...@@ -98,6 +98,22 @@ static const unsigned char speed_val[16] =
static const unsigned int speed_unit[8] = static const unsigned int speed_unit[8] =
{ 10000, 100000, 1000000, 10000000, 0, 0, 0, 0 }; { 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, static int cistpl_funce_common(struct mmc_card *card,
const unsigned char *buf, unsigned size) const unsigned char *buf, unsigned size)
{ {
...@@ -120,6 +136,10 @@ static int cistpl_funce_func(struct sdio_func *func, ...@@ -120,6 +136,10 @@ static int cistpl_funce_func(struct sdio_func *func,
unsigned vsn; unsigned vsn;
unsigned min_size; 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; vsn = func->card->cccr.sdio_vsn;
min_size = (vsn == SDIO_SDIO_REV_1_00) ? 28 : 42; 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, ...@@ -154,13 +174,12 @@ static int cistpl_funce(struct mmc_card *card, struct sdio_func *func,
else else
ret = cistpl_funce_common(card, buf, size); ret = cistpl_funce_common(card, buf, size);
if (ret) { if (ret && ret != -EILSEQ) {
printk(KERN_ERR "%s: bad CISTPL_FUNCE size %u " printk(KERN_ERR "%s: bad CISTPL_FUNCE size %u "
"type %u\n", mmc_hostname(card->host), size, buf[0]); "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 *, typedef int (tpl_parse_t)(struct mmc_card *, struct sdio_func *,
...@@ -253,21 +272,12 @@ static int sdio_read_cis(struct mmc_card *card, struct sdio_func *func) ...@@ -253,21 +272,12 @@ static int sdio_read_cis(struct mmc_card *card, struct sdio_func *func)
for (i = 0; i < ARRAY_SIZE(cis_tpl_list); i++) for (i = 0; i < ARRAY_SIZE(cis_tpl_list); i++)
if (cis_tpl_list[i].code == tpl_code) if (cis_tpl_list[i].code == tpl_code)
break; break;
if (i >= ARRAY_SIZE(cis_tpl_list)) { if (i < ARRAY_SIZE(cis_tpl_list)) {
/* this tuple is unknown to the core */
this->next = NULL;
this->code = tpl_code;
this->size = tpl_link;
*prev = this;
prev = &this->next;
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; const struct cis_tpl *tpl = cis_tpl_list + i;
if (tpl_link < tpl->min_size) { if (tpl_link < tpl->min_size) {
printk(KERN_ERR printk(KERN_ERR
"%s: bad CIS tuple 0x%02x (length = %u, expected >= %u)\n", "%s: bad CIS tuple 0x%02x"
" (length = %u, expected >= %u)\n",
mmc_hostname(card->host), mmc_hostname(card->host),
tpl_code, tpl_link, tpl->min_size); tpl_code, tpl_link, tpl->min_size);
ret = -EINVAL; ret = -EINVAL;
...@@ -275,7 +285,30 @@ static int sdio_read_cis(struct mmc_card *card, struct sdio_func *func) ...@@ -275,7 +285,30 @@ static int sdio_read_cis(struct mmc_card *card, struct sdio_func *func)
ret = tpl->parse(card, func, ret = tpl->parse(card, func,
this->data, tpl_link); 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); 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;
*prev = this;
prev = &this->next;
printk(KERN_DEBUG
"%s: queuing CIS tuple 0x%02x length %u\n",
mmc_hostname(card->host), tpl_code, tpl_link);
/* keep on analyzing tuples */
ret = 0;
} }
ptr += tpl_link; ptr += tpl_link;
......
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