mx31moboard-marxbot.c 9.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373
  1. /*
  2. * Copyright (C) 2009 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/gpio.h>
  16. #include <linux/init.h>
  17. #include <linux/interrupt.h>
  18. #include <linux/i2c.h>
  19. #include <linux/spi/spi.h>
  20. #include <linux/slab.h>
  21. #include <linux/platform_device.h>
  22. #include <linux/types.h>
  23. #include <linux/usb/otg.h>
  24. #include <mach/common.h>
  25. #include <mach/hardware.h>
  26. #include <mach/iomux-mx3.h>
  27. #include <mach/ulpi.h>
  28. #include <media/soc_camera.h>
  29. #include "devices-imx31.h"
  30. static unsigned int marxbot_pins[] = {
  31. /* SDHC2 */
  32. MX31_PIN_PC_PWRON__SD2_DATA3, MX31_PIN_PC_VS1__SD2_DATA2,
  33. MX31_PIN_PC_READY__SD2_DATA1, MX31_PIN_PC_WAIT_B__SD2_DATA0,
  34. MX31_PIN_PC_CD2_B__SD2_CLK, MX31_PIN_PC_CD1_B__SD2_CMD,
  35. MX31_PIN_ATA_DIOR__GPIO3_28, MX31_PIN_ATA_DIOW__GPIO3_29,
  36. /* CSI */
  37. MX31_PIN_CSI_D6__CSI_D6, MX31_PIN_CSI_D7__CSI_D7,
  38. MX31_PIN_CSI_D8__CSI_D8, MX31_PIN_CSI_D9__CSI_D9,
  39. MX31_PIN_CSI_D10__CSI_D10, MX31_PIN_CSI_D11__CSI_D11,
  40. MX31_PIN_CSI_D12__CSI_D12, MX31_PIN_CSI_D13__CSI_D13,
  41. MX31_PIN_CSI_D14__CSI_D14, MX31_PIN_CSI_D15__CSI_D15,
  42. MX31_PIN_CSI_HSYNC__CSI_HSYNC, MX31_PIN_CSI_MCLK__CSI_MCLK,
  43. MX31_PIN_CSI_PIXCLK__CSI_PIXCLK, MX31_PIN_CSI_VSYNC__CSI_VSYNC,
  44. MX31_PIN_CSI_D4__GPIO3_4, MX31_PIN_CSI_D5__GPIO3_5,
  45. MX31_PIN_GPIO3_0__GPIO3_0, MX31_PIN_GPIO3_1__GPIO3_1,
  46. MX31_PIN_TXD2__GPIO1_28,
  47. /* dsPIC resets */
  48. MX31_PIN_STXD5__GPIO1_21, MX31_PIN_SRXD5__GPIO1_22,
  49. /*battery detection */
  50. MX31_PIN_LCS0__GPIO3_23,
  51. /* USB H1 */
  52. MX31_PIN_CSPI1_MISO__USBH1_RXDP, MX31_PIN_CSPI1_MOSI__USBH1_RXDM,
  53. MX31_PIN_CSPI1_SS0__USBH1_TXDM, MX31_PIN_CSPI1_SS1__USBH1_TXDP,
  54. MX31_PIN_CSPI1_SS2__USBH1_RCV, MX31_PIN_CSPI1_SCLK__USBH1_OEB,
  55. MX31_PIN_CSPI1_SPI_RDY__USBH1_FS, MX31_PIN_SFS6__USBH1_SUSPEND,
  56. MX31_PIN_NFRE_B__GPIO1_11, MX31_PIN_NFALE__GPIO1_12,
  57. /* SEL */
  58. MX31_PIN_DTR_DCE1__GPIO2_8, MX31_PIN_DSR_DCE1__GPIO2_9,
  59. MX31_PIN_RI_DCE1__GPIO2_10, MX31_PIN_DCD_DCE1__GPIO2_11,
  60. };
  61. #define SDHC2_CD IOMUX_TO_GPIO(MX31_PIN_ATA_DIOR)
  62. #define SDHC2_WP IOMUX_TO_GPIO(MX31_PIN_ATA_DIOW)
  63. static int marxbot_sdhc2_get_ro(struct device *dev)
  64. {
  65. return !gpio_get_value(SDHC2_WP);
  66. }
  67. static int marxbot_sdhc2_init(struct device *dev, irq_handler_t detect_irq,
  68. void *data)
  69. {
  70. int ret;
  71. ret = gpio_request(SDHC2_CD, "sdhc-detect");
  72. if (ret)
  73. return ret;
  74. gpio_direction_input(SDHC2_CD);
  75. ret = gpio_request(SDHC2_WP, "sdhc-wp");
  76. if (ret)
  77. goto err_gpio_free;
  78. gpio_direction_input(SDHC2_WP);
  79. ret = request_irq(gpio_to_irq(SDHC2_CD), detect_irq,
  80. IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
  81. "sdhc2-card-detect", data);
  82. if (ret)
  83. goto err_gpio_free_2;
  84. return 0;
  85. err_gpio_free_2:
  86. gpio_free(SDHC2_WP);
  87. err_gpio_free:
  88. gpio_free(SDHC2_CD);
  89. return ret;
  90. }
  91. static void marxbot_sdhc2_exit(struct device *dev, void *data)
  92. {
  93. free_irq(gpio_to_irq(SDHC2_CD), data);
  94. gpio_free(SDHC2_WP);
  95. gpio_free(SDHC2_CD);
  96. }
  97. static const struct imxmmc_platform_data sdhc2_pdata __initconst = {
  98. .get_ro = marxbot_sdhc2_get_ro,
  99. .init = marxbot_sdhc2_init,
  100. .exit = marxbot_sdhc2_exit,
  101. };
  102. #define TRSLAT_RST_B IOMUX_TO_GPIO(MX31_PIN_STXD5)
  103. #define DSPICS_RST_B IOMUX_TO_GPIO(MX31_PIN_SRXD5)
  104. static void dspics_resets_init(void)
  105. {
  106. if (!gpio_request(TRSLAT_RST_B, "translator-rst")) {
  107. gpio_direction_output(TRSLAT_RST_B, 0);
  108. gpio_export(TRSLAT_RST_B, false);
  109. }
  110. if (!gpio_request(DSPICS_RST_B, "dspics-rst")) {
  111. gpio_direction_output(DSPICS_RST_B, 0);
  112. gpio_export(DSPICS_RST_B, false);
  113. }
  114. }
  115. static struct spi_board_info marxbot_spi_board_info[] __initdata = {
  116. {
  117. .modalias = "spidev",
  118. .max_speed_hz = 300000,
  119. .bus_num = 1,
  120. .chip_select = 1, /* according spi1_cs[] ! */
  121. },
  122. };
  123. #define TURRETCAM_POWER IOMUX_TO_GPIO(MX31_PIN_GPIO3_1)
  124. #define BASECAM_POWER IOMUX_TO_GPIO(MX31_PIN_CSI_D5)
  125. #define TURRETCAM_RST_B IOMUX_TO_GPIO(MX31_PIN_GPIO3_0)
  126. #define BASECAM_RST_B IOMUX_TO_GPIO(MX31_PIN_CSI_D4)
  127. #define CAM_CHOICE IOMUX_TO_GPIO(MX31_PIN_TXD2)
  128. static int marxbot_basecam_power(struct device *dev, int on)
  129. {
  130. gpio_set_value(BASECAM_POWER, !on);
  131. return 0;
  132. }
  133. static int marxbot_basecam_reset(struct device *dev)
  134. {
  135. gpio_set_value(BASECAM_RST_B, 0);
  136. udelay(100);
  137. gpio_set_value(BASECAM_RST_B, 1);
  138. return 0;
  139. }
  140. static struct i2c_board_info marxbot_i2c_devices[] = {
  141. {
  142. I2C_BOARD_INFO("mt9t031", 0x5d),
  143. },
  144. };
  145. static struct soc_camera_link base_iclink = {
  146. .bus_id = 0, /* Must match with the camera ID */
  147. .power = marxbot_basecam_power,
  148. .reset = marxbot_basecam_reset,
  149. .board_info = &marxbot_i2c_devices[0],
  150. .i2c_adapter_id = 0,
  151. };
  152. static struct platform_device marxbot_camera[] = {
  153. {
  154. .name = "soc-camera-pdrv",
  155. .id = 0,
  156. .dev = {
  157. .platform_data = &base_iclink,
  158. },
  159. },
  160. };
  161. static struct platform_device *marxbot_cameras[] __initdata = {
  162. &marxbot_camera[0],
  163. };
  164. static int __init marxbot_cam_init(void)
  165. {
  166. int ret = gpio_request(CAM_CHOICE, "cam-choice");
  167. if (ret)
  168. return ret;
  169. gpio_direction_output(CAM_CHOICE, 0);
  170. ret = gpio_request(BASECAM_RST_B, "basecam-reset");
  171. if (ret)
  172. return ret;
  173. gpio_direction_output(BASECAM_RST_B, 1);
  174. ret = gpio_request(BASECAM_POWER, "basecam-standby");
  175. if (ret)
  176. return ret;
  177. gpio_direction_output(BASECAM_POWER, 0);
  178. ret = gpio_request(TURRETCAM_RST_B, "turretcam-reset");
  179. if (ret)
  180. return ret;
  181. gpio_direction_output(TURRETCAM_RST_B, 1);
  182. ret = gpio_request(TURRETCAM_POWER, "turretcam-standby");
  183. if (ret)
  184. return ret;
  185. gpio_direction_output(TURRETCAM_POWER, 0);
  186. return 0;
  187. }
  188. #define SEL0 IOMUX_TO_GPIO(MX31_PIN_DTR_DCE1)
  189. #define SEL1 IOMUX_TO_GPIO(MX31_PIN_DSR_DCE1)
  190. #define SEL2 IOMUX_TO_GPIO(MX31_PIN_RI_DCE1)
  191. #define SEL3 IOMUX_TO_GPIO(MX31_PIN_DCD_DCE1)
  192. static void marxbot_init_sel_gpios(void)
  193. {
  194. if (!gpio_request(SEL0, "sel0")) {
  195. gpio_direction_input(SEL0);
  196. gpio_export(SEL0, true);
  197. }
  198. if (!gpio_request(SEL1, "sel1")) {
  199. gpio_direction_input(SEL1);
  200. gpio_export(SEL1, true);
  201. }
  202. if (!gpio_request(SEL2, "sel2")) {
  203. gpio_direction_input(SEL2);
  204. gpio_export(SEL2, true);
  205. }
  206. if (!gpio_request(SEL3, "sel3")) {
  207. gpio_direction_input(SEL3);
  208. gpio_export(SEL3, true);
  209. }
  210. }
  211. #define USB_PAD_CFG (PAD_CTL_DRV_MAX | PAD_CTL_SRE_FAST | PAD_CTL_HYS_CMOS | \
  212. PAD_CTL_ODE_CMOS | PAD_CTL_100K_PU)
  213. static int marxbot_usbh1_hw_init(struct platform_device *pdev)
  214. {
  215. mxc_iomux_set_gpr(MUX_PGP_USB_SUSPEND, true);
  216. mxc_iomux_set_pad(MX31_PIN_CSPI1_MISO, USB_PAD_CFG);
  217. mxc_iomux_set_pad(MX31_PIN_CSPI1_MOSI, USB_PAD_CFG);
  218. mxc_iomux_set_pad(MX31_PIN_CSPI1_SS0, USB_PAD_CFG);
  219. mxc_iomux_set_pad(MX31_PIN_CSPI1_SS1, USB_PAD_CFG);
  220. mxc_iomux_set_pad(MX31_PIN_CSPI1_SS2, USB_PAD_CFG);
  221. mxc_iomux_set_pad(MX31_PIN_CSPI1_SCLK, USB_PAD_CFG);
  222. mxc_iomux_set_pad(MX31_PIN_CSPI1_SPI_RDY, USB_PAD_CFG);
  223. mxc_iomux_set_pad(MX31_PIN_SFS6, USB_PAD_CFG);
  224. mdelay(10);
  225. return mx31_initialize_usb_hw(pdev->id, MXC_EHCI_POWER_PINS_ENABLED |
  226. MXC_EHCI_INTERFACE_SINGLE_UNI);
  227. }
  228. #define USBH1_VBUSEN_B IOMUX_TO_GPIO(MX31_PIN_NFRE_B)
  229. #define USBH1_MODE IOMUX_TO_GPIO(MX31_PIN_NFALE)
  230. static int marxbot_isp1105_init(struct usb_phy *otg)
  231. {
  232. int ret = gpio_request(USBH1_MODE, "usbh1-mode");
  233. if (ret)
  234. return ret;
  235. /* single ended */
  236. gpio_direction_output(USBH1_MODE, 0);
  237. ret = gpio_request(USBH1_VBUSEN_B, "usbh1-vbusen");
  238. if (ret) {
  239. gpio_free(USBH1_MODE);
  240. return ret;
  241. }
  242. gpio_direction_output(USBH1_VBUSEN_B, 1);
  243. return 0;
  244. }
  245. static int marxbot_isp1105_set_vbus(struct usb_otg *otg, bool on)
  246. {
  247. if (on)
  248. gpio_set_value(USBH1_VBUSEN_B, 0);
  249. else
  250. gpio_set_value(USBH1_VBUSEN_B, 1);
  251. return 0;
  252. }
  253. static struct mxc_usbh_platform_data usbh1_pdata __initdata = {
  254. .init = marxbot_usbh1_hw_init,
  255. .portsc = MXC_EHCI_MODE_UTMI | MXC_EHCI_SERIAL,
  256. };
  257. static int __init marxbot_usbh1_init(void)
  258. {
  259. struct usb_phy *phy;
  260. struct platform_device *pdev;
  261. phy = kzalloc(sizeof(*phy), GFP_KERNEL);
  262. if (!phy)
  263. return -ENOMEM;
  264. phy->otg = kzalloc(sizeof(struct usb_otg), GFP_KERNEL);
  265. if (!phy->otg) {
  266. kfree(phy);
  267. return -ENOMEM;
  268. }
  269. phy->label = "ISP1105";
  270. phy->init = marxbot_isp1105_init;
  271. phy->otg->set_vbus = marxbot_isp1105_set_vbus;
  272. usbh1_pdata.otg = phy;
  273. pdev = imx31_add_mxc_ehci_hs(1, &usbh1_pdata);
  274. if (IS_ERR(pdev))
  275. return PTR_ERR(pdev);
  276. return 0;
  277. }
  278. static const struct fsl_usb2_platform_data usb_pdata __initconst = {
  279. .operating_mode = FSL_USB2_DR_DEVICE,
  280. .phy_mode = FSL_USB2_PHY_ULPI,
  281. };
  282. /*
  283. * system init for baseboard usage. Will be called by mx31moboard init.
  284. */
  285. void __init mx31moboard_marxbot_init(void)
  286. {
  287. printk(KERN_INFO "Initializing mx31marxbot peripherals\n");
  288. mxc_iomux_setup_multiple_pins(marxbot_pins, ARRAY_SIZE(marxbot_pins),
  289. "marxbot");
  290. marxbot_init_sel_gpios();
  291. dspics_resets_init();
  292. imx31_add_mxc_mmc(1, &sdhc2_pdata);
  293. spi_register_board_info(marxbot_spi_board_info,
  294. ARRAY_SIZE(marxbot_spi_board_info));
  295. marxbot_cam_init();
  296. platform_add_devices(marxbot_cameras, ARRAY_SIZE(marxbot_cameras));
  297. /* battery present pin */
  298. gpio_request(IOMUX_TO_GPIO(MX31_PIN_LCS0), "bat-present");
  299. gpio_direction_input(IOMUX_TO_GPIO(MX31_PIN_LCS0));
  300. gpio_export(IOMUX_TO_GPIO(MX31_PIN_LCS0), false);
  301. imx31_add_fsl_usb2_udc(&usb_pdata);
  302. marxbot_usbh1_init();
  303. }