Linux Audio

Check our new training course

Loading...
v3.1
  1/*
  2 * Freescale/Motorola Coldfire Queued SPI driver
  3 *
  4 * Copyright 2010 Steven King <sfking@fdwdc.com>
  5 *
  6 * This program is free software; you can redistribute it and/or modify
  7 * it under the terms of the GNU General Public License as published by
  8 * the Free Software Foundation; either version 2 of the License, or
  9 * (at your option) any later version.
 10 *
 11 * This program is distributed in the hope that it will be useful,
 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 14 * GNU General Public License for more details.
 15 *
 16 * You should have received a copy of the GNU General Public License
 17 * along with this program; if not, write to the Free Software
 18 * Foundation, Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA
 19 *
 20*/
 21
 22#include <linux/kernel.h>
 23#include <linux/module.h>
 24#include <linux/interrupt.h>
 25#include <linux/errno.h>
 26#include <linux/platform_device.h>
 27#include <linux/sched.h>
 28#include <linux/workqueue.h>
 29#include <linux/delay.h>
 30#include <linux/io.h>
 31#include <linux/clk.h>
 32#include <linux/err.h>
 33#include <linux/spi/spi.h>
 
 34
 35#include <asm/coldfire.h>
 36#include <asm/mcfsim.h>
 37#include <asm/mcfqspi.h>
 38
 39#define	DRIVER_NAME "mcfqspi"
 40
 41#define	MCFQSPI_BUSCLK			(MCF_BUSCLK / 2)
 42
 43#define	MCFQSPI_QMR			0x00
 44#define		MCFQSPI_QMR_MSTR	0x8000
 45#define		MCFQSPI_QMR_CPOL	0x0200
 46#define		MCFQSPI_QMR_CPHA	0x0100
 47#define	MCFQSPI_QDLYR			0x04
 48#define		MCFQSPI_QDLYR_SPE	0x8000
 49#define	MCFQSPI_QWR			0x08
 50#define		MCFQSPI_QWR_HALT	0x8000
 51#define		MCFQSPI_QWR_WREN	0x4000
 52#define		MCFQSPI_QWR_CSIV	0x1000
 53#define	MCFQSPI_QIR			0x0C
 54#define		MCFQSPI_QIR_WCEFB	0x8000
 55#define		MCFQSPI_QIR_ABRTB	0x4000
 56#define		MCFQSPI_QIR_ABRTL	0x1000
 57#define		MCFQSPI_QIR_WCEFE	0x0800
 58#define		MCFQSPI_QIR_ABRTE	0x0400
 59#define		MCFQSPI_QIR_SPIFE	0x0100
 60#define		MCFQSPI_QIR_WCEF	0x0008
 61#define		MCFQSPI_QIR_ABRT	0x0004
 62#define		MCFQSPI_QIR_SPIF	0x0001
 63#define	MCFQSPI_QAR			0x010
 64#define		MCFQSPI_QAR_TXBUF	0x00
 65#define		MCFQSPI_QAR_RXBUF	0x10
 66#define		MCFQSPI_QAR_CMDBUF	0x20
 67#define	MCFQSPI_QDR			0x014
 68#define	MCFQSPI_QCR			0x014
 69#define		MCFQSPI_QCR_CONT	0x8000
 70#define		MCFQSPI_QCR_BITSE	0x4000
 71#define		MCFQSPI_QCR_DT		0x2000
 72
 73struct mcfqspi {
 74	void __iomem *iobase;
 75	int irq;
 76	struct clk *clk;
 77	struct mcfqspi_cs_control *cs_control;
 78
 79	wait_queue_head_t waitq;
 80
 81	struct work_struct work;
 82	struct workqueue_struct *workq;
 83	spinlock_t lock;
 84	struct list_head msgq;
 85};
 86
 87static void mcfqspi_wr_qmr(struct mcfqspi *mcfqspi, u16 val)
 88{
 89	writew(val, mcfqspi->iobase + MCFQSPI_QMR);
 90}
 91
 92static void mcfqspi_wr_qdlyr(struct mcfqspi *mcfqspi, u16 val)
 93{
 94	writew(val, mcfqspi->iobase + MCFQSPI_QDLYR);
 95}
 96
 97static u16 mcfqspi_rd_qdlyr(struct mcfqspi *mcfqspi)
 98{
 99	return readw(mcfqspi->iobase + MCFQSPI_QDLYR);
100}
101
102static void mcfqspi_wr_qwr(struct mcfqspi *mcfqspi, u16 val)
103{
104	writew(val, mcfqspi->iobase + MCFQSPI_QWR);
105}
106
107static void mcfqspi_wr_qir(struct mcfqspi *mcfqspi, u16 val)
108{
109	writew(val, mcfqspi->iobase + MCFQSPI_QIR);
110}
111
112static void mcfqspi_wr_qar(struct mcfqspi *mcfqspi, u16 val)
113{
114	writew(val, mcfqspi->iobase + MCFQSPI_QAR);
115}
116
117static void mcfqspi_wr_qdr(struct mcfqspi *mcfqspi, u16 val)
118{
119	writew(val, mcfqspi->iobase + MCFQSPI_QDR);
120}
121
122static u16 mcfqspi_rd_qdr(struct mcfqspi *mcfqspi)
123{
124	return readw(mcfqspi->iobase + MCFQSPI_QDR);
125}
126
127static void mcfqspi_cs_select(struct mcfqspi *mcfqspi, u8 chip_select,
128			    bool cs_high)
129{
130	mcfqspi->cs_control->select(mcfqspi->cs_control, chip_select, cs_high);
131}
132
133static void mcfqspi_cs_deselect(struct mcfqspi *mcfqspi, u8 chip_select,
134				bool cs_high)
135{
136	mcfqspi->cs_control->deselect(mcfqspi->cs_control, chip_select, cs_high);
137}
138
139static int mcfqspi_cs_setup(struct mcfqspi *mcfqspi)
140{
141	return (mcfqspi->cs_control && mcfqspi->cs_control->setup) ?
142		mcfqspi->cs_control->setup(mcfqspi->cs_control) : 0;
143}
144
145static void mcfqspi_cs_teardown(struct mcfqspi *mcfqspi)
146{
147	if (mcfqspi->cs_control && mcfqspi->cs_control->teardown)
148		mcfqspi->cs_control->teardown(mcfqspi->cs_control);
149}
150
151static u8 mcfqspi_qmr_baud(u32 speed_hz)
152{
153	return clamp((MCFQSPI_BUSCLK + speed_hz - 1) / speed_hz, 2u, 255u);
154}
155
156static bool mcfqspi_qdlyr_spe(struct mcfqspi *mcfqspi)
157{
158	return mcfqspi_rd_qdlyr(mcfqspi) & MCFQSPI_QDLYR_SPE;
159}
160
161static irqreturn_t mcfqspi_irq_handler(int this_irq, void *dev_id)
162{
163	struct mcfqspi *mcfqspi = dev_id;
164
165	/* clear interrupt */
166	mcfqspi_wr_qir(mcfqspi, MCFQSPI_QIR_SPIFE | MCFQSPI_QIR_SPIF);
167	wake_up(&mcfqspi->waitq);
168
169	return IRQ_HANDLED;
170}
171
172static void mcfqspi_transfer_msg8(struct mcfqspi *mcfqspi, unsigned count,
173				  const u8 *txbuf, u8 *rxbuf)
174{
175	unsigned i, n, offset = 0;
176
177	n = min(count, 16u);
178
179	mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_CMDBUF);
180	for (i = 0; i < n; ++i)
181		mcfqspi_wr_qdr(mcfqspi, MCFQSPI_QCR_BITSE);
182
183	mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_TXBUF);
184	if (txbuf)
185		for (i = 0; i < n; ++i)
186			mcfqspi_wr_qdr(mcfqspi, *txbuf++);
187	else
188		for (i = 0; i < count; ++i)
189			mcfqspi_wr_qdr(mcfqspi, 0);
190
191	count -= n;
192	if (count) {
193		u16 qwr = 0xf08;
194		mcfqspi_wr_qwr(mcfqspi, 0x700);
195		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
196
197		do {
198			wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
199			mcfqspi_wr_qwr(mcfqspi, qwr);
200			mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
201			if (rxbuf) {
202				mcfqspi_wr_qar(mcfqspi,
203					       MCFQSPI_QAR_RXBUF + offset);
204				for (i = 0; i < 8; ++i)
205					*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
206			}
207			n = min(count, 8u);
208			if (txbuf) {
209				mcfqspi_wr_qar(mcfqspi,
210					       MCFQSPI_QAR_TXBUF + offset);
211				for (i = 0; i < n; ++i)
212					mcfqspi_wr_qdr(mcfqspi, *txbuf++);
213			}
214			qwr = (offset ? 0x808 : 0) + ((n - 1) << 8);
215			offset ^= 8;
216			count -= n;
217		} while (count);
218		wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
219		mcfqspi_wr_qwr(mcfqspi, qwr);
220		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
221		if (rxbuf) {
222			mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_RXBUF + offset);
223			for (i = 0; i < 8; ++i)
224				*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
225			offset ^= 8;
226		}
227	} else {
228		mcfqspi_wr_qwr(mcfqspi, (n - 1) << 8);
229		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
230	}
231	wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
232	if (rxbuf) {
233		mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_RXBUF + offset);
234		for (i = 0; i < n; ++i)
235			*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
236	}
237}
238
239static void mcfqspi_transfer_msg16(struct mcfqspi *mcfqspi, unsigned count,
240				   const u16 *txbuf, u16 *rxbuf)
241{
242	unsigned i, n, offset = 0;
243
244	n = min(count, 16u);
245
246	mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_CMDBUF);
247	for (i = 0; i < n; ++i)
248		mcfqspi_wr_qdr(mcfqspi, MCFQSPI_QCR_BITSE);
249
250	mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_TXBUF);
251	if (txbuf)
252		for (i = 0; i < n; ++i)
253			mcfqspi_wr_qdr(mcfqspi, *txbuf++);
254	else
255		for (i = 0; i < count; ++i)
256			mcfqspi_wr_qdr(mcfqspi, 0);
257
258	count -= n;
259	if (count) {
260		u16 qwr = 0xf08;
261		mcfqspi_wr_qwr(mcfqspi, 0x700);
262		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
263
264		do {
265			wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
266			mcfqspi_wr_qwr(mcfqspi, qwr);
267			mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
268			if (rxbuf) {
269				mcfqspi_wr_qar(mcfqspi,
270					       MCFQSPI_QAR_RXBUF + offset);
271				for (i = 0; i < 8; ++i)
272					*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
273			}
274			n = min(count, 8u);
275			if (txbuf) {
276				mcfqspi_wr_qar(mcfqspi,
277					       MCFQSPI_QAR_TXBUF + offset);
278				for (i = 0; i < n; ++i)
279					mcfqspi_wr_qdr(mcfqspi, *txbuf++);
280			}
281			qwr = (offset ? 0x808 : 0x000) + ((n - 1) << 8);
282			offset ^= 8;
283			count -= n;
284		} while (count);
285		wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
286		mcfqspi_wr_qwr(mcfqspi, qwr);
287		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
288		if (rxbuf) {
289			mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_RXBUF + offset);
290			for (i = 0; i < 8; ++i)
291				*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
292			offset ^= 8;
293		}
294	} else {
295		mcfqspi_wr_qwr(mcfqspi, (n - 1) << 8);
296		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
297	}
298	wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
299	if (rxbuf) {
300		mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_RXBUF + offset);
301		for (i = 0; i < n; ++i)
302			*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
303	}
304}
305
306static void mcfqspi_work(struct work_struct *work)
 
