]>
Commit | Line | Data |
---|---|---|
358934a6 SP |
1 | /* |
2 | * Copyright (C) 2009 Texas Instruments. | |
43abb11b | 3 | * Copyright (C) 2010 EF Johnson Technologies |
358934a6 SP |
4 | * |
5 | * This program is free software; you can redistribute it and/or modify | |
6 | * it under the terms of the GNU General Public License as published by | |
7 | * the Free Software Foundation; either version 2 of the License, or | |
8 | * (at your option) any later version. | |
9 | * | |
10 | * This program is distributed in the hope that it will be useful, | |
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 | * GNU General Public License for more details. | |
14 | * | |
15 | * You should have received a copy of the GNU General Public License | |
16 | * along with this program; if not, write to the Free Software | |
17 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
18 | */ | |
19 | ||
20 | #include <linux/interrupt.h> | |
21 | #include <linux/io.h> | |
22 | #include <linux/gpio.h> | |
23 | #include <linux/module.h> | |
24 | #include <linux/delay.h> | |
25 | #include <linux/platform_device.h> | |
26 | #include <linux/err.h> | |
27 | #include <linux/clk.h> | |
048177ce | 28 | #include <linux/dmaengine.h> |
358934a6 | 29 | #include <linux/dma-mapping.h> |
048177ce | 30 | #include <linux/edma.h> |
358934a6 SP |
31 | #include <linux/spi/spi.h> |
32 | #include <linux/spi/spi_bitbang.h> | |
5a0e3ad6 | 33 | #include <linux/slab.h> |
358934a6 | 34 | |
ec2a0833 | 35 | #include <linux/platform_data/spi-davinci.h> |
358934a6 SP |
36 | |
37 | #define SPI_NO_RESOURCE ((resource_size_t)-1) | |
38 | ||
39 | #define SPI_MAX_CHIPSELECT 2 | |
40 | ||
41 | #define CS_DEFAULT 0xFF | |
42 | ||
358934a6 SP |
43 | #define SPIFMT_PHASE_MASK BIT(16) |
44 | #define SPIFMT_POLARITY_MASK BIT(17) | |
45 | #define SPIFMT_DISTIMER_MASK BIT(18) | |
46 | #define SPIFMT_SHIFTDIR_MASK BIT(20) | |
47 | #define SPIFMT_WAITENA_MASK BIT(21) | |
48 | #define SPIFMT_PARITYENA_MASK BIT(22) | |
49 | #define SPIFMT_ODD_PARITY_MASK BIT(23) | |
50 | #define SPIFMT_WDELAY_MASK 0x3f000000u | |
51 | #define SPIFMT_WDELAY_SHIFT 24 | |
7fe0092b | 52 | #define SPIFMT_PRESCALE_SHIFT 8 |
358934a6 | 53 | |
358934a6 SP |
54 | /* SPIPC0 */ |
55 | #define SPIPC0_DIFUN_MASK BIT(11) /* MISO */ | |
56 | #define SPIPC0_DOFUN_MASK BIT(10) /* MOSI */ | |
57 | #define SPIPC0_CLKFUN_MASK BIT(9) /* CLK */ | |
58 | #define SPIPC0_SPIENA_MASK BIT(8) /* nREADY */ | |
358934a6 SP |
59 | |
60 | #define SPIINT_MASKALL 0x0101035F | |
e0d205e9 BN |
61 | #define SPIINT_MASKINT 0x0000015F |
62 | #define SPI_INTLVL_1 0x000001FF | |
63 | #define SPI_INTLVL_0 0x00000000 | |
358934a6 | 64 | |
cfbc5d1d BN |
65 | /* SPIDAT1 (upper 16 bit defines) */ |
66 | #define SPIDAT1_CSHOLD_MASK BIT(12) | |
67 | ||
68 | /* SPIGCR1 */ | |
358934a6 SP |
69 | #define SPIGCR1_CLKMOD_MASK BIT(1) |
70 | #define SPIGCR1_MASTER_MASK BIT(0) | |
3f27b57c | 71 | #define SPIGCR1_POWERDOWN_MASK BIT(8) |
358934a6 | 72 | #define SPIGCR1_LOOPBACK_MASK BIT(16) |
8e206f1c | 73 | #define SPIGCR1_SPIENA_MASK BIT(24) |
358934a6 SP |
74 | |
75 | /* SPIBUF */ | |
76 | #define SPIBUF_TXFULL_MASK BIT(29) | |
77 | #define SPIBUF_RXEMPTY_MASK BIT(31) | |
78 | ||
7abbf23c BN |
79 | /* SPIDELAY */ |
80 | #define SPIDELAY_C2TDELAY_SHIFT 24 | |
81 | #define SPIDELAY_C2TDELAY_MASK (0xFF << SPIDELAY_C2TDELAY_SHIFT) | |
82 | #define SPIDELAY_T2CDELAY_SHIFT 16 | |
83 | #define SPIDELAY_T2CDELAY_MASK (0xFF << SPIDELAY_T2CDELAY_SHIFT) | |
84 | #define SPIDELAY_T2EDELAY_SHIFT 8 | |
85 | #define SPIDELAY_T2EDELAY_MASK (0xFF << SPIDELAY_T2EDELAY_SHIFT) | |
86 | #define SPIDELAY_C2EDELAY_SHIFT 0 | |
87 | #define SPIDELAY_C2EDELAY_MASK 0xFF | |
88 | ||
358934a6 SP |
89 | /* Error Masks */ |
90 | #define SPIFLG_DLEN_ERR_MASK BIT(0) | |
91 | #define SPIFLG_TIMEOUT_MASK BIT(1) | |
92 | #define SPIFLG_PARERR_MASK BIT(2) | |
93 | #define SPIFLG_DESYNC_MASK BIT(3) | |
94 | #define SPIFLG_BITERR_MASK BIT(4) | |
95 | #define SPIFLG_OVRRUN_MASK BIT(6) | |
358934a6 | 96 | #define SPIFLG_BUF_INIT_ACTIVE_MASK BIT(24) |
839c996c BN |
97 | #define SPIFLG_ERROR_MASK (SPIFLG_DLEN_ERR_MASK \ |
98 | | SPIFLG_TIMEOUT_MASK | SPIFLG_PARERR_MASK \ | |
99 | | SPIFLG_DESYNC_MASK | SPIFLG_BITERR_MASK \ | |
100 | | SPIFLG_OVRRUN_MASK) | |
8e206f1c | 101 | |
358934a6 | 102 | #define SPIINT_DMA_REQ_EN BIT(16) |
358934a6 | 103 | |
358934a6 SP |
104 | /* SPI Controller registers */ |
105 | #define SPIGCR0 0x00 | |
106 | #define SPIGCR1 0x04 | |
107 | #define SPIINT 0x08 | |
108 | #define SPILVL 0x0c | |
109 | #define SPIFLG 0x10 | |
110 | #define SPIPC0 0x14 | |
358934a6 SP |
111 | #define SPIDAT1 0x3c |
112 | #define SPIBUF 0x40 | |
358934a6 SP |
113 | #define SPIDELAY 0x48 |
114 | #define SPIDEF 0x4c | |
115 | #define SPIFMT0 0x50 | |
358934a6 | 116 | |
358934a6 SP |
117 | /* SPI Controller driver's private data. */ |
118 | struct davinci_spi { | |
119 | struct spi_bitbang bitbang; | |
120 | struct clk *clk; | |
121 | ||
122 | u8 version; | |
123 | resource_size_t pbase; | |
124 | void __iomem *base; | |
e0d205e9 BN |
125 | u32 irq; |
126 | struct completion done; | |
358934a6 SP |
127 | |
128 | const void *tx; | |
129 | void *rx; | |
e0d205e9 BN |
130 | int rcount; |
131 | int wcount; | |
048177ce MP |
132 | |
133 | struct dma_chan *dma_rx; | |
134 | struct dma_chan *dma_tx; | |
135 | int dma_rx_chnum; | |
136 | int dma_tx_chnum; | |
137 | ||
778e261e | 138 | struct davinci_spi_platform_data *pdata; |
358934a6 SP |
139 | |
140 | void (*get_rx)(u32 rx_data, struct davinci_spi *); | |
141 | u32 (*get_tx)(struct davinci_spi *); | |
142 | ||
cda987eb | 143 | u8 bytes_per_word[SPI_MAX_CHIPSELECT]; |
358934a6 SP |
144 | }; |
145 | ||
53a31b07 BN |
146 | static struct davinci_spi_config davinci_spi_default_cfg; |
147 | ||
212d4b69 | 148 | static void davinci_spi_rx_buf_u8(u32 data, struct davinci_spi *dspi) |
358934a6 | 149 | { |
212d4b69 SN |
150 | if (dspi->rx) { |
151 | u8 *rx = dspi->rx; | |
53d454a1 | 152 | *rx++ = (u8)data; |
212d4b69 | 153 | dspi->rx = rx; |
53d454a1 | 154 | } |
358934a6 SP |
155 | } |
156 | ||
212d4b69 | 157 | static void davinci_spi_rx_buf_u16(u32 data, struct davinci_spi *dspi) |
358934a6 | 158 | { |
212d4b69 SN |
159 | if (dspi->rx) { |
160 | u16 *rx = dspi->rx; | |
53d454a1 | 161 | *rx++ = (u16)data; |
212d4b69 | 162 | dspi->rx = rx; |
53d454a1 | 163 | } |
358934a6 SP |
164 | } |
165 | ||
212d4b69 | 166 | static u32 davinci_spi_tx_buf_u8(struct davinci_spi *dspi) |
358934a6 | 167 | { |
53d454a1 | 168 | u32 data = 0; |
212d4b69 SN |
169 | if (dspi->tx) { |
170 | const u8 *tx = dspi->tx; | |
53d454a1 | 171 | data = *tx++; |
212d4b69 | 172 | dspi->tx = tx; |
53d454a1 | 173 | } |
358934a6 SP |
174 | return data; |
175 | } | |
176 | ||
212d4b69 | 177 | static u32 davinci_spi_tx_buf_u16(struct davinci_spi *dspi) |
358934a6 | 178 | { |
53d454a1 | 179 | u32 data = 0; |
212d4b69 SN |
180 | if (dspi->tx) { |
181 | const u16 *tx = dspi->tx; | |
53d454a1 | 182 | data = *tx++; |
212d4b69 | 183 | dspi->tx = tx; |
53d454a1 | 184 | } |
358934a6 SP |
185 | return data; |
186 | } | |
187 | ||
188 | static inline void set_io_bits(void __iomem *addr, u32 bits) | |
189 | { | |
190 | u32 v = ioread32(addr); | |
191 | ||
192 | v |= bits; | |
193 | iowrite32(v, addr); | |
194 | } | |
195 | ||
196 | static inline void clear_io_bits(void __iomem *addr, u32 bits) | |
197 | { | |
198 | u32 v = ioread32(addr); | |
199 | ||
200 | v &= ~bits; | |
201 | iowrite32(v, addr); | |
202 | } | |
203 | ||
358934a6 SP |
204 | /* |
205 | * Interface to control the chip select signal | |
206 | */ | |
207 | static void davinci_spi_chipselect(struct spi_device *spi, int value) | |
208 | { | |
212d4b69 | 209 | struct davinci_spi *dspi; |
358934a6 | 210 | struct davinci_spi_platform_data *pdata; |
7978b8c3 | 211 | u8 chip_sel = spi->chip_select; |
212d4b69 | 212 | u16 spidat1 = CS_DEFAULT; |
23853973 | 213 | bool gpio_chipsel = false; |
358934a6 | 214 | |
212d4b69 SN |
215 | dspi = spi_master_get_devdata(spi->master); |
216 | pdata = dspi->pdata; | |
358934a6 | 217 | |
23853973 BN |
218 | if (pdata->chip_sel && chip_sel < pdata->num_chipselect && |
219 | pdata->chip_sel[chip_sel] != SPI_INTERN_CS) | |
220 | gpio_chipsel = true; | |
221 | ||
358934a6 SP |
222 | /* |
223 | * Board specific chip select logic decides the polarity and cs | |
224 | * line for the controller | |
225 | */ | |
23853973 BN |
226 | if (gpio_chipsel) { |
227 | if (value == BITBANG_CS_ACTIVE) | |
228 | gpio_set_value(pdata->chip_sel[chip_sel], 0); | |
229 | else | |
230 | gpio_set_value(pdata->chip_sel[chip_sel], 1); | |
231 | } else { | |
232 | if (value == BITBANG_CS_ACTIVE) { | |
212d4b69 SN |
233 | spidat1 |= SPIDAT1_CSHOLD_MASK; |
234 | spidat1 &= ~(0x1 << chip_sel); | |
23853973 | 235 | } |
7978b8c3 | 236 | |
212d4b69 | 237 | iowrite16(spidat1, dspi->base + SPIDAT1 + 2); |
23853973 | 238 | } |
358934a6 SP |
239 | } |
240 | ||
7fe0092b BN |
241 | /** |
242 | * davinci_spi_get_prescale - Calculates the correct prescale value | |
243 | * @maxspeed_hz: the maximum rate the SPI clock can run at | |
244 | * | |
245 | * This function calculates the prescale value that generates a clock rate | |
246 | * less than or equal to the specified maximum. | |
247 | * | |
248 | * Returns: calculated prescale - 1 for easy programming into SPI registers | |
249 | * or negative error number if valid prescalar cannot be updated. | |
250 | */ | |
212d4b69 | 251 | static inline int davinci_spi_get_prescale(struct davinci_spi *dspi, |
7fe0092b BN |
252 | u32 max_speed_hz) |
253 | { | |
254 | int ret; | |
255 | ||
212d4b69 | 256 | ret = DIV_ROUND_UP(clk_get_rate(dspi->clk), max_speed_hz); |
7fe0092b BN |
257 | |
258 | if (ret < 3 || ret > 256) | |
259 | return -EINVAL; | |
260 | ||
261 | return ret - 1; | |
262 | } | |
263 | ||
358934a6 SP |
264 | /** |
265 | * davinci_spi_setup_transfer - This functions will determine transfer method | |
266 | * @spi: spi device on which data transfer to be done | |
267 | * @t: spi transfer in which transfer info is filled | |
268 | * | |
269 | * This function determines data transfer method (8/16/32 bit transfer). | |
270 | * It will also set the SPI Clock Control register according to | |
271 | * SPI slave device freq. | |
272 | */ | |
273 | static int davinci_spi_setup_transfer(struct spi_device *spi, | |
274 | struct spi_transfer *t) | |
275 | { | |
276 | ||
212d4b69 | 277 | struct davinci_spi *dspi; |
25f33512 | 278 | struct davinci_spi_config *spicfg; |
358934a6 | 279 | u8 bits_per_word = 0; |
25f33512 | 280 | u32 hz = 0, spifmt = 0, prescale = 0; |
358934a6 | 281 | |
212d4b69 | 282 | dspi = spi_master_get_devdata(spi->master); |
25f33512 BN |
283 | spicfg = (struct davinci_spi_config *)spi->controller_data; |
284 | if (!spicfg) | |
285 | spicfg = &davinci_spi_default_cfg; | |
358934a6 SP |
286 | |
287 | if (t) { | |
288 | bits_per_word = t->bits_per_word; | |
289 | hz = t->speed_hz; | |
290 | } | |
291 | ||
292 | /* if bits_per_word is not set then set it default */ | |
293 | if (!bits_per_word) | |
294 | bits_per_word = spi->bits_per_word; | |
295 | ||
296 | /* | |
297 | * Assign function pointer to appropriate transfer method | |
298 | * 8bit, 16bit or 32bit transfer | |
299 | */ | |
300 | if (bits_per_word <= 8 && bits_per_word >= 2) { | |
212d4b69 SN |
301 | dspi->get_rx = davinci_spi_rx_buf_u8; |
302 | dspi->get_tx = davinci_spi_tx_buf_u8; | |
303 | dspi->bytes_per_word[spi->chip_select] = 1; | |
358934a6 | 304 | } else if (bits_per_word <= 16 && bits_per_word >= 2) { |
212d4b69 SN |
305 | dspi->get_rx = davinci_spi_rx_buf_u16; |
306 | dspi->get_tx = davinci_spi_tx_buf_u16; | |
307 | dspi->bytes_per_word[spi->chip_select] = 2; | |
358934a6 SP |
308 | } else |
309 | return -EINVAL; | |
310 | ||
311 | if (!hz) | |
312 | hz = spi->max_speed_hz; | |
313 | ||
25f33512 BN |
314 | /* Set up SPIFMTn register, unique to this chipselect. */ |
315 | ||
212d4b69 | 316 | prescale = davinci_spi_get_prescale(dspi, hz); |
7fe0092b BN |
317 | if (prescale < 0) |
318 | return prescale; | |
319 | ||
25f33512 BN |
320 | spifmt = (prescale << SPIFMT_PRESCALE_SHIFT) | (bits_per_word & 0x1f); |
321 | ||
322 | if (spi->mode & SPI_LSB_FIRST) | |
323 | spifmt |= SPIFMT_SHIFTDIR_MASK; | |
324 | ||
325 | if (spi->mode & SPI_CPOL) | |
326 | spifmt |= SPIFMT_POLARITY_MASK; | |
327 | ||
328 | if (!(spi->mode & SPI_CPHA)) | |
329 | spifmt |= SPIFMT_PHASE_MASK; | |
330 | ||
331 | /* | |
332 | * Version 1 hardware supports two basic SPI modes: | |
333 | * - Standard SPI mode uses 4 pins, with chipselect | |
334 | * - 3 pin SPI is a 4 pin variant without CS (SPI_NO_CS) | |
335 | * (distinct from SPI_3WIRE, with just one data wire; | |
336 | * or similar variants without MOSI or without MISO) | |
337 | * | |
338 | * Version 2 hardware supports an optional handshaking signal, | |
339 | * so it can support two more modes: | |
340 | * - 5 pin SPI variant is standard SPI plus SPI_READY | |
341 | * - 4 pin with enable is (SPI_READY | SPI_NO_CS) | |
342 | */ | |
343 | ||
212d4b69 | 344 | if (dspi->version == SPI_VERSION_2) { |
25f33512 | 345 | |
7abbf23c BN |
346 | u32 delay = 0; |
347 | ||
25f33512 BN |
348 | spifmt |= ((spicfg->wdelay << SPIFMT_WDELAY_SHIFT) |
349 | & SPIFMT_WDELAY_MASK); | |
358934a6 | 350 | |
25f33512 BN |
351 | if (spicfg->odd_parity) |
352 | spifmt |= SPIFMT_ODD_PARITY_MASK; | |
353 | ||
354 | if (spicfg->parity_enable) | |
355 | spifmt |= SPIFMT_PARITYENA_MASK; | |
356 | ||
7abbf23c | 357 | if (spicfg->timer_disable) { |
25f33512 | 358 | spifmt |= SPIFMT_DISTIMER_MASK; |
7abbf23c BN |
359 | } else { |
360 | delay |= (spicfg->c2tdelay << SPIDELAY_C2TDELAY_SHIFT) | |
361 | & SPIDELAY_C2TDELAY_MASK; | |
362 | delay |= (spicfg->t2cdelay << SPIDELAY_T2CDELAY_SHIFT) | |
363 | & SPIDELAY_T2CDELAY_MASK; | |
364 | } | |
25f33512 | 365 | |
7abbf23c | 366 | if (spi->mode & SPI_READY) { |
25f33512 | 367 | spifmt |= SPIFMT_WAITENA_MASK; |
7abbf23c BN |
368 | delay |= (spicfg->t2edelay << SPIDELAY_T2EDELAY_SHIFT) |
369 | & SPIDELAY_T2EDELAY_MASK; | |
370 | delay |= (spicfg->c2edelay << SPIDELAY_C2EDELAY_SHIFT) | |
371 | & SPIDELAY_C2EDELAY_MASK; | |
372 | } | |
373 | ||
212d4b69 | 374 | iowrite32(delay, dspi->base + SPIDELAY); |
25f33512 BN |
375 | } |
376 | ||
212d4b69 | 377 | iowrite32(spifmt, dspi->base + SPIFMT0); |
358934a6 SP |
378 | |
379 | return 0; | |
380 | } | |
381 | ||
358934a6 SP |
382 | /** |
383 | * davinci_spi_setup - This functions will set default transfer method | |
384 | * @spi: spi device on which data transfer to be done | |
385 | * | |
386 | * This functions sets the default transfer method. | |
387 | */ | |
358934a6 SP |
388 | static int davinci_spi_setup(struct spi_device *spi) |
389 | { | |
b23a5d46 | 390 | int retval = 0; |
212d4b69 | 391 | struct davinci_spi *dspi; |
be88471b | 392 | struct davinci_spi_platform_data *pdata; |
358934a6 | 393 | |
212d4b69 SN |
394 | dspi = spi_master_get_devdata(spi->master); |
395 | pdata = dspi->pdata; | |
358934a6 SP |
396 | |
397 | /* if bits per word length is zero then set it default 8 */ | |
398 | if (!spi->bits_per_word) | |
399 | spi->bits_per_word = 8; | |
400 | ||
be88471b BN |
401 | if (!(spi->mode & SPI_NO_CS)) { |
402 | if ((pdata->chip_sel == NULL) || | |
403 | (pdata->chip_sel[spi->chip_select] == SPI_INTERN_CS)) | |
212d4b69 | 404 | set_io_bits(dspi->base + SPIPC0, 1 << spi->chip_select); |
be88471b BN |
405 | |
406 | } | |
407 | ||
408 | if (spi->mode & SPI_READY) | |
212d4b69 | 409 | set_io_bits(dspi->base + SPIPC0, SPIPC0_SPIENA_MASK); |
be88471b BN |
410 | |
411 | if (spi->mode & SPI_LOOP) | |
212d4b69 | 412 | set_io_bits(dspi->base + SPIGCR1, SPIGCR1_LOOPBACK_MASK); |
be88471b | 413 | else |
212d4b69 | 414 | clear_io_bits(dspi->base + SPIGCR1, SPIGCR1_LOOPBACK_MASK); |
be88471b | 415 | |
358934a6 SP |
416 | return retval; |
417 | } | |
418 | ||
212d4b69 | 419 | static int davinci_spi_check_error(struct davinci_spi *dspi, int int_status) |
358934a6 | 420 | { |
212d4b69 | 421 | struct device *sdev = dspi->bitbang.master->dev.parent; |
358934a6 SP |
422 | |
423 | if (int_status & SPIFLG_TIMEOUT_MASK) { | |
424 | dev_dbg(sdev, "SPI Time-out Error\n"); | |
425 | return -ETIMEDOUT; | |
426 | } | |
427 | if (int_status & SPIFLG_DESYNC_MASK) { | |
428 | dev_dbg(sdev, "SPI Desynchronization Error\n"); | |
429 | return -EIO; | |
430 | } | |
431 | if (int_status & SPIFLG_BITERR_MASK) { | |
432 | dev_dbg(sdev, "SPI Bit error\n"); | |
433 | return -EIO; | |
434 | } | |
435 | ||
212d4b69 | 436 | if (dspi->version == SPI_VERSION_2) { |
358934a6 SP |
437 | if (int_status & SPIFLG_DLEN_ERR_MASK) { |
438 | dev_dbg(sdev, "SPI Data Length Error\n"); | |
439 | return -EIO; | |
440 | } | |
441 | if (int_status & SPIFLG_PARERR_MASK) { | |
442 | dev_dbg(sdev, "SPI Parity Error\n"); | |
443 | return -EIO; | |
444 | } | |
445 | if (int_status & SPIFLG_OVRRUN_MASK) { | |
446 | dev_dbg(sdev, "SPI Data Overrun error\n"); | |
447 | return -EIO; | |
448 | } | |
358934a6 SP |
449 | if (int_status & SPIFLG_BUF_INIT_ACTIVE_MASK) { |
450 | dev_dbg(sdev, "SPI Buffer Init Active\n"); | |
451 | return -EBUSY; | |
452 | } | |
453 | } | |
454 | ||
455 | return 0; | |
456 | } | |
457 | ||
e0d205e9 BN |
458 | /** |
459 | * davinci_spi_process_events - check for and handle any SPI controller events | |
212d4b69 | 460 | * @dspi: the controller data |
e0d205e9 BN |
461 | * |
462 | * This function will check the SPIFLG register and handle any events that are | |
463 | * detected there | |
464 | */ | |
212d4b69 | 465 | static int davinci_spi_process_events(struct davinci_spi *dspi) |
e0d205e9 | 466 | { |
212d4b69 | 467 | u32 buf, status, errors = 0, spidat1; |
e0d205e9 | 468 | |
212d4b69 | 469 | buf = ioread32(dspi->base + SPIBUF); |
e0d205e9 | 470 | |
212d4b69 SN |
471 | if (dspi->rcount > 0 && !(buf & SPIBUF_RXEMPTY_MASK)) { |
472 | dspi->get_rx(buf & 0xFFFF, dspi); | |
473 | dspi->rcount--; | |
e0d205e9 BN |
474 | } |
475 | ||
212d4b69 | 476 | status = ioread32(dspi->base + SPIFLG); |
e0d205e9 BN |
477 | |
478 | if (unlikely(status & SPIFLG_ERROR_MASK)) { | |
479 | errors = status & SPIFLG_ERROR_MASK; | |
480 | goto out; | |
481 | } | |
482 | ||
212d4b69 SN |
483 | if (dspi->wcount > 0 && !(buf & SPIBUF_TXFULL_MASK)) { |
484 | spidat1 = ioread32(dspi->base + SPIDAT1); | |
485 | dspi->wcount--; | |
486 | spidat1 &= ~0xFFFF; | |
487 | spidat1 |= 0xFFFF & dspi->get_tx(dspi); | |
488 | iowrite32(spidat1, dspi->base + SPIDAT1); | |
e0d205e9 BN |
489 | } |
490 | ||
491 | out: | |
492 | return errors; | |
493 | } | |
494 | ||
048177ce | 495 | static void davinci_spi_dma_rx_callback(void *data) |
87467bd9 | 496 | { |
048177ce | 497 | struct davinci_spi *dspi = (struct davinci_spi *)data; |
87467bd9 | 498 | |
048177ce | 499 | dspi->rcount = 0; |
87467bd9 | 500 | |
048177ce MP |
501 | if (!dspi->wcount && !dspi->rcount) |
502 | complete(&dspi->done); | |
503 | } | |
87467bd9 | 504 | |
048177ce MP |
505 | static void davinci_spi_dma_tx_callback(void *data) |
506 | { | |
507 | struct davinci_spi *dspi = (struct davinci_spi *)data; | |
508 | ||
509 | dspi->wcount = 0; | |
510 | ||
511 | if (!dspi->wcount && !dspi->rcount) | |
212d4b69 | 512 | complete(&dspi->done); |
87467bd9 BN |
513 | } |
514 | ||
358934a6 SP |
515 | /** |
516 | * davinci_spi_bufs - functions which will handle transfer data | |
517 | * @spi: spi device on which data transfer to be done | |
518 | * @t: spi transfer in which transfer info is filled | |
519 | * | |
520 | * This function will put data to be transferred into data register | |
521 | * of SPI controller and then wait until the completion will be marked | |
522 | * by the IRQ Handler. | |
523 | */ | |
87467bd9 | 524 | static int davinci_spi_bufs(struct spi_device *spi, struct spi_transfer *t) |
358934a6 | 525 | { |
212d4b69 | 526 | struct davinci_spi *dspi; |
048177ce | 527 | int data_type, ret = -ENOMEM; |
212d4b69 | 528 | u32 tx_data, spidat1; |
839c996c | 529 | u32 errors = 0; |
e0d205e9 | 530 | struct davinci_spi_config *spicfg; |
358934a6 | 531 | struct davinci_spi_platform_data *pdata; |
87467bd9 | 532 | unsigned uninitialized_var(rx_buf_count); |
048177ce MP |
533 | void *dummy_buf = NULL; |
534 | struct scatterlist sg_rx, sg_tx; | |
358934a6 | 535 | |
212d4b69 SN |
536 | dspi = spi_master_get_devdata(spi->master); |
537 | pdata = dspi->pdata; | |
e0d205e9 BN |
538 | spicfg = (struct davinci_spi_config *)spi->controller_data; |
539 | if (!spicfg) | |
540 | spicfg = &davinci_spi_default_cfg; | |
87467bd9 BN |
541 | |
542 | /* convert len to words based on bits_per_word */ | |
212d4b69 | 543 | data_type = dspi->bytes_per_word[spi->chip_select]; |
358934a6 | 544 | |
212d4b69 SN |
545 | dspi->tx = t->tx_buf; |
546 | dspi->rx = t->rx_buf; | |
547 | dspi->wcount = t->len / data_type; | |
548 | dspi->rcount = dspi->wcount; | |
7978b8c3 | 549 | |
212d4b69 | 550 | spidat1 = ioread32(dspi->base + SPIDAT1); |
839c996c | 551 | |
212d4b69 SN |
552 | clear_io_bits(dspi->base + SPIGCR1, SPIGCR1_POWERDOWN_MASK); |
553 | set_io_bits(dspi->base + SPIGCR1, SPIGCR1_SPIENA_MASK); | |
358934a6 | 554 | |
212d4b69 | 555 | INIT_COMPLETION(dspi->done); |
87467bd9 BN |
556 | |
557 | if (spicfg->io_type == SPI_IO_TYPE_INTR) | |
212d4b69 | 558 | set_io_bits(dspi->base + SPIINT, SPIINT_MASKINT); |
cf90fe73 | 559 | |
87467bd9 BN |
560 | if (spicfg->io_type != SPI_IO_TYPE_DMA) { |
561 | /* start the transfer */ | |
212d4b69 SN |
562 | dspi->wcount--; |
563 | tx_data = dspi->get_tx(dspi); | |
564 | spidat1 &= 0xFFFF0000; | |
565 | spidat1 |= tx_data & 0xFFFF; | |
566 | iowrite32(spidat1, dspi->base + SPIDAT1); | |
87467bd9 | 567 | } else { |
048177ce MP |
568 | struct dma_slave_config dma_rx_conf = { |
569 | .direction = DMA_DEV_TO_MEM, | |
570 | .src_addr = (unsigned long)dspi->pbase + SPIBUF, | |
571 | .src_addr_width = data_type, | |
572 | .src_maxburst = 1, | |
573 | }; | |
574 | struct dma_slave_config dma_tx_conf = { | |
575 | .direction = DMA_MEM_TO_DEV, | |
576 | .dst_addr = (unsigned long)dspi->pbase + SPIDAT1, | |
577 | .dst_addr_width = data_type, | |
578 | .dst_maxburst = 1, | |
579 | }; | |
580 | struct dma_async_tx_descriptor *rxdesc; | |
581 | struct dma_async_tx_descriptor *txdesc; | |
582 | void *buf; | |
583 | ||
584 | dummy_buf = kzalloc(t->len, GFP_KERNEL); | |
585 | if (!dummy_buf) | |
586 | goto err_alloc_dummy_buf; | |
587 | ||
588 | dmaengine_slave_config(dspi->dma_rx, &dma_rx_conf); | |
589 | dmaengine_slave_config(dspi->dma_tx, &dma_tx_conf); | |
590 | ||
591 | sg_init_table(&sg_rx, 1); | |
592 | if (!t->rx_buf) | |
593 | buf = dummy_buf; | |
b1178b21 | 594 | else |
048177ce MP |
595 | buf = t->rx_buf; |
596 | t->rx_dma = dma_map_single(&spi->dev, buf, | |
597 | t->len, DMA_FROM_DEVICE); | |
598 | if (!t->rx_dma) { | |
599 | ret = -EFAULT; | |
600 | goto err_rx_map; | |
87467bd9 | 601 | } |
048177ce MP |
602 | sg_dma_address(&sg_rx) = t->rx_dma; |
603 | sg_dma_len(&sg_rx) = t->len; | |
87467bd9 | 604 | |
048177ce MP |
605 | sg_init_table(&sg_tx, 1); |
606 | if (!t->tx_buf) | |
607 | buf = dummy_buf; | |
608 | else | |
609 | buf = (void *)t->tx_buf; | |
610 | t->tx_dma = dma_map_single(&spi->dev, buf, | |
611 | t->len, DMA_FROM_DEVICE); | |
612 | if (!t->tx_dma) { | |
613 | ret = -EFAULT; | |
614 | goto err_tx_map; | |
87467bd9 | 615 | } |
048177ce MP |
616 | sg_dma_address(&sg_tx) = t->tx_dma; |
617 | sg_dma_len(&sg_tx) = t->len; | |
618 | ||
619 | rxdesc = dmaengine_prep_slave_sg(dspi->dma_rx, | |
620 | &sg_rx, 1, DMA_DEV_TO_MEM, | |
621 | DMA_PREP_INTERRUPT | DMA_CTRL_ACK); | |
622 | if (!rxdesc) | |
623 | goto err_desc; | |
624 | ||
625 | txdesc = dmaengine_prep_slave_sg(dspi->dma_tx, | |
626 | &sg_tx, 1, DMA_MEM_TO_DEV, | |
627 | DMA_PREP_INTERRUPT | DMA_CTRL_ACK); | |
628 | if (!txdesc) | |
629 | goto err_desc; | |
630 | ||
631 | rxdesc->callback = davinci_spi_dma_rx_callback; | |
632 | rxdesc->callback_param = (void *)dspi; | |
633 | txdesc->callback = davinci_spi_dma_tx_callback; | |
634 | txdesc->callback_param = (void *)dspi; | |
87467bd9 BN |
635 | |
636 | if (pdata->cshold_bug) | |
212d4b69 | 637 | iowrite16(spidat1 >> 16, dspi->base + SPIDAT1 + 2); |
87467bd9 | 638 | |
048177ce MP |
639 | dmaengine_submit(rxdesc); |
640 | dmaengine_submit(txdesc); | |
641 | ||
642 | dma_async_issue_pending(dspi->dma_rx); | |
643 | dma_async_issue_pending(dspi->dma_tx); | |
644 | ||
212d4b69 | 645 | set_io_bits(dspi->base + SPIINT, SPIINT_DMA_REQ_EN); |
87467bd9 | 646 | } |
358934a6 | 647 | |
e0d205e9 | 648 | /* Wait for the transfer to complete */ |
87467bd9 | 649 | if (spicfg->io_type != SPI_IO_TYPE_POLL) { |
212d4b69 | 650 | wait_for_completion_interruptible(&(dspi->done)); |
e0d205e9 | 651 | } else { |
212d4b69 SN |
652 | while (dspi->rcount > 0 || dspi->wcount > 0) { |
653 | errors = davinci_spi_process_events(dspi); | |
e0d205e9 BN |
654 | if (errors) |
655 | break; | |
656 | cpu_relax(); | |
358934a6 SP |
657 | } |
658 | } | |
659 | ||
212d4b69 | 660 | clear_io_bits(dspi->base + SPIINT, SPIINT_MASKALL); |
87467bd9 | 661 | if (spicfg->io_type == SPI_IO_TYPE_DMA) { |
212d4b69 | 662 | clear_io_bits(dspi->base + SPIINT, SPIINT_DMA_REQ_EN); |
048177ce MP |
663 | |
664 | dma_unmap_single(&spi->dev, t->rx_dma, | |
665 | t->len, DMA_FROM_DEVICE); | |
666 | dma_unmap_single(&spi->dev, t->tx_dma, | |
667 | t->len, DMA_TO_DEVICE); | |
668 | kfree(dummy_buf); | |
87467bd9 | 669 | } |
e0d205e9 | 670 | |
212d4b69 SN |
671 | clear_io_bits(dspi->base + SPIGCR1, SPIGCR1_SPIENA_MASK); |
672 | set_io_bits(dspi->base + SPIGCR1, SPIGCR1_POWERDOWN_MASK); | |
3f27b57c | 673 | |
358934a6 SP |
674 | /* |
675 | * Check for bit error, desync error,parity error,timeout error and | |
676 | * receive overflow errors | |
677 | */ | |
839c996c | 678 | if (errors) { |
212d4b69 | 679 | ret = davinci_spi_check_error(dspi, errors); |
839c996c BN |
680 | WARN(!ret, "%s: error reported but no error found!\n", |
681 | dev_name(&spi->dev)); | |
358934a6 | 682 | return ret; |
839c996c | 683 | } |
358934a6 | 684 | |
212d4b69 | 685 | if (dspi->rcount != 0 || dspi->wcount != 0) { |
048177ce | 686 | dev_err(&spi->dev, "SPI data transfer error\n"); |
87467bd9 BN |
687 | return -EIO; |
688 | } | |
689 | ||
358934a6 | 690 | return t->len; |
048177ce MP |
691 | |
692 | err_desc: | |
693 | dma_unmap_single(&spi->dev, t->tx_dma, t->len, DMA_TO_DEVICE); | |
694 | err_tx_map: | |
695 | dma_unmap_single(&spi->dev, t->rx_dma, t->len, DMA_FROM_DEVICE); | |
696 | err_rx_map: | |
697 | kfree(dummy_buf); | |
698 | err_alloc_dummy_buf: | |
699 | return ret; | |
358934a6 SP |
700 | } |
701 | ||
e0d205e9 BN |
702 | /** |
703 | * davinci_spi_irq - Interrupt handler for SPI Master Controller | |
704 | * @irq: IRQ number for this SPI Master | |
705 | * @context_data: structure for SPI Master controller davinci_spi | |
706 | * | |
707 | * ISR will determine that interrupt arrives either for READ or WRITE command. | |
708 | * According to command it will do the appropriate action. It will check | |
709 | * transfer length and if it is not zero then dispatch transfer command again. | |
710 | * If transfer length is zero then it will indicate the COMPLETION so that | |
711 | * davinci_spi_bufs function can go ahead. | |
712 | */ | |
212d4b69 | 713 | static irqreturn_t davinci_spi_irq(s32 irq, void *data) |
e0d205e9 | 714 | { |
212d4b69 | 715 | struct davinci_spi *dspi = data; |
e0d205e9 BN |
716 | int status; |
717 | ||
212d4b69 | 718 | status = davinci_spi_process_events(dspi); |
e0d205e9 | 719 | if (unlikely(status != 0)) |
212d4b69 | 720 | clear_io_bits(dspi->base + SPIINT, SPIINT_MASKINT); |
e0d205e9 | 721 | |
212d4b69 SN |
722 | if ((!dspi->rcount && !dspi->wcount) || status) |
723 | complete(&dspi->done); | |
e0d205e9 BN |
724 | |
725 | return IRQ_HANDLED; | |
726 | } | |
727 | ||
212d4b69 | 728 | static int davinci_spi_request_dma(struct davinci_spi *dspi) |
903ca25b | 729 | { |
048177ce MP |
730 | dma_cap_mask_t mask; |
731 | struct device *sdev = dspi->bitbang.master->dev.parent; | |
903ca25b SN |
732 | int r; |
733 | ||
048177ce MP |
734 | dma_cap_zero(mask); |
735 | dma_cap_set(DMA_SLAVE, mask); | |
736 | ||
737 | dspi->dma_rx = dma_request_channel(mask, edma_filter_fn, | |
738 | &dspi->dma_rx_chnum); | |
739 | if (!dspi->dma_rx) { | |
740 | dev_err(sdev, "request RX DMA channel failed\n"); | |
741 | r = -ENODEV; | |
523c37e7 | 742 | goto rx_dma_failed; |
903ca25b SN |
743 | } |
744 | ||
048177ce MP |
745 | dspi->dma_tx = dma_request_channel(mask, edma_filter_fn, |
746 | &dspi->dma_tx_chnum); | |
747 | if (!dspi->dma_tx) { | |
748 | dev_err(sdev, "request TX DMA channel failed\n"); | |
749 | r = -ENODEV; | |
523c37e7 | 750 | goto tx_dma_failed; |
903ca25b SN |
751 | } |
752 | ||
753 | return 0; | |
048177ce | 754 | |
523c37e7 | 755 | tx_dma_failed: |
048177ce | 756 | dma_release_channel(dspi->dma_rx); |
523c37e7 BN |
757 | rx_dma_failed: |
758 | return r; | |
903ca25b SN |
759 | } |
760 | ||
358934a6 SP |
761 | /** |
762 | * davinci_spi_probe - probe function for SPI Master Controller | |
763 | * @pdev: platform_device structure which contains plateform specific data | |
035540f6 BN |
764 | * |
765 | * According to Linux Device Model this function will be invoked by Linux | |
766 | * with platform_device struct which contains the device specific info. | |
767 | * This function will map the SPI controller's memory, register IRQ, | |
768 | * Reset SPI controller and setting its registers to default value. | |
769 | * It will invoke spi_bitbang_start to create work queue so that client driver | |
770 | * can register transfer method to work queue. | |
358934a6 | 771 | */ |
fd4a319b | 772 | static int davinci_spi_probe(struct platform_device *pdev) |
358934a6 SP |
773 | { |
774 | struct spi_master *master; | |
212d4b69 | 775 | struct davinci_spi *dspi; |
358934a6 SP |
776 | struct davinci_spi_platform_data *pdata; |
777 | struct resource *r, *mem; | |
778 | resource_size_t dma_rx_chan = SPI_NO_RESOURCE; | |
779 | resource_size_t dma_tx_chan = SPI_NO_RESOURCE; | |
358934a6 | 780 | int i = 0, ret = 0; |
f34bd4cc | 781 | u32 spipc0; |
358934a6 SP |
782 | |
783 | pdata = pdev->dev.platform_data; | |
784 | if (pdata == NULL) { | |
785 | ret = -ENODEV; | |
786 | goto err; | |
787 | } | |
788 | ||
789 | master = spi_alloc_master(&pdev->dev, sizeof(struct davinci_spi)); | |
790 | if (master == NULL) { | |
791 | ret = -ENOMEM; | |
792 | goto err; | |
793 | } | |
794 | ||
795 | dev_set_drvdata(&pdev->dev, master); | |
796 | ||
212d4b69 SN |
797 | dspi = spi_master_get_devdata(master); |
798 | if (dspi == NULL) { | |
358934a6 SP |
799 | ret = -ENOENT; |
800 | goto free_master; | |
801 | } | |
802 | ||
803 | r = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
804 | if (r == NULL) { | |
805 | ret = -ENOENT; | |
806 | goto free_master; | |
807 | } | |
808 | ||
212d4b69 SN |
809 | dspi->pbase = r->start; |
810 | dspi->pdata = pdata; | |
358934a6 | 811 | |
0e0eae4d | 812 | mem = request_mem_region(r->start, resource_size(r), pdev->name); |
358934a6 SP |
813 | if (mem == NULL) { |
814 | ret = -EBUSY; | |
815 | goto free_master; | |
816 | } | |
817 | ||
212d4b69 SN |
818 | dspi->base = ioremap(r->start, resource_size(r)); |
819 | if (dspi->base == NULL) { | |
358934a6 SP |
820 | ret = -ENOMEM; |
821 | goto release_region; | |
822 | } | |
823 | ||
212d4b69 SN |
824 | dspi->irq = platform_get_irq(pdev, 0); |
825 | if (dspi->irq <= 0) { | |
e0d205e9 BN |
826 | ret = -EINVAL; |
827 | goto unmap_io; | |
828 | } | |
829 | ||
212d4b69 SN |
830 | ret = request_irq(dspi->irq, davinci_spi_irq, 0, dev_name(&pdev->dev), |
831 | dspi); | |
e0d205e9 BN |
832 | if (ret) |
833 | goto unmap_io; | |
834 | ||
212d4b69 SN |
835 | dspi->bitbang.master = spi_master_get(master); |
836 | if (dspi->bitbang.master == NULL) { | |
358934a6 | 837 | ret = -ENODEV; |
d3f7141c | 838 | goto irq_free; |
358934a6 SP |
839 | } |
840 | ||
212d4b69 SN |
841 | dspi->clk = clk_get(&pdev->dev, NULL); |
842 | if (IS_ERR(dspi->clk)) { | |
358934a6 SP |
843 | ret = -ENODEV; |
844 | goto put_master; | |
845 | } | |
212d4b69 | 846 | clk_enable(dspi->clk); |
358934a6 | 847 | |
358934a6 SP |
848 | master->bus_num = pdev->id; |
849 | master->num_chipselect = pdata->num_chipselect; | |
850 | master->setup = davinci_spi_setup; | |
358934a6 | 851 | |
212d4b69 SN |
852 | dspi->bitbang.chipselect = davinci_spi_chipselect; |
853 | dspi->bitbang.setup_transfer = davinci_spi_setup_transfer; | |
358934a6 | 854 | |
212d4b69 | 855 | dspi->version = pdata->version; |
358934a6 | 856 | |
212d4b69 SN |
857 | dspi->bitbang.flags = SPI_NO_CS | SPI_LSB_FIRST | SPI_LOOP; |
858 | if (dspi->version == SPI_VERSION_2) | |
859 | dspi->bitbang.flags |= SPI_READY; | |
358934a6 | 860 | |
903ca25b SN |
861 | r = platform_get_resource(pdev, IORESOURCE_DMA, 0); |
862 | if (r) | |
863 | dma_rx_chan = r->start; | |
864 | r = platform_get_resource(pdev, IORESOURCE_DMA, 1); | |
865 | if (r) | |
866 | dma_tx_chan = r->start; | |
903ca25b | 867 | |
212d4b69 | 868 | dspi->bitbang.txrx_bufs = davinci_spi_bufs; |
903ca25b | 869 | if (dma_rx_chan != SPI_NO_RESOURCE && |
2e3e2a5e | 870 | dma_tx_chan != SPI_NO_RESOURCE) { |
048177ce MP |
871 | dspi->dma_rx_chnum = dma_rx_chan; |
872 | dspi->dma_tx_chnum = dma_tx_chan; | |
96fd881f | 873 | |
212d4b69 | 874 | ret = davinci_spi_request_dma(dspi); |
903ca25b SN |
875 | if (ret) |
876 | goto free_clk; | |
877 | ||
87467bd9 BN |
878 | dev_info(&pdev->dev, "DMA: supported\n"); |
879 | dev_info(&pdev->dev, "DMA: RX channel: %d, TX channel: %d, " | |
880 | "event queue: %d\n", dma_rx_chan, dma_tx_chan, | |
2e3e2a5e | 881 | pdata->dma_event_q); |
358934a6 SP |
882 | } |
883 | ||
212d4b69 SN |
884 | dspi->get_rx = davinci_spi_rx_buf_u8; |
885 | dspi->get_tx = davinci_spi_tx_buf_u8; | |
358934a6 | 886 | |
212d4b69 | 887 | init_completion(&dspi->done); |
e0d205e9 | 888 | |
358934a6 | 889 | /* Reset In/OUT SPI module */ |
212d4b69 | 890 | iowrite32(0, dspi->base + SPIGCR0); |
358934a6 | 891 | udelay(100); |
212d4b69 | 892 | iowrite32(1, dspi->base + SPIGCR0); |
358934a6 | 893 | |
be88471b | 894 | /* Set up SPIPC0. CS and ENA init is done in davinci_spi_setup */ |
f34bd4cc | 895 | spipc0 = SPIPC0_DIFUN_MASK | SPIPC0_DOFUN_MASK | SPIPC0_CLKFUN_MASK; |
212d4b69 | 896 | iowrite32(spipc0, dspi->base + SPIPC0); |
f34bd4cc | 897 | |
23853973 BN |
898 | /* initialize chip selects */ |
899 | if (pdata->chip_sel) { | |
900 | for (i = 0; i < pdata->num_chipselect; i++) { | |
901 | if (pdata->chip_sel[i] != SPI_INTERN_CS) | |
902 | gpio_direction_output(pdata->chip_sel[i], 1); | |
903 | } | |
904 | } | |
905 | ||
e0d205e9 | 906 | if (pdata->intr_line) |
212d4b69 | 907 | iowrite32(SPI_INTLVL_1, dspi->base + SPILVL); |
e0d205e9 | 908 | else |
212d4b69 | 909 | iowrite32(SPI_INTLVL_0, dspi->base + SPILVL); |
e0d205e9 | 910 | |
212d4b69 | 911 | iowrite32(CS_DEFAULT, dspi->base + SPIDEF); |
843a713b | 912 | |
358934a6 | 913 | /* master mode default */ |
212d4b69 SN |
914 | set_io_bits(dspi->base + SPIGCR1, SPIGCR1_CLKMOD_MASK); |
915 | set_io_bits(dspi->base + SPIGCR1, SPIGCR1_MASTER_MASK); | |
916 | set_io_bits(dspi->base + SPIGCR1, SPIGCR1_POWERDOWN_MASK); | |
358934a6 | 917 | |
212d4b69 | 918 | ret = spi_bitbang_start(&dspi->bitbang); |
358934a6 | 919 | if (ret) |
903ca25b | 920 | goto free_dma; |
358934a6 | 921 | |
212d4b69 | 922 | dev_info(&pdev->dev, "Controller at 0x%p\n", dspi->base); |
358934a6 | 923 | |
358934a6 SP |
924 | return ret; |
925 | ||
903ca25b | 926 | free_dma: |
048177ce MP |
927 | dma_release_channel(dspi->dma_rx); |
928 | dma_release_channel(dspi->dma_tx); | |
358934a6 | 929 | free_clk: |
212d4b69 SN |
930 | clk_disable(dspi->clk); |
931 | clk_put(dspi->clk); | |
358934a6 SP |
932 | put_master: |
933 | spi_master_put(master); | |
e0d205e9 | 934 | irq_free: |
212d4b69 | 935 | free_irq(dspi->irq, dspi); |
358934a6 | 936 | unmap_io: |
212d4b69 | 937 | iounmap(dspi->base); |
358934a6 | 938 | release_region: |
212d4b69 | 939 | release_mem_region(dspi->pbase, resource_size(r)); |
358934a6 SP |
940 | free_master: |
941 | kfree(master); | |
942 | err: | |
943 | return ret; | |
944 | } | |
945 | ||
946 | /** | |
947 | * davinci_spi_remove - remove function for SPI Master Controller | |
948 | * @pdev: platform_device structure which contains plateform specific data | |
949 | * | |
950 | * This function will do the reverse action of davinci_spi_probe function | |
951 | * It will free the IRQ and SPI controller's memory region. | |
952 | * It will also call spi_bitbang_stop to destroy the work queue which was | |
953 | * created by spi_bitbang_start. | |
954 | */ | |
fd4a319b | 955 | static int davinci_spi_remove(struct platform_device *pdev) |
358934a6 | 956 | { |
212d4b69 | 957 | struct davinci_spi *dspi; |
358934a6 | 958 | struct spi_master *master; |
0e0eae4d | 959 | struct resource *r; |
358934a6 SP |
960 | |
961 | master = dev_get_drvdata(&pdev->dev); | |
212d4b69 | 962 | dspi = spi_master_get_devdata(master); |
358934a6 | 963 | |
212d4b69 | 964 | spi_bitbang_stop(&dspi->bitbang); |
358934a6 | 965 | |
212d4b69 SN |
966 | clk_disable(dspi->clk); |
967 | clk_put(dspi->clk); | |
358934a6 | 968 | spi_master_put(master); |
212d4b69 SN |
969 | free_irq(dspi->irq, dspi); |
970 | iounmap(dspi->base); | |
0e0eae4d | 971 | r = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
212d4b69 | 972 | release_mem_region(dspi->pbase, resource_size(r)); |
358934a6 SP |
973 | |
974 | return 0; | |
975 | } | |
976 | ||
977 | static struct platform_driver davinci_spi_driver = { | |
d8c174cd BN |
978 | .driver = { |
979 | .name = "spi_davinci", | |
980 | .owner = THIS_MODULE, | |
981 | }, | |
940ab889 | 982 | .probe = davinci_spi_probe, |
fd4a319b | 983 | .remove = davinci_spi_remove, |
358934a6 | 984 | }; |
940ab889 | 985 | module_platform_driver(davinci_spi_driver); |
358934a6 SP |
986 | |
987 | MODULE_DESCRIPTION("TI DaVinci SPI Master Controller Driver"); | |
988 | MODULE_LICENSE("GPL"); |