ARM: mach-shmobile: Mackerel VGA camera support

Add VGA camera support to the Mackerel board
using soc_camera_platform.

The VGA camera module is hooked up using the
8-bit CEU bus, and it is constantly bursting
out frames in fixed video mode setting. The
camera module does not allow any I2C control.

Signed-off-by: Magnus Damm <damm@opensource.se>
Signed-off-by: Paul Mundt <lethal@linux-sh.org>

diff --git a/arch/arm/mach-shmobile/board-mackerel.c b/arch/arm/mach-shmobile/board-mackerel.c
index c0d18cb..cbaf840 100644 (file)
--- a/arch/arm/mach-shmobile/board-mackerel.c
+++ b/arch/arm/mach-shmobile/board-mackerel.c
@@ -44,7 +44,9 @@
 #include <linux/usb/r8a66597.h>
 
 #include <video/sh_mobile_lcdc.h>
-
+#include <media/sh_mobile_ceu.h>
+#include <media/soc_camera.h>
+#include <media/soc_camera_platform.h>
 #include <sound/sh_fsi.h>
 
 #include <mach/common.h>
@@ -595,6 +597,111 @@ static struct platform_device sh_mmcif_device = {
        .resource       = sh_mmcif_resources,
 };
 
+
+static int mackerel_camera_add(struct soc_camera_link *icl, struct device *dev);
+static void mackerel_camera_del(struct soc_camera_link *icl);
+
+static int camera_set_capture(struct soc_camera_platform_info *info,
+                             int enable)
+{
+       return 0; /* camera sensor always enabled */
+}
+
+static struct soc_camera_platform_info camera_info = {
+       .format_name = "UYVY",
+       .format_depth = 16,
+       .format = {
+               .code = V4L2_MBUS_FMT_UYVY8_2X8,
+               .colorspace = V4L2_COLORSPACE_SMPTE170M,
+               .field = V4L2_FIELD_NONE,
+               .width = 640,
+               .height = 480,
+       },
+       .bus_param = SOCAM_PCLK_SAMPLE_RISING | SOCAM_HSYNC_ACTIVE_HIGH |
+       SOCAM_VSYNC_ACTIVE_HIGH | SOCAM_MASTER | SOCAM_DATAWIDTH_8 |
+       SOCAM_DATA_ACTIVE_HIGH,
+       .set_capture = camera_set_capture,
+};
+
+static struct soc_camera_link camera_link = {
+       .bus_id         = 0,
+       .add_device     = mackerel_camera_add,
+       .del_device     = mackerel_camera_del,
+       .module_name    = "soc_camera_platform",
+       .priv           = &camera_info,
+};
+
+static void dummy_release(struct device *dev)
+{
+}
+
+static struct platform_device camera_device = {
+       .name           = "soc_camera_platform",
+       .dev            = {
+               .platform_data  = &camera_info,
+               .release        = dummy_release,
+       },
+};
+
+static int mackerel_camera_add(struct soc_camera_link *icl,
+                              struct device *dev)
+{
+       if (icl != &camera_link)
+               return -ENODEV;
+
+       camera_info.dev = dev;
+
+       return platform_device_register(&camera_device);
+}
+
+static void mackerel_camera_del(struct soc_camera_link *icl)
+{
+       if (icl != &camera_link)
+               return;
+
+       platform_device_unregister(&camera_device);
+       memset(&camera_device.dev.kobj, 0,
+              sizeof(camera_device.dev.kobj));
+}
+
+static struct sh_mobile_ceu_info sh_mobile_ceu_info = {
+       .flags = SH_CEU_FLAG_USE_8BIT_BUS,
+};
+
+static struct resource ceu_resources[] = {
+       [0] = {
+               .name   = "CEU",
+               .start  = 0xfe910000,
+               .end    = 0xfe91009f,
+               .flags  = IORESOURCE_MEM,
+       },
+       [1] = {
+               .start  = intcs_evt2irq(0x880),
+               .flags  = IORESOURCE_IRQ,
+       },
+       [2] = {
+               /* place holder for contiguous memory */
+       },
+};
+
+static struct platform_device ceu_device = {
+       .name           = "sh_mobile_ceu",
+       .id             = 0, /* "ceu0" clock */
+       .num_resources  = ARRAY_SIZE(ceu_resources),
+       .resource       = ceu_resources,
+       .dev            = {
+               .platform_data  = &sh_mobile_ceu_info,
+       },
+};
+
+static struct platform_device mackerel_camera = {
+       .name   = "soc-camera-pdrv",
+       .id     = 0,
+       .dev    = {
+               .platform_data = &camera_link,
+       },
+};
+
 static struct platform_device *mackerel_devices[] __initdata = {
        &nor_flash_device,
        &smc911x_device,
@@ -609,6 +716,8 @@ static struct platform_device *mackerel_devices[] __initdata = {
 #endif
        &sdhi2_device,
        &sh_mmcif_device,
+       &ceu_device,
+       &mackerel_camera,
 };
 
 /* Keypad Initialization */
@@ -811,6 +920,21 @@ static void __init mackerel_init(void)
        gpio_request(GPIO_FN_SCIFA2_TXD1, NULL);
        gpio_request(GPIO_FN_SCIFA2_RXD1, NULL);
 
+       /* CEU */
+       gpio_request(GPIO_FN_VIO_CLK, NULL);
+       gpio_request(GPIO_FN_VIO_VD, NULL);
+       gpio_request(GPIO_FN_VIO_HD, NULL);
+       gpio_request(GPIO_FN_VIO_FIELD, NULL);
+       gpio_request(GPIO_FN_VIO_CKO, NULL);
+       gpio_request(GPIO_FN_VIO_D7, NULL);
+       gpio_request(GPIO_FN_VIO_D6, NULL);
+       gpio_request(GPIO_FN_VIO_D5, NULL);
+       gpio_request(GPIO_FN_VIO_D4, NULL);
+       gpio_request(GPIO_FN_VIO_D3, NULL);
+       gpio_request(GPIO_FN_VIO_D2, NULL);
+       gpio_request(GPIO_FN_VIO_D1, NULL);
+       gpio_request(GPIO_FN_VIO_D0, NULL);
+
        i2c_register_board_info(0, i2c0_devices,
                                ARRAY_SIZE(i2c0_devices));
        i2c_register_board_info(1, i2c1_devices,