[4/5] OMAP3430SDP: Add support for Camera Kit v3

Commit Message

Aguirre Rodriguez, Sergio Alberto March 3, 2009, 8:44 p.m. UTC

This patch adds support for sensors contained in Camkit v3,
which has:
 - Primary sensor (/dev/video0): MT9P012 (Parallel) with
   DW9710 lens driver.
 - Secondary sensor (/dev/video4): OV3640 (CSI2).

It introduces also a new file for storing all camera sensors board
specific related functions, like other platforms do (N800 for example).

Signed-off-by: Sergio Aguirre <[e-mail]>
---
 arch/arm/mach-omap2/Makefile                    |    3 +-
 arch/arm/mach-omap2/board-3430sdp-camera.c      |  490 +++++++++++++++++++++++
 arch/arm/mach-omap2/board-3430sdp.c             |   42 ++-
 arch/arm/plat-omap/include/mach/board-3430sdp.h |    1 +
 4 files changed, 534 insertions(+), 2 deletions(-)
 create mode 100644 arch/arm/mach-omap2/board-3430sdp-camera.c

--
1.5.6.5

--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to [e-mail]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Comments

Dongsoo Kim March 5, 2009, 2:58 a.m. UTC | #1

Hi Sergio,



On Wed, Mar 4, 2009 at 5:44 AM, Aguirre Rodriguez, Sergio Alberto
<[e-mail]> wrote:
> This patch adds support for sensors contained in Camkit v3,
> which has:
>  - Primary sensor (/dev/video0): MT9P012 (Parallel) with
>   DW9710 lens driver.
>  - Secondary sensor (/dev/video4): OV3640 (CSI2).
>
> It introduces also a new file for storing all camera sensors board
> specific related functions, like other platforms do (N800 for example).
>
> Signed-off-by: Sergio Aguirre <[e-mail]>
> ---
>  arch/arm/mach-omap2/Makefile                    |    3 +-
>  arch/arm/mach-omap2/board-3430sdp-camera.c      |  490 +++++++++++++++++++++++
>  arch/arm/mach-omap2/board-3430sdp.c             |   42 ++-
>  arch/arm/plat-omap/include/mach/board-3430sdp.h |    1 +
>  4 files changed, 534 insertions(+), 2 deletions(-)
>  create mode 100644 arch/arm/mach-omap2/board-3430sdp-camera.c
>
> diff --git a/arch/arm/mach-omap2/Makefile b/arch/arm/mach-omap2/Makefile
> index 33b5aa8..8888ee6 100644
> --- a/arch/arm/mach-omap2/Makefile
> +++ b/arch/arm/mach-omap2/Makefile
> @@ -53,7 +53,8 @@ obj-$(CONFIG_MACH_OMAP2EVM)           += board-omap2evm.o \
>                                           mmc-twl4030.o
>  obj-$(CONFIG_MACH_OMAP_3430SDP)                += board-3430sdp.o \
>                                           mmc-twl4030.o \
> -                                          board-3430sdp-flash.o
> +                                          board-3430sdp-flash.o \
> +                                          board-3430sdp-camera.o
>  obj-$(CONFIG_MACH_OMAP3EVM)            += board-omap3evm.o \
>                                           mmc-twl4030.o \
>                                           board-omap3evm-flash.o \
> diff --git a/arch/arm/mach-omap2/board-3430sdp-camera.c b/arch/arm/mach-omap2/board-3430sdp-camera.c
> new file mode 100644
> index 0000000..661d5ed
> --- /dev/null
> +++ b/arch/arm/mach-omap2/board-3430sdp-camera.c
> @@ -0,0 +1,490 @@
> +/*
> + * linux/arch/arm/mach-omap2/board-3430sdp.c
> + *
> + * Copyright (C) 2007 Texas Instruments
> + *
> + * Modified from mach-omap2/board-generic.c
> + *
> + * Initial code: Syed Mohammed Khasim
> + *
> + * This program is free software; you can redistribute it and/or modify
> + * it under the terms of the GNU General Public License version 2 as
> + * published by the Free Software Foundation.
> + */
> +
> +#ifdef CONFIG_TWL4030_CORE
> +
> +#include <linux/clk.h>
> +#include <linux/platform_device.h>
> +#include <linux/delay.h>
> +#include <linux/mm.h>
> +
> +#include <linux/i2c/twl4030.h>
> +
> +#include <asm/io.h>
> +
> +#include <mach/gpio.h>
> +
> +static int cam_inited;
> +#include <media/v4l2-int-device.h>
> +#include <../drivers/media/video/omap34xxcam.h>
> +#include <../drivers/media/video/isp/ispreg.h>
> +#define DEBUG_BASE             0x08000000
> +
> +#define REG_SDP3430_FPGA_GPIO_2 (0x50)
> +#define FPGA_SPR_GPIO1_3v3     (0x1 << 14)
> +#define FPGA_GPIO6_DIR_CTRL    (0x1 << 6)
> +
> +#define VAUX_2_8_V             0x09
> +#define VAUX_1_8_V             0x05
> +#define VAUX_DEV_GRP_P1                0x20
> +#define VAUX_DEV_GRP_NONE      0x00
> +
> +#define CAMKITV3_USE_XCLKA     0
> +#define CAMKITV3_USE_XCLKB     1
> +
> +#define CAMKITV3_RESET_GPIO    98
> +/* Sensor specific GPIO signals */
> +#define MT9P012_STANDBY_GPIO   58
> +#define OV3640_STANDBY_GPIO    55
> +static void __iomem *fpga_map_addr;
> +
> +#if defined(CONFIG_VIDEO_MT9P012) || defined(CONFIG_VIDEO_MT9P012_MODULE)
> +#include <media/mt9p012.h>
> +static enum v4l2_power mt9p012_previous_power = V4L2_POWER_OFF;
> +#endif
> +
> +#if defined(CONFIG_VIDEO_OV3640) || defined(CONFIG_VIDEO_OV3640_MODULE)
> +#include <media/ov3640.h>
> +#include <../drivers/media/video/isp/ispcsi2.h>
> +static struct omap34xxcam_hw_config *hwc;
> +#define OV3640_CSI2_CLOCK_POLARITY     0       /* +/- pin order */
> +#define OV3640_CSI2_DATA0_POLARITY     0       /* +/- pin order */
> +#define OV3640_CSI2_DATA1_POLARITY     0       /* +/- pin order */
> +#define OV3640_CSI2_CLOCK_LANE         1        /* Clock lane position: 1 */
> +#define OV3640_CSI2_DATA0_LANE         2        /* Data0 lane position: 2 */
> +#define OV3640_CSI2_DATA1_LANE         3        /* Data1 lane position: 3 */
> +#define OV3640_CSI2_PHY_THS_TERM       4
> +#define OV3640_CSI2_PHY_THS_SETTLE     14
> +#define OV3640_CSI2_PHY_TCLK_TERM      0
> +#define OV3640_CSI2_PHY_TCLK_MISS      1
> +#define OV3640_CSI2_PHY_TCLK_SETTLE    14
> +#endif
> +
> +#ifdef CONFIG_VIDEO_DW9710
> +#include <media/dw9710.h>
> +#endif
> +
> +static void __iomem *fpga_map_addr;
> +
> +static void enable_fpga_vio_1v8(u8 enable)
> +{
> +       u16 reg_val;
> +
> +       fpga_map_addr = ioremap(DEBUG_BASE, 4096);
> +       reg_val = readw(fpga_map_addr + REG_SDP3430_FPGA_GPIO_2);
> +
> +       /* Ensure that the SPR_GPIO1_3v3 is 0 - powered off.. 1 is on */
> +       if (reg_val & FPGA_SPR_GPIO1_3v3) {
> +               reg_val |= FPGA_SPR_GPIO1_3v3;
> +               reg_val |= FPGA_GPIO6_DIR_CTRL; /* output mode */
> +               writew(reg_val, fpga_map_addr + REG_SDP3430_FPGA_GPIO_2);
> +               /* give a few milli sec to settle down
> +                * Let the sensor also settle down.. if required..
> +                */
> +               if (enable)
> +                       mdelay(10);
> +       }
> +
> +       if (enable) {
> +               reg_val |= FPGA_SPR_GPIO1_3v3 | FPGA_GPIO6_DIR_CTRL;
> +               writew(reg_val, fpga_map_addr + REG_SDP3430_FPGA_GPIO_2);
> +       }
> +       /* Vrise time for the voltage - should be less than 1 ms */
> +       mdelay(1);
> +}
> +
> +#ifdef CONFIG_VIDEO_DW9710
> +static int dw9710_lens_power_set(enum v4l2_power power)
> +{
> +       if (!cam_inited) {
> +               printk(KERN_ERR "DW9710: Unable to control board GPIOs!\n");
> +               return -EFAULT;
> +       }
> +
> +       /* The power change depends on MT9P012 powerup, so if we request a
> +        * power state different from sensor, we should return error
> +        */
> +       if ((mt9p012_previous_power != V4L2_POWER_OFF) &&
> +                                       (power != mt9p012_previous_power))
> +               return -EIO;
> +
> +       switch (power) {
> +       case V4L2_POWER_OFF:
> +               /* Power Down Sequence */
> +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                               VAUX_DEV_GRP_NONE, TWL4030_VAUX2_DEV_GRP);
> +               enable_fpga_vio_1v8(0);
> +               iounmap(fpga_map_addr);
> +               break;
> +       case V4L2_POWER_ON:
> +               /* STANDBY_GPIO is active HIGH for set LOW to release */
> +               gpio_set_value(MT9P012_STANDBY_GPIO, 1);
> +
> +               /* nRESET is active LOW. set HIGH to release reset */
> +               gpio_set_value(CAMKITV3_RESET_GPIO, 1);
> +
> +               /* turn on digital power */
> +               enable_fpga_vio_1v8(1);
> +
> +               /* turn on analog power */
> +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                               VAUX_2_8_V, TWL4030_VAUX2_DEDICATED);
> +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                               VAUX_DEV_GRP_P1, TWL4030_VAUX2_DEV_GRP);
> +
> +               /* out of standby */
> +               gpio_set_value(MT9P012_STANDBY_GPIO, 0);
> +               udelay(1000);

