1 files changed, 76 insertions, 95 deletions

diff --git a/arch/sh/boards/mach-migor/setup.c b/arch/sh/boards/mach-migor/setup.c
index cc1408119c24..28e56c5809a2 100644
--- a/arch/sh/boards/mach-migor/setup.c
+++ b/arch/sh/boards/mach-migor/setup.c
@@ -18,9 +18,12 @@
 #include <linux/delay.h>
 #include <linux/clk.h>
 #include <linux/gpio.h>
-#include <media/soc_camera_platform.h>
-#include <media/sh_mobile_ceu.h>
+#include <linux/spi/spi.h>
+#include <linux/spi/spi_gpio.h>
 #include <video/sh_mobile_lcdc.h>
+#include <media/sh_mobile_ceu.h>
+#include <media/ov772x.h>
+#include <media/tw9910.h>
 #include <asm/clock.h>
 #include <asm/machvec.h>
 #include <asm/io.h>
@@ -292,9 +295,12 @@ static struct platform_device migor_lcdc_device = {
 };
 
 static struct clk *camera_clk;
+static DEFINE_MUTEX(camera_lock);
 
-static void camera_power_on(void)
+static void camera_power_on(int is_tw)
 {
+        mutex_lock(&camera_lock);
+
         /* Use 10 MHz VIO_CKO instead of 24 MHz to work
          * around signal quality issues on Panel Board V2.1.
          */
@@ -304,6 +310,12 @@ static void camera_power_on(void)
 
         /* use VIO_RST to take camera out of reset */
         mdelay(10);
+        if (is_tw) {
+                gpio_set_value(GPIO_PTT2, 0);
+                gpio_set_value(GPIO_PTT0, 0);
+        } else {
+                gpio_set_value(GPIO_PTT0, 1);
+        }
         gpio_set_value(GPIO_PTT3, 0);
         mdelay(10);
         gpio_set_value(GPIO_PTT3, 1);
@@ -316,107 +328,29 @@ static void camera_power_off(void)
         clk_put(camera_clk);
 
         gpio_set_value(GPIO_PTT3, 0);
+        mutex_unlock(&camera_lock);
 }
 
-static void camera_power(int mode)
+static int ov7725_power(struct device *dev, int mode)
 {
         if (mode)
-                camera_power_on();
+                camera_power_on(0);
         else
                 camera_power_off();
-}
 
-#ifdef CONFIG_I2C
-static unsigned char camera_ov772x_magic[] =
-{
-        0x09, 0x01, 0x0c, 0x20, 0x0d, 0x41, 0x0e, 0x01,
-        0x12, 0x00, 0x13, 0x8F, 0x14, 0x4A, 0x15, 0x00,
-        0x16, 0x00, 0x17, 0x23, 0x18, 0xa0, 0x19, 0x07,
-        0x1a, 0xf0, 0x1b, 0x40, 0x1f, 0x00, 0x20, 0x10,
-        0x22, 0xff, 0x23, 0x01, 0x28, 0x00, 0x29, 0xa0,
-        0x2a, 0x00, 0x2b, 0x00, 0x2c, 0xf0, 0x2d, 0x00,
-        0x2e, 0x00, 0x30, 0x80, 0x31, 0x60, 0x32, 0x00,
-        0x33, 0x00, 0x34, 0x00, 0x3d, 0x80, 0x3e, 0xe2,
-        0x3f, 0x1f, 0x42, 0x80, 0x43, 0x80, 0x44, 0x80,
-        0x45, 0x80, 0x46, 0x00, 0x47, 0x00, 0x48, 0x00,
-        0x49, 0x50, 0x4a, 0x30, 0x4b, 0x50, 0x4c, 0x50,
-        0x4d, 0x00, 0x4e, 0xef, 0x4f, 0x10, 0x50, 0x60,
-        0x51, 0x00, 0x52, 0x00, 0x53, 0x24, 0x54, 0x7a,
-        0x55, 0xfc, 0x62, 0xff, 0x63, 0xf0, 0x64, 0x1f,
-        0x65, 0x00, 0x66, 0x10, 0x67, 0x00, 0x68, 0x00,
-        0x69, 0x5c, 0x6a, 0x11, 0x6b, 0xa2, 0x6c, 0x01,
-        0x6d, 0x50, 0x6e, 0x80, 0x6f, 0x80, 0x70, 0x0f,
-        0x71, 0x00, 0x72, 0x00, 0x73, 0x0f, 0x74, 0x0f,
-        0x75, 0xff, 0x78, 0x10, 0x79, 0x70, 0x7a, 0x70,
-        0x7b, 0xf0, 0x7c, 0xf0, 0x7d, 0xf0, 0x7e, 0x0e,
-        0x7f, 0x1a, 0x80, 0x31, 0x81, 0x5a, 0x82, 0x69,
-        0x83, 0x75, 0x84, 0x7e, 0x85, 0x88, 0x86, 0x8f,
-        0x87, 0x96, 0x88, 0xa3, 0x89, 0xaf, 0x8a, 0xc4,
-        0x8b, 0xd7, 0x8c, 0xe8, 0x8d, 0x20, 0x8e, 0x00,
-        0x8f, 0x00, 0x90, 0x08, 0x91, 0x10, 0x92, 0x1f,
-        0x93, 0x01, 0x94, 0x2c, 0x95, 0x24, 0x96, 0x08,
-        0x97, 0x14, 0x98, 0x24, 0x99, 0x38, 0x9a, 0x9e,
-        0x9b, 0x00, 0x9c, 0x40, 0x9e, 0x11, 0x9f, 0x02,
-        0xa0, 0x00, 0xa1, 0x40, 0xa2, 0x40, 0xa3, 0x06,
-        0xa4, 0x00, 0xa6, 0x00, 0xa7, 0x40, 0xa8, 0x40,
-        0xa9, 0x80, 0xaa, 0x80, 0xab, 0x06, 0xac, 0xff,
-        0x12, 0x06, 0x64, 0x3f, 0x12, 0x46, 0x17, 0x3f,
-        0x18, 0x50, 0x19, 0x03, 0x1a, 0x78, 0x29, 0x50,
-        0x2c, 0x78,
-};
+        return 0;
+}
 
