Linux Audio

Check our new training course

Loading...
v3.5.6
  1/*
  2 * Marvell MMC/SD/SDIO driver
  3 *
  4 * Authors: Maen Suleiman, Nicolas Pitre
  5 * Copyright (C) 2008-2009 Marvell Ltd.
  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
 12#include <linux/module.h>
 13#include <linux/init.h>
 14#include <linux/io.h>
 15#include <linux/platform_device.h>
 16#include <linux/mbus.h>
 17#include <linux/delay.h>
 18#include <linux/interrupt.h>
 19#include <linux/dma-mapping.h>
 20#include <linux/scatterlist.h>
 21#include <linux/irq.h>
 22#include <linux/clk.h>
 23#include <linux/gpio.h>
 24#include <linux/mmc/host.h>
 
 25
 26#include <asm/sizes.h>
 27#include <asm/unaligned.h>
 28#include <plat/mvsdio.h>
 29
 30#include "mvsdio.h"
 31
 32#define DRIVER_NAME	"mvsdio"
 33
 34static int maxfreq = MVSD_CLOCKRATE_MAX;
 35static int nodma;
 36
 37struct mvsd_host {
 38	void __iomem *base;
 39	struct mmc_request *mrq;
 40	spinlock_t lock;
 41	unsigned int xfer_mode;
 42	unsigned int intr_en;
 43	unsigned int ctrl;
 44	unsigned int pio_size;
 45	void *pio_ptr;
 46	unsigned int sg_frags;
 47	unsigned int ns_per_clk;
 48	unsigned int clock;
 49	unsigned int base_clock;
 50	struct timer_list timer;
 51	struct mmc_host *mmc;
 52	struct device *dev;
 53	struct resource *res;
 54	int irq;
 55	struct clk *clk;
 56	int gpio_card_detect;
 57	int gpio_write_protect;
 58};
 59
 60#define mvsd_write(offs, val)	writel(val, iobase + (offs))
 61#define mvsd_read(offs)		readl(iobase + (offs))
 62
 63static int mvsd_setup_data(struct mvsd_host *host, struct mmc_data *data)
 64{
 65	void __iomem *iobase = host->base;
 66	unsigned int tmout;
 67	int tmout_index;
 68
 69	/*
 70	 * Hardware weirdness.  The FIFO_EMPTY bit of the HW_STATE
 71	 * register is sometimes not set before a while when some
 72	 * "unusual" data block sizes are used (such as with the SWITCH
 73	 * command), even despite the fact that the XFER_DONE interrupt
 74	 * was raised.  And if another data transfer starts before
 75	 * this bit comes to good sense (which eventually happens by
 76	 * itself) then the new transfer simply fails with a timeout.
 77	 */
 78	if (!(mvsd_read(MVSD_HW_STATE) & (1 << 13))) {
 79		unsigned long t = jiffies + HZ;
 80		unsigned int hw_state,  count = 0;
 81		do {
 
 82			if (time_after(jiffies, t)) {
 83				dev_warn(host->dev, "FIFO_EMPTY bit missing\n");
 84				break;
 85			}
 86			hw_state = mvsd_read(MVSD_HW_STATE);
 87			count++;
 88		} while (!(hw_state & (1 << 13)));
 89		dev_dbg(host->dev, "*** wait for FIFO_EMPTY bit "
 90				   "(hw=0x%04x, count=%d, jiffies=%ld)\n",
 91				   hw_state, count, jiffies - (t - HZ));
 92	}
 93
 94	/* If timeout=0 then maximum timeout index is used. */
 95	tmout = DIV_ROUND_UP(data->timeout_ns, host->ns_per_clk);
 96	tmout += data->timeout_clks;
 97	tmout_index = fls(tmout - 1) - 12;
 98	if (tmout_index < 0)
 99		tmout_index = 0;