307{
308	struct mcfqspi *mcfqspi = container_of(work, struct mcfqspi, work);
309	unsigned long flags;
310
311	spin_lock_irqsave(&mcfqspi->lock, flags);
312	while (!list_empty(&mcfqspi->msgq)) {
313		struct spi_message *msg;
314		struct spi_device *spi;
315		struct spi_transfer *xfer;
316		int status = 0;
317
318		msg = container_of(mcfqspi->msgq.next, struct spi_message,
319				   queue);
320
321		list_del_init(&msg->queue);
322		spin_unlock_irqrestore(&mcfqspi->lock, flags);
323
324		spi = msg->spi;
325
326		list_for_each_entry(xfer, &msg->transfers, transfer_list) {
327			bool cs_high = spi->mode & SPI_CS_HIGH;
328			u16 qmr = MCFQSPI_QMR_MSTR;
329
330			if (xfer->bits_per_word)
331				qmr |= xfer->bits_per_word << 10;
332			else
333				qmr |= spi->bits_per_word << 10;
334			if (spi->mode & SPI_CPHA)
335				qmr |= MCFQSPI_QMR_CPHA;
336			if (spi->mode & SPI_CPOL)
337				qmr |= MCFQSPI_QMR_CPOL;
338			if (xfer->speed_hz)
339				qmr |= mcfqspi_qmr_baud(xfer->speed_hz);
340			else
341				qmr |= mcfqspi_qmr_baud(spi->max_speed_hz);
342			mcfqspi_wr_qmr(mcfqspi, qmr);
343
344			mcfqspi_cs_select(mcfqspi, spi->chip_select, cs_high);
345
346			mcfqspi_wr_qir(mcfqspi, MCFQSPI_QIR_SPIFE);
347			if ((xfer->bits_per_word ? xfer->bits_per_word :
348						spi->bits_per_word) == 8)
349				mcfqspi_transfer_msg8(mcfqspi, xfer->len,
350						      xfer->tx_buf,
351						      xfer->rx_buf);
352			else
353				mcfqspi_transfer_msg16(mcfqspi, xfer->len / 2,
354						       xfer->tx_buf,
355						       xfer->rx_buf);
356			mcfqspi_wr_qir(mcfqspi, 0);
357
358			if (xfer->delay_usecs)
359				udelay(xfer->delay_usecs);
360			if (xfer->cs_change) {
361				if (!list_is_last(&xfer->transfer_list,
362						  &msg->transfers))
363					mcfqspi_cs_deselect(mcfqspi,
364							    spi->chip_select,
365							    cs_high);
366			} else {
367				if (list_is_last(&xfer->transfer_list,
368						 &msg->transfers))
369					mcfqspi_cs_deselect(mcfqspi,
370							    spi->chip_select,
371							    cs_high);
372			}
373			msg->actual_length += xfer->len;
374		}
375		msg->status = status;
376		msg->complete(msg->context);
377
378		spin_lock_irqsave(&mcfqspi->lock, flags);
379	}
380	spin_unlock_irqrestore(&mcfqspi->lock, flags);
 
 
 
 
381}
382
383static int mcfqspi_transfer(struct spi_device *spi, struct spi_message *msg)
384{
385	struct mcfqspi *mcfqspi;
386	struct spi_transfer *xfer;
387	unsigned long flags;
388
389	mcfqspi = spi_master_get_devdata(spi->master);
390
391	list_for_each_entry(xfer, &msg->transfers, transfer_list) {
392		if (xfer->bits_per_word && ((xfer->bits_per_word < 8)
393					|| (xfer->bits_per_word > 16))) {
394			dev_dbg(&spi->dev,
395				"%d bits per word is not supported\n",
396				xfer->bits_per_word);
397			goto fail;
398		}
399		if (xfer->speed_hz) {
400			u32 real_speed = MCFQSPI_BUSCLK /
401				mcfqspi_qmr_baud(xfer->speed_hz);
402			if (real_speed != xfer->speed_hz)
403				dev_dbg(&spi->dev,
404					"using speed %d instead of %d\n",
405					real_speed, xfer->speed_hz);
406		}
407	}
408	msg->status = -EINPROGRESS;
409	msg->actual_length = 0;
410
411	spin_lock_irqsave(&mcfqspi->lock, flags);
412	list_add_tail(&msg->queue, &mcfqspi->msgq);
413	queue_work(mcfqspi->workq, &mcfqspi->work);
414	spin_unlock_irqrestore(&mcfqspi->lock, flags);
415
416	return 0;
417fail:
418	msg->status = -EINVAL;
419	return -EINVAL;
420}
421
422static int mcfqspi_setup(struct spi_device *spi)
423{
424	if ((spi->bits_per_word < 8) || (spi->bits_per_word > 16)) {
425		dev_dbg(&spi->dev, "%d bits per word is not supported\n",
426			spi->bits_per_word);
427		return -EINVAL;
428	}
429	if (spi->chip_select >= spi->master->num_chipselect) {
430		dev_dbg(&spi->dev, "%d chip select is out of range\n",
431			spi->chip_select);
432		return -EINVAL;
433	}
434
435	mcfqspi_cs_deselect(spi_master_get_devdata(spi->master),
436			    spi->chip_select, spi->mode & SPI_CS_HIGH);
437
438	dev_dbg(&spi->dev,
439			"bits per word %d, chip select %d, speed %d KHz\n",
440			spi->bits_per_word, spi->chip_select,
441			(MCFQSPI_BUSCLK / mcfqspi_qmr_baud(spi->max_speed_hz))
442			/ 1000);
443
444	return 0;
445}
446
447static int __devinit mcfqspi_probe(struct platform_device *pdev)
448{
449	struct spi_master *master;
450	struct mcfqspi *mcfqspi;
451	struct resource *res;
452	struct mcfqspi_platform_data *pdata;
453	int status;
454
455	master = spi_alloc_master(&pdev->dev, sizeof(*mcfqspi));
456	if (master == NULL) {
457		dev_dbg(&pdev->dev, "spi_alloc_master failed\n");
458		return -ENOMEM;
459	}
460
461	mcfqspi = spi_master_get_devdata(master);
462
463	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
464	if (!res) {
465		dev_dbg(&pdev->dev, "platform_get_resource failed\n");
466		status = -ENXIO;
467		goto fail0;
468	}
469
470	if (!request_mem_region(res->start, resource_size(res), pdev->name)) {
471		dev_dbg(&pdev->dev, "request_mem_region failed\n");
472		status = -EBUSY;
473		goto fail0;
474	}
475
476	mcfqspi->iobase = ioremap(res->start, resource_size(res));
477	if (!mcfqspi->iobase) {
478		dev_dbg(&pdev->dev, "ioremap failed\n");
479		status = -ENOMEM;
480		goto fail1;
481	}
482
483	mcfqspi->irq = platform_get_irq(pdev, 0);
484	if (mcfqspi->irq < 0) {
485		dev_dbg(&pdev->dev, "platform_get_irq failed\n");
486		status = -ENXIO;
487		goto fail2;
488	}
489
490	status = request_irq(mcfqspi->irq, mcfqspi_irq_handler, IRQF_DISABLED,
491			     pdev->name, mcfqspi);
492	if (status) {
493		dev_dbg(&pdev->dev, "request_irq failed\n");
494		goto fail2;
495	}
496
497	mcfqspi->clk = clk_get(&pdev->dev, "qspi_clk");
498	if (IS_ERR(mcfqspi->clk)) {
499		dev_dbg(&pdev->dev, "clk_get failed\n");
500		status = PTR_ERR(mcfqspi->clk);
501		goto fail3;
502	}
503	clk_enable(mcfqspi->clk);
504
505	mcfqspi->workq = create_singlethread_workqueue(dev_name(master->dev.parent));
506	if (!mcfqspi->workq) {
507		dev_dbg(&pdev->dev, "create_workqueue failed\n");
508		status = -ENOMEM;
509		goto fail4;
510	}
511	INIT_WORK(&mcfqspi->work, mcfqspi_work);
512	spin_lock_init(&mcfqspi->lock);
513	INIT_LIST_HEAD(&mcfqspi->msgq);
514	init_waitqueue_head(&mcfqspi->waitq);
515
516	pdata = pdev->dev.platform_data;
517	if (!pdata) {
518		dev_dbg(&pdev->dev, "platform data is missing\n");
519		goto fail5;
520	}
521	master->bus_num = pdata->bus_num;
522	master->num_chipselect = pdata->num_chipselect;
523
524	mcfqspi->cs_control = pdata->cs_control;
525	status = mcfqspi_cs_setup(mcfqspi);
526	if (status) {
527		dev_dbg(&pdev->dev, "error initializing cs_control\n");
528		goto fail5;
529	}
530
 
 
 
531	master->mode_bits = SPI_CS_HIGH | SPI_CPOL | SPI_CPHA;
532	master->setup = mcfqspi_setup;
533	master->transfer = mcfqspi_transfer;
 
 
534
535	platform_set_drvdata(pdev, master);
536
537	status = spi_register_master(master);
538	if (status) {
539		dev_dbg(&pdev->dev, "spi_register_master failed\n");
540		goto fail6;
541	}
 
 
542	dev_info(&pdev->dev, "Coldfire QSPI bus driver\n");
543
544	return 0;
545
546fail6:
547	mcfqspi_cs_teardown(mcfqspi);
548fail5:
549	destroy_workqueue(mcfqspi->workq);
550fail4:
551	clk_disable(mcfqspi->clk);
552	clk_put(mcfqspi->clk);
553fail3:
554	free_irq(mcfqspi->irq, mcfqspi);
555fail2:
556	iounmap(mcfqspi->iobase);
557fail1:
558	release_mem_region(res->start, resource_size(res));
559fail0:
560	spi_master_put(master);
561
562	dev_dbg(&pdev->dev, "Coldfire QSPI probe failed\n");
563
564	return status;
565}
566
567static int __devexit mcfqspi_remove(struct platform_device *pdev)
568{
569	struct spi_master *master = platform_get_drvdata(pdev);
570	struct mcfqspi *mcfqspi = spi_master_get_devdata(master);
571	struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
572
 
573	/* disable the hardware (set the baud rate to 0) */
574	mcfqspi_wr_qmr(mcfqspi, MCFQSPI_QMR_MSTR);
575
576	platform_set_drvdata(pdev, NULL);
577	mcfqspi_cs_teardown(mcfqspi);
578	destroy_workqueue(mcfqspi->workq);
579	clk_disable(mcfqspi->clk);
580	clk_put(mcfqspi->clk);
581	free_irq(mcfqspi->irq, mcfqspi);
582	iounmap(mcfqspi->iobase);
583	release_mem_region(res->start, resource_size(res));
584	spi_unregister_master(master);
585	spi_master_put(master);
586
587	return 0;
588}
589
590#ifdef CONFIG_PM
591
592static int mcfqspi_suspend(struct device *dev)
593{
594	struct mcfqspi *mcfqspi = platform_get_drvdata(to_platform_device(dev));
 
 
 
595
596	clk_disable(mcfqspi->clk);
597
598	return 0;
599}
600
601static int mcfqspi_resume(struct device *dev)
602{
603	struct mcfqspi *mcfqspi = platform_get_drvdata(to_platform_device(dev));
 
 
 
604
605	clk_enable(mcfqspi->clk);
606
607	return 0;
608}
 