-static int ov772x_set_capture(struct soc_camera_platform_info *info,
-                              int enable)
+static int tw9910_power(struct device *dev, int mode)
 {
-        struct i2c_adapter *a = i2c_get_adapter(0);
-        struct i2c_msg msg;
-        int ret = 0;
-        int i;
-
-        if (!enable)
-                return 0; /* camera_power_off() is enough */
-
-        for (i = 0; i < ARRAY_SIZE(camera_ov772x_magic); i += 2) {
-                u_int8_t buf[8];
-
-                msg.addr = 0x21;
-                msg.buf = buf;
-                msg.len = 2;
-                msg.flags = 0;
-
-                buf[0] = camera_ov772x_magic[i];
-                buf[1] = camera_ov772x_magic[i + 1];
-
-                ret = (ret < 0) ? ret : i2c_transfer(a, &msg, 1);
-        }
+        if (mode)
+                camera_power_on(1);
+        else
+                camera_power_off();
 
-        return ret;
+        return 0;
 }
 
-static struct soc_camera_platform_info ov772x_info = {
-        .iface = 0,
-        .format_name = "RGB565",
-        .format_depth = 16,
-        .format = {
-                .pixelformat = V4L2_PIX_FMT_RGB565,
-                .colorspace = V4L2_COLORSPACE_SRGB,
-                .width = 320,
-                .height = 240,
-        },
-        .bus_param =  SOCAM_PCLK_SAMPLE_RISING | SOCAM_HSYNC_ACTIVE_HIGH |
-        SOCAM_VSYNC_ACTIVE_HIGH | SOCAM_MASTER | SOCAM_DATAWIDTH_8,
-        .power = camera_power,
-        .set_capture = ov772x_set_capture,
-};
-
-static struct platform_device migor_camera_device = {
-        .name           = "soc_camera_platform",
-        .dev    = {
-                .platform_data  = &ov772x_info,
-        },
-};
-#endif /* CONFIG_I2C */
-
 static struct sh_mobile_ceu_info sh_mobile_ceu_info = {
         .flags = SOCAM_MASTER | SOCAM_DATAWIDTH_8 | SOCAM_PCLK_SAMPLE_RISING \
         | SOCAM_HSYNC_ACTIVE_HIGH | SOCAM_VSYNC_ACTIVE_HIGH,
@@ -448,16 +382,43 @@ static struct platform_device migor_ceu_device = {
         },
 };
 
+static struct ov772x_camera_info ov7725_info = {
+        .buswidth  = SOCAM_DATAWIDTH_8,
+        .link = {
+                .power  = ov7725_power,
+        },
+};
+
+static struct tw9910_video_info tw9910_info = {
+        .buswidth = SOCAM_DATAWIDTH_8,
+        .mpout    = TW9910_MPO_FIELD,
+        .link = {
+                .power  = tw9910_power,
+        }
+};
+
+struct spi_gpio_platform_data sdcard_cn9_platform_data = {
+        .sck = GPIO_PTD0,
+        .mosi = GPIO_PTD1,
+        .miso = GPIO_PTD2,
+        .num_chipselect = 1,
+};
+
+static struct platform_device sdcard_cn9_device = {
+        .name           = "spi_gpio",
+        .dev    = {
+                .platform_data  = &sdcard_cn9_platform_data,
+        },
+};
+
 static struct platform_device *migor_devices[] __initdata = {
         &smc91x_eth_device,
         &sh_keysc_device,
         &migor_lcdc_device,
         &migor_ceu_device,
-#ifdef CONFIG_I2C
-        &migor_camera_device,
-#endif
         &migor_nor_flash_device,
         &migor_nand_flash_device,
+        &sdcard_cn9_device,
 };
 
 static struct i2c_board_info migor_i2c_devices[] = {
@@ -468,6 +429,23 @@ static struct i2c_board_info migor_i2c_devices[] = {
                 I2C_BOARD_INFO("migor_ts", 0x51),
                 .irq = 38, /* IRQ6 */
         },
+        {
+                I2C_BOARD_INFO("ov772x", 0x21),
+                .platform_data = &ov7725_info,
+        },
+        {
+                I2C_BOARD_INFO("tw9910", 0x45),
+                .platform_data = &tw9910_info,
+        },
+};
+
+static struct spi_board_info migor_spi_devices[] = {
+        {
+                .modalias = "mmc_spi",
+                .max_speed_hz = 5000000,
+                .chip_select = 0,
+                .controller_data = (void *) GPIO_PTD5,
+        },
 };
 
 static int __init migor_devices_setup(void)
@@ -592,6 +570,9 @@ static int __init migor_devices_setup(void)
         i2c_register_board_info(0, migor_i2c_devices,
                                 ARRAY_SIZE(migor_i2c_devices));
 
+        spi_register_board_info(migor_spi_devices,
+                                ARRAY_SIZE(migor_spi_devices));
+
         return platform_add_devices(migor_devices, ARRAY_SIZE(migor_devices));
 }
 __initcall(migor_devices_setup);