It seems better using msleep rather than udelay for 1000us much. Just
to be safe :)
How about you?

> +
> +               /* have to put sensor to reset to guarantee detection */
> +               gpio_set_value(CAMKITV3_RESET_GPIO, 0);
> +
> +               udelay(1500);
ditto

> +
> +               /* nRESET is active LOW. set HIGH to release reset */
> +               gpio_set_value(CAMKITV3_RESET_GPIO, 1);
> +               /* give sensor sometime to get out of the reset.
> +                * Datasheet says 2400 xclks. At 6 MHz, 400 usec is
> +                * enough
> +                */
> +               udelay(300);
and also here..


> +               break;
> +       case V4L2_POWER_STANDBY:
> +               break;
> +       }
> +       return 0;
> +}
> +
> +static int dw9710_lens_set_prv_data(void *priv)
> +{
> +       struct omap34xxcam_hw_config *hwc = priv;
> +
> +       hwc->dev_index = 0;
> +       hwc->dev_minor = 0;
> +       hwc->dev_type = OMAP34XXCAM_SLAVE_LENS;
> +
> +       return 0;
> +}
> +
> +struct dw9710_platform_data sdp3430_dw9710_platform_data = {
> +       .power_set      = dw9710_lens_power_set,
> +       .priv_data_set  = dw9710_lens_set_prv_data,
> +};
> +#endif
> +
> +#if defined(CONFIG_VIDEO_MT9P012) || defined(CONFIG_VIDEO_MT9P012_MODULE)
> +static struct omap34xxcam_sensor_config cam_hwc = {
> +       .sensor_isp = 0,
> +       .xclk = OMAP34XXCAM_XCLK_A,
> +       .capture_mem = PAGE_ALIGN(2592 * 1944 * 2) * 4,
> +       .ival_default   = { 1, 10 },
> +};
> +
> +static int mt9p012_sensor_set_prv_data(void *priv)
> +{
> +       struct omap34xxcam_hw_config *hwc = priv;
> +
> +       hwc->u.sensor.xclk = cam_hwc.xclk;
> +       hwc->u.sensor.sensor_isp = cam_hwc.sensor_isp;
> +       hwc->u.sensor.capture_mem = cam_hwc.capture_mem;
> +       hwc->dev_index = 0;
> +       hwc->dev_minor = 0;
> +       hwc->dev_type = OMAP34XXCAM_SLAVE_SENSOR;
> +       return 0;
> +}
> +
> +static struct isp_interface_config mt9p012_if_config = {
> +       .ccdc_par_ser = ISP_PARLL,
> +       .dataline_shift = 0x1,
> +       .hsvs_syncdetect = ISPCTRL_SYNC_DETECT_VSRISE,
> +       .strobe = 0x0,
> +       .prestrobe = 0x0,
> +       .shutter = 0x0,
> +       .prev_sph = 2,
> +       .prev_slv = 0,
> +       .wenlog = ISPCCDC_CFG_WENLOG_AND,
> +       .u.par.par_bridge = 0x0,
> +       .u.par.par_clk_pol = 0x0,
> +};
> +
> +static int mt9p012_sensor_power_set(enum v4l2_power power)
> +{
> +       if (!cam_inited) {
> +               printk(KERN_ERR "MT9P012: Unable to control board GPIOs!\n");
> +               return -EFAULT;
> +       }
> +
> +       switch (power) {
> +       case V4L2_POWER_OFF:
> +               /* Power Down Sequence */
> +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                               VAUX_DEV_GRP_NONE, TWL4030_VAUX2_DEV_GRP);
> +
> +               enable_fpga_vio_1v8(0);
> +               iounmap(fpga_map_addr);
> +               break;
> +       case V4L2_POWER_ON:
> +               if (mt9p012_previous_power == V4L2_POWER_OFF) {
> +                       /* Power Up Sequence */
> +                       isp_configure_interface(&mt9p012_if_config);
> +
> +                       /* set to output mode */
> +                       gpio_direction_output(MT9P012_STANDBY_GPIO, true);
> +                       /* set to output mode */
> +                       gpio_direction_output(CAMKITV3_RESET_GPIO, true);
> +
> +                       /* STANDBY_GPIO is active HIGH for set LOW to release */
> +                       gpio_set_value(MT9P012_STANDBY_GPIO, 1);
> +
> +                       /* nRESET is active LOW. set HIGH to release reset */
> +                       gpio_set_value(CAMKITV3_RESET_GPIO, 1);
> +
> +                       /* turn on digital power */
> +                       enable_fpga_vio_1v8(1);
> +
> +                       /* turn on analog power */
> +                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                                       VAUX_2_8_V, TWL4030_VAUX2_DEDICATED);
> +                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                                       VAUX_DEV_GRP_P1, TWL4030_VAUX2_DEV_GRP);
> +               }
> +
> +               /* out of standby */
> +               gpio_set_value(MT9P012_STANDBY_GPIO, 0);
> +               udelay(1000);
ditto