609
610static struct dev_pm_ops mcfqspi_dev_pm_ops = {
611	.suspend	= mcfqspi_suspend,
612	.resume		= mcfqspi_resume,
613};
 
 
 
 
 
614
615#define	MCFQSPI_DEV_PM_OPS	(&mcfqspi_dev_pm_ops)
616#else
617#define	MCFQSPI_DEV_PM_OPS	NULL
 
 
 
 
 
618#endif
619
 
 
 
 
 
 
620static struct platform_driver mcfqspi_driver = {
621	.driver.name	= DRIVER_NAME,
622	.driver.owner	= THIS_MODULE,
623	.driver.pm	= MCFQSPI_DEV_PM_OPS,
 
624	.remove		= __devexit_p(mcfqspi_remove),
625};
626
627static int __init mcfqspi_init(void)
628{
629	return platform_driver_probe(&mcfqspi_driver, mcfqspi_probe);
630}
631module_init(mcfqspi_init);
632
633static void __exit mcfqspi_exit(void)
634{
635	platform_driver_unregister(&mcfqspi_driver);
636}
637module_exit(mcfqspi_exit);
638
639MODULE_AUTHOR("Steven King <sfking@fdwdc.com>");
640MODULE_DESCRIPTION("Coldfire QSPI Controller Driver");
641MODULE_LICENSE("GPL");
642MODULE_ALIAS("platform:" DRIVER_NAME);
v3.5.6
  1/*
  2 * Freescale/Motorola Coldfire Queued SPI driver
  3 *
  4 * Copyright 2010 Steven King <sfking@fdwdc.com>
  5 *
  6 * This program is free software; you can redistribute it and/or modify
  7 * it under the terms of the GNU General Public License as published by
  8 * the Free Software Foundation; either version 2 of the License, or
  9 * (at your option) any later version.
 10 *
 11 * This program is distributed in the hope that it will be useful,
 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 14 * GNU General Public License for more details.
 15 *
 16 * You should have received a copy of the GNU General Public License
 17 * along with this program; if not, write to the Free Software
 18 * Foundation, Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA
 19 *
 20*/
 21
 22#include <linux/kernel.h>
 23#include <linux/module.h>
 24#include <linux/interrupt.h>
 25#include <linux/errno.h>
 26#include <linux/platform_device.h>
 27#include <linux/sched.h>
 
 28#include <linux/delay.h>
 29#include <linux/io.h>
 30#include <linux/clk.h>
 31#include <linux/err.h>
 32#include <linux/spi/spi.h>
 33#include <linux/pm_runtime.h>
 34
 35#include <asm/coldfire.h>
 36#include <asm/mcfsim.h>
 37#include <asm/mcfqspi.h>
 38
 39#define	DRIVER_NAME "mcfqspi"
 40
 41#define	MCFQSPI_BUSCLK			(MCF_BUSCLK / 2)
 42
 43#define	MCFQSPI_QMR			0x00
 44#define		MCFQSPI_QMR_MSTR	0x8000
 45#define		MCFQSPI_QMR_CPOL	0x0200
 46#define		MCFQSPI_QMR_CPHA	0x0100
 47#define	MCFQSPI_QDLYR			0x04
 48#define		MCFQSPI_QDLYR_SPE	0x8000
 49#define	MCFQSPI_QWR			0x08
 50#define		MCFQSPI_QWR_HALT	0x8000
 51#define		MCFQSPI_QWR_WREN	0x4000
 52#define		MCFQSPI_QWR_CSIV	0x1000
 53#define	MCFQSPI_QIR			0x0C
 54#define		MCFQSPI_QIR_WCEFB	0x8000
 55#define		MCFQSPI_QIR_ABRTB	0x4000
 56#define		MCFQSPI_QIR_ABRTL	0x1000
 57#define		MCFQSPI_QIR_WCEFE	0x0800
 58#define		MCFQSPI_QIR_ABRTE	0x0400
 59#define		MCFQSPI_QIR_SPIFE	0x0100
 60#define		MCFQSPI_QIR_WCEF	0x0008
 61#define		MCFQSPI_QIR_ABRT	0x0004
 62#define		MCFQSPI_QIR_SPIF	0x0001
 63#define	MCFQSPI_QAR			0x010
 64#define		MCFQSPI_QAR_TXBUF	0x00
 65#define		MCFQSPI_QAR_RXBUF	0x10
 66#define		MCFQSPI_QAR_CMDBUF	0x20
 67#define	MCFQSPI_QDR			0x014
 68#define	MCFQSPI_QCR			0x014
 69#define		MCFQSPI_QCR_CONT	0x8000
 70#define		MCFQSPI_QCR_BITSE	0x4000
 71#define		MCFQSPI_QCR_DT		0x2000
 72
 73struct mcfqspi {
 74	void __iomem *iobase;
 75	int irq;
 76	struct clk *clk;
 77	struct mcfqspi_cs_control *cs_control;
 78
 79	wait_queue_head_t waitq;
 80
 81	struct device *dev;
 
 
 
 82};
 83
 84static void mcfqspi_wr_qmr(struct mcfqspi *mcfqspi, u16 val)
 85{
 86	writew(val, mcfqspi->iobase + MCFQSPI_QMR);
 87}
 88
 89static void mcfqspi_wr_qdlyr(struct mcfqspi *mcfqspi, u16 val)
 90{
 91	writew(val, mcfqspi->iobase + MCFQSPI_QDLYR);
 92}
 93
 94static u16 mcfqspi_rd_qdlyr(struct mcfqspi *mcfqspi)
 95{
 96	return readw(mcfqspi->iobase + MCFQSPI_QDLYR);
 97}
 98
 99static void mcfqspi_wr_qwr(struct mcfqspi *mcfqspi, u16 val)
