/* * Copyright (c) 2006-2021, RT-Thread Development Team * * SPDX-License-Identifier: Apache-2.0 * * Change Logs: * Date Author Notes * 2011-01-13 weety first version */ #include #include #include #include #include #include "mmcsd.h" #include "edma.h" #define RT_USING_MMCSD0 #define MMCSD_DEBUG 0 #if MMCSD_DEBUG #define mmc_dbg(fmt, ...) rt_kprintf(fmt, ##__VA_ARGS__) #else #define mmc_dbg(fmt, ...) #endif #define MMU_NOCACHE_ADDR(a) ((rt_uint32_t)a | (1UL<<29)) #define CACHE_LINE_SIZE 32 extern void mmu_clean_dcache(rt_uint32_t buffer, rt_uint32_t size); extern void mmu_invalidate_dcache(rt_uint32_t buffer, rt_uint32_t size); #define EVT_QUEUE_NUM 0 /* EDMA3 Event queue number. */ static unsigned rw_threshold = 32; static rt_bool_t use_dma = RT_TRUE; enum DATA_DIR_TYPE { DM365_MMC_DATADIR_NONE = 0, DM365_MMC_DATADIR_READ, DM365_MMC_DATADIR_WRITE, }; struct mmc_dm365_host { struct rt_mmcsd_host *mmc; struct rt_mmcsd_req *req; struct rt_mmcsd_data *data; struct rt_mmcsd_cmd *cmd; struct edmacc_param tx_template; struct edmacc_param rx_template; rt_uint32_t mmc_input_clk; rt_uint32_t ns_in_one_cycle; /* for ns in one cycle calculation */ mmcsd_regs_t *mmcsd_regs; rt_uint8_t bus_mode; enum DATA_DIR_TYPE data_dir; rt_uint32_t rxdma; rt_uint32_t txdma; rt_bool_t use_dma; rt_bool_t do_dma; rt_uint8_t *buffer; rt_uint32_t buffer_bytes_left; rt_uint32_t bytes_left; rt_uint8_t *dma_buffer; rt_bool_t use_dma_buffer; rt_bool_t sdio_int; }; void *mmc_priv(struct rt_mmcsd_host *host) { return (void *)host->private_data; } static void delay_us(rt_uint32_t us) { rt_uint32_t len; for (;us > 0; us --) for (len = 0; len < 10; len++ ); } /******************************************************************************************************* ** 函数名称: calculate_freq_for_card() ** 功能描述: 此函数用于计算设置SD卡频率所需的分频数 ** ** 输　入: host -> DM365 MMC host句柄 ** mmc_req_freq -> MMC工作频率 ** ** 输　出: 分频值 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static rt_uint32_t calculate_freq_for_card(struct mmc_dm365_host *host, rt_uint32_t mmc_req_freq) { rt_uint32_t mmc_freq = 0; rt_uint32_t mmc_pclk = 0; rt_uint32_t mmc_push_pull_divisor = 0; mmc_pclk = host->mmc_input_clk; if (mmc_req_freq && mmc_pclk > (2 * mmc_req_freq)) mmc_push_pull_divisor = ((rt_uint32_t)mmc_pclk / (2 * mmc_req_freq)) - 1; else mmc_push_pull_divisor = 0; mmc_freq = (rt_uint32_t)mmc_pclk / (2 * (mmc_push_pull_divisor + 1)); if (mmc_freq > mmc_req_freq) mmc_push_pull_divisor = mmc_push_pull_divisor + 1; /* Convert ns to clock cycles */ if (mmc_req_freq <= 400000) host->ns_in_one_cycle = (1000000)/(((mmc_pclk/(2*(mmc_push_pull_divisor+1)))/1000)); else host->ns_in_one_cycle = (1000000)/(((mmc_pclk/(2*(mmc_push_pull_divisor+1)))/1000000)); return mmc_push_pull_divisor; } /******************************************************************************************************* ** 函数名称: calculate_freq_for_card() ** 功能描述: 此函数用于计算MMC clock分频数 ** ** 输　入: host -> DM365 MMC host句柄 ** ios -> MMC 操作句柄 ** ** 输　出: 读取到的PHY寄存器值 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void calculate_clk_divider(struct rt_mmcsd_host *mmc, struct rt_mmcsd_io_cfg *ios) { rt_uint32_t temp = 0; rt_uint32_t mmc_pclk = 0; rt_uint32_t open_drain_freq = 0; rt_uint32_t mmc_push_pull_freq = 0; struct mmc_dm365_host *host = mmc_priv(mmc); mmc_pclk = host->mmc_input_clk; if (ios->bus_mode == MMCSD_BUSMODE_OPENDRAIN) { /* Ignoring the init clock value passed for fixing the inter * operability with different cards. */ open_drain_freq = ((rt_uint32_t)mmc_pclk / (2 * MMCSD_INIT_CLOCK)) - 1; if (open_drain_freq > 0xFF) open_drain_freq = 0xFF; temp = host->mmcsd_regs->MMCCLK & ~MMCCLK_CLKRT_MASK; temp |= open_drain_freq; host->mmcsd_regs->MMCCLK = temp; /* Convert ns to clock cycles */ host->ns_in_one_cycle = (1000000) / (MMCSD_INIT_CLOCK / 1000); } else { mmc_push_pull_freq = calculate_freq_for_card(host, ios->clock); if (mmc_push_pull_freq > 0xFF) mmc_push_pull_freq = 0xFF; temp = host->mmcsd_regs->MMCCLK & ~MMCCLK_CLKEN; host->mmcsd_regs->MMCCLK = temp; delay_us(10); temp = host->mmcsd_regs->MMCCLK & ~MMCCLK_CLKRT_MASK; temp |= mmc_push_pull_freq; host->mmcsd_regs->MMCCLK = temp; host->mmcsd_regs->MMCCLK = temp | MMCCLK_CLKEN; delay_us(10); } } /******************************************************************************************************* ** 函数名称: mmc_dm365_set_ios() ** 功能描述: 此函数是mmc设置设置 ** ** 输　入: mmc -> mmc host 句柄 ** ios -> mmc 操作句柄 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void mmc_dm365_set_ios(struct rt_mmcsd_host *mmc, struct rt_mmcsd_io_cfg *ios) { struct mmc_dm365_host *host = mmc_priv(mmc); mmc_dbg("clock %dHz busmode %d powermode %d Vdd %04x\n", ios->clock, ios->bus_mode, ios->power_mode, ios->vdd); switch (ios->bus_width) { case MMCSD_BUS_WIDTH_8: mmc_dbg("Enabling 8 bit mode\n"); host->mmcsd_regs->MMCCTL = (host->mmcsd_regs->MMCCTL & ~MMCCTL_WIDTH_4_BIT) | MMCCTL_WIDTH_8_BIT; break; case MMCSD_BUS_WIDTH_4: mmc_dbg("Enabling 4 bit mode\n"); host->mmcsd_regs->MMCCTL = (host->mmcsd_regs->MMCCTL & ~MMCCTL_WIDTH_8_BIT) | MMCCTL_WIDTH_4_BIT; break; case MMCSD_BUS_WIDTH_1: mmc_dbg("Enabling 1 bit mode\n"); host->mmcsd_regs->MMCCTL = host->mmcsd_regs->MMCCTL & ~(MMCCTL_WIDTH_8_BIT | MMCCTL_WIDTH_4_BIT); break; } calculate_clk_divider(mmc, ios); host->bus_mode = ios->bus_mode; if (ios->power_mode == MMCSD_POWER_UP) { unsigned long timeout = rt_tick_get() + 500; rt_bool_t lose = 1; host->mmcsd_regs->MMCARGHL = 0; host->mmcsd_regs->MMCCMD = MMCCMD_INITCK; while (rt_tick_get() < timeout) { rt_uint32_t tmp = host->mmcsd_regs->MMCST0; if (tmp & MMCST0_RSPDNE) { lose = 0; break; } } if (lose) mmc_dbg("powerup timeout\n"); } } /******************************************************************************************************* ** 函数名称: dm365_fifo_data_trans() ** 功能描述: 此函数是fifo模式传输 ** ** 输　入: host -> DM365 mmc host 句柄 ** n -> 传输字节数 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void dm365_fifo_data_trans(struct mmc_dm365_host *host, rt_uint32_t n) { rt_uint8_t *p; rt_uint32_t i; p = host->buffer; if (host->bytes_left < n) n = host->bytes_left; host->bytes_left -= n; /* NOTE: we never transfer more than rw_threshold bytes * to/from the fifo here; there's no I/O overlap. * This also assumes that access width( i.e. ACCWD) is 4 bytes */ if (host->data_dir == DM365_MMC_DATADIR_WRITE) { for (i = 0; i < (n >> 2); i++) { host->mmcsd_regs->MMCDXR = *((rt_uint32_t *)p); p = p + 4; } if (n & 3) { rt_kprintf("to do ... \n"); // iowrite8_rep(host->base + MMCSD_MMCDXR, p, (n & 3)); p = p + (n & 3); } } else { for (i = 0; i < (n >> 2); i++) { *((rt_uint32_t *)p) = host->mmcsd_regs->MMCDRR; p = p + 4; } if (n & 3) { rt_kprintf("to do ... \n"); // ioread8_rep(host->base + MMCSD_MMCDRR, p, (n & 3)); p = p + (n & 3); } } host->buffer = p; } /******************************************************************************************************* ** 函数名称: mmc_dm365_start_command() ** 功能描述: 此函数是开始发送SD命令 ** ** 输　入: host -> DM365 mmc host 句柄 ** cmd -> SD命令句柄 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void mmc_dm365_start_command(struct mmc_dm365_host *host, struct rt_mmcsd_cmd *cmd) { rt_uint32_t cmd_reg = 0; rt_uint32_t im_val; host->cmd = cmd; switch (resp_type(cmd)) { case RESP_R1B: /* There's some spec confusion about when R1B is * allowed, but if the card doesn't issue a BUSY * then it's harmless for us to allow it. */ cmd_reg |= MMCCMD_BSYEXP; /* FALLTHROUGH */ case RESP_R1: /* 48 bits, CRC */ case RESP_R4: case RESP_R5: case RESP_R6: case RESP_R7: cmd_reg |= MMCCMD_RSPFMT_R1456; break; case RESP_R2: /* 136 bits, CRC */ cmd_reg |= MMCCMD_RSPFMT_R2; break; case RESP_R3: /* 48 bits, no CRC */ cmd_reg |= MMCCMD_RSPFMT_R3; break; default: cmd_reg |= MMCCMD_RSPFMT_NONE; mmc_dbg("unknown resp_type %04x\n", resp_type(cmd)); break; } /* Set command index */ cmd_reg |= cmd->cmd_code; /* Enable EDMA transfer triggers */ if (host->do_dma == RT_TRUE) cmd_reg |= MMCCMD_DMATRIG; if (host->data != RT_NULL && host->data_dir == DM365_MMC_DATADIR_READ) cmd_reg |= MMCCMD_DMATRIG; /* Setting whether command involves data transfer or not */ if (cmd->data) cmd_reg |= MMCCMD_WDATX; /* Setting whether stream or block transfer */ if (cmd->flags & MMC_DATA_STREAM) { mmc_dbg("to do\n"); cmd_reg |= MMCCMD_STRMTP; } /* Setting whether data read or write */ if (host->data_dir == DM365_MMC_DATADIR_WRITE) cmd_reg |= MMCCMD_DTRW; if (host->bus_mode == MMCSD_BUSMODE_PUSHPULL) { cmd_reg |= MMCCMD_PPLEN; } /* set Command timeout */ host->mmcsd_regs->MMCTOR = 0x1FFF; /* Enable interrupt (calculate here, defer until FIFO is stuffed). */ im_val = MMCST0_RSPDNE | MMCST0_CRCRS | MMCST0_TOUTRS; if (host->data_dir == DM365_MMC_DATADIR_WRITE) { im_val |= MMCST0_DATDNE | MMCST0_CRCWR; if (host->do_dma == RT_FALSE) im_val |= MMCST0_DXRDY; } else if (host->data_dir == DM365_MMC_DATADIR_READ) { im_val |= MMCST0_DATDNE | MMCST0_CRCRD | MMCST0_TOUTRD; if (host->do_dma == RT_FALSE) im_val |= MMCST0_DRRDY; } /* * Before non-DMA WRITE commands the controller needs priming: * FIFO should be populated with 32 bytes i.e. whatever is the FIFO size */ if ((host->do_dma == RT_FALSE) && (host->data_dir == DM365_MMC_DATADIR_WRITE)) dm365_fifo_data_trans(host, rw_threshold); host->mmcsd_regs->MMCARGHL = cmd->arg; host->mmcsd_regs->MMCCMD = cmd_reg; host->mmcsd_regs->MMCIM = im_val; } /******************************************************************************************************* ** 函数名称: dm365_abort_dma() ** 功能描述: 此函数终止DMA传输 ** ** 输　入: host -> DM365 mmc host 句柄 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void dm365_abort_dma(struct mmc_dm365_host *host) { int sync_dev; if (host->data_dir == DM365_MMC_DATADIR_READ) sync_dev = host->rxdma; else sync_dev = host->txdma; //EDMA3DisableTransfer(EDMA0CC0_REG_BASE, sync_dev, EDMA3_TRIG_MODE_EVENT); edma_stop(sync_dev); edma_clean_channel(sync_dev); } /******************************************************************************************************* ** 函数名称: mmc_request_done() ** 功能描述: 此函数用于结束处理一个MMC请求 ** ** 输　入: host -> DM365 mmc host 句柄 ** mrq -> request 句柄 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ void mmc_request_done(struct rt_mmcsd_host *host, struct rt_mmcsd_req *mrq) { struct rt_mmcsd_cmd *cmd = mrq->cmd; int err = cmd->err; if (err && cmd->retries) { mmc_dbg("req failed (CMD%u): %d, retrying...\n", cmd->cmd_code, err); cmd->retries--; cmd->err = 0; host->ops->request(host, mrq); } else { mmc_dbg("%s: req done (CMD%u): %d: %08x %08x %08x %08x\n", "dm365 host", cmd->cmd_code, err, cmd->resp[0], cmd->resp[1], cmd->resp[2], cmd->resp[3]); if (mrq->data) { mmc_dbg("%s: %d bytes transferred: %d\n", "dm365 host", mrq->data->bytes_xfered, mrq->data->err); } if (mrq->stop) { mmc_dbg("%s: (CMD%u): %d: %08x %08x %08x %08x\n", "dm365 host", mrq->stop->cmd_code, mrq->stop->err, mrq->stop->resp[0], mrq->stop->resp[1], mrq->stop->resp[2], mrq->stop->resp[3]); } mmcsd_req_complete(host); } } /******************************************************************************************************* ** 函数名称: mmc_dm365_xfer_done() ** 功能描述: 数据传送结束调用此函数 ** ** 输　入: host -> DM365 mmc host 句柄 ** data -> data 句柄 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void mmc_dm365_xfer_done(struct mmc_dm365_host *host, struct rt_mmcsd_data *data) { host->data = RT_NULL; if (host->mmc->flags & MMCSD_SUP_SDIO_IRQ) { /* * SDIO Interrupt Detection work-around as suggested by * Davinci Errata (TMS320DM355 Silicon Revision 1.1 Errata * 2.1.6): Signal SDIO interrupt only if it is enabled by core */ if (host->sdio_int && !(host->mmcsd_regs->SDIOST0 & SDIOST0_DAT1_HI)) { host->mmcsd_regs->SDIOIST = SDIOIST_IOINT; sdio_irq_wakeup(host->mmc); } } if (host->do_dma == RT_TRUE) { dm365_abort_dma(host); if (data->flags & DATA_DIR_READ) { /* read operation */ if (host->use_dma_buffer == RT_TRUE) { /* copy DMA buffer to read buffer */ memcpy(data->buf, (void*)MMU_NOCACHE_ADDR(host->dma_buffer), data->blks * data->blksize); } /*else { mmu_invalidate_dcache((rt_uint32_t)data->buf, data->blks * data->blksize); }*/ } host->do_dma = RT_FALSE; } host->data_dir = DM365_MMC_DATADIR_NONE; if (!data->stop || (host->cmd && host->cmd->err)) { mmc_request_done(host->mmc, data->mrq); host->mmcsd_regs->MMCIM = 0; } else mmc_dm365_start_command(host, data->stop); } static void mmc_dm365_dma_cb(unsigned channel, rt_uint16_t ch_status, void *data) { if (DMA_COMPLETE != ch_status) { struct mmc_dm365_host *host = data; /* Currently means: DMA Event Missed, or "null" transfer * request was seen. In the future, TC errors (like bad * addresses) might be presented too. */ mmc_dbg("DMA %s error\n", (host->data->flags & MMC_DATA_WRITE) ? "write" : "read"); host->data->err = -RT_EIO; mmc_dm365_xfer_done(host, host->data); } } /******************************************************************************************************* ** 函数名称: mmc_dm365_dma_setup() ** 功能描述: DMA 设置函数 ** ** 输　入: host -> DM365 mmc host 句柄 ** tx -> 布尔变量，用于判断Tx或者是Rx ** template -> 用于保存EDMA3CCPaRAMEntry机构数据 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void mmc_dm365_dma_setup(struct mmc_dm365_host *host, rt_bool_t tx, struct edmacc_param *template) { rt_uint32_t sync_dev; const rt_uint16_t acnt = 4; const rt_uint16_t bcnt = rw_threshold >> 2; const rt_uint16_t ccnt = 0; rt_uint32_t src_port = 0; rt_uint32_t dst_port = 0; rt_int16_t src_bidx, dst_bidx; rt_int16_t src_cidx, dst_cidx; //edmacc_param paramSet; /* * A-B Sync transfer: each DMA request is for one "frame" of * rw_threshold bytes, broken into "acnt"-size chunks repeated * "bcnt" times. Each segment needs "ccnt" such frames; since * we tell the block layer our mmc->max_seg_size limit, we can * trust (later) that it's within bounds. * * The FIFOs are read/written in 4-byte chunks (acnt == 4) and * EDMA will optimize memory operations to use larger bursts. */ if (tx) { sync_dev = host->txdma; /* src_prt, ccnt, and link to be set up later */ /*paramSet.srcBIdx = acnt; paramSet.srcCIdx = acnt * bcnt; paramSet.destAddr = (rt_uint32_t)&(host->mmcsd_regs->MMCDXR); paramSet.destBIdx = 0; paramSet.destCIdx = 0;*/ /* src_prt, ccnt, and link to be set up later */ src_bidx = acnt; src_cidx = acnt * bcnt; dst_port = (rt_uint32_t)&(host->mmcsd_regs->MMCDXR); dst_bidx = 0; dst_cidx = 0; } else { sync_dev = host->rxdma; /* dst_prt, ccnt, and link to be set up later */ /*paramSet.srcAddr = (rt_uint32_t)&(host->mmcsd_regs->MMCDRR); paramSet.srcBIdx = 0; paramSet.srcCIdx = 0; paramSet.destBIdx = acnt; paramSet.destCIdx = acnt * bcnt;*/ src_port = (rt_uint32_t)&(host->mmcsd_regs->MMCDRR); src_bidx = 0; src_cidx = 0; /* dst_prt, ccnt, and link to be set up later */ dst_bidx = acnt; dst_cidx = acnt * bcnt; } /* * We can't use FIFO mode for the FIFOs because MMC FIFO addresses * are not 256-bit (32-byte) aligned. So we use INCR, and the W8BIT * parameter is ignored. */ edma_set_src(sync_dev, src_port, INCR, W8BIT); edma_set_dest(sync_dev, dst_port, INCR, W8BIT); edma_set_src_index(sync_dev, src_bidx, src_cidx); edma_set_dest_index(sync_dev, dst_bidx, dst_cidx); edma_set_transfer_params(sync_dev, acnt, bcnt, ccnt, 8, ABSYNC); edma_read_slot(sync_dev, template); /* don't bother with irqs or chaining */ template->opt |= EDMA_CHAN_SLOT(sync_dev) << 12; #if 0 paramSet.opt = 0u; /* Src & Dest are in INCR modes */ paramSet.opt &= 0xFFFFFFFCu; /* Program the TCC */ paramSet.opt |= ((sync_dev << EDMA3CC_OPT_TCC_SHIFT) & EDMA3CC_OPT_TCC); paramSet.aCnt = acnt; paramSet.bCnt = bcnt; /* AB Sync Transfer Mode */ paramSet.opt |= (1 << EDMA3CC_OPT_SYNCDIM_SHIFT); /* Now, write the PaRAM Set. */ EDMA3SetPaRAM(EDMA0CC0_REG_BASE, sync_dev, ¶mSet); EDMA3GetPaRAM(EDMA0CC0_REG_BASE, sync_dev, template); #endif } /******************************************************************************************************* ** 函数名称: mmc_dm365_send_dma_request() ** 功能描述: 发送DMA请求 ** ** 输　入: host -> DM365 mmc host 句柄 ** data -> DMA传送数据结构句柄 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void mmc_dm365_send_dma_request(struct mmc_dm365_host *host, struct rt_mmcsd_data *data) { //struct EDMA3CCPaRAMEntry *template; struct edmacc_param *template; rt_uint32_t buf_ptr; rt_uint32_t channel; rt_uint32_t bytes_left = host->bytes_left; rt_uint32_t count = host->bytes_left; const rt_uint32_t shift = ffs(rw_threshold) - 1; if (host->use_dma_buffer == RT_TRUE) buf_ptr = host->dma_buffer;//MMU_NOCACHE_ADDR(host->dma_buffer); else buf_ptr = (rt_uint32_t)data->buf; if (host->data_dir == DM365_MMC_DATADIR_WRITE) { template = &host->tx_template; channel = host->txdma; } else { template = &host->rx_template; channel = host->rxdma; } template->link_bcntrld = 0xffff; //template->bCntReload = 0x0; if (count > bytes_left) count = bytes_left; bytes_left -= count; if (host->data_dir == DM365_MMC_DATADIR_WRITE) template->src = buf_ptr; else template->dst = buf_ptr; template->ccnt = count >> shift; edma_write_slot(channel, template); edma_clear_event(channel); /*EDMA3SetPaRAM(EDMA0CC0_REG_BASE, channel, template); EDMA3ClrEvt(EDMA0CC0_REG_BASE, channel); EDMA3EnableTransfer(EDMA0CC0_REG_BASE, channel, EDMA3_TRIG_MODE_EVENT);*/ edma_start(channel); } /******************************************************************************************************* ** 函数名称: mmc_dm365_start_dma_transfer() ** 功能描述: 开始DMA传输 ** ** 输　入: host -> DM365 mmc host 句柄 ** data -> DMA传送数据结构句柄 ** ** 输　出: DMA传输字节数 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static int mmc_dm365_start_dma_transfer(struct mmc_dm365_host *host, struct rt_mmcsd_data *data) { /* set initial value */ host->use_dma_buffer = RT_FALSE; if (!(data->flags & DATA_DIR_READ)) { if ((rt_uint32_t)data->buf & (RT_ALIGN_SIZE - 1)) { /* not align to basic size, use DMA buffer */ host->use_dma_buffer = RT_TRUE; memcpy((void*)MMU_NOCACHE_ADDR(host->dma_buffer), data->buf, data->blks * data->blksize); } else { rt_uint32_t addr; addr = ((rt_uint32_t)data->buf & ~(CACHE_LINE_SIZE - 1)); /* write data case, always clean DCache */ mmu_clean_dcache(addr, (data->blks + 1)* data->blksize); } } else { /* whether align to cache line in read operation */ if (((rt_uint32_t)data->buf) & (CACHE_LINE_SIZE - 1)) host->use_dma_buffer = RT_TRUE; else mmu_invalidate_dcache((rt_uint32_t)data->buf, data->blks * data->blksize); } host->do_dma = RT_TRUE; mmc_dm365_send_dma_request(host, data); return 0; } #if 0 /******************************************************************************************************* ** 函数名称: acquire_dma_channels() ** 功能描述: 获取DMA channel ** ** 输　入: host -> DM365 mmc host 句柄 ** ** 输　出: DMA 通道号 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static int acquire_dma_channels(struct mmc_dm365_host *host) { int r; /* Acquire master DMA write channel */ r = EDMA3RequestChannel(EDMA0CC0_REG_BASE, EDMA3_CHANNEL_TYPE_DMA, host->txdma, host->txdma, EVT_QUEUE_NUM); if (r < 0) { rt_kprintf("alloc %s channel err %d\n", "tx", r); return r; } mmc_dm365_dma_setup(host, RT_TRUE, &host->tx_template); /* Acquire master DMA read channel */ r = EDMA3RequestChannel(EDMA0CC0_REG_BASE, EDMA3_CHANNEL_TYPE_DMA, host->rxdma, host->rxdma, EVT_QUEUE_NUM); if (r < 0) { rt_kprintf("alloc %s channel err %d\n", "rx", r); goto free_master_write; } mmc_dm365_dma_setup(host, RT_FALSE, &host->rx_template); return 0; free_master_write: EDMA3FreeChannel(EDMA0CC0_REG_BASE, EDMA3_CHANNEL_TYPE_DMA, host->txdma, EDMA3_TRIG_MODE_EVENT, host->txdma, EVT_QUEUE_NUM); return r; } #endif static int acquire_dma_channels(struct mmc_dm365_host *host) { //u32 link_size; int r, i; /* Acquire master DMA write channel */ r = edma_alloc_channel(host->txdma, mmc_dm365_dma_cb, host, EVENTQ_DEFAULT); if (r < 0) { mmc_dbg("alloc %s channel err %d\n", "tx", r); return r; } mmc_dm365_dma_setup(host, RT_TRUE, &host->tx_template); /* Acquire master DMA read channel */ r = edma_alloc_channel(host->rxdma, mmc_dm365_dma_cb, host, EVENTQ_DEFAULT); if (r < 0) { mmc_dbg("alloc %s channel err %d\n", "rx", r); goto free_master_write; } mmc_dm365_dma_setup(host, RT_FALSE, &host->rx_template); /* Allocate parameter RAM slots, which will later be bound to a * channel as needed to handle a scatterlist. */ #if 0 link_size = min_t(unsigned, host->nr_sg, ARRAY_SIZE(host->links)); for (i = 0; i < link_size; i++) { r = edma_alloc_slot(EDMA_CTLR(host->txdma), EDMA_SLOT_ANY); if (r < 0) { mmc_dbg("dma PaRAM alloc --> %d\n", r); break; } host->links[i] = r; } host->n_link = i; #endif return 0; free_master_write: edma_free_channel(host->txdma); return r; } /******************************************************************************************************* ** 函数名称: mmc_dm365_prepare_data() ** 功能描述: 准备 DMA 数据 ** ** 输　入: host -> DM365 mmc host 句柄 ** req -> SD request 结构句柄 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void mmc_dm365_prepare_data(struct mmc_dm365_host *host, struct rt_mmcsd_req *req) { int timeout; int fifo_lev; struct rt_mmcsd_data *data = req->data; fifo_lev = (rw_threshold == 64) ? MMCFIFOCTL_FIFOLEV : 0; host->data = data; if (data == RT_NULL) { host->data_dir = DM365_MMC_DATADIR_NONE; host->mmcsd_regs->MMCBLEN = 0; host->mmcsd_regs->MMCNBLK = 0; return; } mmc_dbg("%s %s, %d blocks of %d bytes\n", (data->flags & DATA_STREAM) ? "stream" : "block", (data->flags & DATA_DIR_WRITE) ? "write" : "read", data->blks, data->blksize); mmc_dbg(" DTO %d cycles + %d ns\n", data->timeout_clks, data->timeout_ns); timeout = data->timeout_clks + (data->timeout_ns / host->ns_in_one_cycle); if (timeout > 0xffff) timeout = 0xffff; host->mmcsd_regs->MMCTOD = timeout; host->mmcsd_regs->MMCNBLK = data->blks; host->mmcsd_regs->MMCBLEN = data->blksize; /* Configure the FIFO */ switch (data->flags & DATA_DIR_WRITE) { case DATA_DIR_WRITE: host->data_dir = DM365_MMC_DATADIR_WRITE; host->mmcsd_regs->MMCFIFOCTL = fifo_lev | MMCFIFOCTL_FIFODIR_WR | MMCFIFOCTL_FIFORST; host->mmcsd_regs->MMCFIFOCTL = fifo_lev | MMCFIFOCTL_FIFODIR_WR; break; default: host->data_dir = DM365_MMC_DATADIR_READ; host->mmcsd_regs->MMCFIFOCTL = fifo_lev | MMCFIFOCTL_FIFODIR_RD | MMCFIFOCTL_FIFORST; host->mmcsd_regs->MMCFIFOCTL = fifo_lev | MMCFIFOCTL_FIFODIR_RD; break; } host->buffer = RT_NULL; host->bytes_left = data->blks * data->blksize; /* For now we try to use DMA whenever we won't need partial FIFO * reads or writes, either for the whole transfer (as tested here) * or for any individual scatterlist segment (tested when we call * start_dma_transfer). * * While we *could* change that, unusual block sizes are rarely * used. The occasional fallback to PIO should't hurt. */ if ((host->use_dma == RT_TRUE) && (host->bytes_left & (rw_threshold - 1)) == 0 && mmc_dm365_start_dma_transfer(host, data) == 0) { /* zero this to ensure we take no PIO paths */ host->bytes_left = 0; } else { /* Revert to CPU Copy */ host->buffer = (rt_uint8_t*)req->data->buf; } } /******************************************************************************************************* ** 函数名称: mmc_dm365_request() ** 功能描述: 此函数实现SD request操作 ** ** 输　入: host -> DM365 mmc host 句柄 ** req -> SD request 结构句柄 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void mmc_dm365_request(struct rt_mmcsd_host *mmc, struct rt_mmcsd_req *req) { struct mmc_dm365_host *host = mmc_priv(mmc); unsigned long timeout = rt_tick_get() + 900; rt_uint32_t mmcst1 = 0; /* Card may still be sending BUSY after a previous operation, * typically some kind of write. If so, we can't proceed yet. */ while (rt_tick_get() < timeout) { mmcst1 = host->mmcsd_regs->MMCST1; if (!(mmcst1 & MMCST1_BUSY)) break; } if (mmcst1 & MMCST1_BUSY) { mmc_dbg("still BUSY? bad ... \n"); req->cmd->err = -RT_ETIMEOUT; mmc_request_done(mmc, req); return; } host->do_dma = RT_FALSE; mmc_dm365_prepare_data(host, req); mmc_dm365_start_command(host, req->cmd); } static void mmc_dm365_enable_sdio_irq(struct rt_mmcsd_host *mmc, rt_int32_t enable) { struct mmc_dm365_host *host = mmc_priv(mmc); if (enable) { if (!(host->mmcsd_regs->SDIOST0 & SDIOST0_DAT1_HI)) { host->mmcsd_regs->SDIOIST = SDIOIST_IOINT; sdio_irq_wakeup(host->mmc); } else { host->sdio_int = RT_TRUE; host->mmcsd_regs->SDIOIEN |= SDIOIEN_IOINTEN; } } else { host->sdio_int = RT_FALSE; host->mmcsd_regs->SDIOIEN &= ~SDIOIEN_IOINTEN; } } static const struct rt_mmcsd_host_ops mmc_dm365_ops = { mmc_dm365_request, mmc_dm365_set_ios, RT_NULL, mmc_dm365_enable_sdio_irq }; /******************************************************************************************************* ** 函数名称: mmc_dm365_reset_ctrl() ** 功能描述: 此函数用于reset mmc控制器 ** ** 输　入: host -> DM365 mmc host 句柄 ** val -> 判断做reset还是enable ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void mmc_dm365_reset_ctrl(struct mmc_dm365_host *host, int val) { rt_uint32_t temp; temp = host->mmcsd_regs->MMCCTL; if (val) /* reset */ temp |= MMCCTL_CMDRST | MMCCTL_DATRST; else /* enable */ temp &= ~(MMCCTL_CMDRST | MMCCTL_DATRST); host->mmcsd_regs->MMCCTL = temp; delay_us(10); } /******************************************************************************************************* ** 函数名称: init_mmcsd_host() ** 功能描述: 此函数用于初始化DM365 MMCSD控制器 ** ** 输　入: host -> DM365 mmc host 句柄 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void init_mmcsd_host(struct mmc_dm365_host *host) { mmc_dm365_reset_ctrl(host, 1); host->mmcsd_regs->MMCCLK = 0; host->mmcsd_regs->MMCCLK = MMCCLK_CLKEN; host->mmcsd_regs->MMCTOR = 0x1FFF; host->mmcsd_regs->MMCTOD = 0xFFFF; mmc_dm365_reset_ctrl(host, 0); } /******************************************************************************************************* ** 函数名称: mmc_dm365_cmd_done() ** 功能描述: 结束SD 命令后调用此函数 ** ** 输　入: host -> DM365 mmc host 句柄 ** cmd -> SD 命令结构句柄 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void mmc_dm365_cmd_done(struct mmc_dm365_host *host, struct rt_mmcsd_cmd *cmd) { host->cmd = RT_NULL; if (resp_type(cmd) != RESP_NONE) { if (resp_type(cmd) == RESP_R2) { /* response type 2 */ cmd->resp[3] = host->mmcsd_regs->MMCRSP01; cmd->resp[2] = host->mmcsd_regs->MMCRSP23; cmd->resp[1] = host->mmcsd_regs->MMCRSP45; cmd->resp[0] = host->mmcsd_regs->MMCRSP67; } else { /* response types 1, 1b, 3, 4, 5, 6 */ cmd->resp[0] = host->mmcsd_regs->MMCRSP67; } } if (host->data == RT_NULL || cmd->err) { if (cmd->err == -RT_ETIMEOUT) cmd->mrq->cmd->retries = 0; mmc_request_done(host->mmc, cmd->mrq); host->mmcsd_regs->MMCIM = 0; } } /******************************************************************************************************* ** 函数名称: dm365_abort_data() ** 功能描述: 此函数用于终止数据传输 ** ** 输　入: host -> DM365 mmc host 句柄 ** data -> data 结构句柄 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void dm365_abort_data(struct mmc_dm365_host *host, struct rt_mmcsd_data *data) { mmc_dm365_reset_ctrl(host, 1); mmc_dm365_reset_ctrl(host, 0); } static void mmc_dm365_sdio_irq(int irq, void *param) { struct mmc_dm365_host *host = (struct mmc_dm365_host *)param; rt_uint32_t status; status = host->mmcsd_regs->SDIOIST;//readl(host->base + DAVINCI_SDIOIST); if (status & SDIOIST_IOINT) { mmc_dbg("SDIO interrupt status %x\n", status); //writel(status | SDIOIST_IOINT, host->base + DAVINCI_SDIOIST); host->mmcsd_regs->SDIOIST = status | SDIOIST_IOINT; sdio_irq_wakeup(host->mmc); } } /******************************************************************************************************* ** 函数名称: mmc_dm365_irq() ** 功能描述: MMCSD的中断处理程序 ** ** 输　入: irq ->中断向量号 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void mmc_dm365_irq(int irq, void *param) { struct mmc_dm365_host *host = (struct mmc_dm365_host *)param; rt_uint32_t status, qstatus; int end_command = 0; int end_transfer = 0; struct rt_mmcsd_data *data = host->data; if (host->cmd == RT_NULL && host->data == RT_NULL) { status = host->mmcsd_regs->MMCST0; mmc_dbg("Spurious interrupt 0x%04x\n", status); /* Disable the interrupt from mmcsd */ host->mmcsd_regs->MMCIM = 0; return; } status = host->mmcsd_regs->MMCST0; qstatus = status; /* handle FIFO first when using PIO for data. * bytes_left will decrease to zero as I/O progress and status will * read zero over iteration because this controller status * register(MMCST0) reports any status only once and it is cleared * by read. So, it is not unbouned loop even in the case of * non-dma. */ while (host->bytes_left && (status & (MMCST0_DXRDY | MMCST0_DRRDY))) { dm365_fifo_data_trans(host, rw_threshold); status = host->mmcsd_regs->MMCST0; if (!status) break; qstatus |= status; } if (qstatus & MMCST0_DATDNE) { /* All blocks sent/received, and CRC checks passed */ if (data != RT_NULL) { if ((host->do_dma == RT_FALSE) && (host->bytes_left > 0)) { /* if datasize < rw_threshold * no RX ints are generated */ rt_kprintf("to do! host->bytes_left=0x%x\n", host->bytes_left); dm365_fifo_data_trans(host, host->bytes_left); } end_transfer = 1; data->bytes_xfered = data->blks* data->blksize; } else { mmc_dbg("DATDNE with no host->data\n"); } } if (qstatus & MMCST0_TOUTRD) { /* Read data timeout */ data->err = -RT_ETIMEOUT; end_transfer = 1; mmc_dbg("read data timeout, status %x\n", qstatus); rt_kprintf("read data timeout, status %x\n", qstatus); dm365_abort_data(host, data); } if (qstatus & (MMCST0_CRCWR | MMCST0_CRCRD)) { /* Data CRC error */ data->err = -RT_ERROR; end_transfer = 1; /* NOTE: this controller uses CRCWR to report both CRC * errors and timeouts (on writes). MMCDRSP values are * only weakly documented, but 0x9f was clearly a timeout * case and the two three-bit patterns in various SD specs * (101, 010) aren't part of it ... */ if (qstatus & MMCST0_CRCWR) { rt_uint32_t temp = host->mmcsd_regs->MMCDRSP; if (temp == 0x9f) data->err = -RT_ETIMEOUT; } mmc_dbg("data %s %s error\n", (qstatus & MMCST0_CRCWR) ? "write" : "read", (data->err == -110) ? "timeout" : "CRC"); rt_kprintf("data %s %s error\n", (qstatus & MMCST0_CRCWR) ? "write" : "read", (data->err == -110) ? "timeout" : "CRC"); dm365_abort_data(host, data); } if (qstatus & MMCST0_TOUTRS) { /* Command timeout */ if (host->cmd) { mmc_dbg("CMD%d timeout, status %x\n", host->cmd->cmd_code, qstatus); host->cmd->err = -RT_ETIMEOUT; if (data) { end_transfer = 1; dm365_abort_data(host, data); } else end_command = 1; } } if (qstatus & MMCST0_CRCRS) { /* Command CRC error */ mmc_dbg("Command CRC error\n"); if (host->cmd) { host->cmd->err = -RT_ERROR; end_command = 1; } } if (qstatus & MMCST0_RSPDNE) { /* End of command phase */ end_command = (int) host->cmd; } if (end_command) mmc_dm365_cmd_done(host, host->cmd); if (end_transfer) mmc_dm365_xfer_done(host, data); return; } #if 0 /******************************************************************************************************* ** 函数名称: rt_hw_edma_init() ** 功能描述: 此函数用于初始化EDMA3 ** ** 输　入: 无 ** ** 输　出: 无 ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ static void rt_hw_edma_init(void) { psc_transition(PSC0, DOMAIN0, LPSC_TPCC, PSC_ENABLE); psc_transition(PSC0, DOMAIN0, LPSC_TPTC0, PSC_ENABLE); /* Initialization of EDMA3 */ edma3_init(EDMA0CC0_REG_BASE, EVT_QUEUE_NUM); /* Register EDMA3 Interrupts */ // ConfigureAINTCIntEDMA3(); } #endif /******************************************************************************************************* ** 函数名称: rt_hw_mmcsd_init() ** 功能描述: 此函数用于初始化MMC驱动模块 ** ** 输　入: 无 ** ** 输　出: 如果初始化成功，返回0；如果初始化失败，返回-RT_ENOMEM ** ** 全局变量: ** 调用模块: 无 ** ********************************************************************************************************/ int rt_hw_mmcsd_init(void) { struct clk *clk; struct mmc_dm365_host *dm365_host; struct rt_mmcsd_host *mmc = RT_NULL; mmc = mmcsd_alloc_host(); if (!mmc) { mmc_dbg("alloc mmc failed\n"); return -RT_ERROR; } dm365_host = rt_malloc(sizeof(struct mmc_dm365_host)); if (!dm365_host) { mmc_dbg("alloc mci failed\n"); goto err; } rt_memset(dm365_host, 0, sizeof(struct mmc_dm365_host)); #ifdef RT_USING_MMCSD0 //psc_transition(PSC0, DOMAIN0, LPSC_MMCSD0, PSC_ENABLE); //pinmux_config(PINMUX_MMCSD0_REG, PINMUX_MMCSD0_MASK, PINMUX_MMCSD0_VAL); psc_change_state(DAVINCI_DM365_LPSC_MMC_SD0, PSC_ENABLE); dm365_host->mmcsd_regs = (mmcsd_regs_t *)DM365_MMC_SD0_BASE; #else #ifdef RT_USING_MMCSD1 psc_transition(PSC1, DOMAIN0, LPSC_MMCSD1, PSC_ENABLE); pinmux_config(PINMUX_MMCSD1_REG, PINMUX_MMCSD1_MASK, PINMUX_MMCSD1_VAL); dm365_host->mmcsd_regs = MMCSD1; #endif #endif //rt_hw_edma_init(); clk = clk_get("MMCSDCLK0"); dm365_host->mmc_input_clk = clk_get_rate(clk); dm365_host->rxdma = DM365_DMA_MMC0RXEVT; dm365_host->txdma = DM365_DMA_MMC0TXEVT; dm365_host->use_dma = use_dma; if ((dm365_host->use_dma == RT_TRUE)&& acquire_dma_channels(dm365_host) != 0) { dm365_host->use_dma = RT_FALSE; } else { dm365_host->dma_buffer = (rt_uint8_t*)rt_malloc_align(64*1024, 32); if (dm365_host->dma_buffer == RT_NULL) dm365_host->use_dma = RT_FALSE; } mmc->ops = &mmc_dm365_ops; mmc->freq_min = 312500; mmc->freq_max = 25000000; mmc->valid_ocr = VDD_32_33 | VDD_33_34; mmc->flags = MMCSD_BUSWIDTH_4 | MMCSD_MUTBLKWRITE; mmc->flags |= MMCSD_SUP_SDIO_IRQ; dm365_host->mmc = mmc; mmc->private_data = dm365_host; /* install interrupt */ #ifdef RT_USING_MMCSD0 rt_hw_interrupt_install(IRQ_DM3XX_MMCINT0, mmc_dm365_irq, (void *)dm365_host, "MMC0"); rt_hw_interrupt_umask(IRQ_DM3XX_MMCINT0); rt_hw_interrupt_install(IRQ_DM3XX_SDIOINT0, mmc_dm365_sdio_irq, (void *)dm365_host, "SDIO0"); rt_hw_interrupt_umask(IRQ_DM3XX_SDIOINT0); #endif #ifdef RT_USING_MMCSD1 rt_hw_interrupt_install(MMCSD_INT1, mmc_dm365_irq, (void *)dm365_host, "MMC1"); rt_hw_interrupt_umask(MMCSD_INT1); #endif init_mmcsd_host(dm365_host); mmcsd_change(mmc); return 0; err: mmcsd_free_host(mmc); return -RT_ENOMEM; } INIT_DEVICE_EXPORT(rt_hw_mmcsd_init);