Lines Matching +full:bcm2835 +full:- +full:pm

1 // SPDX-License-Identifier: GPL-2.0
3 * bcm2835 sdhost driver.
21 * Copyright (C) 2015-2016 Raspberry Pi (Trading) Ltd.
24 * mmc-bcm2835.c by Gellert Weisz
26 * sdhci-bcm2708.c by Broadcom
27 * sdhci-bcm2835.c by Stephen Warren and Oleksandr Tymoshenko
28 * sdhci.c and sdhci-pci.c by Pierre Ossman
34 #include <linux/dma-mapping.h>
52 #define SDCMD 0x00 /* Command to SD card - 16 R/W */
53 #define SDARG 0x04 /* Argument to SD card - 32 R/W */
54 #define SDTOUT 0x08 /* Start value for timeout counter - 32 R/W */
55 #define SDCDIV 0x0c /* Start value for clock divider - 11 R/W */
56 #define SDRSP0 0x10 /* SD card response (31:0) - 32 R */
57 #define SDRSP1 0x14 /* SD card response (63:32) - 32 R */
58 #define SDRSP2 0x18 /* SD card response (95:64) - 32 R */
59 #define SDRSP3 0x1c /* SD card response (127:96) - 32 R */
60 #define SDHSTS 0x20 /* SD host status - 11 R/W */
61 #define SDVDD 0x30 /* SD card power control - 1 R/W */
62 #define SDEDM 0x34 /* Emergency Debug Mode - 13 R/W */
63 #define SDHCFG 0x38 /* Host configuration - 2 R/W */
64 #define SDHBCT 0x3c /* Host byte count (debug) - 32 R/W */
65 #define SDDATA 0x40 /* Data to/from SD card - 32 R/W */
66 #define SDHBLC 0x50 /* Host block count (SDIO/SDHC) - 9 R/W */
196 struct device *dev = &host->pdev->dev; in bcm2835_dumpcmd()
201 dev_dbg(dev, "%c%s op %d arg 0x%x flags 0x%x - resp %08x %08x %08x %08x, err %d\n", in bcm2835_dumpcmd()
202 (cmd == host->cmd) ? '>' : ' ', in bcm2835_dumpcmd()
203 label, cmd->opcode, cmd->arg, cmd->flags, in bcm2835_dumpcmd()
204 cmd->resp[0], cmd->resp[1], cmd->resp[2], cmd->resp[3], in bcm2835_dumpcmd()
205 cmd->error); in bcm2835_dumpcmd()
210 struct mmc_request *mrq = host->mrq; in bcm2835_dumpregs()
211 struct device *dev = &host->pdev->dev; in bcm2835_dumpregs()
214 bcm2835_dumpcmd(host, mrq->sbc, "sbc"); in bcm2835_dumpregs()
215 bcm2835_dumpcmd(host, mrq->cmd, "cmd"); in bcm2835_dumpregs()
216 if (mrq->data) { in bcm2835_dumpregs()
217 dev_dbg(dev, "data blocks %x blksz %x - err %d\n", in bcm2835_dumpregs()
218 mrq->data->blocks, in bcm2835_dumpregs()
219 mrq->data->blksz, in bcm2835_dumpregs()
220 mrq->data->error); in bcm2835_dumpregs()
222 bcm2835_dumpcmd(host, mrq->stop, "stop"); in bcm2835_dumpregs()
226 dev_dbg(dev, "SDCMD 0x%08x\n", readl(host->ioaddr + SDCMD)); in bcm2835_dumpregs()
227 dev_dbg(dev, "SDARG 0x%08x\n", readl(host->ioaddr + SDARG)); in bcm2835_dumpregs()
228 dev_dbg(dev, "SDTOUT 0x%08x\n", readl(host->ioaddr + SDTOUT)); in bcm2835_dumpregs()
229 dev_dbg(dev, "SDCDIV 0x%08x\n", readl(host->ioaddr + SDCDIV)); in bcm2835_dumpregs()
230 dev_dbg(dev, "SDRSP0 0x%08x\n", readl(host->ioaddr + SDRSP0)); in bcm2835_dumpregs()
231 dev_dbg(dev, "SDRSP1 0x%08x\n", readl(host->ioaddr + SDRSP1)); in bcm2835_dumpregs()
232 dev_dbg(dev, "SDRSP2 0x%08x\n", readl(host->ioaddr + SDRSP2)); in bcm2835_dumpregs()
233 dev_dbg(dev, "SDRSP3 0x%08x\n", readl(host->ioaddr + SDRSP3)); in bcm2835_dumpregs()
234 dev_dbg(dev, "SDHSTS 0x%08x\n", readl(host->ioaddr + SDHSTS)); in bcm2835_dumpregs()
235 dev_dbg(dev, "SDVDD 0x%08x\n", readl(host->ioaddr + SDVDD)); in bcm2835_dumpregs()
236 dev_dbg(dev, "SDEDM 0x%08x\n", readl(host->ioaddr + SDEDM)); in bcm2835_dumpregs()
237 dev_dbg(dev, "SDHCFG 0x%08x\n", readl(host->ioaddr + SDHCFG)); in bcm2835_dumpregs()
238 dev_dbg(dev, "SDHBCT 0x%08x\n", readl(host->ioaddr + SDHBCT)); in bcm2835_dumpregs()
239 dev_dbg(dev, "SDHBLC 0x%08x\n", readl(host->ioaddr + SDHBLC)); in bcm2835_dumpregs()
247 writel(SDVDD_POWER_OFF, host->ioaddr + SDVDD); in bcm2835_reset_internal()
248 writel(0, host->ioaddr + SDCMD); in bcm2835_reset_internal()
249 writel(0, host->ioaddr + SDARG); in bcm2835_reset_internal()
250 writel(0xf00000, host->ioaddr + SDTOUT); in bcm2835_reset_internal()
251 writel(0, host->ioaddr + SDCDIV); in bcm2835_reset_internal()
252 writel(0x7f8, host->ioaddr + SDHSTS); /* Write 1s to clear */ in bcm2835_reset_internal()
253 writel(0, host->ioaddr + SDHCFG); in bcm2835_reset_internal()
254 writel(0, host->ioaddr + SDHBCT); in bcm2835_reset_internal()
255 writel(0, host->ioaddr + SDHBLC); in bcm2835_reset_internal()
258 temp = readl(host->ioaddr + SDEDM); in bcm2835_reset_internal()
263 writel(temp, host->ioaddr + SDEDM); in bcm2835_reset_internal()
265 writel(SDVDD_POWER_ON, host->ioaddr + SDVDD); in bcm2835_reset_internal()
267 host->clock = 0; in bcm2835_reset_internal()
268 writel(host->hcfg, host->ioaddr + SDHCFG); in bcm2835_reset_internal()
269 writel(host->cdiv, host->ioaddr + SDCDIV); in bcm2835_reset_internal()
276 if (host->dma_chan) in bcm2835_reset()
277 dmaengine_terminate_sync(host->dma_chan); in bcm2835_reset()
278 host->dma_chan = NULL; in bcm2835_reset()
289 alternate_idle = (host->mrq->data->flags & MMC_DATA_READ) ? in bcm2835_wait_transfer_complete()
297 edm = readl(host->ioaddr + SDEDM); in bcm2835_wait_transfer_complete()
305 host->ioaddr + SDEDM); in bcm2835_wait_transfer_complete()
311 dev_err(&host->pdev->dev, in bcm2835_wait_transfer_complete()
312 "wait_transfer_complete - still waiting after %d retries\n", in bcm2835_wait_transfer_complete()
315 host->mrq->data->error = -ETIMEDOUT; in bcm2835_wait_transfer_complete()
326 schedule_work(&host->dma_work); in bcm2835_dma_complete()
334 blksize = host->data->blksz; in bcm2835_transfer_block_pio()
344 if (!sg_miter_next(&host->sg_miter)) { in bcm2835_transfer_block_pio()
345 host->data->error = -EINVAL; in bcm2835_transfer_block_pio()
349 len = min(host->sg_miter.length, blksize); in bcm2835_transfer_block_pio()
351 host->data->error = -EINVAL; in bcm2835_transfer_block_pio()
355 blksize -= len; in bcm2835_transfer_block_pio()
356 host->sg_miter.consumed = len; in bcm2835_transfer_block_pio()
358 buf = (u32 *)host->sg_miter.addr; in bcm2835_transfer_block_pio()
367 edm = readl(host->ioaddr + SDEDM); in bcm2835_transfer_block_pio()
371 words = SDDATA_FIFO_WORDS - ((edm >> 4) & 0x1f); in bcm2835_transfer_block_pio()
375 struct device *dev = &host->pdev->dev; in bcm2835_transfer_block_pio()
385 hsts = readl(host->ioaddr + SDHSTS); in bcm2835_transfer_block_pio()
393 dev_err(dev, "PIO %s timeout - EDM %08x\n", in bcm2835_transfer_block_pio()
399 ndelay((burst_words - words) * in bcm2835_transfer_block_pio()
400 host->ns_per_fifo_word); in bcm2835_transfer_block_pio()
406 copy_words -= words; in bcm2835_transfer_block_pio()
410 *(buf++) = readl(host->ioaddr + SDDATA); in bcm2835_transfer_block_pio()
412 writel(*(buf++), host->ioaddr + SDDATA); in bcm2835_transfer_block_pio()
413 words--; in bcm2835_transfer_block_pio()
421 sg_miter_stop(&host->sg_miter); in bcm2835_transfer_block_pio()
426 struct device *dev = &host->pdev->dev; in bcm2835_transfer_pio()
430 is_read = (host->data->flags & MMC_DATA_READ) != 0; in bcm2835_transfer_pio()
433 sdhsts = readl(host->ioaddr + SDHSTS); in bcm2835_transfer_pio()
437 dev_err(dev, "%s transfer error - HSTS %08x\n", in bcm2835_transfer_pio()
439 host->data->error = -EILSEQ; in bcm2835_transfer_pio()
442 dev_err(dev, "%s timeout error - HSTS %08x\n", in bcm2835_transfer_pio()
444 host->data->error = -ETIMEDOUT; in bcm2835_transfer_pio()
455 dma_chan = host->dma_chan_rxtx; in bcm2835_prepare_dma()
456 if (data->flags & MMC_DATA_READ) { in bcm2835_prepare_dma()
465 * multi-block transfers, so don't attempt to DMA the final in bcm2835_prepare_dma()
471 host->drain_words = 0; in bcm2835_prepare_dma()
472 if ((data->blocks > 1) && (dir_data == DMA_FROM_DEVICE)) { in bcm2835_prepare_dma()
477 len = min((u32)(FIFO_READ_THRESHOLD - 1) * 4, in bcm2835_prepare_dma()
478 (u32)data->blocks * data->blksz); in bcm2835_prepare_dma()
480 for_each_sg(data->sg, sg, data->sg_len, i) { in bcm2835_prepare_dma()
482 WARN_ON(sg->length < len); in bcm2835_prepare_dma()
483 sg->length -= len; in bcm2835_prepare_dma()
484 host->drain_page = sg_page(sg); in bcm2835_prepare_dma()
485 host->drain_offset = sg->offset + sg->length; in bcm2835_prepare_dma()
488 host->drain_words = len / 4; in bcm2835_prepare_dma()
494 &host->dma_cfg_rx : in bcm2835_prepare_dma()
495 &host->dma_cfg_tx); in bcm2835_prepare_dma()
497 sg_len = dma_map_sg(dma_chan->device->dev, data->sg, data->sg_len, in bcm2835_prepare_dma()
502 desc = dmaengine_prep_slave_sg(dma_chan, data->sg, sg_len, dir_slave, in bcm2835_prepare_dma()
506 dma_unmap_sg(dma_chan->device->dev, data->sg, sg_len, dir_data); in bcm2835_prepare_dma()
510 desc->callback = bcm2835_dma_complete; in bcm2835_prepare_dma()
511 desc->callback_param = host; in bcm2835_prepare_dma()
512 host->dma_desc = desc; in bcm2835_prepare_dma()
513 host->dma_chan = dma_chan; in bcm2835_prepare_dma()
514 host->dma_dir = dir_data; in bcm2835_prepare_dma()
519 dmaengine_submit(host->dma_desc); in bcm2835_start_dma()
520 dma_async_issue_pending(host->dma_chan); in bcm2835_start_dma()
528 if (host->dma_desc) { in bcm2835_set_transfer_irqs()
529 host->hcfg = (host->hcfg & ~all_irqs) | in bcm2835_set_transfer_irqs()
532 host->hcfg = (host->hcfg & ~all_irqs) | in bcm2835_set_transfer_irqs()
537 writel(host->hcfg, host->ioaddr + SDHCFG); in bcm2835_set_transfer_irqs()
543 struct mmc_data *data = cmd->data; in bcm2835_prepare_data()
545 WARN_ON(host->data); in bcm2835_prepare_data()
547 host->data = data; in bcm2835_prepare_data()
551 host->data_complete = false; in bcm2835_prepare_data()
552 host->data->bytes_xfered = 0; in bcm2835_prepare_data()
554 if (!host->dma_desc) { in bcm2835_prepare_data()
558 if (data->flags & MMC_DATA_READ) in bcm2835_prepare_data()
562 sg_miter_start(&host->sg_miter, data->sg, data->sg_len, flags); in bcm2835_prepare_data()
563 host->blocks = data->blocks; in bcm2835_prepare_data()
568 writel(data->blksz, host->ioaddr + SDHBCT); in bcm2835_prepare_data()
569 writel(data->blocks, host->ioaddr + SDHBLC); in bcm2835_prepare_data()
574 struct device *dev = &host->pdev->dev; in bcm2835_read_wait_sdcmd()
578 ret = readl_poll_timeout(host->ioaddr + SDCMD, value, in bcm2835_read_wait_sdcmd()
580 if (ret == -ETIMEDOUT) in bcm2835_read_wait_sdcmd()
582 ret = readl_poll_timeout(host->ioaddr + SDCMD, value, in bcm2835_read_wait_sdcmd()
585 if (ret == -ETIMEDOUT) in bcm2835_read_wait_sdcmd()
596 cancel_delayed_work(&host->timeout_work); in bcm2835_finish_request()
598 mrq = host->mrq; in bcm2835_finish_request()
600 host->mrq = NULL; in bcm2835_finish_request()
601 host->cmd = NULL; in bcm2835_finish_request()
602 host->data = NULL; in bcm2835_finish_request()
604 host->dma_desc = NULL; in bcm2835_finish_request()
605 terminate_chan = host->dma_chan; in bcm2835_finish_request()
606 host->dma_chan = NULL; in bcm2835_finish_request()
612 dev_err(&host->pdev->dev, in bcm2835_finish_request()
622 struct device *dev = &host->pdev->dev; in bcm2835_send_command()
626 WARN_ON(host->cmd); in bcm2835_send_command()
632 cmd->error = -EILSEQ; in bcm2835_send_command()
637 if (!cmd->data && cmd->busy_timeout > 9000) in bcm2835_send_command()
638 timeout = DIV_ROUND_UP(cmd->busy_timeout, 1000) * HZ + HZ; in bcm2835_send_command()
641 schedule_delayed_work(&host->timeout_work, timeout); in bcm2835_send_command()
643 host->cmd = cmd; in bcm2835_send_command()
646 sdhsts = readl(host->ioaddr + SDHSTS); in bcm2835_send_command()
648 writel(sdhsts, host->ioaddr + SDHSTS); in bcm2835_send_command()
650 if ((cmd->flags & MMC_RSP_136) && (cmd->flags & MMC_RSP_BUSY)) { in bcm2835_send_command()
652 cmd->error = -EINVAL; in bcm2835_send_command()
659 writel(cmd->arg, host->ioaddr + SDARG); in bcm2835_send_command()
661 sdcmd = cmd->opcode & SDCMD_CMD_MASK; in bcm2835_send_command()
663 host->use_busy = false; in bcm2835_send_command()
664 if (!(cmd->flags & MMC_RSP_PRESENT)) { in bcm2835_send_command()
667 if (cmd->flags & MMC_RSP_136) in bcm2835_send_command()
669 if (cmd->flags & MMC_RSP_BUSY) { in bcm2835_send_command()
671 host->use_busy = true; in bcm2835_send_command()
675 if (cmd->data) { in bcm2835_send_command()
676 if (cmd->data->flags & MMC_DATA_WRITE) in bcm2835_send_command()
678 if (cmd->data->flags & MMC_DATA_READ) in bcm2835_send_command()
682 writel(sdcmd | SDCMD_NEW_FLAG, host->ioaddr + SDCMD); in bcm2835_send_command()
691 WARN_ON(!host->data_complete); in bcm2835_transfer_complete()
693 data = host->data; in bcm2835_transfer_complete()
694 host->data = NULL; in bcm2835_transfer_complete()
696 /* Need to send CMD12 if - in bcm2835_transfer_complete()
697 * a) open-ended multiblock transfer (no CMD23) in bcm2835_transfer_complete()
700 if (host->mrq->stop && (data->error || !host->use_sbc)) { in bcm2835_transfer_complete()
701 if (bcm2835_send_command(host, host->mrq->stop)) { in bcm2835_transfer_complete()
703 if (!host->use_busy) in bcm2835_transfer_complete()
714 struct device *dev = &host->pdev->dev; in bcm2835_finish_data()
717 data = host->data; in bcm2835_finish_data()
719 host->hcfg &= ~(SDHCFG_DATA_IRPT_EN | SDHCFG_BLOCK_IRPT_EN); in bcm2835_finish_data()
720 writel(host->hcfg, host->ioaddr + SDHCFG); in bcm2835_finish_data()
722 data->bytes_xfered = data->error ? 0 : (data->blksz * data->blocks); in bcm2835_finish_data()
724 host->data_complete = true; in bcm2835_finish_data()
726 if (host->cmd) { in bcm2835_finish_data()
731 dev_dbg(dev, "Finished early - HSTS %08x\n", in bcm2835_finish_data()
732 readl(host->ioaddr + SDHSTS)); in bcm2835_finish_data()
740 struct device *dev = &host->pdev->dev; in bcm2835_finish_command()
741 struct mmc_command *cmd = host->cmd; in bcm2835_finish_command()
750 host->cmd->error = -EIO; in bcm2835_finish_command()
754 u32 sdhsts = readl(host->ioaddr + SDHSTS); in bcm2835_finish_command()
757 writel(SDHSTS_ERROR_MASK, host->ioaddr + SDHSTS); in bcm2835_finish_command()
760 (host->cmd->opcode != MMC_SEND_OP_COND)) { in bcm2835_finish_command()
764 host->cmd->error = -ETIMEDOUT; in bcm2835_finish_command()
767 host->cmd->opcode); in bcm2835_finish_command()
769 host->cmd->error = -EILSEQ; in bcm2835_finish_command()
771 edm = readl(host->ioaddr + SDEDM); in bcm2835_finish_command()
777 host->ioaddr + SDEDM); in bcm2835_finish_command()
783 if (cmd->flags & MMC_RSP_PRESENT) { in bcm2835_finish_command()
784 if (cmd->flags & MMC_RSP_136) { in bcm2835_finish_command()
788 cmd->resp[3 - i] = in bcm2835_finish_command()
789 readl(host->ioaddr + SDRSP0 + i * 4); in bcm2835_finish_command()
792 cmd->resp[0] = readl(host->ioaddr + SDRSP0); in bcm2835_finish_command()
796 if (cmd == host->mrq->sbc) { in bcm2835_finish_command()
798 host->cmd = NULL; in bcm2835_finish_command()
799 if (bcm2835_send_command(host, host->mrq->cmd)) { in bcm2835_finish_command()
800 if (host->data && host->dma_desc) in bcm2835_finish_command()
806 if (!host->use_busy) in bcm2835_finish_command()
809 } else if (cmd == host->mrq->stop) { in bcm2835_finish_command()
814 host->cmd = NULL; in bcm2835_finish_command()
815 if (!host->data) in bcm2835_finish_command()
817 else if (host->data_complete) in bcm2835_finish_command()
827 struct device *dev = &host->pdev->dev; in bcm2835_timeout()
829 mutex_lock(&host->mutex); in bcm2835_timeout()
831 if (host->mrq) { in bcm2835_timeout()
837 if (host->data) { in bcm2835_timeout()
838 host->data->error = -ETIMEDOUT; in bcm2835_timeout()
841 if (host->cmd) in bcm2835_timeout()
842 host->cmd->error = -ETIMEDOUT; in bcm2835_timeout()
844 host->mrq->cmd->error = -ETIMEDOUT; in bcm2835_timeout()
850 mutex_unlock(&host->mutex); in bcm2835_timeout()
855 struct device *dev = &host->pdev->dev; in bcm2835_check_cmd_error()
860 if (!host->cmd) in bcm2835_check_cmd_error()
865 host->cmd->error = -EILSEQ; in bcm2835_check_cmd_error()
868 if (host->mrq->data) in bcm2835_check_cmd_error()
869 host->mrq->data->error = -EILSEQ; in bcm2835_check_cmd_error()
871 host->cmd->error = -EILSEQ; in bcm2835_check_cmd_error()
873 if (host->mrq->data) in bcm2835_check_cmd_error()
874 host->mrq->data->error = -ETIMEDOUT; in bcm2835_check_cmd_error()
876 host->cmd->error = -ETIMEDOUT; in bcm2835_check_cmd_error()
878 host->cmd->error = -ETIMEDOUT; in bcm2835_check_cmd_error()
886 if (!host->data) in bcm2835_check_data_error()
889 host->data->error = -EILSEQ; in bcm2835_check_data_error()
891 host->data->error = -ETIMEDOUT; in bcm2835_check_data_error()
896 if (WARN_ON(!host->cmd)) { in bcm2835_busy_irq()
901 if (WARN_ON(!host->use_busy)) { in bcm2835_busy_irq()
905 host->use_busy = false; in bcm2835_busy_irq()
918 if (!host->data) in bcm2835_data_irq()
922 if (host->data->error) in bcm2835_data_irq()
925 if (host->data->flags & MMC_DATA_WRITE) { in bcm2835_data_irq()
927 host->hcfg &= ~(SDHCFG_DATA_IRPT_EN); in bcm2835_data_irq()
928 host->hcfg |= SDHCFG_BLOCK_IRPT_EN; in bcm2835_data_irq()
929 writel(host->hcfg, host->ioaddr + SDHCFG); in bcm2835_data_irq()
933 host->blocks--; in bcm2835_data_irq()
934 if ((host->blocks == 0) || host->data->error) in bcm2835_data_irq()
940 host->hcfg &= ~(SDHCFG_DATA_IRPT_EN | SDHCFG_BLOCK_IRPT_EN); in bcm2835_data_irq()
941 writel(host->hcfg, host->ioaddr + SDHCFG); in bcm2835_data_irq()
946 if (!host->data) in bcm2835_data_threaded_irq()
948 if ((host->blocks == 0) || host->data->error) in bcm2835_data_threaded_irq()
954 if (WARN_ON(!host->data)) { in bcm2835_block_irq()
959 if (!host->dma_desc) { in bcm2835_block_irq()
960 WARN_ON(!host->blocks); in bcm2835_block_irq()
961 if (host->data->error || (--host->blocks == 0)) in bcm2835_block_irq()
965 } else if (host->data->flags & MMC_DATA_WRITE) { in bcm2835_block_irq()
976 spin_lock(&host->lock); in bcm2835_irq()
978 intmask = readl(host->ioaddr + SDHSTS); in bcm2835_irq()
984 host->ioaddr + SDHSTS); in bcm2835_irq()
988 host->irq_block = true; in bcm2835_irq()
994 host->irq_busy = true; in bcm2835_irq()
1006 (host->hcfg & SDHCFG_DATA_IRPT_EN)) { in bcm2835_irq()
1008 host->irq_data = true; in bcm2835_irq()
1012 spin_unlock(&host->lock); in bcm2835_irq()
1023 spin_lock_irqsave(&host->lock, flags); in bcm2835_threaded_irq()
1025 block = host->irq_block; in bcm2835_threaded_irq()
1026 busy = host->irq_busy; in bcm2835_threaded_irq()
1027 data = host->irq_data; in bcm2835_threaded_irq()
1028 host->irq_block = false; in bcm2835_threaded_irq()
1029 host->irq_busy = false; in bcm2835_threaded_irq()
1030 host->irq_data = false; in bcm2835_threaded_irq()
1032 spin_unlock_irqrestore(&host->lock, flags); in bcm2835_threaded_irq()
1034 mutex_lock(&host->mutex); in bcm2835_threaded_irq()
1043 mutex_unlock(&host->mutex); in bcm2835_threaded_irq()
1054 mutex_lock(&host->mutex); in bcm2835_dma_complete_work()
1056 data = host->data; in bcm2835_dma_complete_work()
1058 if (host->dma_chan) { in bcm2835_dma_complete_work()
1059 dma_unmap_sg(host->dma_chan->device->dev, in bcm2835_dma_complete_work()
1060 data->sg, data->sg_len, in bcm2835_dma_complete_work()
1061 host->dma_dir); in bcm2835_dma_complete_work()
1063 host->dma_chan = NULL; in bcm2835_dma_complete_work()
1066 if (host->drain_words) { in bcm2835_dma_complete_work()
1070 if (host->drain_offset & PAGE_MASK) { in bcm2835_dma_complete_work()
1071 host->drain_page += host->drain_offset >> PAGE_SHIFT; in bcm2835_dma_complete_work()
1072 host->drain_offset &= ~PAGE_MASK; in bcm2835_dma_complete_work()
1074 page = kmap_local_page(host->drain_page); in bcm2835_dma_complete_work()
1075 buf = page + host->drain_offset; in bcm2835_dma_complete_work()
1077 while (host->drain_words) { in bcm2835_dma_complete_work()
1078 u32 edm = readl(host->ioaddr + SDEDM); in bcm2835_dma_complete_work()
1081 *(buf++) = readl(host->ioaddr + SDDATA); in bcm2835_dma_complete_work()
1082 host->drain_words--; in bcm2835_dma_complete_work()
1090 mutex_unlock(&host->mutex); in bcm2835_dma_complete_work()
1098 /* The SDCDIV register has 11 bits, and holds (div - 2). But in bcm2835_set_clock()
1103 * must be 100-400KHz, so can range check the requested in bcm2835_set_clock()
1107 * clock 250MHz -> 0->125MHz, 1->83.3MHz, 2->62.5MHz, 3->50.0MHz in bcm2835_set_clock()
1108 * 4->41.7MHz, 5->35.7MHz, 6->31.3MHz, 7->27.8MHz in bcm2835_set_clock()
1110 * 623->400KHz/27.8MHz in bcm2835_set_clock()
1111 * reset value (507)->491159/50MHz in bcm2835_set_clock()
1113 * BUT, the 3-bit clock divisor in data mode is too small if in bcm2835_set_clock()
1123 host->cdiv = SDCDIV_MAX_CDIV; in bcm2835_set_clock()
1124 writel(host->cdiv, host->ioaddr + SDCDIV); in bcm2835_set_clock()
1128 div = host->max_clk / clock; in bcm2835_set_clock()
1131 if ((host->max_clk / div) > clock) in bcm2835_set_clock()
1133 div -= 2; in bcm2835_set_clock()
1138 clock = host->max_clk / (div + 2); in bcm2835_set_clock()
1139 mmc->actual_clock = clock; in bcm2835_set_clock()
1143 host->ns_per_fifo_word = (1000000000 / clock) * in bcm2835_set_clock()
1144 ((mmc->caps & MMC_CAP_4_BIT_DATA) ? 8 : 32); in bcm2835_set_clock()
1146 host->cdiv = div; in bcm2835_set_clock()
1147 writel(host->cdiv, host->ioaddr + SDCDIV); in bcm2835_set_clock()
1150 writel(mmc->actual_clock / 2, host->ioaddr + SDTOUT); in bcm2835_set_clock()
1156 struct device *dev = &host->pdev->dev; in bcm2835_request()
1160 if (mrq->sbc) in bcm2835_request()
1161 mrq->sbc->error = 0; in bcm2835_request()
1162 if (mrq->cmd) in bcm2835_request()
1163 mrq->cmd->error = 0; in bcm2835_request()
1164 if (mrq->data) in bcm2835_request()
1165 mrq->data->error = 0; in bcm2835_request()
1166 if (mrq->stop) in bcm2835_request()
1167 mrq->stop->error = 0; in bcm2835_request()
1169 if (mrq->data && !is_power_of_2(mrq->data->blksz)) { in bcm2835_request()
1171 mrq->data->blksz); in bcm2835_request()
1173 if (mrq->cmd) in bcm2835_request()
1174 mrq->cmd->error = -EINVAL; in bcm2835_request()
1180 mutex_lock(&host->mutex); in bcm2835_request()
1182 WARN_ON(host->mrq); in bcm2835_request()
1183 host->mrq = mrq; in bcm2835_request()
1185 edm = readl(host->ioaddr + SDEDM); in bcm2835_request()
1191 readl(host->ioaddr + SDCMD) & SDCMD_CMD_MASK, in bcm2835_request()
1195 if (mrq->cmd) in bcm2835_request()
1196 mrq->cmd->error = -EILSEQ; in bcm2835_request()
1199 mutex_unlock(&host->mutex); in bcm2835_request()
1203 if (host->use_dma && mrq->data && (mrq->data->blocks > PIO_THRESHOLD)) in bcm2835_request()
1204 bcm2835_prepare_dma(host, mrq->data); in bcm2835_request()
1206 host->use_sbc = !!mrq->sbc && host->mrq->data && in bcm2835_request()
1207 (host->mrq->data->flags & MMC_DATA_READ); in bcm2835_request()
1208 if (host->use_sbc) { in bcm2835_request()
1209 if (bcm2835_send_command(host, mrq->sbc)) { in bcm2835_request()
1210 if (!host->use_busy) in bcm2835_request()
1213 } else if (mrq->cmd && bcm2835_send_command(host, mrq->cmd)) { in bcm2835_request()
1214 if (host->data && host->dma_desc) { in bcm2835_request()
1219 if (!host->use_busy) in bcm2835_request()
1223 mutex_unlock(&host->mutex); in bcm2835_request()
1230 mutex_lock(&host->mutex); in bcm2835_set_ios()
1232 if (!ios->clock || ios->clock != host->clock) { in bcm2835_set_ios()
1233 bcm2835_set_clock(host, ios->clock); in bcm2835_set_ios()
1234 host->clock = ios->clock; in bcm2835_set_ios()
1238 host->hcfg &= ~SDHCFG_WIDE_EXT_BUS; in bcm2835_set_ios()
1239 if (ios->bus_width == MMC_BUS_WIDTH_4) in bcm2835_set_ios()
1240 host->hcfg |= SDHCFG_WIDE_EXT_BUS; in bcm2835_set_ios()
1242 host->hcfg |= SDHCFG_WIDE_INT_BUS; in bcm2835_set_ios()
1245 host->hcfg |= SDHCFG_SLOW_CARD; in bcm2835_set_ios()
1247 writel(host->hcfg, host->ioaddr + SDHCFG); in bcm2835_set_ios()
1249 mutex_unlock(&host->mutex); in bcm2835_set_ios()
1261 struct device *dev = &host->pdev->dev; in bcm2835_add_host()
1265 if (!mmc->f_max || mmc->f_max > host->max_clk) in bcm2835_add_host()
1266 mmc->f_max = host->max_clk; in bcm2835_add_host()
1267 mmc->f_min = host->max_clk / SDCDIV_MAX_CDIV; in bcm2835_add_host()
1269 mmc->max_busy_timeout = ~0 / (mmc->f_max / 1000); in bcm2835_add_host()
1272 mmc->f_max, mmc->f_min, mmc->max_busy_timeout); in bcm2835_add_host()
1275 mmc->caps |= MMC_CAP_SD_HIGHSPEED | MMC_CAP_MMC_HIGHSPEED | in bcm2835_add_host()
1278 spin_lock_init(&host->lock); in bcm2835_add_host()
1279 mutex_init(&host->mutex); in bcm2835_add_host()
1281 if (!host->dma_chan_rxtx) { in bcm2835_add_host()
1283 host->use_dma = false; in bcm2835_add_host()
1285 host->use_dma = true; in bcm2835_add_host()
1287 host->dma_cfg_tx.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; in bcm2835_add_host()
1288 host->dma_cfg_tx.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; in bcm2835_add_host()
1289 host->dma_cfg_tx.direction = DMA_MEM_TO_DEV; in bcm2835_add_host()
1290 host->dma_cfg_tx.src_addr = 0; in bcm2835_add_host()
1291 host->dma_cfg_tx.dst_addr = host->phys_addr + SDDATA; in bcm2835_add_host()
1293 host->dma_cfg_rx.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; in bcm2835_add_host()
1294 host->dma_cfg_rx.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; in bcm2835_add_host()
1295 host->dma_cfg_rx.direction = DMA_DEV_TO_MEM; in bcm2835_add_host()
1296 host->dma_cfg_rx.src_addr = host->phys_addr + SDDATA; in bcm2835_add_host()
1297 host->dma_cfg_rx.dst_addr = 0; in bcm2835_add_host()
1299 if (dmaengine_slave_config(host->dma_chan_rxtx, in bcm2835_add_host()
1300 &host->dma_cfg_tx) != 0 || in bcm2835_add_host()
1301 dmaengine_slave_config(host->dma_chan_rxtx, in bcm2835_add_host()
1302 &host->dma_cfg_rx) != 0) in bcm2835_add_host()
1303 host->use_dma = false; in bcm2835_add_host()
1306 mmc->max_segs = 128; in bcm2835_add_host()
1307 mmc->max_req_size = min_t(size_t, 524288, dma_max_mapping_size(dev)); in bcm2835_add_host()
1308 mmc->max_seg_size = mmc->max_req_size; in bcm2835_add_host()
1309 mmc->max_blk_size = 1024; in bcm2835_add_host()
1310 mmc->max_blk_count = 65535; in bcm2835_add_host()
1313 mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; in bcm2835_add_host()
1315 INIT_WORK(&host->dma_work, bcm2835_dma_complete_work); in bcm2835_add_host()
1316 INIT_DELAYED_WORK(&host->timeout_work, bcm2835_timeout); in bcm2835_add_host()
1319 host->hcfg = SDHCFG_BUSY_IRPT_EN; in bcm2835_add_host()
1323 ret = request_threaded_irq(host->irq, bcm2835_irq, in bcm2835_add_host()
1327 dev_err(dev, "failed to request IRQ %d: %d\n", host->irq, ret); in bcm2835_add_host()
1333 free_irq(host->irq, host); in bcm2835_add_host()
1338 if (host->use_dma && (PIO_THRESHOLD > 0)) in bcm2835_add_host()
1340 dev_info(dev, "loaded - DMA %s%s\n", in bcm2835_add_host()
1341 host->use_dma ? "enabled" : "disabled", pio_limit_string); in bcm2835_add_host()
1350 clk_disable_unprepare(host->clk); in bcm2835_suspend()
1359 return clk_prepare_enable(host->clk); in bcm2835_resume()
1367 struct device *dev = &pdev->dev; in bcm2835_probe()
1376 return -ENOMEM; in bcm2835_probe()
1378 mmc->ops = &bcm2835_ops; in bcm2835_probe()
1380 host->pdev = pdev; in bcm2835_probe()
1381 spin_lock_init(&host->lock); in bcm2835_probe()
1383 host->ioaddr = devm_platform_ioremap_resource(pdev, 0); in bcm2835_probe()
1384 if (IS_ERR(host->ioaddr)) { in bcm2835_probe()
1385 ret = PTR_ERR(host->ioaddr); in bcm2835_probe()
1392 regaddr_p = of_get_address(pdev->dev.of_node, 0, NULL, NULL); in bcm2835_probe()
1395 ret = -EINVAL; in bcm2835_probe()
1399 host->phys_addr = be32_to_cpup(regaddr_p); in bcm2835_probe()
1401 host->dma_chan = NULL; in bcm2835_probe()
1402 host->dma_desc = NULL; in bcm2835_probe()
1404 host->dma_chan_rxtx = dma_request_chan(dev, "rx-tx"); in bcm2835_probe()
1405 if (IS_ERR(host->dma_chan_rxtx)) { in bcm2835_probe()
1406 ret = PTR_ERR(host->dma_chan_rxtx); in bcm2835_probe()
1407 host->dma_chan_rxtx = NULL; in bcm2835_probe()
1409 if (ret == -EPROBE_DEFER) in bcm2835_probe()
1415 host->irq = platform_get_irq(pdev, 0); in bcm2835_probe()
1416 if (host->irq < 0) { in bcm2835_probe()
1417 ret = host->irq; in bcm2835_probe()
1425 host->clk = devm_clk_get(dev, NULL); in bcm2835_probe()
1426 if (IS_ERR(host->clk)) { in bcm2835_probe()
1427 ret = dev_err_probe(dev, PTR_ERR(host->clk), "could not get clk\n"); in bcm2835_probe()
1431 ret = clk_prepare_enable(host->clk); in bcm2835_probe()
1435 host->max_clk = clk_get_rate(host->clk); in bcm2835_probe()
1443 dev_dbg(dev, "%s -> OK\n", __func__); in bcm2835_probe()
1448 clk_disable_unprepare(host->clk); in bcm2835_probe()
1450 dev_dbg(dev, "%s -> err %d\n", __func__, ret); in bcm2835_probe()
1451 if (host->dma_chan_rxtx) in bcm2835_probe()
1452 dma_release_channel(host->dma_chan_rxtx); in bcm2835_probe()
1465 writel(SDVDD_POWER_OFF, host->ioaddr + SDVDD); in bcm2835_remove()
1467 free_irq(host->irq, host); in bcm2835_remove()
1469 cancel_work_sync(&host->dma_work); in bcm2835_remove()
1470 cancel_delayed_work_sync(&host->timeout_work); in bcm2835_remove()
1472 clk_disable_unprepare(host->clk); in bcm2835_remove()
1474 if (host->dma_chan_rxtx) in bcm2835_remove()
1475 dma_release_channel(host->dma_chan_rxtx); in bcm2835_remove()
1481 { .compatible = "brcm,bcm2835-sdhost" },
1490 .name = "sdhost-bcm2835",
1493 .pm = pm_ptr(&bcm2835_pm_ops),
1498 MODULE_ALIAS("platform:sdhost-bcm2835");
1499 MODULE_DESCRIPTION("BCM2835 SDHost driver");