Linux Audio

Check our new training course

Embedded Linux training

Mar 31-Apr 8, 2025
Register
Loading...
v3.5.6
  1/*
  2 * SH SPI bus driver
  3 *
  4 * Copyright (C) 2011  Renesas Solutions Corp.
  5 *
  6 * Based on pxa2xx_spi.c:
  7 * Copyright (C) 2005 Stephen Street / StreetFire Sound Labs
  8 *
  9 * This program is free software; you can redistribute it and/or modify
 10 * it under the terms of the GNU General Public License as published by
 11 * the Free Software Foundation; version 2 of the License.
 12 *
 13 * This program is distributed in the hope that it will be useful,
 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 16 * GNU General Public License for more details.
 17 *
 18 * You should have received a copy of the GNU General Public License
 19 * along with this program; if not, write to the Free Software
 20 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 21 *
 22 */
 23
 24#include <linux/module.h>
 25#include <linux/kernel.h>
 26#include <linux/sched.h>
 27#include <linux/errno.h>
 28#include <linux/timer.h>
 29#include <linux/delay.h>
 30#include <linux/list.h>
 31#include <linux/workqueue.h>
 32#include <linux/interrupt.h>
 33#include <linux/platform_device.h>
 34#include <linux/io.h>
 35#include <linux/spi/spi.h>
 36
 37#define SPI_SH_TBR		0x00
 38#define SPI_SH_RBR		0x00
 39#define SPI_SH_CR1		0x08
 40#define SPI_SH_CR2		0x10
 41#define SPI_SH_CR3		0x18
 42#define SPI_SH_CR4		0x20
 43#define SPI_SH_CR5		0x28
 44
 45/* CR1 */
 46#define SPI_SH_TBE		0x80
 47#define SPI_SH_TBF		0x40
 48#define SPI_SH_RBE		0x20
 49#define SPI_SH_RBF		0x10
 50#define SPI_SH_PFONRD		0x08
 51#define SPI_SH_SSDB		0x04
 52#define SPI_SH_SSD		0x02
 53#define SPI_SH_SSA		0x01
 54
 55/* CR2 */
 56#define SPI_SH_RSTF		0x80
 57#define SPI_SH_LOOPBK		0x40
 58#define SPI_SH_CPOL		0x20
 59#define SPI_SH_CPHA		0x10
 60#define SPI_SH_L1M0		0x08
 61
 62/* CR3 */
 63#define SPI_SH_MAX_BYTE		0xFF
 64
 65/* CR4 */
 66#define SPI_SH_TBEI		0x80
 67#define SPI_SH_TBFI		0x40
 68#define SPI_SH_RBEI		0x20
 69#define SPI_SH_RBFI		0x10
 70#define SPI_SH_WPABRT		0x04
 71#define SPI_SH_SSS		0x01
 72
 73/* CR8 */
 74#define SPI_SH_P1L0		0x80
 75#define SPI_SH_PP1L0		0x40
 76#define SPI_SH_MUXI		0x20
 77#define SPI_SH_MUXIRQ		0x10
 78
 79#define SPI_SH_FIFO_SIZE	32
 80#define SPI_SH_SEND_TIMEOUT	(3 * HZ)
 81#define SPI_SH_RECEIVE_TIMEOUT	(HZ >> 3)
 82
 83#undef DEBUG
 84
 85struct spi_sh_data {
 86	void __iomem *addr;
 87	int irq;
 88	struct spi_master *master;
 89	struct list_head queue;
 90	struct workqueue_struct *workqueue;
 91	struct work_struct ws;
 92	unsigned long cr1;
 93	wait_queue_head_t wait;
 94	spinlock_t lock;
 95	int width;
 96};
 97
 98static void spi_sh_write(struct spi_sh_data *ss, unsigned long data,
 99			     unsigned long offset)