> +
> +               if (mt9p012_previous_power == V4L2_POWER_OFF) {
> +                       /* have to put sensor to reset to guarantee detection */
> +                       gpio_set_value(CAMKITV3_RESET_GPIO, 0);
> +
> +                       udelay(1500);
ditto

> +
> +                       /* nRESET is active LOW. set HIGH to release reset */
> +                       gpio_set_value(CAMKITV3_RESET_GPIO, 1);
> +                       /* give sensor sometime to get out of the reset.
> +                        * Datasheet says 2400 xclks. At 6 MHz, 400 usec is
> +                        * enough
> +                        */
> +                       udelay(300);
ditto

> +               }
> +               break;
> +       case V4L2_POWER_STANDBY:
> +               /* stand by */
> +               gpio_set_value(MT9P012_STANDBY_GPIO, 1);
> +               break;
> +       }
> +       /* Save powerstate to know what was before calling POWER_ON. */
> +       mt9p012_previous_power = power;
> +       return 0;
> +}
> +
> +static u32 mt9p012_sensor_set_xclk(u32 xclkfreq)
> +{
> +       return isp_set_xclk(xclkfreq, CAMKITV3_USE_XCLKA);
> +}
> +
> +struct mt9p012_platform_data sdp3430_mt9p012_platform_data = {
> +       .power_set      = mt9p012_sensor_power_set,
> +       .priv_data_set  = mt9p012_sensor_set_prv_data,
> +       .set_xclk       = mt9p012_sensor_set_xclk,
> +};
> +
> +#endif
> +
> +#if defined(CONFIG_VIDEO_OV3640) || defined(CONFIG_VIDEO_OV3640_MODULE)
> +
> +static struct omap34xxcam_sensor_config ov3640_hwc = {
> +       .sensor_isp = 0,
> +#if defined(CONFIG_VIDEO_OV3640_CSI2)
> +       .xclk = OMAP34XXCAM_XCLK_B,
> +#else
> +       .xclk = OMAP34XXCAM_XCLK_A,
> +#endif
> +       .capture_mem = PAGE_ALIGN(2048 * 1536 * 2) * 2,
> +       .ival_default   = { 1, 15 },
> +};
> +
> +static struct isp_interface_config ov3640_if_config = {
> +       .ccdc_par_ser = ISP_CSIA,
> +       .dataline_shift = 0x0,
> +       .hsvs_syncdetect = ISPCTRL_SYNC_DETECT_VSRISE,
> +       .strobe = 0x0,
> +       .prestrobe = 0x0,
> +       .shutter = 0x0,
> +       .prev_sph = 2,
> +       .prev_slv = 0,
> +       .wenlog = ISPCCDC_CFG_WENLOG_AND,
> +       .wait_hs_vs = 2,
> +       .u.csi.crc = 0x0,
> +       .u.csi.mode = 0x0,
> +       .u.csi.edge = 0x0,
> +       .u.csi.signalling = 0x0,
> +       .u.csi.strobe_clock_inv = 0x0,
> +       .u.csi.vs_edge = 0x0,
> +       .u.csi.channel = 0x1,
> +       .u.csi.vpclk = 0x1,
> +       .u.csi.data_start = 0x0,
> +       .u.csi.data_size = 0x0,
> +       .u.csi.format = V4L2_PIX_FMT_SGRBG10,
> +};
> +
> +static int ov3640_sensor_set_prv_data(void *priv)
> +{
> +       hwc = priv;
> +       hwc->u.sensor.xclk = ov3640_hwc.xclk;
> +       hwc->u.sensor.sensor_isp = ov3640_hwc.sensor_isp;
> +       hwc->u.sensor.capture_mem = ov3640_hwc.capture_mem;
> +       hwc->dev_index = 1;
> +       hwc->dev_minor = 4;
> +       hwc->dev_type = OMAP34XXCAM_SLAVE_SENSOR;
> +       return 0;
> +}
> +
> +static int ov3640_sensor_power_set(enum v4l2_power power)
> +{
> +       struct isp_csi2_lanes_cfg lanecfg;
> +       struct isp_csi2_phy_cfg phyconfig;
> +       static enum v4l2_power previous_power = V4L2_POWER_OFF;
> +
> +       if (!cam_inited) {
> +               printk(KERN_ERR "OV3640: Unable to control board GPIOs!\n");
> +               return -EFAULT;
> +       }
> +
> +       switch (power) {
> +       case V4L2_POWER_ON:
> +               if (previous_power == V4L2_POWER_OFF)
> +                       isp_csi2_reset();
> +
> +               lanecfg.clk.pol = OV3640_CSI2_CLOCK_POLARITY;
> +               lanecfg.clk.pos = OV3640_CSI2_CLOCK_LANE;
> +               lanecfg.data[0].pol = OV3640_CSI2_DATA0_POLARITY;
> +               lanecfg.data[0].pos = OV3640_CSI2_DATA0_LANE;
> +               lanecfg.data[1].pol = OV3640_CSI2_DATA1_POLARITY;
> +               lanecfg.data[1].pos = OV3640_CSI2_DATA1_LANE;
> +               lanecfg.data[2].pol = 0;
> +               lanecfg.data[2].pos = 0;
> +               lanecfg.data[3].pol = 0;
> +               lanecfg.data[3].pos = 0;
> +               isp_csi2_complexio_lanes_config(&lanecfg);
> +               isp_csi2_complexio_lanes_update(true);
> +
> +               phyconfig.ths_term = OV3640_CSI2_PHY_THS_TERM;
> +               phyconfig.ths_settle = OV3640_CSI2_PHY_THS_SETTLE;
> +               phyconfig.tclk_term = OV3640_CSI2_PHY_TCLK_TERM;
> +               phyconfig.tclk_miss = OV3640_CSI2_PHY_TCLK_MISS;
> +               phyconfig.tclk_settle = OV3640_CSI2_PHY_TCLK_SETTLE;
> +               isp_csi2_phy_config(&phyconfig);
> +               isp_csi2_phy_update(true);
> +
> +               isp_configure_interface(&ov3640_if_config);
> +
> +               if (previous_power == V4L2_POWER_OFF) {
> +                       /* turn on analog power */
> +#if defined(CONFIG_VIDEO_OV3640_CSI2)
> +                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                                       VAUX_1_8_V, TWL4030_VAUX4_DEDICATED);
> +                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                                       VAUX_DEV_GRP_P1, TWL4030_VAUX4_DEV_GRP);
> +#else
> +                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                                       VAUX_2_8_V, TWL4030_VAUX2_DEDICATED);
> +                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                                       VAUX_DEV_GRP_P1, TWL4030_VAUX2_DEV_GRP);
> +#endif
> +                       udelay(100);
> +
> +                       /* Turn ON Omnivision sensor */
> +                       gpio_set_value(CAMKITV3_RESET_GPIO, 1);
> +                       gpio_set_value(OV3640_STANDBY_GPIO, 0);
> +                       udelay(100);
> +
> +                       /* RESET Omnivision sensor */
> +                       gpio_set_value(CAMKITV3_RESET_GPIO, 0);
> +                       udelay(100);
> +                       gpio_set_value(CAMKITV3_RESET_GPIO, 1);
> +
> +                       /* Wait 10 ms */
> +                       mdelay(10);
> +                       enable_fpga_vio_1v8(1);
> +                       udelay(100);
Does that realy takes that much time to turn off OV device?
> +               }
> +               break;
> +       case V4L2_POWER_OFF:
> +               /* Power Down Sequence */
> +               isp_csi2_complexio_power(ISP_CSI2_POWER_OFF);
> +#if defined(CONFIG_VIDEO_OV3640_CSI2)
> +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                               VAUX_DEV_GRP_NONE, TWL4030_VAUX4_DEV_GRP);
> +#else
> +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> +                               VAUX_DEV_GRP_NONE, TWL4030_VAUX2_DEV_GRP);
> +#endif
> +               enable_fpga_vio_1v8(0);
> +               iounmap(fpga_map_addr);
> +               break;
> +       case V4L2_POWER_STANDBY:
> +               break;
> +       }
> +       previous_power = power;
> +       return 0;
> +}
> +
> +static u32 ov3640_sensor_set_xclk(u32 xclkfreq)
> +{
> +       return isp_set_xclk(xclkfreq, CAMKITV3_USE_XCLKB);
> +}
> +
> +struct ov3640_platform_data sdp3430_ov3640_platform_data = {
> +       .power_set       = ov3640_sensor_power_set,
> +       .priv_data_set   = ov3640_sensor_set_prv_data,
> +       .set_xclk        = ov3640_sensor_set_xclk,
> +};
> +
> +#endif
> +
> +void __init sdp3430_cam_init(void)
> +{
> +       cam_inited = 0;
> +       /* Request and configure gpio pins */
> +       if (gpio_request(CAMKITV3_RESET_GPIO, "camkitv3_reset_gpio") != 0) {
> +               printk(KERN_ERR "Could not request GPIO %d",
> +                                       CAMKITV3_RESET_GPIO);
> +               return;
> +       }
> +
> +       if (gpio_request(OV3640_STANDBY_GPIO, "ov3640_standby_gpio") != 0) {
> +               printk(KERN_ERR "Could not request GPIO %d",
> +                                       OV3640_STANDBY_GPIO);
> +               return;
> +       }
> +
> +       if (gpio_request(MT9P012_STANDBY_GPIO, "mt9p012_standby_gpio")) {
> +               printk(KERN_ERR "Could not request GPIO %d for MT9P012\n",
> +                                                       MT9P012_STANDBY_GPIO);
> +               return;
> +       }
> +
> +       /* set to output mode */
> +       gpio_direction_output(CAMKITV3_RESET_GPIO, true);
> +       gpio_direction_output(OV3640_STANDBY_GPIO, true);
> +       gpio_direction_output(MT9P012_STANDBY_GPIO, true);
> +
> +       cam_inited = 1;
> +}
> +#else
> +void __init sdp3430_cam_init(void)
> +{
> +}
> +#endif
> diff --git a/arch/arm/mach-omap2/board-3430sdp.c b/arch/arm/mach-omap2/board-3430sdp.c
> index 867f5f6..986f087 100644
> --- a/arch/arm/mach-omap2/board-3430sdp.c
> +++ b/arch/arm/mach-omap2/board-3430sdp.c
> @@ -40,6 +40,23 @@
>  #include <mach/dma.h>
>  #include <mach/gpmc.h>
>
> +#include <media/v4l2-int-device.h>
> +
> +#if defined(CONFIG_VIDEO_MT9P012) || defined(CONFIG_VIDEO_MT9P012_MODULE)
> +#include <media/mt9p012.h>
> +extern struct mt9p012_platform_data sdp3430_mt9p012_platform_data;
> +#endif
> +
> +#if defined(CONFIG_VIDEO_OV3640) || defined(CONFIG_VIDEO_OV3640_MODULE)
> +#include <media/ov3640.h>
> +extern struct ov3640_platform_data sdp3430_ov3640_platform_data;
> +#endif
> +
> +#ifdef CONFIG_VIDEO_DW9710
> +#include <media/dw9710.h>
> +extern struct dw9710_platform_data sdp3430_dw9710_platform_data;
> +#endif
> +
>  #include <mach/control.h>
>
>  #include "sdram-qimonda-hyb18m512160af-6.h"
> @@ -610,13 +627,35 @@ static struct i2c_board_info __initdata sdp3430_i2c_boardinfo[] = {
>        },
>  };
>
> +static struct i2c_board_info __initdata sdp3430_i2c_boardinfo_2[] = {
> +#if defined(CONFIG_VIDEO_MT9P012) || defined(CONFIG_VIDEO_MT9P012_MODULE)
> +       {
> +               I2C_BOARD_INFO("mt9p012", MT9P012_I2C_ADDR),
> +               .platform_data = &sdp3430_mt9p012_platform_data,
> +       },
> +#ifdef CONFIG_VIDEO_DW9710
> +       {
> +               I2C_BOARD_INFO("dw9710",  DW9710_AF_I2C_ADDR),
> +               .platform_data = &sdp3430_dw9710_platform_data,
> +       },
> +#endif
> +#endif
> +#if defined(CONFIG_VIDEO_OV3640) || defined(CONFIG_VIDEO_OV3640_MODULE)
> +       {
> +               I2C_BOARD_INFO("ov3640", OV3640_I2C_ADDR),
> +               .platform_data = &sdp3430_ov3640_platform_data,
> +       },
> +#endif
> +};
> +
>  static int __init omap3430_i2c_init(void)
>  {
>        /* i2c1 for PMIC only */
>        omap_register_i2c_bus(1, 2600, sdp3430_i2c_boardinfo,
>                        ARRAY_SIZE(sdp3430_i2c_boardinfo));
>        /* i2c2 on camera connector (for sensor control) and optional isp1301 */
> -       omap_register_i2c_bus(2, 400, NULL, 0);
> +       omap_register_i2c_bus(2, 400, sdp3430_i2c_boardinfo_2,
> +                       ARRAY_SIZE(sdp3430_i2c_boardinfo_2));
>        /* i2c3 on display connector (for DVI, tfp410) */
>        omap_register_i2c_bus(3, 400, NULL, 0);
>        return 0;
> @@ -641,6 +680,7 @@ static void __init omap_3430sdp_init(void)
>        omap_serial_init();
>        usb_musb_init();
>        usb_ehci_init();
> +       sdp3430_cam_init();
>  }
>
>  static void __init omap_3430sdp_map_io(void)
> diff --git a/arch/arm/plat-omap/include/mach/board-3430sdp.h b/arch/arm/plat-omap/include/mach/board-3430sdp.h
> index 67d3f78..2ddb3e5 100644
> --- a/arch/arm/plat-omap/include/mach/board-3430sdp.h
> +++ b/arch/arm/plat-omap/include/mach/board-3430sdp.h
> @@ -32,6 +32,7 @@
>  extern void sdp3430_usb_init(void);
>  extern void sdp3430_flash_init(void);
>  extern void twl4030_bci_battery_init(void);
> +extern void sdp3430_cam_init(void);
>
>  #define DEBUG_BASE                     0x08000000  /* debug board */
>
> --
> 1.5.6.5
>
>

