blob: 1569f7defc7354b7a5b96cd3b26f2b018307287e [file] [log] [blame]
Kumar Galaccf06992006-05-20 15:00:15 -07001/*
Mingkai Hub36ece82010-10-12 18:18:31 +08002 * Freescale SPI controller driver.
Kumar Galaccf06992006-05-20 15:00:15 -07003 *
4 * Maintainer: Kumar Gala
5 *
6 * Copyright (C) 2006 Polycom, Inc.
Mingkai Hub36ece82010-10-12 18:18:31 +08007 * Copyright 2010 Freescale Semiconductor, Inc.
Kumar Galaccf06992006-05-20 15:00:15 -07008 *
Anton Vorontsov4c1fba442009-10-12 20:49:27 +04009 * CPM SPI and QE buffer descriptors mode support:
10 * Copyright (c) 2009 MontaVista Software, Inc.
11 * Author: Anton Vorontsov <avorontsov@ru.mvista.com>
12 *
Kumar Galaccf06992006-05-20 15:00:15 -070013 * This program is free software; you can redistribute it and/or modify it
14 * under the terms of the GNU General Public License as published by the
15 * Free Software Foundation; either version 2 of the License, or (at your
16 * option) any later version.
17 */
18#include <linux/module.h>
Kumar Galaccf06992006-05-20 15:00:15 -070019#include <linux/types.h>
20#include <linux/kernel.h>
Kumar Galaccf06992006-05-20 15:00:15 -070021#include <linux/interrupt.h>
22#include <linux/delay.h>
23#include <linux/irq.h>
Kumar Galaccf06992006-05-20 15:00:15 -070024#include <linux/spi/spi.h>
25#include <linux/spi/spi_bitbang.h>
26#include <linux/platform_device.h>
27#include <linux/fsl_devices.h>
Anton Vorontsov4c1fba442009-10-12 20:49:27 +040028#include <linux/dma-mapping.h>
29#include <linux/mm.h>
30#include <linux/mutex.h>
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -070031#include <linux/of.h>
32#include <linux/of_platform.h>
Andreas Larssone8beacb2013-02-15 16:52:21 +010033#include <linux/of_address.h>
34#include <linux/of_irq.h>
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -070035#include <linux/gpio.h>
36#include <linux/of_gpio.h>
Kumar Galaccf06992006-05-20 15:00:15 -070037
Grant Likelyca632f52011-06-06 01:16:30 -060038#include "spi-fsl-lib.h"
Andreas Larssone8beacb2013-02-15 16:52:21 +010039#include "spi-fsl-cpm.h"
40#include "spi-fsl-spi.h"
Kumar Galaccf06992006-05-20 15:00:15 -070041
Mingkai Hub36ece82010-10-12 18:18:31 +080042static void fsl_spi_change_mode(struct spi_device *spi)
Anton Vorontsova35c1712009-10-12 20:49:24 +040043{
44 struct mpc8xxx_spi *mspi = spi_master_get_devdata(spi->master);
45 struct spi_mpc8xxx_cs *cs = spi->controller_state;
Mingkai Hub36ece82010-10-12 18:18:31 +080046 struct fsl_spi_reg *reg_base = mspi->reg_base;
47 __be32 __iomem *mode = &reg_base->mode;
Anton Vorontsova35c1712009-10-12 20:49:24 +040048 unsigned long flags;
49
50 if (cs->hw_mode == mpc8xxx_spi_read_reg(mode))
51 return;
52
53 /* Turn off IRQs locally to minimize time that SPI is disabled. */
54 local_irq_save(flags);
55
56 /* Turn off SPI unit prior changing mode */
57 mpc8xxx_spi_write_reg(mode, cs->hw_mode & ~SPMODE_ENABLE);
Anton Vorontsova35c1712009-10-12 20:49:24 +040058
Anton Vorontsov4c1fba442009-10-12 20:49:27 +040059 /* When in CPM mode, we need to reinit tx and rx. */
60 if (mspi->flags & SPI_CPM_MODE) {
Andreas Larssone8beacb2013-02-15 16:52:21 +010061 fsl_spi_cpm_reinit_txrx(mspi);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +040062 }
Joakim Tjernlundf9218c22010-05-22 02:18:02 -060063 mpc8xxx_spi_write_reg(mode, cs->hw_mode);
Anton Vorontsova35c1712009-10-12 20:49:24 +040064 local_irq_restore(flags);
65}
66
Mingkai Hub36ece82010-10-12 18:18:31 +080067static void fsl_spi_chipselect(struct spi_device *spi, int value)
Kumar Galaccf06992006-05-20 15:00:15 -070068{
Anton Vorontsov575c5802009-06-18 16:49:08 -070069 struct mpc8xxx_spi *mpc8xxx_spi = spi_master_get_devdata(spi->master);
Kenth Eriksson5039a862012-03-30 17:05:30 +020070 struct fsl_spi_platform_data *pdata;
Anton Vorontsov364fdbc2009-03-31 15:24:36 -070071 bool pol = spi->mode & SPI_CS_HIGH;
Anton Vorontsov575c5802009-06-18 16:49:08 -070072 struct spi_mpc8xxx_cs *cs = spi->controller_state;
Kumar Galaccf06992006-05-20 15:00:15 -070073
Kenth Eriksson5039a862012-03-30 17:05:30 +020074 pdata = spi->dev.parent->parent->platform_data;
75
Kumar Galaccf06992006-05-20 15:00:15 -070076 if (value == BITBANG_CS_INACTIVE) {
Anton Vorontsov364fdbc2009-03-31 15:24:36 -070077 if (pdata->cs_control)
78 pdata->cs_control(spi, !pol);
Kumar Galaccf06992006-05-20 15:00:15 -070079 }
80
81 if (value == BITBANG_CS_ACTIVE) {
Anton Vorontsov575c5802009-06-18 16:49:08 -070082 mpc8xxx_spi->rx_shift = cs->rx_shift;
83 mpc8xxx_spi->tx_shift = cs->tx_shift;
84 mpc8xxx_spi->get_rx = cs->get_rx;
85 mpc8xxx_spi->get_tx = cs->get_tx;
Kumar Galaccf06992006-05-20 15:00:15 -070086
Mingkai Hub36ece82010-10-12 18:18:31 +080087 fsl_spi_change_mode(spi);
Kumar Galaccf06992006-05-20 15:00:15 -070088
Anton Vorontsov364fdbc2009-03-31 15:24:36 -070089 if (pdata->cs_control)
90 pdata->cs_control(spi, pol);
Kumar Galaccf06992006-05-20 15:00:15 -070091 }
92}
93
Mingkai Hub36ece82010-10-12 18:18:31 +080094static int mspi_apply_cpu_mode_quirks(struct spi_mpc8xxx_cs *cs,
95 struct spi_device *spi,
96 struct mpc8xxx_spi *mpc8xxx_spi,
97 int bits_per_word)
Joakim Tjernlund0398fb72010-05-14 09:14:26 +000098{
99 cs->rx_shift = 0;
100 cs->tx_shift = 0;
101 if (bits_per_word <= 8) {
102 cs->get_rx = mpc8xxx_spi_rx_buf_u8;
103 cs->get_tx = mpc8xxx_spi_tx_buf_u8;
104 if (mpc8xxx_spi->flags & SPI_QE_CPU_MODE) {
105 cs->rx_shift = 16;
106 cs->tx_shift = 24;
107 }
108 } else if (bits_per_word <= 16) {
109 cs->get_rx = mpc8xxx_spi_rx_buf_u16;
110 cs->get_tx = mpc8xxx_spi_tx_buf_u16;
111 if (mpc8xxx_spi->flags & SPI_QE_CPU_MODE) {
112 cs->rx_shift = 16;
113 cs->tx_shift = 16;
114 }
115 } else if (bits_per_word <= 32) {
116 cs->get_rx = mpc8xxx_spi_rx_buf_u32;
117 cs->get_tx = mpc8xxx_spi_tx_buf_u32;
118 } else
119 return -EINVAL;
120
121 if (mpc8xxx_spi->flags & SPI_QE_CPU_MODE &&
122 spi->mode & SPI_LSB_FIRST) {
123 cs->tx_shift = 0;
124 if (bits_per_word <= 8)
125 cs->rx_shift = 8;
126 else
127 cs->rx_shift = 0;
128 }
129 mpc8xxx_spi->rx_shift = cs->rx_shift;
130 mpc8xxx_spi->tx_shift = cs->tx_shift;
131 mpc8xxx_spi->get_rx = cs->get_rx;
132 mpc8xxx_spi->get_tx = cs->get_tx;
133
134 return bits_per_word;
135}
136
Mingkai Hub36ece82010-10-12 18:18:31 +0800137static int mspi_apply_qe_mode_quirks(struct spi_mpc8xxx_cs *cs,
138 struct spi_device *spi,
139 int bits_per_word)
Joakim Tjernlund0398fb72010-05-14 09:14:26 +0000140{
141 /* QE uses Little Endian for words > 8
142 * so transform all words > 8 into 8 bits
143 * Unfortnatly that doesn't work for LSB so
144 * reject these for now */
145 /* Note: 32 bits word, LSB works iff
146 * tfcr/rfcr is set to CPMFCR_GBL */
147 if (spi->mode & SPI_LSB_FIRST &&
148 bits_per_word > 8)
149 return -EINVAL;
150 if (bits_per_word > 8)
151 return 8; /* pretend its 8 bits */
152 return bits_per_word;
153}
154
Mingkai Hub36ece82010-10-12 18:18:31 +0800155static int fsl_spi_setup_transfer(struct spi_device *spi,
156 struct spi_transfer *t)
Kumar Galaccf06992006-05-20 15:00:15 -0700157{
Anton Vorontsov575c5802009-06-18 16:49:08 -0700158 struct mpc8xxx_spi *mpc8xxx_spi;
Mingkai Hub36ece82010-10-12 18:18:31 +0800159 int bits_per_word = 0;
Joakim Tjernlund0398fb72010-05-14 09:14:26 +0000160 u8 pm;
Mingkai Hub36ece82010-10-12 18:18:31 +0800161 u32 hz = 0;
Anton Vorontsov575c5802009-06-18 16:49:08 -0700162 struct spi_mpc8xxx_cs *cs = spi->controller_state;
Kumar Galaccf06992006-05-20 15:00:15 -0700163
Anton Vorontsov575c5802009-06-18 16:49:08 -0700164 mpc8xxx_spi = spi_master_get_devdata(spi->master);
Kumar Galaccf06992006-05-20 15:00:15 -0700165
166 if (t) {
167 bits_per_word = t->bits_per_word;
168 hz = t->speed_hz;
Kumar Galaccf06992006-05-20 15:00:15 -0700169 }
170
171 /* spi_transfer level calls that work per-word */
172 if (!bits_per_word)
173 bits_per_word = spi->bits_per_word;
174
175 /* Make sure its a bit width we support [4..16, 32] */
176 if ((bits_per_word < 4)
177 || ((bits_per_word > 16) && (bits_per_word != 32)))
178 return -EINVAL;
179
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700180 if (!hz)
181 hz = spi->max_speed_hz;
182
Joakim Tjernlund0398fb72010-05-14 09:14:26 +0000183 if (!(mpc8xxx_spi->flags & SPI_CPM_MODE))
184 bits_per_word = mspi_apply_cpu_mode_quirks(cs, spi,
185 mpc8xxx_spi,
186 bits_per_word);
187 else if (mpc8xxx_spi->flags & SPI_QE)
188 bits_per_word = mspi_apply_qe_mode_quirks(cs, spi,
189 bits_per_word);
Kumar Galaccf06992006-05-20 15:00:15 -0700190
Joakim Tjernlund0398fb72010-05-14 09:14:26 +0000191 if (bits_per_word < 0)
192 return bits_per_word;
Kumar Galaccf06992006-05-20 15:00:15 -0700193
194 if (bits_per_word == 32)
195 bits_per_word = 0;
196 else
197 bits_per_word = bits_per_word - 1;
198
Anton Vorontsov32421da2007-07-31 00:38:41 -0700199 /* mask out bits we are going to set */
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700200 cs->hw_mode &= ~(SPMODE_LEN(0xF) | SPMODE_DIV16
201 | SPMODE_PM(0xF));
Kumar Galaccf06992006-05-20 15:00:15 -0700202
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700203 cs->hw_mode |= SPMODE_LEN(bits_per_word);
Kumar Galaccf06992006-05-20 15:00:15 -0700204
Anton Vorontsov575c5802009-06-18 16:49:08 -0700205 if ((mpc8xxx_spi->spibrg / hz) > 64) {
Peter Korsgaard53604db2008-09-13 02:33:14 -0700206 cs->hw_mode |= SPMODE_DIV16;
Ernst Schwab4f4517c2010-02-16 21:02:57 -0700207 pm = (mpc8xxx_spi->spibrg - 1) / (hz * 64) + 1;
Anton Vorontsovfd8a11e2009-06-18 16:49:01 -0700208
209 WARN_ONCE(pm > 16, "%s: Requested speed is too low: %d Hz. "
210 "Will use %d Hz instead.\n", dev_name(&spi->dev),
Anton Vorontsov575c5802009-06-18 16:49:08 -0700211 hz, mpc8xxx_spi->spibrg / 1024);
Anton Vorontsovfd8a11e2009-06-18 16:49:01 -0700212 if (pm > 16)
Peter Korsgaard53604db2008-09-13 02:33:14 -0700213 pm = 16;
Mingkai Hub36ece82010-10-12 18:18:31 +0800214 } else {
Ernst Schwab4f4517c2010-02-16 21:02:57 -0700215 pm = (mpc8xxx_spi->spibrg - 1) / (hz * 4) + 1;
Mingkai Hub36ece82010-10-12 18:18:31 +0800216 }
Chen Gonga61f5342008-07-23 21:29:52 -0700217 if (pm)
218 pm--;
219
220 cs->hw_mode |= SPMODE_PM(pm);
David Brownelldccd5732007-07-17 04:04:02 -0700221
Mingkai Hub36ece82010-10-12 18:18:31 +0800222 fsl_spi_change_mode(spi);
Kumar Galaccf06992006-05-20 15:00:15 -0700223 return 0;
224}
225
Mingkai Hub36ece82010-10-12 18:18:31 +0800226static int fsl_spi_cpu_bufs(struct mpc8xxx_spi *mspi,
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400227 struct spi_transfer *t, unsigned int len)
228{
229 u32 word;
Mingkai Hub36ece82010-10-12 18:18:31 +0800230 struct fsl_spi_reg *reg_base = mspi->reg_base;
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400231
232 mspi->count = len;
233
234 /* enable rx ints */
Mingkai Hub36ece82010-10-12 18:18:31 +0800235 mpc8xxx_spi_write_reg(&reg_base->mask, SPIM_NE);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400236
237 /* transmit word */
238 word = mspi->get_tx(mspi);
Mingkai Hub36ece82010-10-12 18:18:31 +0800239 mpc8xxx_spi_write_reg(&reg_base->transmit, word);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400240
241 return 0;
242}
243
Mingkai Hub36ece82010-10-12 18:18:31 +0800244static int fsl_spi_bufs(struct spi_device *spi, struct spi_transfer *t,
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400245 bool is_dma_mapped)
246{
247 struct mpc8xxx_spi *mpc8xxx_spi = spi_master_get_devdata(spi->master);
Mingkai Hub36ece82010-10-12 18:18:31 +0800248 struct fsl_spi_reg *reg_base;
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400249 unsigned int len = t->len;
250 u8 bits_per_word;
251 int ret;
252
Mingkai Hub36ece82010-10-12 18:18:31 +0800253 reg_base = mpc8xxx_spi->reg_base;
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700254 bits_per_word = spi->bits_per_word;
255 if (t->bits_per_word)
256 bits_per_word = t->bits_per_word;
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400257
Peter Korsgaardaa77d962008-09-13 02:33:15 -0700258 if (bits_per_word > 8) {
259 /* invalid length? */
260 if (len & 1)
261 return -EINVAL;
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700262 len /= 2;
Peter Korsgaardaa77d962008-09-13 02:33:15 -0700263 }
264 if (bits_per_word > 16) {
265 /* invalid length? */
266 if (len & 1)
267 return -EINVAL;
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700268 len /= 2;
Peter Korsgaardaa77d962008-09-13 02:33:15 -0700269 }
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400270
271 mpc8xxx_spi->tx = t->tx_buf;
272 mpc8xxx_spi->rx = t->rx_buf;
Peter Korsgaardaa77d962008-09-13 02:33:15 -0700273
Anton Vorontsov575c5802009-06-18 16:49:08 -0700274 INIT_COMPLETION(mpc8xxx_spi->done);
Kumar Galaccf06992006-05-20 15:00:15 -0700275
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400276 if (mpc8xxx_spi->flags & SPI_CPM_MODE)
Mingkai Hub36ece82010-10-12 18:18:31 +0800277 ret = fsl_spi_cpm_bufs(mpc8xxx_spi, t, is_dma_mapped);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400278 else
Mingkai Hub36ece82010-10-12 18:18:31 +0800279 ret = fsl_spi_cpu_bufs(mpc8xxx_spi, t, len);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400280 if (ret)
281 return ret;
Kumar Galaccf06992006-05-20 15:00:15 -0700282
Anton Vorontsov575c5802009-06-18 16:49:08 -0700283 wait_for_completion(&mpc8xxx_spi->done);
Kumar Galaccf06992006-05-20 15:00:15 -0700284
285 /* disable rx ints */
Mingkai Hub36ece82010-10-12 18:18:31 +0800286 mpc8xxx_spi_write_reg(&reg_base->mask, 0);
Kumar Galaccf06992006-05-20 15:00:15 -0700287
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400288 if (mpc8xxx_spi->flags & SPI_CPM_MODE)
Mingkai Hub36ece82010-10-12 18:18:31 +0800289 fsl_spi_cpm_bufs_complete(mpc8xxx_spi);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400290
Anton Vorontsov575c5802009-06-18 16:49:08 -0700291 return mpc8xxx_spi->count;
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700292}
293
Mingkai Hub36ece82010-10-12 18:18:31 +0800294static void fsl_spi_do_one_msg(struct spi_message *m)
Anton Vorontsovb9b9af12009-06-18 16:49:06 -0700295{
296 struct spi_device *spi = m->spi;
297 struct spi_transfer *t;
298 unsigned int cs_change;
299 const int nsecs = 50;
300 int status;
301
302 cs_change = 1;
303 status = 0;
304 list_for_each_entry(t, &m->transfers, transfer_list) {
305 if (t->bits_per_word || t->speed_hz) {
306 /* Don't allow changes if CS is active */
307 status = -EINVAL;
308
309 if (cs_change)
Mingkai Hub36ece82010-10-12 18:18:31 +0800310 status = fsl_spi_setup_transfer(spi, t);
Anton Vorontsovb9b9af12009-06-18 16:49:06 -0700311 if (status < 0)
312 break;
313 }
314
315 if (cs_change) {
Mingkai Hub36ece82010-10-12 18:18:31 +0800316 fsl_spi_chipselect(spi, BITBANG_CS_ACTIVE);
Anton Vorontsovb9b9af12009-06-18 16:49:06 -0700317 ndelay(nsecs);
318 }
319 cs_change = t->cs_change;
320 if (t->len)
Mingkai Hub36ece82010-10-12 18:18:31 +0800321 status = fsl_spi_bufs(spi, t, m->is_dma_mapped);
Anton Vorontsovb9b9af12009-06-18 16:49:06 -0700322 if (status) {
323 status = -EMSGSIZE;
324 break;
325 }
326 m->actual_length += t->len;
327
328 if (t->delay_usecs)
329 udelay(t->delay_usecs);
330
331 if (cs_change) {
332 ndelay(nsecs);
Mingkai Hub36ece82010-10-12 18:18:31 +0800333 fsl_spi_chipselect(spi, BITBANG_CS_INACTIVE);
Anton Vorontsovb9b9af12009-06-18 16:49:06 -0700334 ndelay(nsecs);
335 }
336 }
337
338 m->status = status;
339 m->complete(m->context);
340
341 if (status || !cs_change) {
342 ndelay(nsecs);
Mingkai Hub36ece82010-10-12 18:18:31 +0800343 fsl_spi_chipselect(spi, BITBANG_CS_INACTIVE);
Anton Vorontsovb9b9af12009-06-18 16:49:06 -0700344 }
345
Mingkai Hub36ece82010-10-12 18:18:31 +0800346 fsl_spi_setup_transfer(spi, NULL);
Anton Vorontsovb9b9af12009-06-18 16:49:06 -0700347}
348
Mingkai Hub36ece82010-10-12 18:18:31 +0800349static int fsl_spi_setup(struct spi_device *spi)
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700350{
Anton Vorontsov575c5802009-06-18 16:49:08 -0700351 struct mpc8xxx_spi *mpc8xxx_spi;
Mingkai Hub36ece82010-10-12 18:18:31 +0800352 struct fsl_spi_reg *reg_base;
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700353 int retval;
354 u32 hw_mode;
Anton Vorontsov575c5802009-06-18 16:49:08 -0700355 struct spi_mpc8xxx_cs *cs = spi->controller_state;
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700356
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700357 if (!spi->max_speed_hz)
358 return -EINVAL;
359
360 if (!cs) {
361 cs = kzalloc(sizeof *cs, GFP_KERNEL);
362 if (!cs)
363 return -ENOMEM;
364 spi->controller_state = cs;
365 }
Anton Vorontsov575c5802009-06-18 16:49:08 -0700366 mpc8xxx_spi = spi_master_get_devdata(spi->master);
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700367
Mingkai Hub36ece82010-10-12 18:18:31 +0800368 reg_base = mpc8xxx_spi->reg_base;
369
Thomas Weber88393162010-03-16 11:47:56 +0100370 hw_mode = cs->hw_mode; /* Save original settings */
Mingkai Hub36ece82010-10-12 18:18:31 +0800371 cs->hw_mode = mpc8xxx_spi_read_reg(&reg_base->mode);
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700372 /* mask out bits we are going to set */
373 cs->hw_mode &= ~(SPMODE_CP_BEGIN_EDGECLK | SPMODE_CI_INACTIVEHIGH
374 | SPMODE_REV | SPMODE_LOOP);
375
376 if (spi->mode & SPI_CPHA)
377 cs->hw_mode |= SPMODE_CP_BEGIN_EDGECLK;
378 if (spi->mode & SPI_CPOL)
379 cs->hw_mode |= SPMODE_CI_INACTIVEHIGH;
380 if (!(spi->mode & SPI_LSB_FIRST))
381 cs->hw_mode |= SPMODE_REV;
382 if (spi->mode & SPI_LOOP)
383 cs->hw_mode |= SPMODE_LOOP;
384
Mingkai Hub36ece82010-10-12 18:18:31 +0800385 retval = fsl_spi_setup_transfer(spi, NULL);
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700386 if (retval < 0) {
387 cs->hw_mode = hw_mode; /* Restore settings */
388 return retval;
389 }
Andreas Larssonf482cd02013-02-15 16:52:22 +0100390
391 /* Initialize chipselect - might be active for SPI_CS_HIGH mode */
392 fsl_spi_chipselect(spi, BITBANG_CS_INACTIVE);
393
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700394 return 0;
Kumar Galaccf06992006-05-20 15:00:15 -0700395}
396
Mingkai Hub36ece82010-10-12 18:18:31 +0800397static void fsl_spi_cpu_irq(struct mpc8xxx_spi *mspi, u32 events)
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400398{
Mingkai Hub36ece82010-10-12 18:18:31 +0800399 struct fsl_spi_reg *reg_base = mspi->reg_base;
400
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400401 /* We need handle RX first */
402 if (events & SPIE_NE) {
Mingkai Hub36ece82010-10-12 18:18:31 +0800403 u32 rx_data = mpc8xxx_spi_read_reg(&reg_base->receive);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400404
405 if (mspi->rx)
406 mspi->get_rx(rx_data, mspi);
407 }
408
409 if ((events & SPIE_NF) == 0)
410 /* spin until TX is done */
411 while (((events =
Mingkai Hub36ece82010-10-12 18:18:31 +0800412 mpc8xxx_spi_read_reg(&reg_base->event)) &
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400413 SPIE_NF) == 0)
414 cpu_relax();
415
416 /* Clear the events */
Mingkai Hub36ece82010-10-12 18:18:31 +0800417 mpc8xxx_spi_write_reg(&reg_base->event, events);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400418
419 mspi->count -= 1;
420 if (mspi->count) {
421 u32 word = mspi->get_tx(mspi);
422
Mingkai Hub36ece82010-10-12 18:18:31 +0800423 mpc8xxx_spi_write_reg(&reg_base->transmit, word);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400424 } else {
425 complete(&mspi->done);
426 }
427}
428
Mingkai Hub36ece82010-10-12 18:18:31 +0800429static irqreturn_t fsl_spi_irq(s32 irq, void *context_data)
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400430{
431 struct mpc8xxx_spi *mspi = context_data;
432 irqreturn_t ret = IRQ_NONE;
433 u32 events;
Mingkai Hub36ece82010-10-12 18:18:31 +0800434 struct fsl_spi_reg *reg_base = mspi->reg_base;
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400435
436 /* Get interrupt events(tx/rx) */
Mingkai Hub36ece82010-10-12 18:18:31 +0800437 events = mpc8xxx_spi_read_reg(&reg_base->event);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400438 if (events)
439 ret = IRQ_HANDLED;
440
441 dev_dbg(mspi->dev, "%s: events %x\n", __func__, events);
442
443 if (mspi->flags & SPI_CPM_MODE)
Mingkai Hub36ece82010-10-12 18:18:31 +0800444 fsl_spi_cpm_irq(mspi, events);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400445 else
Mingkai Hub36ece82010-10-12 18:18:31 +0800446 fsl_spi_cpu_irq(mspi, events);
Kumar Galaccf06992006-05-20 15:00:15 -0700447
448 return ret;
449}
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400450
Mingkai Hub36ece82010-10-12 18:18:31 +0800451static void fsl_spi_remove(struct mpc8xxx_spi *mspi)
Anton Vorontsov87ec0e92009-10-12 20:49:25 +0400452{
Mingkai Hub36ece82010-10-12 18:18:31 +0800453 iounmap(mspi->reg_base);
454 fsl_spi_cpm_free(mspi);
Anton Vorontsov87ec0e92009-10-12 20:49:25 +0400455}
456
Grant Likelyfd4a3192012-12-07 16:57:14 +0000457static struct spi_master * fsl_spi_probe(struct device *dev,
Mingkai Hub36ece82010-10-12 18:18:31 +0800458 struct resource *mem, unsigned int irq)
Kumar Galaccf06992006-05-20 15:00:15 -0700459{
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700460 struct fsl_spi_platform_data *pdata = dev->platform_data;
Kumar Galaccf06992006-05-20 15:00:15 -0700461 struct spi_master *master;
Anton Vorontsov575c5802009-06-18 16:49:08 -0700462 struct mpc8xxx_spi *mpc8xxx_spi;
Mingkai Hub36ece82010-10-12 18:18:31 +0800463 struct fsl_spi_reg *reg_base;
Kumar Galaccf06992006-05-20 15:00:15 -0700464 u32 regval;
465 int ret = 0;
466
Anton Vorontsov575c5802009-06-18 16:49:08 -0700467 master = spi_alloc_master(dev, sizeof(struct mpc8xxx_spi));
Kumar Galaccf06992006-05-20 15:00:15 -0700468 if (master == NULL) {
469 ret = -ENOMEM;
470 goto err;
471 }
472
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700473 dev_set_drvdata(dev, master);
Kumar Galaccf06992006-05-20 15:00:15 -0700474
Mingkai Hub36ece82010-10-12 18:18:31 +0800475 ret = mpc8xxx_spi_probe(dev, mem, irq);
476 if (ret)
477 goto err_probe;
David Brownelle7db06b2009-06-17 16:26:04 -0700478
Mingkai Hub36ece82010-10-12 18:18:31 +0800479 master->setup = fsl_spi_setup;
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700480
Anton Vorontsov575c5802009-06-18 16:49:08 -0700481 mpc8xxx_spi = spi_master_get_devdata(master);
Mingkai Hub36ece82010-10-12 18:18:31 +0800482 mpc8xxx_spi->spi_do_one_msg = fsl_spi_do_one_msg;
483 mpc8xxx_spi->spi_remove = fsl_spi_remove;
Anton Vorontsove24a4d12007-08-10 13:01:01 -0700484
Mingkai Hub36ece82010-10-12 18:18:31 +0800485
486 ret = fsl_spi_cpm_init(mpc8xxx_spi);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400487 if (ret)
488 goto err_cpm_init;
489
Anton Vorontsov87ec0e92009-10-12 20:49:25 +0400490 if (mpc8xxx_spi->flags & SPI_QE_CPU_MODE) {
Anton Vorontsov575c5802009-06-18 16:49:08 -0700491 mpc8xxx_spi->rx_shift = 16;
492 mpc8xxx_spi->tx_shift = 24;
Joakim Tjernlundf29ba282007-07-17 04:04:12 -0700493 }
494
Mingkai Hub36ece82010-10-12 18:18:31 +0800495 mpc8xxx_spi->reg_base = ioremap(mem->start, resource_size(mem));
496 if (mpc8xxx_spi->reg_base == NULL) {
Kumar Galaccf06992006-05-20 15:00:15 -0700497 ret = -ENOMEM;
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400498 goto err_ioremap;
Kumar Galaccf06992006-05-20 15:00:15 -0700499 }
500
Kumar Galaccf06992006-05-20 15:00:15 -0700501 /* Register for SPI Interrupt */
Mingkai Hub36ece82010-10-12 18:18:31 +0800502 ret = request_irq(mpc8xxx_spi->irq, fsl_spi_irq,
503 0, "fsl_spi", mpc8xxx_spi);
Kumar Galaccf06992006-05-20 15:00:15 -0700504
505 if (ret != 0)
Mingkai Hub36ece82010-10-12 18:18:31 +0800506 goto free_irq;
Kumar Galaccf06992006-05-20 15:00:15 -0700507
Mingkai Hub36ece82010-10-12 18:18:31 +0800508 reg_base = mpc8xxx_spi->reg_base;
Kumar Galaccf06992006-05-20 15:00:15 -0700509
510 /* SPI controller initializations */
Mingkai Hub36ece82010-10-12 18:18:31 +0800511 mpc8xxx_spi_write_reg(&reg_base->mode, 0);
512 mpc8xxx_spi_write_reg(&reg_base->mask, 0);
513 mpc8xxx_spi_write_reg(&reg_base->command, 0);
514 mpc8xxx_spi_write_reg(&reg_base->event, 0xffffffff);
Kumar Galaccf06992006-05-20 15:00:15 -0700515
516 /* Enable SPI interface */
517 regval = pdata->initial_spmode | SPMODE_INIT_VAL | SPMODE_ENABLE;
Anton Vorontsov87ec0e92009-10-12 20:49:25 +0400518 if (mpc8xxx_spi->flags & SPI_QE_CPU_MODE)
Joakim Tjernlundf29ba282007-07-17 04:04:12 -0700519 regval |= SPMODE_OP;
520
Mingkai Hub36ece82010-10-12 18:18:31 +0800521 mpc8xxx_spi_write_reg(&reg_base->mode, regval);
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700522
523 ret = spi_register_master(master);
524 if (ret < 0)
525 goto unreg_master;
Kumar Galaccf06992006-05-20 15:00:15 -0700526
Mingkai Hub36ece82010-10-12 18:18:31 +0800527 dev_info(dev, "at 0x%p (irq = %d), %s mode\n", reg_base,
Anton Vorontsov87ec0e92009-10-12 20:49:25 +0400528 mpc8xxx_spi->irq, mpc8xxx_spi_strmode(mpc8xxx_spi->flags));
Kumar Galaccf06992006-05-20 15:00:15 -0700529
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700530 return master;
Kumar Galaccf06992006-05-20 15:00:15 -0700531
Joakim Tjernlundc9bfcb32008-05-12 14:02:30 -0700532unreg_master:
Anton Vorontsov575c5802009-06-18 16:49:08 -0700533 free_irq(mpc8xxx_spi->irq, mpc8xxx_spi);
Mingkai Hub36ece82010-10-12 18:18:31 +0800534free_irq:
535 iounmap(mpc8xxx_spi->reg_base);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400536err_ioremap:
Mingkai Hub36ece82010-10-12 18:18:31 +0800537 fsl_spi_cpm_free(mpc8xxx_spi);
Anton Vorontsov4c1fba442009-10-12 20:49:27 +0400538err_cpm_init:
Mingkai Hub36ece82010-10-12 18:18:31 +0800539err_probe:
Kumar Galaccf06992006-05-20 15:00:15 -0700540 spi_master_put(master);
Kumar Galaccf06992006-05-20 15:00:15 -0700541err:
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700542 return ERR_PTR(ret);
Kumar Galaccf06992006-05-20 15:00:15 -0700543}
544
Mingkai Hub36ece82010-10-12 18:18:31 +0800545static void fsl_spi_cs_control(struct spi_device *spi, bool on)
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700546{
Herton Ronaldo Krzesinski067aa482012-05-11 15:29:50 -0700547 struct device *dev = spi->dev.parent->parent;
Anton Vorontsov575c5802009-06-18 16:49:08 -0700548 struct mpc8xxx_spi_probe_info *pinfo = to_of_pinfo(dev->platform_data);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700549 u16 cs = spi->chip_select;
550 int gpio = pinfo->gpios[cs];
551 bool alow = pinfo->alow_flags[cs];
552
553 gpio_set_value(gpio, on ^ alow);
554}
555
Mingkai Hub36ece82010-10-12 18:18:31 +0800556static int of_fsl_spi_get_chipselects(struct device *dev)
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700557{
Grant Likely61c7a082010-04-13 16:12:29 -0700558 struct device_node *np = dev->of_node;
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700559 struct fsl_spi_platform_data *pdata = dev->platform_data;
Anton Vorontsov575c5802009-06-18 16:49:08 -0700560 struct mpc8xxx_spi_probe_info *pinfo = to_of_pinfo(pdata);
Grant Likelye80beb22013-02-12 17:48:37 +0000561 int ngpios;
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700562 int i = 0;
563 int ret;
564
565 ngpios = of_gpio_count(np);
Grant Likelye80beb22013-02-12 17:48:37 +0000566 if (ngpios <= 0) {
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700567 /*
568 * SPI w/o chip-select line. One SPI device is still permitted
569 * though.
570 */
571 pdata->max_chipselect = 1;
572 return 0;
573 }
574
Roel Kluin02141542009-06-16 15:31:15 -0700575 pinfo->gpios = kmalloc(ngpios * sizeof(*pinfo->gpios), GFP_KERNEL);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700576 if (!pinfo->gpios)
577 return -ENOMEM;
Roel Kluin02141542009-06-16 15:31:15 -0700578 memset(pinfo->gpios, -1, ngpios * sizeof(*pinfo->gpios));
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700579
Roel Kluin02141542009-06-16 15:31:15 -0700580 pinfo->alow_flags = kzalloc(ngpios * sizeof(*pinfo->alow_flags),
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700581 GFP_KERNEL);
582 if (!pinfo->alow_flags) {
583 ret = -ENOMEM;
584 goto err_alloc_flags;
585 }
586
587 for (; i < ngpios; i++) {
588 int gpio;
589 enum of_gpio_flags flags;
590
591 gpio = of_get_gpio_flags(np, i, &flags);
592 if (!gpio_is_valid(gpio)) {
593 dev_err(dev, "invalid gpio #%d: %d\n", i, gpio);
Anton Vorontsov783058f2009-10-12 20:49:22 +0400594 ret = gpio;
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700595 goto err_loop;
596 }
597
598 ret = gpio_request(gpio, dev_name(dev));
599 if (ret) {
600 dev_err(dev, "can't request gpio #%d: %d\n", i, ret);
601 goto err_loop;
602 }
603
604 pinfo->gpios[i] = gpio;
605 pinfo->alow_flags[i] = flags & OF_GPIO_ACTIVE_LOW;
606
607 ret = gpio_direction_output(pinfo->gpios[i],
608 pinfo->alow_flags[i]);
609 if (ret) {
610 dev_err(dev, "can't set output direction for gpio "
611 "#%d: %d\n", i, ret);
612 goto err_loop;
613 }
614 }
615
616 pdata->max_chipselect = ngpios;
Mingkai Hub36ece82010-10-12 18:18:31 +0800617 pdata->cs_control = fsl_spi_cs_control;
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700618
619 return 0;
620
621err_loop:
622 while (i >= 0) {
623 if (gpio_is_valid(pinfo->gpios[i]))
624 gpio_free(pinfo->gpios[i]);
625 i--;
626 }
627
628 kfree(pinfo->alow_flags);
629 pinfo->alow_flags = NULL;
630err_alloc_flags:
631 kfree(pinfo->gpios);
632 pinfo->gpios = NULL;
633 return ret;
634}
635
Mingkai Hub36ece82010-10-12 18:18:31 +0800636static int of_fsl_spi_free_chipselects(struct device *dev)
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700637{
638 struct fsl_spi_platform_data *pdata = dev->platform_data;
Anton Vorontsov575c5802009-06-18 16:49:08 -0700639 struct mpc8xxx_spi_probe_info *pinfo = to_of_pinfo(pdata);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700640 int i;
641
642 if (!pinfo->gpios)
643 return 0;
644
645 for (i = 0; i < pdata->max_chipselect; i++) {
646 if (gpio_is_valid(pinfo->gpios[i]))
647 gpio_free(pinfo->gpios[i]);
648 }
649
650 kfree(pinfo->gpios);
651 kfree(pinfo->alow_flags);
652 return 0;
653}
654
Grant Likelyfd4a3192012-12-07 16:57:14 +0000655static int of_fsl_spi_probe(struct platform_device *ofdev)
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700656{
657 struct device *dev = &ofdev->dev;
Grant Likely61c7a082010-04-13 16:12:29 -0700658 struct device_node *np = ofdev->dev.of_node;
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700659 struct spi_master *master;
660 struct resource mem;
Andreas Larssone8beacb2013-02-15 16:52:21 +0100661 int irq;
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700662 int ret = -ENOMEM;
663
Grant Likely18d306d2011-02-22 21:02:43 -0700664 ret = of_mpc8xxx_spi_probe(ofdev);
Mingkai Hub36ece82010-10-12 18:18:31 +0800665 if (ret)
666 return ret;
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700667
Mingkai Hub36ece82010-10-12 18:18:31 +0800668 ret = of_fsl_spi_get_chipselects(dev);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700669 if (ret)
670 goto err;
671
672 ret = of_address_to_resource(np, 0, &mem);
673 if (ret)
674 goto err;
675
Andreas Larssone8beacb2013-02-15 16:52:21 +0100676 irq = irq_of_parse_and_map(np, 0);
677 if (!irq) {
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700678 ret = -EINVAL;
679 goto err;
680 }
681
Andreas Larssone8beacb2013-02-15 16:52:21 +0100682 master = fsl_spi_probe(dev, &mem, irq);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700683 if (IS_ERR(master)) {
684 ret = PTR_ERR(master);
685 goto err;
686 }
687
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700688 return 0;
689
690err:
Mingkai Hub36ece82010-10-12 18:18:31 +0800691 of_fsl_spi_free_chipselects(dev);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700692 return ret;
693}
694
Grant Likelyfd4a3192012-12-07 16:57:14 +0000695static int of_fsl_spi_remove(struct platform_device *ofdev)
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700696{
697 int ret;
698
Anton Vorontsov575c5802009-06-18 16:49:08 -0700699 ret = mpc8xxx_spi_remove(&ofdev->dev);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700700 if (ret)
701 return ret;
Mingkai Hub36ece82010-10-12 18:18:31 +0800702 of_fsl_spi_free_chipselects(&ofdev->dev);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700703 return 0;
704}
705
Mingkai Hub36ece82010-10-12 18:18:31 +0800706static const struct of_device_id of_fsl_spi_match[] = {
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700707 { .compatible = "fsl,spi" },
Mingkai Hub36ece82010-10-12 18:18:31 +0800708 {}
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700709};
Mingkai Hub36ece82010-10-12 18:18:31 +0800710MODULE_DEVICE_TABLE(of, of_fsl_spi_match);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700711
Grant Likely18d306d2011-02-22 21:02:43 -0700712static struct platform_driver of_fsl_spi_driver = {
Grant Likely40182942010-04-13 16:13:02 -0700713 .driver = {
Mingkai Hub36ece82010-10-12 18:18:31 +0800714 .name = "fsl_spi",
Grant Likely40182942010-04-13 16:13:02 -0700715 .owner = THIS_MODULE,
Mingkai Hub36ece82010-10-12 18:18:31 +0800716 .of_match_table = of_fsl_spi_match,
Grant Likely40182942010-04-13 16:13:02 -0700717 },
Mingkai Hub36ece82010-10-12 18:18:31 +0800718 .probe = of_fsl_spi_probe,
Grant Likelyfd4a3192012-12-07 16:57:14 +0000719 .remove = of_fsl_spi_remove,
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700720};
721
722#ifdef CONFIG_MPC832x_RDB
723/*
Mingkai Hub36ece82010-10-12 18:18:31 +0800724 * XXX XXX XXX
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700725 * This is "legacy" platform driver, was used by the MPC8323E-RDB boards
726 * only. The driver should go away soon, since newer MPC8323E-RDB's device
727 * tree can work with OpenFirmware driver. But for now we support old trees
728 * as well.
729 */
Grant Likelyfd4a3192012-12-07 16:57:14 +0000730static int plat_mpc8xxx_spi_probe(struct platform_device *pdev)
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700731{
732 struct resource *mem;
Uwe Kleine-Könige9a172f2010-01-20 13:49:44 -0700733 int irq;
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700734 struct spi_master *master;
735
736 if (!pdev->dev.platform_data)
737 return -EINVAL;
738
739 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
740 if (!mem)
741 return -EINVAL;
742
743 irq = platform_get_irq(pdev, 0);
Uwe Kleine-Könige9a172f2010-01-20 13:49:44 -0700744 if (irq <= 0)
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700745 return -EINVAL;
746
Mingkai Hub36ece82010-10-12 18:18:31 +0800747 master = fsl_spi_probe(&pdev->dev, mem, irq);
Alexandru Gheorghiue4d43782013-03-14 11:07:31 +0200748 return PTR_RET(master);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700749}
750
Grant Likelyfd4a3192012-12-07 16:57:14 +0000751static int plat_mpc8xxx_spi_remove(struct platform_device *pdev)
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700752{
Anton Vorontsov575c5802009-06-18 16:49:08 -0700753 return mpc8xxx_spi_remove(&pdev->dev);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700754}
755
Anton Vorontsov575c5802009-06-18 16:49:08 -0700756MODULE_ALIAS("platform:mpc8xxx_spi");
757static struct platform_driver mpc8xxx_spi_driver = {
758 .probe = plat_mpc8xxx_spi_probe,
Grant Likelyfd4a3192012-12-07 16:57:14 +0000759 .remove = plat_mpc8xxx_spi_remove,
Kumar Galaccf06992006-05-20 15:00:15 -0700760 .driver = {
Anton Vorontsov575c5802009-06-18 16:49:08 -0700761 .name = "mpc8xxx_spi",
Kay Sievers7e38c3c2008-04-10 21:29:20 -0700762 .owner = THIS_MODULE,
Kumar Galaccf06992006-05-20 15:00:15 -0700763 },
764};
765
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700766static bool legacy_driver_failed;
767
768static void __init legacy_driver_register(void)
769{
Anton Vorontsov575c5802009-06-18 16:49:08 -0700770 legacy_driver_failed = platform_driver_register(&mpc8xxx_spi_driver);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700771}
772
773static void __exit legacy_driver_unregister(void)
774{
775 if (legacy_driver_failed)
776 return;
Anton Vorontsov575c5802009-06-18 16:49:08 -0700777 platform_driver_unregister(&mpc8xxx_spi_driver);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700778}
779#else
780static void __init legacy_driver_register(void) {}
781static void __exit legacy_driver_unregister(void) {}
782#endif /* CONFIG_MPC832x_RDB */
783
Mingkai Hub36ece82010-10-12 18:18:31 +0800784static int __init fsl_spi_init(void)
Kumar Galaccf06992006-05-20 15:00:15 -0700785{
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700786 legacy_driver_register();
Grant Likely18d306d2011-02-22 21:02:43 -0700787 return platform_driver_register(&of_fsl_spi_driver);
Kumar Galaccf06992006-05-20 15:00:15 -0700788}
Mingkai Hub36ece82010-10-12 18:18:31 +0800789module_init(fsl_spi_init);
Kumar Galaccf06992006-05-20 15:00:15 -0700790
Mingkai Hub36ece82010-10-12 18:18:31 +0800791static void __exit fsl_spi_exit(void)
Kumar Galaccf06992006-05-20 15:00:15 -0700792{
Grant Likely18d306d2011-02-22 21:02:43 -0700793 platform_driver_unregister(&of_fsl_spi_driver);
Anton Vorontsov35b4b3c2009-03-31 15:24:37 -0700794 legacy_driver_unregister();
Kumar Galaccf06992006-05-20 15:00:15 -0700795}
Mingkai Hub36ece82010-10-12 18:18:31 +0800796module_exit(fsl_spi_exit);
Kumar Galaccf06992006-05-20 15:00:15 -0700797
798MODULE_AUTHOR("Kumar Gala");
Mingkai Hub36ece82010-10-12 18:18:31 +0800799MODULE_DESCRIPTION("Simple Freescale SPI Driver");
Kumar Galaccf06992006-05-20 15:00:15 -0700800MODULE_LICENSE("GPL");