| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1 | /* | 
 | 2 |  *  linux/drivers/mmc/tmio_mmc.c | 
 | 3 |  * | 
 | 4 |  *  Copyright (C) 2004 Ian Molton | 
 | 5 |  *  Copyright (C) 2007 Ian Molton | 
 | 6 |  * | 
 | 7 |  * This program is free software; you can redistribute it and/or modify | 
 | 8 |  * it under the terms of the GNU General Public License version 2 as | 
 | 9 |  * published by the Free Software Foundation. | 
 | 10 |  * | 
 | 11 |  * Driver for the MMC / SD / SDIO cell found in: | 
 | 12 |  * | 
| Philipp Zabel | e6f2c7a | 2009-06-04 20:12:37 +0200 | [diff] [blame] | 13 |  * TC6393XB TC6391XB TC6387XB T7L66XB ASIC3 | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 14 |  * | 
 | 15 |  * This driver draws mainly on scattered spec sheets, Reverse engineering | 
 | 16 |  * of the toshiba e800  SD driver and some parts of the 2.4 ASIC3 driver (4 bit | 
 | 17 |  * support). (Further 4 bit support from a later datasheet). | 
 | 18 |  * | 
 | 19 |  * TODO: | 
 | 20 |  *   Investigate using a workqueue for PIO transfers | 
 | 21 |  *   Eliminate FIXMEs | 
 | 22 |  *   SDIO support | 
 | 23 |  *   Better Power management | 
 | 24 |  *   Handle MMC errors better | 
 | 25 |  *   double buffer support | 
 | 26 |  * | 
 | 27 |  */ | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 28 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 29 | #include <linux/delay.h> | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 30 | #include <linux/device.h> | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 31 | #include <linux/dmaengine.h> | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 32 | #include <linux/highmem.h> | 
 | 33 | #include <linux/interrupt.h> | 
 | 34 | #include <linux/io.h> | 
 | 35 | #include <linux/irq.h> | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 36 | #include <linux/mfd/core.h> | 
 | 37 | #include <linux/mfd/tmio.h> | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 38 | #include <linux/mmc/host.h> | 
 | 39 | #include <linux/module.h> | 
 | 40 | #include <linux/pagemap.h> | 
 | 41 | #include <linux/scatterlist.h> | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 42 | #include <linux/workqueue.h> | 
 | 43 | #include <linux/spinlock.h> | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 44 |  | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 45 | #define CTL_SD_CMD 0x00 | 
 | 46 | #define CTL_ARG_REG 0x04 | 
 | 47 | #define CTL_STOP_INTERNAL_ACTION 0x08 | 
 | 48 | #define CTL_XFER_BLK_COUNT 0xa | 
 | 49 | #define CTL_RESPONSE 0x0c | 
 | 50 | #define CTL_STATUS 0x1c | 
 | 51 | #define CTL_IRQ_MASK 0x20 | 
 | 52 | #define CTL_SD_CARD_CLK_CTL 0x24 | 
 | 53 | #define CTL_SD_XFER_LEN 0x26 | 
 | 54 | #define CTL_SD_MEM_CARD_OPT 0x28 | 
 | 55 | #define CTL_SD_ERROR_DETAIL_STATUS 0x2c | 
 | 56 | #define CTL_SD_DATA_PORT 0x30 | 
 | 57 | #define CTL_TRANSACTION_CTL 0x34 | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 58 | #define CTL_SDIO_STATUS 0x36 | 
 | 59 | #define CTL_SDIO_IRQ_MASK 0x38 | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 60 | #define CTL_RESET_SD 0xe0 | 
 | 61 | #define CTL_SDIO_REGS 0x100 | 
 | 62 | #define CTL_CLK_AND_WAIT_CTL 0x138 | 
 | 63 | #define CTL_RESET_SDIO 0x1e0 | 
 | 64 |  | 
 | 65 | /* Definitions for values the CTRL_STATUS register can take. */ | 
 | 66 | #define TMIO_STAT_CMDRESPEND    0x00000001 | 
 | 67 | #define TMIO_STAT_DATAEND       0x00000004 | 
 | 68 | #define TMIO_STAT_CARD_REMOVE   0x00000008 | 
 | 69 | #define TMIO_STAT_CARD_INSERT   0x00000010 | 
 | 70 | #define TMIO_STAT_SIGSTATE      0x00000020 | 
 | 71 | #define TMIO_STAT_WRPROTECT     0x00000080 | 
 | 72 | #define TMIO_STAT_CARD_REMOVE_A 0x00000100 | 
 | 73 | #define TMIO_STAT_CARD_INSERT_A 0x00000200 | 
 | 74 | #define TMIO_STAT_SIGSTATE_A    0x00000400 | 
 | 75 | #define TMIO_STAT_CMD_IDX_ERR   0x00010000 | 
 | 76 | #define TMIO_STAT_CRCFAIL       0x00020000 | 
 | 77 | #define TMIO_STAT_STOPBIT_ERR   0x00040000 | 
 | 78 | #define TMIO_STAT_DATATIMEOUT   0x00080000 | 
 | 79 | #define TMIO_STAT_RXOVERFLOW    0x00100000 | 
 | 80 | #define TMIO_STAT_TXUNDERRUN    0x00200000 | 
 | 81 | #define TMIO_STAT_CMDTIMEOUT    0x00400000 | 
 | 82 | #define TMIO_STAT_RXRDY         0x01000000 | 
 | 83 | #define TMIO_STAT_TXRQ          0x02000000 | 
 | 84 | #define TMIO_STAT_ILL_FUNC      0x20000000 | 
 | 85 | #define TMIO_STAT_CMD_BUSY      0x40000000 | 
 | 86 | #define TMIO_STAT_ILL_ACCESS    0x80000000 | 
 | 87 |  | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 88 | /* Definitions for values the CTRL_SDIO_STATUS register can take. */ | 
 | 89 | #define TMIO_SDIO_STAT_IOIRQ	0x0001 | 
 | 90 | #define TMIO_SDIO_STAT_EXPUB52	0x4000 | 
 | 91 | #define TMIO_SDIO_STAT_EXWT	0x8000 | 
 | 92 | #define TMIO_SDIO_MASK_ALL	0xc007 | 
 | 93 |  | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 94 | /* Define some IRQ masks */ | 
 | 95 | /* This is the mask used at reset by the chip */ | 
 | 96 | #define TMIO_MASK_ALL           0x837f031d | 
 | 97 | #define TMIO_MASK_READOP  (TMIO_STAT_RXRDY | TMIO_STAT_DATAEND) | 
 | 98 | #define TMIO_MASK_WRITEOP (TMIO_STAT_TXRQ | TMIO_STAT_DATAEND) | 
 | 99 | #define TMIO_MASK_CMD     (TMIO_STAT_CMDRESPEND | TMIO_STAT_CMDTIMEOUT | \ | 
 | 100 | 		TMIO_STAT_CARD_REMOVE | TMIO_STAT_CARD_INSERT) | 
 | 101 | #define TMIO_MASK_IRQ     (TMIO_MASK_READOP | TMIO_MASK_WRITEOP | TMIO_MASK_CMD) | 
 | 102 |  | 
 | 103 | #define enable_mmc_irqs(host, i) \ | 
 | 104 | 	do { \ | 
 | 105 | 		u32 mask;\ | 
 | 106 | 		mask  = sd_ctrl_read32((host), CTL_IRQ_MASK); \ | 
 | 107 | 		mask &= ~((i) & TMIO_MASK_IRQ); \ | 
 | 108 | 		sd_ctrl_write32((host), CTL_IRQ_MASK, mask); \ | 
 | 109 | 	} while (0) | 
 | 110 |  | 
 | 111 | #define disable_mmc_irqs(host, i) \ | 
 | 112 | 	do { \ | 
 | 113 | 		u32 mask;\ | 
 | 114 | 		mask  = sd_ctrl_read32((host), CTL_IRQ_MASK); \ | 
 | 115 | 		mask |= ((i) & TMIO_MASK_IRQ); \ | 
 | 116 | 		sd_ctrl_write32((host), CTL_IRQ_MASK, mask); \ | 
 | 117 | 	} while (0) | 
 | 118 |  | 
 | 119 | #define ack_mmc_irqs(host, i) \ | 
 | 120 | 	do { \ | 
 | 121 | 		sd_ctrl_write32((host), CTL_STATUS, ~(i)); \ | 
 | 122 | 	} while (0) | 
 | 123 |  | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 124 | /* This is arbitrary, just noone needed any higher alignment yet */ | 
 | 125 | #define MAX_ALIGN 4 | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 126 |  | 
 | 127 | struct tmio_mmc_host { | 
 | 128 | 	void __iomem *ctl; | 
 | 129 | 	unsigned long bus_shift; | 
 | 130 | 	struct mmc_command      *cmd; | 
 | 131 | 	struct mmc_request      *mrq; | 
 | 132 | 	struct mmc_data         *data; | 
 | 133 | 	struct mmc_host         *mmc; | 
 | 134 | 	int                     irq; | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 135 | 	unsigned int		sdio_irq_enabled; | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 136 |  | 
 | 137 | 	/* Callbacks for clock / power control */ | 
 | 138 | 	void (*set_pwr)(struct platform_device *host, int state); | 
 | 139 | 	void (*set_clk_div)(struct platform_device *host, int state); | 
 | 140 |  | 
 | 141 | 	/* pio related stuff */ | 
 | 142 | 	struct scatterlist      *sg_ptr; | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 143 | 	struct scatterlist      *sg_orig; | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 144 | 	unsigned int            sg_len; | 
 | 145 | 	unsigned int            sg_off; | 
 | 146 |  | 
 | 147 | 	struct platform_device *pdev; | 
 | 148 |  | 
 | 149 | 	/* DMA support */ | 
 | 150 | 	struct dma_chan		*chan_rx; | 
 | 151 | 	struct dma_chan		*chan_tx; | 
 | 152 | 	struct tasklet_struct	dma_complete; | 
 | 153 | 	struct tasklet_struct	dma_issue; | 
 | 154 | #ifdef CONFIG_TMIO_MMC_DMA | 
 | 155 | 	unsigned int            dma_sglen; | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 156 | 	u8			bounce_buf[PAGE_CACHE_SIZE] __attribute__((aligned(MAX_ALIGN))); | 
 | 157 | 	struct scatterlist	bounce_sg; | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 158 | #endif | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 159 |  | 
 | 160 | 	/* Track lost interrupts */ | 
 | 161 | 	struct delayed_work	delayed_reset_work; | 
 | 162 | 	spinlock_t		lock; | 
 | 163 | 	unsigned long		last_req_ts; | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 164 | }; | 
 | 165 |  | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 166 | static void tmio_check_bounce_buffer(struct tmio_mmc_host *host); | 
 | 167 |  | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 168 | static u16 sd_ctrl_read16(struct tmio_mmc_host *host, int addr) | 
 | 169 | { | 
 | 170 | 	return readw(host->ctl + (addr << host->bus_shift)); | 
 | 171 | } | 
 | 172 |  | 
 | 173 | static void sd_ctrl_read16_rep(struct tmio_mmc_host *host, int addr, | 
 | 174 | 		u16 *buf, int count) | 
 | 175 | { | 
 | 176 | 	readsw(host->ctl + (addr << host->bus_shift), buf, count); | 
 | 177 | } | 
 | 178 |  | 
 | 179 | static u32 sd_ctrl_read32(struct tmio_mmc_host *host, int addr) | 
 | 180 | { | 
 | 181 | 	return readw(host->ctl + (addr << host->bus_shift)) | | 
 | 182 | 	       readw(host->ctl + ((addr + 2) << host->bus_shift)) << 16; | 
 | 183 | } | 
 | 184 |  | 
 | 185 | static void sd_ctrl_write16(struct tmio_mmc_host *host, int addr, u16 val) | 
 | 186 | { | 
 | 187 | 	writew(val, host->ctl + (addr << host->bus_shift)); | 
 | 188 | } | 
 | 189 |  | 
 | 190 | static void sd_ctrl_write16_rep(struct tmio_mmc_host *host, int addr, | 
 | 191 | 		u16 *buf, int count) | 
 | 192 | { | 
 | 193 | 	writesw(host->ctl + (addr << host->bus_shift), buf, count); | 
 | 194 | } | 
 | 195 |  | 
 | 196 | static void sd_ctrl_write32(struct tmio_mmc_host *host, int addr, u32 val) | 
 | 197 | { | 
 | 198 | 	writew(val, host->ctl + (addr << host->bus_shift)); | 
 | 199 | 	writew(val >> 16, host->ctl + ((addr + 2) << host->bus_shift)); | 
 | 200 | } | 
 | 201 |  | 
 | 202 | static void tmio_mmc_init_sg(struct tmio_mmc_host *host, struct mmc_data *data) | 
 | 203 | { | 
 | 204 | 	host->sg_len = data->sg_len; | 
 | 205 | 	host->sg_ptr = data->sg; | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 206 | 	host->sg_orig = data->sg; | 
| Guennadi Liakhovetski | e0bc6ff | 2010-11-23 17:24:11 +0100 | [diff] [blame] | 207 | 	host->sg_off = 0; | 
 | 208 | } | 
 | 209 |  | 
 | 210 | static int tmio_mmc_next_sg(struct tmio_mmc_host *host) | 
 | 211 | { | 
 | 212 | 	host->sg_ptr = sg_next(host->sg_ptr); | 
 | 213 | 	host->sg_off = 0; | 
 | 214 | 	return --host->sg_len; | 
 | 215 | } | 
 | 216 |  | 
 | 217 | static char *tmio_mmc_kmap_atomic(struct scatterlist *sg, unsigned long *flags) | 
 | 218 | { | 
 | 219 | 	local_irq_save(*flags); | 
 | 220 | 	return kmap_atomic(sg_page(sg), KM_BIO_SRC_IRQ) + sg->offset; | 
 | 221 | } | 
 | 222 |  | 
 | 223 | static void tmio_mmc_kunmap_atomic(void *virt, unsigned long *flags) | 
 | 224 | { | 
 | 225 | 	kunmap_atomic(virt, KM_BIO_SRC_IRQ); | 
 | 226 | 	local_irq_restore(*flags); | 
 | 227 | } | 
 | 228 |  | 
 | 229 | #ifdef CONFIG_MMC_DEBUG | 
 | 230 |  | 
 | 231 | #define STATUS_TO_TEXT(a) \ | 
 | 232 | 	do { \ | 
 | 233 | 		if (status & TMIO_STAT_##a) \ | 
 | 234 | 			printk(#a); \ | 
 | 235 | 	} while (0) | 
 | 236 |  | 
 | 237 | void pr_debug_status(u32 status) | 
 | 238 | { | 
 | 239 | 	printk(KERN_DEBUG "status: %08x = ", status); | 
 | 240 | 	STATUS_TO_TEXT(CARD_REMOVE); | 
 | 241 | 	STATUS_TO_TEXT(CARD_INSERT); | 
 | 242 | 	STATUS_TO_TEXT(SIGSTATE); | 
 | 243 | 	STATUS_TO_TEXT(WRPROTECT); | 
 | 244 | 	STATUS_TO_TEXT(CARD_REMOVE_A); | 
 | 245 | 	STATUS_TO_TEXT(CARD_INSERT_A); | 
 | 246 | 	STATUS_TO_TEXT(SIGSTATE_A); | 
 | 247 | 	STATUS_TO_TEXT(CMD_IDX_ERR); | 
 | 248 | 	STATUS_TO_TEXT(STOPBIT_ERR); | 
 | 249 | 	STATUS_TO_TEXT(ILL_FUNC); | 
 | 250 | 	STATUS_TO_TEXT(CMD_BUSY); | 
 | 251 | 	STATUS_TO_TEXT(CMDRESPEND); | 
 | 252 | 	STATUS_TO_TEXT(DATAEND); | 
 | 253 | 	STATUS_TO_TEXT(CRCFAIL); | 
 | 254 | 	STATUS_TO_TEXT(DATATIMEOUT); | 
 | 255 | 	STATUS_TO_TEXT(CMDTIMEOUT); | 
 | 256 | 	STATUS_TO_TEXT(RXOVERFLOW); | 
 | 257 | 	STATUS_TO_TEXT(TXUNDERRUN); | 
 | 258 | 	STATUS_TO_TEXT(RXRDY); | 
 | 259 | 	STATUS_TO_TEXT(TXRQ); | 
 | 260 | 	STATUS_TO_TEXT(ILL_ACCESS); | 
 | 261 | 	printk("\n"); | 
 | 262 | } | 
 | 263 |  | 
 | 264 | #else | 
 | 265 | #define pr_debug_status(s)  do { } while (0) | 
 | 266 | #endif | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 267 |  | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 268 | static void tmio_mmc_enable_sdio_irq(struct mmc_host *mmc, int enable) | 
 | 269 | { | 
 | 270 | 	struct tmio_mmc_host *host = mmc_priv(mmc); | 
 | 271 |  | 
 | 272 | 	if (enable) { | 
 | 273 | 		host->sdio_irq_enabled = 1; | 
 | 274 | 		sd_ctrl_write16(host, CTL_TRANSACTION_CTL, 0x0001); | 
 | 275 | 		sd_ctrl_write16(host, CTL_SDIO_IRQ_MASK, | 
 | 276 | 			(TMIO_SDIO_MASK_ALL & ~TMIO_SDIO_STAT_IOIRQ)); | 
 | 277 | 	} else { | 
 | 278 | 		sd_ctrl_write16(host, CTL_SDIO_IRQ_MASK, TMIO_SDIO_MASK_ALL); | 
 | 279 | 		sd_ctrl_write16(host, CTL_TRANSACTION_CTL, 0x0000); | 
 | 280 | 		host->sdio_irq_enabled = 0; | 
 | 281 | 	} | 
 | 282 | } | 
 | 283 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 284 | static void tmio_mmc_set_clock(struct tmio_mmc_host *host, int new_clock) | 
 | 285 | { | 
| Ian Molton | da46a0b | 2009-06-12 21:53:05 +0100 | [diff] [blame] | 286 | 	u32 clk = 0, clock; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 287 |  | 
 | 288 | 	if (new_clock) { | 
| Ian Molton | da46a0b | 2009-06-12 21:53:05 +0100 | [diff] [blame] | 289 | 		for (clock = host->mmc->f_min, clk = 0x80000080; | 
 | 290 | 			new_clock >= (clock<<1); clk >>= 1) | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 291 | 			clock <<= 1; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 292 | 		clk |= 0x100; | 
 | 293 | 	} | 
 | 294 |  | 
| Ian Molton | 64e8867 | 2010-01-06 13:51:48 +0100 | [diff] [blame] | 295 | 	if (host->set_clk_div) | 
 | 296 | 		host->set_clk_div(host->pdev, (clk>>22) & 1); | 
 | 297 |  | 
| Ian Molton | da46a0b | 2009-06-12 21:53:05 +0100 | [diff] [blame] | 298 | 	sd_ctrl_write16(host, CTL_SD_CARD_CLK_CTL, clk & 0x1ff); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 299 | } | 
 | 300 |  | 
 | 301 | static void tmio_mmc_clk_stop(struct tmio_mmc_host *host) | 
 | 302 | { | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 303 | 	struct mfd_cell *cell = host->pdev->dev.platform_data; | 
 | 304 | 	struct tmio_mmc_data *pdata = cell->driver_data; | 
 | 305 |  | 
 | 306 | 	/* | 
 | 307 | 	 * Testing on sh-mobile showed that SDIO IRQs are unmasked when | 
 | 308 | 	 * CTL_CLK_AND_WAIT_CTL gets written, so we have to disable the | 
 | 309 | 	 * device IRQ here and restore the SDIO IRQ mask before | 
 | 310 | 	 * re-enabling the device IRQ. | 
 | 311 | 	 */ | 
 | 312 | 	if (pdata->flags & TMIO_MMC_SDIO_IRQ) | 
 | 313 | 		disable_irq(host->irq); | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 314 | 	sd_ctrl_write16(host, CTL_CLK_AND_WAIT_CTL, 0x0000); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 315 | 	msleep(10); | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 316 | 	if (pdata->flags & TMIO_MMC_SDIO_IRQ) { | 
 | 317 | 		tmio_mmc_enable_sdio_irq(host->mmc, host->sdio_irq_enabled); | 
 | 318 | 		enable_irq(host->irq); | 
 | 319 | 	} | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 320 | 	sd_ctrl_write16(host, CTL_SD_CARD_CLK_CTL, ~0x0100 & | 
 | 321 | 		sd_ctrl_read16(host, CTL_SD_CARD_CLK_CTL)); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 322 | 	msleep(10); | 
 | 323 | } | 
 | 324 |  | 
 | 325 | static void tmio_mmc_clk_start(struct tmio_mmc_host *host) | 
 | 326 | { | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 327 | 	struct mfd_cell *cell = host->pdev->dev.platform_data; | 
 | 328 | 	struct tmio_mmc_data *pdata = cell->driver_data; | 
 | 329 |  | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 330 | 	sd_ctrl_write16(host, CTL_SD_CARD_CLK_CTL, 0x0100 | | 
 | 331 | 		sd_ctrl_read16(host, CTL_SD_CARD_CLK_CTL)); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 332 | 	msleep(10); | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 333 | 	/* see comment in tmio_mmc_clk_stop above */ | 
 | 334 | 	if (pdata->flags & TMIO_MMC_SDIO_IRQ) | 
 | 335 | 		disable_irq(host->irq); | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 336 | 	sd_ctrl_write16(host, CTL_CLK_AND_WAIT_CTL, 0x0100); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 337 | 	msleep(10); | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 338 | 	if (pdata->flags & TMIO_MMC_SDIO_IRQ) { | 
 | 339 | 		tmio_mmc_enable_sdio_irq(host->mmc, host->sdio_irq_enabled); | 
 | 340 | 		enable_irq(host->irq); | 
 | 341 | 	} | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 342 | } | 
 | 343 |  | 
 | 344 | static void reset(struct tmio_mmc_host *host) | 
 | 345 | { | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 346 | 	/* FIXME - should we set stop clock reg here */ | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 347 | 	sd_ctrl_write16(host, CTL_RESET_SD, 0x0000); | 
 | 348 | 	sd_ctrl_write16(host, CTL_RESET_SDIO, 0x0000); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 349 | 	msleep(10); | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 350 | 	sd_ctrl_write16(host, CTL_RESET_SD, 0x0001); | 
 | 351 | 	sd_ctrl_write16(host, CTL_RESET_SDIO, 0x0001); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 352 | 	msleep(10); | 
 | 353 | } | 
 | 354 |  | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 355 | static void tmio_mmc_reset_work(struct work_struct *work) | 
 | 356 | { | 
 | 357 | 	struct tmio_mmc_host *host = container_of(work, struct tmio_mmc_host, | 
 | 358 | 						  delayed_reset_work.work); | 
 | 359 | 	struct mmc_request *mrq; | 
 | 360 | 	unsigned long flags; | 
 | 361 |  | 
 | 362 | 	spin_lock_irqsave(&host->lock, flags); | 
 | 363 | 	mrq = host->mrq; | 
 | 364 |  | 
 | 365 | 	/* request already finished */ | 
 | 366 | 	if (!mrq | 
 | 367 | 	    || time_is_after_jiffies(host->last_req_ts + | 
 | 368 | 		msecs_to_jiffies(2000))) { | 
 | 369 | 		spin_unlock_irqrestore(&host->lock, flags); | 
 | 370 | 		return; | 
 | 371 | 	} | 
 | 372 |  | 
 | 373 | 	dev_warn(&host->pdev->dev, | 
 | 374 | 		"timeout waiting for hardware interrupt (CMD%u)\n", | 
 | 375 | 		mrq->cmd->opcode); | 
 | 376 |  | 
 | 377 | 	if (host->data) | 
 | 378 | 		host->data->error = -ETIMEDOUT; | 
 | 379 | 	else if (host->cmd) | 
 | 380 | 		host->cmd->error = -ETIMEDOUT; | 
 | 381 | 	else | 
 | 382 | 		mrq->cmd->error = -ETIMEDOUT; | 
 | 383 |  | 
 | 384 | 	host->cmd = NULL; | 
 | 385 | 	host->data = NULL; | 
 | 386 | 	host->mrq = NULL; | 
 | 387 |  | 
 | 388 | 	spin_unlock_irqrestore(&host->lock, flags); | 
 | 389 |  | 
 | 390 | 	reset(host); | 
 | 391 |  | 
 | 392 | 	mmc_request_done(host->mmc, mrq); | 
 | 393 | } | 
 | 394 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 395 | static void | 
 | 396 | tmio_mmc_finish_request(struct tmio_mmc_host *host) | 
 | 397 | { | 
 | 398 | 	struct mmc_request *mrq = host->mrq; | 
 | 399 |  | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 400 | 	if (!mrq) | 
 | 401 | 		return; | 
 | 402 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 403 | 	host->mrq = NULL; | 
 | 404 | 	host->cmd = NULL; | 
 | 405 | 	host->data = NULL; | 
 | 406 |  | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 407 | 	cancel_delayed_work(&host->delayed_reset_work); | 
 | 408 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 409 | 	mmc_request_done(host->mmc, mrq); | 
 | 410 | } | 
 | 411 |  | 
 | 412 | /* These are the bitmasks the tmio chip requires to implement the MMC response | 
 | 413 |  * types. Note that R1 and R6 are the same in this scheme. */ | 
 | 414 | #define APP_CMD        0x0040 | 
 | 415 | #define RESP_NONE      0x0300 | 
 | 416 | #define RESP_R1        0x0400 | 
 | 417 | #define RESP_R1B       0x0500 | 
 | 418 | #define RESP_R2        0x0600 | 
 | 419 | #define RESP_R3        0x0700 | 
 | 420 | #define DATA_PRESENT   0x0800 | 
 | 421 | #define TRANSFER_READ  0x1000 | 
 | 422 | #define TRANSFER_MULTI 0x2000 | 
 | 423 | #define SECURITY_CMD   0x4000 | 
 | 424 |  | 
 | 425 | static int | 
 | 426 | tmio_mmc_start_command(struct tmio_mmc_host *host, struct mmc_command *cmd) | 
 | 427 | { | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 428 | 	struct mmc_data *data = host->data; | 
 | 429 | 	int c = cmd->opcode; | 
 | 430 |  | 
 | 431 | 	/* Command 12 is handled by hardware */ | 
 | 432 | 	if (cmd->opcode == 12 && !cmd->arg) { | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 433 | 		sd_ctrl_write16(host, CTL_STOP_INTERNAL_ACTION, 0x001); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 434 | 		return 0; | 
 | 435 | 	} | 
 | 436 |  | 
 | 437 | 	switch (mmc_resp_type(cmd)) { | 
 | 438 | 	case MMC_RSP_NONE: c |= RESP_NONE; break; | 
 | 439 | 	case MMC_RSP_R1:   c |= RESP_R1;   break; | 
 | 440 | 	case MMC_RSP_R1B:  c |= RESP_R1B;  break; | 
 | 441 | 	case MMC_RSP_R2:   c |= RESP_R2;   break; | 
 | 442 | 	case MMC_RSP_R3:   c |= RESP_R3;   break; | 
 | 443 | 	default: | 
 | 444 | 		pr_debug("Unknown response type %d\n", mmc_resp_type(cmd)); | 
 | 445 | 		return -EINVAL; | 
 | 446 | 	} | 
 | 447 |  | 
 | 448 | 	host->cmd = cmd; | 
 | 449 |  | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 450 | /* FIXME - this seems to be ok commented out but the spec suggest this bit | 
 | 451 |  *         should be set when issuing app commands. | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 452 |  *	if(cmd->flags & MMC_FLAG_ACMD) | 
 | 453 |  *		c |= APP_CMD; | 
 | 454 |  */ | 
 | 455 | 	if (data) { | 
 | 456 | 		c |= DATA_PRESENT; | 
 | 457 | 		if (data->blocks > 1) { | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 458 | 			sd_ctrl_write16(host, CTL_STOP_INTERNAL_ACTION, 0x100); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 459 | 			c |= TRANSFER_MULTI; | 
 | 460 | 		} | 
 | 461 | 		if (data->flags & MMC_DATA_READ) | 
 | 462 | 			c |= TRANSFER_READ; | 
 | 463 | 	} | 
 | 464 |  | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 465 | 	enable_mmc_irqs(host, TMIO_MASK_CMD); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 466 |  | 
 | 467 | 	/* Fire off the command */ | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 468 | 	sd_ctrl_write32(host, CTL_ARG_REG, cmd->arg); | 
 | 469 | 	sd_ctrl_write16(host, CTL_SD_CMD, c); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 470 |  | 
 | 471 | 	return 0; | 
 | 472 | } | 
 | 473 |  | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 474 | /* | 
 | 475 |  * This chip always returns (at least?) as much data as you ask for. | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 476 |  * I'm unsure what happens if you ask for less than a block. This should be | 
 | 477 |  * looked into to ensure that a funny length read doesnt hose the controller. | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 478 |  */ | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 479 | static void tmio_mmc_pio_irq(struct tmio_mmc_host *host) | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 480 | { | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 481 | 	struct mmc_data *data = host->data; | 
| Guennadi Liakhovetski | 5600efb | 2010-09-09 16:37:43 -0700 | [diff] [blame] | 482 | 	void *sg_virt; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 483 | 	unsigned short *buf; | 
 | 484 | 	unsigned int count; | 
 | 485 | 	unsigned long flags; | 
 | 486 |  | 
 | 487 | 	if (!data) { | 
 | 488 | 		pr_debug("Spurious PIO IRQ\n"); | 
 | 489 | 		return; | 
 | 490 | 	} | 
 | 491 |  | 
| Guennadi Liakhovetski | 5600efb | 2010-09-09 16:37:43 -0700 | [diff] [blame] | 492 | 	sg_virt = tmio_mmc_kmap_atomic(host->sg_ptr, &flags); | 
 | 493 | 	buf = (unsigned short *)(sg_virt + host->sg_off); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 494 |  | 
 | 495 | 	count = host->sg_ptr->length - host->sg_off; | 
 | 496 | 	if (count > data->blksz) | 
 | 497 | 		count = data->blksz; | 
 | 498 |  | 
 | 499 | 	pr_debug("count: %08x offset: %08x flags %08x\n", | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 500 | 		 count, host->sg_off, data->flags); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 501 |  | 
 | 502 | 	/* Transfer the data */ | 
 | 503 | 	if (data->flags & MMC_DATA_READ) | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 504 | 		sd_ctrl_read16_rep(host, CTL_SD_DATA_PORT, buf, count >> 1); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 505 | 	else | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 506 | 		sd_ctrl_write16_rep(host, CTL_SD_DATA_PORT, buf, count >> 1); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 507 |  | 
 | 508 | 	host->sg_off += count; | 
 | 509 |  | 
| Guennadi Liakhovetski | 5600efb | 2010-09-09 16:37:43 -0700 | [diff] [blame] | 510 | 	tmio_mmc_kunmap_atomic(sg_virt, &flags); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 511 |  | 
 | 512 | 	if (host->sg_off == host->sg_ptr->length) | 
 | 513 | 		tmio_mmc_next_sg(host); | 
 | 514 |  | 
 | 515 | 	return; | 
 | 516 | } | 
 | 517 |  | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 518 | /* needs to be called with host->lock held */ | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 519 | static void tmio_mmc_do_data_irq(struct tmio_mmc_host *host) | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 520 | { | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 521 | 	struct mmc_data *data = host->data; | 
| Julia Lawall | a0d045c | 2008-12-16 16:13:09 +0100 | [diff] [blame] | 522 | 	struct mmc_command *stop; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 523 |  | 
 | 524 | 	host->data = NULL; | 
 | 525 |  | 
 | 526 | 	if (!data) { | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 527 | 		dev_warn(&host->pdev->dev, "Spurious data end IRQ\n"); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 528 | 		return; | 
 | 529 | 	} | 
| Julia Lawall | a0d045c | 2008-12-16 16:13:09 +0100 | [diff] [blame] | 530 | 	stop = data->stop; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 531 |  | 
 | 532 | 	/* FIXME - return correct transfer count on errors */ | 
 | 533 | 	if (!data->error) | 
 | 534 | 		data->bytes_xfered = data->blocks * data->blksz; | 
 | 535 | 	else | 
 | 536 | 		data->bytes_xfered = 0; | 
 | 537 |  | 
 | 538 | 	pr_debug("Completed data request\n"); | 
 | 539 |  | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 540 | 	/* | 
 | 541 | 	 * FIXME: other drivers allow an optional stop command of any given type | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 542 | 	 *        which we dont do, as the chip can auto generate them. | 
 | 543 | 	 *        Perhaps we can be smarter about when to use auto CMD12 and | 
 | 544 | 	 *        only issue the auto request when we know this is the desired | 
 | 545 | 	 *        stop command, allowing fallback to the stop command the | 
 | 546 | 	 *        upper layers expect. For now, we do what works. | 
 | 547 | 	 */ | 
 | 548 |  | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 549 | 	if (data->flags & MMC_DATA_READ) { | 
 | 550 | 		if (!host->chan_rx) | 
 | 551 | 			disable_mmc_irqs(host, TMIO_MASK_READOP); | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 552 | 		else | 
 | 553 | 			tmio_check_bounce_buffer(host); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 554 | 		dev_dbg(&host->pdev->dev, "Complete Rx request %p\n", | 
 | 555 | 			host->mrq); | 
 | 556 | 	} else { | 
 | 557 | 		if (!host->chan_tx) | 
 | 558 | 			disable_mmc_irqs(host, TMIO_MASK_WRITEOP); | 
 | 559 | 		dev_dbg(&host->pdev->dev, "Complete Tx request %p\n", | 
 | 560 | 			host->mrq); | 
 | 561 | 	} | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 562 |  | 
 | 563 | 	if (stop) { | 
 | 564 | 		if (stop->opcode == 12 && !stop->arg) | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 565 | 			sd_ctrl_write16(host, CTL_STOP_INTERNAL_ACTION, 0x000); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 566 | 		else | 
 | 567 | 			BUG(); | 
 | 568 | 	} | 
 | 569 |  | 
 | 570 | 	tmio_mmc_finish_request(host); | 
 | 571 | } | 
 | 572 |  | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 573 | static void tmio_mmc_data_irq(struct tmio_mmc_host *host) | 
 | 574 | { | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 575 | 	struct mmc_data *data; | 
 | 576 | 	spin_lock(&host->lock); | 
 | 577 | 	data = host->data; | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 578 |  | 
 | 579 | 	if (!data) | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 580 | 		goto out; | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 581 |  | 
 | 582 | 	if (host->chan_tx && (data->flags & MMC_DATA_WRITE)) { | 
 | 583 | 		/* | 
 | 584 | 		 * Has all data been written out yet? Testing on SuperH showed, | 
 | 585 | 		 * that in most cases the first interrupt comes already with the | 
 | 586 | 		 * BUSY status bit clear, but on some operations, like mount or | 
 | 587 | 		 * in the beginning of a write / sync / umount, there is one | 
 | 588 | 		 * DATAEND interrupt with the BUSY bit set, in this cases | 
 | 589 | 		 * waiting for one more interrupt fixes the problem. | 
 | 590 | 		 */ | 
 | 591 | 		if (!(sd_ctrl_read32(host, CTL_STATUS) & TMIO_STAT_CMD_BUSY)) { | 
 | 592 | 			disable_mmc_irqs(host, TMIO_STAT_DATAEND); | 
 | 593 | 			tasklet_schedule(&host->dma_complete); | 
 | 594 | 		} | 
 | 595 | 	} else if (host->chan_rx && (data->flags & MMC_DATA_READ)) { | 
 | 596 | 		disable_mmc_irqs(host, TMIO_STAT_DATAEND); | 
 | 597 | 		tasklet_schedule(&host->dma_complete); | 
 | 598 | 	} else { | 
 | 599 | 		tmio_mmc_do_data_irq(host); | 
 | 600 | 	} | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 601 | out: | 
 | 602 | 	spin_unlock(&host->lock); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 603 | } | 
 | 604 |  | 
 | 605 | static void tmio_mmc_cmd_irq(struct tmio_mmc_host *host, | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 606 | 	unsigned int stat) | 
 | 607 | { | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 608 | 	struct mmc_command *cmd = host->cmd; | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 609 | 	int i, addr; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 610 |  | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 611 | 	spin_lock(&host->lock); | 
 | 612 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 613 | 	if (!host->cmd) { | 
 | 614 | 		pr_debug("Spurious CMD irq\n"); | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 615 | 		goto out; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 616 | 	} | 
 | 617 |  | 
 | 618 | 	host->cmd = NULL; | 
 | 619 |  | 
 | 620 | 	/* This controller is sicker than the PXA one. Not only do we need to | 
 | 621 | 	 * drop the top 8 bits of the first response word, we also need to | 
 | 622 | 	 * modify the order of the response for short response command types. | 
 | 623 | 	 */ | 
 | 624 |  | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 625 | 	for (i = 3, addr = CTL_RESPONSE ; i >= 0 ; i--, addr += 4) | 
 | 626 | 		cmd->resp[i] = sd_ctrl_read32(host, addr); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 627 |  | 
 | 628 | 	if (cmd->flags &  MMC_RSP_136) { | 
 | 629 | 		cmd->resp[0] = (cmd->resp[0] << 8) | (cmd->resp[1] >> 24); | 
 | 630 | 		cmd->resp[1] = (cmd->resp[1] << 8) | (cmd->resp[2] >> 24); | 
 | 631 | 		cmd->resp[2] = (cmd->resp[2] << 8) | (cmd->resp[3] >> 24); | 
 | 632 | 		cmd->resp[3] <<= 8; | 
 | 633 | 	} else if (cmd->flags & MMC_RSP_R3) { | 
 | 634 | 		cmd->resp[0] = cmd->resp[3]; | 
 | 635 | 	} | 
 | 636 |  | 
 | 637 | 	if (stat & TMIO_STAT_CMDTIMEOUT) | 
 | 638 | 		cmd->error = -ETIMEDOUT; | 
 | 639 | 	else if (stat & TMIO_STAT_CRCFAIL && cmd->flags & MMC_RSP_CRC) | 
 | 640 | 		cmd->error = -EILSEQ; | 
 | 641 |  | 
 | 642 | 	/* If there is data to handle we enable data IRQs here, and | 
 | 643 | 	 * we will ultimatley finish the request in the data_end handler. | 
 | 644 | 	 * If theres no data or we encountered an error, finish now. | 
 | 645 | 	 */ | 
 | 646 | 	if (host->data && !cmd->error) { | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 647 | 		if (host->data->flags & MMC_DATA_READ) { | 
 | 648 | 			if (!host->chan_rx) | 
 | 649 | 				enable_mmc_irqs(host, TMIO_MASK_READOP); | 
 | 650 | 		} else { | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 651 | 			if (!host->chan_tx) | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 652 | 				enable_mmc_irqs(host, TMIO_MASK_WRITEOP); | 
 | 653 | 			else | 
 | 654 | 				tasklet_schedule(&host->dma_issue); | 
 | 655 | 		} | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 656 | 	} else { | 
 | 657 | 		tmio_mmc_finish_request(host); | 
 | 658 | 	} | 
 | 659 |  | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 660 | out: | 
 | 661 | 	spin_unlock(&host->lock); | 
 | 662 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 663 | 	return; | 
 | 664 | } | 
 | 665 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 666 | static irqreturn_t tmio_mmc_irq(int irq, void *devid) | 
 | 667 | { | 
 | 668 | 	struct tmio_mmc_host *host = devid; | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 669 | 	struct mfd_cell	*cell = host->pdev->dev.platform_data; | 
 | 670 | 	struct tmio_mmc_data *pdata = cell->driver_data; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 671 | 	unsigned int ireg, irq_mask, status; | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 672 | 	unsigned int sdio_ireg, sdio_irq_mask, sdio_status; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 673 |  | 
 | 674 | 	pr_debug("MMC IRQ begin\n"); | 
 | 675 |  | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 676 | 	status = sd_ctrl_read32(host, CTL_STATUS); | 
 | 677 | 	irq_mask = sd_ctrl_read32(host, CTL_IRQ_MASK); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 678 | 	ireg = status & TMIO_MASK_IRQ & ~irq_mask; | 
 | 679 |  | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 680 | 	sdio_ireg = 0; | 
 | 681 | 	if (!ireg && pdata->flags & TMIO_MMC_SDIO_IRQ) { | 
 | 682 | 		sdio_status = sd_ctrl_read16(host, CTL_SDIO_STATUS); | 
 | 683 | 		sdio_irq_mask = sd_ctrl_read16(host, CTL_SDIO_IRQ_MASK); | 
 | 684 | 		sdio_ireg = sdio_status & TMIO_SDIO_MASK_ALL & ~sdio_irq_mask; | 
 | 685 |  | 
 | 686 | 		sd_ctrl_write16(host, CTL_SDIO_STATUS, sdio_status & ~TMIO_SDIO_MASK_ALL); | 
 | 687 |  | 
 | 688 | 		if (sdio_ireg && !host->sdio_irq_enabled) { | 
 | 689 | 			pr_warning("tmio_mmc: Spurious SDIO IRQ, disabling! 0x%04x 0x%04x 0x%04x\n", | 
 | 690 | 				   sdio_status, sdio_irq_mask, sdio_ireg); | 
 | 691 | 			tmio_mmc_enable_sdio_irq(host->mmc, 0); | 
 | 692 | 			goto out; | 
 | 693 | 		} | 
 | 694 |  | 
 | 695 | 		if (host->mmc->caps & MMC_CAP_SDIO_IRQ && | 
 | 696 | 			sdio_ireg & TMIO_SDIO_STAT_IOIRQ) | 
 | 697 | 			mmc_signal_sdio_irq(host->mmc); | 
 | 698 |  | 
 | 699 | 		if (sdio_ireg) | 
 | 700 | 			goto out; | 
 | 701 | 	} | 
 | 702 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 703 | 	pr_debug_status(status); | 
 | 704 | 	pr_debug_status(ireg); | 
 | 705 |  | 
 | 706 | 	if (!ireg) { | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 707 | 		disable_mmc_irqs(host, status & ~irq_mask); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 708 |  | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 709 | 		pr_warning("tmio_mmc: Spurious irq, disabling! " | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 710 | 			"0x%08x 0x%08x 0x%08x\n", status, irq_mask, ireg); | 
 | 711 | 		pr_debug_status(status); | 
 | 712 |  | 
 | 713 | 		goto out; | 
 | 714 | 	} | 
 | 715 |  | 
 | 716 | 	while (ireg) { | 
 | 717 | 		/* Card insert / remove attempts */ | 
 | 718 | 		if (ireg & (TMIO_STAT_CARD_INSERT | TMIO_STAT_CARD_REMOVE)) { | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 719 | 			ack_mmc_irqs(host, TMIO_STAT_CARD_INSERT | | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 720 | 				TMIO_STAT_CARD_REMOVE); | 
| Magnus Damm | 6d9af5a | 2010-02-17 16:38:04 +0900 | [diff] [blame] | 721 | 			mmc_detect_change(host->mmc, msecs_to_jiffies(100)); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 722 | 		} | 
 | 723 |  | 
 | 724 | 		/* CRC and other errors */ | 
 | 725 | /*		if (ireg & TMIO_STAT_ERR_IRQ) | 
 | 726 |  *			handled |= tmio_error_irq(host, irq, stat); | 
 | 727 |  */ | 
 | 728 |  | 
 | 729 | 		/* Command completion */ | 
| Arnd Hannemann | 2bd6a93 | 2010-12-29 14:21:14 +0100 | [diff] [blame] | 730 | 		if (ireg & (TMIO_STAT_CMDRESPEND | TMIO_STAT_CMDTIMEOUT)) { | 
 | 731 | 			ack_mmc_irqs(host, | 
 | 732 | 				     TMIO_STAT_CMDRESPEND | | 
 | 733 | 				     TMIO_STAT_CMDTIMEOUT); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 734 | 			tmio_mmc_cmd_irq(host, status); | 
 | 735 | 		} | 
 | 736 |  | 
 | 737 | 		/* Data transfer */ | 
 | 738 | 		if (ireg & (TMIO_STAT_RXRDY | TMIO_STAT_TXRQ)) { | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 739 | 			ack_mmc_irqs(host, TMIO_STAT_RXRDY | TMIO_STAT_TXRQ); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 740 | 			tmio_mmc_pio_irq(host); | 
 | 741 | 		} | 
 | 742 |  | 
 | 743 | 		/* Data transfer completion */ | 
 | 744 | 		if (ireg & TMIO_STAT_DATAEND) { | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 745 | 			ack_mmc_irqs(host, TMIO_STAT_DATAEND); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 746 | 			tmio_mmc_data_irq(host); | 
 | 747 | 		} | 
 | 748 |  | 
 | 749 | 		/* Check status - keep going until we've handled it all */ | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 750 | 		status = sd_ctrl_read32(host, CTL_STATUS); | 
 | 751 | 		irq_mask = sd_ctrl_read32(host, CTL_IRQ_MASK); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 752 | 		ireg = status & TMIO_MASK_IRQ & ~irq_mask; | 
 | 753 |  | 
 | 754 | 		pr_debug("Status at end of loop: %08x\n", status); | 
 | 755 | 		pr_debug_status(status); | 
 | 756 | 	} | 
 | 757 | 	pr_debug("MMC IRQ end\n"); | 
 | 758 |  | 
 | 759 | out: | 
 | 760 | 	return IRQ_HANDLED; | 
 | 761 | } | 
 | 762 |  | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 763 | #ifdef CONFIG_TMIO_MMC_DMA | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 764 | static void tmio_check_bounce_buffer(struct tmio_mmc_host *host) | 
 | 765 | { | 
 | 766 | 	if (host->sg_ptr == &host->bounce_sg) { | 
 | 767 | 		unsigned long flags; | 
 | 768 | 		void *sg_vaddr = tmio_mmc_kmap_atomic(host->sg_orig, &flags); | 
 | 769 | 		memcpy(sg_vaddr, host->bounce_buf, host->bounce_sg.length); | 
 | 770 | 		tmio_mmc_kunmap_atomic(sg_vaddr, &flags); | 
 | 771 | 	} | 
 | 772 | } | 
 | 773 |  | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 774 | static void tmio_mmc_enable_dma(struct tmio_mmc_host *host, bool enable) | 
 | 775 | { | 
 | 776 | #if defined(CONFIG_SUPERH) || defined(CONFIG_ARCH_SHMOBILE) | 
 | 777 | 	/* Switch DMA mode on or off - SuperH specific? */ | 
 | 778 | 	sd_ctrl_write16(host, 0xd8, enable ? 2 : 0); | 
 | 779 | #endif | 
 | 780 | } | 
 | 781 |  | 
 | 782 | static void tmio_dma_complete(void *arg) | 
 | 783 | { | 
 | 784 | 	struct tmio_mmc_host *host = arg; | 
 | 785 |  | 
 | 786 | 	dev_dbg(&host->pdev->dev, "Command completed\n"); | 
 | 787 |  | 
 | 788 | 	if (!host->data) | 
 | 789 | 		dev_warn(&host->pdev->dev, "NULL data in DMA completion!\n"); | 
 | 790 | 	else | 
 | 791 | 		enable_mmc_irqs(host, TMIO_STAT_DATAEND); | 
 | 792 | } | 
 | 793 |  | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 794 | static void tmio_mmc_start_dma_rx(struct tmio_mmc_host *host) | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 795 | { | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 796 | 	struct scatterlist *sg = host->sg_ptr, *sg_tmp; | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 797 | 	struct dma_async_tx_descriptor *desc = NULL; | 
 | 798 | 	struct dma_chan *chan = host->chan_rx; | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 799 | 	struct mfd_cell	*cell = host->pdev->dev.platform_data; | 
 | 800 | 	struct tmio_mmc_data *pdata = cell->driver_data; | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 801 | 	dma_cookie_t cookie; | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 802 | 	int ret, i; | 
 | 803 | 	bool aligned = true, multiple = true; | 
 | 804 | 	unsigned int align = (1 << pdata->dma->alignment_shift) - 1; | 
 | 805 |  | 
 | 806 | 	for_each_sg(sg, sg_tmp, host->sg_len, i) { | 
 | 807 | 		if (sg_tmp->offset & align) | 
 | 808 | 			aligned = false; | 
 | 809 | 		if (sg_tmp->length & align) { | 
 | 810 | 			multiple = false; | 
 | 811 | 			break; | 
 | 812 | 		} | 
 | 813 | 	} | 
 | 814 |  | 
 | 815 | 	if ((!aligned && (host->sg_len > 1 || sg->length > PAGE_CACHE_SIZE || | 
| Arnd Hannemann | eba4603 | 2010-12-19 21:16:07 +0000 | [diff] [blame] | 816 | 			  align >= MAX_ALIGN)) || !multiple) { | 
 | 817 | 		ret = -EINVAL; | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 818 | 		goto pio; | 
| Arnd Hannemann | eba4603 | 2010-12-19 21:16:07 +0000 | [diff] [blame] | 819 | 	} | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 820 |  | 
 | 821 | 	/* The only sg element can be unaligned, use our bounce buffer then */ | 
 | 822 | 	if (!aligned) { | 
 | 823 | 		sg_init_one(&host->bounce_sg, host->bounce_buf, sg->length); | 
 | 824 | 		host->sg_ptr = &host->bounce_sg; | 
 | 825 | 		sg = host->sg_ptr; | 
 | 826 | 	} | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 827 |  | 
 | 828 | 	ret = dma_map_sg(&host->pdev->dev, sg, host->sg_len, DMA_FROM_DEVICE); | 
 | 829 | 	if (ret > 0) { | 
 | 830 | 		host->dma_sglen = ret; | 
 | 831 | 		desc = chan->device->device_prep_slave_sg(chan, sg, ret, | 
 | 832 | 			DMA_FROM_DEVICE, DMA_PREP_INTERRUPT | DMA_CTRL_ACK); | 
 | 833 | 	} | 
 | 834 |  | 
 | 835 | 	if (desc) { | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 836 | 		desc->callback = tmio_dma_complete; | 
 | 837 | 		desc->callback_param = host; | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 838 | 		cookie = desc->tx_submit(desc); | 
 | 839 | 		if (cookie < 0) { | 
 | 840 | 			desc = NULL; | 
 | 841 | 			ret = cookie; | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 842 | 		} else { | 
 | 843 | 			chan->device->device_issue_pending(chan); | 
 | 844 | 		} | 
 | 845 | 	} | 
 | 846 | 	dev_dbg(&host->pdev->dev, "%s(): mapped %d -> %d, cookie %d, rq %p\n", | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 847 | 		__func__, host->sg_len, ret, cookie, host->mrq); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 848 |  | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 849 | pio: | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 850 | 	if (!desc) { | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 851 | 		/* DMA failed, fall back to PIO */ | 
 | 852 | 		if (ret >= 0) | 
 | 853 | 			ret = -EIO; | 
 | 854 | 		host->chan_rx = NULL; | 
 | 855 | 		dma_release_channel(chan); | 
 | 856 | 		/* Free the Tx channel too */ | 
 | 857 | 		chan = host->chan_tx; | 
 | 858 | 		if (chan) { | 
 | 859 | 			host->chan_tx = NULL; | 
 | 860 | 			dma_release_channel(chan); | 
 | 861 | 		} | 
 | 862 | 		dev_warn(&host->pdev->dev, | 
 | 863 | 			 "DMA failed: %d, falling back to PIO\n", ret); | 
 | 864 | 		tmio_mmc_enable_dma(host, false); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 865 | 	} | 
 | 866 |  | 
 | 867 | 	dev_dbg(&host->pdev->dev, "%s(): desc %p, cookie %d, sg[%d]\n", __func__, | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 868 | 		desc, cookie, host->sg_len); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 869 | } | 
 | 870 |  | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 871 | static void tmio_mmc_start_dma_tx(struct tmio_mmc_host *host) | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 872 | { | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 873 | 	struct scatterlist *sg = host->sg_ptr, *sg_tmp; | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 874 | 	struct dma_async_tx_descriptor *desc = NULL; | 
 | 875 | 	struct dma_chan *chan = host->chan_tx; | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 876 | 	struct mfd_cell	*cell = host->pdev->dev.platform_data; | 
 | 877 | 	struct tmio_mmc_data *pdata = cell->driver_data; | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 878 | 	dma_cookie_t cookie; | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 879 | 	int ret, i; | 
 | 880 | 	bool aligned = true, multiple = true; | 
 | 881 | 	unsigned int align = (1 << pdata->dma->alignment_shift) - 1; | 
 | 882 |  | 
 | 883 | 	for_each_sg(sg, sg_tmp, host->sg_len, i) { | 
 | 884 | 		if (sg_tmp->offset & align) | 
 | 885 | 			aligned = false; | 
 | 886 | 		if (sg_tmp->length & align) { | 
 | 887 | 			multiple = false; | 
 | 888 | 			break; | 
 | 889 | 		} | 
 | 890 | 	} | 
 | 891 |  | 
 | 892 | 	if ((!aligned && (host->sg_len > 1 || sg->length > PAGE_CACHE_SIZE || | 
| Arnd Hannemann | eba4603 | 2010-12-19 21:16:07 +0000 | [diff] [blame] | 893 | 			  align >= MAX_ALIGN)) || !multiple) { | 
 | 894 | 		ret = -EINVAL; | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 895 | 		goto pio; | 
| Arnd Hannemann | eba4603 | 2010-12-19 21:16:07 +0000 | [diff] [blame] | 896 | 	} | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 897 |  | 
 | 898 | 	/* The only sg element can be unaligned, use our bounce buffer then */ | 
 | 899 | 	if (!aligned) { | 
 | 900 | 		unsigned long flags; | 
 | 901 | 		void *sg_vaddr = tmio_mmc_kmap_atomic(sg, &flags); | 
 | 902 | 		sg_init_one(&host->bounce_sg, host->bounce_buf, sg->length); | 
 | 903 | 		memcpy(host->bounce_buf, sg_vaddr, host->bounce_sg.length); | 
 | 904 | 		tmio_mmc_kunmap_atomic(sg_vaddr, &flags); | 
 | 905 | 		host->sg_ptr = &host->bounce_sg; | 
 | 906 | 		sg = host->sg_ptr; | 
 | 907 | 	} | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 908 |  | 
 | 909 | 	ret = dma_map_sg(&host->pdev->dev, sg, host->sg_len, DMA_TO_DEVICE); | 
 | 910 | 	if (ret > 0) { | 
 | 911 | 		host->dma_sglen = ret; | 
 | 912 | 		desc = chan->device->device_prep_slave_sg(chan, sg, ret, | 
 | 913 | 			DMA_TO_DEVICE, DMA_PREP_INTERRUPT | DMA_CTRL_ACK); | 
 | 914 | 	} | 
 | 915 |  | 
 | 916 | 	if (desc) { | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 917 | 		desc->callback = tmio_dma_complete; | 
 | 918 | 		desc->callback_param = host; | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 919 | 		cookie = desc->tx_submit(desc); | 
 | 920 | 		if (cookie < 0) { | 
 | 921 | 			desc = NULL; | 
 | 922 | 			ret = cookie; | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 923 | 		} | 
 | 924 | 	} | 
 | 925 | 	dev_dbg(&host->pdev->dev, "%s(): mapped %d -> %d, cookie %d, rq %p\n", | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 926 | 		__func__, host->sg_len, ret, cookie, host->mrq); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 927 |  | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 928 | pio: | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 929 | 	if (!desc) { | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 930 | 		/* DMA failed, fall back to PIO */ | 
 | 931 | 		if (ret >= 0) | 
 | 932 | 			ret = -EIO; | 
 | 933 | 		host->chan_tx = NULL; | 
 | 934 | 		dma_release_channel(chan); | 
 | 935 | 		/* Free the Rx channel too */ | 
 | 936 | 		chan = host->chan_rx; | 
 | 937 | 		if (chan) { | 
 | 938 | 			host->chan_rx = NULL; | 
 | 939 | 			dma_release_channel(chan); | 
 | 940 | 		} | 
 | 941 | 		dev_warn(&host->pdev->dev, | 
 | 942 | 			 "DMA failed: %d, falling back to PIO\n", ret); | 
 | 943 | 		tmio_mmc_enable_dma(host, false); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 944 | 	} | 
 | 945 |  | 
 | 946 | 	dev_dbg(&host->pdev->dev, "%s(): desc %p, cookie %d\n", __func__, | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 947 | 		desc, cookie); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 948 | } | 
 | 949 |  | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 950 | static void tmio_mmc_start_dma(struct tmio_mmc_host *host, | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 951 | 			       struct mmc_data *data) | 
 | 952 | { | 
 | 953 | 	if (data->flags & MMC_DATA_READ) { | 
 | 954 | 		if (host->chan_rx) | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 955 | 			tmio_mmc_start_dma_rx(host); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 956 | 	} else { | 
 | 957 | 		if (host->chan_tx) | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 958 | 			tmio_mmc_start_dma_tx(host); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 959 | 	} | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 960 | } | 
 | 961 |  | 
 | 962 | static void tmio_issue_tasklet_fn(unsigned long priv) | 
 | 963 | { | 
 | 964 | 	struct tmio_mmc_host *host = (struct tmio_mmc_host *)priv; | 
 | 965 | 	struct dma_chan *chan = host->chan_tx; | 
 | 966 |  | 
 | 967 | 	chan->device->device_issue_pending(chan); | 
 | 968 | } | 
 | 969 |  | 
 | 970 | static void tmio_tasklet_fn(unsigned long arg) | 
 | 971 | { | 
 | 972 | 	struct tmio_mmc_host *host = (struct tmio_mmc_host *)arg; | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 973 | 	unsigned long flags; | 
 | 974 |  | 
 | 975 | 	spin_lock_irqsave(&host->lock, flags); | 
 | 976 |  | 
 | 977 | 	if (!host->data) | 
 | 978 | 		goto out; | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 979 |  | 
 | 980 | 	if (host->data->flags & MMC_DATA_READ) | 
 | 981 | 		dma_unmap_sg(&host->pdev->dev, host->sg_ptr, host->dma_sglen, | 
 | 982 | 			     DMA_FROM_DEVICE); | 
 | 983 | 	else | 
 | 984 | 		dma_unmap_sg(&host->pdev->dev, host->sg_ptr, host->dma_sglen, | 
 | 985 | 			     DMA_TO_DEVICE); | 
 | 986 |  | 
 | 987 | 	tmio_mmc_do_data_irq(host); | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 988 | out: | 
 | 989 | 	spin_unlock_irqrestore(&host->lock, flags); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 990 | } | 
 | 991 |  | 
 | 992 | /* It might be necessary to make filter MFD specific */ | 
 | 993 | static bool tmio_mmc_filter(struct dma_chan *chan, void *arg) | 
 | 994 | { | 
 | 995 | 	dev_dbg(chan->device->dev, "%s: slave data %p\n", __func__, arg); | 
 | 996 | 	chan->private = arg; | 
 | 997 | 	return true; | 
 | 998 | } | 
 | 999 |  | 
 | 1000 | static void tmio_mmc_request_dma(struct tmio_mmc_host *host, | 
 | 1001 | 				 struct tmio_mmc_data *pdata) | 
 | 1002 | { | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 1003 | 	/* We can only either use DMA for both Tx and Rx or not use it at all */ | 
 | 1004 | 	if (pdata->dma) { | 
 | 1005 | 		dma_cap_mask_t mask; | 
 | 1006 |  | 
 | 1007 | 		dma_cap_zero(mask); | 
 | 1008 | 		dma_cap_set(DMA_SLAVE, mask); | 
 | 1009 |  | 
 | 1010 | 		host->chan_tx = dma_request_channel(mask, tmio_mmc_filter, | 
 | 1011 | 						    pdata->dma->chan_priv_tx); | 
 | 1012 | 		dev_dbg(&host->pdev->dev, "%s: TX: got channel %p\n", __func__, | 
 | 1013 | 			host->chan_tx); | 
 | 1014 |  | 
 | 1015 | 		if (!host->chan_tx) | 
 | 1016 | 			return; | 
 | 1017 |  | 
 | 1018 | 		host->chan_rx = dma_request_channel(mask, tmio_mmc_filter, | 
 | 1019 | 						    pdata->dma->chan_priv_rx); | 
 | 1020 | 		dev_dbg(&host->pdev->dev, "%s: RX: got channel %p\n", __func__, | 
 | 1021 | 			host->chan_rx); | 
 | 1022 |  | 
 | 1023 | 		if (!host->chan_rx) { | 
 | 1024 | 			dma_release_channel(host->chan_tx); | 
 | 1025 | 			host->chan_tx = NULL; | 
 | 1026 | 			return; | 
 | 1027 | 		} | 
 | 1028 |  | 
 | 1029 | 		tasklet_init(&host->dma_complete, tmio_tasklet_fn, (unsigned long)host); | 
 | 1030 | 		tasklet_init(&host->dma_issue, tmio_issue_tasklet_fn, (unsigned long)host); | 
 | 1031 |  | 
 | 1032 | 		tmio_mmc_enable_dma(host, true); | 
 | 1033 | 	} | 
 | 1034 | } | 
 | 1035 |  | 
 | 1036 | static void tmio_mmc_release_dma(struct tmio_mmc_host *host) | 
 | 1037 | { | 
 | 1038 | 	if (host->chan_tx) { | 
 | 1039 | 		struct dma_chan *chan = host->chan_tx; | 
 | 1040 | 		host->chan_tx = NULL; | 
 | 1041 | 		dma_release_channel(chan); | 
 | 1042 | 	} | 
 | 1043 | 	if (host->chan_rx) { | 
 | 1044 | 		struct dma_chan *chan = host->chan_rx; | 
 | 1045 | 		host->chan_rx = NULL; | 
 | 1046 | 		dma_release_channel(chan); | 
 | 1047 | 	} | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 1048 | } | 
 | 1049 | #else | 
| Guennadi Liakhovetski | 9317305 | 2010-12-22 12:02:15 +0100 | [diff] [blame] | 1050 | static void tmio_check_bounce_buffer(struct tmio_mmc_host *host) | 
 | 1051 | { | 
 | 1052 | } | 
 | 1053 |  | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 1054 | static void tmio_mmc_start_dma(struct tmio_mmc_host *host, | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 1055 | 			       struct mmc_data *data) | 
 | 1056 | { | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 1057 | } | 
 | 1058 |  | 
 | 1059 | static void tmio_mmc_request_dma(struct tmio_mmc_host *host, | 
 | 1060 | 				 struct tmio_mmc_data *pdata) | 
 | 1061 | { | 
 | 1062 | 	host->chan_tx = NULL; | 
 | 1063 | 	host->chan_rx = NULL; | 
 | 1064 | } | 
 | 1065 |  | 
 | 1066 | static void tmio_mmc_release_dma(struct tmio_mmc_host *host) | 
 | 1067 | { | 
 | 1068 | } | 
 | 1069 | #endif | 
 | 1070 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1071 | static int tmio_mmc_start_data(struct tmio_mmc_host *host, | 
 | 1072 | 	struct mmc_data *data) | 
 | 1073 | { | 
| Yusuke Goda | f1334fb | 2010-08-30 11:50:19 +0100 | [diff] [blame] | 1074 | 	struct mfd_cell *cell = host->pdev->dev.platform_data; | 
 | 1075 | 	struct tmio_mmc_data *pdata = cell->driver_data; | 
 | 1076 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1077 | 	pr_debug("setup data transfer: blocksize %08x  nr_blocks %d\n", | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 1078 | 		 data->blksz, data->blocks); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1079 |  | 
| Yusuke Goda | f1334fb | 2010-08-30 11:50:19 +0100 | [diff] [blame] | 1080 | 	/* Some hardware cannot perform 2 byte requests in 4 bit mode */ | 
 | 1081 | 	if (host->mmc->ios.bus_width == MMC_BUS_WIDTH_4) { | 
 | 1082 | 		int blksz_2bytes = pdata->flags & TMIO_MMC_BLKSZ_2BYTES; | 
 | 1083 |  | 
 | 1084 | 		if (data->blksz < 2 || (data->blksz < 4 && !blksz_2bytes)) { | 
 | 1085 | 			pr_err("%s: %d byte block unsupported in 4 bit mode\n", | 
 | 1086 | 			       mmc_hostname(host->mmc), data->blksz); | 
 | 1087 | 			return -EINVAL; | 
 | 1088 | 		} | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1089 | 	} | 
 | 1090 |  | 
 | 1091 | 	tmio_mmc_init_sg(host, data); | 
 | 1092 | 	host->data = data; | 
 | 1093 |  | 
 | 1094 | 	/* Set transfer length / blocksize */ | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 1095 | 	sd_ctrl_write16(host, CTL_SD_XFER_LEN, data->blksz); | 
 | 1096 | 	sd_ctrl_write16(host, CTL_XFER_BLK_COUNT, data->blocks); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1097 |  | 
| Guennadi Liakhovetski | ef17fee | 2010-11-11 12:19:47 +0100 | [diff] [blame] | 1098 | 	tmio_mmc_start_dma(host, data); | 
 | 1099 |  | 
 | 1100 | 	return 0; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1101 | } | 
 | 1102 |  | 
 | 1103 | /* Process requests from the MMC layer */ | 
 | 1104 | static void tmio_mmc_request(struct mmc_host *mmc, struct mmc_request *mrq) | 
 | 1105 | { | 
 | 1106 | 	struct tmio_mmc_host *host = mmc_priv(mmc); | 
 | 1107 | 	int ret; | 
 | 1108 |  | 
 | 1109 | 	if (host->mrq) | 
 | 1110 | 		pr_debug("request not null\n"); | 
 | 1111 |  | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 1112 | 	host->last_req_ts = jiffies; | 
 | 1113 | 	wmb(); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1114 | 	host->mrq = mrq; | 
 | 1115 |  | 
 | 1116 | 	if (mrq->data) { | 
 | 1117 | 		ret = tmio_mmc_start_data(host, mrq->data); | 
 | 1118 | 		if (ret) | 
 | 1119 | 			goto fail; | 
 | 1120 | 	} | 
 | 1121 |  | 
 | 1122 | 	ret = tmio_mmc_start_command(host, mrq->cmd); | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 1123 | 	if (!ret) { | 
 | 1124 | 		schedule_delayed_work(&host->delayed_reset_work, | 
 | 1125 | 				      msecs_to_jiffies(2000)); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1126 | 		return; | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 1127 | 	} | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1128 |  | 
 | 1129 | fail: | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 1130 | 	host->mrq = NULL; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1131 | 	mrq->cmd->error = ret; | 
 | 1132 | 	mmc_request_done(mmc, mrq); | 
 | 1133 | } | 
 | 1134 |  | 
 | 1135 | /* Set MMC clock / power. | 
 | 1136 |  * Note: This controller uses a simple divider scheme therefore it cannot | 
 | 1137 |  * run a MMC card at full speed (20MHz). The max clock is 24MHz on SD, but as | 
 | 1138 |  * MMC wont run that fast, it has to be clocked at 12MHz which is the next | 
 | 1139 |  * slowest setting. | 
 | 1140 |  */ | 
 | 1141 | static void tmio_mmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) | 
 | 1142 | { | 
 | 1143 | 	struct tmio_mmc_host *host = mmc_priv(mmc); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1144 |  | 
 | 1145 | 	if (ios->clock) | 
 | 1146 | 		tmio_mmc_set_clock(host, ios->clock); | 
 | 1147 |  | 
 | 1148 | 	/* Power sequence - OFF -> ON -> UP */ | 
 | 1149 | 	switch (ios->power_mode) { | 
 | 1150 | 	case MMC_POWER_OFF: /* power down SD bus */ | 
| Ian Molton | 64e8867 | 2010-01-06 13:51:48 +0100 | [diff] [blame] | 1151 | 		if (host->set_pwr) | 
 | 1152 | 			host->set_pwr(host->pdev, 0); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1153 | 		tmio_mmc_clk_stop(host); | 
 | 1154 | 		break; | 
 | 1155 | 	case MMC_POWER_ON: /* power up SD bus */ | 
| Ian Molton | 64e8867 | 2010-01-06 13:51:48 +0100 | [diff] [blame] | 1156 | 		if (host->set_pwr) | 
 | 1157 | 			host->set_pwr(host->pdev, 1); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1158 | 		break; | 
 | 1159 | 	case MMC_POWER_UP: /* start bus clock */ | 
 | 1160 | 		tmio_mmc_clk_start(host); | 
 | 1161 | 		break; | 
 | 1162 | 	} | 
 | 1163 |  | 
 | 1164 | 	switch (ios->bus_width) { | 
 | 1165 | 	case MMC_BUS_WIDTH_1: | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 1166 | 		sd_ctrl_write16(host, CTL_SD_MEM_CARD_OPT, 0x80e0); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1167 | 	break; | 
 | 1168 | 	case MMC_BUS_WIDTH_4: | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 1169 | 		sd_ctrl_write16(host, CTL_SD_MEM_CARD_OPT, 0x00e0); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1170 | 	break; | 
 | 1171 | 	} | 
 | 1172 |  | 
 | 1173 | 	/* Let things settle. delay taken from winCE driver */ | 
 | 1174 | 	udelay(140); | 
 | 1175 | } | 
 | 1176 |  | 
 | 1177 | static int tmio_mmc_get_ro(struct mmc_host *mmc) | 
 | 1178 | { | 
 | 1179 | 	struct tmio_mmc_host *host = mmc_priv(mmc); | 
| Guennadi Liakhovetski | ac8fb3e | 2010-05-19 18:36:02 +0000 | [diff] [blame] | 1180 | 	struct mfd_cell	*cell = host->pdev->dev.platform_data; | 
 | 1181 | 	struct tmio_mmc_data *pdata = cell->driver_data; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1182 |  | 
| Guennadi Liakhovetski | ac8fb3e | 2010-05-19 18:36:02 +0000 | [diff] [blame] | 1183 | 	return ((pdata->flags & TMIO_MMC_WRPROTECT_DISABLE) || | 
 | 1184 | 		(sd_ctrl_read32(host, CTL_STATUS) & TMIO_STAT_WRPROTECT)) ? 0 : 1; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1185 | } | 
 | 1186 |  | 
| Arnd Hannemann | 19ca750 | 2010-08-24 17:26:59 +0200 | [diff] [blame] | 1187 | static int tmio_mmc_get_cd(struct mmc_host *mmc) | 
 | 1188 | { | 
 | 1189 | 	struct tmio_mmc_host *host = mmc_priv(mmc); | 
 | 1190 | 	struct mfd_cell	*cell = host->pdev->dev.platform_data; | 
 | 1191 | 	struct tmio_mmc_data *pdata = cell->driver_data; | 
 | 1192 |  | 
 | 1193 | 	if (!pdata->get_cd) | 
 | 1194 | 		return -ENOSYS; | 
 | 1195 | 	else | 
 | 1196 | 		return pdata->get_cd(host->pdev); | 
 | 1197 | } | 
 | 1198 |  | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 1199 | static const struct mmc_host_ops tmio_mmc_ops = { | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1200 | 	.request	= tmio_mmc_request, | 
 | 1201 | 	.set_ios	= tmio_mmc_set_ios, | 
 | 1202 | 	.get_ro         = tmio_mmc_get_ro, | 
| Arnd Hannemann | 19ca750 | 2010-08-24 17:26:59 +0200 | [diff] [blame] | 1203 | 	.get_cd		= tmio_mmc_get_cd, | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 1204 | 	.enable_sdio_irq = tmio_mmc_enable_sdio_irq, | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1205 | }; | 
 | 1206 |  | 
 | 1207 | #ifdef CONFIG_PM | 
 | 1208 | static int tmio_mmc_suspend(struct platform_device *dev, pm_message_t state) | 
 | 1209 | { | 
 | 1210 | 	struct mfd_cell	*cell = (struct mfd_cell *)dev->dev.platform_data; | 
 | 1211 | 	struct mmc_host *mmc = platform_get_drvdata(dev); | 
 | 1212 | 	int ret; | 
 | 1213 |  | 
| Matt Fleming | 1a13f8f | 2010-05-26 14:42:08 -0700 | [diff] [blame] | 1214 | 	ret = mmc_suspend_host(mmc); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1215 |  | 
 | 1216 | 	/* Tell MFD core it can disable us now.*/ | 
 | 1217 | 	if (!ret && cell->disable) | 
 | 1218 | 		cell->disable(dev); | 
 | 1219 |  | 
 | 1220 | 	return ret; | 
 | 1221 | } | 
 | 1222 |  | 
 | 1223 | static int tmio_mmc_resume(struct platform_device *dev) | 
 | 1224 | { | 
 | 1225 | 	struct mfd_cell	*cell = (struct mfd_cell *)dev->dev.platform_data; | 
 | 1226 | 	struct mmc_host *mmc = platform_get_drvdata(dev); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1227 | 	int ret = 0; | 
 | 1228 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1229 | 	/* Tell the MFD core we are ready to be enabled */ | 
| Ian Molton | 64e8867 | 2010-01-06 13:51:48 +0100 | [diff] [blame] | 1230 | 	if (cell->resume) { | 
 | 1231 | 		ret = cell->resume(dev); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1232 | 		if (ret) | 
 | 1233 | 			goto out; | 
 | 1234 | 	} | 
 | 1235 |  | 
 | 1236 | 	mmc_resume_host(mmc); | 
 | 1237 |  | 
 | 1238 | out: | 
 | 1239 | 	return ret; | 
 | 1240 | } | 
 | 1241 | #else | 
 | 1242 | #define tmio_mmc_suspend NULL | 
 | 1243 | #define tmio_mmc_resume NULL | 
 | 1244 | #endif | 
 | 1245 |  | 
 | 1246 | static int __devinit tmio_mmc_probe(struct platform_device *dev) | 
 | 1247 | { | 
 | 1248 | 	struct mfd_cell	*cell = (struct mfd_cell *)dev->dev.platform_data; | 
| Philipp Zabel | f0e46cc | 2009-06-04 20:12:31 +0200 | [diff] [blame] | 1249 | 	struct tmio_mmc_data *pdata; | 
| Ian Molton | 64e8867 | 2010-01-06 13:51:48 +0100 | [diff] [blame] | 1250 | 	struct resource *res_ctl; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1251 | 	struct tmio_mmc_host *host; | 
 | 1252 | 	struct mmc_host *mmc; | 
| Philipp Zabel | d6c9b5e | 2009-06-04 20:12:34 +0200 | [diff] [blame] | 1253 | 	int ret = -EINVAL; | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 1254 | 	u32 irq_mask = TMIO_MASK_CMD; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1255 |  | 
| Ian Molton | 64e8867 | 2010-01-06 13:51:48 +0100 | [diff] [blame] | 1256 | 	if (dev->num_resources != 2) | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1257 | 		goto out; | 
 | 1258 |  | 
 | 1259 | 	res_ctl = platform_get_resource(dev, IORESOURCE_MEM, 0); | 
| Ian Molton | 64e8867 | 2010-01-06 13:51:48 +0100 | [diff] [blame] | 1260 | 	if (!res_ctl) | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1261 | 		goto out; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1262 |  | 
| Philipp Zabel | f0e46cc | 2009-06-04 20:12:31 +0200 | [diff] [blame] | 1263 | 	pdata = cell->driver_data; | 
| Philipp Zabel | d6c9b5e | 2009-06-04 20:12:34 +0200 | [diff] [blame] | 1264 | 	if (!pdata || !pdata->hclk) | 
| Philipp Zabel | f0e46cc | 2009-06-04 20:12:31 +0200 | [diff] [blame] | 1265 | 		goto out; | 
| Philipp Zabel | d6c9b5e | 2009-06-04 20:12:34 +0200 | [diff] [blame] | 1266 |  | 
 | 1267 | 	ret = -ENOMEM; | 
| Philipp Zabel | f0e46cc | 2009-06-04 20:12:31 +0200 | [diff] [blame] | 1268 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1269 | 	mmc = mmc_alloc_host(sizeof(struct tmio_mmc_host), &dev->dev); | 
 | 1270 | 	if (!mmc) | 
 | 1271 | 		goto out; | 
 | 1272 |  | 
 | 1273 | 	host = mmc_priv(mmc); | 
 | 1274 | 	host->mmc = mmc; | 
| Ian Molton | 64e8867 | 2010-01-06 13:51:48 +0100 | [diff] [blame] | 1275 | 	host->pdev = dev; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1276 | 	platform_set_drvdata(dev, mmc); | 
 | 1277 |  | 
| Ian Molton | 64e8867 | 2010-01-06 13:51:48 +0100 | [diff] [blame] | 1278 | 	host->set_pwr = pdata->set_pwr; | 
 | 1279 | 	host->set_clk_div = pdata->set_clk_div; | 
 | 1280 |  | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 1281 | 	/* SD control register space size is 0x200, 0x400 for bus_shift=1 */ | 
 | 1282 | 	host->bus_shift = resource_size(res_ctl) >> 10; | 
 | 1283 |  | 
| Magnus Damm | bc6772a | 2009-03-11 21:58:54 +0900 | [diff] [blame] | 1284 | 	host->ctl = ioremap(res_ctl->start, resource_size(res_ctl)); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1285 | 	if (!host->ctl) | 
 | 1286 | 		goto host_free; | 
 | 1287 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1288 | 	mmc->ops = &tmio_mmc_ops; | 
| Guennadi Liakhovetski | 729b0c7 | 2010-11-11 12:15:06 +0100 | [diff] [blame] | 1289 | 	mmc->caps = MMC_CAP_4_BIT_DATA | pdata->capabilities; | 
| Philipp Zabel | f0e46cc | 2009-06-04 20:12:31 +0200 | [diff] [blame] | 1290 | 	mmc->f_max = pdata->hclk; | 
 | 1291 | 	mmc->f_min = mmc->f_max / 512; | 
| Guennadi Liakhovetski | 729b0c7 | 2010-11-11 12:15:06 +0100 | [diff] [blame] | 1292 | 	mmc->max_segs = 32; | 
 | 1293 | 	mmc->max_blk_size = 512; | 
 | 1294 | 	mmc->max_blk_count = (PAGE_CACHE_SIZE / mmc->max_blk_size) * | 
 | 1295 | 		mmc->max_segs; | 
 | 1296 | 	mmc->max_req_size = mmc->max_blk_size * mmc->max_blk_count; | 
 | 1297 | 	mmc->max_seg_size = mmc->max_req_size; | 
| Guennadi Liakhovetski | a2b14dc | 2010-05-19 18:37:25 +0000 | [diff] [blame] | 1298 | 	if (pdata->ocr_mask) | 
 | 1299 | 		mmc->ocr_avail = pdata->ocr_mask; | 
 | 1300 | 	else | 
 | 1301 | 		mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1302 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1303 | 	/* Tell the MFD core we are ready to be enabled */ | 
 | 1304 | 	if (cell->enable) { | 
 | 1305 | 		ret = cell->enable(dev); | 
 | 1306 | 		if (ret) | 
| Ian Molton | 64e8867 | 2010-01-06 13:51:48 +0100 | [diff] [blame] | 1307 | 			goto unmap_ctl; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1308 | 	} | 
 | 1309 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1310 | 	tmio_mmc_clk_stop(host); | 
 | 1311 | 	reset(host); | 
 | 1312 |  | 
 | 1313 | 	ret = platform_get_irq(dev, 0); | 
 | 1314 | 	if (ret >= 0) | 
 | 1315 | 		host->irq = ret; | 
 | 1316 | 	else | 
| Magnus Damm | 7ee422d | 2010-02-17 16:38:23 +0900 | [diff] [blame] | 1317 | 		goto cell_disable; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1318 |  | 
| Philipp Zabel | 5e74672 | 2009-06-04 20:12:32 +0200 | [diff] [blame] | 1319 | 	disable_mmc_irqs(host, TMIO_MASK_ALL); | 
| Arnd Hannemann | 845ecd2 | 2010-12-28 23:22:31 +0100 | [diff] [blame] | 1320 | 	if (pdata->flags & TMIO_MMC_SDIO_IRQ) | 
 | 1321 | 		tmio_mmc_enable_sdio_irq(mmc, 0); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1322 |  | 
| Philipp Zabel | 6c413cc | 2009-06-04 20:12:33 +0200 | [diff] [blame] | 1323 | 	ret = request_irq(host->irq, tmio_mmc_irq, IRQF_DISABLED | | 
| Magnus Damm | 14f1b75 | 2009-12-14 18:01:33 -0800 | [diff] [blame] | 1324 | 		IRQF_TRIGGER_FALLING, dev_name(&dev->dev), host); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1325 | 	if (ret) | 
| Magnus Damm | 7ee422d | 2010-02-17 16:38:23 +0900 | [diff] [blame] | 1326 | 		goto cell_disable; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1327 |  | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 1328 | 	spin_lock_init(&host->lock); | 
 | 1329 |  | 
 | 1330 | 	/* Init delayed work for request timeouts */ | 
 | 1331 | 	INIT_DELAYED_WORK(&host->delayed_reset_work, tmio_mmc_reset_work); | 
 | 1332 |  | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 1333 | 	/* See if we also get DMA */ | 
 | 1334 | 	tmio_mmc_request_dma(host, pdata); | 
 | 1335 |  | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1336 | 	mmc_add_host(mmc); | 
 | 1337 |  | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 1338 | 	pr_info("%s at 0x%08lx irq %d\n", mmc_hostname(host->mmc), | 
 | 1339 | 		(unsigned long)host->ctl, host->irq); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1340 |  | 
 | 1341 | 	/* Unmask the IRQs we want to know about */ | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 1342 | 	if (!host->chan_rx) | 
 | 1343 | 		irq_mask |= TMIO_MASK_READOP; | 
 | 1344 | 	if (!host->chan_tx) | 
 | 1345 | 		irq_mask |= TMIO_MASK_WRITEOP; | 
 | 1346 | 	enable_mmc_irqs(host, irq_mask); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1347 |  | 
 | 1348 | 	return 0; | 
 | 1349 |  | 
| Magnus Damm | 7ee422d | 2010-02-17 16:38:23 +0900 | [diff] [blame] | 1350 | cell_disable: | 
 | 1351 | 	if (cell->disable) | 
 | 1352 | 		cell->disable(dev); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1353 | unmap_ctl: | 
 | 1354 | 	iounmap(host->ctl); | 
 | 1355 | host_free: | 
 | 1356 | 	mmc_free_host(mmc); | 
 | 1357 | out: | 
 | 1358 | 	return ret; | 
 | 1359 | } | 
 | 1360 |  | 
 | 1361 | static int __devexit tmio_mmc_remove(struct platform_device *dev) | 
 | 1362 | { | 
| Magnus Damm | 7ee422d | 2010-02-17 16:38:23 +0900 | [diff] [blame] | 1363 | 	struct mfd_cell	*cell = (struct mfd_cell *)dev->dev.platform_data; | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1364 | 	struct mmc_host *mmc = platform_get_drvdata(dev); | 
 | 1365 |  | 
 | 1366 | 	platform_set_drvdata(dev, NULL); | 
 | 1367 |  | 
 | 1368 | 	if (mmc) { | 
 | 1369 | 		struct tmio_mmc_host *host = mmc_priv(mmc); | 
 | 1370 | 		mmc_remove_host(mmc); | 
| Arnd Hannemann | 6ff56e0 | 2011-01-05 17:36:14 -0500 | [diff] [blame] | 1371 | 		cancel_delayed_work_sync(&host->delayed_reset_work); | 
| Guennadi Liakhovetski | 311f3ac | 2010-05-19 18:34:22 +0000 | [diff] [blame] | 1372 | 		tmio_mmc_release_dma(host); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1373 | 		free_irq(host->irq, host); | 
| Magnus Damm | 7ee422d | 2010-02-17 16:38:23 +0900 | [diff] [blame] | 1374 | 		if (cell->disable) | 
 | 1375 | 			cell->disable(dev); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1376 | 		iounmap(host->ctl); | 
| Magnus Damm | bedcc45 | 2009-03-11 21:59:03 +0900 | [diff] [blame] | 1377 | 		mmc_free_host(mmc); | 
| Ian Molton | 4a48998 | 2008-07-15 16:02:21 +0100 | [diff] [blame] | 1378 | 	} | 
 | 1379 |  | 
 | 1380 | 	return 0; | 
 | 1381 | } | 
 | 1382 |  | 
 | 1383 | /* ------------------- device registration ----------------------- */ | 
 | 1384 |  | 
 | 1385 | static struct platform_driver tmio_mmc_driver = { | 
 | 1386 | 	.driver = { | 
 | 1387 | 		.name = "tmio-mmc", | 
 | 1388 | 		.owner = THIS_MODULE, | 
 | 1389 | 	}, | 
 | 1390 | 	.probe = tmio_mmc_probe, | 
 | 1391 | 	.remove = __devexit_p(tmio_mmc_remove), | 
 | 1392 | 	.suspend = tmio_mmc_suspend, | 
 | 1393 | 	.resume = tmio_mmc_resume, | 
 | 1394 | }; | 
 | 1395 |  | 
 | 1396 |  | 
 | 1397 | static int __init tmio_mmc_init(void) | 
 | 1398 | { | 
 | 1399 | 	return platform_driver_register(&tmio_mmc_driver); | 
 | 1400 | } | 
 | 1401 |  | 
 | 1402 | static void __exit tmio_mmc_exit(void) | 
 | 1403 | { | 
 | 1404 | 	platform_driver_unregister(&tmio_mmc_driver); | 
 | 1405 | } | 
 | 1406 |  | 
 | 1407 | module_init(tmio_mmc_init); | 
 | 1408 | module_exit(tmio_mmc_exit); | 
 | 1409 |  | 
 | 1410 | MODULE_DESCRIPTION("Toshiba TMIO SD/MMC driver"); | 
 | 1411 | MODULE_AUTHOR("Ian Molton <spyro@f2s.com>"); | 
 | 1412 | MODULE_LICENSE("GPL v2"); | 
 | 1413 | MODULE_ALIAS("platform:tmio-mmc"); |