p4-clockmod: Replace cpu_sibling_mask() with topology_sibling_cpumask()
[linux/fpc-iii.git] / drivers / spi / spi-ath79.c
blobb02eb4ac02180e6cf4633d91590f99b6dbccc2c6
1 /*
2 * SPI controller driver for the Atheros AR71XX/AR724X/AR913X SoCs
4 * Copyright (C) 2009-2011 Gabor Juhos <juhosg@openwrt.org>
6 * This driver has been based on the spi-gpio.c:
7 * Copyright (C) 2006,2008 David Brownell
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 as
11 * published by the Free Software Foundation.
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/delay.h>
18 #include <linux/spinlock.h>
19 #include <linux/platform_device.h>
20 #include <linux/io.h>
21 #include <linux/spi/spi.h>
22 #include <linux/spi/spi_bitbang.h>
23 #include <linux/bitops.h>
24 #include <linux/gpio.h>
25 #include <linux/clk.h>
26 #include <linux/err.h>
28 #include <asm/mach-ath79/ar71xx_regs.h>
29 #include <asm/mach-ath79/ath79_spi_platform.h>
31 #define DRV_NAME "ath79-spi"
33 #define ATH79_SPI_RRW_DELAY_FACTOR 12000
34 #define MHZ (1000 * 1000)
36 struct ath79_spi {
37 struct spi_bitbang bitbang;
38 u32 ioc_base;
39 u32 reg_ctrl;
40 void __iomem *base;
41 struct clk *clk;
42 unsigned rrw_delay;
45 static inline u32 ath79_spi_rr(struct ath79_spi *sp, unsigned reg)
47 return ioread32(sp->base + reg);
50 static inline void ath79_spi_wr(struct ath79_spi *sp, unsigned reg, u32 val)
52 iowrite32(val, sp->base + reg);
55 static inline struct ath79_spi *ath79_spidev_to_sp(struct spi_device *spi)
57 return spi_master_get_devdata(spi->master);
60 static inline void ath79_spi_delay(struct ath79_spi *sp, unsigned nsecs)
62 if (nsecs > sp->rrw_delay)
63 ndelay(nsecs - sp->rrw_delay);
66 static void ath79_spi_chipselect(struct spi_device *spi, int is_active)
68 struct ath79_spi *sp = ath79_spidev_to_sp(spi);
69 int cs_high = (spi->mode & SPI_CS_HIGH) ? is_active : !is_active;
71 if (is_active) {
72 /* set initial clock polarity */
73 if (spi->mode & SPI_CPOL)
74 sp->ioc_base |= AR71XX_SPI_IOC_CLK;
75 else
76 sp->ioc_base &= ~AR71XX_SPI_IOC_CLK;
78 ath79_spi_wr(sp, AR71XX_SPI_REG_IOC, sp->ioc_base);
81 if (spi->chip_select) {
82 struct ath79_spi_controller_data *cdata = spi->controller_data;
84 /* SPI is normally active-low */
85 gpio_set_value(cdata->gpio, cs_high);
86 } else {
87 if (cs_high)
88 sp->ioc_base |= AR71XX_SPI_IOC_CS0;
89 else
90 sp->ioc_base &= ~AR71XX_SPI_IOC_CS0;
92 ath79_spi_wr(sp, AR71XX_SPI_REG_IOC, sp->ioc_base);
97 static void ath79_spi_enable(struct ath79_spi *sp)
99 /* enable GPIO mode */
100 ath79_spi_wr(sp, AR71XX_SPI_REG_FS, AR71XX_SPI_FS_GPIO);
102 /* save CTRL register */
103 sp->reg_ctrl = ath79_spi_rr(sp, AR71XX_SPI_REG_CTRL);
104 sp->ioc_base = ath79_spi_rr(sp, AR71XX_SPI_REG_IOC);
106 /* TODO: setup speed? */
107 ath79_spi_wr(sp, AR71XX_SPI_REG_CTRL, 0x43);
110 static void ath79_spi_disable(struct ath79_spi *sp)
112 /* restore CTRL register */
113 ath79_spi_wr(sp, AR71XX_SPI_REG_CTRL, sp->reg_ctrl);
114 /* disable GPIO mode */
115 ath79_spi_wr(sp, AR71XX_SPI_REG_FS, 0);
118 static int ath79_spi_setup_cs(struct spi_device *spi)
120 struct ath79_spi_controller_data *cdata;
121 int status;
123 cdata = spi->controller_data;
124 if (spi->chip_select && !cdata)
125 return -EINVAL;
127 status = 0;
128 if (spi->chip_select) {
129 unsigned long flags;
131 flags = GPIOF_DIR_OUT;
132 if (spi->mode & SPI_CS_HIGH)
133 flags |= GPIOF_INIT_LOW;
134 else
135 flags |= GPIOF_INIT_HIGH;
137 status = gpio_request_one(cdata->gpio, flags,
138 dev_name(&spi->dev));
141 return status;
144 static void ath79_spi_cleanup_cs(struct spi_device *spi)
146 if (spi->chip_select) {
147 struct ath79_spi_controller_data *cdata = spi->controller_data;
148 gpio_free(cdata->gpio);
152 static int ath79_spi_setup(struct spi_device *spi)
154 int status = 0;
156 if (!spi->controller_state) {
157 status = ath79_spi_setup_cs(spi);
158 if (status)
159 return status;
162 status = spi_bitbang_setup(spi);
163 if (status && !spi->controller_state)
164 ath79_spi_cleanup_cs(spi);
166 return status;
169 static void ath79_spi_cleanup(struct spi_device *spi)
171 ath79_spi_cleanup_cs(spi);
172 spi_bitbang_cleanup(spi);
175 static u32 ath79_spi_txrx_mode0(struct spi_device *spi, unsigned nsecs,
176 u32 word, u8 bits)
178 struct ath79_spi *sp = ath79_spidev_to_sp(spi);
179 u32 ioc = sp->ioc_base;
181 /* clock starts at inactive polarity */
182 for (word <<= (32 - bits); likely(bits); bits--) {
183 u32 out;
185 if (word & (1 << 31))
186 out = ioc | AR71XX_SPI_IOC_DO;
187 else
188 out = ioc & ~AR71XX_SPI_IOC_DO;
190 /* setup MSB (to slave) on trailing edge */
191 ath79_spi_wr(sp, AR71XX_SPI_REG_IOC, out);
192 ath79_spi_delay(sp, nsecs);
193 ath79_spi_wr(sp, AR71XX_SPI_REG_IOC, out | AR71XX_SPI_IOC_CLK);
194 ath79_spi_delay(sp, nsecs);
195 if (bits == 1)
196 ath79_spi_wr(sp, AR71XX_SPI_REG_IOC, out);
198 word <<= 1;
201 return ath79_spi_rr(sp, AR71XX_SPI_REG_RDS);
204 static int ath79_spi_probe(struct platform_device *pdev)
206 struct spi_master *master;
207 struct ath79_spi *sp;
208 struct ath79_spi_platform_data *pdata;
209 struct resource *r;
210 unsigned long rate;
211 int ret;
213 master = spi_alloc_master(&pdev->dev, sizeof(*sp));
214 if (master == NULL) {
215 dev_err(&pdev->dev, "failed to allocate spi master\n");
216 return -ENOMEM;
219 sp = spi_master_get_devdata(master);
220 platform_set_drvdata(pdev, sp);
222 pdata = dev_get_platdata(&pdev->dev);
224 master->bits_per_word_mask = SPI_BPW_RANGE_MASK(1, 32);
225 master->setup = ath79_spi_setup;
226 master->cleanup = ath79_spi_cleanup;
227 if (pdata) {
228 master->bus_num = pdata->bus_num;
229 master->num_chipselect = pdata->num_chipselect;
232 sp->bitbang.master = master;
233 sp->bitbang.chipselect = ath79_spi_chipselect;
234 sp->bitbang.txrx_word[SPI_MODE_0] = ath79_spi_txrx_mode0;
235 sp->bitbang.setup_transfer = spi_bitbang_setup_transfer;
236 sp->bitbang.flags = SPI_CS_HIGH;
238 r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
239 if (r == NULL) {
240 ret = -ENOENT;
241 goto err_put_master;
244 sp->base = devm_ioremap(&pdev->dev, r->start, resource_size(r));
245 if (!sp->base) {
246 ret = -ENXIO;
247 goto err_put_master;
250 sp->clk = devm_clk_get(&pdev->dev, "ahb");
251 if (IS_ERR(sp->clk)) {
252 ret = PTR_ERR(sp->clk);
253 goto err_put_master;
256 ret = clk_enable(sp->clk);
257 if (ret)
258 goto err_put_master;
260 rate = DIV_ROUND_UP(clk_get_rate(sp->clk), MHZ);
261 if (!rate) {
262 ret = -EINVAL;
263 goto err_clk_disable;
266 sp->rrw_delay = ATH79_SPI_RRW_DELAY_FACTOR / rate;
267 dev_dbg(&pdev->dev, "register read/write delay is %u nsecs\n",
268 sp->rrw_delay);
270 ath79_spi_enable(sp);
271 ret = spi_bitbang_start(&sp->bitbang);
272 if (ret)
273 goto err_disable;
275 return 0;
277 err_disable:
278 ath79_spi_disable(sp);
279 err_clk_disable:
280 clk_disable(sp->clk);
281 err_put_master:
282 spi_master_put(sp->bitbang.master);
284 return ret;
287 static int ath79_spi_remove(struct platform_device *pdev)
289 struct ath79_spi *sp = platform_get_drvdata(pdev);
291 spi_bitbang_stop(&sp->bitbang);
292 ath79_spi_disable(sp);
293 clk_disable(sp->clk);
294 spi_master_put(sp->bitbang.master);
296 return 0;
299 static void ath79_spi_shutdown(struct platform_device *pdev)
301 ath79_spi_remove(pdev);
304 static struct platform_driver ath79_spi_driver = {
305 .probe = ath79_spi_probe,
306 .remove = ath79_spi_remove,
307 .shutdown = ath79_spi_shutdown,
308 .driver = {
309 .name = DRV_NAME,
312 module_platform_driver(ath79_spi_driver);
314 MODULE_DESCRIPTION("SPI controller driver for Atheros AR71XX/AR724X/AR913X");
315 MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");
316 MODULE_LICENSE("GPL v2");
317 MODULE_ALIAS("platform:" DRV_NAME);