Dominic Curran March 5, 2009, 4:42 p.m. UTC | #2

Hi Kim

> -----Original Message-----
> From: [e-mail] [mailto:linux-omap-
> [e-mail]] On Behalf Of DongSoo(Nathaniel) Kim
> Sent: Wednesday, March 04, 2009 8:58 PM
> To: Aguirre Rodriguez, Sergio Alberto
> Cc: [e-mail]; [e-mail]; Sakari Ailus;
> Tuukka.O Toivonen; Hiroshi DOYU; MiaoStanley; Nagalla, Hari; Hiremath,
> Vaibhav; Lakhani, Amish; Menon, Nishanth
> Subject: Re: [PATCH 4/5] OMAP3430SDP: Add support for Camera Kit v3
>
> Hi Sergio,
>
>
>
> On Wed, Mar 4, 2009 at 5:44 AM, Aguirre Rodriguez, Sergio Alberto
> <[e-mail]> wrote:
> > +               /* turn on analog power */
> > +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> > +                               VAUX_2_8_V, TWL4030_VAUX2_DEDICATED);
> > +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> > +                               VAUX_DEV_GRP_P1, TWL4030_VAUX2_DEV_GRP);
> > +
> > +               /* out of standby */
> > +               gpio_set_value(MT9P012_STANDBY_GPIO, 0);
> > +               udelay(1000);
>
> It seems better using msleep rather than udelay for 1000us much. Just
> to be safe :)
> How about you?
>

Why is msleep safer than udelay ?

--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to [e-mail]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Alexey Klimov March 5, 2009, 10:05 p.m. UTC | #3

Hello, all

On Thu, Mar 5, 2009 at 7:42 PM, Curran, Dominic <[e-mail]> wrote:
>
> Hi Kim
>
>> -----Original Message-----
>> From: [e-mail] [mailto:linux-omap-
>> [e-mail]] On Behalf Of DongSoo(Nathaniel) Kim
>> Sent: Wednesday, March 04, 2009 8:58 PM
>> To: Aguirre Rodriguez, Sergio Alberto
>> Cc: [e-mail]; [e-mail]; Sakari Ailus;
>> Tuukka.O Toivonen; Hiroshi DOYU; MiaoStanley; Nagalla, Hari; Hiremath,
>> Vaibhav; Lakhani, Amish; Menon, Nishanth
>> Subject: Re: [PATCH 4/5] OMAP3430SDP: Add support for Camera Kit v3
>>
>> Hi Sergio,
>>
>>
>>
>> On Wed, Mar 4, 2009 at 5:44 AM, Aguirre Rodriguez, Sergio Alberto
>> <[e-mail]> wrote:
>> > +               /* turn on analog power */
>> > +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
>> > +                               VAUX_2_8_V, TWL4030_VAUX2_DEDICATED);
>> > +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
>> > +                               VAUX_DEV_GRP_P1, TWL4030_VAUX2_DEV_GRP);
>> > +
>> > +               /* out of standby */
>> > +               gpio_set_value(MT9P012_STANDBY_GPIO, 0);
>> > +               udelay(1000);
>>
>> It seems better using msleep rather than udelay for 1000us much. Just
>> to be safe :)
>> How about you?
>>
>
> Why is msleep safer than udelay ?

I have small guess that he is wondering why you are using big delays
with help of udelay(). (It's may be obvious but as we know udelay uses
cpu loops to make delay and msleep calls to scheduler) So, msleep is
more flexible and "softer" but if you need precise time or you can't
sleep in code you need udelay. Sometimes using udelay is reasonably
required.

Dominic Curran March 5, 2009, 11:02 p.m. UTC | #4

> -----Original Message-----
> From: Alexey Klimov [mailto:[e-mail]]
> Sent: Thursday, March 05, 2009 4:05 PM
> To: Curran, Dominic
> Cc: DongSoo(Nathaniel) Kim; Aguirre Rodriguez, Sergio Alberto; linux-
> [e-mail]; [e-mail]; Sakari Ailus; Tuukka.O
> Toivonen; Hiroshi DOYU; MiaoStanley; Nagalla, Hari; Hiremath, Vaibhav;
> Lakhani, Amish; Menon, Nishanth
> Subject: Re: [PATCH 4/5] OMAP3430SDP: Add support for Camera Kit v3
>
> >> > +               /* out of standby */
> >> > +               gpio_set_value(MT9P012_STANDBY_GPIO, 0);
> >> > +               udelay(1000);
> >>
> >> It seems better using msleep rather than udelay for 1000us much. Just
> >> to be safe :)
> >> How about you?
> >>
> >
> > Why is msleep safer than udelay ?
>
> I have small guess that he is wondering why you are using big delays
> with help of udelay(). (It's may be obvious but as we know udelay uses
> cpu loops to make delay and msleep calls to scheduler) So, msleep is
> more flexible and "softer" but if you need precise time or you can't
> sleep in code you need udelay. Sometimes using udelay is reasonably
> required.
>

Ah, I did not know that msleep() called scheduler.
Thank you.
--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to [e-mail]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Dongsoo Kim March 6, 2009, 1:54 a.m. UTC | #5

Hi Alexey,

On Fri, Mar 6, 2009 at 7:05 AM, Alexey Klimov <[e-mail]> wrote:
> Hello, all
>
> On Thu, Mar 5, 2009 at 7:42 PM, Curran, Dominic <[e-mail]> wrote:
>>
>> Hi Kim
>>
>>> -----Original Message-----
>>> From: [e-mail] [mailto:linux-omap-
>>> [e-mail]] On Behalf Of DongSoo(Nathaniel) Kim
>>> Sent: Wednesday, March 04, 2009 8:58 PM
>>> To: Aguirre Rodriguez, Sergio Alberto
>>> Cc: [e-mail]; [e-mail]; Sakari Ailus;
>>> Tuukka.O Toivonen; Hiroshi DOYU; MiaoStanley; Nagalla, Hari; Hiremath,
>>> Vaibhav; Lakhani, Amish; Menon, Nishanth
>>> Subject: Re: [PATCH 4/5] OMAP3430SDP: Add support for Camera Kit v3
>>>
>>> Hi Sergio,
>>>
>>>
>>>
>>> On Wed, Mar 4, 2009 at 5:44 AM, Aguirre Rodriguez, Sergio Alberto
>>> <[e-mail]> wrote:
>>> > +               /* turn on analog power */
>>> > +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
>>> > +                               VAUX_2_8_V, TWL4030_VAUX2_DEDICATED);
>>> > +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
>>> > +                               VAUX_DEV_GRP_P1, TWL4030_VAUX2_DEV_GRP);
>>> > +
>>> > +               /* out of standby */
>>> > +               gpio_set_value(MT9P012_STANDBY_GPIO, 0);
>>> > +               udelay(1000);
>>>
>>> It seems better using msleep rather than udelay for 1000us much. Just
>>> to be safe :)
>>> How about you?
>>>
>>
>> Why is msleep safer than udelay ?
>
> I have small guess that he is wondering why you are using big delays
> with help of udelay(). (It's may be obvious but as we know udelay uses
> cpu loops to make delay and msleep calls to scheduler) So, msleep is
> more flexible and "softer" but if you need precise time or you can't
> sleep in code you need udelay. Sometimes using udelay is reasonably
> required.

