123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884 |
- #define LOG_LEVEL CONFIG_MMC_LOG_LEVEL
- #include <logging/log.h>
- LOG_MODULE_REGISTER(sdio_acts);
- #include <kernel.h>
- #include <init.h>
- #include <device.h>
- #include <irq.h>
- #include <drivers/mmc/mmc.h>
- #include <drivers/mmc/sdio.h>
- #include <soc.h>
- #include "mmc_ops.h"
- #define MAX_FUNC_DEVICE_NUM 1
- #define SDIO_CMD_TIMEOUT_US (200 * 1000)
- struct sdio_func
- {
- struct device *host;
- #ifdef CONFIG_WIFI_RTL8189FTV
- sdio_irq_handler_t *callback;
- unsigned int max_blksize;
- unsigned int cur_blksize;
- unsigned int enable_timeout;
- unsigned int num;
- struct k_mutex host_lock;
- #else
- struct k_mutex host_lock;
- sdio_irq_handler_t *callback;
- unsigned int num;
- unsigned cur_blksize;
- #endif
- uint32_t rca;
- bool dev_scan_done;
- #ifdef CONFIG_MMC_SDIO_ISR_THREAD
- k_tid_t sdio_isr_thread_pid;
- #endif
- };
- #ifdef CONFIG_MMC_SDIO_ISR_THREAD
- static struct k_thread sdio_isr_thread;
- #ifdef CONFIG_WIFI_RTL8189FTV
- static K_THREAD_STACK_DEFINE(sdio_isr_thread_stack, 3096);
- #else
- static K_THREAD_STACK_DEFINE(sdio_isr_thread_stack, 896);
- #endif
- static struct k_sem sdio_isr_thread_sem;
- #endif
- #if defined(CONFIG_WIFI_RTL8189FTV) && defined(CONFIG_MMC_SDIO_ISR_THREAD)
- #define CHECK_SDIO_IRQ_INTERVAL 2000
- static void sdio_check_irq_timer_callback(struct k_timer *timer);
- K_TIMER_DEFINE(check_irq_timer, sdio_check_irq_timer_callback, NULL);
- static uint32_t sdio_irq_pre_cnt = 0, sdio_irq_cur_cnt = 0;
- static void sdio_check_irq_timer_callback(struct k_timer *timer)
- {
- if (sdio_irq_cur_cnt == sdio_irq_pre_cnt) {
- k_sem_give(&sdio_isr_thread_sem);
- } else {
- sdio_irq_pre_cnt = sdio_irq_cur_cnt;
- }
- }
- #endif
- int mmc_send_io_op_cond(struct device *mmc_dev, uint32_t ocr, uint32_t *rocr)
- {
- struct mmc_cmd cmd = {0};
- int i, err = 0;
- cmd.opcode = SD_IO_SEND_OP_COND;
- cmd.arg = ocr;
- cmd.flags = MMC_RSP_R4 | MMC_CMD_BCR;
- for (i = 10; i; i--) {
- err = mmc_send_cmd(mmc_dev, &cmd);
- if (err)
- break;
-
- if (ocr == 0)
- break;
- if (cmd.resp[0] & MMC_CARD_BUSY)
- break;
- err = -ETIMEDOUT;
- k_sleep(10);
- }
- if (rocr)
- *rocr = cmd.resp[0];
- return err;
- }
- int mmc_io_rw_direct(struct device *mmc_dev, int write, unsigned fn,
- unsigned addr, uint8_t in, uint8_t *out)
- {
- struct mmc_cmd cmd = {0};
- uint32_t arg;
- int ret;
-
- if (addr & ~0x1ffff)
- return -EINVAL;
-
- arg = write ? 0x80000000 : 0x00000000;
- arg |= fn << 28;
- arg |= (write && out) ? 0x08000000 : 0x00000000;
- arg |= addr << 9;
- arg |= in;
- cmd.opcode = SD_IO_RW_DIRECT;
- cmd.arg = arg;
- cmd.flags = MMC_RSP_R5 | MMC_CMD_AC;
- ret = mmc_send_cmd(mmc_dev, &cmd);
- if (ret) {
- LOG_ERR("direct r/w failed, ret %d", ret);
- return ret;
- }
- if (cmd.resp[0] & (R5_ERROR | R5_FUNCTION_NUMBER | R5_OUT_OF_RANGE)) {
- LOG_ERR("direct r/w failed, resp 0x%x", cmd.resp[0]);
- return -1;
- }
- if (out)
- *out = cmd.resp[0] & 0xff;
- return 0;
- }
- int mmc_io_rw_extended(struct device *mmc_dev, int write, uint32_t fn, uint32_t addr,
- uint32_t incr_addr, uint8_t *buf, uint32_t blocks, uint32_t blksz)
- {
- struct mmc_cmd cmd = {0};
- uint32_t arg;
- int ret;
-
- if (addr & ~0x1ffff)
- return -EINVAL;
-
- arg = write ? 0x80000000 : 0x00000000;
- arg |= fn << 28;
- arg |= incr_addr ? 0x04000000 : 0x00000000;
- arg |= addr << 9;
- if (blocks == 0)
- arg |= (blksz == 512) ? 0 : blksz;
- else
- arg |= 0x08000000 | blocks;
- cmd.opcode = SD_IO_RW_EXTENDED;
- cmd.arg = arg;
- cmd.blk_size = blksz;
- cmd.blk_num = (blocks == 0) ? 1 : blocks;
- cmd.buf = buf;
- cmd.flags = MMC_RSP_R5 | MMC_CMD_ADTC;
- cmd.flags |= write ? MMC_DATA_WRITE : MMC_DATA_READ;
- ret = mmc_send_cmd(mmc_dev, &cmd);
- if (ret) {
- LOG_ERR("sdio extended r/w failed, ret %d\n", ret);
- return ret;
- }
- if (cmd.resp[0] & (R5_ERROR | R5_FUNCTION_NUMBER | R5_OUT_OF_RANGE)) {
- LOG_ERR("sdio direct r/w failed, resp 0x%x\n", cmd.resp[0]);
- return -1;
- }
- return 0;
- }
- static int mmc_sdio_switch_hs(struct device *mmc_dev, int enable)
- {
- int ret;
- uint8_t speed;
- ret = mmc_io_rw_direct(mmc_dev, 0, 0, SDIO_CCCR_SPEED, 0, &speed);
- if (ret)
- return ret;
- if (!(speed & SDIO_SPEED_SHS)) {
- return 0;
- }
- if (enable)
- speed |= SDIO_SPEED_EHS;
- else
- speed &= ~SDIO_SPEED_EHS;
- ret = mmc_io_rw_direct(mmc_dev, 1, 0, SDIO_CCCR_SPEED, speed, NULL);
- if (ret)
- return ret;
- return 1;
- }
- static int sdio_enable_4bit_bus(struct device *mmc_dev)
- {
- int ret;
- uint32_t caps;
- uint8_t ctrl;
- caps = mmc_get_capability(mmc_dev);
- if (!(caps & MMC_CAP_4_BIT_DATA))
- return 0;
- ret = mmc_io_rw_direct(mmc_dev, 0, 0, SDIO_CCCR_IF, 0, &ctrl);
- if (ret)
- return ret;
-
- ctrl &= ~SDIO_BUS_WIDTH_MASK;
- ctrl |= SDIO_BUS_WIDTH_4BIT;
- ret = mmc_io_rw_direct(mmc_dev, 1, 0, SDIO_CCCR_IF, ctrl, NULL);
- if (ret)
- return ret;
- ret = mmc_io_rw_direct(mmc_dev, 0, 0, SDIO_CCCR_IF, 0, &ctrl);
- if (ret)
- return ret;
- return 1;
- }
- void sdio_claim_host(struct sdio_func *func)
- {
- if (!func->dev_scan_done) {
- return;
- }
- k_mutex_lock(&func->host_lock, K_FOREVER);
- }
- void sdio_release_host(struct sdio_func *func)
- {
- if (!func->dev_scan_done) {
- return;
- }
- k_mutex_unlock(&func->host_lock);
- }
- int sdio_enable_func(struct sdio_func *func)
- {
- int ret, cnt = 0;
- unsigned char reg;
- LOG_DBG("Enabling function %d\n", func->num);
- if (!func->dev_scan_done) {
- return -1;
- }
- ret = mmc_io_rw_direct(func->host, 0, 0, SDIO_CCCR_IOEx, 0, ®);
- if (ret)
- goto err;
- reg |= 1 << func->num;
- ret = mmc_io_rw_direct(func->host, 1, 0, SDIO_CCCR_IOEx, reg, NULL);
- if (ret)
- goto err;
- while (1) {
- ret = mmc_io_rw_direct(func->host, 0, 0, SDIO_CCCR_IORx, 0, ®);
- if (ret)
- goto err;
- if (reg & (1 << func->num))
- break;
-
- k_busy_wait(1);
- if (++cnt > SDIO_CMD_TIMEOUT_US)
- goto err;
- }
- return 0;
- err:
- LOG_DBG("Failed to enable function %d", func->num);
- return ret;
- }
- int sdio_disable_func(struct sdio_func *func)
- {
- int ret;
- unsigned char reg;
- if (!func->dev_scan_done) {
- return -1;
- }
- LOG_DBG("Disabling function %d", func->num);
- ret = mmc_io_rw_direct(func->host, 0, 0, SDIO_CCCR_IOEx, 0, ®);
- if (ret)
- goto err;
- reg &= ~(1 << func->num);
- ret = mmc_io_rw_direct(func->host, 1, 0, SDIO_CCCR_IOEx, reg, NULL);
- if (ret)
- goto err;
- return 0;
- err:
- LOG_DBG("Failed to disable function %d", func->num);
- return -EIO;
- }
- int sdio_set_block_size(struct sdio_func *func, unsigned blksz)
- {
- int ret;
- LOG_DBG("function %d set blksize %d", func->num, blksz);
- if (!func->dev_scan_done) {
- return -1;
- }
- ret = mmc_io_rw_direct(func->host, 1, 0,
- SDIO_FBR_BASE(func->num) + SDIO_FBR_BLKSIZE,
- blksz & 0xff, NULL);
- if (ret)
- return ret;
- ret = mmc_io_rw_direct(func->host, 1, 0,
- SDIO_FBR_BASE(func->num) + SDIO_FBR_BLKSIZE + 1,
- (blksz >> 8) & 0xff, NULL);
- if (ret)
- return ret;
- func->cur_blksize = blksz;
- #ifdef CONFIG_WIFI_RTL8189FTV
- func->max_blksize = blksz;
- #endif
- return 0;
- }
- static int sdio_io_rw_ext_helper(struct sdio_func *func, int write,
- unsigned addr, int incr_addr, unsigned char *buf, unsigned size)
- {
- unsigned remainder = size;
- unsigned max_blocks = 511;
- int ret;
- if (!func->dev_scan_done) {
- return -1;
- }
-
- if (size > func->cur_blksize) {
- while (remainder >= func->cur_blksize) {
- unsigned blocks;
- blocks = remainder / func->cur_blksize;
- if (blocks > max_blocks)
- blocks = max_blocks;
- size = blocks * func->cur_blksize;
- ret = mmc_io_rw_extended(func->host, write,
- func->num, addr, incr_addr, buf,
- blocks, func->cur_blksize);
- if (ret)
- return ret;
- remainder -= size;
- buf += size;
- if (incr_addr)
- addr += size;
- }
- }
-
- while (remainder > 0) {
- size = min(remainder, func->cur_blksize);
-
- ret = mmc_io_rw_extended(func->host, write, func->num, addr,
- incr_addr, buf, 0, size);
- if (ret)
- return ret;
- remainder -= size;
- buf += size;
- if (incr_addr)
- addr += size;
- }
- return 0;
- }
- unsigned char sdio_readb(struct sdio_func *func, unsigned int addr, int *err_ret)
- {
- int ret;
- unsigned char val;
- if (!func->dev_scan_done) {
- return -1;
- }
- if (err_ret)
- *err_ret = 0;
- ret = mmc_io_rw_direct(func->host, 0, func->num, addr, 0, &val);
- if (ret) {
- if (err_ret)
- *err_ret = ret;
- return 0xFF;
- }
- return val;
- }
- void sdio_writeb(struct sdio_func *func, unsigned char b, unsigned int addr,
- int *err_ret)
- {
- int ret;
- if (!func->dev_scan_done) {
- return;
- }
- ret = mmc_io_rw_direct(func->host, 1, func->num, addr, b, NULL);
- if (err_ret)
- *err_ret = ret;
- }
- int sdio_memcpy_fromio(struct sdio_func *func, void *dst,
- unsigned int addr, int count)
- {
- if (!func->dev_scan_done) {
- return -1;
- }
- return sdio_io_rw_ext_helper(func, 0, addr, 1, dst, count);
- }
- int sdio_memcpy_toio(struct sdio_func *func, unsigned int addr,
- void *src, int count)
- {
- if (!func->dev_scan_done) {
- return -1;
- }
- return sdio_io_rw_ext_helper(func, 1, addr, 1, src, count);
- }
- unsigned char sdio_f0_readb(struct sdio_func *func, unsigned int addr,
- int *err_ret)
- {
- int ret;
- unsigned char val;
- if (!func->dev_scan_done) {
- return -1;
- }
- if (err_ret)
- *err_ret = 0;
- ret = mmc_io_rw_direct(func->host, 0, 0, addr, 0, &val);
- if (ret) {
- if (err_ret)
- *err_ret = ret;
- return 0xFF;
- }
- return val;
- }
- void sdio_f0_writeb(struct sdio_func *func, unsigned char b, unsigned int addr,
- int *err_ret)
- {
- int ret;
- ret = mmc_io_rw_direct(func->host, 1, 0, addr, b, NULL);
- if (err_ret)
- *err_ret = ret;
- }
- static void sdio_isr_handler(void *arg)
- {
- struct sdio_func *func = arg;
- mmc_enable_sdio_irq(func->host, 0);
- #ifdef CONFIG_MMC_SDIO_ISR_THREAD
- k_sem_give(&sdio_isr_thread_sem);
- #else
- if (func->sdio_func_callback) {
- func->sdio_func_callback(func);
- mmc_enable_sdio_irq(func->host, 1);
- }
- #endif
- }
- #ifdef CONFIG_MMC_SDIO_ISR_THREAD
- static void sdio_isr_thread_func(void *p1, void *p2, void *p3)
- {
- struct sdio_func *func = p1;
- LOG_DBG("irq thread is ready");
- while (1) {
- k_sem_take(&sdio_isr_thread_sem, K_FOREVER);
- #ifdef CONFIG_WIFI_RTL8189FTV
- sdio_irq_cur_cnt++;
- #endif
- if (func->callback) {
- func->callback(func);
- mmc_enable_sdio_irq(func->host, 1);
- }
- }
- }
- #endif
- int sdio_claim_irq(struct sdio_func *func, sdio_irq_handler_t *handler)
- {
- int err;
- unsigned char reg;
- LOG_DBG("Enabling IRQ for function %d", func->num);
- reg = sdio_f0_readb(func, SDIO_CCCR_IENx, &err);
- if (err) {
- return err;
- }
- reg |= 1 << func->num;
-
- reg |= 1;
- sdio_f0_writeb(func, reg, SDIO_CCCR_IENx, &err);
- if (err) {
- return err;
- }
- #ifdef CONFIG_MMC_SDIO_ISR_THREAD
- k_sem_init(&sdio_isr_thread_sem, 0, 1);
- func->sdio_isr_thread_pid = k_thread_create(&sdio_isr_thread,
- sdio_isr_thread_stack,
- K_THREAD_STACK_SIZEOF(sdio_isr_thread_stack),
- (k_thread_entry_t) sdio_isr_thread_func, func,
- NULL, NULL, K_PRIO_COOP(1), 0, K_NO_WAIT);
- #endif
- func->callback = handler;
- mmc_set_sdio_irq_callback(func->host, sdio_isr_handler, func);
- mmc_enable_sdio_irq(func->host, 1);
- #if defined(CONFIG_WIFI_RTL8189FTV) && defined(CONFIG_MMC_SDIO_ISR_THREAD)
- k_timer_start(&check_irq_timer, CHECK_SDIO_IRQ_INTERVAL, CHECK_SDIO_IRQ_INTERVAL);
- #endif
- return err;
- }
- int sdio_release_irq(struct sdio_func *func)
- {
- int err;
- unsigned char reg;
- LOG_DBG("Disabling IRQ for function %d", func->num);
- #if defined(CONFIG_WIFI_RTL8189FTV) && defined(CONFIG_MMC_SDIO_ISR_THREAD)
- k_timer_stop(&check_irq_timer);
- #endif
- mmc_enable_sdio_irq(func->host, 0);
- #ifdef CONFIG_MMC_SDIO_ISR_THREAD
- k_thread_abort(func->sdio_isr_thread_pid);
- func->sdio_isr_thread_pid = NULL;
- #endif
- func->callback = NULL;
- mmc_set_sdio_irq_callback(func->host, NULL, NULL);
- reg = sdio_f0_readb(func, SDIO_CCCR_IENx, &err);
- if (err) {
- return err;
- }
- reg &= ~(1 << func->num);
-
- if (!(reg & 0xFE))
- reg = 0;
- sdio_f0_writeb(func, reg, SDIO_CCCR_IENx, &err);
- if (err) {
- return err;
- }
- return 0;
- }
- static int sdio_scan_host(struct device *mmc_dev, struct sdio_func *func)
- {
- int err;
- uint32_t ocr;
- mmc_go_idle(mmc_dev);
- err = mmc_send_io_op_cond(mmc_dev, 0, &ocr);
- if (err) {
- LOG_ERR("cannot found sdio device");
- return -ENODEV;
- }
- if (((ocr >> 28) & 0x7) == 0) {
- LOG_ERR("cannot found any sdio function");
- return -ENODEV;
- }
- ocr = ocr & 0xffffff;
- if (!ocr) {
- LOG_ERR("invalid ocr 0x%x", ocr);
- return -ENODEV;
- }
- err = mmc_send_io_op_cond(mmc_dev, ocr, &ocr);
- if (err) {
- LOG_ERR("cannot found sdio device");
- return -ENODEV;
- }
- err = mmc_send_relative_addr(mmc_dev, &func->rca);
- if (err) {
- LOG_ERR("failed to get rca");
- return err;
- }
- err = mmc_select_card(mmc_dev, func->rca);
- if (err) {
- LOG_ERR("failed to select card %d\n", func->rca);
- return err;
- }
- err = mmc_sdio_switch_hs(mmc_dev, true);
- if (err > 0) {
- mmc_set_clock(mmc_dev, 50000000);
- }
-
- err = sdio_enable_4bit_bus(mmc_dev);
- if (err > 0) {
- mmc_set_bus_width(mmc_dev, MMC_BUS_WIDTH_4);
- err = 0;
- }
- func->dev_scan_done = true;
- return 0;
- }
- static struct sdio_func sdio_funcs[MAX_FUNC_DEVICE_NUM];
- struct sdio_func *sdio_get_func(int index)
- {
- struct sdio_func *func;
- if (index > MAX_FUNC_DEVICE_NUM)
- return NULL;
- func = &sdio_funcs[index];
- if (!func->dev_scan_done) {
- return NULL;
- }
- return func;
- }
- int sdio_bus_scan(int bus_id)
- {
- int ret;
- struct sdio_func *func = &sdio_funcs[0];
- ARG_UNUSED(bus_id);
- LOG_INF("scan sdio on mmc bus %s",CONFIG_MMC_SDIO_MMC_DEV_NAME);
- func->host = device_get_binding(CONFIG_MMC_SDIO_MMC_DEV_NAME);
- if (!func->host) {
- LOG_ERR("Cannot find mmc device %s!\n",
- CONFIG_MMC_SDIO_MMC_DEV_NAME);
- return -ENODEV;
- }
- func->callback = NULL;
- func->num = 1;
- func->cur_blksize = 0;
- func->dev_scan_done = false;
- k_mutex_init(&func->host_lock);
- ret = sdio_scan_host(func->host, func);
- if (ret) {
- LOG_ERR("host scan error, ret %d", ret);
- return ret;
- }
- return 0;
- }
- static int sdio_init(struct device *dev)
- {
-
- ARG_UNUSED(dev);
- return 0;
- }
- DEVICE_DEFINE(sdio, "sdio_0", sdio_init, NULL,
- NULL, NULL, POST_KERNEL, 20, NULL);
|