提交 53a51ebf 编写于 作者: L luohui2320@gmail.com

update SDIO driver, fix some bugs

git-svn-id: https://rt-thread.googlecode.com/svn/trunk@1988 bbd45198-f89e-11dd-88c7-29a3b14d5316
上级 b613ecdb
...@@ -129,10 +129,7 @@ struct rt_mmcsd_card { ...@@ -129,10 +129,7 @@ struct rt_mmcsd_card {
rt_uint8_t sdio_function_num; /* totol number of SDIO functions */ rt_uint8_t sdio_function_num; /* totol number of SDIO functions */
struct rt_sdio_cccr cccr; /* common card info */ struct rt_sdio_cccr cccr; /* common card info */
struct rt_sdio_cis cis; /* common tuple info */ struct rt_sdio_cis cis; /* common tuple info */
struct rt_sdio_function *sdio_func0; struct rt_sdio_function *sdio_function[SDIO_MAX_FUNCTIONS + 1]; /* SDIO functions (devices) */
struct rt_sdio_function *sdio_function[SDIO_MAX_FUNCTIONS]; /* SDIO functions (devices) */
//struct rt_sdio_function_tuple *tuples; /* tuples */
}; };
......
...@@ -374,7 +374,7 @@ static rt_int32_t sdio_read_cccr(struct rt_mmcsd_card *card) ...@@ -374,7 +374,7 @@ static rt_int32_t sdio_read_cccr(struct rt_mmcsd_card *card)
rt_memset(&card->cccr, 0, sizeof(struct rt_sdio_cccr)); rt_memset(&card->cccr, 0, sizeof(struct rt_sdio_cccr));
data = sdio_io_readb(card->sdio_func0, SDIO_REG_CCCR_CCCR_REV, &ret); data = sdio_io_readb(card->sdio_function[0], SDIO_REG_CCCR_CCCR_REV, &ret);
if (ret) if (ret)
goto out; goto out;
...@@ -388,7 +388,7 @@ static rt_int32_t sdio_read_cccr(struct rt_mmcsd_card *card) ...@@ -388,7 +388,7 @@ static rt_int32_t sdio_read_cccr(struct rt_mmcsd_card *card)
card->cccr.sdio_version = (data & 0xf0) >> 4; card->cccr.sdio_version = (data & 0xf0) >> 4;
data = sdio_io_readb(card->sdio_func0, SDIO_REG_CCCR_CARD_CAPS, &ret); data = sdio_io_readb(card->sdio_function[0], SDIO_REG_CCCR_CARD_CAPS, &ret);
if (ret) if (ret)
goto out; goto out;
...@@ -403,7 +403,7 @@ static rt_int32_t sdio_read_cccr(struct rt_mmcsd_card *card) ...@@ -403,7 +403,7 @@ static rt_int32_t sdio_read_cccr(struct rt_mmcsd_card *card)
if (cccr_version >= SDIO_CCCR_REV_1_10) if (cccr_version >= SDIO_CCCR_REV_1_10)
{ {
data = sdio_io_readb(card->sdio_func0, SDIO_REG_CCCR_POWER_CTRL, &ret); data = sdio_io_readb(card->sdio_function[0], SDIO_REG_CCCR_POWER_CTRL, &ret);
if (ret) if (ret)
goto out; goto out;
...@@ -413,7 +413,7 @@ static rt_int32_t sdio_read_cccr(struct rt_mmcsd_card *card) ...@@ -413,7 +413,7 @@ static rt_int32_t sdio_read_cccr(struct rt_mmcsd_card *card)
if (cccr_version >= SDIO_CCCR_REV_1_20) if (cccr_version >= SDIO_CCCR_REV_1_20)
{ {
data = sdio_io_readb(card->sdio_func0, SDIO_REG_CCCR_SPEED, &ret); data = sdio_io_readb(card->sdio_function[0], SDIO_REG_CCCR_SPEED, &ret);
if (ret) if (ret)
goto out; goto out;
...@@ -474,7 +474,7 @@ static rt_int32_t sdio_read_cis(struct rt_sdio_function *func) ...@@ -474,7 +474,7 @@ static rt_int32_t sdio_read_cis(struct rt_sdio_function *func)
rt_uint8_t tpl_code, tpl_link; rt_uint8_t tpl_code, tpl_link;
struct rt_mmcsd_card *card = func->card; struct rt_mmcsd_card *card = func->card;
struct rt_sdio_function *func0 = card->sdio_func0; struct rt_sdio_function *func0 = card->sdio_function[0];
RT_ASSERT(func0 != RT_NULL); RT_ASSERT(func0 != RT_NULL);
...@@ -532,16 +532,16 @@ static rt_int32_t sdio_read_cis(struct rt_sdio_function *func) ...@@ -532,16 +532,16 @@ static rt_int32_t sdio_read_cis(struct rt_sdio_function *func)
if (func->num != 0) if (func->num != 0)
{ {
func->manufacturer = curr->data[0]; func->manufacturer = curr->data[0];
func->manufacturer = curr->data[1] << 8; func->manufacturer |= curr->data[1] << 8;
func->product = curr->data[2]; func->product = curr->data[2];
func->product = curr->data[3] << 8; func->product |= curr->data[3] << 8;
} }
else else
{ {
card->cis.manufacturer = curr->data[0]; card->cis.manufacturer = curr->data[0];
card->cis.manufacturer = curr->data[1] << 8; card->cis.manufacturer |= curr->data[1] << 8;
card->cis.product = curr->data[2]; card->cis.product = curr->data[2];
card->cis.product = curr->data[3] << 8; card->cis.product |= curr->data[3] << 8;
} }
break; break;
case CISTPL_FUNCE: case CISTPL_FUNCE:
...@@ -596,7 +596,7 @@ void sdio_free_cis(struct rt_sdio_function *func) ...@@ -596,7 +596,7 @@ void sdio_free_cis(struct rt_sdio_function *func)
tuple = func->tuples; tuple = func->tuples;
while (tuple && ((tuple != card->sdio_func0->tuples) || (!func->num))) while (tuple && ((tuple != card->sdio_function[0]->tuples) || (!func->num)))
{ {
tmp = tuple; tmp = tuple;
tuple = tuple->next; tuple = tuple->next;
...@@ -612,8 +612,9 @@ static rt_int32_t sdio_read_fbr(struct rt_sdio_function *func) ...@@ -612,8 +612,9 @@ static rt_int32_t sdio_read_fbr(struct rt_sdio_function *func)
{ {
rt_int32_t ret; rt_int32_t ret;
rt_uint8_t data; rt_uint8_t data;
struct rt_sdio_function *func0 = func->card->sdio_function[0];
data = sdio_io_readb(func->card->sdio_func0, data = sdio_io_readb(func0,
SDIO_REG_FBR_BASE(func->num) + SDIO_REG_FBR_STD_FUNC_IF, &ret); SDIO_REG_FBR_BASE(func->num) + SDIO_REG_FBR_STD_FUNC_IF, &ret);
if (ret) if (ret)
goto err; goto err;
...@@ -622,7 +623,7 @@ static rt_int32_t sdio_read_fbr(struct rt_sdio_function *func) ...@@ -622,7 +623,7 @@ static rt_int32_t sdio_read_fbr(struct rt_sdio_function *func)
if (data == 0x0f) if (data == 0x0f)
{ {
data = sdio_io_readb(func->card->sdio_func0, data = sdio_io_readb(func0,
SDIO_REG_FBR_BASE(func->num) + SDIO_REG_FBR_STD_IF_EXT, &ret); SDIO_REG_FBR_BASE(func->num) + SDIO_REG_FBR_STD_IF_EXT, &ret);
if (ret) if (ret)
goto err; goto err;
...@@ -662,14 +663,14 @@ static rt_int32_t sdio_initialize_function(struct rt_mmcsd_card *card, rt_uint32 ...@@ -662,14 +663,14 @@ static rt_int32_t sdio_initialize_function(struct rt_mmcsd_card *card, rt_uint32
if (ret) if (ret)
goto err1; goto err1;
card->sdio_function[func_num - 1] = func; card->sdio_function[func_num] = func;
return 0; return 0;
err1: err1:
sdio_free_cis(func); sdio_free_cis(func);
rt_free(func); rt_free(func);
card->sdio_function[func_num - 1] = RT_NULL; card->sdio_function[func_num] = RT_NULL;
err: err:
return ret; return ret;
} }
...@@ -686,13 +687,13 @@ static rt_int32_t sdio_set_highspeed(struct rt_mmcsd_card *card) ...@@ -686,13 +687,13 @@ static rt_int32_t sdio_set_highspeed(struct rt_mmcsd_card *card)
if (!card->cccr.high_speed) if (!card->cccr.high_speed)
return 0; return 0;
speed = sdio_io_readb(card->sdio_func0, SDIO_REG_CCCR_SPEED, &ret); speed = sdio_io_readb(card->sdio_function[0], SDIO_REG_CCCR_SPEED, &ret);
if (ret) if (ret)
return ret; return ret;
speed |= SDIO_SPEED_EHS; speed |= SDIO_SPEED_EHS;
ret = sdio_io_writeb(card->sdio_func0, SDIO_REG_CCCR_SPEED, speed); ret = sdio_io_writeb(card->sdio_function[0], SDIO_REG_CCCR_SPEED, speed);
if (ret) if (ret)
return ret; return ret;
...@@ -712,13 +713,13 @@ static rt_int32_t sdio_set_bus_wide(struct rt_mmcsd_card *card) ...@@ -712,13 +713,13 @@ static rt_int32_t sdio_set_bus_wide(struct rt_mmcsd_card *card)
if (card->cccr.low_speed && !card->cccr.bus_width) if (card->cccr.low_speed && !card->cccr.bus_width)
return 0; return 0;
busif = sdio_io_readb(card->sdio_func0, SDIO_REG_CCCR_BUS_IF, &ret); busif = sdio_io_readb(card->sdio_function[0], SDIO_REG_CCCR_BUS_IF, &ret);
if (ret) if (ret)
return ret; return ret;
busif |= SDIO_BUS_WIDTH_4BIT; busif |= SDIO_BUS_WIDTH_4BIT;
ret = sdio_io_writeb(card->sdio_func0, SDIO_REG_CCCR_BUS_IF, busif); ret = sdio_io_writeb(card->sdio_function[0], SDIO_REG_CCCR_BUS_IF, busif);
if (ret) if (ret)
return ret; return ret;
...@@ -795,16 +796,16 @@ static rt_int32_t sdio_init_card(struct rt_mmcsd_host *host, rt_uint32_t ocr) ...@@ -795,16 +796,16 @@ static rt_int32_t sdio_init_card(struct rt_mmcsd_host *host, rt_uint32_t ocr)
card->host = host; card->host = host;
host->card = card; host->card = card;
card->sdio_func0 = rt_malloc(sizeof(struct rt_sdio_function)); card->sdio_function[0] = rt_malloc(sizeof(struct rt_sdio_function));
if (!card->sdio_func0) if (!card->sdio_function[0])
{ {
rt_kprintf("malloc sdio_func0 failed\n"); rt_kprintf("malloc sdio_func0 failed\n");
err = -RT_ENOMEM; err = -RT_ENOMEM;
goto err1; goto err1;
} }
rt_memset(card->sdio_func0, 0, sizeof(struct rt_sdio_function)); rt_memset(card->sdio_function[0], 0, sizeof(struct rt_sdio_function));
card->sdio_func0->card = card; card->sdio_function[0]->card = card;
card->sdio_func0->num = 0; card->sdio_function[0]->num = 0;
if (!controller_is_spi(host)) if (!controller_is_spi(host))
{ {
...@@ -826,7 +827,7 @@ static rt_int32_t sdio_init_card(struct rt_mmcsd_host *host, rt_uint32_t ocr) ...@@ -826,7 +827,7 @@ static rt_int32_t sdio_init_card(struct rt_mmcsd_host *host, rt_uint32_t ocr)
if (err) if (err)
goto err2; goto err2;
err = sdio_read_cis(card->sdio_func0); err = sdio_read_cis(card->sdio_function[0]);
if (err) if (err)
goto err2; goto err2;
...@@ -847,9 +848,9 @@ static rt_int32_t sdio_init_card(struct rt_mmcsd_host *host, rt_uint32_t ocr) ...@@ -847,9 +848,9 @@ static rt_int32_t sdio_init_card(struct rt_mmcsd_host *host, rt_uint32_t ocr)
if (err) if (err)
goto err2; goto err2;
for (i = 0; i < function_num; i++) for (i = 1; i < function_num + 1; i++)
{ {
err = sdio_initialize_function(card, i + 1); err = sdio_initialize_function(card, i);
if (err) if (err)
goto err3; goto err3;
} }
...@@ -867,7 +868,7 @@ static rt_int32_t sdio_init_card(struct rt_mmcsd_host *host, rt_uint32_t ocr) ...@@ -867,7 +868,7 @@ static rt_int32_t sdio_init_card(struct rt_mmcsd_host *host, rt_uint32_t ocr)
err3: err3:
if (host->card) if (host->card)
{ {
for (i = 0; i < host->card->sdio_function_num; i++) for (i = 1; i < host->card->sdio_function_num + 1; i++)
{ {
if (host->card->sdio_function[i]) if (host->card->sdio_function[i])
{ {
...@@ -881,11 +882,11 @@ err3: ...@@ -881,11 +882,11 @@ err3:
} }
} }
err2: err2:
if (host->card && host->card->sdio_func0) if (host->card && host->card->sdio_function[0])
{ {
sdio_free_cis(host->card->sdio_func0); sdio_free_cis(host->card->sdio_function[0]);
rt_free(host->card->sdio_func0); rt_free(host->card->sdio_function[0]);
host->card->sdio_func0 = RT_NULL; host->card->sdio_function[0] = RT_NULL;
} }
err1: err1:
if (host->card) if (host->card)
...@@ -962,7 +963,7 @@ static void sdio_irq_thread(void *param) ...@@ -962,7 +963,7 @@ static void sdio_irq_thread(void *param)
if (rt_sem_take(host->sdio_irq_sem, RT_WAITING_FOREVER) == RT_EOK) if (rt_sem_take(host->sdio_irq_sem, RT_WAITING_FOREVER) == RT_EOK)
{ {
mmcsd_host_lock(host); mmcsd_host_lock(host);
pending = sdio_io_readb(host->card->sdio_func0, pending = sdio_io_readb(host->card->sdio_function[0],
SDIO_REG_CCCR_INT_PEND, &ret); SDIO_REG_CCCR_INT_PEND, &ret);
if (ret) if (ret)
{ {
...@@ -974,7 +975,7 @@ static void sdio_irq_thread(void *param) ...@@ -974,7 +975,7 @@ static void sdio_irq_thread(void *param)
{ {
if (pending & (1 << i)) if (pending & (1 << i))
{ {
struct rt_sdio_function *func = card->sdio_function[i - 1]; struct rt_sdio_function *func = card->sdio_function[i];
if (!func) if (!func)
{ {
mmcsd_dbg("pending IRQ for " mmcsd_dbg("pending IRQ for "
...@@ -1049,10 +1050,13 @@ rt_int32_t sdio_attach_irq(struct rt_sdio_function *func, rt_sdio_irq_handler_t ...@@ -1049,10 +1050,13 @@ rt_int32_t sdio_attach_irq(struct rt_sdio_function *func, rt_sdio_irq_handler_t
{ {
rt_int32_t ret; rt_int32_t ret;
rt_uint8_t reg; rt_uint8_t reg;
struct rt_sdio_function *func0;
RT_ASSERT(func != RT_NULL); RT_ASSERT(func != RT_NULL);
RT_ASSERT(func->card != RT_NULL); RT_ASSERT(func->card != RT_NULL);
func0 = func->card->sdio_function[0];
mmcsd_dbg("SDIO: enabling IRQ for function %d\n", func->num); mmcsd_dbg("SDIO: enabling IRQ for function %d\n", func->num);
if (func->irq_handler) if (func->irq_handler)
...@@ -1061,7 +1065,7 @@ rt_int32_t sdio_attach_irq(struct rt_sdio_function *func, rt_sdio_irq_handler_t ...@@ -1061,7 +1065,7 @@ rt_int32_t sdio_attach_irq(struct rt_sdio_function *func, rt_sdio_irq_handler_t
return -RT_EBUSY; return -RT_EBUSY;
} }
reg = sdio_io_readb(func, SDIO_REG_CCCR_INT_EN, &ret); reg = sdio_io_readb(func0, SDIO_REG_CCCR_INT_EN, &ret);
if (ret) if (ret)
return ret; return ret;
...@@ -1069,7 +1073,7 @@ rt_int32_t sdio_attach_irq(struct rt_sdio_function *func, rt_sdio_irq_handler_t ...@@ -1069,7 +1073,7 @@ rt_int32_t sdio_attach_irq(struct rt_sdio_function *func, rt_sdio_irq_handler_t
reg |= 1; /* Master interrupt enable */ reg |= 1; /* Master interrupt enable */
ret = sdio_io_writeb(func, SDIO_REG_CCCR_INT_EN, reg); ret = sdio_io_writeb(func0, SDIO_REG_CCCR_INT_EN, reg);
if (ret) if (ret)
return ret; return ret;
...@@ -1086,10 +1090,13 @@ rt_int32_t sdio_detach_irq(struct rt_sdio_function *func) ...@@ -1086,10 +1090,13 @@ rt_int32_t sdio_detach_irq(struct rt_sdio_function *func)
{ {
rt_int32_t ret; rt_int32_t ret;
rt_uint8_t reg; rt_uint8_t reg;
struct rt_sdio_function *func0;
RT_ASSERT(func != RT_NULL); RT_ASSERT(func != RT_NULL);
RT_ASSERT(func->card != RT_NULL); RT_ASSERT(func->card != RT_NULL);
func0 = func->card->sdio_function[0];
mmcsd_dbg("SDIO: disabling IRQ for function %d\n", func->num); mmcsd_dbg("SDIO: disabling IRQ for function %d\n", func->num);
if (func->irq_handler) if (func->irq_handler)
...@@ -1098,7 +1105,7 @@ rt_int32_t sdio_detach_irq(struct rt_sdio_function *func) ...@@ -1098,7 +1105,7 @@ rt_int32_t sdio_detach_irq(struct rt_sdio_function *func)
sdio_irq_thread_delete(func->card); sdio_irq_thread_delete(func->card);
} }
reg = sdio_io_readb(func, SDIO_REG_CCCR_INT_EN, &ret); reg = sdio_io_readb(func0, SDIO_REG_CCCR_INT_EN, &ret);
if (ret) if (ret)
return ret; return ret;
...@@ -1108,7 +1115,7 @@ rt_int32_t sdio_detach_irq(struct rt_sdio_function *func) ...@@ -1108,7 +1115,7 @@ rt_int32_t sdio_detach_irq(struct rt_sdio_function *func)
if (!(reg & 0xFE)) if (!(reg & 0xFE))
reg = 0; reg = 0;
ret = sdio_io_writeb(func, SDIO_REG_CCCR_INT_EN, reg); ret = sdio_io_writeb(func0, SDIO_REG_CCCR_INT_EN, reg);
if (ret) if (ret)
return ret; return ret;
...@@ -1127,19 +1134,22 @@ rt_int32_t sdio_enable_func(struct rt_sdio_function *func) ...@@ -1127,19 +1134,22 @@ rt_int32_t sdio_enable_func(struct rt_sdio_function *func)
rt_int32_t ret; rt_int32_t ret;
rt_uint8_t reg; rt_uint8_t reg;
rt_uint32_t timeout; rt_uint32_t timeout;
struct rt_sdio_function *func0;
RT_ASSERT(func != RT_NULL); RT_ASSERT(func != RT_NULL);
RT_ASSERT(func->card != RT_NULL); RT_ASSERT(func->card != RT_NULL);
func0 = func->card->sdio_function[0];
mmcsd_dbg("SDIO: enabling function %d\n", func->num); mmcsd_dbg("SDIO: enabling function %d\n", func->num);
reg = sdio_io_readb(func, SDIO_REG_CCCR_IO_EN, &ret); reg = sdio_io_readb(func0, SDIO_REG_CCCR_IO_EN, &ret);
if (ret) if (ret)
goto err; goto err;
reg |= 1 << func->num; reg |= 1 << func->num;
ret = sdio_io_writeb(func, SDIO_REG_CCCR_IO_EN, reg); ret = sdio_io_writeb(func0, SDIO_REG_CCCR_IO_EN, reg);
if (ret) if (ret)
goto err; goto err;
...@@ -1147,7 +1157,7 @@ rt_int32_t sdio_enable_func(struct rt_sdio_function *func) ...@@ -1147,7 +1157,7 @@ rt_int32_t sdio_enable_func(struct rt_sdio_function *func)
while (1) while (1)
{ {
reg = sdio_io_readb(func, SDIO_REG_CCCR_IO_RDY, &ret); reg = sdio_io_readb(func0, SDIO_REG_CCCR_IO_RDY, &ret);
if (ret) if (ret)
goto err; goto err;
if (reg & (1 << func->num)) if (reg & (1 << func->num))
...@@ -1171,19 +1181,22 @@ rt_int32_t sdio_disable_func(struct rt_sdio_function *func) ...@@ -1171,19 +1181,22 @@ rt_int32_t sdio_disable_func(struct rt_sdio_function *func)
{ {
rt_int32_t ret; rt_int32_t ret;
rt_uint8_t reg; rt_uint8_t reg;
struct rt_sdio_function *func0;
RT_ASSERT(func != RT_NULL); RT_ASSERT(func != RT_NULL);
RT_ASSERT(func->card != RT_NULL); RT_ASSERT(func->card != RT_NULL);
func0 = func->card->sdio_function[0];
mmcsd_dbg("SDIO: disabling function %d\n", func->num); mmcsd_dbg("SDIO: disabling function %d\n", func->num);
reg = sdio_io_readb(func, SDIO_REG_CCCR_IO_EN, &ret); reg = sdio_io_readb(func0, SDIO_REG_CCCR_IO_EN, &ret);
if (ret) if (ret)
goto err; goto err;
reg &= ~(1 << func->num); reg &= ~(1 << func->num);
ret = sdio_io_writeb(func, SDIO_REG_CCCR_IO_EN, reg); ret = sdio_io_writeb(func0, SDIO_REG_CCCR_IO_EN, reg);
if (ret) if (ret)
goto err; goto err;
...@@ -1199,6 +1212,7 @@ err: ...@@ -1199,6 +1212,7 @@ err:
rt_int32_t sdio_set_block_size(struct rt_sdio_function *func, rt_uint32_t blksize) rt_int32_t sdio_set_block_size(struct rt_sdio_function *func, rt_uint32_t blksize)
{ {
rt_int32_t ret; rt_int32_t ret;
struct rt_sdio_function *func0 = func->card->sdio_function[0];
if (blksize > func->card->host->max_blk_size) if (blksize > func->card->host->max_blk_size)
return -RT_ERROR; return -RT_ERROR;
...@@ -1209,11 +1223,11 @@ rt_int32_t sdio_set_block_size(struct rt_sdio_function *func, rt_uint32_t blksiz ...@@ -1209,11 +1223,11 @@ rt_int32_t sdio_set_block_size(struct rt_sdio_function *func, rt_uint32_t blksiz
blksize = MIN(blksize, 512u); blksize = MIN(blksize, 512u);
} }
ret = sdio_io_writeb(func, SDIO_REG_FBR_BASE(func->num) + SDIO_REG_FBR_BLKSIZE, ret = sdio_io_writeb(func0, SDIO_REG_FBR_BASE(func->num) + SDIO_REG_FBR_BLKSIZE,
blksize & 0xff); blksize & 0xff);
if (ret) if (ret)
return ret; return ret;
ret = sdio_io_writeb(func, SDIO_REG_FBR_BASE(func->num) + SDIO_REG_FBR_BLKSIZE + 1, ret = sdio_io_writeb(func0, SDIO_REG_FBR_BASE(func->num) + SDIO_REG_FBR_BLKSIZE + 1,
(blksize >> 8) & 0xff); (blksize >> 8) & 0xff);
if (ret) if (ret)
return ret; return ret;
......
...@@ -34,8 +34,8 @@ extern "C" { ...@@ -34,8 +34,8 @@ extern "C" {
/* manufacturer id, product io */ /* manufacturer id, product io */
#define SDIO_MANUFACTURER_ID_MARVELL 0x02df #define SDIO_MANUFACTURER_ID_MARVELL 0x02df
#define SDIO_PRODUCT_ID_MARVELL_LIBERTAS 0x9103 #define SDIO_PRODUCT_ID_MARVELL_88W8686 0x9103
#ifdef __cplusplus #ifdef __cplusplus
} }
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册