]>
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> |
e00f0b4a | 24 | #include <linux/platform_device.h> |
220bbcea | 25 | #include <linux/types.h> |
e00f0b4a | 26 | |
e00f0b4a | 27 | #include <mach/common.h> |
220bbcea | 28 | #include <mach/hardware.h> |
e00f0b4a VL |
29 | #include <mach/imx-uart.h> |
30 | #include <mach/iomux-mx3.h> | |
45b131a7 | 31 | #include <mach/mmc.h> |
e00f0b4a | 32 | |
04ea3c80 VL |
33 | #include <media/soc_camera.h> |
34 | ||
e00f0b4a VL |
35 | #include "devices.h" |
36 | ||
56c7a45b VL |
37 | static unsigned int marxbot_pins[] = { |
38 | /* SDHC2 */ | |
39 | MX31_PIN_PC_PWRON__SD2_DATA3, MX31_PIN_PC_VS1__SD2_DATA2, | |
40 | MX31_PIN_PC_READY__SD2_DATA1, MX31_PIN_PC_WAIT_B__SD2_DATA0, | |
41 | MX31_PIN_PC_CD2_B__SD2_CLK, MX31_PIN_PC_CD1_B__SD2_CMD, | |
42 | MX31_PIN_ATA_DIOR__GPIO3_28, MX31_PIN_ATA_DIOW__GPIO3_29, | |
43 | /* CSI */ | |
56c7a45b VL |
44 | MX31_PIN_CSI_D6__CSI_D6, MX31_PIN_CSI_D7__CSI_D7, |
45 | MX31_PIN_CSI_D8__CSI_D8, MX31_PIN_CSI_D9__CSI_D9, | |
46 | MX31_PIN_CSI_D10__CSI_D10, MX31_PIN_CSI_D11__CSI_D11, | |
47 | MX31_PIN_CSI_D12__CSI_D12, MX31_PIN_CSI_D13__CSI_D13, | |
48 | MX31_PIN_CSI_D14__CSI_D14, MX31_PIN_CSI_D15__CSI_D15, | |
49 | MX31_PIN_CSI_HSYNC__CSI_HSYNC, MX31_PIN_CSI_MCLK__CSI_MCLK, | |
50 | MX31_PIN_CSI_PIXCLK__CSI_PIXCLK, MX31_PIN_CSI_VSYNC__CSI_VSYNC, | |
04ea3c80 | 51 | MX31_PIN_CSI_D4__GPIO3_4, MX31_PIN_CSI_D5__GPIO3_5, |
56c7a45b VL |
52 | MX31_PIN_GPIO3_0__GPIO3_0, MX31_PIN_GPIO3_1__GPIO3_1, |
53 | MX31_PIN_TXD2__GPIO1_28, | |
2718c15c VL |
54 | /* dsPIC resets */ |
55 | MX31_PIN_STXD5__GPIO1_21, MX31_PIN_SRXD5__GPIO1_22, | |
10949fff VL |
56 | /*battery detection */ |
57 | MX31_PIN_LCS0__GPIO3_23, | |
56c7a45b VL |
58 | }; |
59 | ||
45b131a7 VL |
60 | #define SDHC2_CD IOMUX_TO_GPIO(MX31_PIN_ATA_DIOR) |
61 | #define SDHC2_WP IOMUX_TO_GPIO(MX31_PIN_ATA_DIOW) | |
62 | ||
63 | static int marxbot_sdhc2_get_ro(struct device *dev) | |
64 | { | |
563abb4b | 65 | return !gpio_get_value(SDHC2_WP); |
45b131a7 VL |
66 | } |
67 | ||
68 | static int marxbot_sdhc2_init(struct device *dev, irq_handler_t detect_irq, | |
69 | void *data) | |
70 | { | |
4f163eb8 SH |
71 | int ret; |
72 | ||
73 | ret = gpio_request(SDHC2_CD, "sdhc-detect"); | |
74 | if (ret) | |
75 | return ret; | |
76 | ||
77 | gpio_direction_input(SDHC2_CD); | |
78 | ||
79 | ret = gpio_request(SDHC2_WP, "sdhc-wp"); | |
80 | if (ret) | |
81 | goto err_gpio_free; | |
82 | gpio_direction_input(SDHC2_WP); | |
83 | ||
84 | ret = request_irq(gpio_to_irq(SDHC2_CD), detect_irq, | |
45b131a7 VL |
85 | IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, |
86 | "sdhc2-card-detect", data); | |
4f163eb8 SH |
87 | if (ret) |
88 | goto err_gpio_free_2; | |
89 | ||
90 | return 0; | |
91 | ||
92 | err_gpio_free_2: | |
93 | gpio_free(SDHC2_WP); | |
94 | err_gpio_free: | |
95 | gpio_free(SDHC2_CD); | |
96 | ||
97 | return ret; | |
45b131a7 VL |
98 | } |
99 | ||
100 | static void marxbot_sdhc2_exit(struct device *dev, void *data) | |
101 | { | |
102 | free_irq(gpio_to_irq(SDHC2_CD), data); | |
4f163eb8 SH |
103 | gpio_free(SDHC2_WP); |
104 | gpio_free(SDHC2_CD); | |
45b131a7 VL |
105 | } |
106 | ||
107 | static struct imxmmc_platform_data sdhc2_pdata = { | |
108 | .get_ro = marxbot_sdhc2_get_ro, | |
109 | .init = marxbot_sdhc2_init, | |
110 | .exit = marxbot_sdhc2_exit, | |
111 | }; | |
112 | ||
2718c15c VL |
113 | #define TRSLAT_RST_B IOMUX_TO_GPIO(MX31_PIN_STXD5) |
114 | #define DSPICS_RST_B IOMUX_TO_GPIO(MX31_PIN_SRXD5) | |
115 | ||
116 | static void dspics_resets_init(void) | |
117 | { | |
118 | if (!gpio_request(TRSLAT_RST_B, "translator-rst")) { | |
119 | gpio_direction_output(TRSLAT_RST_B, 1); | |
120 | gpio_export(TRSLAT_RST_B, false); | |
121 | } | |
122 | ||
123 | if (!gpio_request(DSPICS_RST_B, "dspics-rst")) { | |
124 | gpio_direction_output(DSPICS_RST_B, 1); | |
125 | gpio_export(DSPICS_RST_B, false); | |
126 | } | |
127 | } | |
128 | ||
04ea3c80 VL |
129 | #define TURRETCAM_POWER IOMUX_TO_GPIO(MX31_PIN_GPIO3_1) |
130 | #define BASECAM_POWER IOMUX_TO_GPIO(MX31_PIN_CSI_D5) | |
131 | #define TURRETCAM_RST_B IOMUX_TO_GPIO(MX31_PIN_GPIO3_0) | |
132 | #define BASECAM_RST_B IOMUX_TO_GPIO(MX31_PIN_CSI_D4) | |
133 | #define CAM_CHOICE IOMUX_TO_GPIO(MX31_PIN_TXD2) | |
134 | ||
135 | static int marxbot_basecam_power(struct device *dev, int on) | |
136 | { | |
137 | gpio_set_value(BASECAM_POWER, !on); | |
138 | return 0; | |
139 | } | |
140 | ||
141 | static int marxbot_basecam_reset(struct device *dev) | |
142 | { | |
143 | gpio_set_value(BASECAM_RST_B, 0); | |
144 | udelay(100); | |
145 | gpio_set_value(BASECAM_RST_B, 1); | |
146 | return 0; | |
147 | } | |
148 | ||
149 | static struct i2c_board_info marxbot_i2c_devices[] = { | |
150 | { | |
151 | I2C_BOARD_INFO("mt9t031", 0x5d), | |
152 | }, | |
153 | }; | |
154 | ||
155 | static struct soc_camera_link base_iclink = { | |
156 | .bus_id = 0, /* Must match with the camera ID */ | |
157 | .power = marxbot_basecam_power, | |
158 | .reset = marxbot_basecam_reset, | |
159 | .board_info = &marxbot_i2c_devices[0], | |
160 | .i2c_adapter_id = 0, | |
161 | .module_name = "mt9t031", | |
162 | }; | |
163 | ||
164 | static struct platform_device marxbot_camera[] = { | |
165 | { | |
166 | .name = "soc-camera-pdrv", | |
167 | .id = 0, | |
168 | .dev = { | |
169 | .platform_data = &base_iclink, | |
170 | }, | |
171 | }, | |
172 | }; | |
173 | ||
174 | static struct platform_device *marxbot_cameras[] __initdata = { | |
175 | &marxbot_camera[0], | |
176 | }; | |
177 | ||
178 | static int __init marxbot_cam_init(void) | |
179 | { | |
180 | int ret = gpio_request(CAM_CHOICE, "cam-choice"); | |
181 | if (ret) | |
182 | return ret; | |
183 | gpio_direction_output(CAM_CHOICE, 1); | |
184 | ||
185 | ret = gpio_request(BASECAM_RST_B, "basecam-reset"); | |
186 | if (ret) | |
187 | return ret; | |
188 | gpio_direction_output(BASECAM_RST_B, 1); | |
189 | ret = gpio_request(BASECAM_POWER, "basecam-standby"); | |
190 | if (ret) | |
191 | return ret; | |
192 | gpio_direction_output(BASECAM_POWER, 0); | |
193 | ||
194 | ret = gpio_request(TURRETCAM_RST_B, "turretcam-reset"); | |
195 | if (ret) | |
196 | return ret; | |
197 | gpio_direction_output(TURRETCAM_RST_B, 1); | |
198 | ret = gpio_request(TURRETCAM_POWER, "turretcam-standby"); | |
199 | if (ret) | |
200 | return ret; | |
201 | gpio_direction_output(TURRETCAM_POWER, 0); | |
202 | ||
203 | return 0; | |
204 | } | |
205 | ||
e00f0b4a VL |
206 | /* |
207 | * system init for baseboard usage. Will be called by mx31moboard init. | |
208 | */ | |
209 | void __init mx31moboard_marxbot_init(void) | |
210 | { | |
211 | printk(KERN_INFO "Initializing mx31marxbot peripherals\n"); | |
56c7a45b VL |
212 | |
213 | mxc_iomux_setup_multiple_pins(marxbot_pins, ARRAY_SIZE(marxbot_pins), | |
214 | "marxbot"); | |
45b131a7 | 215 | |
2718c15c VL |
216 | dspics_resets_init(); |
217 | ||
45b131a7 | 218 | mxc_register_device(&mxcsdhc_device1, &sdhc2_pdata); |
10949fff | 219 | |
04ea3c80 VL |
220 | marxbot_cam_init(); |
221 | platform_add_devices(marxbot_cameras, ARRAY_SIZE(marxbot_cameras)); | |
222 | ||
10949fff VL |
223 | /* battery present pin */ |
224 | gpio_request(IOMUX_TO_GPIO(MX31_PIN_LCS0), "bat-present"); | |
225 | gpio_direction_input(IOMUX_TO_GPIO(MX31_PIN_LCS0)); | |
226 | gpio_export(IOMUX_TO_GPIO(MX31_PIN_LCS0), false); | |
e00f0b4a | 227 | } |