I totally agree with you.
But besides the "udelay and mdelay accuracy" issue, Sergio's power up
timing for  MT9P012 seems to delay too much. (not for lens
controller.)
I also have experience using MT9P012 sensor with other ISP, but in
case of mine it took 600 to 800 ms for whole power up sequence.
But if that delay depends on SDP board and Sergio had no options
without making delay for that much, then it explains everything.
So I'm saying if there was no other option than making long delay to
bring up MT9P012 sensor properly, if I were Sergio I should rather use
mdelay than udelay.
But if that delay is necessary to bring up MT9P012 with SDP board, I
have no idea what to say. In that case, Sergio should be right.
Cheers,

Nate



>
> --
> Best regards, Klimov Alexey
>

Alexey Klimov March 7, 2009, 3:41 p.m. UTC | #6

Hello, all

On Fri, 2009-03-06 at 10:54 +0900, DongSoo(Nathaniel) Kim wrote:
> Hi Alexey,
> 
> On Fri, Mar 6, 2009 at 7:05 AM, Alexey Klimov <[e-mail]> wrote:
> > Hello, all
> >
> > On Thu, Mar 5, 2009 at 7:42 PM, Curran, Dominic <[e-mail]> wrote:
> >>
> >> Hi Kim
> >>
> >>> -----Original Message-----
> >>> From: [e-mail] [mailto:linux-omap-
> >>> [e-mail]] On Behalf Of DongSoo(Nathaniel) Kim
> >>> Sent: Wednesday, March 04, 2009 8:58 PM
> >>> To: Aguirre Rodriguez, Sergio Alberto
> >>> Cc: [e-mail]; [e-mail]; Sakari Ailus;
> >>> Tuukka.O Toivonen; Hiroshi DOYU; MiaoStanley; Nagalla, Hari; Hiremath,
> >>> Vaibhav; Lakhani, Amish; Menon, Nishanth
> >>> Subject: Re: [PATCH 4/5] OMAP3430SDP: Add support for Camera Kit v3
> >>>
> >>> Hi Sergio,
> >>>
> >>>
> >>>
> >>> On Wed, Mar 4, 2009 at 5:44 AM, Aguirre Rodriguez, Sergio Alberto
> >>> <[e-mail]> wrote:
> >>> > +               /* turn on analog power */
> >>> > +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> >>> > +                               VAUX_2_8_V, TWL4030_VAUX2_DEDICATED);
> >>> > +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> >>> > +                               VAUX_DEV_GRP_P1, TWL4030_VAUX2_DEV_GRP);
> >>> > +
> >>> > +               /* out of standby */
> >>> > +               gpio_set_value(MT9P012_STANDBY_GPIO, 0);
> >>> > +               udelay(1000);
> >>>
> >>> It seems better using msleep rather than udelay for 1000us much. Just
> >>> to be safe :)
> >>> How about you?
> >>>
> >>
> >> Why is msleep safer than udelay ?
> >
> > I have small guess that he is wondering why you are using big delays
> > with help of udelay(). (It's may be obvious but as we know udelay uses
> > cpu loops to make delay and msleep calls to scheduler) So, msleep is
> > more flexible and "softer" but if you need precise time or you can't
> > sleep in code you need udelay. Sometimes using udelay is reasonably
> > required.
> 
> I totally agree with you.
> But besides the "udelay and mdelay accuracy" issue, Sergio's power up
> timing for  MT9P012 seems to delay too much. (not for lens
> controller.)
> I also have experience using MT9P012 sensor with other ISP, but in
> case of mine it took 600 to 800 ms for whole power up sequence.
> But if that delay depends on SDP board and Sergio had no options
> without making delay for that much, then it explains everything.
> So I'm saying if there was no other option than making long delay to
> bring up MT9P012 sensor properly, if I were Sergio I should rather use
> mdelay than udelay.

I agree with you. mdelay is really safer that udelay. 

>From file include/linux/delay.h:

 * Using udelay() for intervals greater than a few milliseconds can
 * risk overflow for high loops_per_jiffy (high bogomips) machines. The
 * mdelay() provides a wrapper to prevent this.  For delays greater
 * than MAX_UDELAY_MS milliseconds, the wrapper is used.  Architecture
 * specific values can be defined in asm-???/delay.h as an override.

So, let's Sergio check and decide what he needed! :)

> Cheers,
> 
> Nate

Aguirre Rodriguez, Sergio Alberto March 9, 2009, 9:23 p.m. UTC | #7

Hi,

> -----Original Message-----
> From: Alexey Klimov [mailto:[e-mail]]
> Sent: Saturday, March 07, 2009 9:42 AM
> To: DongSoo(Nathaniel) Kim
> Cc: Curran, Dominic; Aguirre Rodriguez, Sergio Alberto; linux-
> [e-mail]; [e-mail]; Sakari Ailus; Tuukka.O
> Toivonen; Hiroshi DOYU; MiaoStanley; Nagalla, Hari; Hiremath, Vaibhav;
> Lakhani, Amish; Menon, Nishanth
> Subject: Re: [PATCH 4/5] OMAP3430SDP: Add support for Camera Kit v3
> 
> Hello, all
> 
> On Fri, 2009-03-06 at 10:54 +0900, DongSoo(Nathaniel) Kim wrote:
> > Hi Alexey,
> >
> > On Fri, Mar 6, 2009 at 7:05 AM, Alexey Klimov <[e-mail]>
> wrote:
> > > Hello, all
> > >
> > > On Thu, Mar 5, 2009 at 7:42 PM, Curran, Dominic <[e-mail]>
> wrote:
> > >>
> > >> Hi Kim
> > >>
> > >>> -----Original Message-----
> > >>> From: [e-mail] [mailto:linux-omap-
> > >>> [e-mail]] On Behalf Of DongSoo(Nathaniel) Kim
> > >>> Sent: Wednesday, March 04, 2009 8:58 PM
> > >>> To: Aguirre Rodriguez, Sergio Alberto
> > >>> Cc: [e-mail]; [e-mail]; Sakari
> Ailus;
> > >>> Tuukka.O Toivonen; Hiroshi DOYU; MiaoStanley; Nagalla, Hari;
> Hiremath,
> > >>> Vaibhav; Lakhani, Amish; Menon, Nishanth
> > >>> Subject: Re: [PATCH 4/5] OMAP3430SDP: Add support for Camera Kit v3
> > >>>
> > >>> Hi Sergio,
> > >>>
> > >>>
> > >>>
> > >>> On Wed, Mar 4, 2009 at 5:44 AM, Aguirre Rodriguez, Sergio Alberto
> > >>> <[e-mail]> wrote:
> > >>> > +               /* turn on analog power */
> > >>> > +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> > >>> > +                               VAUX_2_8_V,
> TWL4030_VAUX2_DEDICATED);
> > >>> > +               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
> > >>> > +                               VAUX_DEV_GRP_P1,
> TWL4030_VAUX2_DEV_GRP);
> > >>> > +
> > >>> > +               /* out of standby */
> > >>> > +               gpio_set_value(MT9P012_STANDBY_GPIO, 0);
> > >>> > +               udelay(1000);
> > >>>
> > >>> It seems better using msleep rather than udelay for 1000us much.
> Just
> > >>> to be safe :)
> > >>> How about you?
> > >>>
> > >>
> > >> Why is msleep safer than udelay ?
> > >
> > > I have small guess that he is wondering why you are using big delays
> > > with help of udelay(). (It's may be obvious but as we know udelay uses
> > > cpu loops to make delay and msleep calls to scheduler) So, msleep is
> > > more flexible and "softer" but if you need precise time or you can't
> > > sleep in code you need udelay. Sometimes using udelay is reasonably
> > > required.
> >
> > I totally agree with you.
> > But besides the "udelay and mdelay accuracy" issue, Sergio's power up
> > timing for  MT9P012 seems to delay too much. (not for lens
> > controller.)
> > I also have experience using MT9P012 sensor with other ISP, but in
> > case of mine it took 600 to 800 ms for whole power up sequence.
> > But if that delay depends on SDP board and Sergio had no options
> > without making delay for that much, then it explains everything.
> > So I'm saying if there was no other option than making long delay to
> > bring up MT9P012 sensor properly, if I were Sergio I should rather use
> > mdelay than udelay.
> 
> I agree with you. mdelay is really safer that udelay.

