Avoid beyond bounds copy while caching ACL
[zen-stable.git] / drivers / spi / spi-nuc900.c
blob182e9c873822a64b6e9e25976470044eae8bc338
1 /*
2 * Copyright (c) 2009 Nuvoton technology.
3 * Wan ZongShun <mcuos.com@gmail.com>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
9 */
11 #include <linux/module.h>
12 #include <linux/init.h>
13 #include <linux/spinlock.h>
14 #include <linux/workqueue.h>
15 #include <linux/interrupt.h>
16 #include <linux/delay.h>
17 #include <linux/errno.h>
18 #include <linux/err.h>
19 #include <linux/clk.h>
20 #include <linux/device.h>
21 #include <linux/platform_device.h>
22 #include <linux/gpio.h>
23 #include <linux/io.h>
24 #include <linux/slab.h>
26 #include <linux/spi/spi.h>
27 #include <linux/spi/spi_bitbang.h>
29 #include <mach/nuc900_spi.h>
31 /* usi registers offset */
32 #define USI_CNT 0x00
33 #define USI_DIV 0x04
34 #define USI_SSR 0x08
35 #define USI_RX0 0x10
36 #define USI_TX0 0x10
38 /* usi register bit */
39 #define ENINT (0x01 << 17)
40 #define ENFLG (0x01 << 16)
41 #define TXNUM (0x03 << 8)
42 #define TXNEG (0x01 << 2)
43 #define RXNEG (0x01 << 1)
44 #define LSB (0x01 << 10)
45 #define SELECTLEV (0x01 << 2)
46 #define SELECTPOL (0x01 << 31)
47 #define SELECTSLAVE 0x01
48 #define GOBUSY 0x01
50 struct nuc900_spi {
51 struct spi_bitbang bitbang;
52 struct completion done;
53 void __iomem *regs;
54 int irq;
55 int len;
56 int count;
57 const unsigned char *tx;
58 unsigned char *rx;
59 struct clk *clk;
60 struct resource *ioarea;
61 struct spi_master *master;
62 struct spi_device *curdev;
63 struct device *dev;
64 struct nuc900_spi_info *pdata;
65 spinlock_t lock;
66 struct resource *res;
69 static inline struct nuc900_spi *to_hw(struct spi_device *sdev)
71 return spi_master_get_devdata(sdev->master);
74 static void nuc900_slave_select(struct spi_device *spi, unsigned int ssr)
76 struct nuc900_spi *hw = to_hw(spi);
77 unsigned int val;
78 unsigned int cs = spi->mode & SPI_CS_HIGH ? 1 : 0;
79 unsigned int cpol = spi->mode & SPI_CPOL ? 1 : 0;
80 unsigned long flags;
82 spin_lock_irqsave(&hw->lock, flags);
84 val = __raw_readl(hw->regs + USI_SSR);
86 if (!cs)
87 val &= ~SELECTLEV;
88 else
89 val |= SELECTLEV;
91 if (!ssr)
92 val &= ~SELECTSLAVE;
93 else
94 val |= SELECTSLAVE;
96 __raw_writel(val, hw->regs + USI_SSR);
98 val = __raw_readl(hw->regs + USI_CNT);
100 if (!cpol)
101 val &= ~SELECTPOL;
102 else
103 val |= SELECTPOL;
105 __raw_writel(val, hw->regs + USI_CNT);
107 spin_unlock_irqrestore(&hw->lock, flags);
110 static void nuc900_spi_chipsel(struct spi_device *spi, int value)
112 switch (value) {
113 case BITBANG_CS_INACTIVE:
114 nuc900_slave_select(spi, 0);
115 break;
117 case BITBANG_CS_ACTIVE:
118 nuc900_slave_select(spi, 1);
119 break;
123 static void nuc900_spi_setup_txnum(struct nuc900_spi *hw,
124 unsigned int txnum)
126 unsigned int val;
127 unsigned long flags;
129 spin_lock_irqsave(&hw->lock, flags);
131 val = __raw_readl(hw->regs + USI_CNT);
133 if (!txnum)
134 val &= ~TXNUM;
135 else
136 val |= txnum << 0x08;
138 __raw_writel(val, hw->regs + USI_CNT);
140 spin_unlock_irqrestore(&hw->lock, flags);
144 static void nuc900_spi_setup_txbitlen(struct nuc900_spi *hw,
145 unsigned int txbitlen)
147 unsigned int val;
148 unsigned long flags;
150 spin_lock_irqsave(&hw->lock, flags);
152 val = __raw_readl(hw->regs + USI_CNT);
154 val |= (txbitlen << 0x03);
156 __raw_writel(val, hw->regs + USI_CNT);
158 spin_unlock_irqrestore(&hw->lock, flags);
161 static void nuc900_spi_gobusy(struct nuc900_spi *hw)
163 unsigned int val;
164 unsigned long flags;
166 spin_lock_irqsave(&hw->lock, flags);
168 val = __raw_readl(hw->regs + USI_CNT);
170 val |= GOBUSY;
172 __raw_writel(val, hw->regs + USI_CNT);
174 spin_unlock_irqrestore(&hw->lock, flags);
177 static int nuc900_spi_setupxfer(struct spi_device *spi,
178 struct spi_transfer *t)
180 return 0;
183 static int nuc900_spi_setup(struct spi_device *spi)
185 return 0;
188 static inline unsigned int hw_txbyte(struct nuc900_spi *hw, int count)
190 return hw->tx ? hw->tx[count] : 0;
193 static int nuc900_spi_txrx(struct spi_device *spi, struct spi_transfer *t)
195 struct nuc900_spi *hw = to_hw(spi);
197 hw->tx = t->tx_buf;
198 hw->rx = t->rx_buf;
199 hw->len = t->len;
200 hw->count = 0;
202 __raw_writel(hw_txbyte(hw, 0x0), hw->regs + USI_TX0);
204 nuc900_spi_gobusy(hw);
206 wait_for_completion(&hw->done);
208 return hw->count;
211 static irqreturn_t nuc900_spi_irq(int irq, void *dev)
213 struct nuc900_spi *hw = dev;
214 unsigned int status;
215 unsigned int count = hw->count;
217 status = __raw_readl(hw->regs + USI_CNT);
218 __raw_writel(status, hw->regs + USI_CNT);
220 if (status & ENFLG) {
221 hw->count++;
223 if (hw->rx)
224 hw->rx[count] = __raw_readl(hw->regs + USI_RX0);
225 count++;
227 if (count < hw->len) {
228 __raw_writel(hw_txbyte(hw, count), hw->regs + USI_TX0);
229 nuc900_spi_gobusy(hw);
230 } else {
231 complete(&hw->done);
234 return IRQ_HANDLED;
237 complete(&hw->done);
238 return IRQ_HANDLED;
241 static void nuc900_tx_edge(struct nuc900_spi *hw, unsigned int edge)
243 unsigned int val;
244 unsigned long flags;
246 spin_lock_irqsave(&hw->lock, flags);
248 val = __raw_readl(hw->regs + USI_CNT);
250 if (edge)
251 val |= TXNEG;
252 else
253 val &= ~TXNEG;
254 __raw_writel(val, hw->regs + USI_CNT);
256 spin_unlock_irqrestore(&hw->lock, flags);
259 static void nuc900_rx_edge(struct nuc900_spi *hw, unsigned int edge)
261 unsigned int val;
262 unsigned long flags;
264 spin_lock_irqsave(&hw->lock, flags);
266 val = __raw_readl(hw->regs + USI_CNT);
268 if (edge)
269 val |= RXNEG;
270 else
271 val &= ~RXNEG;
272 __raw_writel(val, hw->regs + USI_CNT);
274 spin_unlock_irqrestore(&hw->lock, flags);
277 static void nuc900_send_first(struct nuc900_spi *hw, unsigned int lsb)
279 unsigned int val;
280 unsigned long flags;
282 spin_lock_irqsave(&hw->lock, flags);
284 val = __raw_readl(hw->regs + USI_CNT);
286 if (lsb)
287 val |= LSB;
288 else
289 val &= ~LSB;
290 __raw_writel(val, hw->regs + USI_CNT);
292 spin_unlock_irqrestore(&hw->lock, flags);
295 static void nuc900_set_sleep(struct nuc900_spi *hw, unsigned int sleep)
297 unsigned int val;
298 unsigned long flags;
300 spin_lock_irqsave(&hw->lock, flags);
302 val = __raw_readl(hw->regs + USI_CNT);
304 if (sleep)
305 val |= (sleep << 12);
306 else
307 val &= ~(0x0f << 12);
308 __raw_writel(val, hw->regs + USI_CNT);
310 spin_unlock_irqrestore(&hw->lock, flags);
313 static void nuc900_enable_int(struct nuc900_spi *hw)
315 unsigned int val;
316 unsigned long flags;
318 spin_lock_irqsave(&hw->lock, flags);
320 val = __raw_readl(hw->regs + USI_CNT);
322 val |= ENINT;
324 __raw_writel(val, hw->regs + USI_CNT);
326 spin_unlock_irqrestore(&hw->lock, flags);
329 static void nuc900_set_divider(struct nuc900_spi *hw)
331 __raw_writel(hw->pdata->divider, hw->regs + USI_DIV);
334 static void nuc900_init_spi(struct nuc900_spi *hw)
336 clk_enable(hw->clk);
337 spin_lock_init(&hw->lock);
339 nuc900_tx_edge(hw, hw->pdata->txneg);
340 nuc900_rx_edge(hw, hw->pdata->rxneg);
341 nuc900_send_first(hw, hw->pdata->lsb);
342 nuc900_set_sleep(hw, hw->pdata->sleep);
343 nuc900_spi_setup_txbitlen(hw, hw->pdata->txbitlen);
344 nuc900_spi_setup_txnum(hw, hw->pdata->txnum);
345 nuc900_set_divider(hw);
346 nuc900_enable_int(hw);
349 static int __devinit nuc900_spi_probe(struct platform_device *pdev)
351 struct nuc900_spi *hw;
352 struct spi_master *master;
353 int err = 0;
355 master = spi_alloc_master(&pdev->dev, sizeof(struct nuc900_spi));
356 if (master == NULL) {
357 dev_err(&pdev->dev, "No memory for spi_master\n");
358 err = -ENOMEM;
359 goto err_nomem;
362 hw = spi_master_get_devdata(master);
363 memset(hw, 0, sizeof(struct nuc900_spi));
365 hw->master = spi_master_get(master);
366 hw->pdata = pdev->dev.platform_data;
367 hw->dev = &pdev->dev;
369 if (hw->pdata == NULL) {
370 dev_err(&pdev->dev, "No platform data supplied\n");
371 err = -ENOENT;
372 goto err_pdata;
375 platform_set_drvdata(pdev, hw);
376 init_completion(&hw->done);
378 master->mode_bits = SPI_MODE_0;
379 master->num_chipselect = hw->pdata->num_cs;
380 master->bus_num = hw->pdata->bus_num;
381 hw->bitbang.master = hw->master;
382 hw->bitbang.setup_transfer = nuc900_spi_setupxfer;
383 hw->bitbang.chipselect = nuc900_spi_chipsel;
384 hw->bitbang.txrx_bufs = nuc900_spi_txrx;
385 hw->bitbang.master->setup = nuc900_spi_setup;
387 hw->res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
388 if (hw->res == NULL) {
389 dev_err(&pdev->dev, "Cannot get IORESOURCE_MEM\n");
390 err = -ENOENT;
391 goto err_pdata;
394 hw->ioarea = request_mem_region(hw->res->start,
395 resource_size(hw->res), pdev->name);
397 if (hw->ioarea == NULL) {
398 dev_err(&pdev->dev, "Cannot reserve region\n");
399 err = -ENXIO;
400 goto err_pdata;
403 hw->regs = ioremap(hw->res->start, resource_size(hw->res));
404 if (hw->regs == NULL) {
405 dev_err(&pdev->dev, "Cannot map IO\n");
406 err = -ENXIO;
407 goto err_iomap;
410 hw->irq = platform_get_irq(pdev, 0);
411 if (hw->irq < 0) {
412 dev_err(&pdev->dev, "No IRQ specified\n");
413 err = -ENOENT;
414 goto err_irq;
417 err = request_irq(hw->irq, nuc900_spi_irq, 0, pdev->name, hw);
418 if (err) {
419 dev_err(&pdev->dev, "Cannot claim IRQ\n");
420 goto err_irq;
423 hw->clk = clk_get(&pdev->dev, "spi");
424 if (IS_ERR(hw->clk)) {
425 dev_err(&pdev->dev, "No clock for device\n");
426 err = PTR_ERR(hw->clk);
427 goto err_clk;
430 mfp_set_groupg(&pdev->dev, NULL);
431 nuc900_init_spi(hw);
433 err = spi_bitbang_start(&hw->bitbang);
434 if (err) {
435 dev_err(&pdev->dev, "Failed to register SPI master\n");
436 goto err_register;
439 return 0;
441 err_register:
442 clk_disable(hw->clk);
443 clk_put(hw->clk);
444 err_clk:
445 free_irq(hw->irq, hw);
446 err_irq:
447 iounmap(hw->regs);
448 err_iomap:
449 release_mem_region(hw->res->start, resource_size(hw->res));
450 kfree(hw->ioarea);
451 err_pdata:
452 spi_master_put(hw->master);
454 err_nomem:
455 return err;
458 static int __devexit nuc900_spi_remove(struct platform_device *dev)
460 struct nuc900_spi *hw = platform_get_drvdata(dev);
462 free_irq(hw->irq, hw);
464 platform_set_drvdata(dev, NULL);
466 spi_bitbang_stop(&hw->bitbang);
468 clk_disable(hw->clk);
469 clk_put(hw->clk);
471 iounmap(hw->regs);
473 release_mem_region(hw->res->start, resource_size(hw->res));
474 kfree(hw->ioarea);
476 spi_master_put(hw->master);
477 return 0;
480 static struct platform_driver nuc900_spi_driver = {
481 .probe = nuc900_spi_probe,
482 .remove = __devexit_p(nuc900_spi_remove),
483 .driver = {
484 .name = "nuc900-spi",
485 .owner = THIS_MODULE,
488 module_platform_driver(nuc900_spi_driver);
490 MODULE_AUTHOR("Wan ZongShun <mcuos.com@gmail.com>");
491 MODULE_DESCRIPTION("nuc900 spi driver!");
492 MODULE_LICENSE("GPL");
493 MODULE_ALIAS("platform:nuc900-spi");