2 * Copyright (C) 2009 Valentin Longchamp, EPFL Mobots group
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.
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.
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
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>
27 #include <mach/common.h>
28 #include <mach/hardware.h>
29 #include <mach/imx-uart.h>
30 #include <mach/iomux-mx3.h>
32 #include <media/soc_camera.h>
36 static unsigned int smartbot_pins
[] = {
38 MX31_PIN_CTS2__CTS2
, MX31_PIN_RTS2__RTS2
,
39 MX31_PIN_TXD2__TXD2
, MX31_PIN_RXD2__RXD2
,
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
,
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
,
55 static struct imxuart_platform_data uart_pdata
= {
56 .flags
= IMXUART_HAVE_RTSCTS
,
59 #define CAM_POWER IOMUX_TO_GPIO(MX31_PIN_GPIO3_1)
60 #define CAM_RST_B IOMUX_TO_GPIO(MX31_PIN_GPIO3_0)
62 static int smartbot_cam_power(struct device
*dev
, int on
)
64 gpio_set_value(CAM_POWER
, !on
);
68 static int smartbot_cam_reset(struct device
*dev
)
70 gpio_set_value(CAM_RST_B
, 0);
72 gpio_set_value(CAM_RST_B
, 1);
76 static struct i2c_board_info smartbot_i2c_devices
[] = {
78 I2C_BOARD_INFO("mt9t031", 0x5d),
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],
88 .module_name
= "mt9t031",
91 static struct platform_device smartbot_camera
[] = {
93 .name
= "soc-camera-pdrv",
96 .platform_data
= &base_iclink
,
101 static struct platform_device
*smartbot_cameras
[] __initdata
= {
105 static int __init
smartbot_cam_init(void)
107 int ret
= gpio_request(CAM_RST_B
, "cam-reset");
110 gpio_direction_output(CAM_RST_B
, 1);
111 ret
= gpio_request(CAM_POWER
, "cam-standby");
114 gpio_direction_output(CAM_POWER
, 0);
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)
122 #define SEL3 IOMUX_TO_GPIO(MX31_PIN_DCD_DCE1)
124 static void smartbot_resets_init(void)
126 if (!gpio_request(POWER_EN
, "power-enable")) {
127 gpio_direction_output(POWER_EN
, 0);
128 gpio_export(POWER_EN
, false);
131 if (!gpio_request(DSPIC_RST_B
, "dspic-rst")) {
132 gpio_direction_output(DSPIC_RST_B
, 0);
133 gpio_export(DSPIC_RST_B
, false);
136 if (!gpio_request(TRSLAT_RST_B
, "translator-rst")) {
137 gpio_direction_output(TRSLAT_RST_B
, 0);
138 gpio_export(TRSLAT_RST_B
, false);
141 if (!gpio_request(SEL3
, "sel3")) {
142 gpio_direction_input(SEL3
);
143 gpio_export(SEL3
, true);
147 * system init for baseboard usage. Will be called by mx31moboard init.
149 void __init
mx31moboard_smartbot_init(void)
151 printk(KERN_INFO
"Initializing mx31smartbot peripherals\n");
153 mxc_iomux_setup_multiple_pins(smartbot_pins
, ARRAY_SIZE(smartbot_pins
),
156 mxc_register_device(&mxc_uart_device1
, &uart_pdata
);
158 smartbot_resets_init();
161 platform_add_devices(smartbot_cameras
, ARRAY_SIZE(smartbot_cameras
));