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