1d96be879SSascha Hauer /* 2d96be879SSascha Hauer * linux/drivers/mmc/host/mxcmmc.c - Freescale i.MX MMCI driver 3d96be879SSascha Hauer * 4d96be879SSascha Hauer * This is a driver for the SDHC controller found in Freescale MX2/MX3 5d96be879SSascha Hauer * SoCs. It is basically the same hardware as found on MX1 (imxmmc.c). 6d96be879SSascha Hauer * Unlike the hardware found on MX1, this hardware just works and does 7d96be879SSascha Hauer * not need all the quirks found in imxmmc.c, hence the seperate driver. 8d96be879SSascha Hauer * 9d96be879SSascha Hauer * Copyright (C) 2008 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de> 10d96be879SSascha Hauer * Copyright (C) 2006 Pavel Pisa, PiKRON <ppisa@pikron.com> 11d96be879SSascha Hauer * 12d96be879SSascha Hauer * derived from pxamci.c by Russell King 13d96be879SSascha Hauer * 14d96be879SSascha Hauer * This program is free software; you can redistribute it and/or modify 15d96be879SSascha Hauer * it under the terms of the GNU General Public License version 2 as 16d96be879SSascha Hauer * published by the Free Software Foundation. 17d96be879SSascha Hauer * 18d96be879SSascha Hauer */ 19d96be879SSascha Hauer 20d96be879SSascha Hauer #include <linux/module.h> 21d96be879SSascha Hauer #include <linux/init.h> 22d96be879SSascha Hauer #include <linux/ioport.h> 23d96be879SSascha Hauer #include <linux/platform_device.h> 24d96be879SSascha Hauer #include <linux/interrupt.h> 25d96be879SSascha Hauer #include <linux/irq.h> 26d96be879SSascha Hauer #include <linux/blkdev.h> 27d96be879SSascha Hauer #include <linux/dma-mapping.h> 28d96be879SSascha Hauer #include <linux/mmc/host.h> 29d96be879SSascha Hauer #include <linux/mmc/card.h> 30d96be879SSascha Hauer #include <linux/delay.h> 31d96be879SSascha Hauer #include <linux/clk.h> 32d96be879SSascha Hauer #include <linux/io.h> 33d96be879SSascha Hauer #include <linux/gpio.h> 34d96be879SSascha Hauer 35d96be879SSascha Hauer #include <asm/dma.h> 36d96be879SSascha Hauer #include <asm/irq.h> 37d96be879SSascha Hauer #include <asm/sizes.h> 38d96be879SSascha Hauer #include <mach/mmc.h> 39d96be879SSascha Hauer 40d96be879SSascha Hauer #ifdef CONFIG_ARCH_MX2 41d96be879SSascha Hauer #include <mach/dma-mx1-mx2.h> 42d96be879SSascha Hauer #define HAS_DMA 43d96be879SSascha Hauer #endif 44d96be879SSascha Hauer 459563b1dbSSascha Hauer #define DRIVER_NAME "mxc-mmc" 46d96be879SSascha Hauer 47d96be879SSascha Hauer #define MMC_REG_STR_STP_CLK 0x00 48d96be879SSascha Hauer #define MMC_REG_STATUS 0x04 49d96be879SSascha Hauer #define MMC_REG_CLK_RATE 0x08 50d96be879SSascha Hauer #define MMC_REG_CMD_DAT_CONT 0x0C 51d96be879SSascha Hauer #define MMC_REG_RES_TO 0x10 52d96be879SSascha Hauer #define MMC_REG_READ_TO 0x14 53d96be879SSascha Hauer #define MMC_REG_BLK_LEN 0x18 54d96be879SSascha Hauer #define MMC_REG_NOB 0x1C 55d96be879SSascha Hauer #define MMC_REG_REV_NO 0x20 56d96be879SSascha Hauer #define MMC_REG_INT_CNTR 0x24 57d96be879SSascha Hauer #define MMC_REG_CMD 0x28 58d96be879SSascha Hauer #define MMC_REG_ARG 0x2C 59d96be879SSascha Hauer #define MMC_REG_RES_FIFO 0x34 60d96be879SSascha Hauer #define MMC_REG_BUFFER_ACCESS 0x38 61d96be879SSascha Hauer 62d96be879SSascha Hauer #define STR_STP_CLK_RESET (1 << 3) 63d96be879SSascha Hauer #define STR_STP_CLK_START_CLK (1 << 1) 64d96be879SSascha Hauer #define STR_STP_CLK_STOP_CLK (1 << 0) 65d96be879SSascha Hauer 66d96be879SSascha Hauer #define STATUS_CARD_INSERTION (1 << 31) 67d96be879SSascha Hauer #define STATUS_CARD_REMOVAL (1 << 30) 68d96be879SSascha Hauer #define STATUS_YBUF_EMPTY (1 << 29) 69d96be879SSascha Hauer #define STATUS_XBUF_EMPTY (1 << 28) 70d96be879SSascha Hauer #define STATUS_YBUF_FULL (1 << 27) 71d96be879SSascha Hauer #define STATUS_XBUF_FULL (1 << 26) 72d96be879SSascha Hauer #define STATUS_BUF_UND_RUN (1 << 25) 73d96be879SSascha Hauer #define STATUS_BUF_OVFL (1 << 24) 74d96be879SSascha Hauer #define STATUS_SDIO_INT_ACTIVE (1 << 14) 75d96be879SSascha Hauer #define STATUS_END_CMD_RESP (1 << 13) 76d96be879SSascha Hauer #define STATUS_WRITE_OP_DONE (1 << 12) 77d96be879SSascha Hauer #define STATUS_DATA_TRANS_DONE (1 << 11) 78d96be879SSascha Hauer #define STATUS_READ_OP_DONE (1 << 11) 79d96be879SSascha Hauer #define STATUS_WR_CRC_ERROR_CODE_MASK (3 << 10) 80d96be879SSascha Hauer #define STATUS_CARD_BUS_CLK_RUN (1 << 8) 81d96be879SSascha Hauer #define STATUS_BUF_READ_RDY (1 << 7) 82d96be879SSascha Hauer #define STATUS_BUF_WRITE_RDY (1 << 6) 83d96be879SSascha Hauer #define STATUS_RESP_CRC_ERR (1 << 5) 84d96be879SSascha Hauer #define STATUS_CRC_READ_ERR (1 << 3) 85d96be879SSascha Hauer #define STATUS_CRC_WRITE_ERR (1 << 2) 86d96be879SSascha Hauer #define STATUS_TIME_OUT_RESP (1 << 1) 87d96be879SSascha Hauer #define STATUS_TIME_OUT_READ (1 << 0) 88d96be879SSascha Hauer #define STATUS_ERR_MASK 0x2f 89d96be879SSascha Hauer 90d96be879SSascha Hauer #define CMD_DAT_CONT_CMD_RESP_LONG_OFF (1 << 12) 91d96be879SSascha Hauer #define CMD_DAT_CONT_STOP_READWAIT (1 << 11) 92d96be879SSascha Hauer #define CMD_DAT_CONT_START_READWAIT (1 << 10) 93d96be879SSascha Hauer #define CMD_DAT_CONT_BUS_WIDTH_4 (2 << 8) 94d96be879SSascha Hauer #define CMD_DAT_CONT_INIT (1 << 7) 95d96be879SSascha Hauer #define CMD_DAT_CONT_WRITE (1 << 4) 96d96be879SSascha Hauer #define CMD_DAT_CONT_DATA_ENABLE (1 << 3) 97d96be879SSascha Hauer #define CMD_DAT_CONT_RESPONSE_48BIT_CRC (1 << 0) 98d96be879SSascha Hauer #define CMD_DAT_CONT_RESPONSE_136BIT (2 << 0) 99d96be879SSascha Hauer #define CMD_DAT_CONT_RESPONSE_48BIT (3 << 0) 100d96be879SSascha Hauer 101d96be879SSascha Hauer #define INT_SDIO_INT_WKP_EN (1 << 18) 102d96be879SSascha Hauer #define INT_CARD_INSERTION_WKP_EN (1 << 17) 103d96be879SSascha Hauer #define INT_CARD_REMOVAL_WKP_EN (1 << 16) 104d96be879SSascha Hauer #define INT_CARD_INSERTION_EN (1 << 15) 105d96be879SSascha Hauer #define INT_CARD_REMOVAL_EN (1 << 14) 106d96be879SSascha Hauer #define INT_SDIO_IRQ_EN (1 << 13) 107d96be879SSascha Hauer #define INT_DAT0_EN (1 << 12) 108d96be879SSascha Hauer #define INT_BUF_READ_EN (1 << 4) 109d96be879SSascha Hauer #define INT_BUF_WRITE_EN (1 << 3) 110d96be879SSascha Hauer #define INT_END_CMD_RES_EN (1 << 2) 111d96be879SSascha Hauer #define INT_WRITE_OP_DONE_EN (1 << 1) 112d96be879SSascha Hauer #define INT_READ_OP_EN (1 << 0) 113d96be879SSascha Hauer 114d96be879SSascha Hauer struct mxcmci_host { 115d96be879SSascha Hauer struct mmc_host *mmc; 116d96be879SSascha Hauer struct resource *res; 117d96be879SSascha Hauer void __iomem *base; 118d96be879SSascha Hauer int irq; 119d96be879SSascha Hauer int detect_irq; 120d96be879SSascha Hauer int dma; 121d96be879SSascha Hauer int do_dma; 122d96be879SSascha Hauer unsigned int power_mode; 123d96be879SSascha Hauer struct imxmmc_platform_data *pdata; 124d96be879SSascha Hauer 125d96be879SSascha Hauer struct mmc_request *req; 126d96be879SSascha Hauer struct mmc_command *cmd; 127d96be879SSascha Hauer struct mmc_data *data; 128d96be879SSascha Hauer 129d96be879SSascha Hauer unsigned int dma_nents; 130d96be879SSascha Hauer unsigned int datasize; 131d96be879SSascha Hauer unsigned int dma_dir; 132d96be879SSascha Hauer 133d96be879SSascha Hauer u16 rev_no; 134d96be879SSascha Hauer unsigned int cmdat; 135d96be879SSascha Hauer 136d96be879SSascha Hauer struct clk *clk; 137d96be879SSascha Hauer 138d96be879SSascha Hauer int clock; 139d96be879SSascha Hauer 140d96be879SSascha Hauer struct work_struct datawork; 141d96be879SSascha Hauer }; 142d96be879SSascha Hauer 143d96be879SSascha Hauer static inline int mxcmci_use_dma(struct mxcmci_host *host) 144d96be879SSascha Hauer { 145d96be879SSascha Hauer return host->do_dma; 146d96be879SSascha Hauer } 147d96be879SSascha Hauer 148d96be879SSascha Hauer static void mxcmci_softreset(struct mxcmci_host *host) 149d96be879SSascha Hauer { 150d96be879SSascha Hauer int i; 151d96be879SSascha Hauer 152d96be879SSascha Hauer /* reset sequence */ 153d96be879SSascha Hauer writew(STR_STP_CLK_RESET, host->base + MMC_REG_STR_STP_CLK); 154d96be879SSascha Hauer writew(STR_STP_CLK_RESET | STR_STP_CLK_START_CLK, 155d96be879SSascha Hauer host->base + MMC_REG_STR_STP_CLK); 156d96be879SSascha Hauer 157d96be879SSascha Hauer for (i = 0; i < 8; i++) 158d96be879SSascha Hauer writew(STR_STP_CLK_START_CLK, host->base + MMC_REG_STR_STP_CLK); 159d96be879SSascha Hauer 160d96be879SSascha Hauer writew(0xff, host->base + MMC_REG_RES_TO); 161d96be879SSascha Hauer } 162d96be879SSascha Hauer 163d96be879SSascha Hauer static void mxcmci_setup_data(struct mxcmci_host *host, struct mmc_data *data) 164d96be879SSascha Hauer { 165d96be879SSascha Hauer unsigned int nob = data->blocks; 166d96be879SSascha Hauer unsigned int blksz = data->blksz; 167d96be879SSascha Hauer unsigned int datasize = nob * blksz; 168d96be879SSascha Hauer #ifdef HAS_DMA 169d96be879SSascha Hauer struct scatterlist *sg; 170d96be879SSascha Hauer int i; 171d96be879SSascha Hauer #endif 172d96be879SSascha Hauer if (data->flags & MMC_DATA_STREAM) 173d96be879SSascha Hauer nob = 0xffff; 174d96be879SSascha Hauer 175d96be879SSascha Hauer host->data = data; 176d96be879SSascha Hauer data->bytes_xfered = 0; 177d96be879SSascha Hauer 178d96be879SSascha Hauer writew(nob, host->base + MMC_REG_NOB); 179d96be879SSascha Hauer writew(blksz, host->base + MMC_REG_BLK_LEN); 180d96be879SSascha Hauer host->datasize = datasize; 181d96be879SSascha Hauer 182d96be879SSascha Hauer #ifdef HAS_DMA 183d96be879SSascha Hauer for_each_sg(data->sg, sg, data->sg_len, i) { 184d96be879SSascha Hauer if (sg->offset & 3 || sg->length & 3) { 185d96be879SSascha Hauer host->do_dma = 0; 186d96be879SSascha Hauer return; 187d96be879SSascha Hauer } 188d96be879SSascha Hauer } 189d96be879SSascha Hauer 190d96be879SSascha Hauer if (data->flags & MMC_DATA_READ) { 191d96be879SSascha Hauer host->dma_dir = DMA_FROM_DEVICE; 192d96be879SSascha Hauer host->dma_nents = dma_map_sg(mmc_dev(host->mmc), data->sg, 193d96be879SSascha Hauer data->sg_len, host->dma_dir); 194d96be879SSascha Hauer 195d96be879SSascha Hauer imx_dma_setup_sg(host->dma, data->sg, host->dma_nents, datasize, 196d96be879SSascha Hauer host->res->start + MMC_REG_BUFFER_ACCESS, 197d96be879SSascha Hauer DMA_MODE_READ); 198d96be879SSascha Hauer } else { 199d96be879SSascha Hauer host->dma_dir = DMA_TO_DEVICE; 200d96be879SSascha Hauer host->dma_nents = dma_map_sg(mmc_dev(host->mmc), data->sg, 201d96be879SSascha Hauer data->sg_len, host->dma_dir); 202d96be879SSascha Hauer 203d96be879SSascha Hauer imx_dma_setup_sg(host->dma, data->sg, host->dma_nents, datasize, 204d96be879SSascha Hauer host->res->start + MMC_REG_BUFFER_ACCESS, 205d96be879SSascha Hauer DMA_MODE_WRITE); 206d96be879SSascha Hauer } 207d96be879SSascha Hauer 208d96be879SSascha Hauer wmb(); 209d96be879SSascha Hauer 210d96be879SSascha Hauer imx_dma_enable(host->dma); 211d96be879SSascha Hauer #endif /* HAS_DMA */ 212d96be879SSascha Hauer } 213d96be879SSascha Hauer 214d96be879SSascha Hauer static int mxcmci_start_cmd(struct mxcmci_host *host, struct mmc_command *cmd, 215d96be879SSascha Hauer unsigned int cmdat) 216d96be879SSascha Hauer { 217d96be879SSascha Hauer WARN_ON(host->cmd != NULL); 218d96be879SSascha Hauer host->cmd = cmd; 219d96be879SSascha Hauer 220d96be879SSascha Hauer switch (mmc_resp_type(cmd)) { 221d96be879SSascha Hauer case MMC_RSP_R1: /* short CRC, OPCODE */ 222d96be879SSascha Hauer case MMC_RSP_R1B:/* short CRC, OPCODE, BUSY */ 223d96be879SSascha Hauer cmdat |= CMD_DAT_CONT_RESPONSE_48BIT_CRC; 224d96be879SSascha Hauer break; 225d96be879SSascha Hauer case MMC_RSP_R2: /* long 136 bit + CRC */ 226d96be879SSascha Hauer cmdat |= CMD_DAT_CONT_RESPONSE_136BIT; 227d96be879SSascha Hauer break; 228d96be879SSascha Hauer case MMC_RSP_R3: /* short */ 229d96be879SSascha Hauer cmdat |= CMD_DAT_CONT_RESPONSE_48BIT; 230d96be879SSascha Hauer break; 231d96be879SSascha Hauer case MMC_RSP_NONE: 232d96be879SSascha Hauer break; 233d96be879SSascha Hauer default: 234d96be879SSascha Hauer dev_err(mmc_dev(host->mmc), "unhandled response type 0x%x\n", 235d96be879SSascha Hauer mmc_resp_type(cmd)); 236d96be879SSascha Hauer cmd->error = -EINVAL; 237d96be879SSascha Hauer return -EINVAL; 238d96be879SSascha Hauer } 239d96be879SSascha Hauer 240d96be879SSascha Hauer if (mxcmci_use_dma(host)) 241d96be879SSascha Hauer writel(INT_READ_OP_EN | INT_WRITE_OP_DONE_EN | 242d96be879SSascha Hauer INT_END_CMD_RES_EN, 243d96be879SSascha Hauer host->base + MMC_REG_INT_CNTR); 244d96be879SSascha Hauer else 245d96be879SSascha Hauer writel(INT_END_CMD_RES_EN, host->base + MMC_REG_INT_CNTR); 246d96be879SSascha Hauer 247d96be879SSascha Hauer writew(cmd->opcode, host->base + MMC_REG_CMD); 248d96be879SSascha Hauer writel(cmd->arg, host->base + MMC_REG_ARG); 249d96be879SSascha Hauer writew(cmdat, host->base + MMC_REG_CMD_DAT_CONT); 250d96be879SSascha Hauer 251d96be879SSascha Hauer return 0; 252d96be879SSascha Hauer } 253d96be879SSascha Hauer 254d96be879SSascha Hauer static void mxcmci_finish_request(struct mxcmci_host *host, 255d96be879SSascha Hauer struct mmc_request *req) 256d96be879SSascha Hauer { 257d96be879SSascha Hauer writel(0, host->base + MMC_REG_INT_CNTR); 258d96be879SSascha Hauer 259d96be879SSascha Hauer host->req = NULL; 260d96be879SSascha Hauer host->cmd = NULL; 261d96be879SSascha Hauer host->data = NULL; 262d96be879SSascha Hauer 263d96be879SSascha Hauer mmc_request_done(host->mmc, req); 264d96be879SSascha Hauer } 265d96be879SSascha Hauer 266d96be879SSascha Hauer static int mxcmci_finish_data(struct mxcmci_host *host, unsigned int stat) 267d96be879SSascha Hauer { 268d96be879SSascha Hauer struct mmc_data *data = host->data; 269d96be879SSascha Hauer int data_error; 270d96be879SSascha Hauer 271d96be879SSascha Hauer #ifdef HAS_DMA 272d96be879SSascha Hauer if (mxcmci_use_dma(host)) { 273d96be879SSascha Hauer imx_dma_disable(host->dma); 274d96be879SSascha Hauer dma_unmap_sg(mmc_dev(host->mmc), data->sg, host->dma_nents, 275d96be879SSascha Hauer host->dma_dir); 276d96be879SSascha Hauer } 277d96be879SSascha Hauer #endif 278d96be879SSascha Hauer 279d96be879SSascha Hauer if (stat & STATUS_ERR_MASK) { 280d96be879SSascha Hauer dev_dbg(mmc_dev(host->mmc), "request failed. status: 0x%08x\n", 281d96be879SSascha Hauer stat); 282d96be879SSascha Hauer if (stat & STATUS_CRC_READ_ERR) { 283d96be879SSascha Hauer data->error = -EILSEQ; 284d96be879SSascha Hauer } else if (stat & STATUS_CRC_WRITE_ERR) { 285d96be879SSascha Hauer u32 err_code = (stat >> 9) & 0x3; 286d96be879SSascha Hauer if (err_code == 2) /* No CRC response */ 287d96be879SSascha Hauer data->error = -ETIMEDOUT; 288d96be879SSascha Hauer else 289d96be879SSascha Hauer data->error = -EILSEQ; 290d96be879SSascha Hauer } else if (stat & STATUS_TIME_OUT_READ) { 291d96be879SSascha Hauer data->error = -ETIMEDOUT; 292d96be879SSascha Hauer } else { 293d96be879SSascha Hauer data->error = -EIO; 294d96be879SSascha Hauer } 295d96be879SSascha Hauer } else { 296d96be879SSascha Hauer data->bytes_xfered = host->datasize; 297d96be879SSascha Hauer } 298d96be879SSascha Hauer 299d96be879SSascha Hauer data_error = data->error; 300d96be879SSascha Hauer 301d96be879SSascha Hauer host->data = NULL; 302d96be879SSascha Hauer 303d96be879SSascha Hauer return data_error; 304d96be879SSascha Hauer } 305d96be879SSascha Hauer 306d96be879SSascha Hauer static void mxcmci_read_response(struct mxcmci_host *host, unsigned int stat) 307d96be879SSascha Hauer { 308d96be879SSascha Hauer struct mmc_command *cmd = host->cmd; 309d96be879SSascha Hauer int i; 310d96be879SSascha Hauer u32 a, b, c; 311d96be879SSascha Hauer 312d96be879SSascha Hauer if (!cmd) 313d96be879SSascha Hauer return; 314d96be879SSascha Hauer 315d96be879SSascha Hauer if (stat & STATUS_TIME_OUT_RESP) { 316d96be879SSascha Hauer dev_dbg(mmc_dev(host->mmc), "CMD TIMEOUT\n"); 317d96be879SSascha Hauer cmd->error = -ETIMEDOUT; 318d96be879SSascha Hauer } else if (stat & STATUS_RESP_CRC_ERR && cmd->flags & MMC_RSP_CRC) { 319d96be879SSascha Hauer dev_dbg(mmc_dev(host->mmc), "cmd crc error\n"); 320d96be879SSascha Hauer cmd->error = -EILSEQ; 321d96be879SSascha Hauer } 322d96be879SSascha Hauer 323d96be879SSascha Hauer if (cmd->flags & MMC_RSP_PRESENT) { 324d96be879SSascha Hauer if (cmd->flags & MMC_RSP_136) { 325d96be879SSascha Hauer for (i = 0; i < 4; i++) { 326d96be879SSascha Hauer a = readw(host->base + MMC_REG_RES_FIFO); 327d96be879SSascha Hauer b = readw(host->base + MMC_REG_RES_FIFO); 328d96be879SSascha Hauer cmd->resp[i] = a << 16 | b; 329d96be879SSascha Hauer } 330d96be879SSascha Hauer } else { 331d96be879SSascha Hauer a = readw(host->base + MMC_REG_RES_FIFO); 332d96be879SSascha Hauer b = readw(host->base + MMC_REG_RES_FIFO); 333d96be879SSascha Hauer c = readw(host->base + MMC_REG_RES_FIFO); 334d96be879SSascha Hauer cmd->resp[0] = a << 24 | b << 8 | c >> 8; 335d96be879SSascha Hauer } 336d96be879SSascha Hauer } 337d96be879SSascha Hauer } 338d96be879SSascha Hauer 339d96be879SSascha Hauer static int mxcmci_poll_status(struct mxcmci_host *host, u32 mask) 340d96be879SSascha Hauer { 341d96be879SSascha Hauer u32 stat; 342d96be879SSascha Hauer unsigned long timeout = jiffies + HZ; 343d96be879SSascha Hauer 344d96be879SSascha Hauer do { 345d96be879SSascha Hauer stat = readl(host->base + MMC_REG_STATUS); 346d96be879SSascha Hauer if (stat & STATUS_ERR_MASK) 347d96be879SSascha Hauer return stat; 348d96be879SSascha Hauer if (time_after(jiffies, timeout)) 349d96be879SSascha Hauer return STATUS_TIME_OUT_READ; 350d96be879SSascha Hauer if (stat & mask) 351d96be879SSascha Hauer return 0; 352d96be879SSascha Hauer cpu_relax(); 353d96be879SSascha Hauer } while (1); 354d96be879SSascha Hauer } 355d96be879SSascha Hauer 356d96be879SSascha Hauer static int mxcmci_pull(struct mxcmci_host *host, void *_buf, int bytes) 357d96be879SSascha Hauer { 358d96be879SSascha Hauer unsigned int stat; 359d96be879SSascha Hauer u32 *buf = _buf; 360d96be879SSascha Hauer 361d96be879SSascha Hauer while (bytes > 3) { 362d96be879SSascha Hauer stat = mxcmci_poll_status(host, 363d96be879SSascha Hauer STATUS_BUF_READ_RDY | STATUS_READ_OP_DONE); 364d96be879SSascha Hauer if (stat) 365d96be879SSascha Hauer return stat; 366d96be879SSascha Hauer *buf++ = readl(host->base + MMC_REG_BUFFER_ACCESS); 367d96be879SSascha Hauer bytes -= 4; 368d96be879SSascha Hauer } 369d96be879SSascha Hauer 370d96be879SSascha Hauer if (bytes) { 371d96be879SSascha Hauer u8 *b = (u8 *)buf; 372d96be879SSascha Hauer u32 tmp; 373d96be879SSascha Hauer 374d96be879SSascha Hauer stat = mxcmci_poll_status(host, 375d96be879SSascha Hauer STATUS_BUF_READ_RDY | STATUS_READ_OP_DONE); 376d96be879SSascha Hauer if (stat) 377d96be879SSascha Hauer return stat; 378d96be879SSascha Hauer tmp = readl(host->base + MMC_REG_BUFFER_ACCESS); 379d96be879SSascha Hauer memcpy(b, &tmp, bytes); 380d96be879SSascha Hauer } 381d96be879SSascha Hauer 382d96be879SSascha Hauer return 0; 383d96be879SSascha Hauer } 384d96be879SSascha Hauer 385d96be879SSascha Hauer static int mxcmci_push(struct mxcmci_host *host, void *_buf, int bytes) 386d96be879SSascha Hauer { 387d96be879SSascha Hauer unsigned int stat; 388d96be879SSascha Hauer u32 *buf = _buf; 389d96be879SSascha Hauer 390d96be879SSascha Hauer while (bytes > 3) { 391d96be879SSascha Hauer stat = mxcmci_poll_status(host, STATUS_BUF_WRITE_RDY); 392d96be879SSascha Hauer if (stat) 393d96be879SSascha Hauer return stat; 394d96be879SSascha Hauer writel(*buf++, host->base + MMC_REG_BUFFER_ACCESS); 395d96be879SSascha Hauer bytes -= 4; 396d96be879SSascha Hauer } 397d96be879SSascha Hauer 398d96be879SSascha Hauer if (bytes) { 399d96be879SSascha Hauer u8 *b = (u8 *)buf; 400d96be879SSascha Hauer u32 tmp; 401d96be879SSascha Hauer 402d96be879SSascha Hauer stat = mxcmci_poll_status(host, STATUS_BUF_WRITE_RDY); 403d96be879SSascha Hauer if (stat) 404d96be879SSascha Hauer return stat; 405d96be879SSascha Hauer 406d96be879SSascha Hauer memcpy(&tmp, b, bytes); 407d96be879SSascha Hauer writel(tmp, host->base + MMC_REG_BUFFER_ACCESS); 408d96be879SSascha Hauer } 409d96be879SSascha Hauer 410d96be879SSascha Hauer stat = mxcmci_poll_status(host, STATUS_BUF_WRITE_RDY); 411d96be879SSascha Hauer if (stat) 412d96be879SSascha Hauer return stat; 413d96be879SSascha Hauer 414d96be879SSascha Hauer return 0; 415d96be879SSascha Hauer } 416d96be879SSascha Hauer 417d96be879SSascha Hauer static int mxcmci_transfer_data(struct mxcmci_host *host) 418d96be879SSascha Hauer { 419d96be879SSascha Hauer struct mmc_data *data = host->req->data; 420d96be879SSascha Hauer struct scatterlist *sg; 421d96be879SSascha Hauer int stat, i; 422d96be879SSascha Hauer 423d96be879SSascha Hauer host->datasize = 0; 424d96be879SSascha Hauer 425d96be879SSascha Hauer host->data = data; 426d96be879SSascha Hauer host->datasize = 0; 427d96be879SSascha Hauer 428d96be879SSascha Hauer if (data->flags & MMC_DATA_READ) { 429d96be879SSascha Hauer for_each_sg(data->sg, sg, data->sg_len, i) { 430d96be879SSascha Hauer stat = mxcmci_pull(host, sg_virt(sg), sg->length); 431d96be879SSascha Hauer if (stat) 432d96be879SSascha Hauer return stat; 433d96be879SSascha Hauer host->datasize += sg->length; 434d96be879SSascha Hauer } 435d96be879SSascha Hauer } else { 436d96be879SSascha Hauer for_each_sg(data->sg, sg, data->sg_len, i) { 437d96be879SSascha Hauer stat = mxcmci_push(host, sg_virt(sg), sg->length); 438d96be879SSascha Hauer if (stat) 439d96be879SSascha Hauer return stat; 440d96be879SSascha Hauer host->datasize += sg->length; 441d96be879SSascha Hauer } 442d96be879SSascha Hauer stat = mxcmci_poll_status(host, STATUS_WRITE_OP_DONE); 443d96be879SSascha Hauer if (stat) 444d96be879SSascha Hauer return stat; 445d96be879SSascha Hauer } 446d96be879SSascha Hauer return 0; 447d96be879SSascha Hauer } 448d96be879SSascha Hauer 449d96be879SSascha Hauer static void mxcmci_datawork(struct work_struct *work) 450d96be879SSascha Hauer { 451d96be879SSascha Hauer struct mxcmci_host *host = container_of(work, struct mxcmci_host, 452d96be879SSascha Hauer datawork); 453d96be879SSascha Hauer int datastat = mxcmci_transfer_data(host); 454d96be879SSascha Hauer mxcmci_finish_data(host, datastat); 455d96be879SSascha Hauer 456d96be879SSascha Hauer if (host->req->stop) { 457d96be879SSascha Hauer if (mxcmci_start_cmd(host, host->req->stop, 0)) { 458d96be879SSascha Hauer mxcmci_finish_request(host, host->req); 459d96be879SSascha Hauer return; 460d96be879SSascha Hauer } 461d96be879SSascha Hauer } else { 462d96be879SSascha Hauer mxcmci_finish_request(host, host->req); 463d96be879SSascha Hauer } 464d96be879SSascha Hauer } 465d96be879SSascha Hauer 466d96be879SSascha Hauer #ifdef HAS_DMA 467d96be879SSascha Hauer static void mxcmci_data_done(struct mxcmci_host *host, unsigned int stat) 468d96be879SSascha Hauer { 469d96be879SSascha Hauer struct mmc_data *data = host->data; 470d96be879SSascha Hauer int data_error; 471d96be879SSascha Hauer 472d96be879SSascha Hauer if (!data) 473d96be879SSascha Hauer return; 474d96be879SSascha Hauer 475d96be879SSascha Hauer data_error = mxcmci_finish_data(host, stat); 476d96be879SSascha Hauer 477d96be879SSascha Hauer mxcmci_read_response(host, stat); 478d96be879SSascha Hauer host->cmd = NULL; 479d96be879SSascha Hauer 480d96be879SSascha Hauer if (host->req->stop) { 481d96be879SSascha Hauer if (mxcmci_start_cmd(host, host->req->stop, 0)) { 482d96be879SSascha Hauer mxcmci_finish_request(host, host->req); 483d96be879SSascha Hauer return; 484d96be879SSascha Hauer } 485d96be879SSascha Hauer } else { 486d96be879SSascha Hauer mxcmci_finish_request(host, host->req); 487d96be879SSascha Hauer } 488d96be879SSascha Hauer } 489d96be879SSascha Hauer #endif /* HAS_DMA */ 490d96be879SSascha Hauer 491d96be879SSascha Hauer static void mxcmci_cmd_done(struct mxcmci_host *host, unsigned int stat) 492d96be879SSascha Hauer { 493d96be879SSascha Hauer mxcmci_read_response(host, stat); 494d96be879SSascha Hauer host->cmd = NULL; 495d96be879SSascha Hauer 496d96be879SSascha Hauer if (!host->data && host->req) { 497d96be879SSascha Hauer mxcmci_finish_request(host, host->req); 498d96be879SSascha Hauer return; 499d96be879SSascha Hauer } 500d96be879SSascha Hauer 501d96be879SSascha Hauer /* For the DMA case the DMA engine handles the data transfer 502d96be879SSascha Hauer * automatically. For non DMA we have to to it ourselves. 503d96be879SSascha Hauer * Don't do it in interrupt context though. 504d96be879SSascha Hauer */ 505d96be879SSascha Hauer if (!mxcmci_use_dma(host) && host->data) 506d96be879SSascha Hauer schedule_work(&host->datawork); 507d96be879SSascha Hauer 508d96be879SSascha Hauer } 509d96be879SSascha Hauer 510d96be879SSascha Hauer static irqreturn_t mxcmci_irq(int irq, void *devid) 511d96be879SSascha Hauer { 512d96be879SSascha Hauer struct mxcmci_host *host = devid; 513d96be879SSascha Hauer u32 stat; 514d96be879SSascha Hauer 515d96be879SSascha Hauer stat = readl(host->base + MMC_REG_STATUS); 516d96be879SSascha Hauer writel(stat, host->base + MMC_REG_STATUS); 517d96be879SSascha Hauer 518d96be879SSascha Hauer dev_dbg(mmc_dev(host->mmc), "%s: 0x%08x\n", __func__, stat); 519d96be879SSascha Hauer 520d96be879SSascha Hauer if (stat & STATUS_END_CMD_RESP) 521d96be879SSascha Hauer mxcmci_cmd_done(host, stat); 522d96be879SSascha Hauer #ifdef HAS_DMA 523d96be879SSascha Hauer if (mxcmci_use_dma(host) && 524d96be879SSascha Hauer (stat & (STATUS_DATA_TRANS_DONE | STATUS_WRITE_OP_DONE))) 525d96be879SSascha Hauer mxcmci_data_done(host, stat); 526d96be879SSascha Hauer #endif 527d96be879SSascha Hauer return IRQ_HANDLED; 528d96be879SSascha Hauer } 529d96be879SSascha Hauer 530d96be879SSascha Hauer static void mxcmci_request(struct mmc_host *mmc, struct mmc_request *req) 531d96be879SSascha Hauer { 532d96be879SSascha Hauer struct mxcmci_host *host = mmc_priv(mmc); 533d96be879SSascha Hauer unsigned int cmdat = host->cmdat; 534d96be879SSascha Hauer 535d96be879SSascha Hauer WARN_ON(host->req != NULL); 536d96be879SSascha Hauer 537d96be879SSascha Hauer host->req = req; 538d96be879SSascha Hauer host->cmdat &= ~CMD_DAT_CONT_INIT; 539d96be879SSascha Hauer #ifdef HAS_DMA 540d96be879SSascha Hauer host->do_dma = 1; 541d96be879SSascha Hauer #endif 542d96be879SSascha Hauer if (req->data) { 543d96be879SSascha Hauer mxcmci_setup_data(host, req->data); 544d96be879SSascha Hauer 545d96be879SSascha Hauer cmdat |= CMD_DAT_CONT_DATA_ENABLE; 546d96be879SSascha Hauer 547d96be879SSascha Hauer if (req->data->flags & MMC_DATA_WRITE) 548d96be879SSascha Hauer cmdat |= CMD_DAT_CONT_WRITE; 549d96be879SSascha Hauer } 550d96be879SSascha Hauer 551d96be879SSascha Hauer if (mxcmci_start_cmd(host, req->cmd, cmdat)) 552d96be879SSascha Hauer mxcmci_finish_request(host, req); 553d96be879SSascha Hauer } 554d96be879SSascha Hauer 555d96be879SSascha Hauer static void mxcmci_set_clk_rate(struct mxcmci_host *host, unsigned int clk_ios) 556d96be879SSascha Hauer { 557d96be879SSascha Hauer unsigned int divider; 558d96be879SSascha Hauer int prescaler = 0; 559d96be879SSascha Hauer unsigned int clk_in = clk_get_rate(host->clk); 560d96be879SSascha Hauer 561d96be879SSascha Hauer while (prescaler <= 0x800) { 562d96be879SSascha Hauer for (divider = 1; divider <= 0xF; divider++) { 563d96be879SSascha Hauer int x; 564d96be879SSascha Hauer 565d96be879SSascha Hauer x = (clk_in / (divider + 1)); 566d96be879SSascha Hauer 567d96be879SSascha Hauer if (prescaler) 568d96be879SSascha Hauer x /= (prescaler * 2); 569d96be879SSascha Hauer 570d96be879SSascha Hauer if (x <= clk_ios) 571d96be879SSascha Hauer break; 572d96be879SSascha Hauer } 573d96be879SSascha Hauer if (divider < 0x10) 574d96be879SSascha Hauer break; 575d96be879SSascha Hauer 576d96be879SSascha Hauer if (prescaler == 0) 577d96be879SSascha Hauer prescaler = 1; 578d96be879SSascha Hauer else 579d96be879SSascha Hauer prescaler <<= 1; 580d96be879SSascha Hauer } 581d96be879SSascha Hauer 582d96be879SSascha Hauer writew((prescaler << 4) | divider, host->base + MMC_REG_CLK_RATE); 583d96be879SSascha Hauer 584d96be879SSascha Hauer dev_dbg(mmc_dev(host->mmc), "scaler: %d divider: %d in: %d out: %d\n", 585d96be879SSascha Hauer prescaler, divider, clk_in, clk_ios); 586d96be879SSascha Hauer } 587d96be879SSascha Hauer 588d96be879SSascha Hauer static void mxcmci_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) 589d96be879SSascha Hauer { 590d96be879SSascha Hauer struct mxcmci_host *host = mmc_priv(mmc); 591d96be879SSascha Hauer #ifdef HAS_DMA 592d96be879SSascha Hauer unsigned int blen; 593d96be879SSascha Hauer /* 594d96be879SSascha Hauer * use burstlen of 64 in 4 bit mode (--> reg value 0) 595d96be879SSascha Hauer * use burstlen of 16 in 1 bit mode (--> reg value 16) 596d96be879SSascha Hauer */ 597d96be879SSascha Hauer if (ios->bus_width == MMC_BUS_WIDTH_4) 598d96be879SSascha Hauer blen = 0; 599d96be879SSascha Hauer else 600d96be879SSascha Hauer blen = 16; 601d96be879SSascha Hauer 602d96be879SSascha Hauer imx_dma_config_burstlen(host->dma, blen); 603d96be879SSascha Hauer #endif 604d96be879SSascha Hauer if (ios->bus_width == MMC_BUS_WIDTH_4) 605d96be879SSascha Hauer host->cmdat |= CMD_DAT_CONT_BUS_WIDTH_4; 606d96be879SSascha Hauer else 607d96be879SSascha Hauer host->cmdat &= ~CMD_DAT_CONT_BUS_WIDTH_4; 608d96be879SSascha Hauer 609d96be879SSascha Hauer if (host->power_mode != ios->power_mode) { 610d96be879SSascha Hauer if (host->pdata && host->pdata->setpower) 611d96be879SSascha Hauer host->pdata->setpower(mmc_dev(mmc), ios->vdd); 612d96be879SSascha Hauer host->power_mode = ios->power_mode; 613d96be879SSascha Hauer if (ios->power_mode == MMC_POWER_ON) 614d96be879SSascha Hauer host->cmdat |= CMD_DAT_CONT_INIT; 615d96be879SSascha Hauer } 616d96be879SSascha Hauer 617d96be879SSascha Hauer if (ios->clock) { 618d96be879SSascha Hauer mxcmci_set_clk_rate(host, ios->clock); 619d96be879SSascha Hauer writew(STR_STP_CLK_START_CLK, host->base + MMC_REG_STR_STP_CLK); 620d96be879SSascha Hauer } else { 621d96be879SSascha Hauer writew(STR_STP_CLK_STOP_CLK, host->base + MMC_REG_STR_STP_CLK); 622d96be879SSascha Hauer } 623d96be879SSascha Hauer 624d96be879SSascha Hauer host->clock = ios->clock; 625d96be879SSascha Hauer } 626d96be879SSascha Hauer 627d96be879SSascha Hauer static irqreturn_t mxcmci_detect_irq(int irq, void *data) 628d96be879SSascha Hauer { 629d96be879SSascha Hauer struct mmc_host *mmc = data; 630d96be879SSascha Hauer 631d96be879SSascha Hauer dev_dbg(mmc_dev(mmc), "%s\n", __func__); 632d96be879SSascha Hauer 633d96be879SSascha Hauer mmc_detect_change(mmc, msecs_to_jiffies(250)); 634d96be879SSascha Hauer return IRQ_HANDLED; 635d96be879SSascha Hauer } 636d96be879SSascha Hauer 637d96be879SSascha Hauer static int mxcmci_get_ro(struct mmc_host *mmc) 638d96be879SSascha Hauer { 639d96be879SSascha Hauer struct mxcmci_host *host = mmc_priv(mmc); 640d96be879SSascha Hauer 641d96be879SSascha Hauer if (host->pdata && host->pdata->get_ro) 642d96be879SSascha Hauer return !!host->pdata->get_ro(mmc_dev(mmc)); 643d96be879SSascha Hauer /* 644d96be879SSascha Hauer * Board doesn't support read only detection; let the mmc core 645d96be879SSascha Hauer * decide what to do. 646d96be879SSascha Hauer */ 647d96be879SSascha Hauer return -ENOSYS; 648d96be879SSascha Hauer } 649d96be879SSascha Hauer 650d96be879SSascha Hauer 651d96be879SSascha Hauer static const struct mmc_host_ops mxcmci_ops = { 652d96be879SSascha Hauer .request = mxcmci_request, 653d96be879SSascha Hauer .set_ios = mxcmci_set_ios, 654d96be879SSascha Hauer .get_ro = mxcmci_get_ro, 655d96be879SSascha Hauer }; 656d96be879SSascha Hauer 657d96be879SSascha Hauer static int mxcmci_probe(struct platform_device *pdev) 658d96be879SSascha Hauer { 659d96be879SSascha Hauer struct mmc_host *mmc; 660d96be879SSascha Hauer struct mxcmci_host *host = NULL; 661d96be879SSascha Hauer struct resource *r; 662d96be879SSascha Hauer int ret = 0, irq; 663d96be879SSascha Hauer 664d96be879SSascha Hauer printk(KERN_INFO "i.MX SDHC driver\n"); 665d96be879SSascha Hauer 666d96be879SSascha Hauer r = platform_get_resource(pdev, IORESOURCE_MEM, 0); 667d96be879SSascha Hauer irq = platform_get_irq(pdev, 0); 668d96be879SSascha Hauer if (!r || irq < 0) 669d96be879SSascha Hauer return -EINVAL; 670d96be879SSascha Hauer 671d96be879SSascha Hauer r = request_mem_region(r->start, resource_size(r), pdev->name); 672d96be879SSascha Hauer if (!r) 673d96be879SSascha Hauer return -EBUSY; 674d96be879SSascha Hauer 675d96be879SSascha Hauer mmc = mmc_alloc_host(sizeof(struct mxcmci_host), &pdev->dev); 676d96be879SSascha Hauer if (!mmc) { 677d96be879SSascha Hauer ret = -ENOMEM; 678d96be879SSascha Hauer goto out_release_mem; 679d96be879SSascha Hauer } 680d96be879SSascha Hauer 681d96be879SSascha Hauer mmc->ops = &mxcmci_ops; 682d96be879SSascha Hauer mmc->caps = MMC_CAP_4_BIT_DATA; 683d96be879SSascha Hauer 684d96be879SSascha Hauer /* MMC core transfer sizes tunable parameters */ 685d96be879SSascha Hauer mmc->max_hw_segs = 64; 686d96be879SSascha Hauer mmc->max_phys_segs = 64; 687d96be879SSascha Hauer mmc->max_blk_size = 2048; 688d96be879SSascha Hauer mmc->max_blk_count = 65535; 689d96be879SSascha Hauer mmc->max_req_size = mmc->max_blk_size * mmc->max_blk_count; 690d96be879SSascha Hauer mmc->max_seg_size = mmc->max_seg_size; 691d96be879SSascha Hauer 692d96be879SSascha Hauer host = mmc_priv(mmc); 693d96be879SSascha Hauer host->base = ioremap(r->start, resource_size(r)); 694d96be879SSascha Hauer if (!host->base) { 695d96be879SSascha Hauer ret = -ENOMEM; 696d96be879SSascha Hauer goto out_free; 697d96be879SSascha Hauer } 698d96be879SSascha Hauer 699d96be879SSascha Hauer host->mmc = mmc; 700d96be879SSascha Hauer host->pdata = pdev->dev.platform_data; 701d96be879SSascha Hauer 702d96be879SSascha Hauer if (host->pdata && host->pdata->ocr_avail) 703d96be879SSascha Hauer mmc->ocr_avail = host->pdata->ocr_avail; 704d96be879SSascha Hauer else 705d96be879SSascha Hauer mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; 706d96be879SSascha Hauer 707d96be879SSascha Hauer host->res = r; 708d96be879SSascha Hauer host->irq = irq; 709d96be879SSascha Hauer 71006277b5cSSascha Hauer host->clk = clk_get(&pdev->dev, NULL); 711d96be879SSascha Hauer if (IS_ERR(host->clk)) { 712d96be879SSascha Hauer ret = PTR_ERR(host->clk); 713d96be879SSascha Hauer goto out_iounmap; 714d96be879SSascha Hauer } 715d96be879SSascha Hauer clk_enable(host->clk); 716d96be879SSascha Hauer 717d96be879SSascha Hauer mxcmci_softreset(host); 718d96be879SSascha Hauer 719d96be879SSascha Hauer host->rev_no = readw(host->base + MMC_REG_REV_NO); 720d96be879SSascha Hauer if (host->rev_no != 0x400) { 721d96be879SSascha Hauer ret = -ENODEV; 722d96be879SSascha Hauer dev_err(mmc_dev(host->mmc), "wrong rev.no. 0x%08x. aborting.\n", 723d96be879SSascha Hauer host->rev_no); 724d96be879SSascha Hauer goto out_clk_put; 725d96be879SSascha Hauer } 726d96be879SSascha Hauer 727c499b067SSascha Hauer mmc->f_min = clk_get_rate(host->clk) >> 16; 728c499b067SSascha Hauer if (mmc->f_min < 400000) 729c499b067SSascha Hauer mmc->f_min = 400000; 730d96be879SSascha Hauer mmc->f_max = clk_get_rate(host->clk) >> 1; 731d96be879SSascha Hauer 732d96be879SSascha Hauer /* recommended in data sheet */ 733d96be879SSascha Hauer writew(0x2db4, host->base + MMC_REG_READ_TO); 734d96be879SSascha Hauer 735d96be879SSascha Hauer writel(0, host->base + MMC_REG_INT_CNTR); 736d96be879SSascha Hauer 737d96be879SSascha Hauer #ifdef HAS_DMA 738d96be879SSascha Hauer host->dma = imx_dma_request_by_prio(DRIVER_NAME, DMA_PRIO_LOW); 739d96be879SSascha Hauer if (host->dma < 0) { 740d96be879SSascha Hauer dev_err(mmc_dev(host->mmc), "imx_dma_request_by_prio failed\n"); 741d96be879SSascha Hauer ret = -EBUSY; 742d96be879SSascha Hauer goto out_clk_put; 743d96be879SSascha Hauer } 744d96be879SSascha Hauer 745d96be879SSascha Hauer r = platform_get_resource(pdev, IORESOURCE_DMA, 0); 746d96be879SSascha Hauer if (!r) { 747d96be879SSascha Hauer ret = -EINVAL; 748d96be879SSascha Hauer goto out_free_dma; 749d96be879SSascha Hauer } 750d96be879SSascha Hauer 751d96be879SSascha Hauer ret = imx_dma_config_channel(host->dma, 752d96be879SSascha Hauer IMX_DMA_MEMSIZE_32 | IMX_DMA_TYPE_FIFO, 753d96be879SSascha Hauer IMX_DMA_MEMSIZE_32 | IMX_DMA_TYPE_LINEAR, 754d96be879SSascha Hauer r->start, 0); 755d96be879SSascha Hauer if (ret) { 756d96be879SSascha Hauer dev_err(mmc_dev(host->mmc), "failed to config DMA channel\n"); 757d96be879SSascha Hauer goto out_free_dma; 758d96be879SSascha Hauer } 759d96be879SSascha Hauer #endif 760d96be879SSascha Hauer INIT_WORK(&host->datawork, mxcmci_datawork); 761d96be879SSascha Hauer 762d96be879SSascha Hauer ret = request_irq(host->irq, mxcmci_irq, 0, DRIVER_NAME, host); 763d96be879SSascha Hauer if (ret) 764d96be879SSascha Hauer goto out_free_dma; 765d96be879SSascha Hauer 766d96be879SSascha Hauer platform_set_drvdata(pdev, mmc); 767d96be879SSascha Hauer 768d96be879SSascha Hauer if (host->pdata && host->pdata->init) { 769d96be879SSascha Hauer ret = host->pdata->init(&pdev->dev, mxcmci_detect_irq, 770d96be879SSascha Hauer host->mmc); 771d96be879SSascha Hauer if (ret) 772d96be879SSascha Hauer goto out_free_irq; 773d96be879SSascha Hauer } 774d96be879SSascha Hauer 775d96be879SSascha Hauer mmc_add_host(mmc); 776d96be879SSascha Hauer 777d96be879SSascha Hauer return 0; 778d96be879SSascha Hauer 779d96be879SSascha Hauer out_free_irq: 780d96be879SSascha Hauer free_irq(host->irq, host); 781d96be879SSascha Hauer out_free_dma: 782d96be879SSascha Hauer #ifdef HAS_DMA 783d96be879SSascha Hauer imx_dma_free(host->dma); 784d96be879SSascha Hauer #endif 785d96be879SSascha Hauer out_clk_put: 786d96be879SSascha Hauer clk_disable(host->clk); 787d96be879SSascha Hauer clk_put(host->clk); 788d96be879SSascha Hauer out_iounmap: 789d96be879SSascha Hauer iounmap(host->base); 790d96be879SSascha Hauer out_free: 791d96be879SSascha Hauer mmc_free_host(mmc); 792d96be879SSascha Hauer out_release_mem: 793d96be879SSascha Hauer release_mem_region(host->res->start, resource_size(host->res)); 794d96be879SSascha Hauer return ret; 795d96be879SSascha Hauer } 796d96be879SSascha Hauer 797d96be879SSascha Hauer static int mxcmci_remove(struct platform_device *pdev) 798d96be879SSascha Hauer { 799d96be879SSascha Hauer struct mmc_host *mmc = platform_get_drvdata(pdev); 800d96be879SSascha Hauer struct mxcmci_host *host = mmc_priv(mmc); 801d96be879SSascha Hauer 802d96be879SSascha Hauer platform_set_drvdata(pdev, NULL); 803d96be879SSascha Hauer 804d96be879SSascha Hauer mmc_remove_host(mmc); 805d96be879SSascha Hauer 806d96be879SSascha Hauer if (host->pdata && host->pdata->exit) 807d96be879SSascha Hauer host->pdata->exit(&pdev->dev, mmc); 808d96be879SSascha Hauer 809d96be879SSascha Hauer free_irq(host->irq, host); 810d96be879SSascha Hauer iounmap(host->base); 811d96be879SSascha Hauer #ifdef HAS_DMA 812d96be879SSascha Hauer imx_dma_free(host->dma); 813d96be879SSascha Hauer #endif 814d96be879SSascha Hauer clk_disable(host->clk); 815d96be879SSascha Hauer clk_put(host->clk); 816d96be879SSascha Hauer 817d96be879SSascha Hauer release_mem_region(host->res->start, resource_size(host->res)); 818d96be879SSascha Hauer release_resource(host->res); 819d96be879SSascha Hauer 820d96be879SSascha Hauer mmc_free_host(mmc); 821d96be879SSascha Hauer 822d96be879SSascha Hauer return 0; 823d96be879SSascha Hauer } 824d96be879SSascha Hauer 825d96be879SSascha Hauer #ifdef CONFIG_PM 826d96be879SSascha Hauer static int mxcmci_suspend(struct platform_device *dev, pm_message_t state) 827d96be879SSascha Hauer { 828d96be879SSascha Hauer struct mmc_host *mmc = platform_get_drvdata(dev); 829d96be879SSascha Hauer int ret = 0; 830d96be879SSascha Hauer 831d96be879SSascha Hauer if (mmc) 832d96be879SSascha Hauer ret = mmc_suspend_host(mmc, state); 833d96be879SSascha Hauer 834d96be879SSascha Hauer return ret; 835d96be879SSascha Hauer } 836d96be879SSascha Hauer 837d96be879SSascha Hauer static int mxcmci_resume(struct platform_device *dev) 838d96be879SSascha Hauer { 839d96be879SSascha Hauer struct mmc_host *mmc = platform_get_drvdata(dev); 840d96be879SSascha Hauer struct mxcmci_host *host; 841d96be879SSascha Hauer int ret = 0; 842d96be879SSascha Hauer 843d96be879SSascha Hauer if (mmc) { 844d96be879SSascha Hauer host = mmc_priv(mmc); 845d96be879SSascha Hauer ret = mmc_resume_host(mmc); 846d96be879SSascha Hauer } 847d96be879SSascha Hauer 848d96be879SSascha Hauer return ret; 849d96be879SSascha Hauer } 850d96be879SSascha Hauer #else 851d96be879SSascha Hauer #define mxcmci_suspend NULL 852d96be879SSascha Hauer #define mxcmci_resume NULL 853d96be879SSascha Hauer #endif /* CONFIG_PM */ 854d96be879SSascha Hauer 855d96be879SSascha Hauer static struct platform_driver mxcmci_driver = { 856d96be879SSascha Hauer .probe = mxcmci_probe, 857d96be879SSascha Hauer .remove = mxcmci_remove, 858d96be879SSascha Hauer .suspend = mxcmci_suspend, 859d96be879SSascha Hauer .resume = mxcmci_resume, 860d96be879SSascha Hauer .driver = { 861d96be879SSascha Hauer .name = DRIVER_NAME, 862d96be879SSascha Hauer .owner = THIS_MODULE, 863d96be879SSascha Hauer } 864d96be879SSascha Hauer }; 865d96be879SSascha Hauer 866d96be879SSascha Hauer static int __init mxcmci_init(void) 867d96be879SSascha Hauer { 868d96be879SSascha Hauer return platform_driver_register(&mxcmci_driver); 869d96be879SSascha Hauer } 870d96be879SSascha Hauer 871d96be879SSascha Hauer static void __exit mxcmci_exit(void) 872d96be879SSascha Hauer { 873d96be879SSascha Hauer platform_driver_unregister(&mxcmci_driver); 874d96be879SSascha Hauer } 875d96be879SSascha Hauer 876d96be879SSascha Hauer module_init(mxcmci_init); 877d96be879SSascha Hauer module_exit(mxcmci_exit); 878d96be879SSascha Hauer 879d96be879SSascha Hauer MODULE_DESCRIPTION("i.MX Multimedia Card Interface Driver"); 880d96be879SSascha Hauer MODULE_AUTHOR("Sascha Hauer, Pengutronix"); 881d96be879SSascha Hauer MODULE_LICENSE("GPL"); 882d96be879SSascha Hauer MODULE_ALIAS("platform:imx-mmc"); 883