Commit | Line | Data |
---|---|---|
ccf06998 | 1 | /* |
b36ece83 | 2 | * Freescale SPI controller driver. |
ccf06998 KG |
3 | * |
4 | * Maintainer: Kumar Gala | |
5 | * | |
6 | * Copyright (C) 2006 Polycom, Inc. | |
b36ece83 | 7 | * Copyright 2010 Freescale Semiconductor, Inc. |
ccf06998 | 8 | * |
4c1fba44 AV |
9 | * CPM SPI and QE buffer descriptors mode support: |
10 | * Copyright (c) 2009 MontaVista Software, Inc. | |
11 | * Author: Anton Vorontsov <avorontsov@ru.mvista.com> | |
12 | * | |
447b0c7b AL |
13 | * GRLIB support: |
14 | * Copyright (c) 2012 Aeroflex Gaisler AB. | |
15 | * Author: Andreas Larsson <andreas@gaisler.com> | |
16 | * | |
ccf06998 KG |
17 | * This program is free software; you can redistribute it and/or modify it |
18 | * under the terms of the GNU General Public License as published by the | |
19 | * Free Software Foundation; either version 2 of the License, or (at your | |
20 | * option) any later version. | |
21 | */ | |
22 | #include <linux/module.h> | |
ccf06998 KG |
23 | #include <linux/types.h> |
24 | #include <linux/kernel.h> | |
ccf06998 KG |
25 | #include <linux/interrupt.h> |
26 | #include <linux/delay.h> | |
27 | #include <linux/irq.h> | |
ccf06998 KG |
28 | #include <linux/spi/spi.h> |
29 | #include <linux/spi/spi_bitbang.h> | |
30 | #include <linux/platform_device.h> | |
31 | #include <linux/fsl_devices.h> | |
4c1fba44 AV |
32 | #include <linux/dma-mapping.h> |
33 | #include <linux/mm.h> | |
34 | #include <linux/mutex.h> | |
35b4b3c0 AV |
35 | #include <linux/of.h> |
36 | #include <linux/of_platform.h> | |
e8beacbb AL |
37 | #include <linux/of_address.h> |
38 | #include <linux/of_irq.h> | |
35b4b3c0 AV |
39 | #include <linux/gpio.h> |
40 | #include <linux/of_gpio.h> | |
ccf06998 | 41 | |
ca632f55 | 42 | #include "spi-fsl-lib.h" |
e8beacbb AL |
43 | #include "spi-fsl-cpm.h" |
44 | #include "spi-fsl-spi.h" | |
ccf06998 | 45 | |
c3f3e771 | 46 | #define TYPE_FSL 0 |
447b0c7b | 47 | #define TYPE_GRLIB 1 |
c3f3e771 AL |
48 | |
49 | struct fsl_spi_match_data { | |
50 | int type; | |
51 | }; | |
52 | ||
53 | static struct fsl_spi_match_data of_fsl_spi_fsl_config = { | |
54 | .type = TYPE_FSL, | |
55 | }; | |
56 | ||
447b0c7b AL |
57 | static struct fsl_spi_match_data of_fsl_spi_grlib_config = { |
58 | .type = TYPE_GRLIB, | |
59 | }; | |
60 | ||
3aea901d | 61 | static const struct of_device_id of_fsl_spi_match[] = { |
c3f3e771 AL |
62 | { |
63 | .compatible = "fsl,spi", | |
64 | .data = &of_fsl_spi_fsl_config, | |
65 | }, | |
447b0c7b AL |
66 | { |
67 | .compatible = "aeroflexgaisler,spictrl", | |
68 | .data = &of_fsl_spi_grlib_config, | |
69 | }, | |
c3f3e771 AL |
70 | {} |
71 | }; | |
72 | MODULE_DEVICE_TABLE(of, of_fsl_spi_match); | |
73 | ||
74 | static int fsl_spi_get_type(struct device *dev) | |
75 | { | |
76 | const struct of_device_id *match; | |
77 | ||
78 | if (dev->of_node) { | |
79 | match = of_match_node(of_fsl_spi_match, dev->of_node); | |
80 | if (match && match->data) | |
81 | return ((struct fsl_spi_match_data *)match->data)->type; | |
82 | } | |
83 | return TYPE_FSL; | |
84 | } | |
85 | ||
b36ece83 | 86 | static void fsl_spi_change_mode(struct spi_device *spi) |
a35c1710 AV |
87 | { |
88 | struct mpc8xxx_spi *mspi = spi_master_get_devdata(spi->master); | |
89 | struct spi_mpc8xxx_cs *cs = spi->controller_state; | |
b36ece83 MH |
90 | struct fsl_spi_reg *reg_base = mspi->reg_base; |
91 | __be32 __iomem *mode = ®_base->mode; | |
a35c1710 AV |
92 | unsigned long flags; |
93 | ||
94 | if (cs->hw_mode == mpc8xxx_spi_read_reg(mode)) | |
95 | return; | |
96 | ||
97 | /* Turn off IRQs locally to minimize time that SPI is disabled. */ | |
98 | local_irq_save(flags); | |
99 | ||
100 | /* Turn off SPI unit prior changing mode */ | |
101 | mpc8xxx_spi_write_reg(mode, cs->hw_mode & ~SPMODE_ENABLE); | |
a35c1710 | 102 | |
4c1fba44 AV |
103 | /* When in CPM mode, we need to reinit tx and rx. */ |
104 | if (mspi->flags & SPI_CPM_MODE) { | |
e8beacbb | 105 | fsl_spi_cpm_reinit_txrx(mspi); |
4c1fba44 | 106 | } |
f9218c2a | 107 | mpc8xxx_spi_write_reg(mode, cs->hw_mode); |
a35c1710 AV |
108 | local_irq_restore(flags); |
109 | } | |
110 | ||
b36ece83 | 111 | static void fsl_spi_chipselect(struct spi_device *spi, int value) |
ccf06998 | 112 | { |
575c5807 | 113 | struct mpc8xxx_spi *mpc8xxx_spi = spi_master_get_devdata(spi->master); |
5039a869 | 114 | struct fsl_spi_platform_data *pdata; |
364fdbc0 | 115 | bool pol = spi->mode & SPI_CS_HIGH; |
575c5807 | 116 | struct spi_mpc8xxx_cs *cs = spi->controller_state; |
ccf06998 | 117 | |
5039a869 KE |
118 | pdata = spi->dev.parent->parent->platform_data; |
119 | ||
ccf06998 | 120 | if (value == BITBANG_CS_INACTIVE) { |
364fdbc0 AV |
121 | if (pdata->cs_control) |
122 | pdata->cs_control(spi, !pol); | |
ccf06998 KG |
123 | } |
124 | ||
125 | if (value == BITBANG_CS_ACTIVE) { | |
575c5807 AV |
126 | mpc8xxx_spi->rx_shift = cs->rx_shift; |
127 | mpc8xxx_spi->tx_shift = cs->tx_shift; | |
128 | mpc8xxx_spi->get_rx = cs->get_rx; | |
129 | mpc8xxx_spi->get_tx = cs->get_tx; | |
c9bfcb31 | 130 | |
b36ece83 | 131 | fsl_spi_change_mode(spi); |
a35c1710 | 132 | |
364fdbc0 AV |
133 | if (pdata->cs_control) |
134 | pdata->cs_control(spi, pol); | |
ccf06998 KG |
135 | } |
136 | } | |
137 | ||
b48c4e3c AL |
138 | static void fsl_spi_qe_cpu_set_shifts(u32 *rx_shift, u32 *tx_shift, |
139 | int bits_per_word, int msb_first) | |
140 | { | |
141 | *rx_shift = 0; | |
142 | *tx_shift = 0; | |
143 | if (msb_first) { | |
144 | if (bits_per_word <= 8) { | |
145 | *rx_shift = 16; | |
146 | *tx_shift = 24; | |
147 | } else if (bits_per_word <= 16) { | |
148 | *rx_shift = 16; | |
149 | *tx_shift = 16; | |
150 | } | |
151 | } else { | |
152 | if (bits_per_word <= 8) | |
153 | *rx_shift = 8; | |
154 | } | |
155 | } | |
156 | ||
447b0c7b AL |
157 | static void fsl_spi_grlib_set_shifts(u32 *rx_shift, u32 *tx_shift, |
158 | int bits_per_word, int msb_first) | |
159 | { | |
160 | *rx_shift = 0; | |
161 | *tx_shift = 0; | |
162 | if (bits_per_word <= 16) { | |
163 | if (msb_first) { | |
164 | *rx_shift = 16; /* LSB in bit 16 */ | |
165 | *tx_shift = 32 - bits_per_word; /* MSB in bit 31 */ | |
166 | } else { | |
167 | *rx_shift = 16 - bits_per_word; /* MSB in bit 15 */ | |
168 | } | |
169 | } | |
170 | } | |
171 | ||
b36ece83 MH |
172 | static int mspi_apply_cpu_mode_quirks(struct spi_mpc8xxx_cs *cs, |
173 | struct spi_device *spi, | |
174 | struct mpc8xxx_spi *mpc8xxx_spi, | |
175 | int bits_per_word) | |
ccf06998 | 176 | { |
c9bfcb31 JT |
177 | cs->rx_shift = 0; |
178 | cs->tx_shift = 0; | |
ccf06998 | 179 | if (bits_per_word <= 8) { |
575c5807 AV |
180 | cs->get_rx = mpc8xxx_spi_rx_buf_u8; |
181 | cs->get_tx = mpc8xxx_spi_tx_buf_u8; | |
ccf06998 | 182 | } else if (bits_per_word <= 16) { |
575c5807 AV |
183 | cs->get_rx = mpc8xxx_spi_rx_buf_u16; |
184 | cs->get_tx = mpc8xxx_spi_tx_buf_u16; | |
ccf06998 | 185 | } else if (bits_per_word <= 32) { |
575c5807 AV |
186 | cs->get_rx = mpc8xxx_spi_rx_buf_u32; |
187 | cs->get_tx = mpc8xxx_spi_tx_buf_u32; | |
ccf06998 KG |
188 | } else |
189 | return -EINVAL; | |
190 | ||
b48c4e3c AL |
191 | if (mpc8xxx_spi->set_shifts) |
192 | mpc8xxx_spi->set_shifts(&cs->rx_shift, &cs->tx_shift, | |
193 | bits_per_word, | |
194 | !(spi->mode & SPI_LSB_FIRST)); | |
195 | ||
575c5807 AV |
196 | mpc8xxx_spi->rx_shift = cs->rx_shift; |
197 | mpc8xxx_spi->tx_shift = cs->tx_shift; | |
198 | mpc8xxx_spi->get_rx = cs->get_rx; | |
199 | mpc8xxx_spi->get_tx = cs->get_tx; | |
ccf06998 | 200 | |
0398fb70 JT |
201 | return bits_per_word; |
202 | } | |
203 | ||
b36ece83 MH |
204 | static int mspi_apply_qe_mode_quirks(struct spi_mpc8xxx_cs *cs, |
205 | struct spi_device *spi, | |
206 | int bits_per_word) | |
0398fb70 JT |
207 | { |
208 | /* QE uses Little Endian for words > 8 | |
209 | * so transform all words > 8 into 8 bits | |
210 | * Unfortnatly that doesn't work for LSB so | |
211 | * reject these for now */ | |
212 | /* Note: 32 bits word, LSB works iff | |
213 | * tfcr/rfcr is set to CPMFCR_GBL */ | |
214 | if (spi->mode & SPI_LSB_FIRST && | |
215 | bits_per_word > 8) | |
216 | return -EINVAL; | |
217 | if (bits_per_word > 8) | |
218 | return 8; /* pretend its 8 bits */ | |
219 | return bits_per_word; | |
220 | } | |
221 | ||
b36ece83 MH |
222 | static int fsl_spi_setup_transfer(struct spi_device *spi, |
223 | struct spi_transfer *t) | |
0398fb70 JT |
224 | { |
225 | struct mpc8xxx_spi *mpc8xxx_spi; | |
b36ece83 | 226 | int bits_per_word = 0; |
0398fb70 | 227 | u8 pm; |
b36ece83 | 228 | u32 hz = 0; |
0398fb70 JT |
229 | struct spi_mpc8xxx_cs *cs = spi->controller_state; |
230 | ||
231 | mpc8xxx_spi = spi_master_get_devdata(spi->master); | |
232 | ||
233 | if (t) { | |
234 | bits_per_word = t->bits_per_word; | |
235 | hz = t->speed_hz; | |
0398fb70 JT |
236 | } |
237 | ||
238 | /* spi_transfer level calls that work per-word */ | |
239 | if (!bits_per_word) | |
240 | bits_per_word = spi->bits_per_word; | |
241 | ||
0398fb70 JT |
242 | if (!hz) |
243 | hz = spi->max_speed_hz; | |
244 | ||
245 | if (!(mpc8xxx_spi->flags & SPI_CPM_MODE)) | |
246 | bits_per_word = mspi_apply_cpu_mode_quirks(cs, spi, | |
247 | mpc8xxx_spi, | |
248 | bits_per_word); | |
249 | else if (mpc8xxx_spi->flags & SPI_QE) | |
250 | bits_per_word = mspi_apply_qe_mode_quirks(cs, spi, | |
251 | bits_per_word); | |
252 | ||
253 | if (bits_per_word < 0) | |
254 | return bits_per_word; | |
255 | ||
ccf06998 KG |
256 | if (bits_per_word == 32) |
257 | bits_per_word = 0; | |
258 | else | |
259 | bits_per_word = bits_per_word - 1; | |
260 | ||
32421daa | 261 | /* mask out bits we are going to set */ |
c9bfcb31 JT |
262 | cs->hw_mode &= ~(SPMODE_LEN(0xF) | SPMODE_DIV16 |
263 | | SPMODE_PM(0xF)); | |
264 | ||
265 | cs->hw_mode |= SPMODE_LEN(bits_per_word); | |
266 | ||
575c5807 | 267 | if ((mpc8xxx_spi->spibrg / hz) > 64) { |
53604dbe | 268 | cs->hw_mode |= SPMODE_DIV16; |
4f4517c4 | 269 | pm = (mpc8xxx_spi->spibrg - 1) / (hz * 64) + 1; |
fd8a11e1 AV |
270 | |
271 | WARN_ONCE(pm > 16, "%s: Requested speed is too low: %d Hz. " | |
272 | "Will use %d Hz instead.\n", dev_name(&spi->dev), | |
575c5807 | 273 | hz, mpc8xxx_spi->spibrg / 1024); |
fd8a11e1 | 274 | if (pm > 16) |
53604dbe | 275 | pm = 16; |
b36ece83 | 276 | } else { |
4f4517c4 | 277 | pm = (mpc8xxx_spi->spibrg - 1) / (hz * 4) + 1; |
b36ece83 | 278 | } |
a61f5345 CG |
279 | if (pm) |
280 | pm--; | |
281 | ||
282 | cs->hw_mode |= SPMODE_PM(pm); | |
a35c1710 | 283 | |
b36ece83 | 284 | fsl_spi_change_mode(spi); |
c9bfcb31 JT |
285 | return 0; |
286 | } | |
ccf06998 | 287 | |
b36ece83 | 288 | static int fsl_spi_cpu_bufs(struct mpc8xxx_spi *mspi, |
4c1fba44 AV |
289 | struct spi_transfer *t, unsigned int len) |
290 | { | |
291 | u32 word; | |
b36ece83 | 292 | struct fsl_spi_reg *reg_base = mspi->reg_base; |
4c1fba44 AV |
293 | |
294 | mspi->count = len; | |
295 | ||
296 | /* enable rx ints */ | |
b36ece83 | 297 | mpc8xxx_spi_write_reg(®_base->mask, SPIM_NE); |
4c1fba44 AV |
298 | |
299 | /* transmit word */ | |
300 | word = mspi->get_tx(mspi); | |
b36ece83 | 301 | mpc8xxx_spi_write_reg(®_base->transmit, word); |
4c1fba44 AV |
302 | |
303 | return 0; | |
304 | } | |
305 | ||
b36ece83 | 306 | static int fsl_spi_bufs(struct spi_device *spi, struct spi_transfer *t, |
4c1fba44 AV |
307 | bool is_dma_mapped) |
308 | { | |
309 | struct mpc8xxx_spi *mpc8xxx_spi = spi_master_get_devdata(spi->master); | |
b36ece83 | 310 | struct fsl_spi_reg *reg_base; |
4c1fba44 AV |
311 | unsigned int len = t->len; |
312 | u8 bits_per_word; | |
313 | int ret; | |
c9bfcb31 | 314 | |
b36ece83 | 315 | reg_base = mpc8xxx_spi->reg_base; |
c9bfcb31 JT |
316 | bits_per_word = spi->bits_per_word; |
317 | if (t->bits_per_word) | |
318 | bits_per_word = t->bits_per_word; | |
4c1fba44 | 319 | |
aa77d96b PK |
320 | if (bits_per_word > 8) { |
321 | /* invalid length? */ | |
322 | if (len & 1) | |
323 | return -EINVAL; | |
c9bfcb31 | 324 | len /= 2; |
aa77d96b PK |
325 | } |
326 | if (bits_per_word > 16) { | |
327 | /* invalid length? */ | |
328 | if (len & 1) | |
329 | return -EINVAL; | |
c9bfcb31 | 330 | len /= 2; |
aa77d96b | 331 | } |
aa77d96b | 332 | |
4c1fba44 AV |
333 | mpc8xxx_spi->tx = t->tx_buf; |
334 | mpc8xxx_spi->rx = t->rx_buf; | |
c9bfcb31 | 335 | |
16735d02 | 336 | reinit_completion(&mpc8xxx_spi->done); |
c9bfcb31 | 337 | |
4c1fba44 | 338 | if (mpc8xxx_spi->flags & SPI_CPM_MODE) |
b36ece83 | 339 | ret = fsl_spi_cpm_bufs(mpc8xxx_spi, t, is_dma_mapped); |
4c1fba44 | 340 | else |
b36ece83 | 341 | ret = fsl_spi_cpu_bufs(mpc8xxx_spi, t, len); |
4c1fba44 AV |
342 | if (ret) |
343 | return ret; | |
c9bfcb31 | 344 | |
575c5807 | 345 | wait_for_completion(&mpc8xxx_spi->done); |
c9bfcb31 JT |
346 | |
347 | /* disable rx ints */ | |
b36ece83 | 348 | mpc8xxx_spi_write_reg(®_base->mask, 0); |
c9bfcb31 | 349 | |
4c1fba44 | 350 | if (mpc8xxx_spi->flags & SPI_CPM_MODE) |
b36ece83 | 351 | fsl_spi_cpm_bufs_complete(mpc8xxx_spi); |
4c1fba44 | 352 | |
575c5807 | 353 | return mpc8xxx_spi->count; |
c9bfcb31 JT |
354 | } |
355 | ||
b36ece83 | 356 | static void fsl_spi_do_one_msg(struct spi_message *m) |
c9bfcb31 | 357 | { |
b9b9af11 | 358 | struct spi_device *spi = m->spi; |
4302a596 | 359 | struct spi_transfer *t, *first; |
b9b9af11 AV |
360 | unsigned int cs_change; |
361 | const int nsecs = 50; | |
362 | int status; | |
363 | ||
4302a596 SR |
364 | /* Don't allow changes if CS is active */ |
365 | first = list_first_entry(&m->transfers, struct spi_transfer, | |
366 | transfer_list); | |
b9b9af11 | 367 | list_for_each_entry(t, &m->transfers, transfer_list) { |
4302a596 SR |
368 | if ((first->bits_per_word != t->bits_per_word) || |
369 | (first->speed_hz != t->speed_hz)) { | |
b9b9af11 | 370 | status = -EINVAL; |
4302a596 SR |
371 | dev_err(&spi->dev, |
372 | "bits_per_word/speed_hz should be same for the same SPI transfer\n"); | |
373 | return; | |
374 | } | |
375 | } | |
b9b9af11 | 376 | |
4302a596 SR |
377 | cs_change = 1; |
378 | status = -EINVAL; | |
379 | list_for_each_entry(t, &m->transfers, transfer_list) { | |
380 | if (t->bits_per_word || t->speed_hz) { | |
b9b9af11 | 381 | if (cs_change) |
b36ece83 | 382 | status = fsl_spi_setup_transfer(spi, t); |
b9b9af11 | 383 | if (status < 0) |
c9bfcb31 | 384 | break; |
b9b9af11 | 385 | } |
c9bfcb31 | 386 | |
b9b9af11 | 387 | if (cs_change) { |
b36ece83 | 388 | fsl_spi_chipselect(spi, BITBANG_CS_ACTIVE); |
b9b9af11 AV |
389 | ndelay(nsecs); |
390 | } | |
391 | cs_change = t->cs_change; | |
392 | if (t->len) | |
b36ece83 | 393 | status = fsl_spi_bufs(spi, t, m->is_dma_mapped); |
b9b9af11 AV |
394 | if (status) { |
395 | status = -EMSGSIZE; | |
396 | break; | |
c9bfcb31 | 397 | } |
b9b9af11 | 398 | m->actual_length += t->len; |
c9bfcb31 | 399 | |
b9b9af11 AV |
400 | if (t->delay_usecs) |
401 | udelay(t->delay_usecs); | |
c9bfcb31 | 402 | |
b9b9af11 | 403 | if (cs_change) { |
c9bfcb31 | 404 | ndelay(nsecs); |
b36ece83 | 405 | fsl_spi_chipselect(spi, BITBANG_CS_INACTIVE); |
b9b9af11 | 406 | ndelay(nsecs); |
c9bfcb31 | 407 | } |
b9b9af11 AV |
408 | } |
409 | ||
410 | m->status = status; | |
0a6d3879 AL |
411 | if (m->complete) |
412 | m->complete(m->context); | |
b9b9af11 AV |
413 | |
414 | if (status || !cs_change) { | |
415 | ndelay(nsecs); | |
b36ece83 | 416 | fsl_spi_chipselect(spi, BITBANG_CS_INACTIVE); |
b9b9af11 AV |
417 | } |
418 | ||
b36ece83 | 419 | fsl_spi_setup_transfer(spi, NULL); |
ccf06998 KG |
420 | } |
421 | ||
b36ece83 | 422 | static int fsl_spi_setup(struct spi_device *spi) |
ccf06998 | 423 | { |
575c5807 | 424 | struct mpc8xxx_spi *mpc8xxx_spi; |
b36ece83 | 425 | struct fsl_spi_reg *reg_base; |
ccf06998 | 426 | int retval; |
c9bfcb31 | 427 | u32 hw_mode; |
d9f26748 | 428 | struct spi_mpc8xxx_cs *cs = spi_get_ctldata(spi); |
ccf06998 KG |
429 | |
430 | if (!spi->max_speed_hz) | |
431 | return -EINVAL; | |
432 | ||
c9bfcb31 | 433 | if (!cs) { |
d9f26748 | 434 | cs = kzalloc(sizeof(*cs), GFP_KERNEL); |
c9bfcb31 JT |
435 | if (!cs) |
436 | return -ENOMEM; | |
d9f26748 | 437 | spi_set_ctldata(spi, cs); |
c9bfcb31 | 438 | } |
575c5807 | 439 | mpc8xxx_spi = spi_master_get_devdata(spi->master); |
ccf06998 | 440 | |
b36ece83 MH |
441 | reg_base = mpc8xxx_spi->reg_base; |
442 | ||
88393161 | 443 | hw_mode = cs->hw_mode; /* Save original settings */ |
b36ece83 | 444 | cs->hw_mode = mpc8xxx_spi_read_reg(®_base->mode); |
c9bfcb31 JT |
445 | /* mask out bits we are going to set */ |
446 | cs->hw_mode &= ~(SPMODE_CP_BEGIN_EDGECLK | SPMODE_CI_INACTIVEHIGH | |
447 | | SPMODE_REV | SPMODE_LOOP); | |
448 | ||
449 | if (spi->mode & SPI_CPHA) | |
450 | cs->hw_mode |= SPMODE_CP_BEGIN_EDGECLK; | |
451 | if (spi->mode & SPI_CPOL) | |
452 | cs->hw_mode |= SPMODE_CI_INACTIVEHIGH; | |
453 | if (!(spi->mode & SPI_LSB_FIRST)) | |
454 | cs->hw_mode |= SPMODE_REV; | |
455 | if (spi->mode & SPI_LOOP) | |
456 | cs->hw_mode |= SPMODE_LOOP; | |
457 | ||
b36ece83 | 458 | retval = fsl_spi_setup_transfer(spi, NULL); |
c9bfcb31 JT |
459 | if (retval < 0) { |
460 | cs->hw_mode = hw_mode; /* Restore settings */ | |
ccf06998 | 461 | return retval; |
c9bfcb31 | 462 | } |
f482cd0f | 463 | |
76a7498f AL |
464 | if (mpc8xxx_spi->type == TYPE_GRLIB) { |
465 | if (gpio_is_valid(spi->cs_gpio)) { | |
466 | int desel; | |
467 | ||
468 | retval = gpio_request(spi->cs_gpio, | |
469 | dev_name(&spi->dev)); | |
470 | if (retval) | |
471 | return retval; | |
472 | ||
473 | desel = !(spi->mode & SPI_CS_HIGH); | |
474 | retval = gpio_direction_output(spi->cs_gpio, desel); | |
475 | if (retval) { | |
476 | gpio_free(spi->cs_gpio); | |
477 | return retval; | |
478 | } | |
479 | } else if (spi->cs_gpio != -ENOENT) { | |
480 | if (spi->cs_gpio < 0) | |
481 | return spi->cs_gpio; | |
482 | return -EINVAL; | |
483 | } | |
484 | /* When spi->cs_gpio == -ENOENT, a hole in the phandle list | |
485 | * indicates to use native chipselect if present, or allow for | |
486 | * an always selected chip | |
487 | */ | |
488 | } | |
489 | ||
f482cd0f AL |
490 | /* Initialize chipselect - might be active for SPI_CS_HIGH mode */ |
491 | fsl_spi_chipselect(spi, BITBANG_CS_INACTIVE); | |
492 | ||
ccf06998 KG |
493 | return 0; |
494 | } | |
495 | ||
76a7498f AL |
496 | static void fsl_spi_cleanup(struct spi_device *spi) |
497 | { | |
498 | struct mpc8xxx_spi *mpc8xxx_spi = spi_master_get_devdata(spi->master); | |
d9f26748 | 499 | struct spi_mpc8xxx_cs *cs = spi_get_ctldata(spi); |
76a7498f AL |
500 | |
501 | if (mpc8xxx_spi->type == TYPE_GRLIB && gpio_is_valid(spi->cs_gpio)) | |
502 | gpio_free(spi->cs_gpio); | |
d9f26748 AL |
503 | |
504 | kfree(cs); | |
505 | spi_set_ctldata(spi, NULL); | |
76a7498f AL |
506 | } |
507 | ||
b36ece83 | 508 | static void fsl_spi_cpu_irq(struct mpc8xxx_spi *mspi, u32 events) |
4c1fba44 | 509 | { |
b36ece83 MH |
510 | struct fsl_spi_reg *reg_base = mspi->reg_base; |
511 | ||
4c1fba44 AV |
512 | /* We need handle RX first */ |
513 | if (events & SPIE_NE) { | |
b36ece83 | 514 | u32 rx_data = mpc8xxx_spi_read_reg(®_base->receive); |
4c1fba44 AV |
515 | |
516 | if (mspi->rx) | |
517 | mspi->get_rx(rx_data, mspi); | |
ccf06998 KG |
518 | } |
519 | ||
4c1fba44 | 520 | if ((events & SPIE_NF) == 0) |
ccf06998 | 521 | /* spin until TX is done */ |
4c1fba44 | 522 | while (((events = |
b36ece83 | 523 | mpc8xxx_spi_read_reg(®_base->event)) & |
ccf06998 | 524 | SPIE_NF) == 0) |
9effb959 | 525 | cpu_relax(); |
ccf06998 | 526 | |
4c1fba44 | 527 | /* Clear the events */ |
b36ece83 | 528 | mpc8xxx_spi_write_reg(®_base->event, events); |
4c1fba44 AV |
529 | |
530 | mspi->count -= 1; | |
531 | if (mspi->count) { | |
532 | u32 word = mspi->get_tx(mspi); | |
533 | ||
b36ece83 | 534 | mpc8xxx_spi_write_reg(®_base->transmit, word); |
ccf06998 | 535 | } else { |
4c1fba44 | 536 | complete(&mspi->done); |
ccf06998 | 537 | } |
4c1fba44 | 538 | } |
ccf06998 | 539 | |
b36ece83 | 540 | static irqreturn_t fsl_spi_irq(s32 irq, void *context_data) |
4c1fba44 AV |
541 | { |
542 | struct mpc8xxx_spi *mspi = context_data; | |
543 | irqreturn_t ret = IRQ_NONE; | |
544 | u32 events; | |
b36ece83 | 545 | struct fsl_spi_reg *reg_base = mspi->reg_base; |
4c1fba44 AV |
546 | |
547 | /* Get interrupt events(tx/rx) */ | |
b36ece83 | 548 | events = mpc8xxx_spi_read_reg(®_base->event); |
4c1fba44 AV |
549 | if (events) |
550 | ret = IRQ_HANDLED; | |
551 | ||
552 | dev_dbg(mspi->dev, "%s: events %x\n", __func__, events); | |
553 | ||
554 | if (mspi->flags & SPI_CPM_MODE) | |
b36ece83 | 555 | fsl_spi_cpm_irq(mspi, events); |
4c1fba44 | 556 | else |
b36ece83 | 557 | fsl_spi_cpu_irq(mspi, events); |
ccf06998 KG |
558 | |
559 | return ret; | |
560 | } | |
4c1fba44 | 561 | |
b36ece83 | 562 | static void fsl_spi_remove(struct mpc8xxx_spi *mspi) |
87ec0e98 | 563 | { |
b36ece83 MH |
564 | iounmap(mspi->reg_base); |
565 | fsl_spi_cpm_free(mspi); | |
87ec0e98 AV |
566 | } |
567 | ||
447b0c7b AL |
568 | static void fsl_spi_grlib_cs_control(struct spi_device *spi, bool on) |
569 | { | |
570 | struct mpc8xxx_spi *mpc8xxx_spi = spi_master_get_devdata(spi->master); | |
571 | struct fsl_spi_reg *reg_base = mpc8xxx_spi->reg_base; | |
572 | u32 slvsel; | |
573 | u16 cs = spi->chip_select; | |
574 | ||
76a7498f AL |
575 | if (gpio_is_valid(spi->cs_gpio)) { |
576 | gpio_set_value(spi->cs_gpio, on); | |
577 | } else if (cs < mpc8xxx_spi->native_chipselects) { | |
578 | slvsel = mpc8xxx_spi_read_reg(®_base->slvsel); | |
579 | slvsel = on ? (slvsel | (1 << cs)) : (slvsel & ~(1 << cs)); | |
580 | mpc8xxx_spi_write_reg(®_base->slvsel, slvsel); | |
581 | } | |
447b0c7b AL |
582 | } |
583 | ||
584 | static void fsl_spi_grlib_probe(struct device *dev) | |
585 | { | |
8074cf06 | 586 | struct fsl_spi_platform_data *pdata = dev_get_platdata(dev); |
447b0c7b AL |
587 | struct spi_master *master = dev_get_drvdata(dev); |
588 | struct mpc8xxx_spi *mpc8xxx_spi = spi_master_get_devdata(master); | |
589 | struct fsl_spi_reg *reg_base = mpc8xxx_spi->reg_base; | |
590 | int mbits; | |
591 | u32 capabilities; | |
592 | ||
593 | capabilities = mpc8xxx_spi_read_reg(®_base->cap); | |
594 | ||
595 | mpc8xxx_spi->set_shifts = fsl_spi_grlib_set_shifts; | |
596 | mbits = SPCAP_MAXWLEN(capabilities); | |
597 | if (mbits) | |
598 | mpc8xxx_spi->max_bits_per_word = mbits + 1; | |
599 | ||
76a7498f | 600 | mpc8xxx_spi->native_chipselects = 0; |
447b0c7b | 601 | if (SPCAP_SSEN(capabilities)) { |
76a7498f | 602 | mpc8xxx_spi->native_chipselects = SPCAP_SSSZ(capabilities); |
447b0c7b AL |
603 | mpc8xxx_spi_write_reg(®_base->slvsel, 0xffffffff); |
604 | } | |
76a7498f | 605 | master->num_chipselect = mpc8xxx_spi->native_chipselects; |
447b0c7b AL |
606 | pdata->cs_control = fsl_spi_grlib_cs_control; |
607 | } | |
608 | ||
fd4a319b | 609 | static struct spi_master * fsl_spi_probe(struct device *dev, |
b36ece83 | 610 | struct resource *mem, unsigned int irq) |
ccf06998 | 611 | { |
8074cf06 | 612 | struct fsl_spi_platform_data *pdata = dev_get_platdata(dev); |
ccf06998 | 613 | struct spi_master *master; |
575c5807 | 614 | struct mpc8xxx_spi *mpc8xxx_spi; |
b36ece83 | 615 | struct fsl_spi_reg *reg_base; |
ccf06998 KG |
616 | u32 regval; |
617 | int ret = 0; | |
618 | ||
575c5807 | 619 | master = spi_alloc_master(dev, sizeof(struct mpc8xxx_spi)); |
ccf06998 KG |
620 | if (master == NULL) { |
621 | ret = -ENOMEM; | |
622 | goto err; | |
623 | } | |
624 | ||
35b4b3c0 | 625 | dev_set_drvdata(dev, master); |
ccf06998 | 626 | |
b36ece83 MH |
627 | ret = mpc8xxx_spi_probe(dev, mem, irq); |
628 | if (ret) | |
629 | goto err_probe; | |
e7db06b5 | 630 | |
b36ece83 | 631 | master->setup = fsl_spi_setup; |
76a7498f | 632 | master->cleanup = fsl_spi_cleanup; |
575c5807 AV |
633 | |
634 | mpc8xxx_spi = spi_master_get_devdata(master); | |
b36ece83 MH |
635 | mpc8xxx_spi->spi_do_one_msg = fsl_spi_do_one_msg; |
636 | mpc8xxx_spi->spi_remove = fsl_spi_remove; | |
8922a366 | 637 | mpc8xxx_spi->max_bits_per_word = 32; |
c3f3e771 | 638 | mpc8xxx_spi->type = fsl_spi_get_type(dev); |
575c5807 | 639 | |
b36ece83 | 640 | ret = fsl_spi_cpm_init(mpc8xxx_spi); |
4c1fba44 AV |
641 | if (ret) |
642 | goto err_cpm_init; | |
643 | ||
447b0c7b AL |
644 | mpc8xxx_spi->reg_base = ioremap(mem->start, resource_size(mem)); |
645 | if (mpc8xxx_spi->reg_base == NULL) { | |
646 | ret = -ENOMEM; | |
647 | goto err_ioremap; | |
648 | } | |
649 | ||
650 | if (mpc8xxx_spi->type == TYPE_GRLIB) | |
651 | fsl_spi_grlib_probe(dev); | |
652 | ||
f734394d AL |
653 | master->bits_per_word_mask = |
654 | (SPI_BPW_RANGE_MASK(4, 16) | SPI_BPW_MASK(32)) & | |
655 | SPI_BPW_RANGE_MASK(1, mpc8xxx_spi->max_bits_per_word); | |
656 | ||
b48c4e3c AL |
657 | if (mpc8xxx_spi->flags & SPI_QE_CPU_MODE) |
658 | mpc8xxx_spi->set_shifts = fsl_spi_qe_cpu_set_shifts; | |
659 | ||
660 | if (mpc8xxx_spi->set_shifts) | |
661 | /* 8 bits per word and MSB first */ | |
662 | mpc8xxx_spi->set_shifts(&mpc8xxx_spi->rx_shift, | |
663 | &mpc8xxx_spi->tx_shift, 8, 1); | |
f29ba280 | 664 | |
ccf06998 | 665 | /* Register for SPI Interrupt */ |
b36ece83 MH |
666 | ret = request_irq(mpc8xxx_spi->irq, fsl_spi_irq, |
667 | 0, "fsl_spi", mpc8xxx_spi); | |
ccf06998 KG |
668 | |
669 | if (ret != 0) | |
b36ece83 | 670 | goto free_irq; |
ccf06998 | 671 | |
b36ece83 | 672 | reg_base = mpc8xxx_spi->reg_base; |
ccf06998 KG |
673 | |
674 | /* SPI controller initializations */ | |
b36ece83 MH |
675 | mpc8xxx_spi_write_reg(®_base->mode, 0); |
676 | mpc8xxx_spi_write_reg(®_base->mask, 0); | |
677 | mpc8xxx_spi_write_reg(®_base->command, 0); | |
678 | mpc8xxx_spi_write_reg(®_base->event, 0xffffffff); | |
ccf06998 KG |
679 | |
680 | /* Enable SPI interface */ | |
681 | regval = pdata->initial_spmode | SPMODE_INIT_VAL | SPMODE_ENABLE; | |
8922a366 AL |
682 | if (mpc8xxx_spi->max_bits_per_word < 8) { |
683 | regval &= ~SPMODE_LEN(0xF); | |
684 | regval |= SPMODE_LEN(mpc8xxx_spi->max_bits_per_word - 1); | |
685 | } | |
87ec0e98 | 686 | if (mpc8xxx_spi->flags & SPI_QE_CPU_MODE) |
f29ba280 JT |
687 | regval |= SPMODE_OP; |
688 | ||
b36ece83 | 689 | mpc8xxx_spi_write_reg(®_base->mode, regval); |
c9bfcb31 JT |
690 | |
691 | ret = spi_register_master(master); | |
692 | if (ret < 0) | |
693 | goto unreg_master; | |
ccf06998 | 694 | |
b36ece83 | 695 | dev_info(dev, "at 0x%p (irq = %d), %s mode\n", reg_base, |
87ec0e98 | 696 | mpc8xxx_spi->irq, mpc8xxx_spi_strmode(mpc8xxx_spi->flags)); |
ccf06998 | 697 | |
35b4b3c0 | 698 | return master; |
ccf06998 | 699 | |
c9bfcb31 | 700 | unreg_master: |
575c5807 | 701 | free_irq(mpc8xxx_spi->irq, mpc8xxx_spi); |
b36ece83 MH |
702 | free_irq: |
703 | iounmap(mpc8xxx_spi->reg_base); | |
4c1fba44 | 704 | err_ioremap: |
b36ece83 | 705 | fsl_spi_cpm_free(mpc8xxx_spi); |
4c1fba44 | 706 | err_cpm_init: |
b36ece83 | 707 | err_probe: |
ccf06998 | 708 | spi_master_put(master); |
ccf06998 | 709 | err: |
35b4b3c0 | 710 | return ERR_PTR(ret); |
ccf06998 KG |
711 | } |
712 | ||
b36ece83 | 713 | static void fsl_spi_cs_control(struct spi_device *spi, bool on) |
35b4b3c0 | 714 | { |
067aa481 | 715 | struct device *dev = spi->dev.parent->parent; |
8074cf06 JH |
716 | struct fsl_spi_platform_data *pdata = dev_get_platdata(dev); |
717 | struct mpc8xxx_spi_probe_info *pinfo = to_of_pinfo(pdata); | |
35b4b3c0 AV |
718 | u16 cs = spi->chip_select; |
719 | int gpio = pinfo->gpios[cs]; | |
720 | bool alow = pinfo->alow_flags[cs]; | |
721 | ||
722 | gpio_set_value(gpio, on ^ alow); | |
723 | } | |
724 | ||
b36ece83 | 725 | static int of_fsl_spi_get_chipselects(struct device *dev) |
35b4b3c0 | 726 | { |
61c7a080 | 727 | struct device_node *np = dev->of_node; |
8074cf06 | 728 | struct fsl_spi_platform_data *pdata = dev_get_platdata(dev); |
575c5807 | 729 | struct mpc8xxx_spi_probe_info *pinfo = to_of_pinfo(pdata); |
e80beb27 | 730 | int ngpios; |
35b4b3c0 AV |
731 | int i = 0; |
732 | int ret; | |
733 | ||
734 | ngpios = of_gpio_count(np); | |
e80beb27 | 735 | if (ngpios <= 0) { |
35b4b3c0 AV |
736 | /* |
737 | * SPI w/o chip-select line. One SPI device is still permitted | |
738 | * though. | |
739 | */ | |
740 | pdata->max_chipselect = 1; | |
741 | return 0; | |
742 | } | |
743 | ||
02141546 | 744 | pinfo->gpios = kmalloc(ngpios * sizeof(*pinfo->gpios), GFP_KERNEL); |
35b4b3c0 AV |
745 | if (!pinfo->gpios) |
746 | return -ENOMEM; | |
02141546 | 747 | memset(pinfo->gpios, -1, ngpios * sizeof(*pinfo->gpios)); |
35b4b3c0 | 748 | |
02141546 | 749 | pinfo->alow_flags = kzalloc(ngpios * sizeof(*pinfo->alow_flags), |
35b4b3c0 AV |
750 | GFP_KERNEL); |
751 | if (!pinfo->alow_flags) { | |
752 | ret = -ENOMEM; | |
753 | goto err_alloc_flags; | |
754 | } | |
755 | ||
756 | for (; i < ngpios; i++) { | |
757 | int gpio; | |
758 | enum of_gpio_flags flags; | |
759 | ||
760 | gpio = of_get_gpio_flags(np, i, &flags); | |
761 | if (!gpio_is_valid(gpio)) { | |
762 | dev_err(dev, "invalid gpio #%d: %d\n", i, gpio); | |
783058fd | 763 | ret = gpio; |
35b4b3c0 AV |
764 | goto err_loop; |
765 | } | |
766 | ||
767 | ret = gpio_request(gpio, dev_name(dev)); | |
768 | if (ret) { | |
769 | dev_err(dev, "can't request gpio #%d: %d\n", i, ret); | |
770 | goto err_loop; | |
771 | } | |
772 | ||
773 | pinfo->gpios[i] = gpio; | |
774 | pinfo->alow_flags[i] = flags & OF_GPIO_ACTIVE_LOW; | |
775 | ||
776 | ret = gpio_direction_output(pinfo->gpios[i], | |
777 | pinfo->alow_flags[i]); | |
778 | if (ret) { | |
779 | dev_err(dev, "can't set output direction for gpio " | |
780 | "#%d: %d\n", i, ret); | |
781 | goto err_loop; | |
782 | } | |
783 | } | |
784 | ||
785 | pdata->max_chipselect = ngpios; | |
b36ece83 | 786 | pdata->cs_control = fsl_spi_cs_control; |
35b4b3c0 AV |
787 | |
788 | return 0; | |
789 | ||
790 | err_loop: | |
791 | while (i >= 0) { | |
792 | if (gpio_is_valid(pinfo->gpios[i])) | |
793 | gpio_free(pinfo->gpios[i]); | |
794 | i--; | |
795 | } | |
796 | ||
797 | kfree(pinfo->alow_flags); | |
798 | pinfo->alow_flags = NULL; | |
799 | err_alloc_flags: | |
800 | kfree(pinfo->gpios); | |
801 | pinfo->gpios = NULL; | |
802 | return ret; | |
803 | } | |
804 | ||
b36ece83 | 805 | static int of_fsl_spi_free_chipselects(struct device *dev) |
35b4b3c0 | 806 | { |
8074cf06 | 807 | struct fsl_spi_platform_data *pdata = dev_get_platdata(dev); |
575c5807 | 808 | struct mpc8xxx_spi_probe_info *pinfo = to_of_pinfo(pdata); |
35b4b3c0 AV |
809 | int i; |
810 | ||
811 | if (!pinfo->gpios) | |
812 | return 0; | |
813 | ||
814 | for (i = 0; i < pdata->max_chipselect; i++) { | |
815 | if (gpio_is_valid(pinfo->gpios[i])) | |
816 | gpio_free(pinfo->gpios[i]); | |
817 | } | |
818 | ||
819 | kfree(pinfo->gpios); | |
820 | kfree(pinfo->alow_flags); | |
821 | return 0; | |
822 | } | |
823 | ||
fd4a319b | 824 | static int of_fsl_spi_probe(struct platform_device *ofdev) |
35b4b3c0 AV |
825 | { |
826 | struct device *dev = &ofdev->dev; | |
61c7a080 | 827 | struct device_node *np = ofdev->dev.of_node; |
35b4b3c0 AV |
828 | struct spi_master *master; |
829 | struct resource mem; | |
447b0c7b | 830 | int irq, type; |
35b4b3c0 AV |
831 | int ret = -ENOMEM; |
832 | ||
18d306d1 | 833 | ret = of_mpc8xxx_spi_probe(ofdev); |
b36ece83 MH |
834 | if (ret) |
835 | return ret; | |
35b4b3c0 | 836 | |
447b0c7b AL |
837 | type = fsl_spi_get_type(&ofdev->dev); |
838 | if (type == TYPE_FSL) { | |
839 | ret = of_fsl_spi_get_chipselects(dev); | |
840 | if (ret) | |
841 | goto err; | |
842 | } | |
35b4b3c0 AV |
843 | |
844 | ret = of_address_to_resource(np, 0, &mem); | |
845 | if (ret) | |
846 | goto err; | |
847 | ||
e8beacbb AL |
848 | irq = irq_of_parse_and_map(np, 0); |
849 | if (!irq) { | |
35b4b3c0 AV |
850 | ret = -EINVAL; |
851 | goto err; | |
852 | } | |
853 | ||
e8beacbb | 854 | master = fsl_spi_probe(dev, &mem, irq); |
35b4b3c0 AV |
855 | if (IS_ERR(master)) { |
856 | ret = PTR_ERR(master); | |
857 | goto err; | |
858 | } | |
859 | ||
35b4b3c0 AV |
860 | return 0; |
861 | ||
862 | err: | |
447b0c7b AL |
863 | if (type == TYPE_FSL) |
864 | of_fsl_spi_free_chipselects(dev); | |
35b4b3c0 AV |
865 | return ret; |
866 | } | |
867 | ||
fd4a319b | 868 | static int of_fsl_spi_remove(struct platform_device *ofdev) |
35b4b3c0 | 869 | { |
24b5a82c | 870 | struct spi_master *master = platform_get_drvdata(ofdev); |
447b0c7b | 871 | struct mpc8xxx_spi *mpc8xxx_spi = spi_master_get_devdata(master); |
35b4b3c0 AV |
872 | int ret; |
873 | ||
575c5807 | 874 | ret = mpc8xxx_spi_remove(&ofdev->dev); |
35b4b3c0 AV |
875 | if (ret) |
876 | return ret; | |
447b0c7b AL |
877 | if (mpc8xxx_spi->type == TYPE_FSL) |
878 | of_fsl_spi_free_chipselects(&ofdev->dev); | |
35b4b3c0 AV |
879 | return 0; |
880 | } | |
881 | ||
18d306d1 | 882 | static struct platform_driver of_fsl_spi_driver = { |
4018294b | 883 | .driver = { |
b36ece83 | 884 | .name = "fsl_spi", |
4018294b | 885 | .owner = THIS_MODULE, |
b36ece83 | 886 | .of_match_table = of_fsl_spi_match, |
4018294b | 887 | }, |
b36ece83 | 888 | .probe = of_fsl_spi_probe, |
fd4a319b | 889 | .remove = of_fsl_spi_remove, |
35b4b3c0 AV |
890 | }; |
891 | ||
892 | #ifdef CONFIG_MPC832x_RDB | |
893 | /* | |
b36ece83 | 894 | * XXX XXX XXX |
35b4b3c0 AV |
895 | * This is "legacy" platform driver, was used by the MPC8323E-RDB boards |
896 | * only. The driver should go away soon, since newer MPC8323E-RDB's device | |
897 | * tree can work with OpenFirmware driver. But for now we support old trees | |
898 | * as well. | |
899 | */ | |
fd4a319b | 900 | static int plat_mpc8xxx_spi_probe(struct platform_device *pdev) |
35b4b3c0 AV |
901 | { |
902 | struct resource *mem; | |
e9a172f0 | 903 | int irq; |
35b4b3c0 AV |
904 | struct spi_master *master; |
905 | ||
8074cf06 | 906 | if (!dev_get_platdata(&pdev->dev)) |
35b4b3c0 AV |
907 | return -EINVAL; |
908 | ||
909 | mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
910 | if (!mem) | |
911 | return -EINVAL; | |
912 | ||
913 | irq = platform_get_irq(pdev, 0); | |
e9a172f0 | 914 | if (irq <= 0) |
35b4b3c0 AV |
915 | return -EINVAL; |
916 | ||
b36ece83 | 917 | master = fsl_spi_probe(&pdev->dev, mem, irq); |
8c6ffba0 | 918 | return PTR_ERR_OR_ZERO(master); |
35b4b3c0 AV |
919 | } |
920 | ||
fd4a319b | 921 | static int plat_mpc8xxx_spi_remove(struct platform_device *pdev) |
35b4b3c0 | 922 | { |
575c5807 | 923 | return mpc8xxx_spi_remove(&pdev->dev); |
35b4b3c0 AV |
924 | } |
925 | ||
575c5807 AV |
926 | MODULE_ALIAS("platform:mpc8xxx_spi"); |
927 | static struct platform_driver mpc8xxx_spi_driver = { | |
928 | .probe = plat_mpc8xxx_spi_probe, | |
fd4a319b | 929 | .remove = plat_mpc8xxx_spi_remove, |
ccf06998 | 930 | .driver = { |
575c5807 | 931 | .name = "mpc8xxx_spi", |
7e38c3c4 | 932 | .owner = THIS_MODULE, |
ccf06998 KG |
933 | }, |
934 | }; | |
935 | ||
35b4b3c0 AV |
936 | static bool legacy_driver_failed; |
937 | ||
938 | static void __init legacy_driver_register(void) | |
939 | { | |
575c5807 | 940 | legacy_driver_failed = platform_driver_register(&mpc8xxx_spi_driver); |
35b4b3c0 AV |
941 | } |
942 | ||
943 | static void __exit legacy_driver_unregister(void) | |
944 | { | |
945 | if (legacy_driver_failed) | |
946 | return; | |
575c5807 | 947 | platform_driver_unregister(&mpc8xxx_spi_driver); |
35b4b3c0 AV |
948 | } |
949 | #else | |
950 | static void __init legacy_driver_register(void) {} | |
951 | static void __exit legacy_driver_unregister(void) {} | |
952 | #endif /* CONFIG_MPC832x_RDB */ | |
953 | ||
b36ece83 | 954 | static int __init fsl_spi_init(void) |
ccf06998 | 955 | { |
35b4b3c0 | 956 | legacy_driver_register(); |
18d306d1 | 957 | return platform_driver_register(&of_fsl_spi_driver); |
ccf06998 | 958 | } |
b36ece83 | 959 | module_init(fsl_spi_init); |
ccf06998 | 960 | |
b36ece83 | 961 | static void __exit fsl_spi_exit(void) |
ccf06998 | 962 | { |
18d306d1 | 963 | platform_driver_unregister(&of_fsl_spi_driver); |
35b4b3c0 | 964 | legacy_driver_unregister(); |
ccf06998 | 965 | } |
b36ece83 | 966 | module_exit(fsl_spi_exit); |
ccf06998 KG |
967 | |
968 | MODULE_AUTHOR("Kumar Gala"); | |
b36ece83 | 969 | MODULE_DESCRIPTION("Simple Freescale SPI Driver"); |
ccf06998 | 970 | MODULE_LICENSE("GPL"); |