100	if (tmout_index > MVSD_HOST_CTRL_TMOUT_MAX)
101		tmout_index = MVSD_HOST_CTRL_TMOUT_MAX;
102
103	dev_dbg(host->dev, "data %s at 0x%08x: blocks=%d blksz=%d tmout=%u (%d)\n",
104		(data->flags & MMC_DATA_READ) ? "read" : "write",
105		(u32)sg_virt(data->sg), data->blocks, data->blksz,
106		tmout, tmout_index);
107
108	host->ctrl &= ~MVSD_HOST_CTRL_TMOUT_MASK;
109	host->ctrl |= MVSD_HOST_CTRL_TMOUT(tmout_index);
110	mvsd_write(MVSD_HOST_CTRL, host->ctrl);
111	mvsd_write(MVSD_BLK_COUNT, data->blocks);
112	mvsd_write(MVSD_BLK_SIZE, data->blksz);
113
114	if (nodma || (data->blksz | data->sg->offset) & 3) {
 
115		/*
116		 * We cannot do DMA on a buffer which offset or size
117		 * is not aligned on a 4-byte boundary.
 
 
 
 
118		 */
119		host->pio_size = data->blocks * data->blksz;
120		host->pio_ptr = sg_virt(data->sg);
121		if (!nodma)
122			pr_debug("%s: fallback to PIO for data "
123					  "at 0x%p size %d\n",
124					  mmc_hostname(host->mmc),
125					  host->pio_ptr, host->pio_size);
126		return 1;
127	} else {
128		dma_addr_t phys_addr;
129		int dma_dir = (data->flags & MMC_DATA_READ) ?
130			DMA_FROM_DEVICE : DMA_TO_DEVICE;
131		host->sg_frags = dma_map_sg(mmc_dev(host->mmc), data->sg,
132					    data->sg_len, dma_dir);
133		phys_addr = sg_dma_address(data->sg);
134		mvsd_write(MVSD_SYS_ADDR_LOW, (u32)phys_addr & 0xffff);
135		mvsd_write(MVSD_SYS_ADDR_HI,  (u32)phys_addr >> 16);
136		return 0;
137	}
138}
139
140static void mvsd_request(struct mmc_host *mmc, struct mmc_request *mrq)
141{
142	struct mvsd_host *host = mmc_priv(mmc);
143	void __iomem *iobase = host->base;
144	struct mmc_command *cmd = mrq->cmd;
145	u32 cmdreg = 0, xfer = 0, intr = 0;
146	unsigned long flags;
147
148	BUG_ON(host->mrq != NULL);
149	host->mrq = mrq;
150
151	dev_dbg(host->dev, "cmd %d (hw state 0x%04x)\n",
152		cmd->opcode, mvsd_read(MVSD_HW_STATE));
153
154	cmdreg = MVSD_CMD_INDEX(cmd->opcode);
155
156	if (cmd->flags & MMC_RSP_BUSY)
157		cmdreg |= MVSD_CMD_RSP_48BUSY;
158	else if (cmd->flags & MMC_RSP_136)
159		cmdreg |= MVSD_CMD_RSP_136;
160	else if (cmd->flags & MMC_RSP_PRESENT)
161		cmdreg |= MVSD_CMD_RSP_48;
162	else
163		cmdreg |= MVSD_CMD_RSP_NONE;
164
165	if (cmd->flags & MMC_RSP_CRC)
166		cmdreg |= MVSD_CMD_CHECK_CMDCRC;
167
168	if (cmd->flags & MMC_RSP_OPCODE)
169		cmdreg |= MVSD_CMD_INDX_CHECK;
170
171	if (cmd->flags & MMC_RSP_PRESENT) {
172		cmdreg |= MVSD_UNEXPECTED_RESP;
173		intr |= MVSD_NOR_UNEXP_RSP;
174	}
175
176	if (mrq->data) {
177		struct mmc_data *data = mrq->data;
178		int pio;
179
180		cmdreg |= MVSD_CMD_DATA_PRESENT | MVSD_CMD_CHECK_DATACRC16;
181		xfer |= MVSD_XFER_MODE_HW_WR_DATA_EN;
182		if (data->flags & MMC_DATA_READ)
183			xfer |= MVSD_XFER_MODE_TO_HOST;
184
185		pio = mvsd_setup_data(host, data);
186		if (pio) {
187			xfer |= MVSD_XFER_MODE_PIO;
188			/* PIO section of mvsd_irq has comments on those bits */
189			if (data->flags & MMC_DATA_WRITE)
190				intr |= MVSD_NOR_TX_AVAIL;
191			else if (host->pio_size > 32)
192				intr |= MVSD_NOR_RX_FIFO_8W;
193			else
194				intr |= MVSD_NOR_RX_READY;
195		}
196
197		if (data->stop) {
198			struct mmc_command *stop = data->stop;
199			u32 cmd12reg = 0;
200
201			mvsd_write(MVSD_AUTOCMD12_ARG_LOW, stop->arg & 0xffff);
202			mvsd_write(MVSD_AUTOCMD12_ARG_HI,  stop->arg >> 16);
203
204			if (stop->flags & MMC_RSP_BUSY)
205				cmd12reg |= MVSD_AUTOCMD12_BUSY;
206			if (stop->flags & MMC_RSP_OPCODE)
207				cmd12reg |= MVSD_AUTOCMD12_INDX_CHECK;
208			cmd12reg |= MVSD_AUTOCMD12_INDEX(stop->opcode);
209			mvsd_write(MVSD_AUTOCMD12_CMD, cmd12reg);
210
211			xfer |= MVSD_XFER_MODE_AUTO_CMD12;
212			intr |= MVSD_NOR_AUTOCMD12_DONE;
213		} else {
214			intr |= MVSD_NOR_XFER_DONE;
215		}
216	} else {
217		intr |= MVSD_NOR_CMD_DONE;
218	}
219
220	mvsd_write(MVSD_ARG_LOW, cmd->arg & 0xffff);
221	mvsd_write(MVSD_ARG_HI,  cmd->arg >> 16);
222
223	spin_lock_irqsave(&host->lock, flags);
224
225	host->xfer_mode &= MVSD_XFER_MODE_INT_CHK_EN;
226	host->xfer_mode |= xfer;
227	mvsd_write(MVSD_XFER_MODE, host->xfer_mode);
228
229	mvsd_write(MVSD_NOR_INTR_STATUS, ~MVSD_NOR_CARD_INT);
230	mvsd_write(MVSD_ERR_INTR_STATUS, 0xffff);
231	mvsd_write(MVSD_CMD, cmdreg);
232
233	host->intr_en &= MVSD_NOR_CARD_INT;
234	host->intr_en |= intr | MVSD_NOR_ERROR;
235	mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
236	mvsd_write(MVSD_ERR_INTR_EN, 0xffff);
237
238	mod_timer(&host->timer, jiffies + 5 * HZ);
239
240	spin_unlock_irqrestore(&host->lock, flags);
241}
242
243static u32 mvsd_finish_cmd(struct mvsd_host *host, struct mmc_command *cmd,
244			   u32 err_status)
245{
246	void __iomem *iobase = host->base;
247
248	if (cmd->flags & MMC_RSP_136) {
249		unsigned int response[8], i;
250		for (i = 0; i < 8; i++)
251			response[i] = mvsd_read(MVSD_RSP(i));
252		cmd->resp[0] =		((response[0] & 0x03ff) << 22) |
253					((response[1] & 0xffff) << 6) |
254					((response[2] & 0xfc00) >> 10);
255		cmd->resp[1] =		((response[2] & 0x03ff) << 22) |
256					((response[3] & 0xffff) << 6) |
257					((response[4] & 0xfc00) >> 10);
258		cmd->resp[2] =		((response[4] & 0x03ff) << 22) |
259					((response[5] & 0xffff) << 6) |
260					((response[6] & 0xfc00) >> 10);
261		cmd->resp[3] =		((response[6] & 0x03ff) << 22) |
262					((response[7] & 0x3fff) << 8);
263	} else if (cmd->flags & MMC_RSP_PRESENT) {
264		unsigned int response[3], i;
265		for (i = 0; i < 3; i++)
266			response[i] = mvsd_read(MVSD_RSP(i));
267		cmd->resp[0] =		((response[2] & 0x003f) << (8 - 8)) |
268					((response[1] & 0xffff) << (14 - 8)) |
269					((response[0] & 0x03ff) << (30 - 8));
270		cmd->resp[1] =		((response[0] & 0xfc00) >> 10);
271		cmd->resp[2] = 0;
272		cmd->resp[3] = 0;
273	}
274
275	if (err_status & MVSD_ERR_CMD_TIMEOUT) {
276		cmd->error = -ETIMEDOUT;
277	} else if (err_status & (MVSD_ERR_CMD_CRC | MVSD_ERR_CMD_ENDBIT |
278				 MVSD_ERR_CMD_INDEX | MVSD_ERR_CMD_STARTBIT)) {
279		cmd->error = -EILSEQ;
280	}
281	err_status &= ~(MVSD_ERR_CMD_TIMEOUT | MVSD_ERR_CMD_CRC |
282			MVSD_ERR_CMD_ENDBIT | MVSD_ERR_CMD_INDEX |
283			MVSD_ERR_CMD_STARTBIT);
284
285	return err_status;
286}
287
288static u32 mvsd_finish_data(struct mvsd_host *host, struct mmc_data *data,
289			    u32 err_status)
290{
291	void __iomem *iobase = host->base;
292
293	if (host->pio_ptr) {
294		host->pio_ptr = NULL;
295		host->pio_size = 0;
296	} else {
297		dma_unmap_sg(mmc_dev(host->mmc), data->sg, host->sg_frags,
298			     (data->flags & MMC_DATA_READ) ?
299				DMA_FROM_DEVICE : DMA_TO_DEVICE);
300	}
301
302	if (err_status & MVSD_ERR_DATA_TIMEOUT)
303		data->error = -ETIMEDOUT;
304	else if (err_status & (MVSD_ERR_DATA_CRC | MVSD_ERR_DATA_ENDBIT))
305		data->error = -EILSEQ;
306	else if (err_status & MVSD_ERR_XFER_SIZE)
307		data->error = -EBADE;
308	err_status &= ~(MVSD_ERR_DATA_TIMEOUT | MVSD_ERR_DATA_CRC |
309			MVSD_ERR_DATA_ENDBIT | MVSD_ERR_XFER_SIZE);
310
311	dev_dbg(host->dev, "data done: blocks_left=%d, bytes_left=%d\n",
312		mvsd_read(MVSD_CURR_BLK_LEFT), mvsd_read(MVSD_CURR_BYTE_LEFT));
313	data->bytes_xfered =
314		(data->blocks - mvsd_read(MVSD_CURR_BLK_LEFT)) * data->blksz;
315	/* We can't be sure about the last block when errors are detected */
316	if (data->bytes_xfered && data->error)
317		data->bytes_xfered -= data->blksz;
318
319	/* Handle Auto cmd 12 response */
320	if (data->stop) {
321		unsigned int response[3], i;
322		for (i = 0; i < 3; i++)
323			response[i] = mvsd_read(MVSD_AUTO_RSP(i));
324		data->stop->resp[0] =	((response[2] & 0x003f) << (8 - 8)) |
325					((response[1] & 0xffff) << (14 - 8)) |
326					((response[0] & 0x03ff) << (30 - 8));
327		data->stop->resp[1] =	((response[0] & 0xfc00) >> 10);
328		data->stop->resp[2] = 0;
329		data->stop->resp[3] = 0;
330
331		if (err_status & MVSD_ERR_AUTOCMD12) {
332			u32 err_cmd12 = mvsd_read(MVSD_AUTOCMD12_ERR_STATUS);
333			dev_dbg(host->dev, "c12err 0x%04x\n", err_cmd12);
334			if (err_cmd12 & MVSD_AUTOCMD12_ERR_NOTEXE)
335				data->stop->error = -ENOEXEC;
336			else if (err_cmd12 & MVSD_AUTOCMD12_ERR_TIMEOUT)
337				data->stop->error = -ETIMEDOUT;
338			else if (err_cmd12)
339				data->stop->error = -EILSEQ;
340			err_status &= ~MVSD_ERR_AUTOCMD12;
341		}
342	}
343
344	return err_status;
345}
346
347static irqreturn_t mvsd_irq(int irq, void *dev)
348{
349	struct mvsd_host *host = dev;
350	void __iomem *iobase = host->base;
351	u32 intr_status, intr_done_mask;
352	int irq_handled = 0;
353
354	intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
355	dev_dbg(host->dev, "intr 0x%04x intr_en 0x%04x hw_state 0x%04x\n",
356		intr_status, mvsd_read(MVSD_NOR_INTR_EN),
357		mvsd_read(MVSD_HW_STATE));
358
 
 
 
 
 
 
 
 
 
 
 
 
 
 
359	spin_lock(&host->lock);
360
361	/* PIO handling, if needed. Messy business... */
362	if (host->pio_size &&
363	    (intr_status & host->intr_en &
364	     (MVSD_NOR_RX_READY | MVSD_NOR_RX_FIFO_8W))) {
365		u16 *p = host->pio_ptr;
366		int s = host->pio_size;
367		while (s >= 32 && (intr_status & MVSD_NOR_RX_FIFO_8W)) {
368			readsw(iobase + MVSD_FIFO, p, 16);
369			p += 16;
370			s -= 32;
371			intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
372		}
373		/*
374		 * Normally we'd use < 32 here, but the RX_FIFO_8W bit
375		 * doesn't appear to assert when there is exactly 32 bytes
376		 * (8 words) left to fetch in a transfer.
377		 */
378		if (s <= 32) {
379			while (s >= 4 && (intr_status & MVSD_NOR_RX_READY)) {
380				put_unaligned(mvsd_read(MVSD_FIFO), p++);
381				put_unaligned(mvsd_read(MVSD_FIFO), p++);
382				s -= 4;
383				intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
384			}
385			if (s && s < 4 && (intr_status & MVSD_NOR_RX_READY)) {
386				u16 val[2] = {0, 0};
387				val[0] = mvsd_read(MVSD_FIFO);
388				val[1] = mvsd_read(MVSD_FIFO);
389				memcpy(p, ((void *)&val) + 4 - s, s);
390				s = 0;
391				intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
392			}
393			if (s == 0) {
394				host->intr_en &=
395				     ~(MVSD_NOR_RX_READY | MVSD_NOR_RX_FIFO_8W);
396				mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
397			} else if (host->intr_en & MVSD_NOR_RX_FIFO_8W) {
398				host->intr_en &= ~MVSD_NOR_RX_FIFO_8W;
399				host->intr_en |= MVSD_NOR_RX_READY;
400				mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
401			}
402		}
403		dev_dbg(host->dev, "pio %d intr 0x%04x hw_state 0x%04x\n",
404			s, intr_status, mvsd_read(MVSD_HW_STATE));
405		host->pio_ptr = p;
406		host->pio_size = s;
407		irq_handled = 1;
408	} else if (host->pio_size &&
409		   (intr_status & host->intr_en &
410		    (MVSD_NOR_TX_AVAIL | MVSD_NOR_TX_FIFO_8W))) {
411		u16 *p = host->pio_ptr;
412		int s = host->pio_size;
413		/*
414		 * The TX_FIFO_8W bit is unreliable. When set, bursting
415		 * 16 halfwords all at once in the FIFO drops data. Actually
416		 * TX_AVAIL does go off after only one word is pushed even if
417		 * TX_FIFO_8W remains set.
418		 */
419		while (s >= 4 && (intr_status & MVSD_NOR_TX_AVAIL)) {
420			mvsd_write(MVSD_FIFO, get_unaligned(p++));
421			mvsd_write(MVSD_FIFO, get_unaligned(p++));
422			s -= 4;
423			intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
424		}
425		if (s < 4) {
426			if (s && (intr_status & MVSD_NOR_TX_AVAIL)) {
427				u16 val[2] = {0, 0};
428				memcpy(((void *)&val) + 4 - s, p, s);
429				mvsd_write(MVSD_FIFO, val[0]);
430				mvsd_write(MVSD_FIFO, val[1]);
431				s = 0;
432				intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
433			}
434			if (s == 0) {
435				host->intr_en &=
436				     ~(MVSD_NOR_TX_AVAIL | MVSD_NOR_TX_FIFO_8W);
437				mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
438			}
439		}
440		dev_dbg(host->dev, "pio %d intr 0x%04x hw_state 0x%04x\n",
441			s, intr_status, mvsd_read(MVSD_HW_STATE));
442		host->pio_ptr = p;
443		host->pio_size = s;
444		irq_handled = 1;
445	}
446
447	mvsd_write(MVSD_NOR_INTR_STATUS, intr_status);
448
449	intr_done_mask = MVSD_NOR_CARD_INT | MVSD_NOR_RX_READY |
450			 MVSD_NOR_RX_FIFO_8W | MVSD_NOR_TX_FIFO_8W;
451	if (intr_status & host->intr_en & ~intr_done_mask) {
452		struct mmc_request *mrq = host->mrq;
453		struct mmc_command *cmd = mrq->cmd;
454		u32 err_status = 0;
455
456		del_timer(&host->timer);
457		host->mrq = NULL;
458
459		host->intr_en &= MVSD_NOR_CARD_INT;
460		mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
461		mvsd_write(MVSD_ERR_INTR_EN, 0);
462
463		spin_unlock(&host->lock);
464
465		if (intr_status & MVSD_NOR_UNEXP_RSP) {
466			cmd->error = -EPROTO;
467		} else if (intr_status & MVSD_NOR_ERROR) {
468			err_status = mvsd_read(MVSD_ERR_INTR_STATUS);
469			dev_dbg(host->dev, "err 0x%04x\n", err_status);
470		}
471
472		err_status = mvsd_finish_cmd(host, cmd, err_status);
473		if (mrq->data)
474			err_status = mvsd_finish_data(host, mrq->data, err_status);
475		if (err_status) {
476			pr_err("%s: unhandled error status %#04x\n",
477					mmc_hostname(host->mmc), err_status);
478			cmd->error = -ENOMSG;
479		}
480
481		mmc_request_done(host->mmc, mrq);
482		irq_handled = 1;
483	} else
484		spin_unlock(&host->lock);
485
486	if (intr_status & MVSD_NOR_CARD_INT) {
487		mmc_signal_sdio_irq(host->mmc);
488		irq_handled = 1;
489	}
490
491	if (irq_handled)
492		return IRQ_HANDLED;
493
494	pr_err("%s: unhandled interrupt status=0x%04x en=0x%04x "
495			"pio=%d\n", mmc_hostname(host->mmc), intr_status,
496			host->intr_en, host->pio_size);
497	return IRQ_NONE;
498}
499
500static void mvsd_timeout_timer(unsigned long data)
501{
502	struct mvsd_host *host = (struct mvsd_host *)data;
503	void __iomem *iobase = host->base;
504	struct mmc_request *mrq;
505	unsigned long flags;
506
507	spin_lock_irqsave(&host->lock, flags);
508	mrq = host->mrq;
509	if (mrq) {
510		pr_err("%s: Timeout waiting for hardware interrupt.\n",
511				mmc_hostname(host->mmc));
512		pr_err("%s: hw_state=0x%04x, intr_status=0x%04x "
513				"intr_en=0x%04x\n", mmc_hostname(host->mmc),
514				mvsd_read(MVSD_HW_STATE),
515				mvsd_read(MVSD_NOR_INTR_STATUS),
516				mvsd_read(MVSD_NOR_INTR_EN));
517
518		host->mrq = NULL;
519
520		mvsd_write(MVSD_SW_RESET, MVSD_SW_RESET_NOW);
521
522		host->xfer_mode &= MVSD_XFER_MODE_INT_CHK_EN;
523		mvsd_write(MVSD_XFER_MODE, host->xfer_mode);
524
525		host->intr_en &= MVSD_NOR_CARD_INT;
526		mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
527		mvsd_write(MVSD_ERR_INTR_EN, 0);
528		mvsd_write(MVSD_ERR_INTR_STATUS, 0xffff);
529
530		mrq->cmd->error = -ETIMEDOUT;
531		mvsd_finish_cmd(host, mrq->cmd, 0);
532		if (mrq->data) {
533			mrq->data->error = -ETIMEDOUT;
534			mvsd_finish_data(host, mrq->data, 0);
535		}
536	}
537	spin_unlock_irqrestore(&host->lock, flags);
538
539	if (mrq)
540		mmc_request_done(host->mmc, mrq);
541}
542
543static irqreturn_t mvsd_card_detect_irq(int irq, void *dev)
544{
545	struct mvsd_host *host = dev;
546	mmc_detect_change(host->mmc, msecs_to_jiffies(100));
547	return IRQ_HANDLED;
548}
549
550static void mvsd_enable_sdio_irq(struct mmc_host *mmc, int enable)
551{
552	struct mvsd_host *host = mmc_priv(mmc);
553	void __iomem *iobase = host->base;
554	unsigned long flags;
555
556	spin_lock_irqsave(&host->lock, flags);
557	if (enable) {
558		host->xfer_mode |= MVSD_XFER_MODE_INT_CHK_EN;
559		host->intr_en |= MVSD_NOR_CARD_INT;
560	} else {
561		host->xfer_mode &= ~MVSD_XFER_MODE_INT_CHK_EN;
562		host->intr_en &= ~MVSD_NOR_CARD_INT;
563	}
564	mvsd_write(MVSD_XFER_MODE, host->xfer_mode);
565	mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
566	spin_unlock_irqrestore(&host->lock, flags);
567}
568
569static int mvsd_get_ro(struct mmc_host *mmc)
570{
571	struct mvsd_host *host = mmc_priv(mmc);
572
573	if (host->gpio_write_protect)
574		return gpio_get_value(host->gpio_write_protect);
575
576	/*
577	 * Board doesn't support read only detection; let the mmc core
578	 * decide what to do.
579	 */
580	return -ENOSYS;
581}
582
583static void mvsd_power_up(struct mvsd_host *host)
584{
585	void __iomem *iobase = host->base;
586	dev_dbg(host->dev, "power up\n");
587	mvsd_write(MVSD_NOR_INTR_EN, 0);
588	mvsd_write(MVSD_ERR_INTR_EN, 0);
589	mvsd_write(MVSD_SW_RESET, MVSD_SW_RESET_NOW);
590	mvsd_write(MVSD_XFER_MODE, 0);
591	mvsd_write(MVSD_NOR_STATUS_EN, 0xffff);
592	mvsd_write(MVSD_ERR_STATUS_EN, 0xffff);
593	mvsd_write(MVSD_NOR_INTR_STATUS, 0xffff);
594	mvsd_write(MVSD_ERR_INTR_STATUS, 0xffff);
595}
596
597static void mvsd_power_down(struct mvsd_host *host)
598{
599	void __iomem *iobase = host->base;
600	dev_dbg(host->dev, "power down\n");
601	mvsd_write(MVSD_NOR_INTR_EN, 0);
602	mvsd_write(MVSD_ERR_INTR_EN, 0);
603	mvsd_write(MVSD_SW_RESET, MVSD_SW_RESET_NOW);
604	mvsd_write(MVSD_XFER_MODE, MVSD_XFER_MODE_STOP_CLK);
605	mvsd_write(MVSD_NOR_STATUS_EN, 0);
606	mvsd_write(MVSD_ERR_STATUS_EN, 0);
607	mvsd_write(MVSD_NOR_INTR_STATUS, 0xffff);
608	mvsd_write(MVSD_ERR_INTR_STATUS, 0xffff);
609}
610
611static void mvsd_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
612{
613	struct mvsd_host *host = mmc_priv(mmc);
614	void __iomem *iobase = host->base;
615	u32 ctrl_reg = 0;
616
617	if (ios->power_mode == MMC_POWER_UP)
618		mvsd_power_up(host);
619
620	if (ios->clock == 0) {
621		mvsd_write(MVSD_XFER_MODE, MVSD_XFER_MODE_STOP_CLK);
622		mvsd_write(MVSD_CLK_DIV, MVSD_BASE_DIV_MAX);
623		host->clock = 0;
624		dev_dbg(host->dev, "clock off\n");
625	} else if (ios->clock != host->clock) {
626		u32 m = DIV_ROUND_UP(host->base_clock, ios->clock) - 1;
627		if (m > MVSD_BASE_DIV_MAX)
628			m = MVSD_BASE_DIV_MAX;
629		mvsd_write(MVSD_CLK_DIV, m);
630		host->clock = ios->clock;
631		host->ns_per_clk = 1000000000 / (host->base_clock / (m+1));
632		dev_dbg(host->dev, "clock=%d (%d), div=0x%04x\n",
633			ios->clock, host->base_clock / (m+1), m);
634	}
635
636	/* default transfer mode */
637	ctrl_reg |= MVSD_HOST_CTRL_BIG_ENDIAN;
638	ctrl_reg &= ~MVSD_HOST_CTRL_LSB_FIRST;
639
640	/* default to maximum timeout */
641	ctrl_reg |= MVSD_HOST_CTRL_TMOUT_MASK;
642	ctrl_reg |= MVSD_HOST_CTRL_TMOUT_EN;
643
644	if (ios->bus_mode == MMC_BUSMODE_PUSHPULL)
645		ctrl_reg |= MVSD_HOST_CTRL_PUSH_PULL_EN;
646
647	if (ios->bus_width == MMC_BUS_WIDTH_4)
648		ctrl_reg |= MVSD_HOST_CTRL_DATA_WIDTH_4_BITS;
649
650	/*
651	 * The HI_SPEED_EN bit is causing trouble with many (but not all)
652	 * high speed SD, SDHC and SDIO cards.  Not enabling that bit
653	 * makes all cards work.  So let's just ignore that bit for now
654	 * and revisit this issue if problems for not enabling this bit
655	 * are ever reported.
656	 */
657#if 0
658	if (ios->timing == MMC_TIMING_MMC_HS ||
659	    ios->timing == MMC_TIMING_SD_HS)
660		ctrl_reg |= MVSD_HOST_CTRL_HI_SPEED_EN;
661#endif
662
663	host->ctrl = ctrl_reg;
664	mvsd_write(MVSD_HOST_CTRL, ctrl_reg);
665	dev_dbg(host->dev, "ctrl 0x%04x: %s %s %s\n", ctrl_reg,
666		(ctrl_reg & MVSD_HOST_CTRL_PUSH_PULL_EN) ?
667			"push-pull" : "open-drain",
668		(ctrl_reg & MVSD_HOST_CTRL_DATA_WIDTH_4_BITS) ?
669			"4bit-width" : "1bit-width",
670		(ctrl_reg & MVSD_HOST_CTRL_HI_SPEED_EN) ?
671			"high-speed" : "");
672
673	if (ios->power_mode == MMC_POWER_OFF)
674		mvsd_power_down(host);
675}
676
677static const struct mmc_host_ops mvsd_ops = {
678	.request		= mvsd_request,
679	.get_ro			= mvsd_get_ro,
680	.set_ios		= mvsd_set_ios,
681	.enable_sdio_irq	= mvsd_enable_sdio_irq,
682};
683
684static void __init
685mv_conf_mbus_windows(struct mvsd_host *host,
686		     const struct mbus_dram_target_info *dram)
687{
688	void __iomem *iobase = host->base;
689	int i;
690
691	for (i = 0; i < 4; i++) {
692		writel(0, iobase + MVSD_WINDOW_CTRL(i));
693		writel(0, iobase + MVSD_WINDOW_BASE(i));
694	}
695
696	for (i = 0; i < dram->num_cs; i++) {
697		const struct mbus_dram_window *cs = dram->cs + i;
698		writel(((cs->size - 1) & 0xffff0000) |
699		       (cs->mbus_attr << 8) |
700		       (dram->mbus_dram_target_id << 4) | 1,
701		       iobase + MVSD_WINDOW_CTRL(i));
702		writel(cs->base, iobase + MVSD_WINDOW_BASE(i));
703	}
704}
705
706static int __init mvsd_probe(struct platform_device *pdev)
707{
 
708	struct mmc_host *mmc = NULL;
709	struct mvsd_host *host = NULL;
710	const struct mvsdio_platform_data *mvsd_data;
711	const struct mbus_dram_target_info *dram;
712	struct resource *r;
713	int ret, irq;
714
 
 
 
 
715	r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
716	irq = platform_get_irq(pdev, 0);
717	mvsd_data = pdev->dev.platform_data;
718	if (!r || irq < 0 || !mvsd_data)
719		return -ENXIO;
720
721	r = request_mem_region(r->start, SZ_1K, DRIVER_NAME);
722	if (!r)
723		return -EBUSY;
724
725	mmc = mmc_alloc_host(sizeof(struct mvsd_host), &pdev->dev);
726	if (!mmc) {
727		ret = -ENOMEM;
728		goto out;
729	}
730
731	host = mmc_priv(mmc);
732	host->mmc = mmc;
733	host->dev = &pdev->dev;
734	host->res = r;
735	host->base_clock = mvsd_data->clock / 2;
 
 
 
 
 
 
 
 
 
 
 
 
 
736
737	mmc->ops = &mvsd_ops;
738
739	mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
740	mmc->caps = MMC_CAP_4_BIT_DATA | MMC_CAP_SDIO_IRQ |
741		    MMC_CAP_SD_HIGHSPEED | MMC_CAP_MMC_HIGHSPEED;
742
743	mmc->f_min = DIV_ROUND_UP(host->base_clock, MVSD_BASE_DIV_MAX);
744	mmc->f_max = maxfreq;
745
746	mmc->max_blk_size = 2048;
747	mmc->max_blk_count = 65535;
748
749	mmc->max_segs = 1;
750	mmc->max_seg_size = mmc->max_blk_size * mmc->max_blk_count;
751	mmc->max_req_size = mmc->max_blk_size * mmc->max_blk_count;
752
 
 
 
 
 
 
 
753	spin_lock_init(&host->lock);
754
755	host->base = ioremap(r->start, SZ_4K);
756	if (!host->base) {
757		ret = -ENOMEM;
758		goto out;
759	}
760
761	/* (Re-)program MBUS remapping windows if we are asked to. */
762	dram = mv_mbus_dram_info();
763	if (dram)
764		mv_conf_mbus_windows(host, dram);
765
766	mvsd_power_down(host);
767
768	ret = request_irq(irq, mvsd_irq, 0, DRIVER_NAME, host);
769	if (ret) {
770		pr_err("%s: cannot assign irq %d\n", DRIVER_NAME, irq);
771		goto out;
772	} else
773		host->irq = irq;
774
775	/* Not all platforms can gate the clock, so it is not
776	   an error if the clock does not exists. */
777	host->clk = clk_get(&pdev->dev, NULL);
778	if (!IS_ERR(host->clk)) {
779		clk_prepare_enable(host->clk);
780	}
781
782	if (mvsd_data->gpio_card_detect) {
783		ret = gpio_request(mvsd_data->gpio_card_detect,
784				   DRIVER_NAME " cd");
785		if (ret == 0) {
786			gpio_direction_input(mvsd_data->gpio_card_detect);
787			irq = gpio_to_irq(mvsd_data->gpio_card_detect);
788			ret = request_irq(irq, mvsd_card_detect_irq,
789					  IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING,
790					  DRIVER_NAME " cd", host);
791			if (ret == 0)
792				host->gpio_card_detect =
793					mvsd_data->gpio_card_detect;
794			else
795				gpio_free(mvsd_data->gpio_card_detect);
796		}
797	}
798	if (!host->gpio_card_detect)
799		mmc->caps |= MMC_CAP_NEEDS_POLL;
800
801	if (mvsd_data->gpio_write_protect) {
802		ret = gpio_request(mvsd_data->gpio_write_protect,
803				   DRIVER_NAME " wp");
804		if (ret == 0) {
805			gpio_direction_input(mvsd_data->gpio_write_protect);
806			host->gpio_write_protect =
807				mvsd_data->gpio_write_protect;
808		}
809	}
810
811	setup_timer(&host->timer, mvsd_timeout_timer, (unsigned long)host);
812	platform_set_drvdata(pdev, mmc);
813	ret = mmc_add_host(mmc);
814	if (ret)
815		goto out;
816
817	pr_notice("%s: %s driver initialized, ",
818			   mmc_hostname(mmc), DRIVER_NAME);
819	if (host->gpio_card_detect)
820		printk("using GPIO %d for card detection\n",
821		       host->gpio_card_detect);
822	else
823		printk("lacking card detect (fall back to polling)\n");
 
824	return 0;
825
826out:
827	if (host) {
828		if (host->irq)
829			free_irq(host->irq, host);
830		if (host->gpio_card_detect) {
831			free_irq(gpio_to_irq(host->gpio_card_detect), host);
832			gpio_free(host->gpio_card_detect);
833		}
834		if (host->gpio_write_protect)
835			gpio_free(host->gpio_write_protect);
836		if (host->base)
837			iounmap(host->base);
838	}
839	if (r)
840		release_resource(r);
841	if (mmc)
842		mmc_free_host(mmc);
 
843
844	return ret;
845}
846
847static int __exit mvsd_remove(struct platform_device *pdev)
848{
849	struct mmc_host *mmc = platform_get_drvdata(pdev);
850
851	if (mmc) {
852		struct mvsd_host *host = mmc_priv(mmc);
853
854		if (host->gpio_card_detect) {
855			free_irq(gpio_to_irq(host->gpio_card_detect), host);
856			gpio_free(host->gpio_card_detect);
857		}
858		mmc_remove_host(mmc);
859		free_irq(host->irq, host);
860		if (host->gpio_write_protect)
861			gpio_free(host->gpio_write_protect);
862		del_timer_sync(&host->timer);
863		mvsd_power_down(host);
864		iounmap(host->base);
865		release_resource(host->res);
866
867		if (!IS_ERR(host->clk)) {
868			clk_disable_unprepare(host->clk);
869			clk_put(host->clk);
870		}
871		mmc_free_host(mmc);
872	}
873	platform_set_drvdata(pdev, NULL);
874	return 0;
875}
876
877#ifdef CONFIG_PM
878static int mvsd_suspend(struct platform_device *dev, pm_message_t state)
879{
880	struct mmc_host *mmc = platform_get_drvdata(dev);
881	int ret = 0;
882
883	if (mmc)
884		ret = mmc_suspend_host(mmc);
 
885
886	return ret;
887}
888
889static int mvsd_resume(struct platform_device *dev)
890{
891	struct mmc_host *mmc = platform_get_drvdata(dev);
892	int ret = 0;
893
894	if (mmc)
895		ret = mmc_resume_host(mmc);
896
897	return ret;
898}
899#else
900#define mvsd_suspend	NULL
901#define mvsd_resume	NULL
902#endif
903
904static struct platform_driver mvsd_driver = {
905	.remove		= __exit_p(mvsd_remove),
906	.suspend	= mvsd_suspend,
907	.resume		= mvsd_resume,
908	.driver		= {
909		.name	= DRIVER_NAME,
 
910	},
911};
912
913static int __init mvsd_init(void)
914{
915	return platform_driver_probe(&mvsd_driver, mvsd_probe);
916}
917
918static void __exit mvsd_exit(void)
919{
920	platform_driver_unregister(&mvsd_driver);
921}
922
923module_init(mvsd_init);
924module_exit(mvsd_exit);
925
926/* maximum card clock frequency (default 50MHz) */
927module_param(maxfreq, int, 0);
928
929/* force PIO transfers all the time */
930module_param(nodma, int, 0);
931
932MODULE_AUTHOR("Maen Suleiman, Nicolas Pitre");
933MODULE_DESCRIPTION("Marvell MMC,SD,SDIO Host Controller driver");
934MODULE_LICENSE("GPL");
935MODULE_ALIAS("platform:mvsdio");
v4.17
  1/*
  2 * Marvell MMC/SD/SDIO driver
  3 *
  4 * Authors: Maen Suleiman, Nicolas Pitre
  5 * Copyright (C) 2008-2009 Marvell Ltd.
  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
 12#include <linux/module.h>
 13#include <linux/init.h>
 14#include <linux/io.h>
 15#include <linux/platform_device.h>
 16#include <linux/mbus.h>
 17#include <linux/delay.h>
 18#include <linux/interrupt.h>
 19#include <linux/dma-mapping.h>
 20#include <linux/scatterlist.h>
 21#include <linux/irq.h>
 22#include <linux/clk.h>
 23#include <linux/of_irq.h>
 24#include <linux/mmc/host.h>
 25#include <linux/mmc/slot-gpio.h>
 26
 27#include <asm/sizes.h>
 28#include <asm/unaligned.h>
 
 29
 30#include "mvsdio.h"
 31
 32#define DRIVER_NAME	"mvsdio"
 33
 34static int maxfreq;
 35static int nodma;
 36
 37struct mvsd_host {
 38	void __iomem *base;
 39	struct mmc_request *mrq;
 40	spinlock_t lock;
 41	unsigned int xfer_mode;
 42	unsigned int intr_en;
 43	unsigned int ctrl;
 44	unsigned int pio_size;
 45	void *pio_ptr;
 46	unsigned int sg_frags;
 47	unsigned int ns_per_clk;
 48	unsigned int clock;
 49	unsigned int base_clock;
 50	struct timer_list timer;
 51	struct mmc_host *mmc;
 52	struct device *dev;
 
 
 53	struct clk *clk;
 
 
 54};
 55
 56#define mvsd_write(offs, val)	writel(val, iobase + (offs))
 57#define mvsd_read(offs)		readl(iobase + (offs))
 58
 59static int mvsd_setup_data(struct mvsd_host *host, struct mmc_data *data)
 60{
 61	void __iomem *iobase = host->base;
 62	unsigned int tmout;
 63	int tmout_index;
 64
 65	/*
 66	 * Hardware weirdness.  The FIFO_EMPTY bit of the HW_STATE
 67	 * register is sometimes not set before a while when some
 68	 * "unusual" data block sizes are used (such as with the SWITCH
 69	 * command), even despite the fact that the XFER_DONE interrupt
 70	 * was raised.  And if another data transfer starts before
 71	 * this bit comes to good sense (which eventually happens by
 72	 * itself) then the new transfer simply fails with a timeout.
 73	 */
 74	if (!(mvsd_read(MVSD_HW_STATE) & (1 << 13))) {
 75		unsigned long t = jiffies + HZ;
 76		unsigned int hw_state,  count = 0;
 77		do {
 78			hw_state = mvsd_read(MVSD_HW_STATE);
 79			if (time_after(jiffies, t)) {
 80				dev_warn(host->dev, "FIFO_EMPTY bit missing\n");
 81				break;
 82			}
 
 83			count++;
 84		} while (!(hw_state & (1 << 13)));
 85		dev_dbg(host->dev, "*** wait for FIFO_EMPTY bit "
 86				   "(hw=0x%04x, count=%d, jiffies=%ld)\n",
 87				   hw_state, count, jiffies - (t - HZ));
 88	}
 89
 90	/* If timeout=0 then maximum timeout index is used. */
 91	tmout = DIV_ROUND_UP(data->timeout_ns, host->ns_per_clk);
 92	tmout += data->timeout_clks;
 93	tmout_index = fls(tmout - 1) - 12;
 94	if (tmout_index < 0)
 95		tmout_index = 0;
 96	if (tmout_index > MVSD_HOST_CTRL_TMOUT_MAX)
 97		tmout_index = MVSD_HOST_CTRL_TMOUT_MAX;
 98
 99	dev_dbg(host->dev, "data %s at 0x%08x: blocks=%d blksz=%d tmout=%u (%d)\n",
100		(data->flags & MMC_DATA_READ) ? "read" : "write",
101		(u32)sg_virt(data->sg), data->blocks, data->blksz,
102		tmout, tmout_index);
103
104	host->ctrl &= ~MVSD_HOST_CTRL_TMOUT_MASK;
105	host->ctrl |= MVSD_HOST_CTRL_TMOUT(tmout_index);
106	mvsd_write(MVSD_HOST_CTRL, host->ctrl);
107	mvsd_write(MVSD_BLK_COUNT, data->blocks);
108	mvsd_write(MVSD_BLK_SIZE, data->blksz);
109
110	if (nodma || (data->blksz | data->sg->offset) & 3 ||
111	    ((!(data->flags & MMC_DATA_READ) && data->sg->offset & 0x3f))) {
112		/*
113		 * We cannot do DMA on a buffer which offset or size
114		 * is not aligned on a 4-byte boundary.
115		 *
116		 * It also appears the host to card DMA can corrupt
117		 * data when the buffer is not aligned on a 64 byte
118		 * boundary.
119		 */
120		host->pio_size = data->blocks * data->blksz;
121		host->pio_ptr = sg_virt(data->sg);
122		if (!nodma)
123			dev_dbg(host->dev, "fallback to PIO for data at 0x%p size %d\n",
124				host->pio_ptr, host->pio_size);
 
 
125		return 1;
126	} else {
127		dma_addr_t phys_addr;
128
129		host->sg_frags = dma_map_sg(mmc_dev(host->mmc),
130					    data->sg, data->sg_len,
131					    mmc_get_dma_dir(data));
132		phys_addr = sg_dma_address(data->sg);
133		mvsd_write(MVSD_SYS_ADDR_LOW, (u32)phys_addr & 0xffff);
134		mvsd_write(MVSD_SYS_ADDR_HI,  (u32)phys_addr >> 16);
135		return 0;
136	}
137}
138
139static void mvsd_request(struct mmc_host *mmc, struct mmc_request *mrq)
140{
141	struct mvsd_host *host = mmc_priv(mmc);
142	void __iomem *iobase = host->base;
143	struct mmc_command *cmd = mrq->cmd;
144	u32 cmdreg = 0, xfer = 0, intr = 0;
145	unsigned long flags;
146
147	BUG_ON(host->mrq != NULL);
148	host->mrq = mrq;
149
150	dev_dbg(host->dev, "cmd %d (hw state 0x%04x)\n",
151		cmd->opcode, mvsd_read(MVSD_HW_STATE));
152
153	cmdreg = MVSD_CMD_INDEX(cmd->opcode);
154
155	if (cmd->flags & MMC_RSP_BUSY)
156		cmdreg |= MVSD_CMD_RSP_48BUSY;
157	else if (cmd->flags & MMC_RSP_136)
158		cmdreg |= MVSD_CMD_RSP_136;
159	else if (cmd->flags & MMC_RSP_PRESENT)
160		cmdreg |= MVSD_CMD_RSP_48;
161	else
162		cmdreg |= MVSD_CMD_RSP_NONE;
163
164	if (cmd->flags & MMC_RSP_CRC)
165		cmdreg |= MVSD_CMD_CHECK_CMDCRC;
166
167	if (cmd->flags & MMC_RSP_OPCODE)
168		cmdreg |= MVSD_CMD_INDX_CHECK;
169
170	if (cmd->flags & MMC_RSP_PRESENT) {
171		cmdreg |= MVSD_UNEXPECTED_RESP;
172		intr |= MVSD_NOR_UNEXP_RSP;
173	}
174
175	if (mrq->data) {
176		struct mmc_data *data = mrq->data;
177		int pio;
178
179		cmdreg |= MVSD_CMD_DATA_PRESENT | MVSD_CMD_CHECK_DATACRC16;
180		xfer |= MVSD_XFER_MODE_HW_WR_DATA_EN;
181		if (data->flags & MMC_DATA_READ)
182			xfer |= MVSD_XFER_MODE_TO_HOST;
183
184		pio = mvsd_setup_data(host, data);
185		if (pio) {
186			xfer |= MVSD_XFER_MODE_PIO;
187			/* PIO section of mvsd_irq has comments on those bits */
188			if (data->flags & MMC_DATA_WRITE)
189				intr |= MVSD_NOR_TX_AVAIL;
190			else if (host->pio_size > 32)
191				intr |= MVSD_NOR_RX_FIFO_8W;
192			else
193				intr |= MVSD_NOR_RX_READY;
194		}
195
196		if (data->stop) {
197			struct mmc_command *stop = data->stop;
198			u32 cmd12reg = 0;
199
200			mvsd_write(MVSD_AUTOCMD12_ARG_LOW, stop->arg & 0xffff);
201			mvsd_write(MVSD_AUTOCMD12_ARG_HI,  stop->arg >> 16);
202
203			if (stop->flags & MMC_RSP_BUSY)
204				cmd12reg |= MVSD_AUTOCMD12_BUSY;
205			if (stop->flags & MMC_RSP_OPCODE)
206				cmd12reg |= MVSD_AUTOCMD12_INDX_CHECK;
207			cmd12reg |= MVSD_AUTOCMD12_INDEX(stop->opcode);
208			mvsd_write(MVSD_AUTOCMD12_CMD, cmd12reg);
209
210			xfer |= MVSD_XFER_MODE_AUTO_CMD12;
211			intr |= MVSD_NOR_AUTOCMD12_DONE;
212		} else {
213			intr |= MVSD_NOR_XFER_DONE;
214		}
215	} else {
216		intr |= MVSD_NOR_CMD_DONE;
217	}
218
219	mvsd_write(MVSD_ARG_LOW, cmd->arg & 0xffff);
220	mvsd_write(MVSD_ARG_HI,  cmd->arg >> 16);
221
222	spin_lock_irqsave(&host->lock, flags);
223
224	host->xfer_mode &= MVSD_XFER_MODE_INT_CHK_EN;
225	host->xfer_mode |= xfer;
226	mvsd_write(MVSD_XFER_MODE, host->xfer_mode);
227
228	mvsd_write(MVSD_NOR_INTR_STATUS, ~MVSD_NOR_CARD_INT);
229	mvsd_write(MVSD_ERR_INTR_STATUS, 0xffff);
230	mvsd_write(MVSD_CMD, cmdreg);
231
232	host->intr_en &= MVSD_NOR_CARD_INT;
233	host->intr_en |= intr | MVSD_NOR_ERROR;
234	mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
235	mvsd_write(MVSD_ERR_INTR_EN, 0xffff);
236
237	mod_timer(&host->timer, jiffies + 5 * HZ);
238
239	spin_unlock_irqrestore(&host->lock, flags);
240}
241
242static u32 mvsd_finish_cmd(struct mvsd_host *host, struct mmc_command *cmd,
243			   u32 err_status)
244{
245	void __iomem *iobase = host->base;
246
247	if (cmd->flags & MMC_RSP_136) {
248		unsigned int response[8], i;
249		for (i = 0; i < 8; i++)
250			response[i] = mvsd_read(MVSD_RSP(i));
251		cmd->resp[0] =		((response[0] & 0x03ff) << 22) |
252					((response[1] & 0xffff) << 6) |
253					((response[2] & 0xfc00) >> 10);
254		cmd->resp[1] =		((response[2] & 0x03ff) << 22) |
255					((response[3] & 0xffff) << 6) |
256					((response[4] & 0xfc00) >> 10);
257		cmd->resp[2] =		((response[4] & 0x03ff) << 22) |
258					((response[5] & 0xffff) << 6) |
259					((response[6] & 0xfc00) >> 10);
260		cmd->resp[3] =		((response[6] & 0x03ff) << 22) |
261					((response[7] & 0x3fff) << 8);
262	} else if (cmd->flags & MMC_RSP_PRESENT) {
263		unsigned int response[3], i;
264		for (i = 0; i < 3; i++)
265			response[i] = mvsd_read(MVSD_RSP(i));
266		cmd->resp[0] =		((response[2] & 0x003f) << (8 - 8)) |
267					((response[1] & 0xffff) << (14 - 8)) |
268					((response[0] & 0x03ff) << (30 - 8));
269		cmd->resp[1] =		((response[0] & 0xfc00) >> 10);
270		cmd->resp[2] = 0;
271		cmd->resp[3] = 0;
272	}
273
274	if (err_status & MVSD_ERR_CMD_TIMEOUT) {
275		cmd->error = -ETIMEDOUT;
276	} else if (err_status & (MVSD_ERR_CMD_CRC | MVSD_ERR_CMD_ENDBIT |
277				 MVSD_ERR_CMD_INDEX | MVSD_ERR_CMD_STARTBIT)) {
278		cmd->error = -EILSEQ;
279	}
280	err_status &= ~(MVSD_ERR_CMD_TIMEOUT | MVSD_ERR_CMD_CRC |
281			MVSD_ERR_CMD_ENDBIT | MVSD_ERR_CMD_INDEX |
282			MVSD_ERR_CMD_STARTBIT);
283
284	return err_status;
285}
286
287static u32 mvsd_finish_data(struct mvsd_host *host, struct mmc_data *data,
288			    u32 err_status)
289{
290	void __iomem *iobase = host->base;
291
292	if (host->pio_ptr) {
293		host->pio_ptr = NULL;
294		host->pio_size = 0;
295	} else {
296		dma_unmap_sg(mmc_dev(host->mmc), data->sg, host->sg_frags,
297			     mmc_get_dma_dir(data));
 
298	}
299
300	if (err_status & MVSD_ERR_DATA_TIMEOUT)
301		data->error = -ETIMEDOUT;
302	else if (err_status & (MVSD_ERR_DATA_CRC | MVSD_ERR_DATA_ENDBIT))
303		data->error = -EILSEQ;
304	else if (err_status & MVSD_ERR_XFER_SIZE)
305		data->error = -EBADE;
306	err_status &= ~(MVSD_ERR_DATA_TIMEOUT | MVSD_ERR_DATA_CRC |
307			MVSD_ERR_DATA_ENDBIT | MVSD_ERR_XFER_SIZE);
308
309	dev_dbg(host->dev, "data done: blocks_left=%d, bytes_left=%d\n",
310		mvsd_read(MVSD_CURR_BLK_LEFT), mvsd_read(MVSD_CURR_BYTE_LEFT));
311	data->bytes_xfered =
312		(data->blocks - mvsd_read(MVSD_CURR_BLK_LEFT)) * data->blksz;
313	/* We can't be sure about the last block when errors are detected */
314	if (data->bytes_xfered && data->error)
315		data->bytes_xfered -= data->blksz;
316
317	/* Handle Auto cmd 12 response */
318	if (data->stop) {
319		unsigned int response[3], i;
320		for (i = 0; i < 3; i++)
321			response[i] = mvsd_read(MVSD_AUTO_RSP(i));
322		data->stop->resp[0] =	((response[2] & 0x003f) << (8 - 8)) |
323					((response[1] & 0xffff) << (14 - 8)) |
324					((response[0] & 0x03ff) << (30 - 8));
325		data->stop->resp[1] =	((response[0] & 0xfc00) >> 10);
326		data->stop->resp[2] = 0;
327		data->stop->resp[3] = 0;
328
329		if (err_status & MVSD_ERR_AUTOCMD12) {
330			u32 err_cmd12 = mvsd_read(MVSD_AUTOCMD12_ERR_STATUS);
331			dev_dbg(host->dev, "c12err 0x%04x\n", err_cmd12);
332			if (err_cmd12 & MVSD_AUTOCMD12_ERR_NOTEXE)
333				data->stop->error = -ENOEXEC;
334			else if (err_cmd12 & MVSD_AUTOCMD12_ERR_TIMEOUT)
335				data->stop->error = -ETIMEDOUT;
336			else if (err_cmd12)
337				data->stop->error = -EILSEQ;
338			err_status &= ~MVSD_ERR_AUTOCMD12;
339		}
340	}
341
342	return err_status;
343}
344
345static irqreturn_t mvsd_irq(int irq, void *dev)
346{
347	struct mvsd_host *host = dev;
348	void __iomem *iobase = host->base;
349	u32 intr_status, intr_done_mask;
350	int irq_handled = 0;
351
352	intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
353	dev_dbg(host->dev, "intr 0x%04x intr_en 0x%04x hw_state 0x%04x\n",
354		intr_status, mvsd_read(MVSD_NOR_INTR_EN),
355		mvsd_read(MVSD_HW_STATE));
356
357	/*
358	 * It looks like, SDIO IP can issue one late, spurious irq
359	 * although all irqs should be disabled. To work around this,
360	 * bail out early, if we didn't expect any irqs to occur.
361	 */
362	if (!mvsd_read(MVSD_NOR_INTR_EN) && !mvsd_read(MVSD_ERR_INTR_EN)) {
363		dev_dbg(host->dev, "spurious irq detected intr 0x%04x intr_en 0x%04x erri 0x%04x erri_en 0x%04x\n",
364			mvsd_read(MVSD_NOR_INTR_STATUS),
365			mvsd_read(MVSD_NOR_INTR_EN),
366			mvsd_read(MVSD_ERR_INTR_STATUS),
367			mvsd_read(MVSD_ERR_INTR_EN));
368		return IRQ_HANDLED;
369	}
370
371	spin_lock(&host->lock);
372
373	/* PIO handling, if needed. Messy business... */
374	if (host->pio_size &&
375	    (intr_status & host->intr_en &
376	     (MVSD_NOR_RX_READY | MVSD_NOR_RX_FIFO_8W))) {
377		u16 *p = host->pio_ptr;
378		int s = host->pio_size;
379		while (s >= 32 && (intr_status & MVSD_NOR_RX_FIFO_8W)) {
380			readsw(iobase + MVSD_FIFO, p, 16);
381			p += 16;
382			s -= 32;
383			intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
384		}
385		/*
386		 * Normally we'd use < 32 here, but the RX_FIFO_8W bit
387		 * doesn't appear to assert when there is exactly 32 bytes
388		 * (8 words) left to fetch in a transfer.
389		 */
390		if (s <= 32) {
391			while (s >= 4 && (intr_status & MVSD_NOR_RX_READY)) {
392				put_unaligned(mvsd_read(MVSD_FIFO), p++);
393				put_unaligned(mvsd_read(MVSD_FIFO), p++);
394				s -= 4;
395				intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
396			}
397			if (s && s < 4 && (intr_status & MVSD_NOR_RX_READY)) {
398				u16 val[2] = {0, 0};
399				val[0] = mvsd_read(MVSD_FIFO);
400				val[1] = mvsd_read(MVSD_FIFO);
401				memcpy(p, ((void *)&val) + 4 - s, s);
402				s = 0;
403				intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
404			}
405			if (s == 0) {
406				host->intr_en &=
407				     ~(MVSD_NOR_RX_READY | MVSD_NOR_RX_FIFO_8W);
408				mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
409			} else if (host->intr_en & MVSD_NOR_RX_FIFO_8W) {
410				host->intr_en &= ~MVSD_NOR_RX_FIFO_8W;
411				host->intr_en |= MVSD_NOR_RX_READY;
412				mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
413			}
414		}
415		dev_dbg(host->dev, "pio %d intr 0x%04x hw_state 0x%04x\n",
416			s, intr_status, mvsd_read(MVSD_HW_STATE));
417		host->pio_ptr = p;
418		host->pio_size = s;
419		irq_handled = 1;
420	} else if (host->pio_size &&
421		   (intr_status & host->intr_en &
422		    (MVSD_NOR_TX_AVAIL | MVSD_NOR_TX_FIFO_8W))) {
423		u16 *p = host->pio_ptr;
424		int s = host->pio_size;
425		/*
426		 * The TX_FIFO_8W bit is unreliable. When set, bursting
427		 * 16 halfwords all at once in the FIFO drops data. Actually
428		 * TX_AVAIL does go off after only one word is pushed even if
429		 * TX_FIFO_8W remains set.
430		 */
431		while (s >= 4 && (intr_status & MVSD_NOR_TX_AVAIL)) {
432			mvsd_write(MVSD_FIFO, get_unaligned(p++));
433			mvsd_write(MVSD_FIFO, get_unaligned(p++));
434			s -= 4;
435			intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
436		}
437		if (s < 4) {
438			if (s && (intr_status & MVSD_NOR_TX_AVAIL)) {
439				u16 val[2] = {0, 0};
440				memcpy(((void *)&val) + 4 - s, p, s);
441				mvsd_write(MVSD_FIFO, val[0]);
442				mvsd_write(MVSD_FIFO, val[1]);
443				s = 0;
444				intr_status = mvsd_read(MVSD_NOR_INTR_STATUS);
445			}
446			if (s == 0) {
447				host->intr_en &=
448				     ~(MVSD_NOR_TX_AVAIL | MVSD_NOR_TX_FIFO_8W);
449				mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
450			}
451		}
452		dev_dbg(host->dev, "pio %d intr 0x%04x hw_state 0x%04x\n",
453			s, intr_status, mvsd_read(MVSD_HW_STATE));
454		host->pio_ptr = p;
455		host->pio_size = s;
456		irq_handled = 1;
457	}
458
459	mvsd_write(MVSD_NOR_INTR_STATUS, intr_status);
460
461	intr_done_mask = MVSD_NOR_CARD_INT | MVSD_NOR_RX_READY |
462			 MVSD_NOR_RX_FIFO_8W | MVSD_NOR_TX_FIFO_8W;
463	if (intr_status & host->intr_en & ~intr_done_mask) {
464		struct mmc_request *mrq = host->mrq;
465		struct mmc_command *cmd = mrq->cmd;
466		u32 err_status = 0;
467
468		del_timer(&host->timer);
469		host->mrq = NULL;
470
471		host->intr_en &= MVSD_NOR_CARD_INT;
472		mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
473		mvsd_write(MVSD_ERR_INTR_EN, 0);
474
475		spin_unlock(&host->lock);
476
477		if (intr_status & MVSD_NOR_UNEXP_RSP) {
478			cmd->error = -EPROTO;
479		} else if (intr_status & MVSD_NOR_ERROR) {
480			err_status = mvsd_read(MVSD_ERR_INTR_STATUS);
481			dev_dbg(host->dev, "err 0x%04x\n", err_status);
482		}
483
484		err_status = mvsd_finish_cmd(host, cmd, err_status);
485		if (mrq->data)
486			err_status = mvsd_finish_data(host, mrq->data, err_status);
487		if (err_status) {
488			dev_err(host->dev, "unhandled error status %#04x\n",
489				err_status);
490			cmd->error = -ENOMSG;
491		}
492
493		mmc_request_done(host->mmc, mrq);
494		irq_handled = 1;
495	} else
496		spin_unlock(&host->lock);
497
498	if (intr_status & MVSD_NOR_CARD_INT) {
499		mmc_signal_sdio_irq(host->mmc);
500		irq_handled = 1;
501	}
502
503	if (irq_handled)
504		return IRQ_HANDLED;
505
506	dev_err(host->dev, "unhandled interrupt status=0x%04x en=0x%04x pio=%d\n",
507		intr_status, host->intr_en, host->pio_size);
 
508	return IRQ_NONE;
509}
510
511static void mvsd_timeout_timer(struct timer_list *t)
512{
513	struct mvsd_host *host = from_timer(host, t, timer);
514	void __iomem *iobase = host->base;
515	struct mmc_request *mrq;
516	unsigned long flags;
517
518	spin_lock_irqsave(&host->lock, flags);
519	mrq = host->mrq;
520	if (mrq) {
521		dev_err(host->dev, "Timeout waiting for hardware interrupt.\n");
522		dev_err(host->dev, "hw_state=0x%04x, intr_status=0x%04x intr_en=0x%04x\n",
523			mvsd_read(MVSD_HW_STATE),
524			mvsd_read(MVSD_NOR_INTR_STATUS),
525			mvsd_read(MVSD_NOR_INTR_EN));
 
 
526
527		host->mrq = NULL;
528
529		mvsd_write(MVSD_SW_RESET, MVSD_SW_RESET_NOW);
530
531		host->xfer_mode &= MVSD_XFER_MODE_INT_CHK_EN;
532		mvsd_write(MVSD_XFER_MODE, host->xfer_mode);
533
534		host->intr_en &= MVSD_NOR_CARD_INT;
535		mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
536		mvsd_write(MVSD_ERR_INTR_EN, 0);
537		mvsd_write(MVSD_ERR_INTR_STATUS, 0xffff);
538
539		mrq->cmd->error = -ETIMEDOUT;
540		mvsd_finish_cmd(host, mrq->cmd, 0);
541		if (mrq->data) {
542			mrq->data->error = -ETIMEDOUT;
543			mvsd_finish_data(host, mrq->data, 0);
544		}
545	}
546	spin_unlock_irqrestore(&host->lock, flags);
547
548	if (mrq)
549		mmc_request_done(host->mmc, mrq);
550}
551
 
 
 
 
 
 
 