Sorry for not participating much in this thread, I have been busy fixing other comments.

This delay setting was set before I ever touched this drivers by other omap3 Linux camera ex-team member here in TI. I suspect they were set to the minimum working level in SDP already, but I haven't honestly tried to move them. I guess it's a good time to do so. :)

I'll fix some other things first, and put this on my plate to check before reposting next version of drivers.

I really appreciate your feedback on this.

Regards,
Sergio

> 
> >From file include/linux/delay.h:
> 
>  * Using udelay() for intervals greater than a few milliseconds can
>  * risk overflow for high loops_per_jiffy (high bogomips) machines. The
>  * mdelay() provides a wrapper to prevent this.  For delays greater
>  * than MAX_UDELAY_MS milliseconds, the wrapper is used.  Architecture
>  * specific values can be defined in asm-???/delay.h as an override.
> 
> So, let's Sergio check and decide what he needed! :)
> 
> > Cheers,
> >
> > Nate
> 
> --
> Best regards, Klimov Alexey
> 

--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to [e-mail]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Patch

diff --git a/arch/arm/mach-omap2/Makefile b/arch/arm/mach-omap2/Makefile
index 33b5aa8..8888ee6 100644
--- a/arch/arm/mach-omap2/Makefile
+++ b/arch/arm/mach-omap2/Makefile
@@ -53,7 +53,8 @@  obj-$(CONFIG_MACH_OMAP2EVM)           += board-omap2evm.o \
                                           mmc-twl4030.o
 obj-$(CONFIG_MACH_OMAP_3430SDP)                += board-3430sdp.o \
                                           mmc-twl4030.o \
-                                          board-3430sdp-flash.o
+                                          board-3430sdp-flash.o \
+                                          board-3430sdp-camera.o
 obj-$(CONFIG_MACH_OMAP3EVM)            += board-omap3evm.o \
                                           mmc-twl4030.o \
                                           board-omap3evm-flash.o \
