1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/module.h>
15#include <linux/init.h>
16#include <linux/interrupt.h>
17#include <linux/platform_device.h>
18#include <linux/spi/spi.h>
19#include <linux/spi/spi_bitbang.h>
20#include <linux/io.h>
21
22#include <syslib/virtex_devices.h>
23
24#define XILINX_SPI_NAME "xilinx_spi"
25
26
27
28
29#define XSPI_CR_OFFSET 0x62
30
31#define XSPI_CR_ENABLE 0x02
32#define XSPI_CR_MASTER_MODE 0x04
33#define XSPI_CR_CPOL 0x08
34#define XSPI_CR_CPHA 0x10
35#define XSPI_CR_MODE_MASK (XSPI_CR_CPHA | XSPI_CR_CPOL)
36#define XSPI_CR_TXFIFO_RESET 0x20
37#define XSPI_CR_RXFIFO_RESET 0x40
38#define XSPI_CR_MANUAL_SSELECT 0x80
39#define XSPI_CR_TRANS_INHIBIT 0x100
40
41#define XSPI_SR_OFFSET 0x67
42
43#define XSPI_SR_RX_EMPTY_MASK 0x01
44#define XSPI_SR_RX_FULL_MASK 0x02
45#define XSPI_SR_TX_EMPTY_MASK 0x04
46#define XSPI_SR_TX_FULL_MASK 0x08
47#define XSPI_SR_MODE_FAULT_MASK 0x10
48
49#define XSPI_TXD_OFFSET 0x6b
50#define XSPI_RXD_OFFSET 0x6f
51
52#define XSPI_SSR_OFFSET 0x70
53
54
55
56
57#define XIPIF_V123B_DGIER_OFFSET 0x1c
58#define XIPIF_V123B_GINTR_ENABLE 0x80000000
59
60#define XIPIF_V123B_IISR_OFFSET 0x20
61#define XIPIF_V123B_IIER_OFFSET 0x28
62
63#define XSPI_INTR_MODE_FAULT 0x01
64#define XSPI_INTR_SLAVE_MODE_FAULT 0x02
65
66#define XSPI_INTR_TX_EMPTY 0x04
67#define XSPI_INTR_TX_UNDERRUN 0x08
68#define XSPI_INTR_RX_FULL 0x10
69#define XSPI_INTR_RX_OVERRUN 0x20
70
71#define XIPIF_V123B_RESETR_OFFSET 0x40
72#define XIPIF_V123B_RESET_MASK 0x0a
73
74struct xilinx_spi {
75
76 struct spi_bitbang bitbang;
77 struct completion done;
78
79 void __iomem *regs;
80
81 u32 irq;
82
83 u32 speed_hz;
84
85 u8 *rx_ptr;
86 const u8 *tx_ptr;
87 int remaining_bytes;
88};
89
90static void xspi_init_hw(void __iomem *regs_base)
91{
92
93 out_be32(regs_base + XIPIF_V123B_RESETR_OFFSET,
94 XIPIF_V123B_RESET_MASK);
95
96 out_be32(regs_base + XIPIF_V123B_IIER_OFFSET, 0);
97
98 out_be32(regs_base + XIPIF_V123B_DGIER_OFFSET,
99 XIPIF_V123B_GINTR_ENABLE);
100
101 out_be32(regs_base + XSPI_SSR_OFFSET, 0xffff);
102
103
104 out_be16(regs_base + XSPI_CR_OFFSET,
105 XSPI_CR_TRANS_INHIBIT | XSPI_CR_MANUAL_SSELECT
106 | XSPI_CR_MASTER_MODE | XSPI_CR_ENABLE);
107}
108
109static void xilinx_spi_chipselect(struct spi_device *spi, int is_on)
110{
111 struct xilinx_spi *xspi = spi_master_get_devdata(spi->master);
112
113 if (is_on == BITBANG_CS_INACTIVE) {
114
115 out_be32(xspi->regs + XSPI_SSR_OFFSET, 0xffff);
116 } else if (is_on == BITBANG_CS_ACTIVE) {
117
118 u16 cr = in_be16(xspi->regs + XSPI_CR_OFFSET)
119 & ~XSPI_CR_MODE_MASK;
120 if (spi->mode & SPI_CPHA)
121 cr |= XSPI_CR_CPHA;
122 if (spi->mode & SPI_CPOL)
123 cr |= XSPI_CR_CPOL;
124 out_be16(xspi->regs + XSPI_CR_OFFSET, cr);
125
126
127
128
129
130
131
132 out_be32(xspi->regs + XSPI_SSR_OFFSET,
133 ~(0x0001 << spi->chip_select));
134 }
135}
136
137
138
139
140
141
142
143static int xilinx_spi_setup_transfer(struct spi_device *spi,
144 struct spi_transfer *t)
145{
146 u8 bits_per_word;
147 u32 hz;
148 struct xilinx_spi *xspi = spi_master_get_devdata(spi->master);
149
150 bits_per_word = (t) ? t->bits_per_word : spi->bits_per_word;
151 hz = (t) ? t->speed_hz : spi->max_speed_hz;
152 if (bits_per_word != 8) {
153 dev_err(&spi->dev, "%s, unsupported bits_per_word=%d\n",
154 __FUNCTION__, bits_per_word);
155 return -EINVAL;
156 }
157
158 if (hz && xspi->speed_hz > hz) {
159 dev_err(&spi->dev, "%s, unsupported clock rate %uHz\n",
160 __FUNCTION__, hz);
161 return -EINVAL;
162 }
163
164 return 0;
165}
166
167
168#define MODEBITS (SPI_CPOL | SPI_CPHA)
169
170static int xilinx_spi_setup(struct spi_device *spi)
171{
172 struct spi_bitbang *bitbang;
173 struct xilinx_spi *xspi;
174 int retval;
175
176 xspi = spi_master_get_devdata(spi->master);
177 bitbang = &xspi->bitbang;
178
179 if (!spi->bits_per_word)
180 spi->bits_per_word = 8;
181
182 if (spi->mode & ~MODEBITS) {
183 dev_err(&spi->dev, "%s, unsupported mode bits %x\n",
184 __FUNCTION__, spi->mode & ~MODEBITS);
185 return -EINVAL;
186 }
187
188 retval = xilinx_spi_setup_transfer(spi, NULL);
189 if (retval < 0)
190 return retval;
191
192 dev_dbg(&spi->dev, "%s, mode %d, %u bits/w, %u nsec/bit\n",
193 __FUNCTION__, spi->mode & MODEBITS, spi->bits_per_word, 0);
194
195 return 0;
196}
197
198static void xilinx_spi_fill_tx_fifo(struct xilinx_spi *xspi)
199{
200 u8 sr;
201
202
203 sr = in_8(xspi->regs + XSPI_SR_OFFSET);
204 while ((sr & XSPI_SR_TX_FULL_MASK) == 0 && xspi->remaining_bytes > 0) {
205 if (xspi->tx_ptr) {
206 out_8(xspi->regs + XSPI_TXD_OFFSET, *xspi->tx_ptr++);
207 } else {
208 out_8(xspi->regs + XSPI_TXD_OFFSET, 0);
209 }
210 xspi->remaining_bytes--;
211 sr = in_8(xspi->regs + XSPI_SR_OFFSET);
212 }
213}
214
215static int xilinx_spi_txrx_bufs(struct spi_device *spi, struct spi_transfer *t)
216{
217 struct xilinx_spi *xspi = spi_master_get_devdata(spi->master);
218 u32 ipif_ier;
219 u16 cr;
220
221
222
223 xspi->tx_ptr = t->tx_buf;
224 xspi->rx_ptr = t->rx_buf;
225 xspi->remaining_bytes = t->len;
226 INIT_COMPLETION(xspi->done);
227
228 xilinx_spi_fill_tx_fifo(xspi);
229
230
231
232
233 ipif_ier = in_be32(xspi->regs + XIPIF_V123B_IIER_OFFSET);
234 out_be32(xspi->regs + XIPIF_V123B_IIER_OFFSET,
235 ipif_ier | XSPI_INTR_TX_EMPTY);
236
237
238 cr = in_be16(xspi->regs + XSPI_CR_OFFSET) & ~XSPI_CR_TRANS_INHIBIT;
239 out_be16(xspi->regs + XSPI_CR_OFFSET, cr);
240
241 wait_for_completion(&xspi->done);
242
243
244 out_be32(xspi->regs + XIPIF_V123B_IIER_OFFSET, ipif_ier);
245
246 return t->len - xspi->remaining_bytes;
247}
248
249
250
251
252
253
254
255static irqreturn_t xilinx_spi_irq(int irq, void *dev_id)
256{
257 struct xilinx_spi *xspi = dev_id;
258 u32 ipif_isr;
259
260
261 ipif_isr = in_be32(xspi->regs + XIPIF_V123B_IISR_OFFSET);
262 out_be32(xspi->regs + XIPIF_V123B_IISR_OFFSET, ipif_isr);
263
264 if (ipif_isr & XSPI_INTR_TX_EMPTY) {
265 u16 cr;
266 u8 sr;
267
268
269
270
271
272
273 cr = in_be16(xspi->regs + XSPI_CR_OFFSET);
274 out_be16(xspi->regs + XSPI_CR_OFFSET,
275 cr | XSPI_CR_TRANS_INHIBIT);
276
277
278 sr = in_8(xspi->regs + XSPI_SR_OFFSET);
279 while ((sr & XSPI_SR_RX_EMPTY_MASK) == 0) {
280 u8 data;
281
282 data = in_8(xspi->regs + XSPI_RXD_OFFSET);
283 if (xspi->rx_ptr) {
284 *xspi->rx_ptr++ = data;
285 }
286 sr = in_8(xspi->regs + XSPI_SR_OFFSET);
287 }
288
289
290 if (xspi->remaining_bytes > 0) {
291 xilinx_spi_fill_tx_fifo(xspi);
292
293
294
295 out_be16(xspi->regs + XSPI_CR_OFFSET, cr);
296 } else {
297
298
299
300 complete(&xspi->done);
301 }
302 }
303
304 return IRQ_HANDLED;
305}
306
307static int __init xilinx_spi_probe(struct platform_device *dev)
308{
309 int ret = 0;
310 struct spi_master *master;
311 struct xilinx_spi *xspi;
312 struct xspi_platform_data *pdata;
313 struct resource *r;
314
315
316 master = spi_alloc_master(&dev->dev, sizeof(struct xilinx_spi));
317
318 if (master == NULL) {
319 return -ENOMEM;
320 }
321
322 platform_set_drvdata(dev, master);
323 pdata = dev->dev.platform_data;
324
325 if (pdata == NULL) {
326 ret = -ENODEV;
327 goto put_master;
328 }
329
330 r = platform_get_resource(dev, IORESOURCE_MEM, 0);
331 if (r == NULL) {
332 ret = -ENODEV;
333 goto put_master;
334 }
335
336 xspi = spi_master_get_devdata(master);
337 xspi->bitbang.master = spi_master_get(master);
338 xspi->bitbang.chipselect = xilinx_spi_chipselect;
339 xspi->bitbang.setup_transfer = xilinx_spi_setup_transfer;
340 xspi->bitbang.txrx_bufs = xilinx_spi_txrx_bufs;
341 xspi->bitbang.master->setup = xilinx_spi_setup;
342 init_completion(&xspi->done);
343
344 if (!request_mem_region(r->start,
345 r->end - r->start + 1, XILINX_SPI_NAME)) {
346 ret = -ENXIO;
347 goto put_master;
348 }
349
350 xspi->regs = ioremap(r->start, r->end - r->start + 1);
351 if (xspi->regs == NULL) {
352 ret = -ENOMEM;
353 goto put_master;
354 }
355
356 xspi->irq = platform_get_irq(dev, 0);
357 if (xspi->irq < 0) {
358 ret = -ENXIO;
359 goto unmap_io;
360 }
361
362 master->bus_num = pdata->bus_num;
363 master->num_chipselect = pdata->num_chipselect;
364 xspi->speed_hz = pdata->speed_hz;
365
366
367 xspi_init_hw(xspi->regs);
368
369
370 ret = request_irq(xspi->irq, xilinx_spi_irq, 0, XILINX_SPI_NAME, xspi);
371 if (ret != 0)
372 goto unmap_io;
373
374 ret = spi_bitbang_start(&xspi->bitbang);
375 if (ret != 0) {
376 dev_err(&dev->dev, "spi_bitbang_start FAILED\n");
377 goto free_irq;
378 }
379
380 dev_info(&dev->dev, "at 0x%08X mapped to 0x%08X, irq=%d\n",
381 r->start, (u32)xspi->regs, xspi->irq);
382
383 return ret;
384
385free_irq:
386 free_irq(xspi->irq, xspi);
387unmap_io:
388 iounmap(xspi->regs);
389put_master:
390 spi_master_put(master);
391 return ret;
392}
393
394static int __devexit xilinx_spi_remove(struct platform_device *dev)
395{
396 struct xilinx_spi *xspi;
397 struct spi_master *master;
398
399 master = platform_get_drvdata(dev);
400 xspi = spi_master_get_devdata(master);
401
402 spi_bitbang_stop(&xspi->bitbang);
403 free_irq(xspi->irq, xspi);
404 iounmap(xspi->regs);
405 platform_set_drvdata(dev, 0);
406 spi_master_put(xspi->bitbang.master);
407
408 return 0;
409}
410
411static struct platform_driver xilinx_spi_driver = {
412 .probe = xilinx_spi_probe,
413 .remove = __devexit_p(xilinx_spi_remove),
414 .driver = {
415 .name = XILINX_SPI_NAME,
416 .owner = THIS_MODULE,
417 },
418};
419
420static int __init xilinx_spi_init(void)
421{
422 return platform_driver_register(&xilinx_spi_driver);
423}
424module_init(xilinx_spi_init);
425
426static void __exit xilinx_spi_exit(void)
427{
428 platform_driver_unregister(&xilinx_spi_driver);
429}
430module_exit(xilinx_spi_exit);
431
432MODULE_AUTHOR("MontaVista Software, Inc. <source@mvista.com>");
433MODULE_DESCRIPTION("Xilinx SPI driver");
434MODULE_LICENSE("GPL");
435