100{
101	if (ss->width == 8)
102		iowrite8(data, ss->addr + (offset >> 2));
103	else if (ss->width == 32)
104		iowrite32(data, ss->addr + offset);
105}
106
107static unsigned long spi_sh_read(struct spi_sh_data *ss, unsigned long offset)
108{
109	if (ss->width == 8)
110		return ioread8(ss->addr + (offset >> 2));
111	else if (ss->width == 32)
112		return ioread32(ss->addr + offset);
113	else
114		return 0;
115}
116
117static void spi_sh_set_bit(struct spi_sh_data *ss, unsigned long val,
118				unsigned long offset)
119{
120	unsigned long tmp;
121
122	tmp = spi_sh_read(ss, offset);
123	tmp |= val;
124	spi_sh_write(ss, tmp, offset);
125}
126
127static void spi_sh_clear_bit(struct spi_sh_data *ss, unsigned long val,
128				unsigned long offset)
129{
130	unsigned long tmp;
131
132	tmp = spi_sh_read(ss, offset);
133	tmp &= ~val;
134	spi_sh_write(ss, tmp, offset);
135}
136
137static void clear_fifo(struct spi_sh_data *ss)
138{
139	spi_sh_set_bit(ss, SPI_SH_RSTF, SPI_SH_CR2);
140	spi_sh_clear_bit(ss, SPI_SH_RSTF, SPI_SH_CR2);
141}
142
143static int spi_sh_wait_receive_buffer(struct spi_sh_data *ss)
144{
145	int timeout = 100000;
146
147	while (spi_sh_read(ss, SPI_SH_CR1) & SPI_SH_RBE) {
148		udelay(10);
149		if (timeout-- < 0)
150			return -ETIMEDOUT;
151	}
152	return 0;
153}
154
155static int spi_sh_wait_write_buffer_empty(struct spi_sh_data *ss)
156{
157	int timeout = 100000;
158
159	while (!(spi_sh_read(ss, SPI_SH_CR1) & SPI_SH_TBE)) {
160		udelay(10);
161		if (timeout-- < 0)
162			return -ETIMEDOUT;
163	}
164	return 0;
165}
166
167static int spi_sh_send(struct spi_sh_data *ss, struct spi_message *mesg,
168			struct spi_transfer *t)
169{
170	int i, retval = 0;
171	int remain = t->len;
172	int cur_len;
173	unsigned char *data;
174	unsigned long tmp;
175	long ret;
176
177	if (t->len)
178		spi_sh_set_bit(ss, SPI_SH_SSA, SPI_SH_CR1);
179
180	data = (unsigned char *)t->tx_buf;
181	while (remain > 0) {
182		cur_len = min(SPI_SH_FIFO_SIZE, remain);
183		for (i = 0; i < cur_len &&
184				!(spi_sh_read(ss, SPI_SH_CR4) &
185							SPI_SH_WPABRT) &&
186				!(spi_sh_read(ss, SPI_SH_CR1) & SPI_SH_TBF);
187				i++)
188			spi_sh_write(ss, (unsigned long)data[i], SPI_SH_TBR);
189
190		if (spi_sh_read(ss, SPI_SH_CR4) & SPI_SH_WPABRT) {
191			/* Abort SPI operation */
192			spi_sh_set_bit(ss, SPI_SH_WPABRT, SPI_SH_CR4);
193			retval = -EIO;
194			break;
195		}
196
197		cur_len = i;
198
199		remain -= cur_len;
200		data += cur_len;
201
202		if (remain > 0) {
203			ss->cr1 &= ~SPI_SH_TBE;
204			spi_sh_set_bit(ss, SPI_SH_TBE, SPI_SH_CR4);
205			ret = wait_event_interruptible_timeout(ss->wait,
206						 ss->cr1 & SPI_SH_TBE,
207						 SPI_SH_SEND_TIMEOUT);
208			if (ret == 0 && !(ss->cr1 & SPI_SH_TBE)) {
209				printk(KERN_ERR "%s: timeout\n", __func__);
210				return -ETIMEDOUT;
211			}
212		}
213	}
214
215	if (list_is_last(&t->transfer_list, &mesg->transfers)) {
216		tmp = spi_sh_read(ss, SPI_SH_CR1);
217		tmp = tmp & ~(SPI_SH_SSD | SPI_SH_SSDB);
218		spi_sh_write(ss, tmp, SPI_SH_CR1);
219		spi_sh_set_bit(ss, SPI_SH_SSA, SPI_SH_CR1);
220
221		ss->cr1 &= ~SPI_SH_TBE;
222		spi_sh_set_bit(ss, SPI_SH_TBE, SPI_SH_CR4);
223		ret = wait_event_interruptible_timeout(ss->wait,
224					 ss->cr1 & SPI_SH_TBE,
225					 SPI_SH_SEND_TIMEOUT);
226		if (ret == 0 && (ss->cr1 & SPI_SH_TBE)) {
227			printk(KERN_ERR "%s: timeout\n", __func__);
228			return -ETIMEDOUT;
229		}
230	}
231
232	return retval;
233}
234
235static int spi_sh_receive(struct spi_sh_data *ss, struct spi_message *mesg,
236			  struct spi_transfer *t)
237{
238	int i;
239	int remain = t->len;
240	int cur_len;
241	unsigned char *data;
242	unsigned long tmp;
243	long ret;
244
245	if (t->len > SPI_SH_MAX_BYTE)
246		spi_sh_write(ss, SPI_SH_MAX_BYTE, SPI_SH_CR3);
247	else
248		spi_sh_write(ss, t->len, SPI_SH_CR3);
249
250	tmp = spi_sh_read(ss, SPI_SH_CR1);
251	tmp = tmp & ~(SPI_SH_SSD | SPI_SH_SSDB);
252	spi_sh_write(ss, tmp, SPI_SH_CR1);
253	spi_sh_set_bit(ss, SPI_SH_SSA, SPI_SH_CR1);
254
255	spi_sh_wait_write_buffer_empty(ss);
256
257	data = (unsigned char *)t->rx_buf;
258	while (remain > 0) {
259		if (remain >= SPI_SH_FIFO_SIZE) {
260			ss->cr1 &= ~SPI_SH_RBF;
261			spi_sh_set_bit(ss, SPI_SH_RBF, SPI_SH_CR4);
262			ret = wait_event_interruptible_timeout(ss->wait,
263						 ss->cr1 & SPI_SH_RBF,
264						 SPI_SH_RECEIVE_TIMEOUT);
265			if (ret == 0 &&
266			    spi_sh_read(ss, SPI_SH_CR1) & SPI_SH_RBE) {
267				printk(KERN_ERR "%s: timeout\n", __func__);
268				return -ETIMEDOUT;
269			}
270		}
271
272		cur_len = min(SPI_SH_FIFO_SIZE, remain);
273		for (i = 0; i < cur_len; i++) {
274			if (spi_sh_wait_receive_buffer(ss))
275				break;
276			data[i] = (unsigned char)spi_sh_read(ss, SPI_SH_RBR);
277		}
278
279		remain -= cur_len;
280		data += cur_len;
281	}
282
283	/* deassert CS when SPI is receiving. */
284	if (t->len > SPI_SH_MAX_BYTE) {
285		clear_fifo(ss);
286		spi_sh_write(ss, 1, SPI_SH_CR3);
287	} else {
288		spi_sh_write(ss, 0, SPI_SH_CR3);
289	}
290
291	return 0;
292}
293
294static void spi_sh_work(struct work_struct *work)
295{
296	struct spi_sh_data *ss = container_of(work, struct spi_sh_data, ws);
297	struct spi_message *mesg;
298	struct spi_transfer *t;
299	unsigned long flags;
300	int ret;
301
302	pr_debug("%s: enter\n", __func__);
303
304	spin_lock_irqsave(&ss->lock, flags);
305	while (!list_empty(&ss->queue)) {
306		mesg = list_entry(ss->queue.next, struct spi_message, queue);
307		list_del_init(&mesg->queue);
308
309		spin_unlock_irqrestore(&ss->lock, flags);
310		list_for_each_entry(t, &mesg->transfers, transfer_list) {
311			pr_debug("tx_buf = %p, rx_buf = %p\n",
312					t->tx_buf, t->rx_buf);
313			pr_debug("len = %d, delay_usecs = %d\n",
314					t->len, t->delay_usecs);
315
316			if (t->tx_buf) {
317				ret = spi_sh_send(ss, mesg, t);
318				if (ret < 0)
319					goto error;
320			}
321			if (t->rx_buf) {
322				ret = spi_sh_receive(ss, mesg, t);
323				if (ret < 0)
324					goto error;
325			}
326			mesg->actual_length += t->len;
327		}
328		spin_lock_irqsave(&ss->lock, flags);
329
330		mesg->status = 0;
331		mesg->complete(mesg->context);
 
332	}
333
334	clear_fifo(ss);
335	spi_sh_set_bit(ss, SPI_SH_SSD, SPI_SH_CR1);
336	udelay(100);
337
338	spi_sh_clear_bit(ss, SPI_SH_SSA | SPI_SH_SSDB | SPI_SH_SSD,
339			 SPI_SH_CR1);
340
341	clear_fifo(ss);
342
343	spin_unlock_irqrestore(&ss->lock, flags);
344
345	return;
346
347 error:
348	mesg->status = ret;
349	mesg->complete(mesg->context);
 
350
351	spi_sh_clear_bit(ss, SPI_SH_SSA | SPI_SH_SSDB | SPI_SH_SSD,
352			 SPI_SH_CR1);
353	clear_fifo(ss);
354
355}
356
357static int spi_sh_setup(struct spi_device *spi)
358{
359	struct spi_sh_data *ss = spi_master_get_devdata(spi->master);
360
361	if (!spi->bits_per_word)
362		spi->bits_per_word = 8;
363
364	pr_debug("%s: enter\n", __func__);
365
366	spi_sh_write(ss, 0xfe, SPI_SH_CR1);	/* SPI sycle stop */
367	spi_sh_write(ss, 0x00, SPI_SH_CR1);	/* CR1 init */
368	spi_sh_write(ss, 0x00, SPI_SH_CR3);	/* CR3 init */
369
370	clear_fifo(ss);
371
372	/* 1/8 clock */
373	spi_sh_write(ss, spi_sh_read(ss, SPI_SH_CR2) | 0x07, SPI_SH_CR2);
374	udelay(10);
375
376	return 0;
377}
378
379static int spi_sh_transfer(struct spi_device *spi, struct spi_message *mesg)
380{
381	struct spi_sh_data *ss = spi_master_get_devdata(spi->master);
382	unsigned long flags;
383
384	pr_debug("%s: enter\n", __func__);
385	pr_debug("\tmode = %02x\n", spi->mode);
386
387	spin_lock_irqsave(&ss->lock, flags);
388
389	mesg->actual_length = 0;
390	mesg->status = -EINPROGRESS;
391
392	spi_sh_clear_bit(ss, SPI_SH_SSA, SPI_SH_CR1);
393
394	list_add_tail(&mesg->queue, &ss->queue);
395	queue_work(ss->workqueue, &ss->ws);
396
397	spin_unlock_irqrestore(&ss->lock, flags);
398
399	return 0;
400}
401
402static void spi_sh_cleanup(struct spi_device *spi)
403{
404	struct spi_sh_data *ss = spi_master_get_devdata(spi->master);
405
406	pr_debug("%s: enter\n", __func__);
407
408	spi_sh_clear_bit(ss, SPI_SH_SSA | SPI_SH_SSDB | SPI_SH_SSD,
409			 SPI_SH_CR1);
410}
411
412static irqreturn_t spi_sh_irq(int irq, void *_ss)
413{
414	struct spi_sh_data *ss = (struct spi_sh_data *)_ss;
415	unsigned long cr1;
416
417	cr1 = spi_sh_read(ss, SPI_SH_CR1);
418	if (cr1 & SPI_SH_TBE)
419		ss->cr1 |= SPI_SH_TBE;
420	if (cr1 & SPI_SH_TBF)
421		ss->cr1 |= SPI_SH_TBF;
422	if (cr1 & SPI_SH_RBE)
423		ss->cr1 |= SPI_SH_RBE;
424	if (cr1 & SPI_SH_RBF)
425		ss->cr1 |= SPI_SH_RBF;
426
427	if (ss->cr1) {
428		spi_sh_clear_bit(ss, ss->cr1, SPI_SH_CR4);
429		wake_up(&ss->wait);
430	}
431
432	return IRQ_HANDLED;
433}
434
435static int __devexit spi_sh_remove(struct platform_device *pdev)
436{
437	struct spi_sh_data *ss = dev_get_drvdata(&pdev->dev);
438
439	spi_unregister_master(ss->master);
440	destroy_workqueue(ss->workqueue);
441	free_irq(ss->irq, ss);
442	iounmap(ss->addr);
443
444	return 0;
445}
446
447static int __devinit spi_sh_probe(struct platform_device *pdev)
448{
449	struct resource *res;
450	struct spi_master *master;
451	struct spi_sh_data *ss;
452	int ret, irq;
453
454	/* get base addr */
455	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
456	if (unlikely(res == NULL)) {
457		dev_err(&pdev->dev, "invalid resource\n");
458		return -EINVAL;
459	}
460
461	irq = platform_get_irq(pdev, 0);
462	if (irq < 0) {
463		dev_err(&pdev->dev, "platform_get_irq error\n");
464		return -ENODEV;
465	}
466
467	master = spi_alloc_master(&pdev->dev, sizeof(struct spi_sh_data));
468	if (master == NULL) {
469		dev_err(&pdev->dev, "spi_alloc_master error.\n");
470		return -ENOMEM;
471	}
472
473	ss = spi_master_get_devdata(master);
474	dev_set_drvdata(&pdev->dev, ss);
475
476	switch (res->flags & IORESOURCE_MEM_TYPE_MASK) {
477	case IORESOURCE_MEM_8BIT:
478		ss->width = 8;
479		break;
480	case IORESOURCE_MEM_32BIT:
481		ss->width = 32;
482		break;
483	default:
484		dev_err(&pdev->dev, "No support width\n");
485		ret = -ENODEV;
486		goto error1;
487	}
488	ss->irq = irq;
489	ss->master = master;
490	ss->addr = ioremap(res->start, resource_size(res));
491	if (ss->addr == NULL) {
492		dev_err(&pdev->dev, "ioremap error.\n");
493		ret = -ENOMEM;
494		goto error1;
495	}
496	INIT_LIST_HEAD(&ss->queue);
497	spin_lock_init(&ss->lock);
498	INIT_WORK(&ss->ws, spi_sh_work);
499	init_waitqueue_head(&ss->wait);
500	ss->workqueue = create_singlethread_workqueue(
501					dev_name(master->dev.parent));
502	if (ss->workqueue == NULL) {
503		dev_err(&pdev->dev, "create workqueue error\n");
504		ret = -EBUSY;
505		goto error2;
506	}
507
508	ret = request_irq(irq, spi_sh_irq, 0, "spi_sh", ss);
509	if (ret < 0) {
510		dev_err(&pdev->dev, "request_irq error\n");
511		goto error3;
512	}
513
514	master->num_chipselect = 2;
515	master->bus_num = pdev->id;
516	master->setup = spi_sh_setup;
517	master->transfer = spi_sh_transfer;
518	master->cleanup = spi_sh_cleanup;
519
520	ret = spi_register_master(master);
521	if (ret < 0) {
522		printk(KERN_ERR "spi_register_master error.\n");
523		goto error4;
524	}
525
526	return 0;
527
528 error4:
529	free_irq(irq, ss);
530 error3:
531	destroy_workqueue(ss->workqueue);
532 error2:
533	iounmap(ss->addr);
534 error1:
535	spi_master_put(master);
536
537	return ret;
538}
539
540static struct platform_driver spi_sh_driver = {
541	.probe = spi_sh_probe,
542	.remove = __devexit_p(spi_sh_remove),
543	.driver = {
544		.name = "sh_spi",
545		.owner = THIS_MODULE,
546	},
547};
548module_platform_driver(spi_sh_driver);
549
550MODULE_DESCRIPTION("SH SPI bus driver");
551MODULE_LICENSE("GPL");
552MODULE_AUTHOR("Yoshihiro Shimoda");
553MODULE_ALIAS("platform:sh_spi");
v3.15
  1/*
  2 * SH SPI bus driver
  3 *
  4 * Copyright (C) 2011  Renesas Solutions Corp.
  5 *
  6 * Based on pxa2xx_spi.c:
  7 * Copyright (C) 2005 Stephen Street / StreetFire Sound Labs
  8 *
  9 * This program is free software; you can redistribute it and/or modify
 10 * it under the terms of the GNU General Public License as published by
 11 * the Free Software Foundation; version 2 of the License.
 12 *
 13 * This program is distributed in the hope that it will be useful,
 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 16 * GNU General Public License for more details.
 17 *
 18 * You should have received a copy of the GNU General Public License
 19 * along with this program; if not, write to the Free Software
 20 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 21 *
 22 */
 23
 24#include <linux/module.h>
 25#include <linux/kernel.h>
 26#include <linux/sched.h>
 27#include <linux/errno.h>
 28#include <linux/timer.h>
 29#include <linux/delay.h>
 30#include <linux/list.h>
 31#include <linux/workqueue.h>
 32#include <linux/interrupt.h>
 33#include <linux/platform_device.h>
 34#include <linux/io.h>
 35#include <linux/spi/spi.h>
 36
 37#define SPI_SH_TBR		0x00
 38#define SPI_SH_RBR		0x00
 39#define SPI_SH_CR1		0x08
 40#define SPI_SH_CR2		0x10
 41#define SPI_SH_CR3		0x18
 42#define SPI_SH_CR4		0x20
 43#define SPI_SH_CR5		0x28
 44
 45/* CR1 */
 46#define SPI_SH_TBE		0x80
 47#define SPI_SH_TBF		0x40
 48#define SPI_SH_RBE		0x20
 49#define SPI_SH_RBF		0x10
 50#define SPI_SH_PFONRD		0x08
 51#define SPI_SH_SSDB		0x04
 52#define SPI_SH_SSD		0x02
 53#define SPI_SH_SSA		0x01
 54
 55/* CR2 */
 56#define SPI_SH_RSTF		0x80
 57#define SPI_SH_LOOPBK		0x40
 58#define SPI_SH_CPOL		0x20
 59#define SPI_SH_CPHA		0x10
 60#define SPI_SH_L1M0		0x08
 61
 62/* CR3 */
 63#define SPI_SH_MAX_BYTE		0xFF
 64
 65/* CR4 */
 66#define SPI_SH_TBEI		0x80
 67#define SPI_SH_TBFI		0x40
 68#define SPI_SH_RBEI		0x20
 69#define SPI_SH_RBFI		0x10
 70#define SPI_SH_WPABRT		0x04
 71#define SPI_SH_SSS		0x01
 72
 73/* CR8 */
 74#define SPI_SH_P1L0		0x80
 75#define SPI_SH_PP1L0		0x40
 76#define SPI_SH_MUXI		0x20
 77#define SPI_SH_MUXIRQ		0x10
 78
 79#define SPI_SH_FIFO_SIZE	32
 80#define SPI_SH_SEND_TIMEOUT	(3 * HZ)
 81#define SPI_SH_RECEIVE_TIMEOUT	(HZ >> 3)
 82
 83#undef DEBUG
 84
 85struct spi_sh_data {
 86	void __iomem *addr;
 87	int irq;
 88	struct spi_master *master;
 89	struct list_head queue;
 90	struct workqueue_struct *workqueue;
 91	struct work_struct ws;
 92	unsigned long cr1;
 93	wait_queue_head_t wait;
 94	spinlock_t lock;
 95	int width;
 96};
 97
 98static void spi_sh_write(struct spi_sh_data *ss, unsigned long data,
 99			     unsigned long offset)
