timberdale.c 18 KB

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