OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / spi / spi-imx.c
blobc6e697f5e007a7642db7e30e6025160bf783ded9
1 /*
2 * Copyright 2004-2007 Freescale Semiconductor, Inc. All Rights Reserved.
3 * Copyright (C) 2008 Juergen Beisert
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License
7 * as published by the Free Software Foundation; either version 2
8 * of the License, or (at your option) any later version.
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the
16 * Free Software Foundation
17 * 51 Franklin Street, Fifth Floor
18 * Boston, MA 02110-1301, USA.
21 #include <linux/clk.h>
22 #include <linux/completion.h>
23 #include <linux/delay.h>
24 #include <linux/err.h>
25 #include <linux/gpio.h>
26 #include <linux/init.h>
27 #include <linux/interrupt.h>
28 #include <linux/io.h>
29 #include <linux/irq.h>
30 #include <linux/kernel.h>
31 #include <linux/module.h>
32 #include <linux/platform_device.h>
33 #include <linux/slab.h>
34 #include <linux/spi/spi.h>
35 #include <linux/spi/spi_bitbang.h>
36 #include <linux/types.h>
37 #include <linux/of.h>
38 #include <linux/of_device.h>
39 #include <linux/of_gpio.h>
41 #include <mach/spi.h>
43 #define DRIVER_NAME "spi_imx"
45 #define MXC_CSPIRXDATA 0x00
46 #define MXC_CSPITXDATA 0x04
47 #define MXC_CSPICTRL 0x08
48 #define MXC_CSPIINT 0x0c
49 #define MXC_RESET 0x1c
51 /* generic defines to abstract from the different register layouts */
52 #define MXC_INT_RR (1 << 0) /* Receive data ready interrupt */
53 #define MXC_INT_TE (1 << 1) /* Transmit FIFO empty interrupt */
55 struct spi_imx_config {
56 unsigned int speed_hz;
57 unsigned int bpw;
58 unsigned int mode;
59 u8 cs;
62 enum spi_imx_devtype {
63 IMX1_CSPI,
64 IMX21_CSPI,
65 IMX27_CSPI,
66 IMX31_CSPI,
67 IMX35_CSPI, /* CSPI on all i.mx except above */
68 IMX51_ECSPI, /* ECSPI on i.mx51 and later */
71 struct spi_imx_data;
73 struct spi_imx_devtype_data {
74 void (*intctrl)(struct spi_imx_data *, int);
75 int (*config)(struct spi_imx_data *, struct spi_imx_config *);
76 void (*trigger)(struct spi_imx_data *);
77 int (*rx_available)(struct spi_imx_data *);
78 void (*reset)(struct spi_imx_data *);
79 enum spi_imx_devtype devtype;
82 struct spi_imx_data {
83 struct spi_bitbang bitbang;
85 struct completion xfer_done;
86 void *base;
87 int irq;
88 struct clk *clk;
89 unsigned long spi_clk;
91 unsigned int count;
92 void (*tx)(struct spi_imx_data *);
93 void (*rx)(struct spi_imx_data *);
94 void *rx_buf;
95 const void *tx_buf;
96 unsigned int txfifo; /* number of words pushed in tx FIFO */
98 struct spi_imx_devtype_data *devtype_data;
99 int chipselect[0];
102 static inline int is_imx27_cspi(struct spi_imx_data *d)
104 return d->devtype_data->devtype == IMX27_CSPI;
107 static inline int is_imx35_cspi(struct spi_imx_data *d)
109 return d->devtype_data->devtype == IMX35_CSPI;
112 static inline unsigned spi_imx_get_fifosize(struct spi_imx_data *d)
114 return (d->devtype_data->devtype == IMX51_ECSPI) ? 64 : 8;
117 #define MXC_SPI_BUF_RX(type) \
118 static void spi_imx_buf_rx_##type(struct spi_imx_data *spi_imx) \
120 unsigned int val = readl(spi_imx->base + MXC_CSPIRXDATA); \
122 if (spi_imx->rx_buf) { \
123 *(type *)spi_imx->rx_buf = val; \
124 spi_imx->rx_buf += sizeof(type); \
128 #define MXC_SPI_BUF_TX(type) \
129 static void spi_imx_buf_tx_##type(struct spi_imx_data *spi_imx) \
131 type val = 0; \
133 if (spi_imx->tx_buf) { \
134 val = *(type *)spi_imx->tx_buf; \
135 spi_imx->tx_buf += sizeof(type); \
138 spi_imx->count -= sizeof(type); \
140 writel(val, spi_imx->base + MXC_CSPITXDATA); \
143 MXC_SPI_BUF_RX(u8)
144 MXC_SPI_BUF_TX(u8)
145 MXC_SPI_BUF_RX(u16)
146 MXC_SPI_BUF_TX(u16)
147 MXC_SPI_BUF_RX(u32)
148 MXC_SPI_BUF_TX(u32)
150 /* First entry is reserved, second entry is valid only if SDHC_SPIEN is set
151 * (which is currently not the case in this driver)
153 static int mxc_clkdivs[] = {0, 3, 4, 6, 8, 12, 16, 24, 32, 48, 64, 96, 128, 192,
154 256, 384, 512, 768, 1024};
156 /* MX21, MX27 */
157 static unsigned int spi_imx_clkdiv_1(unsigned int fin,
158 unsigned int fspi, unsigned int max)
160 int i;
162 for (i = 2; i < max; i++)
163 if (fspi * mxc_clkdivs[i] >= fin)
164 return i;
166 return max;
169 /* MX1, MX31, MX35, MX51 CSPI */
170 static unsigned int spi_imx_clkdiv_2(unsigned int fin,
171 unsigned int fspi)
173 int i, div = 4;
175 for (i = 0; i < 7; i++) {
176 if (fspi * div >= fin)
177 return i;
178 div <<= 1;
181 return 7;
184 #define MX51_ECSPI_CTRL 0x08
185 #define MX51_ECSPI_CTRL_ENABLE (1 << 0)
186 #define MX51_ECSPI_CTRL_XCH (1 << 2)
187 #define MX51_ECSPI_CTRL_MODE_MASK (0xf << 4)
188 #define MX51_ECSPI_CTRL_POSTDIV_OFFSET 8
189 #define MX51_ECSPI_CTRL_PREDIV_OFFSET 12
190 #define MX51_ECSPI_CTRL_CS(cs) ((cs) << 18)
191 #define MX51_ECSPI_CTRL_BL_OFFSET 20
193 #define MX51_ECSPI_CONFIG 0x0c
194 #define MX51_ECSPI_CONFIG_SCLKPHA(cs) (1 << ((cs) + 0))
195 #define MX51_ECSPI_CONFIG_SCLKPOL(cs) (1 << ((cs) + 4))
196 #define MX51_ECSPI_CONFIG_SBBCTRL(cs) (1 << ((cs) + 8))
197 #define MX51_ECSPI_CONFIG_SSBPOL(cs) (1 << ((cs) + 12))
199 #define MX51_ECSPI_INT 0x10
200 #define MX51_ECSPI_INT_TEEN (1 << 0)
201 #define MX51_ECSPI_INT_RREN (1 << 3)
203 #define MX51_ECSPI_STAT 0x18
204 #define MX51_ECSPI_STAT_RR (1 << 3)
206 /* MX51 eCSPI */
207 static unsigned int mx51_ecspi_clkdiv(unsigned int fin, unsigned int fspi)
210 * there are two 4-bit dividers, the pre-divider divides by
211 * $pre, the post-divider by 2^$post
213 unsigned int pre, post;
215 if (unlikely(fspi > fin))
216 return 0;
218 post = fls(fin) - fls(fspi);
219 if (fin > fspi << post)
220 post++;
222 /* now we have: (fin <= fspi << post) with post being minimal */
224 post = max(4U, post) - 4;
225 if (unlikely(post > 0xf)) {
226 pr_err("%s: cannot set clock freq: %u (base freq: %u)\n",
227 __func__, fspi, fin);
228 return 0xff;
231 pre = DIV_ROUND_UP(fin, fspi << post) - 1;
233 pr_debug("%s: fin: %u, fspi: %u, post: %u, pre: %u\n",
234 __func__, fin, fspi, post, pre);
235 return (pre << MX51_ECSPI_CTRL_PREDIV_OFFSET) |
236 (post << MX51_ECSPI_CTRL_POSTDIV_OFFSET);
239 static void __maybe_unused mx51_ecspi_intctrl(struct spi_imx_data *spi_imx, int enable)
241 unsigned val = 0;
243 if (enable & MXC_INT_TE)
244 val |= MX51_ECSPI_INT_TEEN;
246 if (enable & MXC_INT_RR)
247 val |= MX51_ECSPI_INT_RREN;
249 writel(val, spi_imx->base + MX51_ECSPI_INT);
252 static void __maybe_unused mx51_ecspi_trigger(struct spi_imx_data *spi_imx)
254 u32 reg;
256 reg = readl(spi_imx->base + MX51_ECSPI_CTRL);
257 reg |= MX51_ECSPI_CTRL_XCH;
258 writel(reg, spi_imx->base + MX51_ECSPI_CTRL);
261 static int __maybe_unused mx51_ecspi_config(struct spi_imx_data *spi_imx,
262 struct spi_imx_config *config)
264 u32 ctrl = MX51_ECSPI_CTRL_ENABLE, cfg = 0;
267 * The hardware seems to have a race condition when changing modes. The
268 * current assumption is that the selection of the channel arrives
269 * earlier in the hardware than the mode bits when they are written at
270 * the same time.
271 * So set master mode for all channels as we do not support slave mode.
273 ctrl |= MX51_ECSPI_CTRL_MODE_MASK;
275 /* set clock speed */
276 ctrl |= mx51_ecspi_clkdiv(spi_imx->spi_clk, config->speed_hz);
278 /* set chip select to use */
279 ctrl |= MX51_ECSPI_CTRL_CS(config->cs);
281 ctrl |= (config->bpw - 1) << MX51_ECSPI_CTRL_BL_OFFSET;
283 cfg |= MX51_ECSPI_CONFIG_SBBCTRL(config->cs);
285 if (config->mode & SPI_CPHA)
286 cfg |= MX51_ECSPI_CONFIG_SCLKPHA(config->cs);
288 if (config->mode & SPI_CPOL)
289 cfg |= MX51_ECSPI_CONFIG_SCLKPOL(config->cs);
291 if (config->mode & SPI_CS_HIGH)
292 cfg |= MX51_ECSPI_CONFIG_SSBPOL(config->cs);
294 writel(ctrl, spi_imx->base + MX51_ECSPI_CTRL);
295 writel(cfg, spi_imx->base + MX51_ECSPI_CONFIG);
297 return 0;
300 static int __maybe_unused mx51_ecspi_rx_available(struct spi_imx_data *spi_imx)
302 return readl(spi_imx->base + MX51_ECSPI_STAT) & MX51_ECSPI_STAT_RR;
305 static void __maybe_unused mx51_ecspi_reset(struct spi_imx_data *spi_imx)
307 /* drain receive buffer */
308 while (mx51_ecspi_rx_available(spi_imx))
309 readl(spi_imx->base + MXC_CSPIRXDATA);
312 #define MX31_INTREG_TEEN (1 << 0)
313 #define MX31_INTREG_RREN (1 << 3)
315 #define MX31_CSPICTRL_ENABLE (1 << 0)
316 #define MX31_CSPICTRL_MASTER (1 << 1)
317 #define MX31_CSPICTRL_XCH (1 << 2)
318 #define MX31_CSPICTRL_POL (1 << 4)
319 #define MX31_CSPICTRL_PHA (1 << 5)
320 #define MX31_CSPICTRL_SSCTL (1 << 6)
321 #define MX31_CSPICTRL_SSPOL (1 << 7)
322 #define MX31_CSPICTRL_BC_SHIFT 8
323 #define MX35_CSPICTRL_BL_SHIFT 20
324 #define MX31_CSPICTRL_CS_SHIFT 24
325 #define MX35_CSPICTRL_CS_SHIFT 12
326 #define MX31_CSPICTRL_DR_SHIFT 16
328 #define MX31_CSPISTATUS 0x14
329 #define MX31_STATUS_RR (1 << 3)
331 /* These functions also work for the i.MX35, but be aware that
332 * the i.MX35 has a slightly different register layout for bits
333 * we do not use here.
335 static void __maybe_unused mx31_intctrl(struct spi_imx_data *spi_imx, int enable)
337 unsigned int val = 0;
339 if (enable & MXC_INT_TE)
340 val |= MX31_INTREG_TEEN;
341 if (enable & MXC_INT_RR)
342 val |= MX31_INTREG_RREN;
344 writel(val, spi_imx->base + MXC_CSPIINT);
347 static void __maybe_unused mx31_trigger(struct spi_imx_data *spi_imx)
349 unsigned int reg;
351 reg = readl(spi_imx->base + MXC_CSPICTRL);
352 reg |= MX31_CSPICTRL_XCH;
353 writel(reg, spi_imx->base + MXC_CSPICTRL);
356 static int __maybe_unused mx31_config(struct spi_imx_data *spi_imx,
357 struct spi_imx_config *config)
359 unsigned int reg = MX31_CSPICTRL_ENABLE | MX31_CSPICTRL_MASTER;
360 int cs = spi_imx->chipselect[config->cs];
362 reg |= spi_imx_clkdiv_2(spi_imx->spi_clk, config->speed_hz) <<
363 MX31_CSPICTRL_DR_SHIFT;
365 if (is_imx35_cspi(spi_imx)) {
366 reg |= (config->bpw - 1) << MX35_CSPICTRL_BL_SHIFT;
367 reg |= MX31_CSPICTRL_SSCTL;
368 } else {
369 reg |= (config->bpw - 1) << MX31_CSPICTRL_BC_SHIFT;
372 if (config->mode & SPI_CPHA)
373 reg |= MX31_CSPICTRL_PHA;
374 if (config->mode & SPI_CPOL)
375 reg |= MX31_CSPICTRL_POL;
376 if (config->mode & SPI_CS_HIGH)
377 reg |= MX31_CSPICTRL_SSPOL;
378 if (cs < 0)
379 reg |= (cs + 32) <<
380 (is_imx35_cspi(spi_imx) ? MX35_CSPICTRL_CS_SHIFT :
381 MX31_CSPICTRL_CS_SHIFT);
383 writel(reg, spi_imx->base + MXC_CSPICTRL);
385 return 0;
388 static int __maybe_unused mx31_rx_available(struct spi_imx_data *spi_imx)
390 return readl(spi_imx->base + MX31_CSPISTATUS) & MX31_STATUS_RR;
393 static void __maybe_unused mx31_reset(struct spi_imx_data *spi_imx)
395 /* drain receive buffer */
396 while (readl(spi_imx->base + MX31_CSPISTATUS) & MX31_STATUS_RR)
397 readl(spi_imx->base + MXC_CSPIRXDATA);
400 #define MX21_INTREG_RR (1 << 4)
401 #define MX21_INTREG_TEEN (1 << 9)
402 #define MX21_INTREG_RREN (1 << 13)
404 #define MX21_CSPICTRL_POL (1 << 5)
405 #define MX21_CSPICTRL_PHA (1 << 6)
406 #define MX21_CSPICTRL_SSPOL (1 << 8)
407 #define MX21_CSPICTRL_XCH (1 << 9)
408 #define MX21_CSPICTRL_ENABLE (1 << 10)
409 #define MX21_CSPICTRL_MASTER (1 << 11)
410 #define MX21_CSPICTRL_DR_SHIFT 14
411 #define MX21_CSPICTRL_CS_SHIFT 19
413 static void __maybe_unused mx21_intctrl(struct spi_imx_data *spi_imx, int enable)
415 unsigned int val = 0;
417 if (enable & MXC_INT_TE)
418 val |= MX21_INTREG_TEEN;
419 if (enable & MXC_INT_RR)
420 val |= MX21_INTREG_RREN;
422 writel(val, spi_imx->base + MXC_CSPIINT);
425 static void __maybe_unused mx21_trigger(struct spi_imx_data *spi_imx)
427 unsigned int reg;
429 reg = readl(spi_imx->base + MXC_CSPICTRL);
430 reg |= MX21_CSPICTRL_XCH;
431 writel(reg, spi_imx->base + MXC_CSPICTRL);
434 static int __maybe_unused mx21_config(struct spi_imx_data *spi_imx,
435 struct spi_imx_config *config)
437 unsigned int reg = MX21_CSPICTRL_ENABLE | MX21_CSPICTRL_MASTER;
438 int cs = spi_imx->chipselect[config->cs];
439 unsigned int max = is_imx27_cspi(spi_imx) ? 16 : 18;
441 reg |= spi_imx_clkdiv_1(spi_imx->spi_clk, config->speed_hz, max) <<
442 MX21_CSPICTRL_DR_SHIFT;
443 reg |= config->bpw - 1;
445 if (config->mode & SPI_CPHA)
446 reg |= MX21_CSPICTRL_PHA;
447 if (config->mode & SPI_CPOL)
448 reg |= MX21_CSPICTRL_POL;
449 if (config->mode & SPI_CS_HIGH)
450 reg |= MX21_CSPICTRL_SSPOL;
451 if (cs < 0)
452 reg |= (cs + 32) << MX21_CSPICTRL_CS_SHIFT;
454 writel(reg, spi_imx->base + MXC_CSPICTRL);
456 return 0;
459 static int __maybe_unused mx21_rx_available(struct spi_imx_data *spi_imx)
461 return readl(spi_imx->base + MXC_CSPIINT) & MX21_INTREG_RR;
464 static void __maybe_unused mx21_reset(struct spi_imx_data *spi_imx)
466 writel(1, spi_imx->base + MXC_RESET);
469 #define MX1_INTREG_RR (1 << 3)
470 #define MX1_INTREG_TEEN (1 << 8)
471 #define MX1_INTREG_RREN (1 << 11)
473 #define MX1_CSPICTRL_POL (1 << 4)
474 #define MX1_CSPICTRL_PHA (1 << 5)
475 #define MX1_CSPICTRL_XCH (1 << 8)
476 #define MX1_CSPICTRL_ENABLE (1 << 9)
477 #define MX1_CSPICTRL_MASTER (1 << 10)
478 #define MX1_CSPICTRL_DR_SHIFT 13
480 static void __maybe_unused mx1_intctrl(struct spi_imx_data *spi_imx, int enable)
482 unsigned int val = 0;
484 if (enable & MXC_INT_TE)
485 val |= MX1_INTREG_TEEN;
486 if (enable & MXC_INT_RR)
487 val |= MX1_INTREG_RREN;
489 writel(val, spi_imx->base + MXC_CSPIINT);
492 static void __maybe_unused mx1_trigger(struct spi_imx_data *spi_imx)
494 unsigned int reg;
496 reg = readl(spi_imx->base + MXC_CSPICTRL);
497 reg |= MX1_CSPICTRL_XCH;
498 writel(reg, spi_imx->base + MXC_CSPICTRL);
501 static int __maybe_unused mx1_config(struct spi_imx_data *spi_imx,
502 struct spi_imx_config *config)
504 unsigned int reg = MX1_CSPICTRL_ENABLE | MX1_CSPICTRL_MASTER;
506 reg |= spi_imx_clkdiv_2(spi_imx->spi_clk, config->speed_hz) <<
507 MX1_CSPICTRL_DR_SHIFT;
508 reg |= config->bpw - 1;
510 if (config->mode & SPI_CPHA)
511 reg |= MX1_CSPICTRL_PHA;
512 if (config->mode & SPI_CPOL)
513 reg |= MX1_CSPICTRL_POL;
515 writel(reg, spi_imx->base + MXC_CSPICTRL);
517 return 0;
520 static int __maybe_unused mx1_rx_available(struct spi_imx_data *spi_imx)
522 return readl(spi_imx->base + MXC_CSPIINT) & MX1_INTREG_RR;
525 static void __maybe_unused mx1_reset(struct spi_imx_data *spi_imx)
527 writel(1, spi_imx->base + MXC_RESET);
530 static struct spi_imx_devtype_data imx1_cspi_devtype_data = {
531 .intctrl = mx1_intctrl,
532 .config = mx1_config,
533 .trigger = mx1_trigger,
534 .rx_available = mx1_rx_available,
535 .reset = mx1_reset,
536 .devtype = IMX1_CSPI,
539 static struct spi_imx_devtype_data imx21_cspi_devtype_data = {
540 .intctrl = mx21_intctrl,
541 .config = mx21_config,
542 .trigger = mx21_trigger,
543 .rx_available = mx21_rx_available,
544 .reset = mx21_reset,
545 .devtype = IMX21_CSPI,
548 static struct spi_imx_devtype_data imx27_cspi_devtype_data = {
549 /* i.mx27 cspi shares the functions with i.mx21 one */
550 .intctrl = mx21_intctrl,
551 .config = mx21_config,
552 .trigger = mx21_trigger,
553 .rx_available = mx21_rx_available,
554 .reset = mx21_reset,
555 .devtype = IMX27_CSPI,
558 static struct spi_imx_devtype_data imx31_cspi_devtype_data = {
559 .intctrl = mx31_intctrl,
560 .config = mx31_config,
561 .trigger = mx31_trigger,
562 .rx_available = mx31_rx_available,
563 .reset = mx31_reset,
564 .devtype = IMX31_CSPI,
567 static struct spi_imx_devtype_data imx35_cspi_devtype_data = {
568 /* i.mx35 and later cspi shares the functions with i.mx31 one */
569 .intctrl = mx31_intctrl,
570 .config = mx31_config,
571 .trigger = mx31_trigger,
572 .rx_available = mx31_rx_available,
573 .reset = mx31_reset,
574 .devtype = IMX35_CSPI,
577 static struct spi_imx_devtype_data imx51_ecspi_devtype_data = {
578 .intctrl = mx51_ecspi_intctrl,
579 .config = mx51_ecspi_config,
580 .trigger = mx51_ecspi_trigger,
581 .rx_available = mx51_ecspi_rx_available,
582 .reset = mx51_ecspi_reset,
583 .devtype = IMX51_ECSPI,
586 static struct platform_device_id spi_imx_devtype[] = {
588 .name = "imx1-cspi",
589 .driver_data = (kernel_ulong_t) &imx1_cspi_devtype_data,
590 }, {
591 .name = "imx21-cspi",
592 .driver_data = (kernel_ulong_t) &imx21_cspi_devtype_data,
593 }, {
594 .name = "imx27-cspi",
595 .driver_data = (kernel_ulong_t) &imx27_cspi_devtype_data,
596 }, {
597 .name = "imx31-cspi",
598 .driver_data = (kernel_ulong_t) &imx31_cspi_devtype_data,
599 }, {
600 .name = "imx35-cspi",
601 .driver_data = (kernel_ulong_t) &imx35_cspi_devtype_data,
602 }, {
603 .name = "imx51-ecspi",
604 .driver_data = (kernel_ulong_t) &imx51_ecspi_devtype_data,
605 }, {
606 /* sentinel */
610 static const struct of_device_id spi_imx_dt_ids[] = {
611 { .compatible = "fsl,imx1-cspi", .data = &imx1_cspi_devtype_data, },
612 { .compatible = "fsl,imx21-cspi", .data = &imx21_cspi_devtype_data, },
613 { .compatible = "fsl,imx27-cspi", .data = &imx27_cspi_devtype_data, },
614 { .compatible = "fsl,imx31-cspi", .data = &imx31_cspi_devtype_data, },
615 { .compatible = "fsl,imx35-cspi", .data = &imx35_cspi_devtype_data, },
616 { .compatible = "fsl,imx51-ecspi", .data = &imx51_ecspi_devtype_data, },
617 { /* sentinel */ }
620 static void spi_imx_chipselect(struct spi_device *spi, int is_active)
622 struct spi_imx_data *spi_imx = spi_master_get_devdata(spi->master);
623 int gpio = spi_imx->chipselect[spi->chip_select];
624 int active = is_active != BITBANG_CS_INACTIVE;
625 int dev_is_lowactive = !(spi->mode & SPI_CS_HIGH);
627 if (gpio < 0)
628 return;
630 gpio_set_value(gpio, dev_is_lowactive ^ active);
633 static void spi_imx_push(struct spi_imx_data *spi_imx)
635 while (spi_imx->txfifo < spi_imx_get_fifosize(spi_imx)) {
636 if (!spi_imx->count)
637 break;
638 spi_imx->tx(spi_imx);
639 spi_imx->txfifo++;
642 spi_imx->devtype_data->trigger(spi_imx);
645 static irqreturn_t spi_imx_isr(int irq, void *dev_id)
647 struct spi_imx_data *spi_imx = dev_id;
649 while (spi_imx->devtype_data->rx_available(spi_imx)) {
650 spi_imx->rx(spi_imx);
651 spi_imx->txfifo--;
654 if (spi_imx->count) {
655 spi_imx_push(spi_imx);
656 return IRQ_HANDLED;
659 if (spi_imx->txfifo) {
660 /* No data left to push, but still waiting for rx data,
661 * enable receive data available interrupt.
663 spi_imx->devtype_data->intctrl(
664 spi_imx, MXC_INT_RR);
665 return IRQ_HANDLED;
668 spi_imx->devtype_data->intctrl(spi_imx, 0);
669 complete(&spi_imx->xfer_done);
671 return IRQ_HANDLED;
674 static int spi_imx_setupxfer(struct spi_device *spi,
675 struct spi_transfer *t)
677 struct spi_imx_data *spi_imx = spi_master_get_devdata(spi->master);
678 struct spi_imx_config config;
680 config.bpw = t ? t->bits_per_word : spi->bits_per_word;
681 config.speed_hz = t ? t->speed_hz : spi->max_speed_hz;
682 config.mode = spi->mode;
683 config.cs = spi->chip_select;
685 if (!config.speed_hz)
686 config.speed_hz = spi->max_speed_hz;
687 if (!config.bpw)
688 config.bpw = spi->bits_per_word;
689 if (!config.speed_hz)
690 config.speed_hz = spi->max_speed_hz;
692 /* Initialize the functions for transfer */
693 if (config.bpw <= 8) {
694 spi_imx->rx = spi_imx_buf_rx_u8;
695 spi_imx->tx = spi_imx_buf_tx_u8;
696 } else if (config.bpw <= 16) {
697 spi_imx->rx = spi_imx_buf_rx_u16;
698 spi_imx->tx = spi_imx_buf_tx_u16;
699 } else if (config.bpw <= 32) {
700 spi_imx->rx = spi_imx_buf_rx_u32;
701 spi_imx->tx = spi_imx_buf_tx_u32;
702 } else
703 BUG();
705 spi_imx->devtype_data->config(spi_imx, &config);
707 return 0;
710 static int spi_imx_transfer(struct spi_device *spi,
711 struct spi_transfer *transfer)
713 struct spi_imx_data *spi_imx = spi_master_get_devdata(spi->master);
715 spi_imx->tx_buf = transfer->tx_buf;
716 spi_imx->rx_buf = transfer->rx_buf;
717 spi_imx->count = transfer->len;
718 spi_imx->txfifo = 0;
720 init_completion(&spi_imx->xfer_done);
722 spi_imx_push(spi_imx);
724 spi_imx->devtype_data->intctrl(spi_imx, MXC_INT_TE);
726 wait_for_completion(&spi_imx->xfer_done);
728 return transfer->len;
731 static int spi_imx_setup(struct spi_device *spi)
733 struct spi_imx_data *spi_imx = spi_master_get_devdata(spi->master);
734 int gpio = spi_imx->chipselect[spi->chip_select];
736 dev_dbg(&spi->dev, "%s: mode %d, %u bpw, %d hz\n", __func__,
737 spi->mode, spi->bits_per_word, spi->max_speed_hz);
739 if (gpio >= 0)
740 gpio_direction_output(gpio, spi->mode & SPI_CS_HIGH ? 0 : 1);
742 spi_imx_chipselect(spi, BITBANG_CS_INACTIVE);
744 return 0;
747 static void spi_imx_cleanup(struct spi_device *spi)
751 static int __devinit spi_imx_probe(struct platform_device *pdev)
753 struct device_node *np = pdev->dev.of_node;
754 const struct of_device_id *of_id =
755 of_match_device(spi_imx_dt_ids, &pdev->dev);
756 struct spi_imx_master *mxc_platform_info =
757 dev_get_platdata(&pdev->dev);
758 struct spi_master *master;
759 struct spi_imx_data *spi_imx;
760 struct resource *res;
761 int i, ret, num_cs;
763 if (!np && !mxc_platform_info) {
764 dev_err(&pdev->dev, "can't get the platform data\n");
765 return -EINVAL;
768 ret = of_property_read_u32(np, "fsl,spi-num-chipselects", &num_cs);
769 if (ret < 0)
770 num_cs = mxc_platform_info->num_chipselect;
772 master = spi_alloc_master(&pdev->dev,
773 sizeof(struct spi_imx_data) + sizeof(int) * num_cs);
774 if (!master)
775 return -ENOMEM;
777 platform_set_drvdata(pdev, master);
779 master->bus_num = pdev->id;
780 master->num_chipselect = num_cs;
782 spi_imx = spi_master_get_devdata(master);
783 spi_imx->bitbang.master = spi_master_get(master);
785 for (i = 0; i < master->num_chipselect; i++) {
786 int cs_gpio = of_get_named_gpio(np, "cs-gpios", i);
787 if (cs_gpio < 0)
788 cs_gpio = mxc_platform_info->chipselect[i];
790 spi_imx->chipselect[i] = cs_gpio;
791 if (cs_gpio < 0)
792 continue;
794 ret = gpio_request(spi_imx->chipselect[i], DRIVER_NAME);
795 if (ret) {
796 while (i > 0) {
797 i--;
798 if (spi_imx->chipselect[i] >= 0)
799 gpio_free(spi_imx->chipselect[i]);
801 dev_err(&pdev->dev, "can't get cs gpios\n");
802 goto out_master_put;
806 spi_imx->bitbang.chipselect = spi_imx_chipselect;
807 spi_imx->bitbang.setup_transfer = spi_imx_setupxfer;
808 spi_imx->bitbang.txrx_bufs = spi_imx_transfer;
809 spi_imx->bitbang.master->setup = spi_imx_setup;
810 spi_imx->bitbang.master->cleanup = spi_imx_cleanup;
811 spi_imx->bitbang.master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH;
813 init_completion(&spi_imx->xfer_done);
815 spi_imx->devtype_data = of_id ? of_id->data :
816 (struct spi_imx_devtype_data *) pdev->id_entry->driver_data;
818 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
819 if (!res) {
820 dev_err(&pdev->dev, "can't get platform resource\n");
821 ret = -ENOMEM;
822 goto out_gpio_free;
825 if (!request_mem_region(res->start, resource_size(res), pdev->name)) {
826 dev_err(&pdev->dev, "request_mem_region failed\n");
827 ret = -EBUSY;
828 goto out_gpio_free;
831 spi_imx->base = ioremap(res->start, resource_size(res));
832 if (!spi_imx->base) {
833 ret = -EINVAL;
834 goto out_release_mem;
837 spi_imx->irq = platform_get_irq(pdev, 0);
838 if (spi_imx->irq < 0) {
839 ret = -EINVAL;
840 goto out_iounmap;
843 ret = request_irq(spi_imx->irq, spi_imx_isr, 0, DRIVER_NAME, spi_imx);
844 if (ret) {
845 dev_err(&pdev->dev, "can't get irq%d: %d\n", spi_imx->irq, ret);
846 goto out_iounmap;
849 spi_imx->clk = clk_get(&pdev->dev, NULL);
850 if (IS_ERR(spi_imx->clk)) {
851 dev_err(&pdev->dev, "unable to get clock\n");
852 ret = PTR_ERR(spi_imx->clk);
853 goto out_free_irq;
856 clk_enable(spi_imx->clk);
857 spi_imx->spi_clk = clk_get_rate(spi_imx->clk);
859 spi_imx->devtype_data->reset(spi_imx);
861 spi_imx->devtype_data->intctrl(spi_imx, 0);
863 master->dev.of_node = pdev->dev.of_node;
864 ret = spi_bitbang_start(&spi_imx->bitbang);
865 if (ret) {
866 dev_err(&pdev->dev, "bitbang start failed with %d\n", ret);
867 goto out_clk_put;
870 dev_info(&pdev->dev, "probed\n");
872 return ret;
874 out_clk_put:
875 clk_disable(spi_imx->clk);
876 clk_put(spi_imx->clk);
877 out_free_irq:
878 free_irq(spi_imx->irq, spi_imx);
879 out_iounmap:
880 iounmap(spi_imx->base);
881 out_release_mem:
882 release_mem_region(res->start, resource_size(res));
883 out_gpio_free:
884 for (i = 0; i < master->num_chipselect; i++)
885 if (spi_imx->chipselect[i] >= 0)
886 gpio_free(spi_imx->chipselect[i]);
887 out_master_put:
888 spi_master_put(master);
889 kfree(master);
890 platform_set_drvdata(pdev, NULL);
891 return ret;
894 static int __devexit spi_imx_remove(struct platform_device *pdev)
896 struct spi_master *master = platform_get_drvdata(pdev);
897 struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
898 struct spi_imx_data *spi_imx = spi_master_get_devdata(master);
899 int i;
901 spi_bitbang_stop(&spi_imx->bitbang);
903 writel(0, spi_imx->base + MXC_CSPICTRL);
904 clk_disable(spi_imx->clk);
905 clk_put(spi_imx->clk);
906 free_irq(spi_imx->irq, spi_imx);
907 iounmap(spi_imx->base);
909 for (i = 0; i < master->num_chipselect; i++)
910 if (spi_imx->chipselect[i] >= 0)
911 gpio_free(spi_imx->chipselect[i]);
913 spi_master_put(master);
915 release_mem_region(res->start, resource_size(res));
917 platform_set_drvdata(pdev, NULL);
919 return 0;
922 static struct platform_driver spi_imx_driver = {
923 .driver = {
924 .name = DRIVER_NAME,
925 .owner = THIS_MODULE,
926 .of_match_table = spi_imx_dt_ids,
928 .id_table = spi_imx_devtype,
929 .probe = spi_imx_probe,
930 .remove = __devexit_p(spi_imx_remove),
932 module_platform_driver(spi_imx_driver);
934 MODULE_DESCRIPTION("SPI Master Controller driver");
935 MODULE_AUTHOR("Sascha Hauer, Pengutronix");
936 MODULE_LICENSE("GPL");