diff --git a/arch/arm/mach-omap2/board-3430sdp-camera.c b/arch/arm/mach-omap2/board-3430sdp-camera.c
new file mode 100644
index 0000000..661d5ed
--- /dev/null
+++ b/arch/arm/mach-omap2/board-3430sdp-camera.c
@@ -0,0 +1,490 @@ 
+/*
+ * linux/arch/arm/mach-omap2/board-3430sdp.c
+ *
+ * Copyright (C) 2007 Texas Instruments
+ *
+ * Modified from mach-omap2/board-generic.c
+ *
+ * Initial code: Syed Mohammed Khasim
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#ifdef CONFIG_TWL4030_CORE
+
+#include <linux/clk.h>
+#include <linux/platform_device.h>
+#include <linux/delay.h>
+#include <linux/mm.h>
+
+#include <linux/i2c/twl4030.h>
+
+#include <asm/io.h>
+
+#include <mach/gpio.h>
+
+static int cam_inited;
+#include <media/v4l2-int-device.h>
+#include <../drivers/media/video/omap34xxcam.h>
+#include <../drivers/media/video/isp/ispreg.h>
+#define DEBUG_BASE             0x08000000
+
+#define REG_SDP3430_FPGA_GPIO_2 (0x50)
+#define FPGA_SPR_GPIO1_3v3     (0x1 << 14)
+#define FPGA_GPIO6_DIR_CTRL    (0x1 << 6)
+
+#define VAUX_2_8_V             0x09
+#define VAUX_1_8_V             0x05
+#define VAUX_DEV_GRP_P1                0x20
+#define VAUX_DEV_GRP_NONE      0x00
+
+#define CAMKITV3_USE_XCLKA     0
+#define CAMKITV3_USE_XCLKB     1
+
+#define CAMKITV3_RESET_GPIO    98
+/* Sensor specific GPIO signals */
+#define MT9P012_STANDBY_GPIO   58
+#define OV3640_STANDBY_GPIO    55
+static void __iomem *fpga_map_addr;
+
+#if defined(CONFIG_VIDEO_MT9P012) || defined(CONFIG_VIDEO_MT9P012_MODULE)
+#include <media/mt9p012.h>
+static enum v4l2_power mt9p012_previous_power = V4L2_POWER_OFF;
+#endif
+
+#if defined(CONFIG_VIDEO_OV3640) || defined(CONFIG_VIDEO_OV3640_MODULE)
+#include <media/ov3640.h>
+#include <../drivers/media/video/isp/ispcsi2.h>
+static struct omap34xxcam_hw_config *hwc;
+#define OV3640_CSI2_CLOCK_POLARITY     0       /* +/- pin order */
+#define OV3640_CSI2_DATA0_POLARITY     0       /* +/- pin order */
+#define OV3640_CSI2_DATA1_POLARITY     0       /* +/- pin order */
+#define OV3640_CSI2_CLOCK_LANE         1        /* Clock lane position: 1 */
+#define OV3640_CSI2_DATA0_LANE         2        /* Data0 lane position: 2 */
+#define OV3640_CSI2_DATA1_LANE         3        /* Data1 lane position: 3 */
+#define OV3640_CSI2_PHY_THS_TERM       4
+#define OV3640_CSI2_PHY_THS_SETTLE     14
+#define OV3640_CSI2_PHY_TCLK_TERM      0
+#define OV3640_CSI2_PHY_TCLK_MISS      1
+#define OV3640_CSI2_PHY_TCLK_SETTLE    14
+#endif
+
+#ifdef CONFIG_VIDEO_DW9710
+#include <media/dw9710.h>
+#endif
+
+static void __iomem *fpga_map_addr;
+
+static void enable_fpga_vio_1v8(u8 enable)
+{
+       u16 reg_val;
+
+       fpga_map_addr = ioremap(DEBUG_BASE, 4096);
+       reg_val = readw(fpga_map_addr + REG_SDP3430_FPGA_GPIO_2);
+
+       /* Ensure that the SPR_GPIO1_3v3 is 0 - powered off.. 1 is on */
+       if (reg_val & FPGA_SPR_GPIO1_3v3) {
+               reg_val |= FPGA_SPR_GPIO1_3v3;
+               reg_val |= FPGA_GPIO6_DIR_CTRL; /* output mode */
+               writew(reg_val, fpga_map_addr + REG_SDP3430_FPGA_GPIO_2);
+               /* give a few milli sec to settle down
+                * Let the sensor also settle down.. if required..
+                */
+               if (enable)
+                       mdelay(10);
+       }
+
+       if (enable) {
+               reg_val |= FPGA_SPR_GPIO1_3v3 | FPGA_GPIO6_DIR_CTRL;
+               writew(reg_val, fpga_map_addr + REG_SDP3430_FPGA_GPIO_2);
+       }
+       /* Vrise time for the voltage - should be less than 1 ms */
+       mdelay(1);
+}
+
+#ifdef CONFIG_VIDEO_DW9710
+static int dw9710_lens_power_set(enum v4l2_power power)
+{
+       if (!cam_inited) {
+               printk(KERN_ERR "DW9710: Unable to control board GPIOs!\n");
+               return -EFAULT;
+       }
+
+       /* The power change depends on MT9P012 powerup, so if we request a
+        * power state different from sensor, we should return error
+        */
+       if ((mt9p012_previous_power != V4L2_POWER_OFF) &&
+                                       (power != mt9p012_previous_power))
+               return -EIO;
+
+       switch (power) {
+       case V4L2_POWER_OFF:
+               /* Power Down Sequence */
+               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                               VAUX_DEV_GRP_NONE, TWL4030_VAUX2_DEV_GRP);
+               enable_fpga_vio_1v8(0);
+               iounmap(fpga_map_addr);
+               break;
+       case V4L2_POWER_ON:
+               /* STANDBY_GPIO is active HIGH for set LOW to release */
+               gpio_set_value(MT9P012_STANDBY_GPIO, 1);
+
+               /* nRESET is active LOW. set HIGH to release reset */
+               gpio_set_value(CAMKITV3_RESET_GPIO, 1);
+
+               /* turn on digital power */
+               enable_fpga_vio_1v8(1);
+
+               /* turn on analog power */
+               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                               VAUX_2_8_V, TWL4030_VAUX2_DEDICATED);
+               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                               VAUX_DEV_GRP_P1, TWL4030_VAUX2_DEV_GRP);
+
+               /* out of standby */
+               gpio_set_value(MT9P012_STANDBY_GPIO, 0);
+               udelay(1000);
+
+               /* have to put sensor to reset to guarantee detection */
+               gpio_set_value(CAMKITV3_RESET_GPIO, 0);
+
+               udelay(1500);
+
+               /* nRESET is active LOW. set HIGH to release reset */
+               gpio_set_value(CAMKITV3_RESET_GPIO, 1);
+               /* give sensor sometime to get out of the reset.
+                * Datasheet says 2400 xclks. At 6 MHz, 400 usec is
+                * enough
+                */
+               udelay(300);
+               break;
+       case V4L2_POWER_STANDBY:
+               break;
+       }
+       return 0;
+}
+
+static int dw9710_lens_set_prv_data(void *priv)
+{
+       struct omap34xxcam_hw_config *hwc = priv;
+
+       hwc->dev_index = 0;
+       hwc->dev_minor = 0;
+       hwc->dev_type = OMAP34XXCAM_SLAVE_LENS;
+
+       return 0;
+}
+
+struct dw9710_platform_data sdp3430_dw9710_platform_data = {
+       .power_set      = dw9710_lens_power_set,
+       .priv_data_set  = dw9710_lens_set_prv_data,
+};
+#endif
+
+#if defined(CONFIG_VIDEO_MT9P012) || defined(CONFIG_VIDEO_MT9P012_MODULE)
+static struct omap34xxcam_sensor_config cam_hwc = {
+       .sensor_isp = 0,
+       .xclk = OMAP34XXCAM_XCLK_A,
+       .capture_mem = PAGE_ALIGN(2592 * 1944 * 2) * 4,
+       .ival_default   = { 1, 10 },
+};
+
+static int mt9p012_sensor_set_prv_data(void *priv)
+{
+       struct omap34xxcam_hw_config *hwc = priv;
+
+       hwc->u.sensor.xclk = cam_hwc.xclk;
+       hwc->u.sensor.sensor_isp = cam_hwc.sensor_isp;
+       hwc->u.sensor.capture_mem = cam_hwc.capture_mem;
+       hwc->dev_index = 0;
+       hwc->dev_minor = 0;
+       hwc->dev_type = OMAP34XXCAM_SLAVE_SENSOR;
+       return 0;
+}
+
+static struct isp_interface_config mt9p012_if_config = {
+       .ccdc_par_ser = ISP_PARLL,
+       .dataline_shift = 0x1,
+       .hsvs_syncdetect = ISPCTRL_SYNC_DETECT_VSRISE,
+       .strobe = 0x0,
+       .prestrobe = 0x0,
+       .shutter = 0x0,
+       .prev_sph = 2,
+       .prev_slv = 0,
+       .wenlog = ISPCCDC_CFG_WENLOG_AND,
+       .u.par.par_bridge = 0x0,
+       .u.par.par_clk_pol = 0x0,
+};
+
+static int mt9p012_sensor_power_set(enum v4l2_power power)
+{
+       if (!cam_inited) {
+               printk(KERN_ERR "MT9P012: Unable to control board GPIOs!\n");
+               return -EFAULT;
+       }
+
+       switch (power) {
+       case V4L2_POWER_OFF:
+               /* Power Down Sequence */
+               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                               VAUX_DEV_GRP_NONE, TWL4030_VAUX2_DEV_GRP);
+
+               enable_fpga_vio_1v8(0);
+               iounmap(fpga_map_addr);
+               break;
+       case V4L2_POWER_ON:
+               if (mt9p012_previous_power == V4L2_POWER_OFF) {
+                       /* Power Up Sequence */
+                       isp_configure_interface(&mt9p012_if_config);
+
+                       /* set to output mode */
+                       gpio_direction_output(MT9P012_STANDBY_GPIO, true);
+                       /* set to output mode */
+                       gpio_direction_output(CAMKITV3_RESET_GPIO, true);
+
+                       /* STANDBY_GPIO is active HIGH for set LOW to release */
+                       gpio_set_value(MT9P012_STANDBY_GPIO, 1);
+
+                       /* nRESET is active LOW. set HIGH to release reset */
+                       gpio_set_value(CAMKITV3_RESET_GPIO, 1);
+
+                       /* turn on digital power */
+                       enable_fpga_vio_1v8(1);
+
+                       /* turn on analog power */
+                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                                       VAUX_2_8_V, TWL4030_VAUX2_DEDICATED);
+                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                                       VAUX_DEV_GRP_P1, TWL4030_VAUX2_DEV_GRP);
+               }
+
+               /* out of standby */
+               gpio_set_value(MT9P012_STANDBY_GPIO, 0);
+               udelay(1000);
+
+               if (mt9p012_previous_power == V4L2_POWER_OFF) {
+                       /* have to put sensor to reset to guarantee detection */
+                       gpio_set_value(CAMKITV3_RESET_GPIO, 0);
+
+                       udelay(1500);
+
+                       /* nRESET is active LOW. set HIGH to release reset */
+                       gpio_set_value(CAMKITV3_RESET_GPIO, 1);
+                       /* give sensor sometime to get out of the reset.
+                        * Datasheet says 2400 xclks. At 6 MHz, 400 usec is
+                        * enough
+                        */
+                       udelay(300);
+               }
+               break;
+       case V4L2_POWER_STANDBY:
+               /* stand by */
+               gpio_set_value(MT9P012_STANDBY_GPIO, 1);
+               break;
+       }
+       /* Save powerstate to know what was before calling POWER_ON. */
+       mt9p012_previous_power = power;
+       return 0;
+}
+
+static u32 mt9p012_sensor_set_xclk(u32 xclkfreq)
+{
+       return isp_set_xclk(xclkfreq, CAMKITV3_USE_XCLKA);
+}
+
+struct mt9p012_platform_data sdp3430_mt9p012_platform_data = {
+       .power_set      = mt9p012_sensor_power_set,
+       .priv_data_set  = mt9p012_sensor_set_prv_data,
+       .set_xclk       = mt9p012_sensor_set_xclk,
+};
+
+#endif
+
+#if defined(CONFIG_VIDEO_OV3640) || defined(CONFIG_VIDEO_OV3640_MODULE)
+
+static struct omap34xxcam_sensor_config ov3640_hwc = {
+       .sensor_isp = 0,
+#if defined(CONFIG_VIDEO_OV3640_CSI2)
+       .xclk = OMAP34XXCAM_XCLK_B,
+#else
+       .xclk = OMAP34XXCAM_XCLK_A,
+#endif
+       .capture_mem = PAGE_ALIGN(2048 * 1536 * 2) * 2,
+       .ival_default   = { 1, 15 },
+};
+
+static struct isp_interface_config ov3640_if_config = {
+       .ccdc_par_ser = ISP_CSIA,
+       .dataline_shift = 0x0,
+       .hsvs_syncdetect = ISPCTRL_SYNC_DETECT_VSRISE,
+       .strobe = 0x0,
+       .prestrobe = 0x0,
+       .shutter = 0x0,
+       .prev_sph = 2,
+       .prev_slv = 0,
+       .wenlog = ISPCCDC_CFG_WENLOG_AND,
+       .wait_hs_vs = 2,
+       .u.csi.crc = 0x0,
+       .u.csi.mode = 0x0,
+       .u.csi.edge = 0x0,
+       .u.csi.signalling = 0x0,
+       .u.csi.strobe_clock_inv = 0x0,
+       .u.csi.vs_edge = 0x0,
+       .u.csi.channel = 0x1,
+       .u.csi.vpclk = 0x1,
+       .u.csi.data_start = 0x0,
+       .u.csi.data_size = 0x0,
+       .u.csi.format = V4L2_PIX_FMT_SGRBG10,
+};
+
+static int ov3640_sensor_set_prv_data(void *priv)
+{
+       hwc = priv;
+       hwc->u.sensor.xclk = ov3640_hwc.xclk;
+       hwc->u.sensor.sensor_isp = ov3640_hwc.sensor_isp;
+       hwc->u.sensor.capture_mem = ov3640_hwc.capture_mem;
+       hwc->dev_index = 1;
+       hwc->dev_minor = 4;
+       hwc->dev_type = OMAP34XXCAM_SLAVE_SENSOR;
+       return 0;
+}
+
+static int ov3640_sensor_power_set(enum v4l2_power power)
+{
+       struct isp_csi2_lanes_cfg lanecfg;
+       struct isp_csi2_phy_cfg phyconfig;
+       static enum v4l2_power previous_power = V4L2_POWER_OFF;
+
+       if (!cam_inited) {
+               printk(KERN_ERR "OV3640: Unable to control board GPIOs!\n");
+               return -EFAULT;
+       }
+
+       switch (power) {
+       case V4L2_POWER_ON:
+               if (previous_power == V4L2_POWER_OFF)
+                       isp_csi2_reset();
+
+               lanecfg.clk.pol = OV3640_CSI2_CLOCK_POLARITY;
+               lanecfg.clk.pos = OV3640_CSI2_CLOCK_LANE;
+               lanecfg.data[0].pol = OV3640_CSI2_DATA0_POLARITY;
+               lanecfg.data[0].pos = OV3640_CSI2_DATA0_LANE;
+               lanecfg.data[1].pol = OV3640_CSI2_DATA1_POLARITY;
+               lanecfg.data[1].pos = OV3640_CSI2_DATA1_LANE;
+               lanecfg.data[2].pol = 0;
+               lanecfg.data[2].pos = 0;
+               lanecfg.data[3].pol = 0;
+               lanecfg.data[3].pos = 0;
+               isp_csi2_complexio_lanes_config(&lanecfg);
+               isp_csi2_complexio_lanes_update(true);
+
+               phyconfig.ths_term = OV3640_CSI2_PHY_THS_TERM;
+               phyconfig.ths_settle = OV3640_CSI2_PHY_THS_SETTLE;
+               phyconfig.tclk_term = OV3640_CSI2_PHY_TCLK_TERM;
+               phyconfig.tclk_miss = OV3640_CSI2_PHY_TCLK_MISS;
+               phyconfig.tclk_settle = OV3640_CSI2_PHY_TCLK_SETTLE;
+               isp_csi2_phy_config(&phyconfig);
+               isp_csi2_phy_update(true);
+
+               isp_configure_interface(&ov3640_if_config);
+
+               if (previous_power == V4L2_POWER_OFF) {
+                       /* turn on analog power */
+#if defined(CONFIG_VIDEO_OV3640_CSI2)
+                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                                       VAUX_1_8_V, TWL4030_VAUX4_DEDICATED);
+                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                                       VAUX_DEV_GRP_P1, TWL4030_VAUX4_DEV_GRP);
+#else
+                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                                       VAUX_2_8_V, TWL4030_VAUX2_DEDICATED);
+                       twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                                       VAUX_DEV_GRP_P1, TWL4030_VAUX2_DEV_GRP);
+#endif
+                       udelay(100);
+
+                       /* Turn ON Omnivision sensor */
+                       gpio_set_value(CAMKITV3_RESET_GPIO, 1);
+                       gpio_set_value(OV3640_STANDBY_GPIO, 0);
+                       udelay(100);
+
+                       /* RESET Omnivision sensor */
+                       gpio_set_value(CAMKITV3_RESET_GPIO, 0);
+                       udelay(100);
+                       gpio_set_value(CAMKITV3_RESET_GPIO, 1);
+
+                       /* Wait 10 ms */
+                       mdelay(10);
+                       enable_fpga_vio_1v8(1);
+                       udelay(100);
+               }
+               break;
+       case V4L2_POWER_OFF:
+               /* Power Down Sequence */
+               isp_csi2_complexio_power(ISP_CSI2_POWER_OFF);
+#if defined(CONFIG_VIDEO_OV3640_CSI2)
+               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                               VAUX_DEV_GRP_NONE, TWL4030_VAUX4_DEV_GRP);
+#else
+               twl4030_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER,
+                               VAUX_DEV_GRP_NONE, TWL4030_VAUX2_DEV_GRP);
+#endif
+               enable_fpga_vio_1v8(0);
+               iounmap(fpga_map_addr);
+               break;
+       case V4L2_POWER_STANDBY:
+               break;
+       }
+       previous_power = power;
+       return 0;
+}
+
+static u32 ov3640_sensor_set_xclk(u32 xclkfreq)
+{
+       return isp_set_xclk(xclkfreq, CAMKITV3_USE_XCLKB);
+}
+
+struct ov3640_platform_data sdp3430_ov3640_platform_data = {
+       .power_set       = ov3640_sensor_power_set,
+       .priv_data_set   = ov3640_sensor_set_prv_data,
+       .set_xclk        = ov3640_sensor_set_xclk,
+};
+
+#endif
+
+void __init sdp3430_cam_init(void)
+{
+       cam_inited = 0;
+       /* Request and configure gpio pins */
+       if (gpio_request(CAMKITV3_RESET_GPIO, "camkitv3_reset_gpio") != 0) {
+               printk(KERN_ERR "Could not request GPIO %d",
+                                       CAMKITV3_RESET_GPIO);
+               return;
+       }
+
+       if (gpio_request(OV3640_STANDBY_GPIO, "ov3640_standby_gpio") != 0) {
+               printk(KERN_ERR "Could not request GPIO %d",
+                                       OV3640_STANDBY_GPIO);
+               return;
+       }
+
+       if (gpio_request(MT9P012_STANDBY_GPIO, "mt9p012_standby_gpio")) {
+               printk(KERN_ERR "Could not request GPIO %d for MT9P012\n",
+                                                       MT9P012_STANDBY_GPIO);
+               return;
+       }
+
+       /* set to output mode */
+       gpio_direction_output(CAMKITV3_RESET_GPIO, true);
+       gpio_direction_output(OV3640_STANDBY_GPIO, true);
+       gpio_direction_output(MT9P012_STANDBY_GPIO, true);
+
+       cam_inited = 1;
+}
+#else
+void __init sdp3430_cam_init(void)
+{
+}
+#endif
diff --git a/arch/arm/mach-omap2/board-3430sdp.c b/arch/arm/mach-omap2/board-3430sdp.c
index 867f5f6..986f087 100644
--- a/arch/arm/mach-omap2/board-3430sdp.c
+++ b/arch/arm/mach-omap2/board-3430sdp.c
@@ -40,6 +40,23 @@ 
 #include <mach/dma.h>
 #include <mach/gpmc.h>