552static void mvsd_enable_sdio_irq(struct mmc_host *mmc, int enable)
553{
554	struct mvsd_host *host = mmc_priv(mmc);
555	void __iomem *iobase = host->base;
556	unsigned long flags;
557
558	spin_lock_irqsave(&host->lock, flags);
559	if (enable) {
560		host->xfer_mode |= MVSD_XFER_MODE_INT_CHK_EN;
561		host->intr_en |= MVSD_NOR_CARD_INT;
562	} else {
563		host->xfer_mode &= ~MVSD_XFER_MODE_INT_CHK_EN;
564		host->intr_en &= ~MVSD_NOR_CARD_INT;
565	}
566	mvsd_write(MVSD_XFER_MODE, host->xfer_mode);
567	mvsd_write(MVSD_NOR_INTR_EN, host->intr_en);
568	spin_unlock_irqrestore(&host->lock, flags);
569}
570
 
 
 
 
 
 
 
 
 
 
 
 
 
 
571static void mvsd_power_up(struct mvsd_host *host)
572{
573	void __iomem *iobase = host->base;
574	dev_dbg(host->dev, "power up\n");
575	mvsd_write(MVSD_NOR_INTR_EN, 0);
576	mvsd_write(MVSD_ERR_INTR_EN, 0);
577	mvsd_write(MVSD_SW_RESET, MVSD_SW_RESET_NOW);
578	mvsd_write(MVSD_XFER_MODE, 0);
579	mvsd_write(MVSD_NOR_STATUS_EN, 0xffff);
580	mvsd_write(MVSD_ERR_STATUS_EN, 0xffff);
581	mvsd_write(MVSD_NOR_INTR_STATUS, 0xffff);
582	mvsd_write(MVSD_ERR_INTR_STATUS, 0xffff);
583}
584
585static void mvsd_power_down(struct mvsd_host *host)
586{
587	void __iomem *iobase = host->base;
588	dev_dbg(host->dev, "power down\n");
589	mvsd_write(MVSD_NOR_INTR_EN, 0);
590	mvsd_write(MVSD_ERR_INTR_EN, 0);
591	mvsd_write(MVSD_SW_RESET, MVSD_SW_RESET_NOW);
592	mvsd_write(MVSD_XFER_MODE, MVSD_XFER_MODE_STOP_CLK);
593	mvsd_write(MVSD_NOR_STATUS_EN, 0);
594	mvsd_write(MVSD_ERR_STATUS_EN, 0);
595	mvsd_write(MVSD_NOR_INTR_STATUS, 0xffff);
596	mvsd_write(MVSD_ERR_INTR_STATUS, 0xffff);
597}
598
599static void mvsd_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
600{
601	struct mvsd_host *host = mmc_priv(mmc);
602	void __iomem *iobase = host->base;
603	u32 ctrl_reg = 0;
604
605	if (ios->power_mode == MMC_POWER_UP)
606		mvsd_power_up(host);
607
608	if (ios->clock == 0) {
609		mvsd_write(MVSD_XFER_MODE, MVSD_XFER_MODE_STOP_CLK);
610		mvsd_write(MVSD_CLK_DIV, MVSD_BASE_DIV_MAX);
611		host->clock = 0;
612		dev_dbg(host->dev, "clock off\n");
613	} else if (ios->clock != host->clock) {
614		u32 m = DIV_ROUND_UP(host->base_clock, ios->clock) - 1;
615		if (m > MVSD_BASE_DIV_MAX)
616			m = MVSD_BASE_DIV_MAX;
617		mvsd_write(MVSD_CLK_DIV, m);
618		host->clock = ios->clock;
619		host->ns_per_clk = 1000000000 / (host->base_clock / (m+1));
620		dev_dbg(host->dev, "clock=%d (%d), div=0x%04x\n",
621			ios->clock, host->base_clock / (m+1), m);
622	}
623
624	/* default transfer mode */
625	ctrl_reg |= MVSD_HOST_CTRL_BIG_ENDIAN;
626	ctrl_reg &= ~MVSD_HOST_CTRL_LSB_FIRST;
627
628	/* default to maximum timeout */
629	ctrl_reg |= MVSD_HOST_CTRL_TMOUT_MASK;
630	ctrl_reg |= MVSD_HOST_CTRL_TMOUT_EN;
631
632	if (ios->bus_mode == MMC_BUSMODE_PUSHPULL)
633		ctrl_reg |= MVSD_HOST_CTRL_PUSH_PULL_EN;
634
635	if (ios->bus_width == MMC_BUS_WIDTH_4)
636		ctrl_reg |= MVSD_HOST_CTRL_DATA_WIDTH_4_BITS;
637
638	/*
639	 * The HI_SPEED_EN bit is causing trouble with many (but not all)
640	 * high speed SD, SDHC and SDIO cards.  Not enabling that bit
641	 * makes all cards work.  So let's just ignore that bit for now
642	 * and revisit this issue if problems for not enabling this bit
643	 * are ever reported.
644	 */
645#if 0
646	if (ios->timing == MMC_TIMING_MMC_HS ||
647	    ios->timing == MMC_TIMING_SD_HS)
648		ctrl_reg |= MVSD_HOST_CTRL_HI_SPEED_EN;
649#endif
650
651	host->ctrl = ctrl_reg;
652	mvsd_write(MVSD_HOST_CTRL, ctrl_reg);
653	dev_dbg(host->dev, "ctrl 0x%04x: %s %s %s\n", ctrl_reg,
654		(ctrl_reg & MVSD_HOST_CTRL_PUSH_PULL_EN) ?
655			"push-pull" : "open-drain",
656		(ctrl_reg & MVSD_HOST_CTRL_DATA_WIDTH_4_BITS) ?
657			"4bit-width" : "1bit-width",
658		(ctrl_reg & MVSD_HOST_CTRL_HI_SPEED_EN) ?
659			"high-speed" : "");
660
661	if (ios->power_mode == MMC_POWER_OFF)
662		mvsd_power_down(host);
663}
664
665static const struct mmc_host_ops mvsd_ops = {
666	.request		= mvsd_request,
667	.get_ro			= mmc_gpio_get_ro,
668	.set_ios		= mvsd_set_ios,
669	.enable_sdio_irq	= mvsd_enable_sdio_irq,
670};
671
672static void
673mv_conf_mbus_windows(struct mvsd_host *host,
674		     const struct mbus_dram_target_info *dram)
675{
676	void __iomem *iobase = host->base;
677	int i;
678
679	for (i = 0; i < 4; i++) {
680		writel(0, iobase + MVSD_WINDOW_CTRL(i));
681		writel(0, iobase + MVSD_WINDOW_BASE(i));
682	}
683
684	for (i = 0; i < dram->num_cs; i++) {
685		const struct mbus_dram_window *cs = dram->cs + i;
686		writel(((cs->size - 1) & 0xffff0000) |
687		       (cs->mbus_attr << 8) |
688		       (dram->mbus_dram_target_id << 4) | 1,
689		       iobase + MVSD_WINDOW_CTRL(i));
690		writel(cs->base, iobase + MVSD_WINDOW_BASE(i));
691	}
692}
693
694static int mvsd_probe(struct platform_device *pdev)
695{
696	struct device_node *np = pdev->dev.of_node;
697	struct mmc_host *mmc = NULL;
698	struct mvsd_host *host = NULL;
 
699	const struct mbus_dram_target_info *dram;
700	struct resource *r;
701	int ret, irq;
702
703	if (!np) {
704		dev_err(&pdev->dev, "no DT node\n");
705		return -ENODEV;
706	}
707	r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
708	irq = platform_get_irq(pdev, 0);
709	if (!r || irq < 0)
 
710		return -ENXIO;
711
 
 
 
 
712	mmc = mmc_alloc_host(sizeof(struct mvsd_host), &pdev->dev);
713	if (!mmc) {
714		ret = -ENOMEM;
715		goto out;
716	}
717
718	host = mmc_priv(mmc);
719	host->mmc = mmc;
720	host->dev = &pdev->dev;
721
722	/*
723	 * Some non-DT platforms do not pass a clock, and the clock
724	 * frequency is passed through platform_data. On DT platforms,
725	 * a clock must always be passed, even if there is no gatable
726	 * clock associated to the SDIO interface (it can simply be a
727	 * fixed rate clock).
728	 */
729	host->clk = devm_clk_get(&pdev->dev, NULL);
730	if (IS_ERR(host->clk)) {
731		dev_err(&pdev->dev, "no clock associated\n");
732		ret = -EINVAL;
733		goto out;
734	}
735	clk_prepare_enable(host->clk);
736
737	mmc->ops = &mvsd_ops;
738
739	mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34;
 
 
740
741	mmc->f_min = DIV_ROUND_UP(host->base_clock, MVSD_BASE_DIV_MAX);
742	mmc->f_max = MVSD_CLOCKRATE_MAX;
743
744	mmc->max_blk_size = 2048;
745	mmc->max_blk_count = 65535;
746
747	mmc->max_segs = 1;
748	mmc->max_seg_size = mmc->max_blk_size * mmc->max_blk_count;
749	mmc->max_req_size = mmc->max_blk_size * mmc->max_blk_count;
750
751	host->base_clock = clk_get_rate(host->clk) / 2;
752	ret = mmc_of_parse(mmc);
753	if (ret < 0)
754		goto out;
755	if (maxfreq)
756		mmc->f_max = maxfreq;
757
758	spin_lock_init(&host->lock);
759
760	host->base = devm_ioremap_resource(&pdev->dev, r);
761	if (IS_ERR(host->base)) {
762		ret = PTR_ERR(host->base);
763		goto out;
764	}
765
766	/* (Re-)program MBUS remapping windows if we are asked to. */
767	dram = mv_mbus_dram_info();
768	if (dram)
769		mv_conf_mbus_windows(host, dram);
770
771	mvsd_power_down(host);
772
773	ret = devm_request_irq(&pdev->dev, irq, mvsd_irq, 0, DRIVER_NAME, host);
774	if (ret) {
775		dev_err(&pdev->dev, "cannot assign irq %d\n", irq);
776		goto out;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
777	}
 
 
778
779	timer_setup(&host->timer, mvsd_timeout_timer, 0);
 
 
 
 
 
 
 
 
 
 
780	platform_set_drvdata(pdev, mmc);
781	ret = mmc_add_host(mmc);
782	if (ret)
783		goto out;
784
785	if (!(mmc->caps & MMC_CAP_NEEDS_POLL))
786		dev_dbg(&pdev->dev, "using GPIO for card detection\n");
 
 
 
787	else
788		dev_dbg(&pdev->dev, "lacking card detect (fall back to polling)\n");
789
790	return 0;
791
792out:
793	if (mmc) {
794		if (!IS_ERR(host->clk))
795			clk_disable_unprepare(host->clk);
 
 
 
 
 
 
 
 
 
 
 
 
796		mmc_free_host(mmc);
797	}
798
799	return ret;
800}
801
802static int mvsd_remove(struct platform_device *pdev)
803{
804	struct mmc_host *mmc = platform_get_drvdata(pdev);
805
806	struct mvsd_host *host = mmc_priv(mmc);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
807
808	mmc_remove_host(mmc);
809	del_timer_sync(&host->timer);
810	mvsd_power_down(host);
 
 
811
812	if (!IS_ERR(host->clk))
813		clk_disable_unprepare(host->clk);
814	mmc_free_host(mmc);
815
816	return 0;
817}
818
819static const struct of_device_id mvsdio_dt_ids[] = {
820	{ .compatible = "marvell,orion-sdio" },
821	{ /* sentinel */ }
822};
823MODULE_DEVICE_TABLE(of, mvsdio_dt_ids);
 
 
 
 
 
 
 
 
 
824
825static struct platform_driver mvsd_driver = {
826	.probe		= mvsd_probe,
827	.remove		= mvsd_remove,
 
828	.driver		= {
829		.name	= DRIVER_NAME,
830		.of_match_table = mvsdio_dt_ids,
831	},
832};
833
834module_platform_driver(mvsd_driver);
 
 
 
 
 
 
 
 
 
 
 
835
836/* maximum card clock frequency (default 50MHz) */
837module_param(maxfreq, int, 0);
838
839/* force PIO transfers all the time */
840module_param(nodma, int, 0);
841
842MODULE_AUTHOR("Maen Suleiman, Nicolas Pitre");
843MODULE_DESCRIPTION("Marvell MMC,SD,SDIO Host Controller driver");
844MODULE_LICENSE("GPL");
845MODULE_ALIAS("platform:mvsdio");