net: add skb_dst_force() in sock_queue_err_skb()
[linux/fpc-iii.git] / drivers / spi / xilinx_spi.c
blobc69c6f2c2c5ceeadae69afa2efc60c636517a0e3
1 /*
2 * Xilinx SPI controller driver (master mode only)
4 * Author: MontaVista Software, Inc.
5 * source@mvista.com
7 * Copyright (c) 2010 Secret Lab Technologies, Ltd.
8 * Copyright (c) 2009 Intel Corporation
9 * 2002-2007 (c) MontaVista Software, Inc.
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License version 2 as
13 * published by the Free Software Foundation.
16 #include <linux/module.h>
17 #include <linux/init.h>
18 #include <linux/interrupt.h>
19 #include <linux/of.h>
20 #include <linux/platform_device.h>
21 #include <linux/mfd/core.h>
22 #include <linux/spi/spi.h>
23 #include <linux/spi/spi_bitbang.h>
24 #include <linux/spi/xilinx_spi.h>
25 #include <linux/io.h>
27 #define XILINX_SPI_NAME "xilinx_spi"
29 /* Register definitions as per "OPB Serial Peripheral Interface (SPI) (v1.00e)
30 * Product Specification", DS464
32 #define XSPI_CR_OFFSET 0x60 /* Control Register */
34 #define XSPI_CR_ENABLE 0x02
35 #define XSPI_CR_MASTER_MODE 0x04
36 #define XSPI_CR_CPOL 0x08
37 #define XSPI_CR_CPHA 0x10
38 #define XSPI_CR_MODE_MASK (XSPI_CR_CPHA | XSPI_CR_CPOL)
39 #define XSPI_CR_TXFIFO_RESET 0x20
40 #define XSPI_CR_RXFIFO_RESET 0x40
41 #define XSPI_CR_MANUAL_SSELECT 0x80
42 #define XSPI_CR_TRANS_INHIBIT 0x100
43 #define XSPI_CR_LSB_FIRST 0x200
45 #define XSPI_SR_OFFSET 0x64 /* Status Register */
47 #define XSPI_SR_RX_EMPTY_MASK 0x01 /* Receive FIFO is empty */
48 #define XSPI_SR_RX_FULL_MASK 0x02 /* Receive FIFO is full */
49 #define XSPI_SR_TX_EMPTY_MASK 0x04 /* Transmit FIFO is empty */
50 #define XSPI_SR_TX_FULL_MASK 0x08 /* Transmit FIFO is full */
51 #define XSPI_SR_MODE_FAULT_MASK 0x10 /* Mode fault error */
53 #define XSPI_TXD_OFFSET 0x68 /* Data Transmit Register */
54 #define XSPI_RXD_OFFSET 0x6c /* Data Receive Register */
56 #define XSPI_SSR_OFFSET 0x70 /* 32-bit Slave Select Register */
58 /* Register definitions as per "OPB IPIF (v3.01c) Product Specification", DS414
59 * IPIF registers are 32 bit
61 #define XIPIF_V123B_DGIER_OFFSET 0x1c /* IPIF global int enable reg */
62 #define XIPIF_V123B_GINTR_ENABLE 0x80000000
64 #define XIPIF_V123B_IISR_OFFSET 0x20 /* IPIF interrupt status reg */
65 #define XIPIF_V123B_IIER_OFFSET 0x28 /* IPIF interrupt enable reg */
67 #define XSPI_INTR_MODE_FAULT 0x01 /* Mode fault error */
68 #define XSPI_INTR_SLAVE_MODE_FAULT 0x02 /* Selected as slave while
69 * disabled */
70 #define XSPI_INTR_TX_EMPTY 0x04 /* TxFIFO is empty */
71 #define XSPI_INTR_TX_UNDERRUN 0x08 /* TxFIFO was underrun */
72 #define XSPI_INTR_RX_FULL 0x10 /* RxFIFO is full */
73 #define XSPI_INTR_RX_OVERRUN 0x20 /* RxFIFO was overrun */
74 #define XSPI_INTR_TX_HALF_EMPTY 0x40 /* TxFIFO is half empty */
76 #define XIPIF_V123B_RESETR_OFFSET 0x40 /* IPIF reset register */
77 #define XIPIF_V123B_RESET_MASK 0x0a /* the value to write */
79 struct xilinx_spi {
80 /* bitbang has to be first */
81 struct spi_bitbang bitbang;
82 struct completion done;
83 struct resource mem; /* phys mem */
84 void __iomem *regs; /* virt. address of the control registers */
86 u32 irq;
88 u8 *rx_ptr; /* pointer in the Tx buffer */
89 const u8 *tx_ptr; /* pointer in the Rx buffer */
90 int remaining_bytes; /* the number of bytes left to transfer */
91 u8 bits_per_word;
92 unsigned int (*read_fn) (void __iomem *);
93 void (*write_fn) (u32, void __iomem *);
94 void (*tx_fn) (struct xilinx_spi *);
95 void (*rx_fn) (struct xilinx_spi *);
98 static void xspi_write32(u32 val, void __iomem *addr)
100 iowrite32(val, addr);
103 static unsigned int xspi_read32(void __iomem *addr)
105 return ioread32(addr);
108 static void xspi_write32_be(u32 val, void __iomem *addr)
110 iowrite32be(val, addr);
113 static unsigned int xspi_read32_be(void __iomem *addr)
115 return ioread32be(addr);
118 static void xspi_tx8(struct xilinx_spi *xspi)
120 xspi->write_fn(*xspi->tx_ptr, xspi->regs + XSPI_TXD_OFFSET);
121 xspi->tx_ptr++;
124 static void xspi_tx16(struct xilinx_spi *xspi)
126 xspi->write_fn(*(u16 *)(xspi->tx_ptr), xspi->regs + XSPI_TXD_OFFSET);
127 xspi->tx_ptr += 2;
130 static void xspi_tx32(struct xilinx_spi *xspi)
132 xspi->write_fn(*(u32 *)(xspi->tx_ptr), xspi->regs + XSPI_TXD_OFFSET);
133 xspi->tx_ptr += 4;
136 static void xspi_rx8(struct xilinx_spi *xspi)
138 u32 data = xspi->read_fn(xspi->regs + XSPI_RXD_OFFSET);
139 if (xspi->rx_ptr) {
140 *xspi->rx_ptr = data & 0xff;
141 xspi->rx_ptr++;
145 static void xspi_rx16(struct xilinx_spi *xspi)
147 u32 data = xspi->read_fn(xspi->regs + XSPI_RXD_OFFSET);
148 if (xspi->rx_ptr) {
149 *(u16 *)(xspi->rx_ptr) = data & 0xffff;
150 xspi->rx_ptr += 2;
154 static void xspi_rx32(struct xilinx_spi *xspi)
156 u32 data = xspi->read_fn(xspi->regs + XSPI_RXD_OFFSET);
157 if (xspi->rx_ptr) {
158 *(u32 *)(xspi->rx_ptr) = data;
159 xspi->rx_ptr += 4;
163 static void xspi_init_hw(struct xilinx_spi *xspi)
165 void __iomem *regs_base = xspi->regs;
167 /* Reset the SPI device */
168 xspi->write_fn(XIPIF_V123B_RESET_MASK,
169 regs_base + XIPIF_V123B_RESETR_OFFSET);
170 /* Disable all the interrupts just in case */
171 xspi->write_fn(0, regs_base + XIPIF_V123B_IIER_OFFSET);
172 /* Enable the global IPIF interrupt */
173 xspi->write_fn(XIPIF_V123B_GINTR_ENABLE,
174 regs_base + XIPIF_V123B_DGIER_OFFSET);
175 /* Deselect the slave on the SPI bus */
176 xspi->write_fn(0xffff, regs_base + XSPI_SSR_OFFSET);
177 /* Disable the transmitter, enable Manual Slave Select Assertion,
178 * put SPI controller into master mode, and enable it */
179 xspi->write_fn(XSPI_CR_TRANS_INHIBIT | XSPI_CR_MANUAL_SSELECT |
180 XSPI_CR_MASTER_MODE | XSPI_CR_ENABLE | XSPI_CR_TXFIFO_RESET |
181 XSPI_CR_RXFIFO_RESET, regs_base + XSPI_CR_OFFSET);
184 static void xilinx_spi_chipselect(struct spi_device *spi, int is_on)
186 struct xilinx_spi *xspi = spi_master_get_devdata(spi->master);
188 if (is_on == BITBANG_CS_INACTIVE) {
189 /* Deselect the slave on the SPI bus */
190 xspi->write_fn(0xffff, xspi->regs + XSPI_SSR_OFFSET);
191 } else if (is_on == BITBANG_CS_ACTIVE) {
192 /* Set the SPI clock phase and polarity */
193 u16 cr = xspi->read_fn(xspi->regs + XSPI_CR_OFFSET)
194 & ~XSPI_CR_MODE_MASK;
195 if (spi->mode & SPI_CPHA)
196 cr |= XSPI_CR_CPHA;
197 if (spi->mode & SPI_CPOL)
198 cr |= XSPI_CR_CPOL;
199 xspi->write_fn(cr, xspi->regs + XSPI_CR_OFFSET);
201 /* We do not check spi->max_speed_hz here as the SPI clock
202 * frequency is not software programmable (the IP block design
203 * parameter)
206 /* Activate the chip select */
207 xspi->write_fn(~(0x0001 << spi->chip_select),
208 xspi->regs + XSPI_SSR_OFFSET);
212 /* spi_bitbang requires custom setup_transfer() to be defined if there is a
213 * custom txrx_bufs(). We have nothing to setup here as the SPI IP block
214 * supports 8 or 16 bits per word which cannot be changed in software.
215 * SPI clock can't be changed in software either.
216 * Check for correct bits per word. Chip select delay calculations could be
217 * added here as soon as bitbang_work() can be made aware of the delay value.
219 static int xilinx_spi_setup_transfer(struct spi_device *spi,
220 struct spi_transfer *t)
222 struct xilinx_spi *xspi = spi_master_get_devdata(spi->master);
223 u8 bits_per_word;
225 bits_per_word = (t && t->bits_per_word)
226 ? t->bits_per_word : spi->bits_per_word;
227 if (bits_per_word != xspi->bits_per_word) {
228 dev_err(&spi->dev, "%s, unsupported bits_per_word=%d\n",
229 __func__, bits_per_word);
230 return -EINVAL;
233 return 0;
236 static int xilinx_spi_setup(struct spi_device *spi)
238 /* always return 0, we can not check the number of bits.
239 * There are cases when SPI setup is called before any driver is
240 * there, in that case the SPI core defaults to 8 bits, which we
241 * do not support in some cases. But if we return an error, the
242 * SPI device would not be registered and no driver can get hold of it
243 * When the driver is there, it will call SPI setup again with the
244 * correct number of bits per transfer.
245 * If a driver setups with the wrong bit number, it will fail when
246 * it tries to do a transfer
248 return 0;
251 static void xilinx_spi_fill_tx_fifo(struct xilinx_spi *xspi)
253 u8 sr;
255 /* Fill the Tx FIFO with as many bytes as possible */
256 sr = xspi->read_fn(xspi->regs + XSPI_SR_OFFSET);
257 while ((sr & XSPI_SR_TX_FULL_MASK) == 0 && xspi->remaining_bytes > 0) {
258 if (xspi->tx_ptr)
259 xspi->tx_fn(xspi);
260 else
261 xspi->write_fn(0, xspi->regs + XSPI_TXD_OFFSET);
262 xspi->remaining_bytes -= xspi->bits_per_word / 8;
263 sr = xspi->read_fn(xspi->regs + XSPI_SR_OFFSET);
267 static int xilinx_spi_txrx_bufs(struct spi_device *spi, struct spi_transfer *t)
269 struct xilinx_spi *xspi = spi_master_get_devdata(spi->master);
270 u32 ipif_ier;
271 u16 cr;
273 /* We get here with transmitter inhibited */
275 xspi->tx_ptr = t->tx_buf;
276 xspi->rx_ptr = t->rx_buf;
277 xspi->remaining_bytes = t->len;
278 INIT_COMPLETION(xspi->done);
280 xilinx_spi_fill_tx_fifo(xspi);
282 /* Enable the transmit empty interrupt, which we use to determine
283 * progress on the transmission.
285 ipif_ier = xspi->read_fn(xspi->regs + XIPIF_V123B_IIER_OFFSET);
286 xspi->write_fn(ipif_ier | XSPI_INTR_TX_EMPTY,
287 xspi->regs + XIPIF_V123B_IIER_OFFSET);
289 /* Start the transfer by not inhibiting the transmitter any longer */
290 cr = xspi->read_fn(xspi->regs + XSPI_CR_OFFSET) &
291 ~XSPI_CR_TRANS_INHIBIT;
292 xspi->write_fn(cr, xspi->regs + XSPI_CR_OFFSET);
294 wait_for_completion(&xspi->done);
296 /* Disable the transmit empty interrupt */
297 xspi->write_fn(ipif_ier, xspi->regs + XIPIF_V123B_IIER_OFFSET);
299 return t->len - xspi->remaining_bytes;
303 /* This driver supports single master mode only. Hence Tx FIFO Empty
304 * is the only interrupt we care about.
305 * Receive FIFO Overrun, Transmit FIFO Underrun, Mode Fault, and Slave Mode
306 * Fault are not to happen.
308 static irqreturn_t xilinx_spi_irq(int irq, void *dev_id)
310 struct xilinx_spi *xspi = dev_id;
311 u32 ipif_isr;
313 /* Get the IPIF interrupts, and clear them immediately */
314 ipif_isr = xspi->read_fn(xspi->regs + XIPIF_V123B_IISR_OFFSET);
315 xspi->write_fn(ipif_isr, xspi->regs + XIPIF_V123B_IISR_OFFSET);
317 if (ipif_isr & XSPI_INTR_TX_EMPTY) { /* Transmission completed */
318 u16 cr;
319 u8 sr;
321 /* A transmit has just completed. Process received data and
322 * check for more data to transmit. Always inhibit the
323 * transmitter while the Isr refills the transmit register/FIFO,
324 * or make sure it is stopped if we're done.
326 cr = xspi->read_fn(xspi->regs + XSPI_CR_OFFSET);
327 xspi->write_fn(cr | XSPI_CR_TRANS_INHIBIT,
328 xspi->regs + XSPI_CR_OFFSET);
330 /* Read out all the data from the Rx FIFO */
331 sr = xspi->read_fn(xspi->regs + XSPI_SR_OFFSET);
332 while ((sr & XSPI_SR_RX_EMPTY_MASK) == 0) {
333 xspi->rx_fn(xspi);
334 sr = xspi->read_fn(xspi->regs + XSPI_SR_OFFSET);
337 /* See if there is more data to send */
338 if (xspi->remaining_bytes > 0) {
339 xilinx_spi_fill_tx_fifo(xspi);
340 /* Start the transfer by not inhibiting the
341 * transmitter any longer
343 xspi->write_fn(cr, xspi->regs + XSPI_CR_OFFSET);
344 } else {
345 /* No more data to send.
346 * Indicate the transfer is completed.
348 complete(&xspi->done);
352 return IRQ_HANDLED;
355 static const struct of_device_id xilinx_spi_of_match[] = {
356 { .compatible = "xlnx,xps-spi-2.00.a", },
357 { .compatible = "xlnx,xps-spi-2.00.b", },
360 MODULE_DEVICE_TABLE(of, xilinx_spi_of_match);
362 struct spi_master *xilinx_spi_init(struct device *dev, struct resource *mem,
363 u32 irq, s16 bus_num, int num_cs, int little_endian, int bits_per_word)
365 struct spi_master *master;
366 struct xilinx_spi *xspi;
367 int ret;
369 master = spi_alloc_master(dev, sizeof(struct xilinx_spi));
370 if (!master)
371 return NULL;
373 /* the spi->mode bits understood by this driver: */
374 master->mode_bits = SPI_CPOL | SPI_CPHA;
376 xspi = spi_master_get_devdata(master);
377 xspi->bitbang.master = spi_master_get(master);
378 xspi->bitbang.chipselect = xilinx_spi_chipselect;
379 xspi->bitbang.setup_transfer = xilinx_spi_setup_transfer;
380 xspi->bitbang.txrx_bufs = xilinx_spi_txrx_bufs;
381 xspi->bitbang.master->setup = xilinx_spi_setup;
382 init_completion(&xspi->done);
384 if (!request_mem_region(mem->start, resource_size(mem),
385 XILINX_SPI_NAME))
386 goto put_master;
388 xspi->regs = ioremap(mem->start, resource_size(mem));
389 if (xspi->regs == NULL) {
390 dev_warn(dev, "ioremap failure\n");
391 goto map_failed;
394 master->bus_num = bus_num;
395 master->num_chipselect = num_cs;
396 master->dev.of_node = dev->of_node;
398 xspi->mem = *mem;
399 xspi->irq = irq;
400 if (little_endian) {
401 xspi->read_fn = xspi_read32;
402 xspi->write_fn = xspi_write32;
403 } else {
404 xspi->read_fn = xspi_read32_be;
405 xspi->write_fn = xspi_write32_be;
407 xspi->bits_per_word = bits_per_word;
408 if (xspi->bits_per_word == 8) {
409 xspi->tx_fn = xspi_tx8;
410 xspi->rx_fn = xspi_rx8;
411 } else if (xspi->bits_per_word == 16) {
412 xspi->tx_fn = xspi_tx16;
413 xspi->rx_fn = xspi_rx16;
414 } else if (xspi->bits_per_word == 32) {
415 xspi->tx_fn = xspi_tx32;
416 xspi->rx_fn = xspi_rx32;
417 } else
418 goto unmap_io;
421 /* SPI controller initializations */
422 xspi_init_hw(xspi);
424 /* Register for SPI Interrupt */
425 ret = request_irq(xspi->irq, xilinx_spi_irq, 0, XILINX_SPI_NAME, xspi);
426 if (ret)
427 goto unmap_io;
429 ret = spi_bitbang_start(&xspi->bitbang);
430 if (ret) {
431 dev_err(dev, "spi_bitbang_start FAILED\n");
432 goto free_irq;
435 dev_info(dev, "at 0x%08llX mapped to 0x%p, irq=%d\n",
436 (unsigned long long)mem->start, xspi->regs, xspi->irq);
437 return master;
439 free_irq:
440 free_irq(xspi->irq, xspi);
441 unmap_io:
442 iounmap(xspi->regs);
443 map_failed:
444 release_mem_region(mem->start, resource_size(mem));
445 put_master:
446 spi_master_put(master);
447 return NULL;
449 EXPORT_SYMBOL(xilinx_spi_init);
451 void xilinx_spi_deinit(struct spi_master *master)
453 struct xilinx_spi *xspi;
455 xspi = spi_master_get_devdata(master);
457 spi_bitbang_stop(&xspi->bitbang);
458 free_irq(xspi->irq, xspi);
459 iounmap(xspi->regs);
461 release_mem_region(xspi->mem.start, resource_size(&xspi->mem));
462 spi_master_put(xspi->bitbang.master);
464 EXPORT_SYMBOL(xilinx_spi_deinit);
466 static int __devinit xilinx_spi_probe(struct platform_device *dev)
468 struct xspi_platform_data *pdata;
469 struct resource *r;
470 int irq, num_cs = 0, little_endian = 0, bits_per_word = 8;
471 struct spi_master *master;
472 u8 i;
474 pdata = mfd_get_data(dev);
475 if (pdata) {
476 num_cs = pdata->num_chipselect;
477 little_endian = pdata->little_endian;
478 bits_per_word = pdata->bits_per_word;
481 #ifdef CONFIG_OF
482 if (dev->dev.of_node) {
483 const __be32 *prop;
484 int len;
486 /* number of slave select bits is required */
487 prop = of_get_property(dev->dev.of_node, "xlnx,num-ss-bits",
488 &len);
489 if (prop && len >= sizeof(*prop))
490 num_cs = __be32_to_cpup(prop);
492 #endif
494 if (!num_cs) {
495 dev_err(&dev->dev, "Missing slave select configuration data\n");
496 return -EINVAL;
500 r = platform_get_resource(dev, IORESOURCE_MEM, 0);
501 if (!r)
502 return -ENODEV;
504 irq = platform_get_irq(dev, 0);
505 if (irq < 0)
506 return -ENXIO;
508 master = xilinx_spi_init(&dev->dev, r, irq, dev->id, num_cs,
509 little_endian, bits_per_word);
510 if (!master)
511 return -ENODEV;
513 if (pdata) {
514 for (i = 0; i < pdata->num_devices; i++)
515 spi_new_device(master, pdata->devices + i);
518 platform_set_drvdata(dev, master);
519 return 0;
522 static int __devexit xilinx_spi_remove(struct platform_device *dev)
524 xilinx_spi_deinit(platform_get_drvdata(dev));
525 platform_set_drvdata(dev, 0);
527 return 0;
530 /* work with hotplug and coldplug */
531 MODULE_ALIAS("platform:" XILINX_SPI_NAME);
533 static struct platform_driver xilinx_spi_driver = {
534 .probe = xilinx_spi_probe,
535 .remove = __devexit_p(xilinx_spi_remove),
536 .driver = {
537 .name = XILINX_SPI_NAME,
538 .owner = THIS_MODULE,
539 .of_match_table = xilinx_spi_of_match,
543 static int __init xilinx_spi_pltfm_init(void)
545 return platform_driver_register(&xilinx_spi_driver);
547 module_init(xilinx_spi_pltfm_init);
549 static void __exit xilinx_spi_pltfm_exit(void)
551 platform_driver_unregister(&xilinx_spi_driver);
553 module_exit(xilinx_spi_pltfm_exit);
555 MODULE_AUTHOR("MontaVista Software, Inc. <source@mvista.com>");
556 MODULE_DESCRIPTION("Xilinx SPI driver");
557 MODULE_LICENSE("GPL");