Linux Audio

Check our new training course

Loading...
v6.2
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * OMAP7xx SPI 100k controller driver
  4 * Author: Fabrice Crohas <fcrohas@gmail.com>
  5 * from original omap1_mcspi driver
  6 *
  7 * Copyright (C) 2005, 2006 Nokia Corporation
  8 * Author:      Samuel Ortiz <samuel.ortiz@nokia.com> and
  9 *              Juha Yrjola <juha.yrjola@nokia.com>
 
 
 
 
 
 
 
 
 
 
 10 */
 11#include <linux/kernel.h>
 12#include <linux/init.h>
 13#include <linux/interrupt.h>
 14#include <linux/module.h>
 15#include <linux/device.h>
 16#include <linux/delay.h>
 17#include <linux/platform_device.h>
 18#include <linux/pm_runtime.h>
 19#include <linux/err.h>
 20#include <linux/clk.h>
 21#include <linux/io.h>
 
 22#include <linux/slab.h>
 23
 24#include <linux/spi/spi.h>
 25
 26#define OMAP1_SPI100K_MAX_FREQ          48000000
 27
 28#define ICR_SPITAS      (OMAP7XX_ICR_BASE + 0x12)
 29
 30#define SPI_SETUP1      0x00
 31#define SPI_SETUP2      0x02
 32#define SPI_CTRL        0x04
 33#define SPI_STATUS      0x06
 34#define SPI_TX_LSB      0x08
 35#define SPI_TX_MSB      0x0a
 36#define SPI_RX_LSB      0x0c
 37#define SPI_RX_MSB      0x0e
 38
 39#define SPI_SETUP1_INT_READ_ENABLE      (1UL << 5)
 40#define SPI_SETUP1_INT_WRITE_ENABLE     (1UL << 4)
 41#define SPI_SETUP1_CLOCK_DIVISOR(x)     ((x) << 1)
 42#define SPI_SETUP1_CLOCK_ENABLE         (1UL << 0)
 43
 44#define SPI_SETUP2_ACTIVE_EDGE_FALLING  (0UL << 0)
 45#define SPI_SETUP2_ACTIVE_EDGE_RISING   (1UL << 0)
 46#define SPI_SETUP2_NEGATIVE_LEVEL       (0UL << 5)
 47#define SPI_SETUP2_POSITIVE_LEVEL       (1UL << 5)
 48#define SPI_SETUP2_LEVEL_TRIGGER        (0UL << 10)
 49#define SPI_SETUP2_EDGE_TRIGGER         (1UL << 10)
 50
 51#define SPI_CTRL_SEN(x)                 ((x) << 7)
 52#define SPI_CTRL_WORD_SIZE(x)           (((x) - 1) << 2)
 53#define SPI_CTRL_WR                     (1UL << 1)
 54#define SPI_CTRL_RD                     (1UL << 0)
 55
 56#define SPI_STATUS_WE                   (1UL << 1)
 57#define SPI_STATUS_RD                   (1UL << 0)
 58
 59/* use PIO for small transfers, avoiding DMA setup/teardown overhead and
 60 * cache operations; better heuristics consider wordsize and bitrate.
 61 */
 62#define DMA_MIN_BYTES                   8
 63
 64#define SPI_RUNNING	0
 65#define SPI_SHUTDOWN	1
 66
 67struct omap1_spi100k {
 68	struct clk              *ick;
 69	struct clk              *fck;
 70
 71	/* Virtual base address of the controller */
 72	void __iomem            *base;
 73};
 74
 75struct omap1_spi100k_cs {
 76	void __iomem            *base;
 77	int                     word_len;
 78};
 79
 80static void spi100k_enable_clock(struct spi_master *master)
 81{
 82	unsigned int val;
 83	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
 84
 85	/* enable SPI */
 86	val = readw(spi100k->base + SPI_SETUP1);
 87	val |= SPI_SETUP1_CLOCK_ENABLE;
 88	writew(val, spi100k->base + SPI_SETUP1);
 89}
 90
 91static void spi100k_disable_clock(struct spi_master *master)
 92{
 93	unsigned int val;
 94	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
 95
 96	/* disable SPI */
 97	val = readw(spi100k->base + SPI_SETUP1);
 98	val &= ~SPI_SETUP1_CLOCK_ENABLE;
 99	writew(val, spi100k->base + SPI_SETUP1);
100}
101
102static void spi100k_write_data(struct spi_master *master, int len, int data)
103{
104	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
105
106	/* write 16-bit word, shifting 8-bit data if necessary */
107	if (len <= 8) {
108		data <<= 8;
109		len = 16;
110	}
111
112	spi100k_enable_clock(master);
113	writew(data, spi100k->base + SPI_TX_MSB);
114
115	writew(SPI_CTRL_SEN(0) |
116	       SPI_CTRL_WORD_SIZE(len) |
117	       SPI_CTRL_WR,
118	       spi100k->base + SPI_CTRL);
119
120	/* Wait for bit ack send change */
121	while ((readw(spi100k->base + SPI_STATUS) & SPI_STATUS_WE) != SPI_STATUS_WE)
122		;
123	udelay(1000);
124
125	spi100k_disable_clock(master);
126}
127
128static int spi100k_read_data(struct spi_master *master, int len)
129{
130	int dataL;
131	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
132
133	/* Always do at least 16 bits */
134	if (len <= 8)
135		len = 16;
136
137	spi100k_enable_clock(master);
138	writew(SPI_CTRL_SEN(0) |
139	       SPI_CTRL_WORD_SIZE(len) |
140	       SPI_CTRL_RD,
141	       spi100k->base + SPI_CTRL);
142
143	while ((readw(spi100k->base + SPI_STATUS) & SPI_STATUS_RD) != SPI_STATUS_RD)
144		;
145	udelay(1000);
146
147	dataL = readw(spi100k->base + SPI_RX_LSB);
148	readw(spi100k->base + SPI_RX_MSB);
149	spi100k_disable_clock(master);
150
151	return dataL;
152}
153
154static void spi100k_open(struct spi_master *master)
155{
156	/* get control of SPI */
157	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
158
159	writew(SPI_SETUP1_INT_READ_ENABLE |
160	       SPI_SETUP1_INT_WRITE_ENABLE |
161	       SPI_SETUP1_CLOCK_DIVISOR(0), spi100k->base + SPI_SETUP1);
162
163	/* configure clock and interrupts */
164	writew(SPI_SETUP2_ACTIVE_EDGE_FALLING |
165	       SPI_SETUP2_NEGATIVE_LEVEL |
166	       SPI_SETUP2_LEVEL_TRIGGER, spi100k->base + SPI_SETUP2);
167}
168
169static void omap1_spi100k_force_cs(struct omap1_spi100k *spi100k, int enable)
170{
171	if (enable)
172		writew(0x05fc, spi100k->base + SPI_CTRL);
173	else
174		writew(0x05fd, spi100k->base + SPI_CTRL);
175}
176
177static unsigned
178omap1_spi100k_txrx_pio(struct spi_device *spi, struct spi_transfer *xfer)
179{
180	struct omap1_spi100k_cs *cs = spi->controller_state;
181	unsigned int            count, c;
182	int                     word_len;
183
184	count = xfer->len;
185	c = count;
186	word_len = cs->word_len;
187
188	if (word_len <= 8) {
189		u8              *rx;
190		const u8        *tx;
191
192		rx = xfer->rx_buf;
193		tx = xfer->tx_buf;
194		do {
195			c -= 1;
196			if (xfer->tx_buf != NULL)
197				spi100k_write_data(spi->master, word_len, *tx++);
198			if (xfer->rx_buf != NULL)
199				*rx++ = spi100k_read_data(spi->master, word_len);
200		} while (c);
201	} else if (word_len <= 16) {
202		u16             *rx;
203		const u16       *tx;
204
205		rx = xfer->rx_buf;
206		tx = xfer->tx_buf;
207		do {
208			c -= 2;
209			if (xfer->tx_buf != NULL)
210				spi100k_write_data(spi->master, word_len, *tx++);
211			if (xfer->rx_buf != NULL)
212				*rx++ = spi100k_read_data(spi->master, word_len);
213		} while (c);
214	} else if (word_len <= 32) {
215		u32             *rx;
216		const u32       *tx;
217
218		rx = xfer->rx_buf;
219		tx = xfer->tx_buf;
220		do {
221			c -= 4;
222			if (xfer->tx_buf != NULL)
223				spi100k_write_data(spi->master, word_len, *tx);
224			if (xfer->rx_buf != NULL)
225				*rx = spi100k_read_data(spi->master, word_len);
226		} while (c);
227	}
228	return count - c;
229}
230
231/* called only when no transfer is active to this device */
232static int omap1_spi100k_setup_transfer(struct spi_device *spi,
233		struct spi_transfer *t)
234{
235	struct omap1_spi100k *spi100k = spi_master_get_devdata(spi->master);
236	struct omap1_spi100k_cs *cs = spi->controller_state;
237	u8 word_len;
238
239	if (t != NULL)
240		word_len = t->bits_per_word;
241	else
242		word_len = spi->bits_per_word;
243
244	if (word_len > 32)
245		return -EINVAL;
246	cs->word_len = word_len;
247
248	/* SPI init before transfer */
249	writew(0x3e, spi100k->base + SPI_SETUP1);
250	writew(0x00, spi100k->base + SPI_STATUS);
251	writew(0x3e, spi100k->base + SPI_CTRL);
252
253	return 0;
254}
255
256/* the spi->mode bits understood by this driver: */
257#define MODEBITS (SPI_CPOL | SPI_CPHA | SPI_CS_HIGH)
258
259static int omap1_spi100k_setup(struct spi_device *spi)
260{
261	int                     ret;
262	struct omap1_spi100k    *spi100k;
263	struct omap1_spi100k_cs *cs = spi->controller_state;
264
265	spi100k = spi_master_get_devdata(spi->master);
266
267	if (!cs) {
268		cs = devm_kzalloc(&spi->dev, sizeof(*cs), GFP_KERNEL);
269		if (!cs)
270			return -ENOMEM;
271		cs->base = spi100k->base + spi->chip_select * 0x14;
272		spi->controller_state = cs;
273	}
274
275	spi100k_open(spi->master);
276
277	clk_prepare_enable(spi100k->ick);
278	clk_prepare_enable(spi100k->fck);
279
280	ret = omap1_spi100k_setup_transfer(spi, NULL);
281
282	clk_disable_unprepare(spi100k->ick);
283	clk_disable_unprepare(spi100k->fck);
284
285	return ret;
286}
287
288static int omap1_spi100k_transfer_one_message(struct spi_master *master,
289					      struct spi_message *m)
290{
291	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
292	struct spi_device *spi = m->spi;
293	struct spi_transfer *t = NULL;
294	int cs_active = 0;
295	int status = 0;
296
297	list_for_each_entry(t, &m->transfers, transfer_list) {
298		if (t->tx_buf == NULL && t->rx_buf == NULL && t->len) {
 
299			break;
300		}
301		status = omap1_spi100k_setup_transfer(spi, t);
302		if (status < 0)
303			break;
304
305		if (!cs_active) {
306			omap1_spi100k_force_cs(spi100k, 1);
307			cs_active = 1;
308		}
309
310		if (t->len) {
311			unsigned count;
312
313			count = omap1_spi100k_txrx_pio(spi, t);
314			m->actual_length += count;
315
316			if (count != t->len) {
 
317				break;
318			}
319		}
320
321		spi_transfer_delay_exec(t);
 
322
323		/* ignore the "leave it on after last xfer" hint */
324
325		if (t->cs_change) {
326			omap1_spi100k_force_cs(spi100k, 0);
327			cs_active = 0;
328		}
329	}
330
331	status = omap1_spi100k_setup_transfer(spi, NULL);
332
333	if (cs_active)
334		omap1_spi100k_force_cs(spi100k, 0);
335
336	m->status = status;
337
338	spi_finalize_current_message(master);
339
340	return status;
341}
342
343static int omap1_spi100k_probe(struct platform_device *pdev)
344{
345	struct spi_master       *master;
346	struct omap1_spi100k    *spi100k;
347	int                     status = 0;
348
349	if (!pdev->id)
350		return -EINVAL;
351
352	master = spi_alloc_master(&pdev->dev, sizeof(*spi100k));
353	if (master == NULL) {
354		dev_dbg(&pdev->dev, "master allocation failed\n");
355		return -ENOMEM;
356	}
357
358	if (pdev->id != -1)
359		master->bus_num = pdev->id;
360
361	master->setup = omap1_spi100k_setup;
362	master->transfer_one_message = omap1_spi100k_transfer_one_message;
363	master->num_chipselect = 2;
364	master->mode_bits = MODEBITS;
365	master->bits_per_word_mask = SPI_BPW_RANGE_MASK(4, 32);
366	master->min_speed_hz = OMAP1_SPI100K_MAX_FREQ/(1<<16);
367	master->max_speed_hz = OMAP1_SPI100K_MAX_FREQ;
368	master->auto_runtime_pm = true;
369
370	spi100k = spi_master_get_devdata(master);
371
372	/*
373	 * The memory region base address is taken as the platform_data.
374	 * You should allocate this with ioremap() before initializing
375	 * the SPI.
376	 */
377	spi100k->base = (void __iomem *)dev_get_platdata(&pdev->dev);
378
379	spi100k->ick = devm_clk_get(&pdev->dev, "ick");
380	if (IS_ERR(spi100k->ick)) {
381		dev_dbg(&pdev->dev, "can't get spi100k_ick\n");
382		status = PTR_ERR(spi100k->ick);
383		goto err;
384	}
385
386	spi100k->fck = devm_clk_get(&pdev->dev, "fck");
387	if (IS_ERR(spi100k->fck)) {
388		dev_dbg(&pdev->dev, "can't get spi100k_fck\n");
389		status = PTR_ERR(spi100k->fck);
390		goto err;
391	}
392
393	status = clk_prepare_enable(spi100k->ick);
394	if (status != 0) {
395		dev_err(&pdev->dev, "failed to enable ick: %d\n", status);
396		goto err;
397	}
398
399	status = clk_prepare_enable(spi100k->fck);
400	if (status != 0) {
401		dev_err(&pdev->dev, "failed to enable fck: %d\n", status);
402		goto err_ick;
403	}
404
405	pm_runtime_enable(&pdev->dev);
406	pm_runtime_set_active(&pdev->dev);
407
408	status = devm_spi_register_master(&pdev->dev, master);
409	if (status < 0)
410		goto err_fck;
411
412	return status;
413
414err_fck:
415	pm_runtime_disable(&pdev->dev);
416	clk_disable_unprepare(spi100k->fck);
417err_ick:
418	clk_disable_unprepare(spi100k->ick);
419err:
420	spi_master_put(master);
421	return status;
422}
423
424static int omap1_spi100k_remove(struct platform_device *pdev)
425{
426	struct spi_master *master = platform_get_drvdata(pdev);
427	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
428
429	pm_runtime_disable(&pdev->dev);
430
431	clk_disable_unprepare(spi100k->fck);
432	clk_disable_unprepare(spi100k->ick);
433
434	return 0;
435}
436
437#ifdef CONFIG_PM
438static int omap1_spi100k_runtime_suspend(struct device *dev)
439{
440	struct spi_master *master = dev_get_drvdata(dev);
441	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
442
443	clk_disable_unprepare(spi100k->ick);
444	clk_disable_unprepare(spi100k->fck);
445
446	return 0;
447}
448
449static int omap1_spi100k_runtime_resume(struct device *dev)
450{
451	struct spi_master *master = dev_get_drvdata(dev);
452	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
453	int ret;
454
455	ret = clk_prepare_enable(spi100k->ick);
456	if (ret != 0) {
457		dev_err(dev, "Failed to enable ick: %d\n", ret);
458		return ret;
459	}
460
461	ret = clk_prepare_enable(spi100k->fck);
462	if (ret != 0) {
463		dev_err(dev, "Failed to enable fck: %d\n", ret);
464		clk_disable_unprepare(spi100k->ick);
465		return ret;
466	}
467
468	return 0;
469}
470#endif
471
472static const struct dev_pm_ops omap1_spi100k_pm = {
473	SET_RUNTIME_PM_OPS(omap1_spi100k_runtime_suspend,
474			   omap1_spi100k_runtime_resume, NULL)
475};
476
477static struct platform_driver omap1_spi100k_driver = {
478	.driver = {
479		.name		= "omap1_spi100k",
480		.pm		= &omap1_spi100k_pm,
481	},
482	.probe		= omap1_spi100k_probe,
483	.remove		= omap1_spi100k_remove,
484};
485
486module_platform_driver(omap1_spi100k_driver);
487
488MODULE_DESCRIPTION("OMAP7xx SPI 100k controller driver");
489MODULE_AUTHOR("Fabrice Crohas <fcrohas@gmail.com>");
490MODULE_LICENSE("GPL");
v4.17
 
  1/*
  2 * OMAP7xx SPI 100k controller driver
  3 * Author: Fabrice Crohas <fcrohas@gmail.com>
  4 * from original omap1_mcspi driver
  5 *
  6 * Copyright (C) 2005, 2006 Nokia Corporation
  7 * Author:      Samuel Ortiz <samuel.ortiz@nokia.com> and
  8 *              Juha Yrj�l� <juha.yrjola@nokia.com>
  9 *
 10 * This program is free software; you can redistribute it and/or modify
 11 * it under the terms of the GNU General Public License as published by
 12 * the Free Software Foundation; either version 2 of the License, or
 13 * (at your option) any later version.
 14 *
 15 * This program is distributed in the hope that it will be useful,
 16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 18 * GNU General Public License for more details.
 19 */
 20#include <linux/kernel.h>
 21#include <linux/init.h>
 22#include <linux/interrupt.h>
 23#include <linux/module.h>
 24#include <linux/device.h>
 25#include <linux/delay.h>
 26#include <linux/platform_device.h>
 27#include <linux/pm_runtime.h>
 28#include <linux/err.h>
 29#include <linux/clk.h>
 30#include <linux/io.h>
 31#include <linux/gpio.h>
 32#include <linux/slab.h>
 33
 34#include <linux/spi/spi.h>
 35
 36#define OMAP1_SPI100K_MAX_FREQ          48000000
 37
 38#define ICR_SPITAS      (OMAP7XX_ICR_BASE + 0x12)
 39
 40#define SPI_SETUP1      0x00
 41#define SPI_SETUP2      0x02
 42#define SPI_CTRL        0x04
 43#define SPI_STATUS      0x06
 44#define SPI_TX_LSB      0x08
 45#define SPI_TX_MSB      0x0a
 46#define SPI_RX_LSB      0x0c
 47#define SPI_RX_MSB      0x0e
 48
 49#define SPI_SETUP1_INT_READ_ENABLE      (1UL << 5)
 50#define SPI_SETUP1_INT_WRITE_ENABLE     (1UL << 4)
 51#define SPI_SETUP1_CLOCK_DIVISOR(x)     ((x) << 1)
 52#define SPI_SETUP1_CLOCK_ENABLE         (1UL << 0)
 53
 54#define SPI_SETUP2_ACTIVE_EDGE_FALLING  (0UL << 0)
 55#define SPI_SETUP2_ACTIVE_EDGE_RISING   (1UL << 0)
 56#define SPI_SETUP2_NEGATIVE_LEVEL       (0UL << 5)
 57#define SPI_SETUP2_POSITIVE_LEVEL       (1UL << 5)
 58#define SPI_SETUP2_LEVEL_TRIGGER        (0UL << 10)
 59#define SPI_SETUP2_EDGE_TRIGGER         (1UL << 10)
 60
 61#define SPI_CTRL_SEN(x)                 ((x) << 7)
 62#define SPI_CTRL_WORD_SIZE(x)           (((x) - 1) << 2)
 63#define SPI_CTRL_WR                     (1UL << 1)
 64#define SPI_CTRL_RD                     (1UL << 0)
 65
 66#define SPI_STATUS_WE                   (1UL << 1)
 67#define SPI_STATUS_RD                   (1UL << 0)
 68
 69/* use PIO for small transfers, avoiding DMA setup/teardown overhead and
 70 * cache operations; better heuristics consider wordsize and bitrate.
 71 */
 72#define DMA_MIN_BYTES                   8
 73
 74#define SPI_RUNNING	0
 75#define SPI_SHUTDOWN	1
 76
 77struct omap1_spi100k {
 78	struct clk              *ick;
 79	struct clk              *fck;
 80
 81	/* Virtual base address of the controller */
 82	void __iomem            *base;
 83};
 84
 85struct omap1_spi100k_cs {
 86	void __iomem            *base;
 87	int                     word_len;
 88};
 89
 90static void spi100k_enable_clock(struct spi_master *master)
 91{
 92	unsigned int val;
 93	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
 94
 95	/* enable SPI */
 96	val = readw(spi100k->base + SPI_SETUP1);
 97	val |= SPI_SETUP1_CLOCK_ENABLE;
 98	writew(val, spi100k->base + SPI_SETUP1);
 99}
