Commit | Line | Data |
---|---|---|
8edbede9 RR |
1 | /* |
2 | * timberdale.c timberdale FPGA MFD driver | |
3 | * Copyright (c) 2009 Intel Corporation | |
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 version 2 as | |
7 | * published by the Free Software Foundation. | |
8 | * | |
9 | * This program is distributed in the hope that it will be useful, | |
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
12 | * GNU General Public License for more details. | |
13 | * | |
14 | * You should have received a copy of the GNU General Public License | |
15 | * along with this program; if not, write to the Free Software | |
16 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
17 | */ | |
18 | ||
19 | /* Supports: | |
20 | * Timberdale FPGA | |
21 | */ | |
22 | ||
23 | #include <linux/kernel.h> | |
24 | #include <linux/module.h> | |
25 | #include <linux/pci.h> | |
26 | #include <linux/msi.h> | |
27 | #include <linux/mfd/core.h> | |
28 | ||
29 | #include <linux/timb_gpio.h> | |
30 | ||
31 | #include <linux/i2c.h> | |
32 | #include <linux/i2c-ocores.h> | |
33 | #include <linux/i2c/tsc2007.h> | |
34 | ||
35 | #include <linux/spi/spi.h> | |
36 | #include <linux/spi/xilinx_spi.h> | |
37 | #include <linux/spi/max7301.h> | |
38 | #include <linux/spi/mc33880.h> | |
39 | ||
40 | #include "timberdale.h" | |
41 | ||
42 | #define DRIVER_NAME "timberdale" | |
43 | ||
44 | struct timberdale_device { | |
45 | resource_size_t ctl_mapbase; | |
46 | unsigned char __iomem *ctl_membase; | |
47 | struct { | |
48 | u32 major; | |
49 | u32 minor; | |
50 | u32 config; | |
51 | } fw; | |
52 | }; | |
53 | ||
54 | /*--------------------------------------------------------------------------*/ | |
55 | ||
56 | static struct tsc2007_platform_data timberdale_tsc2007_platform_data = { | |
57 | .model = 2003, | |
58 | .x_plate_ohms = 100 | |
59 | }; | |
60 | ||
61 | static struct i2c_board_info timberdale_i2c_board_info[] = { | |
62 | { | |
63 | I2C_BOARD_INFO("tsc2007", 0x48), | |
64 | .platform_data = &timberdale_tsc2007_platform_data, | |
65 | .irq = IRQ_TIMBERDALE_TSC_INT | |
66 | }, | |
67 | }; | |
68 | ||
69 | static __devinitdata struct ocores_i2c_platform_data | |
70 | timberdale_ocores_platform_data = { | |
71 | .regstep = 4, | |
72 | .clock_khz = 62500, | |
73 | .devices = timberdale_i2c_board_info, | |
74 | .num_devices = ARRAY_SIZE(timberdale_i2c_board_info) | |
75 | }; | |
76 | ||
77 | const static __devinitconst struct resource timberdale_ocores_resources[] = { | |
78 | { | |
79 | .start = OCORESOFFSET, | |
80 | .end = OCORESEND, | |
81 | .flags = IORESOURCE_MEM, | |
82 | }, | |
83 | { | |
84 | .start = IRQ_TIMBERDALE_I2C, | |
85 | .end = IRQ_TIMBERDALE_I2C, | |
86 | .flags = IORESOURCE_IRQ, | |
87 | }, | |
88 | }; | |
89 | ||
90 | const struct max7301_platform_data timberdale_max7301_platform_data = { | |
91 | .base = 200 | |
92 | }; | |
93 | ||
94 | const struct mc33880_platform_data timberdale_mc33880_platform_data = { | |
95 | .base = 100 | |
96 | }; | |
97 | ||
98 | static struct spi_board_info timberdale_spi_16bit_board_info[] = { | |
99 | { | |
100 | .modalias = "max7301", | |
101 | .max_speed_hz = 26000, | |
102 | .chip_select = 2, | |
103 | .mode = SPI_MODE_0, | |
104 | .platform_data = &timberdale_max7301_platform_data | |
105 | }, | |
106 | }; | |
107 | ||
108 | static struct spi_board_info timberdale_spi_8bit_board_info[] = { | |
109 | { | |
110 | .modalias = "mc33880", | |
111 | .max_speed_hz = 4000, | |
112 | .chip_select = 1, | |
113 | .mode = SPI_MODE_1, | |
114 | .platform_data = &timberdale_mc33880_platform_data | |
115 | }, | |
116 | }; | |
117 | ||
118 | static __devinitdata struct xspi_platform_data timberdale_xspi_platform_data = { | |
119 | .num_chipselect = 3, | |
120 | .little_endian = true, | |
121 | /* bits per word and devices will be filled in runtime depending | |
122 | * on the HW config | |
123 | */ | |
124 | }; | |
125 | ||
126 | const static __devinitconst struct resource timberdale_spi_resources[] = { | |
127 | { | |
128 | .start = SPIOFFSET, | |
129 | .end = SPIEND, | |
130 | .flags = IORESOURCE_MEM, | |
131 | }, | |
132 | { | |
133 | .start = IRQ_TIMBERDALE_SPI, | |
134 | .end = IRQ_TIMBERDALE_SPI, | |
135 | .flags = IORESOURCE_IRQ, | |
136 | }, | |
137 | }; | |
138 | ||
139 | const static __devinitconst struct resource timberdale_eth_resources[] = { | |
140 | { | |
141 | .start = ETHOFFSET, | |
142 | .end = ETHEND, | |
143 | .flags = IORESOURCE_MEM, | |
144 | }, | |
145 | { | |
146 | .start = IRQ_TIMBERDALE_ETHSW_IF, | |
147 | .end = IRQ_TIMBERDALE_ETHSW_IF, | |
148 | .flags = IORESOURCE_IRQ, | |
149 | }, | |
150 | }; | |
151 | ||
152 | static __devinitdata struct timbgpio_platform_data | |
153 | timberdale_gpio_platform_data = { | |
154 | .gpio_base = 0, | |
155 | .nr_pins = GPIO_NR_PINS, | |
156 | .irq_base = 200, | |
157 | }; | |
158 | ||
159 | const static __devinitconst struct resource timberdale_gpio_resources[] = { | |
160 | { | |
161 | .start = GPIOOFFSET, | |
162 | .end = GPIOEND, | |
163 | .flags = IORESOURCE_MEM, | |
164 | }, | |
165 | { | |
166 | .start = IRQ_TIMBERDALE_GPIO, | |
167 | .end = IRQ_TIMBERDALE_GPIO, | |
168 | .flags = IORESOURCE_IRQ, | |
169 | }, | |
170 | }; | |
171 | ||
172 | const static __devinitconst struct resource timberdale_mlogicore_resources[] = { | |
173 | { | |
174 | .start = MLCOREOFFSET, | |
175 | .end = MLCOREEND, | |
176 | .flags = IORESOURCE_MEM, | |
177 | }, | |
178 | { | |
179 | .start = IRQ_TIMBERDALE_MLCORE, | |
180 | .end = IRQ_TIMBERDALE_MLCORE, | |
181 | .flags = IORESOURCE_IRQ, | |
182 | }, | |
183 | { | |
184 | .start = IRQ_TIMBERDALE_MLCORE_BUF, | |
185 | .end = IRQ_TIMBERDALE_MLCORE_BUF, | |
186 | .flags = IORESOURCE_IRQ, | |
187 | }, | |
188 | }; | |
189 | ||
190 | const static __devinitconst struct resource timberdale_uart_resources[] = { | |
191 | { | |
192 | .start = UARTOFFSET, | |
193 | .end = UARTEND, | |
194 | .flags = IORESOURCE_MEM, | |
195 | }, | |
196 | { | |
197 | .start = IRQ_TIMBERDALE_UART, | |
198 | .end = IRQ_TIMBERDALE_UART, | |
199 | .flags = IORESOURCE_IRQ, | |
200 | }, | |
201 | }; | |
202 | ||
203 | const static __devinitconst struct resource timberdale_uartlite_resources[] = { | |
204 | { | |
205 | .start = UARTLITEOFFSET, | |
206 | .end = UARTLITEEND, | |
207 | .flags = IORESOURCE_MEM, | |
208 | }, | |
209 | { | |
210 | .start = IRQ_TIMBERDALE_UARTLITE, | |
211 | .end = IRQ_TIMBERDALE_UARTLITE, | |
212 | .flags = IORESOURCE_IRQ, | |
213 | }, | |
214 | }; | |
215 | ||
216 | const static __devinitconst struct resource timberdale_dma_resources[] = { | |
217 | { | |
218 | .start = DMAOFFSET, | |
219 | .end = DMAEND, | |
220 | .flags = IORESOURCE_MEM, | |
221 | }, | |
222 | { | |
223 | .start = IRQ_TIMBERDALE_DMA, | |
224 | .end = IRQ_TIMBERDALE_DMA, | |
225 | .flags = IORESOURCE_IRQ, | |
226 | }, | |
227 | }; | |
228 | ||
229 | static __devinitdata struct mfd_cell timberdale_cells_bar0_cfg0[] = { | |
230 | { | |
231 | .name = "timb-uart", | |
232 | .num_resources = ARRAY_SIZE(timberdale_uart_resources), | |
233 | .resources = timberdale_uart_resources, | |
234 | }, | |
235 | { | |
236 | .name = "timb-gpio", | |
237 | .num_resources = ARRAY_SIZE(timberdale_gpio_resources), | |
238 | .resources = timberdale_gpio_resources, | |
239 | .platform_data = &timberdale_gpio_platform_data, | |
240 | .data_size = sizeof(timberdale_gpio_platform_data), | |
241 | }, | |
242 | { | |
243 | .name = "xilinx_spi", | |
244 | .num_resources = ARRAY_SIZE(timberdale_spi_resources), | |
245 | .resources = timberdale_spi_resources, | |
246 | .platform_data = &timberdale_xspi_platform_data, | |
247 | .data_size = sizeof(timberdale_xspi_platform_data), | |
248 | }, | |
249 | { | |
250 | .name = "ks8842", | |
251 | .num_resources = ARRAY_SIZE(timberdale_eth_resources), | |
252 | .resources = timberdale_eth_resources, | |
253 | }, | |
254 | { | |
255 | .name = "timb-dma", | |
256 | .num_resources = ARRAY_SIZE(timberdale_dma_resources), | |
257 | .resources = timberdale_dma_resources, | |
258 | }, | |
259 | }; | |
260 | ||
261 | static __devinitdata struct mfd_cell timberdale_cells_bar0_cfg1[] = { | |
262 | { | |
263 | .name = "timb-uart", | |
264 | .num_resources = ARRAY_SIZE(timberdale_uart_resources), | |
265 | .resources = timberdale_uart_resources, | |
266 | }, | |
267 | { | |
268 | .name = "uartlite", | |
269 | .num_resources = ARRAY_SIZE(timberdale_uartlite_resources), | |
270 | .resources = timberdale_uartlite_resources, | |
271 | }, | |
272 | { | |
273 | .name = "timb-gpio", | |
274 | .num_resources = ARRAY_SIZE(timberdale_gpio_resources), | |
275 | .resources = timberdale_gpio_resources, | |
276 | .platform_data = &timberdale_gpio_platform_data, | |
277 | .data_size = sizeof(timberdale_gpio_platform_data), | |
278 | }, | |
279 | { | |
280 | .name = "timb-mlogicore", | |
281 | .num_resources = ARRAY_SIZE(timberdale_mlogicore_resources), | |
282 | .resources = timberdale_mlogicore_resources, | |
283 | }, | |
284 | { | |
285 | .name = "xilinx_spi", | |
286 | .num_resources = ARRAY_SIZE(timberdale_spi_resources), | |
287 | .resources = timberdale_spi_resources, | |
288 | .platform_data = &timberdale_xspi_platform_data, | |
289 | .data_size = sizeof(timberdale_xspi_platform_data), | |
290 | }, | |
291 | { | |
292 | .name = "ks8842", | |
293 | .num_resources = ARRAY_SIZE(timberdale_eth_resources), | |
294 | .resources = timberdale_eth_resources, | |
295 | }, | |
296 | { | |
297 | .name = "timb-dma", | |
298 | .num_resources = ARRAY_SIZE(timberdale_dma_resources), | |
299 | .resources = timberdale_dma_resources, | |
300 | }, | |
301 | }; | |
302 | ||
303 | static __devinitdata struct mfd_cell timberdale_cells_bar0_cfg2[] = { | |
304 | { | |
305 | .name = "timb-uart", | |
306 | .num_resources = ARRAY_SIZE(timberdale_uart_resources), | |
307 | .resources = timberdale_uart_resources, | |
308 | }, | |
309 | { | |
310 | .name = "timb-gpio", | |
311 | .num_resources = ARRAY_SIZE(timberdale_gpio_resources), | |
312 | .resources = timberdale_gpio_resources, | |
313 | .platform_data = &timberdale_gpio_platform_data, | |
314 | .data_size = sizeof(timberdale_gpio_platform_data), | |
315 | }, | |
316 | { | |
317 | .name = "xilinx_spi", | |
318 | .num_resources = ARRAY_SIZE(timberdale_spi_resources), | |
319 | .resources = timberdale_spi_resources, | |
320 | .platform_data = &timberdale_xspi_platform_data, | |
321 | .data_size = sizeof(timberdale_xspi_platform_data), | |
322 | }, | |
323 | { | |
324 | .name = "timb-dma", | |
325 | .num_resources = ARRAY_SIZE(timberdale_dma_resources), | |
326 | .resources = timberdale_dma_resources, | |
327 | }, | |
328 | }; | |
329 | ||
330 | static __devinitdata struct mfd_cell timberdale_cells_bar0_cfg3[] = { | |
331 | { | |
332 | .name = "timb-uart", | |
333 | .num_resources = ARRAY_SIZE(timberdale_uart_resources), | |
334 | .resources = timberdale_uart_resources, | |
335 | }, | |
336 | { | |
337 | .name = "ocores-i2c", | |
338 | .num_resources = ARRAY_SIZE(timberdale_ocores_resources), | |
339 | .resources = timberdale_ocores_resources, | |
340 | .platform_data = &timberdale_ocores_platform_data, | |
341 | .data_size = sizeof(timberdale_ocores_platform_data), | |
342 | }, | |
343 | { | |
344 | .name = "timb-gpio", | |
345 | .num_resources = ARRAY_SIZE(timberdale_gpio_resources), | |
346 | .resources = timberdale_gpio_resources, | |
347 | .platform_data = &timberdale_gpio_platform_data, | |
348 | .data_size = sizeof(timberdale_gpio_platform_data), | |
349 | }, | |
350 | { | |
351 | .name = "xilinx_spi", | |
352 | .num_resources = ARRAY_SIZE(timberdale_spi_resources), | |
353 | .resources = timberdale_spi_resources, | |
354 | .platform_data = &timberdale_xspi_platform_data, | |
355 | .data_size = sizeof(timberdale_xspi_platform_data), | |
356 | }, | |
357 | { | |
358 | .name = "ks8842", | |
359 | .num_resources = ARRAY_SIZE(timberdale_eth_resources), | |
360 | .resources = timberdale_eth_resources, | |
361 | }, | |
362 | { | |
363 | .name = "timb-dma", | |
364 | .num_resources = ARRAY_SIZE(timberdale_dma_resources), | |
365 | .resources = timberdale_dma_resources, | |
366 | }, | |
367 | }; | |
368 | ||
369 | static const __devinitconst struct resource timberdale_sdhc_resources[] = { | |
370 | /* located in bar 1 and bar 2 */ | |
371 | { | |
372 | .start = SDHC0OFFSET, | |
373 | .end = SDHC0END, | |
374 | .flags = IORESOURCE_MEM, | |
375 | }, | |
376 | { | |
377 | .start = IRQ_TIMBERDALE_SDHC, | |
378 | .end = IRQ_TIMBERDALE_SDHC, | |
379 | .flags = IORESOURCE_IRQ, | |
380 | }, | |
381 | }; | |
382 | ||
383 | static __devinitdata struct mfd_cell timberdale_cells_bar1[] = { | |
384 | { | |
385 | .name = "sdhci", | |
386 | .num_resources = ARRAY_SIZE(timberdale_sdhc_resources), | |
387 | .resources = timberdale_sdhc_resources, | |
388 | }, | |
389 | }; | |
390 | ||
391 | static __devinitdata struct mfd_cell timberdale_cells_bar2[] = { | |
392 | { | |
393 | .name = "sdhci", | |
394 | .num_resources = ARRAY_SIZE(timberdale_sdhc_resources), | |
395 | .resources = timberdale_sdhc_resources, | |
396 | }, | |
397 | }; | |
398 | ||
399 | static ssize_t show_fw_ver(struct device *dev, struct device_attribute *attr, | |
400 | char *buf) | |
401 | { | |
402 | struct pci_dev *pdev = to_pci_dev(dev); | |
403 | struct timberdale_device *priv = pci_get_drvdata(pdev); | |
404 | ||
405 | return sprintf(buf, "%d.%d.%d\n", priv->fw.major, priv->fw.minor, | |
406 | priv->fw.config); | |
407 | } | |
408 | ||
409 | static DEVICE_ATTR(fw_ver, S_IRUGO, show_fw_ver, NULL); | |
410 | ||
411 | /*--------------------------------------------------------------------------*/ | |
412 | ||
413 | static int __devinit timb_probe(struct pci_dev *dev, | |
414 | const struct pci_device_id *id) | |
415 | { | |
416 | struct timberdale_device *priv; | |
417 | int err, i; | |
418 | resource_size_t mapbase; | |
419 | struct msix_entry *msix_entries = NULL; | |
420 | u8 ip_setup; | |
421 | ||
422 | priv = kzalloc(sizeof(*priv), GFP_KERNEL); | |
423 | if (!priv) | |
424 | return -ENOMEM; | |
425 | ||
426 | pci_set_drvdata(dev, priv); | |
427 | ||
428 | err = pci_enable_device(dev); | |
429 | if (err) | |
430 | goto err_enable; | |
431 | ||
432 | mapbase = pci_resource_start(dev, 0); | |
433 | if (!mapbase) { | |
434 | dev_err(&dev->dev, "No resource\n"); | |
435 | goto err_start; | |
436 | } | |
437 | ||
438 | /* create a resource for the PCI master register */ | |
439 | priv->ctl_mapbase = mapbase + CHIPCTLOFFSET; | |
440 | if (!request_mem_region(priv->ctl_mapbase, CHIPCTLSIZE, "timb-ctl")) { | |
441 | dev_err(&dev->dev, "Failed to request ctl mem\n"); | |
442 | goto err_request; | |
443 | } | |
444 | ||
445 | priv->ctl_membase = ioremap(priv->ctl_mapbase, CHIPCTLSIZE); | |
446 | if (!priv->ctl_membase) { | |
447 | dev_err(&dev->dev, "ioremap failed for ctl mem\n"); | |
448 | goto err_ioremap; | |
449 | } | |
450 | ||
451 | /* read the HW config */ | |
452 | priv->fw.major = ioread32(priv->ctl_membase + TIMB_REV_MAJOR); | |
453 | priv->fw.minor = ioread32(priv->ctl_membase + TIMB_REV_MINOR); | |
454 | priv->fw.config = ioread32(priv->ctl_membase + TIMB_HW_CONFIG); | |
455 | ||
456 | if (priv->fw.major > TIMB_SUPPORTED_MAJOR) { | |
457 | dev_err(&dev->dev, "The driver supports an older " | |
458 | "version of the FPGA, please update the driver to " | |
459 | "support %d.%d\n", priv->fw.major, priv->fw.minor); | |
460 | goto err_ioremap; | |
461 | } | |
462 | if (priv->fw.major < TIMB_SUPPORTED_MAJOR || | |
463 | priv->fw.minor < TIMB_REQUIRED_MINOR) { | |
464 | dev_err(&dev->dev, "The FPGA image is too old (%d.%d), " | |
465 | "please upgrade the FPGA to at least: %d.%d\n", | |
466 | priv->fw.major, priv->fw.minor, | |
467 | TIMB_SUPPORTED_MAJOR, TIMB_REQUIRED_MINOR); | |
468 | goto err_ioremap; | |
469 | } | |
470 | ||
471 | msix_entries = kzalloc(TIMBERDALE_NR_IRQS * sizeof(*msix_entries), | |
472 | GFP_KERNEL); | |
473 | if (!msix_entries) | |
474 | goto err_ioremap; | |
475 | ||
476 | for (i = 0; i < TIMBERDALE_NR_IRQS; i++) | |
477 | msix_entries[i].entry = i; | |
478 | ||
479 | err = pci_enable_msix(dev, msix_entries, TIMBERDALE_NR_IRQS); | |
480 | if (err) { | |
481 | dev_err(&dev->dev, | |
482 | "MSI-X init failed: %d, expected entries: %d\n", | |
483 | err, TIMBERDALE_NR_IRQS); | |
484 | goto err_msix; | |
485 | } | |
486 | ||
487 | err = device_create_file(&dev->dev, &dev_attr_fw_ver); | |
488 | if (err) | |
489 | goto err_create_file; | |
490 | ||
491 | /* Reset all FPGA PLB peripherals */ | |
492 | iowrite32(0x1, priv->ctl_membase + TIMB_SW_RST); | |
493 | ||
494 | /* update IRQ offsets in I2C board info */ | |
495 | for (i = 0; i < ARRAY_SIZE(timberdale_i2c_board_info); i++) | |
496 | timberdale_i2c_board_info[i].irq = | |
497 | msix_entries[timberdale_i2c_board_info[i].irq].vector; | |
498 | ||
499 | /* Update the SPI configuration depending on the HW (8 or 16 bit) */ | |
500 | if (priv->fw.config & TIMB_HW_CONFIG_SPI_8BIT) { | |
501 | timberdale_xspi_platform_data.bits_per_word = 8; | |
502 | timberdale_xspi_platform_data.devices = | |
503 | timberdale_spi_8bit_board_info; | |
504 | timberdale_xspi_platform_data.num_devices = | |
505 | ARRAY_SIZE(timberdale_spi_8bit_board_info); | |
506 | } else { | |
507 | timberdale_xspi_platform_data.bits_per_word = 16; | |
508 | timberdale_xspi_platform_data.devices = | |
509 | timberdale_spi_16bit_board_info; | |
510 | timberdale_xspi_platform_data.num_devices = | |
511 | ARRAY_SIZE(timberdale_spi_16bit_board_info); | |
512 | } | |
513 | ||
514 | ip_setup = priv->fw.config & TIMB_HW_VER_MASK; | |
515 | switch (ip_setup) { | |
516 | case TIMB_HW_VER0: | |
517 | err = mfd_add_devices(&dev->dev, -1, | |
518 | timberdale_cells_bar0_cfg0, | |
519 | ARRAY_SIZE(timberdale_cells_bar0_cfg0), | |
520 | &dev->resource[0], msix_entries[0].vector); | |
521 | break; | |
522 | case TIMB_HW_VER1: | |
523 | err = mfd_add_devices(&dev->dev, -1, | |
524 | timberdale_cells_bar0_cfg1, | |
525 | ARRAY_SIZE(timberdale_cells_bar0_cfg1), | |
526 | &dev->resource[0], msix_entries[0].vector); | |
527 | break; | |
528 | case TIMB_HW_VER2: | |
529 | err = mfd_add_devices(&dev->dev, -1, | |
530 | timberdale_cells_bar0_cfg2, | |
531 | ARRAY_SIZE(timberdale_cells_bar0_cfg2), | |
532 | &dev->resource[0], msix_entries[0].vector); | |
533 | break; | |
534 | case TIMB_HW_VER3: | |
535 | err = mfd_add_devices(&dev->dev, -1, | |
536 | timberdale_cells_bar0_cfg3, | |
537 | ARRAY_SIZE(timberdale_cells_bar0_cfg3), | |
538 | &dev->resource[0], msix_entries[0].vector); | |
539 | break; | |
540 | default: | |
541 | dev_err(&dev->dev, "Uknown IP setup: %d.%d.%d\n", | |
542 | priv->fw.major, priv->fw.minor, ip_setup); | |
543 | err = -ENODEV; | |
544 | goto err_mfd; | |
545 | break; | |
546 | } | |
547 | ||
548 | if (err) { | |
549 | dev_err(&dev->dev, "mfd_add_devices failed: %d\n", err); | |
550 | goto err_mfd; | |
551 | } | |
552 | ||
553 | err = mfd_add_devices(&dev->dev, 0, | |
554 | timberdale_cells_bar1, ARRAY_SIZE(timberdale_cells_bar1), | |
555 | &dev->resource[1], msix_entries[0].vector); | |
556 | if (err) { | |
557 | dev_err(&dev->dev, "mfd_add_devices failed: %d\n", err); | |
558 | goto err_mfd2; | |
559 | } | |
560 | ||
561 | /* only version 0 and 3 have the iNand routed to SDHCI */ | |
562 | if (((priv->fw.config & TIMB_HW_VER_MASK) == TIMB_HW_VER0) || | |
563 | ((priv->fw.config & TIMB_HW_VER_MASK) == TIMB_HW_VER3)) { | |
564 | err = mfd_add_devices(&dev->dev, 1, timberdale_cells_bar2, | |
565 | ARRAY_SIZE(timberdale_cells_bar2), | |
566 | &dev->resource[2], msix_entries[0].vector); | |
567 | if (err) { | |
568 | dev_err(&dev->dev, "mfd_add_devices failed: %d\n", err); | |
569 | goto err_mfd2; | |
570 | } | |
571 | } | |
572 | ||
573 | kfree(msix_entries); | |
574 | ||
575 | dev_info(&dev->dev, | |
576 | "Found Timberdale Card. Rev: %d.%d, HW config: 0x%02x\n", | |
577 | priv->fw.major, priv->fw.minor, priv->fw.config); | |
578 | ||
579 | return 0; | |
580 | ||
581 | err_mfd2: | |
582 | mfd_remove_devices(&dev->dev); | |
583 | err_mfd: | |
584 | device_remove_file(&dev->dev, &dev_attr_fw_ver); | |
585 | err_create_file: | |
586 | pci_disable_msix(dev); | |
587 | err_msix: | |
588 | iounmap(priv->ctl_membase); | |
589 | err_ioremap: | |
590 | release_mem_region(priv->ctl_mapbase, CHIPCTLSIZE); | |
591 | err_request: | |
592 | pci_set_drvdata(dev, NULL); | |
593 | err_start: | |
594 | pci_disable_device(dev); | |
595 | err_enable: | |
596 | kfree(msix_entries); | |
597 | kfree(priv); | |
598 | pci_set_drvdata(dev, NULL); | |
599 | return -ENODEV; | |
600 | } | |
601 | ||
602 | static void __devexit timb_remove(struct pci_dev *dev) | |
603 | { | |
604 | struct timberdale_device *priv = pci_get_drvdata(dev); | |
605 | ||
606 | mfd_remove_devices(&dev->dev); | |
607 | ||
608 | device_remove_file(&dev->dev, &dev_attr_fw_ver); | |
609 | ||
610 | iounmap(priv->ctl_membase); | |
611 | release_mem_region(priv->ctl_mapbase, CHIPCTLSIZE); | |
612 | ||
613 | pci_disable_msix(dev); | |
614 | pci_disable_device(dev); | |
615 | pci_set_drvdata(dev, NULL); | |
616 | kfree(priv); | |
617 | } | |
618 | ||
619 | static struct pci_device_id timberdale_pci_tbl[] = { | |
620 | { PCI_DEVICE(PCI_VENDOR_ID_TIMB, PCI_DEVICE_ID_TIMB) }, | |
621 | { 0 } | |
622 | }; | |
623 | MODULE_DEVICE_TABLE(pci, timberdale_pci_tbl); | |
624 | ||
625 | static struct pci_driver timberdale_pci_driver = { | |
626 | .name = DRIVER_NAME, | |
627 | .id_table = timberdale_pci_tbl, | |
628 | .probe = timb_probe, | |
629 | .remove = __devexit_p(timb_remove), | |
630 | }; | |
631 | ||
632 | static int __init timberdale_init(void) | |
633 | { | |
634 | int err; | |
635 | ||
636 | err = pci_register_driver(&timberdale_pci_driver); | |
637 | if (err < 0) { | |
638 | printk(KERN_ERR | |
639 | "Failed to register PCI driver for %s device.\n", | |
640 | timberdale_pci_driver.name); | |
641 | return -ENODEV; | |
642 | } | |
643 | ||
644 | printk(KERN_INFO "Driver for %s has been successfully registered.\n", | |
645 | timberdale_pci_driver.name); | |
646 | ||
647 | return 0; | |
648 | } | |
649 | ||
650 | static void __exit timberdale_exit(void) | |
651 | { | |
652 | pci_unregister_driver(&timberdale_pci_driver); | |
653 | ||
654 | printk(KERN_INFO "Driver for %s has been successfully unregistered.\n", | |
655 | timberdale_pci_driver.name); | |
656 | } | |
657 | ||
658 | module_init(timberdale_init); | |
659 | module_exit(timberdale_exit); | |
660 | ||
661 | MODULE_AUTHOR("Mocean Laboratories <info@mocean-labs.com>"); | |
662 | MODULE_VERSION(DRV_VERSION); | |
663 | MODULE_LICENSE("GPL v2"); |