100{
101	writew(val, mcfqspi->iobase + MCFQSPI_QWR);
102}
103
104static void mcfqspi_wr_qir(struct mcfqspi *mcfqspi, u16 val)
105{
106	writew(val, mcfqspi->iobase + MCFQSPI_QIR);
107}
108
109static void mcfqspi_wr_qar(struct mcfqspi *mcfqspi, u16 val)
110{
111	writew(val, mcfqspi->iobase + MCFQSPI_QAR);
112}
113
114static void mcfqspi_wr_qdr(struct mcfqspi *mcfqspi, u16 val)
115{
116	writew(val, mcfqspi->iobase + MCFQSPI_QDR);
117}
118
119static u16 mcfqspi_rd_qdr(struct mcfqspi *mcfqspi)
120{
121	return readw(mcfqspi->iobase + MCFQSPI_QDR);
122}
123
124static void mcfqspi_cs_select(struct mcfqspi *mcfqspi, u8 chip_select,
125			    bool cs_high)
126{
127	mcfqspi->cs_control->select(mcfqspi->cs_control, chip_select, cs_high);
128}
129
130static void mcfqspi_cs_deselect(struct mcfqspi *mcfqspi, u8 chip_select,
131				bool cs_high)
132{
133	mcfqspi->cs_control->deselect(mcfqspi->cs_control, chip_select, cs_high);
134}
135
136static int mcfqspi_cs_setup(struct mcfqspi *mcfqspi)
137{
138	return (mcfqspi->cs_control && mcfqspi->cs_control->setup) ?
139		mcfqspi->cs_control->setup(mcfqspi->cs_control) : 0;
140}
141
142static void mcfqspi_cs_teardown(struct mcfqspi *mcfqspi)
143{
144	if (mcfqspi->cs_control && mcfqspi->cs_control->teardown)
145		mcfqspi->cs_control->teardown(mcfqspi->cs_control);
146}
147
148static u8 mcfqspi_qmr_baud(u32 speed_hz)
149{
150	return clamp((MCFQSPI_BUSCLK + speed_hz - 1) / speed_hz, 2u, 255u);
151}
152
153static bool mcfqspi_qdlyr_spe(struct mcfqspi *mcfqspi)
154{
155	return mcfqspi_rd_qdlyr(mcfqspi) & MCFQSPI_QDLYR_SPE;
156}
157
158static irqreturn_t mcfqspi_irq_handler(int this_irq, void *dev_id)
159{
160	struct mcfqspi *mcfqspi = dev_id;
161
162	/* clear interrupt */
163	mcfqspi_wr_qir(mcfqspi, MCFQSPI_QIR_SPIFE | MCFQSPI_QIR_SPIF);
164	wake_up(&mcfqspi->waitq);
165
166	return IRQ_HANDLED;
167}
168
169static void mcfqspi_transfer_msg8(struct mcfqspi *mcfqspi, unsigned count,
170				  const u8 *txbuf, u8 *rxbuf)
171{
172	unsigned i, n, offset = 0;
173
174	n = min(count, 16u);
175
176	mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_CMDBUF);
177	for (i = 0; i < n; ++i)
178		mcfqspi_wr_qdr(mcfqspi, MCFQSPI_QCR_BITSE);
179
180	mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_TXBUF);
181	if (txbuf)
182		for (i = 0; i < n; ++i)
183			mcfqspi_wr_qdr(mcfqspi, *txbuf++);
184	else
185		for (i = 0; i < count; ++i)
186			mcfqspi_wr_qdr(mcfqspi, 0);
187
188	count -= n;
189	if (count) {
190		u16 qwr = 0xf08;
191		mcfqspi_wr_qwr(mcfqspi, 0x700);
192		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
193
194		do {
195			wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
196			mcfqspi_wr_qwr(mcfqspi, qwr);
197			mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
198			if (rxbuf) {
199				mcfqspi_wr_qar(mcfqspi,
200					       MCFQSPI_QAR_RXBUF + offset);
201				for (i = 0; i < 8; ++i)
202					*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
203			}
204			n = min(count, 8u);
205			if (txbuf) {
206				mcfqspi_wr_qar(mcfqspi,
207					       MCFQSPI_QAR_TXBUF + offset);
208				for (i = 0; i < n; ++i)
209					mcfqspi_wr_qdr(mcfqspi, *txbuf++);
210			}
211			qwr = (offset ? 0x808 : 0) + ((n - 1) << 8);
212			offset ^= 8;
213			count -= n;
214		} while (count);
215		wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
216		mcfqspi_wr_qwr(mcfqspi, qwr);
217		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
218		if (rxbuf) {
219			mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_RXBUF + offset);
220			for (i = 0; i < 8; ++i)
221				*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
222			offset ^= 8;
223		}
224	} else {
225		mcfqspi_wr_qwr(mcfqspi, (n - 1) << 8);
226		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
227	}
228	wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
229	if (rxbuf) {
230		mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_RXBUF + offset);
231		for (i = 0; i < n; ++i)
232			*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
233	}
234}
235
236static void mcfqspi_transfer_msg16(struct mcfqspi *mcfqspi, unsigned count,
237				   const u16 *txbuf, u16 *rxbuf)
238{
239	unsigned i, n, offset = 0;
240
241	n = min(count, 16u);
242
243	mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_CMDBUF);
244	for (i = 0; i < n; ++i)
245		mcfqspi_wr_qdr(mcfqspi, MCFQSPI_QCR_BITSE);
246
247	mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_TXBUF);
248	if (txbuf)
249		for (i = 0; i < n; ++i)
250			mcfqspi_wr_qdr(mcfqspi, *txbuf++);
251	else
252		for (i = 0; i < count; ++i)
253			mcfqspi_wr_qdr(mcfqspi, 0);
254
255	count -= n;
256	if (count) {
257		u16 qwr = 0xf08;
258		mcfqspi_wr_qwr(mcfqspi, 0x700);
259		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
260
261		do {
262			wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
263			mcfqspi_wr_qwr(mcfqspi, qwr);
264			mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
265			if (rxbuf) {
266				mcfqspi_wr_qar(mcfqspi,
267					       MCFQSPI_QAR_RXBUF + offset);
268				for (i = 0; i < 8; ++i)
269					*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
270			}
271			n = min(count, 8u);
272			if (txbuf) {
273				mcfqspi_wr_qar(mcfqspi,
274					       MCFQSPI_QAR_TXBUF + offset);
275				for (i = 0; i < n; ++i)
276					mcfqspi_wr_qdr(mcfqspi, *txbuf++);
277			}
278			qwr = (offset ? 0x808 : 0x000) + ((n - 1) << 8);
279			offset ^= 8;
280			count -= n;
281		} while (count);
282		wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
283		mcfqspi_wr_qwr(mcfqspi, qwr);
284		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
285		if (rxbuf) {
286			mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_RXBUF + offset);
287			for (i = 0; i < 8; ++i)
288				*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
289			offset ^= 8;
290		}
291	} else {
292		mcfqspi_wr_qwr(mcfqspi, (n - 1) << 8);
293		mcfqspi_wr_qdlyr(mcfqspi, MCFQSPI_QDLYR_SPE);
294	}
295	wait_event(mcfqspi->waitq, !mcfqspi_qdlyr_spe(mcfqspi));
296	if (rxbuf) {
297		mcfqspi_wr_qar(mcfqspi, MCFQSPI_QAR_RXBUF + offset);
298		for (i = 0; i < n; ++i)
299			*rxbuf++ = mcfqspi_rd_qdr(mcfqspi);
300	}
301}
302
303static int mcfqspi_transfer_one_message(struct spi_master *master,
304					 struct spi_message *msg)
305{
306	struct mcfqspi *mcfqspi = spi_master_get_devdata(master);
307	struct spi_device *spi = msg->spi;
308	struct spi_transfer *t;
309	int status = 0;
310
311	list_for_each_entry(t, &msg->transfers, transfer_list) {
312		bool cs_high = spi->mode & SPI_CS_HIGH;
313		u16 qmr = MCFQSPI_QMR_MSTR;
314
315		if (t->bits_per_word)
316			qmr |= t->bits_per_word << 10;
317		else
318			qmr |= spi->bits_per_word << 10;
319		if (spi->mode & SPI_CPHA)
320			qmr |= MCFQSPI_QMR_CPHA;
321		if (spi->mode & SPI_CPOL)
322			qmr |= MCFQSPI_QMR_CPOL;
323		if (t->speed_hz)
324			qmr |= mcfqspi_qmr_baud(t->speed_hz);
325		else
326			qmr |= mcfqspi_qmr_baud(spi->max_speed_hz);
327		mcfqspi_wr_qmr(mcfqspi, qmr);
328
329		mcfqspi_cs_select(mcfqspi, spi->chip_select, cs_high);
330
331		mcfqspi_wr_qir(mcfqspi, MCFQSPI_QIR_SPIFE);
332		if ((t->bits_per_word ? t->bits_per_word :
333					spi->bits_per_word) == 8)
334			mcfqspi_transfer_msg8(mcfqspi, t->len, t->tx_buf,
335					t->rx_buf);
336		else
337			mcfqspi_transfer_msg16(mcfqspi, t->len / 2, t->tx_buf,
338					t->rx_buf);
339		mcfqspi_wr_qir(mcfqspi, 0);
340
341		if (t->delay_usecs)
342			udelay(t->delay_usecs);
343		if (t->cs_change) {
344			if (!list_is_last(&t->transfer_list, &msg->transfers))
345				mcfqspi_cs_deselect(mcfqspi, spi->chip_select,
346						cs_high);
347		} else {
348			if (list_is_last(&t->transfer_list, &msg->transfers))
349				mcfqspi_cs_deselect(mcfqspi, spi->chip_select,
350						cs_high);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
351		}
352		msg->actual_length += t->len;
 
 
 
353	}
354	msg->status = status;
355	spi_finalize_current_message(master);
356
357	return status;
358
359}
360
361static int mcfqspi_prepare_transfer_hw(struct spi_master *master)
362{
363	struct mcfqspi *mcfqspi = spi_master_get_devdata(master);
 
 
364
365	pm_runtime_get_sync(mcfqspi->dev);
366
367	return 0;
368}
369
370static int mcfqspi_unprepare_transfer_hw(struct spi_master *master)
371{
372	struct mcfqspi *mcfqspi = spi_master_get_devdata(master);
 
 
 
 
 
 
 
 
 
 
 
 
 
373
374	pm_runtime_put_sync(mcfqspi->dev);
 
 
 
375
376	return 0;
 
 
 
377}
378
379static int mcfqspi_setup(struct spi_device *spi)
380{
381	if ((spi->bits_per_word < 8) || (spi->bits_per_word > 16)) {
382		dev_dbg(&spi->dev, "%d bits per word is not supported\n",
383			spi->bits_per_word);
384		return -EINVAL;
385	}
386	if (spi->chip_select >= spi->master->num_chipselect) {
387		dev_dbg(&spi->dev, "%d chip select is out of range\n",
388			spi->chip_select);
389		return -EINVAL;
390	}
391
392	mcfqspi_cs_deselect(spi_master_get_devdata(spi->master),
393			    spi->chip_select, spi->mode & SPI_CS_HIGH);
394
395	dev_dbg(&spi->dev,
396			"bits per word %d, chip select %d, speed %d KHz\n",
397			spi->bits_per_word, spi->chip_select,
398			(MCFQSPI_BUSCLK / mcfqspi_qmr_baud(spi->max_speed_hz))
399			/ 1000);
400
401	return 0;
402}
403
404static int __devinit mcfqspi_probe(struct platform_device *pdev)
405{
406	struct spi_master *master;
407	struct mcfqspi *mcfqspi;
408	struct resource *res;
409	struct mcfqspi_platform_data *pdata;
410	int status;
411
412	master = spi_alloc_master(&pdev->dev, sizeof(*mcfqspi));
413	if (master == NULL) {
414		dev_dbg(&pdev->dev, "spi_alloc_master failed\n");
415		return -ENOMEM;
416	}
417
418	mcfqspi = spi_master_get_devdata(master);
419
420	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
421	if (!res) {
422		dev_dbg(&pdev->dev, "platform_get_resource failed\n");
423		status = -ENXIO;
424		goto fail0;
425	}
426
427	if (!request_mem_region(res->start, resource_size(res), pdev->name)) {
428		dev_dbg(&pdev->dev, "request_mem_region failed\n");
429		status = -EBUSY;
430		goto fail0;
431	}
432
433	mcfqspi->iobase = ioremap(res->start, resource_size(res));
434	if (!mcfqspi->iobase) {
435		dev_dbg(&pdev->dev, "ioremap failed\n");
436		status = -ENOMEM;
437		goto fail1;
438	}
439
440	mcfqspi->irq = platform_get_irq(pdev, 0);
441	if (mcfqspi->irq < 0) {
442		dev_dbg(&pdev->dev, "platform_get_irq failed\n");
443		status = -ENXIO;
444		goto fail2;
445	}
446
447	status = request_irq(mcfqspi->irq, mcfqspi_irq_handler, 0,
448			     pdev->name, mcfqspi);
449	if (status) {
450		dev_dbg(&pdev->dev, "request_irq failed\n");
451		goto fail2;
452	}
453
454	mcfqspi->clk = clk_get(&pdev->dev, "qspi_clk");
455	if (IS_ERR(mcfqspi->clk)) {
456		dev_dbg(&pdev->dev, "clk_get failed\n");
457		status = PTR_ERR(mcfqspi->clk);
458		goto fail3;
459	}
460	clk_enable(mcfqspi->clk);
461
 
 
 
 
 
 
 
 
 
 
 
462	pdata = pdev->dev.platform_data;
463	if (!pdata) {
464		dev_dbg(&pdev->dev, "platform data is missing\n");
465		goto fail4;
466	}
467	master->bus_num = pdata->bus_num;
468	master->num_chipselect = pdata->num_chipselect;
469
470	mcfqspi->cs_control = pdata->cs_control;
471	status = mcfqspi_cs_setup(mcfqspi);
472	if (status) {
473		dev_dbg(&pdev->dev, "error initializing cs_control\n");
474		goto fail4;
475	}
476
477	init_waitqueue_head(&mcfqspi->waitq);
478	mcfqspi->dev = &pdev->dev;
479
480	master->mode_bits = SPI_CS_HIGH | SPI_CPOL | SPI_CPHA;
481	master->setup = mcfqspi_setup;
482	master->transfer_one_message = mcfqspi_transfer_one_message;
483	master->prepare_transfer_hardware = mcfqspi_prepare_transfer_hw;
484	master->unprepare_transfer_hardware = mcfqspi_unprepare_transfer_hw;
485
486	platform_set_drvdata(pdev, master);
487
488	status = spi_register_master(master);
489	if (status) {
490		dev_dbg(&pdev->dev, "spi_register_master failed\n");
491		goto fail5;
492	}
493	pm_runtime_enable(mcfqspi->dev);
494
495	dev_info(&pdev->dev, "Coldfire QSPI bus driver\n");
496
497	return 0;
498
 
 
499fail5:
500	mcfqspi_cs_teardown(mcfqspi);
501fail4:
502	clk_disable(mcfqspi->clk);
503	clk_put(mcfqspi->clk);
504fail3:
505	free_irq(mcfqspi->irq, mcfqspi);
506fail2:
507	iounmap(mcfqspi->iobase);
508fail1:
509	release_mem_region(res->start, resource_size(res));
510fail0:
511	spi_master_put(master);
512
513	dev_dbg(&pdev->dev, "Coldfire QSPI probe failed\n");
514
515	return status;
516}
517
518static int __devexit mcfqspi_remove(struct platform_device *pdev)
519{
520	struct spi_master *master = platform_get_drvdata(pdev);
521	struct mcfqspi *mcfqspi = spi_master_get_devdata(master);
522	struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
523
524	pm_runtime_disable(mcfqspi->dev);
525	/* disable the hardware (set the baud rate to 0) */
526	mcfqspi_wr_qmr(mcfqspi, MCFQSPI_QMR_MSTR);
527
528	platform_set_drvdata(pdev, NULL);
529	mcfqspi_cs_teardown(mcfqspi);
 
530	clk_disable(mcfqspi->clk);
531	clk_put(mcfqspi->clk);
532	free_irq(mcfqspi->irq, mcfqspi);
533	iounmap(mcfqspi->iobase);
534	release_mem_region(res->start, resource_size(res));
535	spi_unregister_master(master);
536	spi_master_put(master);
537
538	return 0;
539}
540
541#ifdef CONFIG_PM_SLEEP
 
