mach-mx31moboard.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605
  1. /*
  2. * Copyright (C) 2008 Valentin Longchamp, EPFL Mobots group
  3. *
  4. * This program is free software; you can redistribute it and/or modify
  5. * it under the terms of the GNU General Public License as published by
  6. * the Free Software Foundation; either version 2 of the License, or
  7. * (at your option) any later version.
  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. #include <linux/delay.h>
  15. #include <linux/dma-mapping.h>
  16. #include <linux/gfp.h>
  17. #include <linux/gpio.h>
  18. #include <linux/init.h>
  19. #include <linux/interrupt.h>
  20. #include <linux/moduleparam.h>
  21. #include <linux/leds.h>
  22. #include <linux/memory.h>
  23. #include <linux/mtd/physmap.h>
  24. #include <linux/mtd/partitions.h>
  25. #include <linux/platform_device.h>
  26. #include <linux/regulator/machine.h>
  27. #include <linux/mfd/mc13783.h>
  28. #include <linux/spi/spi.h>
  29. #include <linux/types.h>
  30. #include <linux/memblock.h>
  31. #include <linux/clk.h>
  32. #include <linux/io.h>
  33. #include <linux/err.h>
  34. #include <linux/input.h>
  35. #include <linux/usb/otg.h>
  36. #include <linux/usb/ulpi.h>
  37. #include <asm/mach-types.h>
  38. #include <asm/mach/arch.h>
  39. #include <asm/mach/time.h>
  40. #include <asm/mach/map.h>
  41. #include <asm/memblock.h>
  42. #include <mach/board-mx31moboard.h>
  43. #include <mach/common.h>
  44. #include <mach/hardware.h>
  45. #include <mach/iomux-mx3.h>
  46. #include <mach/ulpi.h>
  47. #include "devices-imx31.h"
  48. static unsigned int moboard_pins[] = {
  49. /* UART0 */
  50. MX31_PIN_TXD1__TXD1, MX31_PIN_RXD1__RXD1,
  51. MX31_PIN_CTS1__GPIO2_7,
  52. /* UART4 */
  53. MX31_PIN_PC_RST__CTS5, MX31_PIN_PC_VS2__RTS5,
  54. MX31_PIN_PC_BVD2__TXD5, MX31_PIN_PC_BVD1__RXD5,
  55. /* I2C0 */
  56. MX31_PIN_I2C_DAT__I2C1_SDA, MX31_PIN_I2C_CLK__I2C1_SCL,
  57. /* I2C1 */
  58. MX31_PIN_DCD_DTE1__I2C2_SDA, MX31_PIN_RI_DTE1__I2C2_SCL,
  59. /* SDHC1 */
  60. MX31_PIN_SD1_DATA3__SD1_DATA3, MX31_PIN_SD1_DATA2__SD1_DATA2,
  61. MX31_PIN_SD1_DATA1__SD1_DATA1, MX31_PIN_SD1_DATA0__SD1_DATA0,
  62. MX31_PIN_SD1_CLK__SD1_CLK, MX31_PIN_SD1_CMD__SD1_CMD,
  63. MX31_PIN_ATA_CS0__GPIO3_26, MX31_PIN_ATA_CS1__GPIO3_27,
  64. /* USB reset */
  65. MX31_PIN_GPIO1_0__GPIO1_0,
  66. /* USB OTG */
  67. MX31_PIN_USBOTG_DATA0__USBOTG_DATA0,
  68. MX31_PIN_USBOTG_DATA1__USBOTG_DATA1,
  69. MX31_PIN_USBOTG_DATA2__USBOTG_DATA2,
  70. MX31_PIN_USBOTG_DATA3__USBOTG_DATA3,
  71. MX31_PIN_USBOTG_DATA4__USBOTG_DATA4,
  72. MX31_PIN_USBOTG_DATA5__USBOTG_DATA5,
  73. MX31_PIN_USBOTG_DATA6__USBOTG_DATA6,
  74. MX31_PIN_USBOTG_DATA7__USBOTG_DATA7,
  75. MX31_PIN_USBOTG_CLK__USBOTG_CLK, MX31_PIN_USBOTG_DIR__USBOTG_DIR,
  76. MX31_PIN_USBOTG_NXT__USBOTG_NXT, MX31_PIN_USBOTG_STP__USBOTG_STP,
  77. MX31_PIN_USB_OC__GPIO1_30,
  78. /* USB H2 */
  79. MX31_PIN_USBH2_DATA0__USBH2_DATA0,
  80. MX31_PIN_USBH2_DATA1__USBH2_DATA1,
  81. MX31_PIN_STXD3__USBH2_DATA2, MX31_PIN_SRXD3__USBH2_DATA3,
  82. MX31_PIN_SCK3__USBH2_DATA4, MX31_PIN_SFS3__USBH2_DATA5,
  83. MX31_PIN_STXD6__USBH2_DATA6, MX31_PIN_SRXD6__USBH2_DATA7,
  84. MX31_PIN_USBH2_CLK__USBH2_CLK, MX31_PIN_USBH2_DIR__USBH2_DIR,
  85. MX31_PIN_USBH2_NXT__USBH2_NXT, MX31_PIN_USBH2_STP__USBH2_STP,
  86. MX31_PIN_SCK6__GPIO1_25,
  87. /* LEDs */
  88. MX31_PIN_SVEN0__GPIO2_0, MX31_PIN_STX0__GPIO2_1,
  89. MX31_PIN_SRX0__GPIO2_2, MX31_PIN_SIMPD0__GPIO2_3,
  90. /* SPI1 */
  91. MX31_PIN_CSPI2_MOSI__MOSI, MX31_PIN_CSPI2_MISO__MISO,
  92. MX31_PIN_CSPI2_SCLK__SCLK, MX31_PIN_CSPI2_SPI_RDY__SPI_RDY,
  93. MX31_PIN_CSPI2_SS0__SS0, MX31_PIN_CSPI2_SS2__SS2,
  94. /* Atlas IRQ */
  95. MX31_PIN_GPIO1_3__GPIO1_3,
  96. /* SPI2 */
  97. MX31_PIN_CSPI3_MOSI__MOSI, MX31_PIN_CSPI3_MISO__MISO,
  98. MX31_PIN_CSPI3_SCLK__SCLK, MX31_PIN_CSPI3_SPI_RDY__SPI_RDY,
  99. MX31_PIN_CSPI2_SS1__CSPI3_SS1,
  100. };
  101. static struct physmap_flash_data mx31moboard_flash_data = {
  102. .width = 2,
  103. };
  104. static struct resource mx31moboard_flash_resource = {
  105. .start = 0xa0000000,
  106. .end = 0xa1ffffff,
  107. .flags = IORESOURCE_MEM,
  108. };
  109. static struct platform_device mx31moboard_flash = {
  110. .name = "physmap-flash",
  111. .id = 0,
  112. .dev = {
  113. .platform_data = &mx31moboard_flash_data,
  114. },
  115. .resource = &mx31moboard_flash_resource,
  116. .num_resources = 1,
  117. };
  118. static int moboard_uart0_init(struct platform_device *pdev)
  119. {
  120. int ret = gpio_request(IOMUX_TO_GPIO(MX31_PIN_CTS1), "uart0-cts-hack");
  121. if (ret)
  122. return ret;
  123. ret = gpio_direction_output(IOMUX_TO_GPIO(MX31_PIN_CTS1), 0);
  124. if (ret)
  125. gpio_free(IOMUX_TO_GPIO(MX31_PIN_CTS1));
  126. return ret;
  127. }
  128. static void moboard_uart0_exit(struct platform_device *pdev)
  129. {
  130. gpio_free(IOMUX_TO_GPIO(MX31_PIN_CTS1));
  131. }
  132. static const struct imxuart_platform_data uart0_pdata __initconst = {
  133. .init = moboard_uart0_init,
  134. .exit = moboard_uart0_exit,
  135. };
  136. static const struct imxuart_platform_data uart4_pdata __initconst = {
  137. .flags = IMXUART_HAVE_RTSCTS,
  138. };
  139. static const struct imxi2c_platform_data moboard_i2c0_data __initconst = {
  140. .bitrate = 400000,
  141. };
  142. static const struct imxi2c_platform_data moboard_i2c1_data __initconst = {
  143. .bitrate = 100000,
  144. };
  145. static int moboard_spi1_cs[] = {
  146. MXC_SPI_CS(0),
  147. MXC_SPI_CS(2),
  148. };
  149. static const struct spi_imx_master moboard_spi1_pdata __initconst = {
  150. .chipselect = moboard_spi1_cs,
  151. .num_chipselect = ARRAY_SIZE(moboard_spi1_cs),
  152. };
  153. static struct regulator_consumer_supply sdhc_consumers[] = {
  154. {
  155. .dev_name = "mxc-mmc.0",
  156. .supply = "sdhc0_vcc",
  157. },
  158. {
  159. .dev_name = "mxc-mmc.1",
  160. .supply = "sdhc1_vcc",
  161. },
  162. };
  163. static struct regulator_init_data sdhc_vreg_data = {
  164. .constraints = {
  165. .min_uV = 2700000,
  166. .max_uV = 3000000,
  167. .valid_ops_mask = REGULATOR_CHANGE_VOLTAGE |
  168. REGULATOR_CHANGE_MODE | REGULATOR_CHANGE_STATUS,
  169. .valid_modes_mask = REGULATOR_MODE_NORMAL |
  170. REGULATOR_MODE_FAST,
  171. .always_on = 0,
  172. .boot_on = 1,
  173. },
  174. .num_consumer_supplies = ARRAY_SIZE(sdhc_consumers),
  175. .consumer_supplies = sdhc_consumers,
  176. };
  177. static struct regulator_consumer_supply cam_consumers[] = {
  178. {
  179. .dev_name = "mx3_camera.0",
  180. .supply = "cam_vcc",
  181. },
  182. };
  183. static struct regulator_init_data cam_vreg_data = {
  184. .constraints = {
  185. .min_uV = 2700000,
  186. .max_uV = 3000000,
  187. .valid_ops_mask = REGULATOR_CHANGE_VOLTAGE |
  188. REGULATOR_CHANGE_MODE | REGULATOR_CHANGE_STATUS,
  189. .valid_modes_mask = REGULATOR_MODE_NORMAL |
  190. REGULATOR_MODE_FAST,
  191. .always_on = 0,
  192. .boot_on = 1,
  193. },
  194. .num_consumer_supplies = ARRAY_SIZE(cam_consumers),
  195. .consumer_supplies = cam_consumers,
  196. };
  197. static struct mc13xxx_regulator_init_data moboard_regulators[] = {
  198. {
  199. .id = MC13783_REG_VMMC1,
  200. .init_data = &sdhc_vreg_data,
  201. },
  202. {
  203. .id = MC13783_REG_VCAM,
  204. .init_data = &cam_vreg_data,
  205. },
  206. };
  207. static struct mc13xxx_led_platform_data moboard_led[] = {
  208. {
  209. .id = MC13783_LED_R1,
  210. .name = "coreboard-led-4:red",
  211. .max_current = 2,
  212. },
  213. {
  214. .id = MC13783_LED_G1,
  215. .name = "coreboard-led-4:green",
  216. .max_current = 2,
  217. },
  218. {
  219. .id = MC13783_LED_B1,
  220. .name = "coreboard-led-4:blue",
  221. .max_current = 2,
  222. },
  223. {
  224. .id = MC13783_LED_R2,
  225. .name = "coreboard-led-5:red",
  226. .max_current = 3,
  227. },
  228. {
  229. .id = MC13783_LED_G2,
  230. .name = "coreboard-led-5:green",
  231. .max_current = 3,
  232. },
  233. {
  234. .id = MC13783_LED_B2,
  235. .name = "coreboard-led-5:blue",
  236. .max_current = 3,
  237. },
  238. };
  239. static struct mc13xxx_leds_platform_data moboard_leds = {
  240. .num_leds = ARRAY_SIZE(moboard_led),
  241. .led = moboard_led,
  242. .flags = MC13783_LED_SLEWLIMTC,
  243. .abmode = MC13783_LED_AB_DISABLED,
  244. .tc1_period = MC13783_LED_PERIOD_10MS,
  245. .tc2_period = MC13783_LED_PERIOD_10MS,
  246. };
  247. static struct mc13xxx_buttons_platform_data moboard_buttons = {
  248. .b1on_flags = MC13783_BUTTON_DBNC_750MS | MC13783_BUTTON_ENABLE |
  249. MC13783_BUTTON_POL_INVERT,
  250. .b1on_key = KEY_POWER,
  251. };
  252. static struct mc13xxx_platform_data moboard_pmic = {
  253. .regulators = {
  254. .regulators = moboard_regulators,
  255. .num_regulators = ARRAY_SIZE(moboard_regulators),
  256. },
  257. .leds = &moboard_leds,
  258. .buttons = &moboard_buttons,
  259. .flags = MC13XXX_USE_RTC | MC13XXX_USE_ADC,
  260. };
  261. static struct spi_board_info moboard_spi_board_info[] __initdata = {
  262. {
  263. .modalias = "mc13783",
  264. .irq = IOMUX_TO_IRQ(MX31_PIN_GPIO1_3),
  265. .max_speed_hz = 300000,
  266. .bus_num = 1,
  267. .chip_select = 0,
  268. .platform_data = &moboard_pmic,
  269. .mode = SPI_CS_HIGH,
  270. },
  271. };
  272. static int moboard_spi2_cs[] = {
  273. MXC_SPI_CS(1),
  274. };
  275. static const struct spi_imx_master moboard_spi2_pdata __initconst = {
  276. .chipselect = moboard_spi2_cs,
  277. .num_chipselect = ARRAY_SIZE(moboard_spi2_cs),
  278. };
  279. #define SDHC1_CD IOMUX_TO_GPIO(MX31_PIN_ATA_CS0)
  280. #define SDHC1_WP IOMUX_TO_GPIO(MX31_PIN_ATA_CS1)
  281. static int moboard_sdhc1_get_ro(struct device *dev)
  282. {
  283. return !gpio_get_value(SDHC1_WP);
  284. }
  285. static int moboard_sdhc1_init(struct device *dev, irq_handler_t detect_irq,
  286. void *data)
  287. {
  288. int ret;
  289. ret = gpio_request(SDHC1_CD, "sdhc-detect");
  290. if (ret)
  291. return ret;
  292. gpio_direction_input(SDHC1_CD);
  293. ret = gpio_request(SDHC1_WP, "sdhc-wp");
  294. if (ret)
  295. goto err_gpio_free;
  296. gpio_direction_input(SDHC1_WP);
  297. ret = request_irq(gpio_to_irq(SDHC1_CD), detect_irq,
  298. IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
  299. "sdhc1-card-detect", data);
  300. if (ret)
  301. goto err_gpio_free_2;
  302. return 0;
  303. err_gpio_free_2:
  304. gpio_free(SDHC1_WP);
  305. err_gpio_free:
  306. gpio_free(SDHC1_CD);
  307. return ret;
  308. }
  309. static void moboard_sdhc1_exit(struct device *dev, void *data)
  310. {
  311. free_irq(gpio_to_irq(SDHC1_CD), data);
  312. gpio_free(SDHC1_WP);
  313. gpio_free(SDHC1_CD);
  314. }
  315. static const struct imxmmc_platform_data sdhc1_pdata __initconst = {
  316. .get_ro = moboard_sdhc1_get_ro,
  317. .init = moboard_sdhc1_init,
  318. .exit = moboard_sdhc1_exit,
  319. };
  320. /*
  321. * this pin is dedicated for all mx31moboard systems, so we do it here
  322. */
  323. #define USB_RESET_B IOMUX_TO_GPIO(MX31_PIN_GPIO1_0)
  324. #define USB_PAD_CFG (PAD_CTL_DRV_MAX | PAD_CTL_SRE_FAST | PAD_CTL_HYS_CMOS | \
  325. PAD_CTL_ODE_CMOS)
  326. #define OTG_EN_B IOMUX_TO_GPIO(MX31_PIN_USB_OC)
  327. #define USBH2_EN_B IOMUX_TO_GPIO(MX31_PIN_SCK6)
  328. static void usb_xcvr_reset(void)
  329. {
  330. mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA0, USB_PAD_CFG | PAD_CTL_100K_PD);
  331. mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA1, USB_PAD_CFG | PAD_CTL_100K_PD);
  332. mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA2, USB_PAD_CFG | PAD_CTL_100K_PD);
  333. mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA3, USB_PAD_CFG | PAD_CTL_100K_PD);
  334. mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA4, USB_PAD_CFG | PAD_CTL_100K_PD);
  335. mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA5, USB_PAD_CFG | PAD_CTL_100K_PD);
  336. mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA6, USB_PAD_CFG | PAD_CTL_100K_PD);
  337. mxc_iomux_set_pad(MX31_PIN_USBOTG_DATA7, USB_PAD_CFG | PAD_CTL_100K_PD);
  338. mxc_iomux_set_pad(MX31_PIN_USBOTG_CLK, USB_PAD_CFG | PAD_CTL_100K_PU);
  339. mxc_iomux_set_pad(MX31_PIN_USBOTG_DIR, USB_PAD_CFG | PAD_CTL_100K_PU);
  340. mxc_iomux_set_pad(MX31_PIN_USBOTG_NXT, USB_PAD_CFG | PAD_CTL_100K_PU);
  341. mxc_iomux_set_pad(MX31_PIN_USBOTG_STP, USB_PAD_CFG | PAD_CTL_100K_PU);
  342. mxc_iomux_set_gpr(MUX_PGP_UH2, true);
  343. mxc_iomux_set_pad(MX31_PIN_USBH2_CLK, USB_PAD_CFG | PAD_CTL_100K_PU);
  344. mxc_iomux_set_pad(MX31_PIN_USBH2_DIR, USB_PAD_CFG | PAD_CTL_100K_PU);
  345. mxc_iomux_set_pad(MX31_PIN_USBH2_NXT, USB_PAD_CFG | PAD_CTL_100K_PU);
  346. mxc_iomux_set_pad(MX31_PIN_USBH2_STP, USB_PAD_CFG | PAD_CTL_100K_PU);
  347. mxc_iomux_set_pad(MX31_PIN_USBH2_DATA0, USB_PAD_CFG | PAD_CTL_100K_PD);
  348. mxc_iomux_set_pad(MX31_PIN_USBH2_DATA1, USB_PAD_CFG | PAD_CTL_100K_PD);
  349. mxc_iomux_set_pad(MX31_PIN_SRXD6, USB_PAD_CFG | PAD_CTL_100K_PD);
  350. mxc_iomux_set_pad(MX31_PIN_STXD6, USB_PAD_CFG | PAD_CTL_100K_PD);
  351. mxc_iomux_set_pad(MX31_PIN_SFS3, USB_PAD_CFG | PAD_CTL_100K_PD);
  352. mxc_iomux_set_pad(MX31_PIN_SCK3, USB_PAD_CFG | PAD_CTL_100K_PD);
  353. mxc_iomux_set_pad(MX31_PIN_SRXD3, USB_PAD_CFG | PAD_CTL_100K_PD);
  354. mxc_iomux_set_pad(MX31_PIN_STXD3, USB_PAD_CFG | PAD_CTL_100K_PD);
  355. gpio_request(OTG_EN_B, "usb-udc-en");
  356. gpio_direction_output(OTG_EN_B, 0);
  357. gpio_request(USBH2_EN_B, "usbh2-en");
  358. gpio_direction_output(USBH2_EN_B, 0);
  359. gpio_request(USB_RESET_B, "usb-reset");
  360. gpio_direction_output(USB_RESET_B, 0);
  361. mdelay(1);
  362. gpio_set_value(USB_RESET_B, 1);
  363. mdelay(1);
  364. }
  365. static int moboard_usbh2_init_hw(struct platform_device *pdev)
  366. {
  367. return mx31_initialize_usb_hw(pdev->id, MXC_EHCI_POWER_PINS_ENABLED);
  368. }
  369. static struct mxc_usbh_platform_data usbh2_pdata __initdata = {
  370. .init = moboard_usbh2_init_hw,
  371. .portsc = MXC_EHCI_MODE_ULPI | MXC_EHCI_UTMI_8BIT,
  372. };
  373. static int __init moboard_usbh2_init(void)
  374. {
  375. struct platform_device *pdev;
  376. usbh2_pdata.otg = imx_otg_ulpi_create(ULPI_OTG_DRVVBUS |
  377. ULPI_OTG_DRVVBUS_EXT);
  378. if (!usbh2_pdata.otg)
  379. return -ENODEV;
  380. pdev = imx31_add_mxc_ehci_hs(2, &usbh2_pdata);
  381. if (IS_ERR(pdev))
  382. return PTR_ERR(pdev);
  383. return 0;
  384. }
  385. static const struct gpio_led mx31moboard_leds[] __initconst = {
  386. {
  387. .name = "coreboard-led-0:red:running",
  388. .default_trigger = "heartbeat",
  389. .gpio = IOMUX_TO_GPIO(MX31_PIN_SVEN0),
  390. }, {
  391. .name = "coreboard-led-1:red",
  392. .gpio = IOMUX_TO_GPIO(MX31_PIN_STX0),
  393. }, {
  394. .name = "coreboard-led-2:red",
  395. .gpio = IOMUX_TO_GPIO(MX31_PIN_SRX0),
  396. }, {
  397. .name = "coreboard-led-3:red",
  398. .gpio = IOMUX_TO_GPIO(MX31_PIN_SIMPD0),
  399. },
  400. };
  401. static const struct gpio_led_platform_data mx31moboard_led_pdata __initconst = {
  402. .num_leds = ARRAY_SIZE(mx31moboard_leds),
  403. .leds = mx31moboard_leds,
  404. };
  405. static const struct ipu_platform_data mx3_ipu_data __initconst = {
  406. .irq_base = MXC_IPU_IRQ_START,
  407. };
  408. static struct platform_device *devices[] __initdata = {
  409. &mx31moboard_flash,
  410. };
  411. static struct mx3_camera_pdata camera_pdata __initdata = {
  412. .flags = MX3_CAMERA_DATAWIDTH_8 | MX3_CAMERA_DATAWIDTH_10,
  413. .mclk_10khz = 4800,
  414. };
  415. static phys_addr_t mx3_camera_base __initdata;
  416. #define MX3_CAMERA_BUF_SIZE SZ_4M
  417. static int __init mx31moboard_init_cam(void)
  418. {
  419. int dma, ret = -ENOMEM;
  420. struct platform_device *pdev;
  421. imx31_add_ipu_core(&mx3_ipu_data);
  422. pdev = imx31_alloc_mx3_camera(&camera_pdata);
  423. if (IS_ERR(pdev))
  424. return PTR_ERR(pdev);
  425. dma = dma_declare_coherent_memory(&pdev->dev,
  426. mx3_camera_base, mx3_camera_base,
  427. MX3_CAMERA_BUF_SIZE,
  428. DMA_MEMORY_MAP | DMA_MEMORY_EXCLUSIVE);
  429. if (!(dma & DMA_MEMORY_MAP))
  430. goto err;
  431. ret = platform_device_add(pdev);
  432. if (ret)
  433. err:
  434. platform_device_put(pdev);
  435. return ret;
  436. }
  437. static void mx31moboard_poweroff(void)
  438. {
  439. struct clk *clk = clk_get_sys("imx2-wdt.0", NULL);
  440. if (!IS_ERR(clk))
  441. clk_prepare_enable(clk);
  442. mxc_iomux_mode(MX31_PIN_WATCHDOG_RST__WATCHDOG_RST);
  443. __raw_writew(1 << 6 | 1 << 2, MX31_IO_ADDRESS(MX31_WDOG_BASE_ADDR));
  444. }
  445. static int mx31moboard_baseboard;
  446. core_param(mx31moboard_baseboard, mx31moboard_baseboard, int, 0444);
  447. /*
  448. * Board specific initialization.
  449. */
  450. static void __init mx31moboard_init(void)
  451. {
  452. imx31_soc_init();
  453. mxc_iomux_setup_multiple_pins(moboard_pins, ARRAY_SIZE(moboard_pins),
  454. "moboard");
  455. platform_add_devices(devices, ARRAY_SIZE(devices));
  456. gpio_led_register_device(-1, &mx31moboard_led_pdata);
  457. imx31_add_imx2_wdt(NULL);
  458. imx31_add_imx_uart0(&uart0_pdata);
  459. imx31_add_imx_uart4(&uart4_pdata);
  460. imx31_add_imx_i2c0(&moboard_i2c0_data);
  461. imx31_add_imx_i2c1(&moboard_i2c1_data);
  462. imx31_add_spi_imx1(&moboard_spi1_pdata);
  463. imx31_add_spi_imx2(&moboard_spi2_pdata);
  464. gpio_request(IOMUX_TO_GPIO(MX31_PIN_GPIO1_3), "pmic-irq");
  465. gpio_direction_input(IOMUX_TO_GPIO(MX31_PIN_GPIO1_3));
  466. spi_register_board_info(moboard_spi_board_info,
  467. ARRAY_SIZE(moboard_spi_board_info));
  468. imx31_add_mxc_mmc(0, &sdhc1_pdata);
  469. mx31moboard_init_cam();
  470. usb_xcvr_reset();
  471. moboard_usbh2_init();
  472. pm_power_off = mx31moboard_poweroff;
  473. switch (mx31moboard_baseboard) {
  474. case MX31NOBOARD:
  475. break;
  476. case MX31DEVBOARD:
  477. mx31moboard_devboard_init();
  478. break;
  479. case MX31MARXBOT:
  480. mx31moboard_marxbot_init();
  481. break;
  482. case MX31SMARTBOT:
  483. case MX31EYEBOT:
  484. mx31moboard_smartbot_init(mx31moboard_baseboard);
  485. break;
  486. default:
  487. printk(KERN_ERR "Illegal mx31moboard_baseboard type %d\n",
  488. mx31moboard_baseboard);
  489. }
  490. }
  491. static void __init mx31moboard_timer_init(void)
  492. {
  493. mx31_clocks_init(26000000);
  494. }
  495. struct sys_timer mx31moboard_timer = {
  496. .init = mx31moboard_timer_init,
  497. };
  498. static void __init mx31moboard_reserve(void)
  499. {
  500. /* reserve 4 MiB for mx3-camera */
  501. mx3_camera_base = arm_memblock_steal(MX3_CAMERA_BUF_SIZE,
  502. MX3_CAMERA_BUF_SIZE);
  503. }
  504. MACHINE_START(MX31MOBOARD, "EPFL Mobots mx31moboard")
  505. /* Maintainer: Philippe Retornaz, EPFL Mobots group */
  506. .atag_offset = 0x100,
  507. .reserve = mx31moboard_reserve,
  508. .map_io = mx31_map_io,
  509. .init_early = imx31_init_early,
  510. .init_irq = mx31_init_irq,
  511. .handle_irq = imx31_handle_irq,
  512. .timer = &mx31moboard_timer,
  513. .init_machine = mx31moboard_init,
  514. .restart = mxc_restart,
  515. MACHINE_END