+#include <media/v4l2-int-device.h>
+
+#if defined(CONFIG_VIDEO_MT9P012) || defined(CONFIG_VIDEO_MT9P012_MODULE)
+#include <media/mt9p012.h>
+extern struct mt9p012_platform_data sdp3430_mt9p012_platform_data;
+#endif
+
+#if defined(CONFIG_VIDEO_OV3640) || defined(CONFIG_VIDEO_OV3640_MODULE)
+#include <media/ov3640.h>
+extern struct ov3640_platform_data sdp3430_ov3640_platform_data;
+#endif
+
+#ifdef CONFIG_VIDEO_DW9710
+#include <media/dw9710.h>
+extern struct dw9710_platform_data sdp3430_dw9710_platform_data;
+#endif
+
 #include <mach/control.h>

 #include "sdram-qimonda-hyb18m512160af-6.h"
@@ -610,13 +627,35 @@  static struct i2c_board_info __initdata sdp3430_i2c_boardinfo[] = {
        },
 };

+static struct i2c_board_info __initdata sdp3430_i2c_boardinfo_2[] = {
+#if defined(CONFIG_VIDEO_MT9P012) || defined(CONFIG_VIDEO_MT9P012_MODULE)
+       {
+               I2C_BOARD_INFO("mt9p012", MT9P012_I2C_ADDR),
+               .platform_data = &sdp3430_mt9p012_platform_data,
+       },
+#ifdef CONFIG_VIDEO_DW9710
+       {
+               I2C_BOARD_INFO("dw9710",  DW9710_AF_I2C_ADDR),
+               .platform_data = &sdp3430_dw9710_platform_data,
+       },
+#endif
+#endif
+#if defined(CONFIG_VIDEO_OV3640) || defined(CONFIG_VIDEO_OV3640_MODULE)
+       {
+               I2C_BOARD_INFO("ov3640", OV3640_I2C_ADDR),
+               .platform_data = &sdp3430_ov3640_platform_data,
+       },
+#endif
+};
+
 static int __init omap3430_i2c_init(void)
 {
        /* i2c1 for PMIC only */
        omap_register_i2c_bus(1, 2600, sdp3430_i2c_boardinfo,
                        ARRAY_SIZE(sdp3430_i2c_boardinfo));
        /* i2c2 on camera connector (for sensor control) and optional isp1301 */
-       omap_register_i2c_bus(2, 400, NULL, 0);
+       omap_register_i2c_bus(2, 400, sdp3430_i2c_boardinfo_2,
+                       ARRAY_SIZE(sdp3430_i2c_boardinfo_2));
        /* i2c3 on display connector (for DVI, tfp410) */
        omap_register_i2c_bus(3, 400, NULL, 0);
        return 0;
@@ -641,6 +680,7 @@  static void __init omap_3430sdp_init(void)
        omap_serial_init();
        usb_musb_init();
        usb_ehci_init();
+       sdp3430_cam_init();
 }

 static void __init omap_3430sdp_map_io(void)
diff --git a/arch/arm/plat-omap/include/mach/board-3430sdp.h b/arch/arm/plat-omap/include/mach/board-3430sdp.h
index 67d3f78..2ddb3e5 100644
--- a/arch/arm/plat-omap/include/mach/board-3430sdp.h
+++ b/arch/arm/plat-omap/include/mach/board-3430sdp.h
@@ -32,6 +32,7 @@ 
 extern void sdp3430_usb_init(void);
 extern void sdp3430_flash_init(void);
 extern void twl4030_bci_battery_init(void);
+extern void sdp3430_cam_init(void);

 #define DEBUG_BASE                     0x08000000  /* debug board */