542static int mcfqspi_suspend(struct device *dev)
543{
544	struct spi_master *master = spi_master_get(dev_get_drvdata(dev));
545	struct mcfqspi *mcfqspi = spi_master_get_devdata(master);
546
547	spi_master_suspend(master);
548
549	clk_disable(mcfqspi->clk);
550
551	return 0;
552}
553
554static int mcfqspi_resume(struct device *dev)
555{
556	struct spi_master *master = spi_master_get(dev_get_drvdata(dev));
557	struct mcfqspi *mcfqspi = spi_master_get_devdata(master);
558
559	spi_master_resume(master);
560
561	clk_enable(mcfqspi->clk);
562
563	return 0;
564}
565#endif
566
567#ifdef CONFIG_PM_RUNTIME
568static int mcfqspi_runtime_suspend(struct device *dev)
569{
570	struct mcfqspi *mcfqspi = platform_get_drvdata(to_platform_device(dev));
571
572	clk_disable(mcfqspi->clk);
573
574	return 0;
575}
576
577static int mcfqspi_runtime_resume(struct device *dev)
578{
579	struct mcfqspi *mcfqspi = platform_get_drvdata(to_platform_device(dev));
580
581	clk_enable(mcfqspi->clk);
582
583	return 0;
584}
585#endif
586
587static const struct dev_pm_ops mcfqspi_pm = {
588	SET_SYSTEM_SLEEP_PM_OPS(mcfqspi_suspend, mcfqspi_resume)
589	SET_RUNTIME_PM_OPS(mcfqspi_runtime_suspend, mcfqspi_runtime_resume,
590			NULL)
591};
592
593static struct platform_driver mcfqspi_driver = {
594	.driver.name	= DRIVER_NAME,
595	.driver.owner	= THIS_MODULE,
596	.driver.pm	= &mcfqspi_pm,
597	.probe		= mcfqspi_probe,
598	.remove		= __devexit_p(mcfqspi_remove),
599};
600module_platform_driver(mcfqspi_driver);
 
 
 
 
 
 
 
 
 
 
 
601
602MODULE_AUTHOR("Steven King <sfking@fdwdc.com>");
603MODULE_DESCRIPTION("Coldfire QSPI Controller Driver");
604MODULE_LICENSE("GPL");
605MODULE_ALIAS("platform:" DRIVER_NAME);