100
101static void spi100k_disable_clock(struct spi_master *master)
102{
103	unsigned int val;
104	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
105
106	/* disable SPI */
107	val = readw(spi100k->base + SPI_SETUP1);
108	val &= ~SPI_SETUP1_CLOCK_ENABLE;
109	writew(val, spi100k->base + SPI_SETUP1);
110}
111
112static void spi100k_write_data(struct spi_master *master, int len, int data)
113{
114	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
115
116	/* write 16-bit word, shifting 8-bit data if necessary */
117	if (len <= 8) {
118		data <<= 8;
119		len = 16;
120	}
121
122	spi100k_enable_clock(master);
123	writew(data , spi100k->base + SPI_TX_MSB);
124
125	writew(SPI_CTRL_SEN(0) |
126	       SPI_CTRL_WORD_SIZE(len) |
127	       SPI_CTRL_WR,
128	       spi100k->base + SPI_CTRL);
129
130	/* Wait for bit ack send change */
131	while ((readw(spi100k->base + SPI_STATUS) & SPI_STATUS_WE) != SPI_STATUS_WE)
132		;
133	udelay(1000);
134
135	spi100k_disable_clock(master);
136}
137
138static int spi100k_read_data(struct spi_master *master, int len)
139{
140	int dataH, dataL;
141	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
142
143	/* Always do at least 16 bits */
144	if (len <= 8)
145		len = 16;
146
147	spi100k_enable_clock(master);
148	writew(SPI_CTRL_SEN(0) |
149	       SPI_CTRL_WORD_SIZE(len) |
150	       SPI_CTRL_RD,
151	       spi100k->base + SPI_CTRL);
152
153	while ((readw(spi100k->base + SPI_STATUS) & SPI_STATUS_RD) != SPI_STATUS_RD)
154		;
155	udelay(1000);
156
157	dataL = readw(spi100k->base + SPI_RX_LSB);
158	dataH = readw(spi100k->base + SPI_RX_MSB);
159	spi100k_disable_clock(master);
160
161	return dataL;
162}
163
164static void spi100k_open(struct spi_master *master)
165{
166	/* get control of SPI */
167	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
168
169	writew(SPI_SETUP1_INT_READ_ENABLE |
170	       SPI_SETUP1_INT_WRITE_ENABLE |
171	       SPI_SETUP1_CLOCK_DIVISOR(0), spi100k->base + SPI_SETUP1);
172
173	/* configure clock and interrupts */
174	writew(SPI_SETUP2_ACTIVE_EDGE_FALLING |
175	       SPI_SETUP2_NEGATIVE_LEVEL |
176	       SPI_SETUP2_LEVEL_TRIGGER, spi100k->base + SPI_SETUP2);
177}
178
179static void omap1_spi100k_force_cs(struct omap1_spi100k *spi100k, int enable)
180{
181	if (enable)
182		writew(0x05fc, spi100k->base + SPI_CTRL);
183	else
184		writew(0x05fd, spi100k->base + SPI_CTRL);
185}
186
187static unsigned
188omap1_spi100k_txrx_pio(struct spi_device *spi, struct spi_transfer *xfer)
189{
190	struct omap1_spi100k_cs *cs = spi->controller_state;
191	unsigned int            count, c;
192	int                     word_len;
193
194	count = xfer->len;
195	c = count;
196	word_len = cs->word_len;
197
198	if (word_len <= 8) {
199		u8              *rx;
200		const u8        *tx;
201
202		rx = xfer->rx_buf;
203		tx = xfer->tx_buf;
204		do {
205			c -= 1;
206			if (xfer->tx_buf != NULL)
207				spi100k_write_data(spi->master, word_len, *tx++);
208			if (xfer->rx_buf != NULL)
209				*rx++ = spi100k_read_data(spi->master, word_len);
210		} while (c);
211	} else if (word_len <= 16) {
212		u16             *rx;
213		const u16       *tx;
214
215		rx = xfer->rx_buf;
216		tx = xfer->tx_buf;
217		do {
218			c -= 2;
219			if (xfer->tx_buf != NULL)
220				spi100k_write_data(spi->master, word_len, *tx++);
221			if (xfer->rx_buf != NULL)
222				*rx++ = spi100k_read_data(spi->master, word_len);
223		} while (c);
224	} else if (word_len <= 32) {
225		u32             *rx;
226		const u32       *tx;
227
228		rx = xfer->rx_buf;
229		tx = xfer->tx_buf;
230		do {
231			c -= 4;
232			if (xfer->tx_buf != NULL)
233				spi100k_write_data(spi->master, word_len, *tx);
234			if (xfer->rx_buf != NULL)
235				*rx = spi100k_read_data(spi->master, word_len);
236		} while (c);
237	}
238	return count - c;
239}
240
241/* called only when no transfer is active to this device */
242static int omap1_spi100k_setup_transfer(struct spi_device *spi,
243		struct spi_transfer *t)
244{
245	struct omap1_spi100k *spi100k = spi_master_get_devdata(spi->master);
246	struct omap1_spi100k_cs *cs = spi->controller_state;
247	u8 word_len;
248
249	if (t != NULL)
250		word_len = t->bits_per_word;
251	else
252		word_len = spi->bits_per_word;
253
254	if (spi->bits_per_word > 32)
255		return -EINVAL;
256	cs->word_len = word_len;
257
258	/* SPI init before transfer */
259	writew(0x3e , spi100k->base + SPI_SETUP1);
260	writew(0x00 , spi100k->base + SPI_STATUS);
261	writew(0x3e , spi100k->base + SPI_CTRL);
262
263	return 0;
264}
265
266/* the spi->mode bits understood by this driver: */
267#define MODEBITS (SPI_CPOL | SPI_CPHA | SPI_CS_HIGH)
268
269static int omap1_spi100k_setup(struct spi_device *spi)
270{
271	int                     ret;
272	struct omap1_spi100k    *spi100k;
273	struct omap1_spi100k_cs *cs = spi->controller_state;
274
275	spi100k = spi_master_get_devdata(spi->master);
276
277	if (!cs) {
278		cs = devm_kzalloc(&spi->dev, sizeof(*cs), GFP_KERNEL);
279		if (!cs)
280			return -ENOMEM;
281		cs->base = spi100k->base + spi->chip_select * 0x14;
282		spi->controller_state = cs;
283	}
284
285	spi100k_open(spi->master);
286
287	clk_prepare_enable(spi100k->ick);
288	clk_prepare_enable(spi100k->fck);
289
290	ret = omap1_spi100k_setup_transfer(spi, NULL);
291
292	clk_disable_unprepare(spi100k->ick);
293	clk_disable_unprepare(spi100k->fck);
294
295	return ret;
296}
297
298static int omap1_spi100k_transfer_one_message(struct spi_master *master,
299					      struct spi_message *m)
300{
301	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
302	struct spi_device *spi = m->spi;
303	struct spi_transfer *t = NULL;
304	int cs_active = 0;
305	int status = 0;
306
307	list_for_each_entry(t, &m->transfers, transfer_list) {
308		if (t->tx_buf == NULL && t->rx_buf == NULL && t->len) {
309			status = -EINVAL;
310			break;
311		}
312		status = omap1_spi100k_setup_transfer(spi, t);
313		if (status < 0)
314			break;
315
316		if (!cs_active) {
317			omap1_spi100k_force_cs(spi100k, 1);
318			cs_active = 1;
319		}
320
321		if (t->len) {
322			unsigned count;
323
324			count = omap1_spi100k_txrx_pio(spi, t);
325			m->actual_length += count;
326
327			if (count != t->len) {
328				status = -EIO;
329				break;
330			}
331		}
332
333		if (t->delay_usecs)
334			udelay(t->delay_usecs);
335
336		/* ignore the "leave it on after last xfer" hint */
337
338		if (t->cs_change) {
339			omap1_spi100k_force_cs(spi100k, 0);
340			cs_active = 0;
341		}
342	}
343
344	status = omap1_spi100k_setup_transfer(spi, NULL);
345
346	if (cs_active)
347		omap1_spi100k_force_cs(spi100k, 0);
348
349	m->status = status;
350
351	spi_finalize_current_message(master);
352
353	return status;
354}
355
356static int omap1_spi100k_probe(struct platform_device *pdev)
357{
358	struct spi_master       *master;
359	struct omap1_spi100k    *spi100k;
360	int                     status = 0;
361
362	if (!pdev->id)
363		return -EINVAL;
364
365	master = spi_alloc_master(&pdev->dev, sizeof(*spi100k));
366	if (master == NULL) {
367		dev_dbg(&pdev->dev, "master allocation failed\n");
368		return -ENOMEM;
369	}
370
371	if (pdev->id != -1)
372		master->bus_num = pdev->id;
373
374	master->setup = omap1_spi100k_setup;
375	master->transfer_one_message = omap1_spi100k_transfer_one_message;
376	master->num_chipselect = 2;
377	master->mode_bits = MODEBITS;
378	master->bits_per_word_mask = SPI_BPW_RANGE_MASK(4, 32);
379	master->min_speed_hz = OMAP1_SPI100K_MAX_FREQ/(1<<16);
380	master->max_speed_hz = OMAP1_SPI100K_MAX_FREQ;
381	master->auto_runtime_pm = true;
382
383	spi100k = spi_master_get_devdata(master);
384
385	/*
386	 * The memory region base address is taken as the platform_data.
387	 * You should allocate this with ioremap() before initializing
388	 * the SPI.
389	 */
390	spi100k->base = (void __iomem *)dev_get_platdata(&pdev->dev);
391
392	spi100k->ick = devm_clk_get(&pdev->dev, "ick");
393	if (IS_ERR(spi100k->ick)) {
394		dev_dbg(&pdev->dev, "can't get spi100k_ick\n");
395		status = PTR_ERR(spi100k->ick);
396		goto err;
397	}
398
399	spi100k->fck = devm_clk_get(&pdev->dev, "fck");
400	if (IS_ERR(spi100k->fck)) {
401		dev_dbg(&pdev->dev, "can't get spi100k_fck\n");
402		status = PTR_ERR(spi100k->fck);
403		goto err;
404	}
405
406	status = clk_prepare_enable(spi100k->ick);
407	if (status != 0) {
408		dev_err(&pdev->dev, "failed to enable ick: %d\n", status);
409		goto err;
410	}
411
412	status = clk_prepare_enable(spi100k->fck);
413	if (status != 0) {
414		dev_err(&pdev->dev, "failed to enable fck: %d\n", status);
415		goto err_ick;
416	}
417
418	pm_runtime_enable(&pdev->dev);
419	pm_runtime_set_active(&pdev->dev);
420
421	status = devm_spi_register_master(&pdev->dev, master);
422	if (status < 0)
423		goto err_fck;
424
425	return status;
426
427err_fck:
 
428	clk_disable_unprepare(spi100k->fck);
429err_ick:
430	clk_disable_unprepare(spi100k->ick);
431err:
432	spi_master_put(master);
433	return status;
434}
435
436static int omap1_spi100k_remove(struct platform_device *pdev)
437{
438	struct spi_master *master = spi_master_get(platform_get_drvdata(pdev));
439	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
440
441	pm_runtime_disable(&pdev->dev);
442
443	clk_disable_unprepare(spi100k->fck);
444	clk_disable_unprepare(spi100k->ick);
445
446	return 0;
447}
448
449#ifdef CONFIG_PM
450static int omap1_spi100k_runtime_suspend(struct device *dev)
451{
452	struct spi_master *master = spi_master_get(dev_get_drvdata(dev));
453	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
454
455	clk_disable_unprepare(spi100k->ick);
456	clk_disable_unprepare(spi100k->fck);
457
458	return 0;
459}
460
461static int omap1_spi100k_runtime_resume(struct device *dev)
462{
463	struct spi_master *master = spi_master_get(dev_get_drvdata(dev));
464	struct omap1_spi100k *spi100k = spi_master_get_devdata(master);
465	int ret;
466
467	ret = clk_prepare_enable(spi100k->ick);
468	if (ret != 0) {
469		dev_err(dev, "Failed to enable ick: %d\n", ret);
470		return ret;
471	}
472
473	ret = clk_prepare_enable(spi100k->fck);
474	if (ret != 0) {
475		dev_err(dev, "Failed to enable fck: %d\n", ret);
476		clk_disable_unprepare(spi100k->ick);
477		return ret;
478	}
479
480	return 0;
481}
482#endif
483
484static const struct dev_pm_ops omap1_spi100k_pm = {
485	SET_RUNTIME_PM_OPS(omap1_spi100k_runtime_suspend,
486			   omap1_spi100k_runtime_resume, NULL)
487};
488
489static struct platform_driver omap1_spi100k_driver = {
490	.driver = {
491		.name		= "omap1_spi100k",
492		.pm		= &omap1_spi100k_pm,
493	},
494	.probe		= omap1_spi100k_probe,
495	.remove		= omap1_spi100k_remove,
496};
497
498module_platform_driver(omap1_spi100k_driver);
499
500MODULE_DESCRIPTION("OMAP7xx SPI 100k controller driver");
501MODULE_AUTHOR("Fabrice Crohas <fcrohas@gmail.com>");
502MODULE_LICENSE("GPL");