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