Commit | Line | Data |
---|---|---|
e335c75c 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 | ||
19 | #include <linux/delay.h> | |
20 | #include <linux/gpio.h> | |
21 | #include <linux/init.h> | |
22 | #include <linux/interrupt.h> | |
23 | #include <linux/i2c.h> | |
24 | #include <linux/platform_device.h> | |
25 | #include <linux/types.h> | |
26 | ||
27 | #include <mach/common.h> | |
28 | #include <mach/hardware.h> | |
29 | #include <mach/imx-uart.h> | |
30 | #include <mach/iomux-mx3.h> | |
31 | ||
32 | #include <media/soc_camera.h> | |
33 | ||
34 | #include "devices.h" | |
35 | ||
36 | static unsigned int smartbot_pins[] = { | |
37 | /* UART1 */ | |
38 | MX31_PIN_CTS2__CTS2, MX31_PIN_RTS2__RTS2, | |
39 | MX31_PIN_TXD2__TXD2, MX31_PIN_RXD2__RXD2, | |
40 | /* CSI */ | |
41 | MX31_PIN_CSI_D4__CSI_D4, MX31_PIN_CSI_D5__CSI_D5, | |
42 | MX31_PIN_CSI_D6__CSI_D6, MX31_PIN_CSI_D7__CSI_D7, | |
43 | MX31_PIN_CSI_D8__CSI_D8, MX31_PIN_CSI_D9__CSI_D9, | |
44 | MX31_PIN_CSI_D10__CSI_D10, MX31_PIN_CSI_D11__CSI_D11, | |
45 | MX31_PIN_CSI_D12__CSI_D12, MX31_PIN_CSI_D13__CSI_D13, | |
46 | MX31_PIN_CSI_D14__CSI_D14, MX31_PIN_CSI_D15__CSI_D15, | |
47 | MX31_PIN_CSI_HSYNC__CSI_HSYNC, MX31_PIN_CSI_MCLK__CSI_MCLK, | |
48 | MX31_PIN_CSI_PIXCLK__CSI_PIXCLK, MX31_PIN_CSI_VSYNC__CSI_VSYNC, | |
49 | MX31_PIN_GPIO3_0__GPIO3_0, MX31_PIN_GPIO3_1__GPIO3_1, | |
50 | /* ENABLES */ | |
51 | MX31_PIN_DTR_DCE1__GPIO2_8, MX31_PIN_DSR_DCE1__GPIO2_9, | |
52 | MX31_PIN_RI_DCE1__GPIO2_10, MX31_PIN_DCD_DCE1__GPIO2_11, | |
53 | }; | |
54 | ||
55 | static struct imxuart_platform_data uart_pdata = { | |
56 | .flags = IMXUART_HAVE_RTSCTS, | |
57 | }; | |
58 | ||
59 | #define CAM_POWER IOMUX_TO_GPIO(MX31_PIN_GPIO3_1) | |
60 | #define CAM_RST_B IOMUX_TO_GPIO(MX31_PIN_GPIO3_0) | |
61 | ||
62 | static int smartbot_cam_power(struct device *dev, int on) | |
63 | { | |
64 | gpio_set_value(CAM_POWER, !on); | |
65 | return 0; | |
66 | } | |
67 | ||
68 | static int smartbot_cam_reset(struct device *dev) | |
69 | { | |
70 | gpio_set_value(CAM_RST_B, 0); | |
71 | udelay(100); | |
72 | gpio_set_value(CAM_RST_B, 1); | |
73 | return 0; | |
74 | } | |
75 | ||
76 | static struct i2c_board_info smartbot_i2c_devices[] = { | |
77 | { | |
78 | I2C_BOARD_INFO("mt9t031", 0x5d), | |
79 | }, | |
80 | }; | |
81 | ||
82 | static struct soc_camera_link base_iclink = { | |
83 | .bus_id = 0, /* Must match with the camera ID */ | |
84 | .power = smartbot_cam_power, | |
85 | .reset = smartbot_cam_reset, | |
86 | .board_info = &smartbot_i2c_devices[0], | |
87 | .i2c_adapter_id = 0, | |
88 | .module_name = "mt9t031", | |
89 | }; | |
90 | ||
91 | static struct platform_device smartbot_camera[] = { | |
92 | { | |
93 | .name = "soc-camera-pdrv", | |
94 | .id = 0, | |
95 | .dev = { | |
96 | .platform_data = &base_iclink, | |
97 | }, | |
98 | }, | |
99 | }; | |
100 | ||
101 | static struct platform_device *smartbot_cameras[] __initdata = { | |
102 | &smartbot_camera[0], | |
103 | }; | |
104 | ||
105 | static int __init smartbot_cam_init(void) | |
106 | { | |
107 | int ret = gpio_request(CAM_RST_B, "cam-reset"); | |
108 | if (ret) | |
109 | return ret; | |
110 | gpio_direction_output(CAM_RST_B, 1); | |
111 | ret = gpio_request(CAM_POWER, "cam-standby"); | |
112 | if (ret) | |
113 | return ret; | |
114 | gpio_direction_output(CAM_POWER, 0); | |
115 | ||
116 | return 0; | |
117 | } | |
118 | ||
119 | #define POWER_EN IOMUX_TO_GPIO(MX31_PIN_DTR_DCE1) | |
120 | #define DSPIC_RST_B IOMUX_TO_GPIO(MX31_PIN_DSR_DCE1) | |
121 | #define TRSLAT_RST_B IOMUX_TO_GPIO(MX31_PIN_RI_DCE1) | |
7176441b | 122 | #define TRSLAT_SRC_CHOICE IOMUX_TO_GPIO(MX31_PIN_DCD_DCE1) |
e335c75c VL |
123 | |
124 | static void smartbot_resets_init(void) | |
125 | { | |
126 | if (!gpio_request(POWER_EN, "power-enable")) { | |
127 | gpio_direction_output(POWER_EN, 0); | |
128 | gpio_export(POWER_EN, false); | |
129 | } | |
130 | ||
131 | if (!gpio_request(DSPIC_RST_B, "dspic-rst")) { | |
132 | gpio_direction_output(DSPIC_RST_B, 0); | |
133 | gpio_export(DSPIC_RST_B, false); | |
134 | } | |
135 | ||
136 | if (!gpio_request(TRSLAT_RST_B, "translator-rst")) { | |
137 | gpio_direction_output(TRSLAT_RST_B, 0); | |
138 | gpio_export(TRSLAT_RST_B, false); | |
139 | } | |
140 | ||
7176441b VL |
141 | if (!gpio_request(TRSLAT_SRC_CHOICE, "translator-src-choice")) { |
142 | gpio_direction_output(TRSLAT_SRC_CHOICE, 0); | |
143 | gpio_export(TRSLAT_SRC_CHOICE, false); | |
e335c75c VL |
144 | } |
145 | } | |
146 | /* | |
147 | * system init for baseboard usage. Will be called by mx31moboard init. | |
148 | */ | |
149 | void __init mx31moboard_smartbot_init(void) | |
150 | { | |
151 | printk(KERN_INFO "Initializing mx31smartbot peripherals\n"); | |
152 | ||
153 | mxc_iomux_setup_multiple_pins(smartbot_pins, ARRAY_SIZE(smartbot_pins), | |
154 | "smartbot"); | |
155 | ||
156 | mxc_register_device(&mxc_uart_device1, &uart_pdata); | |
157 | ||
158 | smartbot_resets_init(); | |
159 | ||
160 | smartbot_cam_init(); | |
161 | platform_add_devices(smartbot_cameras, ARRAY_SIZE(smartbot_cameras)); | |
162 | } |