100{
101	if (ss->width == 8)
102		iowrite8(data, ss->addr + (offset >> 2));
103	else if (ss->width == 32)
104		iowrite32(data, ss->addr + offset);
105}
106
107static unsigned long spi_sh_read(struct spi_sh_data *ss, unsigned long offset)
108{
109	if (ss->width == 8)
110		return ioread8(ss->addr + (offset >> 2));
111	else if (ss->width == 32)
112		return ioread32(ss->addr + offset);
113	else
114		return 0;
115}
116
117static void spi_sh_set_bit(struct spi_sh_data *ss, unsigned long val,
118				unsigned long offset)
119{
120	unsigned long tmp;
121
122	tmp = spi_sh_read(ss, offset);
123	tmp |= val;
124	spi_sh_write(ss, tmp, offset);
125}
126
127static void spi_sh_clear_bit(struct spi_sh_data *ss, unsigned long val,
128				unsigned long offset)
129{
130	unsigned long tmp;
131
132	tmp = spi_sh_read(ss, offset);
133	tmp &= ~val;
134	spi_sh_write(ss, tmp, offset);
135}
136
137static void clear_fifo(struct spi_sh_data *ss)
138{
139	spi_sh_set_bit(ss, SPI_SH_RSTF, SPI_SH_CR2);
140	spi_sh_clear_bit(ss, SPI_SH_RSTF, SPI_SH_CR2);
141}
142
143static int spi_sh_wait_receive_buffer(struct spi_sh_data *ss)
144{
145	int timeout = 100000;
146
147	while (spi_sh_read(ss, SPI_SH_CR1) & SPI_SH_RBE) {
148		udelay(10);
149		if (timeout-- < 0)
150			return -ETIMEDOUT;
151	}
152	return 0;
153}
154
155static int spi_sh_wait_write_buffer_empty(struct spi_sh_data *ss)
156{
157	int timeout = 100000;
158
159	while (!(spi_sh_read(ss, SPI_SH_CR1) & SPI_SH_TBE)) {
160		udelay(10);
161		if (timeout-- < 0)
162			return -ETIMEDOUT;
163	}
164	return 0;
165}
166
167static int spi_sh_send(struct spi_sh_data *ss, struct spi_message *mesg,
168			struct spi_transfer *t)
169{
170	int i, retval = 0;
171	int remain = t->len;
172	int cur_len;
173	unsigned char *data;
 
174	long ret;
175
176	if (t->len)
177		spi_sh_set_bit(ss, SPI_SH_SSA, SPI_SH_CR1);
178
179	data = (unsigned char *)t->tx_buf;
180	while (remain > 0) {
181		cur_len = min(SPI_SH_FIFO_SIZE, remain);
182		for (i = 0; i < cur_len &&
183				!(spi_sh_read(ss, SPI_SH_CR4) &
184							SPI_SH_WPABRT) &&
185				!(spi_sh_read(ss, SPI_SH_CR1) & SPI_SH_TBF);
186				i++)
187			spi_sh_write(ss, (unsigned long)data[i], SPI_SH_TBR);
188
189		if (spi_sh_read(ss, SPI_SH_CR4) & SPI_SH_WPABRT) {
190			/* Abort SPI operation */
191			spi_sh_set_bit(ss, SPI_SH_WPABRT, SPI_SH_CR4);
192			retval = -EIO;
193			break;
194		}
195
196		cur_len = i;
197
198		remain -= cur_len;
199		data += cur_len;
200
201		if (remain > 0) {
202			ss->cr1 &= ~SPI_SH_TBE;
203			spi_sh_set_bit(ss, SPI_SH_TBE, SPI_SH_CR4);
204			ret = wait_event_interruptible_timeout(ss->wait,
205						 ss->cr1 & SPI_SH_TBE,
206						 SPI_SH_SEND_TIMEOUT);
207			if (ret == 0 && !(ss->cr1 & SPI_SH_TBE)) {
208				printk(KERN_ERR "%s: timeout\n", __func__);
209				return -ETIMEDOUT;
210			}
211		}
212	}
213
214	if (list_is_last(&t->transfer_list, &mesg->transfers)) {
215		spi_sh_clear_bit(ss, SPI_SH_SSD | SPI_SH_SSDB, SPI_SH_CR1);
 
 
216		spi_sh_set_bit(ss, SPI_SH_SSA, SPI_SH_CR1);
217
218		ss->cr1 &= ~SPI_SH_TBE;
219		spi_sh_set_bit(ss, SPI_SH_TBE, SPI_SH_CR4);
220		ret = wait_event_interruptible_timeout(ss->wait,
221					 ss->cr1 & SPI_SH_TBE,
222					 SPI_SH_SEND_TIMEOUT);
223		if (ret == 0 && (ss->cr1 & SPI_SH_TBE)) {
224			printk(KERN_ERR "%s: timeout\n", __func__);
225			return -ETIMEDOUT;
226		}
227	}
228
229	return retval;
230}
231
232static int spi_sh_receive(struct spi_sh_data *ss, struct spi_message *mesg,
233			  struct spi_transfer *t)
234{
235	int i;
236	int remain = t->len;
237	int cur_len;
238	unsigned char *data;
 
239	long ret;
240
241	if (t->len > SPI_SH_MAX_BYTE)
242		spi_sh_write(ss, SPI_SH_MAX_BYTE, SPI_SH_CR3);
243	else
244		spi_sh_write(ss, t->len, SPI_SH_CR3);
245
246	spi_sh_clear_bit(ss, SPI_SH_SSD | SPI_SH_SSDB, SPI_SH_CR1);
 
 
247	spi_sh_set_bit(ss, SPI_SH_SSA, SPI_SH_CR1);
248
249	spi_sh_wait_write_buffer_empty(ss);
250
251	data = (unsigned char *)t->rx_buf;
252	while (remain > 0) {
253		if (remain >= SPI_SH_FIFO_SIZE) {
254			ss->cr1 &= ~SPI_SH_RBF;
255			spi_sh_set_bit(ss, SPI_SH_RBF, SPI_SH_CR4);
256			ret = wait_event_interruptible_timeout(ss->wait,
257						 ss->cr1 & SPI_SH_RBF,
258						 SPI_SH_RECEIVE_TIMEOUT);
259			if (ret == 0 &&
260			    spi_sh_read(ss, SPI_SH_CR1) & SPI_SH_RBE) {
261				printk(KERN_ERR "%s: timeout\n", __func__);
262				return -ETIMEDOUT;
263			}
264		}
265
266		cur_len = min(SPI_SH_FIFO_SIZE, remain);
267		for (i = 0; i < cur_len; i++) {
268			if (spi_sh_wait_receive_buffer(ss))
269				break;
270			data[i] = (unsigned char)spi_sh_read(ss, SPI_SH_RBR);
271		}
272
273		remain -= cur_len;
274		data += cur_len;
275	}
276
277	/* deassert CS when SPI is receiving. */
278	if (t->len > SPI_SH_MAX_BYTE) {
279		clear_fifo(ss);
280		spi_sh_write(ss, 1, SPI_SH_CR3);
281	} else {
282		spi_sh_write(ss, 0, SPI_SH_CR3);
283	}
284
285	return 0;
286}
287
288static void spi_sh_work(struct work_struct *work)
289{
290	struct spi_sh_data *ss = container_of(work, struct spi_sh_data, ws);
291	struct spi_message *mesg;
292	struct spi_transfer *t;
293	unsigned long flags;
294	int ret;
295
296	pr_debug("%s: enter\n", __func__);
297
298	spin_lock_irqsave(&ss->lock, flags);
299	while (!list_empty(&ss->queue)) {
300		mesg = list_entry(ss->queue.next, struct spi_message, queue);
301		list_del_init(&mesg->queue);
302
303		spin_unlock_irqrestore(&ss->lock, flags);
304		list_for_each_entry(t, &mesg->transfers, transfer_list) {
305			pr_debug("tx_buf = %p, rx_buf = %p\n",
306					t->tx_buf, t->rx_buf);
307			pr_debug("len = %d, delay_usecs = %d\n",
308					t->len, t->delay_usecs);
309
310			if (t->tx_buf) {
311				ret = spi_sh_send(ss, mesg, t);
312				if (ret < 0)
313					goto error;
314			}
315			if (t->rx_buf) {
316				ret = spi_sh_receive(ss, mesg, t);
317				if (ret < 0)
318					goto error;
319			}
320			mesg->actual_length += t->len;
321		}
322		spin_lock_irqsave(&ss->lock, flags);
323
324		mesg->status = 0;
325		if (mesg->complete)
326			mesg->complete(mesg->context);
327	}
328
329	clear_fifo(ss);
330	spi_sh_set_bit(ss, SPI_SH_SSD, SPI_SH_CR1);
331	udelay(100);
332
333	spi_sh_clear_bit(ss, SPI_SH_SSA | SPI_SH_SSDB | SPI_SH_SSD,
334			 SPI_SH_CR1);
335
336	clear_fifo(ss);
337
338	spin_unlock_irqrestore(&ss->lock, flags);
339
340	return;
341
342 error:
343	mesg->status = ret;
344	if (mesg->complete)
345		mesg->complete(mesg->context);
346
347	spi_sh_clear_bit(ss, SPI_SH_SSA | SPI_SH_SSDB | SPI_SH_SSD,
348			 SPI_SH_CR1);
349	clear_fifo(ss);
350
351}
352
353static int spi_sh_setup(struct spi_device *spi)
354{
355	struct spi_sh_data *ss = spi_master_get_devdata(spi->master);
356
 
 
 
357	pr_debug("%s: enter\n", __func__);
358
359	spi_sh_write(ss, 0xfe, SPI_SH_CR1);	/* SPI sycle stop */
360	spi_sh_write(ss, 0x00, SPI_SH_CR1);	/* CR1 init */
361	spi_sh_write(ss, 0x00, SPI_SH_CR3);	/* CR3 init */
362
363	clear_fifo(ss);
364
365	/* 1/8 clock */
366	spi_sh_write(ss, spi_sh_read(ss, SPI_SH_CR2) | 0x07, SPI_SH_CR2);
367	udelay(10);
368
369	return 0;
370}
371
372static int spi_sh_transfer(struct spi_device *spi, struct spi_message *mesg)
373{
374	struct spi_sh_data *ss = spi_master_get_devdata(spi->master);
375	unsigned long flags;
376
377	pr_debug("%s: enter\n", __func__);
378	pr_debug("\tmode = %02x\n", spi->mode);
379
380	spin_lock_irqsave(&ss->lock, flags);
381
382	mesg->actual_length = 0;
383	mesg->status = -EINPROGRESS;
384
385	spi_sh_clear_bit(ss, SPI_SH_SSA, SPI_SH_CR1);
386
387	list_add_tail(&mesg->queue, &ss->queue);
388	queue_work(ss->workqueue, &ss->ws);
389
390	spin_unlock_irqrestore(&ss->lock, flags);
391
392	return 0;
393}
394
395static void spi_sh_cleanup(struct spi_device *spi)
396{
397	struct spi_sh_data *ss = spi_master_get_devdata(spi->master);
398
399	pr_debug("%s: enter\n", __func__);
400
401	spi_sh_clear_bit(ss, SPI_SH_SSA | SPI_SH_SSDB | SPI_SH_SSD,
402			 SPI_SH_CR1);
403}
404
405static irqreturn_t spi_sh_irq(int irq, void *_ss)
406{
407	struct spi_sh_data *ss = (struct spi_sh_data *)_ss;
408	unsigned long cr1;
409
410	cr1 = spi_sh_read(ss, SPI_SH_CR1);
411	if (cr1 & SPI_SH_TBE)
412		ss->cr1 |= SPI_SH_TBE;
413	if (cr1 & SPI_SH_TBF)
414		ss->cr1 |= SPI_SH_TBF;
415	if (cr1 & SPI_SH_RBE)
416		ss->cr1 |= SPI_SH_RBE;
417	if (cr1 & SPI_SH_RBF)
418		ss->cr1 |= SPI_SH_RBF;
419
420	if (ss->cr1) {
421		spi_sh_clear_bit(ss, ss->cr1, SPI_SH_CR4);
422		wake_up(&ss->wait);
423	}
424
425	return IRQ_HANDLED;
426}
427
428static int spi_sh_remove(struct platform_device *pdev)
429{
430	struct spi_sh_data *ss = platform_get_drvdata(pdev);
431
432	spi_unregister_master(ss->master);
433	destroy_workqueue(ss->workqueue);
434	free_irq(ss->irq, ss);
435	iounmap(ss->addr);
436
437	return 0;
438}
439
440static int spi_sh_probe(struct platform_device *pdev)
441{
442	struct resource *res;
443	struct spi_master *master;
444	struct spi_sh_data *ss;
445	int ret, irq;
446
447	/* get base addr */
448	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
449	if (unlikely(res == NULL)) {
450		dev_err(&pdev->dev, "invalid resource\n");
451		return -EINVAL;
452	}
453
454	irq = platform_get_irq(pdev, 0);
455	if (irq < 0) {
456		dev_err(&pdev->dev, "platform_get_irq error\n");
457		return -ENODEV;
458	}
459
460	master = spi_alloc_master(&pdev->dev, sizeof(struct spi_sh_data));
461	if (master == NULL) {
462		dev_err(&pdev->dev, "spi_alloc_master error.\n");
463		return -ENOMEM;
464	}
465
466	ss = spi_master_get_devdata(master);
467	platform_set_drvdata(pdev, ss);
468
469	switch (res->flags & IORESOURCE_MEM_TYPE_MASK) {
470	case IORESOURCE_MEM_8BIT:
471		ss->width = 8;
472		break;
473	case IORESOURCE_MEM_32BIT:
474		ss->width = 32;
475		break;
476	default:
477		dev_err(&pdev->dev, "No support width\n");
478		ret = -ENODEV;
479		goto error1;
480	}
481	ss->irq = irq;
482	ss->master = master;
483	ss->addr = ioremap(res->start, resource_size(res));
484	if (ss->addr == NULL) {
485		dev_err(&pdev->dev, "ioremap error.\n");
486		ret = -ENOMEM;
487		goto error1;
488	}
489	INIT_LIST_HEAD(&ss->queue);
490	spin_lock_init(&ss->lock);
491	INIT_WORK(&ss->ws, spi_sh_work);
492	init_waitqueue_head(&ss->wait);
493	ss->workqueue = create_singlethread_workqueue(
494					dev_name(master->dev.parent));
495	if (ss->workqueue == NULL) {
496		dev_err(&pdev->dev, "create workqueue error\n");
497		ret = -EBUSY;
498		goto error2;
499	}
500
501	ret = request_irq(irq, spi_sh_irq, 0, "spi_sh", ss);
502	if (ret < 0) {
503		dev_err(&pdev->dev, "request_irq error\n");
504		goto error3;
505	}
506
507	master->num_chipselect = 2;
508	master->bus_num = pdev->id;
509	master->setup = spi_sh_setup;
510	master->transfer = spi_sh_transfer;
511	master->cleanup = spi_sh_cleanup;
512
513	ret = spi_register_master(master);
514	if (ret < 0) {
515		printk(KERN_ERR "spi_register_master error.\n");
516		goto error4;
517	}
518
519	return 0;
520
521 error4:
522	free_irq(irq, ss);
523 error3:
524	destroy_workqueue(ss->workqueue);
525 error2:
526	iounmap(ss->addr);
527 error1:
528	spi_master_put(master);
529
530	return ret;
531}
532
533static struct platform_driver spi_sh_driver = {
534	.probe = spi_sh_probe,
535	.remove = spi_sh_remove,
536	.driver = {
537		.name = "sh_spi",
538		.owner = THIS_MODULE,
539	},
540};
541module_platform_driver(spi_sh_driver);
542
543MODULE_DESCRIPTION("SH SPI bus driver");
544MODULE_LICENSE("GPL");
545MODULE_AUTHOR("Yoshihiro Shimoda");
546MODULE_ALIAS("platform:sh_spi");