From dae2101b35e9050bbfd02f6cd084e76d005de061 Mon Sep 17 00:00:00 2001 From: Bryan Wu Date: Tue, 25 Jun 2013 17:30:57 -0700 Subject: media: ov5640: update OV5640 sensor driver Bug 1369083 Change-Id: I1522b688e0681e52592c0f26a8e335937372836a Signed-off-by: Bryan Wu Reviewed-on: http://git-master/r/279989 Reviewed-by: Matthew Pedro Tested-by: Matthew Pedro --- drivers/media/video/ov5640.c | 2135 +++++++++++++++++++++++++----------------- 1 file changed, 1289 insertions(+), 846 deletions(-) diff --git a/drivers/media/video/ov5640.c b/drivers/media/video/ov5640.c index 8e45fa3de5d2..795d9bd541b3 100644 --- a/drivers/media/video/ov5640.c +++ b/drivers/media/video/ov5640.c @@ -1,5 +1,5 @@ /* - * Copyright (c) 2012, NVIDIA CORPORATION. All rights reserved. + * Copyright (c) 2012-2013, NVIDIA CORPORATION. All rights reserved. * * This program is free software; you can redistribute it and/or modify it * under the terms and conditions of the GNU General Public License, @@ -14,6 +14,7 @@ * along with this program. If not, see . */ +#include #include #include #include @@ -21,793 +22,1324 @@ #include #include -#define to_ov5640(sd) container_of(sd, struct ov5640_priv, subdev) - -#define OV5640_SYSTEM_CTRL 0x3008 -#define OV5640_CHIP_ID_HI 0x300a -#define OV5640_CHIP_ID_LO 0x300b -#define OV5640_PAD_OUTPUT_ENABLE00 0x3016 -#define OV5640_PAD_OUTPUT_ENABLE01 0x3017 -#define OV5640_PAD_OUTPUT_ENABLE02 0x3018 -#define OV5640_SC_PLL_CTRL0 0x3034 -#define OV5640_SC_PLL_CTRL1 0x3035 -#define OV5640_SC_PLL_CTRL2 0x3036 -#define OV5640_SC_PLL_CTRL3 0x3037 - -/* SCCB Control */ -#define OV5640_SCCB_SYSTEM_CTRL1 0x3103 -#define OV5640_SYSTEM_ROOT_DIVIDER 0x3108 - -/* Timing Control */ -#define OV5640_TIMING_HS_HI 0x3800 -#define OV5640_TIMING_HS_LO 0x3801 -#define OV5640_TIMING_VS_HI 0x3802 -#define OV5640_TIMING_VS_LO 0x3803 -#define OV5640_TIMING_HW_HI 0x3804 -#define OV5640_TIMING_HW_LO 0x3805 -#define OV5640_TIMING_VH_HI 0x3806 -#define OV5640_TIMING_VH_LO 0x3807 -#define OV5640_TIMING_DVPHO_HI 0x3808 -#define OV5640_TIMING_DVPHO_LO 0x3809 -#define OV5640_TIMING_DVPVO_HI 0x380a -#define OV5640_TIMING_DVPVO_LO 0x380b -#define OV5640_TIMING_HTS_HI 0x380c -#define OV5640_TIMING_HTS_LO 0x380d -#define OV5640_TIMING_VTS_HI 0x380e -#define OV5640_TIMING_VTS_LO 0x380f -#define OV5640_TIMING_HOFFSET_HI 0x3810 -#define OV5640_TIMING_HOFFSET_LO 0x3811 -#define OV5640_TIMING_VOFFSET_HI 0x3812 -#define OV5640_TIMING_VOFFSET_LO 0x3813 -#define OV5640_TIMING_X_INC 0x3814 -#define OV5640_TIMING_Y_INC 0x3815 -#define OV5640_TIMING_TC_REG20 0x3820 -#define OV5640_TIMING_TC_REG21 0x3821 - -/* AEC/AGC Power Down Domain Control */ -#define OV5640_AEC_MAX_EXPO_60HZ_HI 0x3a02 -#define OV5640_AEC_MAX_EXPO_60HZ_LO 0x3a03 -#define OV5640_AEC_B50_STEP_HI 0x3a08 -#define OV5640_AEC_B50_STEP_LO 0x3a09 -#define OV5640_AEC_B60_STEP_HI 0x3a0a -#define OV5640_AEC_B60_STEP_LO 0x3a0b -#define OV5640_AEC_CTRL0C 0x3a0c -#define OV5640_AEC_CTRL0D 0x3a0d -#define OV5640_AEC_CTRL0E 0x3a0e -#define OV5640_AEC_CTRL0F 0x3a0f -#define OV5640_AEC_CTRL10 0x3a10 -#define OV5640_AEC_CTRL11 0x3a11 -#define OV5640_AEC_CTRL12 0x3a12 -#define OV5640_AEC_CTRL13 0x3a13 -#define OV5640_AEC_MAX_EXPO_50HZ_HI 0x3a14 -#define OV5640_AEC_MAX_EXPO_50HZ_LO 0x3a15 -#define OV5640_AEC_GAIN_CEILING_HI 0x3a18 -#define OV5640_AEC_GAIN_CEILING_LO 0x3a19 -#define OV5640_AEC_CTRL1B 0x3a1b -#define OV5640_AEC_CTRL1E 0x3a1e -#define OV5640_AEC_CTRL1F 0x3a1f - -/* 50/60Hz Detector Control */ -#define OV5640_5060HZ_CTRL00 0x3c00 -#define OV5640_5060HZ_CTRL01 0x3c01 -#define OV5640_5060HZ_CTRL02 0x3c02 -#define OV5640_5060HZ_CTRL03 0x3c03 -#define OV5640_5060HZ_CTRL04 0x3c04 -#define OV5640_5060HZ_CTRL05 0x3c05 -#define OV5640_LIGHT_METER1_THRESHOLD_HI 0x3c06 -#define OV5640_LIGHT_METER1_THRESHOLD_LO 0x3c07 -#define OV5640_LIGHT_METER2_THRESHOLD_HI 0x3c08 -#define OV5640_LIGHT_METER2_THRESHOLD_LO 0x3c09 -#define OV5640_SAMPLE_NUMBER_HI 0x3c0a -#define OV5640_SAMPLE_NUMBER_LO 0x3c0b - -/* ISP General Controls */ -#define OV5640_ISP_CTRL00 0x5000 -#define OV5640_ISP_CTRL01 0x5001 -#define OV5640_ISP_CTRL37 0x5025 - -/* AWB Control */ -#define OV5640_AWB_CTRL00 0x5180 -#define OV5640_AWB_CTRL01 0x5181 -#define OV5640_AWB_CTRL02 0x5182 -#define OV5640_AWB_CTRL03 0x5183 -#define OV5640_AWB_CTRL04 0x5184 -#define OV5640_AWB_CTRL05 0x5185 -#define OV5640_AWB_CTRL06 0x5186 -#define OV5640_AWB_CTRL07 0x5187 -#define OV5640_AWB_CTRL08 0x5188 -#define OV5640_AWB_CTRL09 0x5189 -#define OV5640_AWB_CTRL10 0x518a -#define OV5640_AWB_CTRL11 0x518b -#define OV5640_AWB_CTRL12 0x518c -#define OV5640_AWB_CTRL13 0x518d -#define OV5640_AWB_CTRL14 0x518e -#define OV5640_AWB_CTRL15 0x518f -#define OV5640_AWB_CTRL16 0x5190 -#define OV5640_AWB_CTRL17 0x5191 -#define OV5640_AWB_CTRL18 0x5192 -#define OV5640_AWB_CTRL19 0x5193 -#define OV5640_AWB_CTRL20 0x5194 -#define OV5640_AWB_CTRL21 0x5195 -#define OV5640_AWB_CTRL22 0x5196 -#define OV5640_AWB_CTRL23 0x5197 -#define OV5640_AWB_CTRL24 0x5198 -#define OV5640_AWB_CTRL25 0x5199 -#define OV5640_AWB_CTRL26 0x519a -#define OV5640_AWB_CTRL27 0x519b -#define OV5640_AWB_CTRL28 0x519c -#define OV5640_AWB_CTRL29 0x519d -#define OV5640_AWB_CTRL30 0x519e - -/* CIP Control */ -#define OV5640_CIP_SHARPENMT_THRESHOLD_1 0x5300 -#define OV5640_CIP_SHARPENMT_THRESHOLD_2 0x5301 -#define OV5640_CIP_SHARPENMT_OFFSET_1 0x5302 -#define OV5640_CIP_SHARPENMT_OFFSET_2 0x5303 -#define OV5640_CIP_DNS_THRESHOLD_1 0x5304 -#define OV5640_CIP_DNS_THRESHOLD_2 0x5305 -#define OV5640_CIP_DNS_OFFSET_1 0x5306 -#define OV5640_CIP_DNS_OFFSET_2 0x5307 -#define OV5640_CIP_CTRL 0x5308 -#define OV5640_CIP_SHARPENTH_THRESHOLD_1 0x5309 -#define OV5640_CIP_SHARPENTH_THRESHOLD_2 0x530a -#define OV5640_CIP_SHARPENTH_OFFSET_1 0x530b -#define OV5640_CIP_SHARPENTH_OFFSET_2 0x530c -#define OV5640_CIP_EDGE_MT_AUTO 0x530d -#define OV5640_CIP_DNS_THRESHOLD_AUTO 0x530e -#define OF5640_CIP_SHARPEN_THRESHOLD_AUTO 0x530f - -/* CMX Control */ -#define OV5640_CMX_CTRL 0x5380 -#define OV5640_CMX1 0x5381 -#define OV5640_CMX2 0x5382 -#define OV5640_CMX3 0x5383 -#define OV5640_CMX4 0x5384 -#define OV5640_CMX5 0x5385 -#define OV5640_CMX6 0x5386 -#define OV5640_CMX7 0x5387 -#define OV5640_CMX8 0x5388 -#define OV5640_CMX9 0x5389 -#define OV5640_CMXSIGN_HI 0x538a -#define OV5640_CMXSIGN_LO 0x538b - -/* Gamma Control */ -#define OV5640_GAMMA_CTRL00 0x5480 -#define OV5640_YST00 0x5481 -#define OV5640_YST01 0x5482 -#define OV5640_YST02 0x5483 -#define OV5640_YST03 0x5484 -#define OV5640_YST04 0x5485 -#define OV5640_YST05 0x5486 -#define OV5640_YST06 0x5487 -#define OV5640_YST07 0x5488 -#define OV5640_YST08 0x5489 -#define OV5640_YST09 0x548a -#define OV5640_YST0A 0x548b -#define OV5640_YST0B 0x548c -#define OV5640_YST0C 0x548d -#define OV5640_YST0D 0x548e -#define OV5640_YST0E 0x548f -#define OV5640_YST0F 0x5490 - -/* SDE Control */ -#define OV5640_SDE_CTRL_0 0x5580 -#define OV5640_SDE_CTRL_1 0x5581 -#define OV5640_SDE_CTRL_2 0x5582 -#define OV5640_SDE_CTRL_3 0x5583 -#define OV5640_SDE_CTRL_4 0x5584 -#define OV5640_SDE_CTRL_5 0x5585 -#define OV5640_SDE_CTRL_6 0x5586 -#define OV5640_SDE_CTRL_7 0x5587 -#define OV5640_SDE_CTRL_8 0x5588 -#define OV5640_SDE_CTRL_9 0x5589 -#define OV5640_SDE_CTRL_10 0x558a -#define OV5640_SDE_CTRL_11 0x558b -#define OV5640_SDE_CTRL_12 0x558c - -/* LENC Control */ -#define OV5640_GMTRX00 0x5800 -#define OV5640_GMTRX01 0x5801 -#define OV5640_GMTRX02 0x5802 -#define OV5640_GMTRX03 0x5803 -#define OV5640_GMTRX04 0x5804 -#define OV5640_GMTRX05 0x5805 -#define OV5640_GMTRX10 0x5806 -#define OV5640_GMTRX11 0x5807 -#define OV5640_GMTRX12 0x5808 -#define OV5640_GMTRX13 0x5809 -#define OV5640_GMTRX14 0x580a -#define OV5640_GMTRX15 0x580b -#define OV5640_GMTRX20 0x580c -#define OV5640_GMTRX21 0x580d -#define OV5640_GMTRX22 0x580e -#define OV5640_GMTRX23 0x580f -#define OV5640_GMTRX24 0x5810 -#define OV5640_GMTRX25 0x5811 -#define OV5640_GMTRX30 0x5812 -#define OV5640_GMTRX31 0x5813 -#define OV5640_GMTRX32 0x5814 -#define OV5640_GMTRX33 0x5815 -#define OV5640_GMTRX34 0x5816 -#define OV5640_GMTRX35 0x5817 -#define OV5640_GMTRX40 0x5818 -#define OV5640_GMTRX41 0x5819 -#define OV5640_GMTRX42 0x581a -#define OV5640_GMTRX43 0x581b -#define OV5640_GMTRX44 0x581c -#define OV5640_GMTRX45 0x581d -#define OV5640_GMTRX50 0x581e -#define OV5640_GMTRX51 0x581f -#define OV5640_GMTRX52 0x5820 -#define OV5640_GMTRX53 0x5821 -#define OV5640_GMTRX54 0x5822 -#define OV5640_GMTRX55 0x5823 -#define OV5640_BRMATRX00 0x5824 -#define OV5640_BRMATRX01 0x5825 -#define OV5640_BRMATRX02 0x5826 -#define OV5640_BRMATRX03 0x5827 -#define OV5640_BRMATRX04 0x5828 -#define OV5640_BRMATRX05 0x5829 -#define OV5640_BRMATRX06 0x582a -#define OV5640_BRMATRX07 0x582b -#define OV5640_BRMATRX08 0x582c -#define OV5640_BRMATRX09 0x582d -#define OV5640_BRMATRX20 0x582e -#define OV5640_BRMATRX21 0x582f -#define OV5640_BRMATRX22 0x5830 -#define OV5640_BRMATRX23 0x5831 -#define OV5640_BRMATRX24 0x5832 -#define OV5640_BRMATRX30 0x5833 -#define OV5640_BRMATRX31 0x5834 -#define OV5640_BRMATRX32 0x5835 -#define OV5640_BRMATRX33 0x5836 -#define OV5640_BRMATRX34 0x5837 -#define OV5640_BRMATRX40 0x5838 -#define OV5640_BRMATRX41 0x5839 -#define OV5640_BRMATRX42 0x583a -#define OV5640_BRMATRX43 0x583b -#define OV5640_BRMATRX44 0x583c -#define OV5640_LENC_BR_OFFSET 0x583d - -#define OV5640_MAX_WIDTH 640 -#define OV5640_MAX_HEIGHT 480 - -/* Misc. structures */ struct ov5640_reg { - u16 reg; - u8 val; + u16 addr; + u16 val; }; -struct ov5640_priv { - struct v4l2_subdev subdev; +#define OV5640_TABLE_WAIT_MS 0 +#define OV5640_TABLE_END 1 - int ident; - u16 chip_id; - u8 revision; - u8 manid; - u8 smiaver; +static struct ov5640_reg mode_2592x1944[] = { + /* PLL Control MIPI bit rate/lane = 672MHz, 16-bit mode. + * Output size: 2608x1948 (0, 0) - (2623, 1951), + * Line Length = 2844, Frame Length = 1968 + */ + {0x3103, 0x11}, + {0x3008, 0x82}, + {OV5640_TABLE_WAIT_MS, 5}, + {0x3008, 0x42}, + {0x3103, 0x03}, + {0x3017, 0x00}, + {0x3018, 0x00}, + {0x3034, 0x18}, + {0x3035, 0x11}, + {0x3036, 0x7d}, + {0x3037, 0x13}, + {0x3108, 0x01}, + {0x3630, 0x36}, + {0x3631, 0x0e}, + {0x3632, 0xe2}, + {0x3633, 0x12}, + {0x3621, 0xe0}, + {0x3704, 0xa0}, + {0x3703, 0x5a}, + {0x3715, 0x78}, + {0x3717, 0x01}, + {0x370b, 0x60}, + {0x3705, 0x1a}, + {0x3905, 0x02}, + {0x3906, 0x10}, + {0x3901, 0x0a}, + {0x3731, 0x12}, + {0x3600, 0x08}, + {0x3601, 0x33}, + {0x302d, 0x60}, + {0x3620, 0x52}, + {0x371b, 0x20}, + {0x471c, 0x50}, + {0x3a13, 0x43}, + {0x3a18, 0x00}, + {0x3a19, 0xf8}, + {0x3635, 0x13}, + {0x3636, 0x03}, + {0x3634, 0x40}, + {0x3622, 0x01}, + {0x3c01, 0x34}, + {0x3c04, 0x28}, + {0x3c05, 0x98}, + {0x3c06, 0x00}, + {0x3c07, 0x07}, + {0x3c08, 0x00}, + {0x3c09, 0x1c}, + {0x3c0a, 0x9c}, + {0x3c0b, 0x40}, + {0x3820, 0x40}, + {0x3821, 0x06}, + {0x3814, 0x11}, + {0x3815, 0x11}, + {0x3800, 0x00}, + {0x3801, 0x00}, + {0x3802, 0x00}, + {0x3803, 0x00}, + {0x3804, 0x0a}, + {0x3805, 0x3f}, + {0x3806, 0x07}, + {0x3807, 0x9f}, + {0x3808, 0x0a}, + {0x3809, 0x30}, + {0x380a, 0x07}, + {0x380b, 0x9c}, + {0x380c, 0x0b}, + {0x380d, 0x1c}, + {0x380e, 0x07}, + {0x380f, 0xb0}, + {0x3810, 0x00}, + {0x3811, 0x08}, + {0x3812, 0x00}, + {0x3813, 0x02}, + {0x3618, 0x04}, + {0x3612, 0x2b}, + {0x3708, 0x64}, + {0x3709, 0x12}, + {0x370c, 0x00}, + {0x3a02, 0x07}, + {0x3a03, 0xb0}, + {0x3a08, 0x01}, + {0x3a09, 0x27}, + {0x3a0a, 0x00}, + {0x3a0b, 0xf6}, + {0x3a0e, 0x06}, + {0x3a0d, 0x08}, + {0x3a14, 0x07}, + {0x3a15, 0xb0}, + {0x4001, 0x02}, + {0x4004, 0x06}, + {0x3000, 0x00}, + {0x3002, 0x1c}, + {0x3004, 0xff}, + {0x3006, 0xc3}, + {0x300e, 0x45}, + {0x302e, 0x08}, + {0x4300, 0x32}, + {0x4800, 0x24}, + {0x4837, 0x0a}, + {0x501f, 0x00}, + {0x440e, 0x00}, + {0x5000, 0xa7}, + {0x5001, 0x83}, + {0x5180, 0xff}, + {0x5181, 0xf2}, + {0x5182, 0x00}, + {0x5183, 0x14}, + {0x5184, 0x25}, + {0x5185, 0x24}, + {0x5186, 0x09}, + {0x5187, 0x09}, + {0x5188, 0x09}, + {0x5189, 0x75}, + {0x518a, 0x54}, + {0x518b, 0xe0}, + {0x518c, 0xb2}, + {0x518d, 0x42}, + {0x518e, 0x3d}, + {0x518f, 0x56}, + {0x5190, 0x46}, + {0x5191, 0xf8}, + {0x5192, 0x04}, + {0x5193, 0x70}, + {0x5194, 0xf0}, + {0x5195, 0xf0}, + {0x5196, 0x03}, + {0x5197, 0x01}, + {0x5198, 0x04}, + {0x5199, 0x12}, + {0x519a, 0x04}, + {0x519b, 0x00}, + {0x519c, 0x06}, + {0x519d, 0x82}, + {0x519e, 0x38}, + {0x5381, 0x1e}, + {0x5382, 0x5b}, + {0x5383, 0x08}, + {0x5384, 0x0a}, + {0x5385, 0x7e}, + {0x5386, 0x88}, + {0x5387, 0x7c}, + {0x5388, 0x6c}, + {0x5389, 0x10}, + {0x538a, 0x01}, + {0x538b, 0x98}, + {0x5300, 0x08}, + {0x5301, 0x30}, + {0x5302, 0x10}, + {0x5303, 0x00}, + {0x5304, 0x08}, + {0x5305, 0x30}, + {0x5306, 0x08}, + {0x5307, 0x16}, + {0x5309, 0x08}, + {0x530a, 0x30}, + {0x530b, 0x04}, + {0x530c, 0x06}, + {0x5480, 0x01}, + {0x5481, 0x08}, + {0x5482, 0x14}, + {0x5483, 0x28}, + {0x5484, 0x51}, + {0x5485, 0x65}, + {0x5486, 0x71}, + {0x5487, 0x7d}, + {0x5488, 0x87}, + {0x5489, 0x91}, + {0x548a, 0x9a}, + {0x548b, 0xaa}, + {0x548c, 0xb8}, + {0x548d, 0xcd}, + {0x548e, 0xdd}, + {0x548f, 0xea}, + {0x5490, 0x1d}, + {0x5580, 0x02}, + {0x5583, 0x40}, + {0x5584, 0x10}, + {0x5589, 0x10}, + {0x558a, 0x00}, + {0x558b, 0xf8}, + {0x5800, 0x23}, + {0x5801, 0x14}, + {0x5802, 0x0f}, + {0x5803, 0x0f}, + {0x5804, 0x12}, + {0x5805, 0x26}, + {0x5806, 0x0c}, + {0x5807, 0x08}, + {0x5808, 0x05}, + {0x5809, 0x05}, + {0x580a, 0x08}, + {0x580b, 0x0d}, + {0x580c, 0x08}, + {0x580d, 0x03}, + {0x580e, 0x00}, + {0x580f, 0x00}, + {0x5810, 0x03}, + {0x5811, 0x09}, + {0x5812, 0x07}, + {0x5813, 0x03}, + {0x5814, 0x00}, + {0x5815, 0x01}, + {0x5816, 0x03}, + {0x5817, 0x08}, + {0x5818, 0x0d}, + {0x5819, 0x08}, + {0x581a, 0x05}, + {0x581b, 0x06}, + {0x581c, 0x08}, + {0x581d, 0x0e}, + {0x581e, 0x29}, + {0x581f, 0x17}, + {0x5820, 0x11}, + {0x5821, 0x11}, + {0x5822, 0x15}, + {0x5823, 0x28}, + {0x5824, 0x46}, + {0x5825, 0x26}, + {0x5826, 0x08}, + {0x5827, 0x26}, + {0x5828, 0x64}, + {0x5829, 0x26}, + {0x582a, 0x24}, + {0x582b, 0x22}, + {0x582c, 0x24}, + {0x582d, 0x24}, + {0x582e, 0x06}, + {0x582f, 0x22}, + {0x5830, 0x40}, + {0x5831, 0x42}, + {0x5832, 0x24}, + {0x5833, 0x26}, + {0x5834, 0x24}, + {0x5835, 0x22}, + {0x5836, 0x22}, + {0x5837, 0x26}, + {0x5838, 0x44}, + {0x5839, 0x24}, + {0x583a, 0x26}, + {0x583b, 0x28}, + {0x583c, 0x42}, + {0x583d, 0xce}, + {0x5025, 0x00}, + {0x3a0f, 0x30}, + {0x3a10, 0x28}, + {0x3a1b, 0x30}, + {0x3a1e, 0x26}, + {0x3a11, 0x60}, + {0x3a1f, 0x14}, + {0x3008, 0x02}, + {OV5640_TABLE_END, 0x0000} +}; - bool flag_vflip; - bool flag_hflip; +static struct ov5640_reg mode_1920x1080[] = { + /* PLL Control MIPI bit rate/lane = 672MHz, 16-bit mode. + * Output size: 1936x1096 (336, 426) - (2287, 1529), + * Line Length = 2500, Frame Length = 1120. + */ + {0x3103, 0x11}, + {0x3008, 0x82}, + {OV5640_TABLE_WAIT_MS, 5}, + {0x3008, 0x42}, + {0x3103, 0x03}, + {0x3017, 0x00}, + {0x3018, 0x00}, + {0x3034, 0x18}, + {0x3035, 0x11}, + {0x3036, 0x54}, + {0x3037, 0x13}, + {0x3108, 0x01}, + {0x3630, 0x36}, + {0x3631, 0x0e}, + {0x3632, 0xe2}, + {0x3633, 0x12}, + {0x3621, 0xe0}, + {0x3704, 0xa0}, + {0x3703, 0x5a}, + {0x3715, 0x78}, + {0x3717, 0x01}, + {0x370b, 0x60}, + {0x3705, 0x1a}, + {0x3905, 0x02}, + {0x3906, 0x10}, + {0x3901, 0x0a}, + {0x3731, 0x12}, + {0x3600, 0x08}, + {0x3601, 0x33}, + {0x302d, 0x60}, + {0x3620, 0x52}, + {0x371b, 0x20}, + {0x471c, 0x50}, + {0x3a13, 0x43}, + {0x3a18, 0x00}, + {0x3a19, 0xf8}, + {0x3635, 0x13}, + {0x3636, 0x03}, + {0x3634, 0x40}, + {0x3622, 0x01}, + {0x3c01, 0x34}, + {0x3c04, 0x28}, + {0x3c05, 0x98}, + {0x3c06, 0x00}, + {0x3c07, 0x07}, + {0x3c08, 0x00}, + {0x3c09, 0x1c}, + {0x3c0a, 0x9c}, + {0x3c0b, 0x40}, + {0x3820, 0x40}, + {0x3821, 0x06}, + {0x3814, 0x11}, + {0x3815, 0x11}, + {0x3800, 0x01}, + {0x3801, 0x50}, + {0x3802, 0x01}, + {0x3803, 0xaa}, + {0x3804, 0x08}, + {0x3805, 0xef}, + {0x3806, 0x05}, + {0x3807, 0xf9}, + {0x3808, 0x07}, + {0x3809, 0x90}, + {0x380a, 0x04}, + {0x380b, 0x48}, + {0x380c, 0x09}, + {0x380d, 0xc4}, + {0x380e, 0x04}, + {0x380f, 0x60}, + {0x3810, 0x00}, + {0x3811, 0x08}, + {0x3812, 0x00}, + {0x3813, 0x04}, + {0x3618, 0x04}, + {0x3612, 0x2b}, + {0x3708, 0x64}, + {0x3709, 0x12}, + {0x370c, 0x00}, + {0x3a02, 0x04}, + {0x3a03, 0x60}, + {0x3a08, 0x01}, + {0x3a09, 0x50}, + {0x3a0a, 0x01}, + {0x3a0b, 0x18}, + {0x3a0e, 0x03}, + {0x3a0d, 0x04}, + {0x3a14, 0x04}, + {0x3a15, 0x60}, + {0x4001, 0x02}, + {0x4004, 0x06}, + {0x3000, 0x00}, + {0x3002, 0x1c}, + {0x3004, 0xff}, + {0x3006, 0xc3}, + {0x300e, 0x45}, + {0x302e, 0x08}, + {0x4300, 0x32}, + {0x501f, 0x00}, + {0x4713, 0x02}, + {0x4407, 0x04}, + {0x440e, 0x00}, + {0x460b, 0x37}, + {0x460c, 0x20}, + {0x4800, 0x24}, + {0x4837, 0x0a}, + {0x3824, 0x04}, + {0x5000, 0xa7}, + {0x5001, 0x83}, + {0x5180, 0xff}, + {0x5181, 0xf2}, + {0x5182, 0x00}, + {0x5183, 0x14}, + {0x5184, 0x25}, + {0x5185, 0x24}, + {0x5186, 0x09}, + {0x5187, 0x09}, + {0x5188, 0x09}, + {0x5189, 0x75}, + {0x518a, 0x54}, + {0x518b, 0xe0}, + {0x518c, 0xb2}, + {0x518d, 0x42}, + {0x518e, 0x3d}, + {0x518f, 0x56}, + {0x5190, 0x46}, + {0x5191, 0xf8}, + {0x5192, 0x04}, + {0x5193, 0x70}, + {0x5194, 0xf0}, + {0x5195, 0xf0}, + {0x5196, 0x03}, + {0x5197, 0x01}, + {0x5198, 0x04}, + {0x5199, 0x12}, + {0x519a, 0x04}, + {0x519b, 0x00}, + {0x519c, 0x06}, + {0x519d, 0x82}, + {0x519e, 0x38}, + {0x5381, 0x1e}, + {0x5382, 0x5b}, + {0x5383, 0x08}, + {0x5384, 0x0a}, + {0x5385, 0x7e}, + {0x5386, 0x88}, + {0x5387, 0x7c}, + {0x5388, 0x6c}, + {0x5389, 0x10}, + {0x538a, 0x01}, + {0x538b, 0x98}, + {0x5300, 0x08}, + {0x5301, 0x30}, + {0x5302, 0x10}, + {0x5303, 0x00}, + {0x5304, 0x08}, + {0x5305, 0x30}, + {0x5306, 0x08}, + {0x5307, 0x16}, + {0x5309, 0x08}, + {0x530a, 0x30}, + {0x530b, 0x04}, + {0x530c, 0x06}, + {0x5480, 0x01}, + {0x5481, 0x08}, + {0x5482, 0x14}, + {0x5483, 0x28}, + {0x5484, 0x51}, + {0x5485, 0x65}, + {0x5486, 0x71}, + {0x5487, 0x7d}, + + {0x5488, 0x87}, + {0x5489, 0x91}, + {0x548a, 0x9a}, + {0x548b, 0xaa}, + {0x548c, 0xb8}, + {0x548d, 0xcd}, + {0x548e, 0xdd}, + {0x548f, 0xea}, + {0x5490, 0x1d}, + {0x5580, 0x02}, + {0x5583, 0x40}, + {0x5584, 0x10}, + {0x5589, 0x10}, + {0x558a, 0x00}, + {0x558b, 0xf8}, + {0x5800, 0x23}, + {0x5801, 0x14}, + {0x5802, 0x0f}, + {0x5803, 0x0f}, + {0x5804, 0x12}, + {0x5805, 0x26}, + {0x5806, 0x0c}, + {0x5807, 0x08}, + {0x5808, 0x05}, + {0x5809, 0x05}, + {0x580a, 0x08}, + {0x580b, 0x0d}, + {0x580c, 0x08}, + {0x580d, 0x03}, + {0x580e, 0x00}, + {0x580f, 0x00}, + {0x5810, 0x03}, + {0x5811, 0x09}, + {0x5812, 0x07}, + {0x5813, 0x03}, + {0x5814, 0x00}, + {0x5815, 0x01}, + {0x5816, 0x03}, + {0x5817, 0x08}, + {0x5818, 0x0d}, + {0x5819, 0x08}, + {0x581a, 0x05}, + {0x581b, 0x06}, + {0x581c, 0x08}, + {0x581d, 0x0e}, + {0x581e, 0x29}, + {0x581f, 0x17}, + {0x5820, 0x11}, + {0x5821, 0x11}, + {0x5822, 0x15}, + {0x5823, 0x28}, + {0x5824, 0x46}, + {0x5825, 0x26}, + {0x5826, 0x08}, + {0x5827, 0x26}, + {0x5828, 0x64}, + {0x5829, 0x26}, + {0x582a, 0x24}, + {0x582b, 0x22}, + {0x582c, 0x24}, + {0x582d, 0x24}, + {0x582e, 0x06}, + {0x582f, 0x22}, + {0x5830, 0x40}, + {0x5831, 0x42}, + {0x5832, 0x24}, + {0x5833, 0x26}, + {0x5834, 0x24}, + {0x5835, 0x22}, + {0x5836, 0x22}, + {0x5837, 0x26}, + {0x5838, 0x44}, + {0x5839, 0x24}, + {0x583a, 0x26}, + {0x583b, 0x28}, + {0x583c, 0x42}, + {0x583d, 0xce}, + {0x5025, 0x00}, + {0x3a0f, 0x30}, + {0x3a10, 0x28}, + {0x3a1b, 0x30}, + {0x3a1e, 0x26}, + {0x3a11, 0x60}, + {0x3a1f, 0x14}, + {0x3008, 0x02}, + {OV5640_TABLE_END, 0x0000} +}; - /* For suspend/resume. */ - struct v4l2_mbus_framefmt current_mf; - bool current_enable; +static struct ov5640_reg mode_1296x972[] = { + /* PLL Control MIPI bit rate/lane = 448MHz, 16-bit mode. + * Output size: 1304x972 (0, 0) - (2623, 1951), + * Line Length = 1886, Frame Length = 990. + */ + {0x3103, 0x11}, + {0x3008, 0x82}, + {OV5640_TABLE_WAIT_MS, 5}, + {0x3008, 0x42}, + {0x3103, 0x03}, + {0x3017, 0x00}, + {0x3018, 0x00}, + {0x3034, 0x18}, + {0x3035, 0x21}, + {0x3036, 0x70}, + {0x3037, 0x13}, + {0x3108, 0x01}, + {0x3630, 0x36}, + {0x3631, 0x0e}, + {0x3632, 0xe2}, + {0x3633, 0x12}, + {0x3621, 0xe0}, + {0x3704, 0xa0}, + {0x3703, 0x5a}, + {0x3715, 0x78}, + {0x3717, 0x01}, + {0x370b, 0x60}, + {0x3705, 0x1a}, + {0x3905, 0x02}, + {0x3906, 0x10}, + {0x3901, 0x0a}, + {0x3731, 0x12}, + {0x3600, 0x08}, + {0x3601, 0x33}, + {0x302d, 0x60}, + {0x3620, 0x52}, + {0x371b, 0x20}, + {0x471c, 0x50}, + {0x3a13, 0x43}, + {0x3a18, 0x00}, + {0x3a19, 0xf8}, + {0x3635, 0x13}, + {0x3636, 0x03}, + {0x3634, 0x40}, + {0x3622, 0x01}, + {0x3c01, 0x34}, + {0x3c04, 0x28}, + {0x3c05, 0x98}, + {0x3c06, 0x00}, + {0x3c07, 0x07}, + {0x3c08, 0x00}, + {0x3c09, 0x1c}, + {0x3c0a, 0x9c}, + {0x3c0b, 0x40}, + {0x3820, 0x41}, + {0x3821, 0x07}, + {0x3814, 0x31}, + {0x3815, 0x31}, + {0x3800, 0x00}, + {0x3801, 0x00}, + {0x3802, 0x00}, + {0x3803, 0x00}, + {0x3804, 0x0a}, + {0x3805, 0x3f}, + {0x3806, 0x07}, + {0x3807, 0x9f}, + {0x3808, 0x05}, + {0x3809, 0x18}, + {0x380a, 0x03}, + {0x380b, 0xcc}, + {0x380c, 0x07}, + {0x380d, 0x5e}, + {0x380e, 0x03}, + {0x380f, 0xde}, + {0x3810, 0x00}, + {0x3811, 0x06}, + {0x3812, 0x00}, + {0x3813, 0x02}, + {0x3618, 0x00}, + {0x3612, 0x29}, + {0x3708, 0x62}, + {0x3709, 0x52}, + {0x370c, 0x03}, + {0x3a02, 0x03}, + {0x3a03, 0xd8}, + {0x3a08, 0x01}, + {0x3a09, 0x27}, + {0x3a0a, 0x00}, + {0x3a0b, 0xf6}, + {0x3a0e, 0x03}, + {0x3a0d, 0x04}, + {0x3a14, 0x03}, + {0x3a15, 0xd8}, + {0x4001, 0x02}, + {0x4004, 0x02}, + {0x3000, 0x00}, + {0x3002, 0x1c}, + {0x3004, 0xff}, + {0x3006, 0xc3}, + {0x300e, 0x45}, + {0x302e, 0x08}, + {0x4300, 0x32}, + {0x501f, 0x00}, + {0x4713, 0x02}, + {0x4407, 0x04}, + {0x440e, 0x00}, + {0x460b, 0x37}, + {0x460c, 0x20}, + {0x4800, 0x24}, + {0x4837, 0x10}, + {0x3824, 0x04}, + {0x5000, 0xa7}, + {0x5001, 0x83}, + {0x5180, 0xff}, + {0x5181, 0xf2}, + {0x5182, 0x00}, + {0x5183, 0x14}, + {0x5184, 0x25}, + {0x5185, 0x24}, + {0x5186, 0x09}, + {0x5187, 0x09}, + {0x5188, 0x09}, + {0x5189, 0x75}, + {0x518a, 0x54}, + {0x518b, 0xe0}, + {0x518c, 0xb2}, + {0x518d, 0x42}, + {0x518e, 0x3d}, + {0x518f, 0x56}, + {0x5190, 0x46}, + {0x5191, 0xf8}, + {0x5192, 0x04}, + {0x5193, 0x70}, + {0x5194, 0xf0}, + {0x5195, 0xf0}, + {0x5196, 0x03}, + {0x5197, 0x01}, + {0x5198, 0x04}, + {0x5199, 0x12}, + {0x519a, 0x04}, + {0x519b, 0x00}, + {0x519c, 0x06}, + {0x519d, 0x82}, + {0x519e, 0x38}, + {0x5381, 0x1e}, + {0x5382, 0x5b}, + {0x5383, 0x08}, + {0x5384, 0x0a}, + {0x5385, 0x7e}, + {0x5386, 0x88}, + {0x5387, 0x7c}, + {0x5388, 0x6c}, + {0x5389, 0x10}, + {0x538a, 0x01}, + {0x538b, 0x98}, + {0x5300, 0x08}, + {0x5301, 0x30}, + {0x5302, 0x10}, + {0x5303, 0x00}, + {0x5304, 0x08}, + {0x5305, 0x30}, + {0x5306, 0x08}, + {0x5307, 0x16}, + {0x5309, 0x08}, + {0x530a, 0x30}, + {0x530b, 0x04}, + {0x530c, 0x06}, + {0x5480, 0x01}, + {0x5481, 0x08}, + {0x5482, 0x14}, + {0x5483, 0x28}, + {0x5484, 0x51}, + {0x5485, 0x65}, + {0x5486, 0x71}, + {0x5487, 0x7d}, + {0x5488, 0x87}, + {0x5489, 0x91}, + {0x548a, 0x9a}, + {0x548b, 0xaa}, + {0x548c, 0xb8}, + {0x548d, 0xcd}, + {0x548e, 0xdd}, + {0x548f, 0xea}, + {0x5490, 0x1d}, + {0x5580, 0x02}, + {0x5583, 0x40}, + {0x5584, 0x10}, + {0x5589, 0x10}, + {0x558a, 0x00}, + {0x558b, 0xf8}, + {0x5800, 0x23}, + {0x5801, 0x14}, + {0x5802, 0x0f}, + {0x5803, 0x0f}, + {0x5804, 0x12}, + {0x5805, 0x26}, + {0x5806, 0x0c}, + {0x5807, 0x08}, + {0x5808, 0x05}, + {0x5809, 0x05}, + {0x580a, 0x08}, + {0x580b, 0x0d}, + {0x580c, 0x08}, + {0x580d, 0x03}, + {0x580e, 0x00}, + {0x580f, 0x00}, + {0x5810, 0x03}, + {0x5811, 0x09}, + {0x5812, 0x07}, + {0x5813, 0x03}, + {0x5814, 0x00}, + {0x5815, 0x01}, + {0x5816, 0x03}, + {0x5817, 0x08}, + {0x5818, 0x0d}, + {0x5819, 0x08}, + {0x581a, 0x05}, + {0x581b, 0x06}, + {0x581c, 0x08}, + {0x581d, 0x0e}, + {0x581e, 0x29}, + {0x581f, 0x17}, + {0x5820, 0x11}, + {0x5821, 0x11}, + {0x5822, 0x15}, + {0x5823, 0x28}, + {0x5824, 0x46}, + {0x5825, 0x26}, + {0x5826, 0x08}, + {0x5827, 0x26}, + {0x5828, 0x64}, + {0x5829, 0x26}, + {0x582a, 0x24}, + {0x582b, 0x22}, + {0x582c, 0x24}, + {0x582d, 0x24}, + {0x582e, 0x06}, + {0x582f, 0x22}, + {0x5830, 0x40}, + {0x5831, 0x42}, + {0x5832, 0x24}, + {0x5833, 0x26}, + {0x5834, 0x24}, + {0x5835, 0x22}, + {0x5836, 0x22}, + {0x5837, 0x26}, + {0x5838, 0x44}, + {0x5839, 0x24}, + {0x583a, 0x26}, + {0x583b, 0x28}, + {0x583c, 0x42}, + {0x583d, 0xce}, + {0x5025, 0x00}, + {0x3a0f, 0x30}, + {0x3a10, 0x28}, + {0x3a1b, 0x30}, + {0x3a1e, 0x26}, + {0x3a11, 0x60}, + {0x3a1f, 0x14}, + {0x3008, 0x02}, + {OV5640_TABLE_END, 0x0000} }; -static const struct ov5640_reg ov5640_defaults[] = { - { OV5640_SCCB_SYSTEM_CTRL1, 0x11}, - { OV5640_SYSTEM_CTRL, 0x82}, - { OV5640_SYSTEM_CTRL, 0x42}, - { OV5640_SCCB_SYSTEM_CTRL1, 0x03}, - { OV5640_PAD_OUTPUT_ENABLE01, 0x00}, - { OV5640_PAD_OUTPUT_ENABLE02, 0x00}, - { OV5640_SC_PLL_CTRL0, 0x18}, - { OV5640_SC_PLL_CTRL1, 0x14}, - { OV5640_SC_PLL_CTRL2, 0x38}, - { OV5640_SC_PLL_CTRL3, 0x13}, - { 0x4800, 0x24}, /* noncontinuous clock */ - { OV5640_SYSTEM_ROOT_DIVIDER, 0x01}, - { 0x3630, 0x36}, - { 0x3631, 0x0e}, - { 0x3632, 0xe2}, - { 0x3633, 0x12}, - { 0x3621, 0xe0}, - { 0x3704, 0xa0}, - { 0x3703, 0x5a}, - { 0x3715, 0x78}, - { 0x3717, 0x01}, - { 0x370b, 0x60}, - { 0x3705, 0x1a}, - { 0x3905, 0x02}, - { 0x3906, 0x10}, - { 0x3901, 0x0a}, - { 0x3731, 0x12}, - { 0x3600, 0x08}, - { 0x3601, 0x33}, - { 0x302d, 0x60}, - { 0x3620, 0x52}, - { 0x371b, 0x20}, - { 0x471c, 0x50}, - { 0x3a13, 0x43}, - { 0x3a18, 0x00}, - { 0x3a19, 0xf8}, - { 0x3635, 0x13}, - { 0x3636, 0x03}, - { 0x3634, 0x40}, - { 0x3622, 0x01}, - { 0x3c01, 0x34}, - { 0x3c04, 0x28}, - { 0x3c05, 0x98}, - { 0x3c06, 0x00}, - { 0x3c07, 0x08}, - { 0x3c08, 0x00}, - { 0x3c09, 0x1c}, - { 0x3c0a, 0x9c}, - { 0x3c0b, 0x40}, - { OV5640_TIMING_TC_REG20, 0x41}, - { OV5640_TIMING_TC_REG21, 0x01}, - { 0x3814, 0x31}, - { 0x3815, 0x31}, - { 0x3800, 0x00}, - { 0x3801, 0x00}, - { 0x3802, 0x00}, - { 0x3803, 0x04}, - { 0x3804, 0x0a}, - { 0x3805, 0x3f}, - { 0x3806, 0x07}, - { 0x3807, 0x9b}, - { 0x3808, 0x02}, - { 0x3809, 0x80}, - { 0x380a, 0x01}, - { 0x380b, 0xe0}, - { 0x380c, 0x07}, - { 0x380d, 0x68}, - { 0x380e, 0x03}, - { 0x380f, 0xd8}, - { 0x3810, 0x00}, - { 0x3811, 0x10}, - { 0x3812, 0x00}, - { 0x3813, 0x06}, - { 0x3618, 0x00}, - { 0x3612, 0x29}, - { 0x3708, 0x64}, - { 0x3709, 0x52}, - { 0x370c, 0x03}, +static struct ov5640_reg mode_640x480[] = { + {0x3103, 0x11}, + {0x3008, 0x82}, + {OV5640_TABLE_WAIT_MS, 5}, + {0x3008, 0x42}, + {0x3103, 0x03}, + {0x3017, 0x00}, + {0x3018, 0x00}, + {0x3034, 0x18}, + {0x3035, 0x14}, + {0x3036, 0x70}, + {0x3037, 0x13}, + {0x4800, 0x24}, /* noncontinuous clock */ + {0x3108, 0x01}, + {0x3630, 0x36}, + {0x3631, 0x0e}, + {0x3632, 0xe2}, + {0x3633, 0x12}, + {0x3621, 0xe0}, + {0x3704, 0xa0}, + {0x3703, 0x5a}, + {0x3715, 0x78}, + {0x3717, 0x01}, + {0x370b, 0x60}, + {0x3705, 0x1a}, + {0x3905, 0x02}, + {0x3906, 0x10}, + {0x3901, 0x0a}, + {0x3731, 0x12}, + {0x3600, 0x08}, + {0x3601, 0x33}, + {0x302d, 0x60}, + {0x3620, 0x52}, + {0x371b, 0x20}, + {0x471c, 0x50}, + {0x3a13, 0x43}, + {0x3a18, 0x00}, + {0x3a19, 0xf8}, + {0x3635, 0x13}, + {0x3636, 0x03}, + {0x3634, 0x40}, + {0x3622, 0x01}, + {0x3c01, 0x34}, + {0x3c04, 0x28}, + {0x3c05, 0x98}, + {0x3c06, 0x00}, + {0x3c07, 0x08}, + {0x3c08, 0x00}, + {0x3c09, 0x1c}, + {0x3c0a, 0x9c}, + {0x3c0b, 0x40}, + {0x3820, 0x41}, + {0x3821, 0x07}, + {0x3814, 0x31}, + {0x3815, 0x31}, + {0x3800, 0x00}, + {0x3801, 0x00}, + {0x3802, 0x00}, + {0x3803, 0x04}, + {0x3804, 0x0a}, + {0x3805, 0x3f}, + {0x3806, 0x07}, + {0x3807, 0x9b}, + {0x3808, 0x02}, + {0x3809, 0x80}, + {0x380a, 0x01}, + {0x380b, 0xe0}, + {0x380c, 0x07}, + {0x380d, 0x68}, + {0x380e, 0x03}, + {0x380f, 0xd8}, + {0x3810, 0x00}, + {0x3811, 0x10}, + {0x3812, 0x00}, + {0x3813, 0x06}, + {0x3618, 0x00}, + {0x3612, 0x29}, + {0x3708, 0x64}, + {0x3709, 0x52}, + {0x370c, 0x03}, /* AEC/AGC Power Down Domain Control */ - { OV5640_AEC_MAX_EXPO_60HZ_HI, 0x03}, - { OV5640_AEC_MAX_EXPO_60HZ_LO, 0xd8}, - { OV5640_AEC_B50_STEP_HI, 0x01}, - { OV5640_AEC_B50_STEP_LO, 0x27}, - { OV5640_AEC_B60_STEP_HI, 0x00}, - { OV5640_AEC_B60_STEP_LO, 0xf6}, - { OV5640_AEC_CTRL0E, 0x03}, - { OV5640_AEC_CTRL0D, 0x04}, - { OV5640_AEC_MAX_EXPO_50HZ_HI, 0x03}, - { OV5640_AEC_MAX_EXPO_50HZ_LO, 0xd8}, - - { 0x4001, 0x02}, - { 0x4004, 0x02}, - { 0x3000, 0x00}, - { 0x3002, 0x1c}, - { 0x3004, 0xff}, - { 0x3006, 0xc3}, - { 0x300e, 0x45}, - { 0x302e, 0x08}, + {0x3a02, 0x03}, + {0x3a03, 0xd8}, + {0x3a08, 0x01}, + {0x3a09, 0x27}, + {0x3a0a, 0x00}, + {0x3a0b, 0xf6}, + {0x3a0e, 0x03}, + {0x3a0d, 0x04}, + {0x3a14, 0x03}, + {0x3a15, 0xd8}, + + {0x4001, 0x02}, + {0x4004, 0x02}, + {0x3000, 0x00}, + {0x3002, 0x1c}, + {0x3004, 0xff}, + {0x3006, 0xc3}, + {0x300e, 0x45}, + {0x302e, 0x08}, /* org:30 bit[3:0] 0x0:YUYV 0x1:YVYU 0x2:UYVY 0x3:VYUY 0xF:UYVY 0x4~0xE:Not-allowed */ - { 0x4300, 0x32}, - { 0x501f, 0x00}, - { 0x4713, 0x03}, - { 0x4407, 0x04}, - { 0x440e, 0x00}, - { 0x460b, 0x35}, - { 0x460c, 0x22}, - { 0x4837, 0x44}, - { 0x3824, 0x02}, - { 0x5000, 0xa7}, - { 0x5001, 0xa3}, + {0x4300, 0x32}, + {0x501f, 0x00}, + {0x4713, 0x03}, + {0x4407, 0x04}, + {0x440e, 0x00}, + {0x460b, 0x35}, + {0x460c, 0x22}, + {0x4837, 0x44}, + {0x3824, 0x02}, + {0x5000, 0xa7}, + {0x5001, 0xa3}, /* AWB Control */ - { OV5640_AWB_CTRL00, 0xff}, { OV5640_AWB_CTRL01, 0xf2}, - { OV5640_AWB_CTRL02, 0x00}, { OV5640_AWB_CTRL03, 0x14}, - { OV5640_AWB_CTRL04, 0x25}, { OV5640_AWB_CTRL05, 0x24}, - { OV5640_AWB_CTRL06, 0x09}, { OV5640_AWB_CTRL07, 0x09}, - { OV5640_AWB_CTRL08, 0x09}, { OV5640_AWB_CTRL09, 0x75}, - { OV5640_AWB_CTRL10, 0x54}, { OV5640_AWB_CTRL11, 0xe0}, - { OV5640_AWB_CTRL12, 0xb2}, { OV5640_AWB_CTRL13, 0x42}, - { OV5640_AWB_CTRL14, 0x3d}, { OV5640_AWB_CTRL15, 0x56}, - { OV5640_AWB_CTRL16, 0x46}, { OV5640_AWB_CTRL17, 0xf8}, - { OV5640_AWB_CTRL18, 0x04}, { OV5640_AWB_CTRL19, 0x70}, - { OV5640_AWB_CTRL20, 0xf0}, { OV5640_AWB_CTRL21, 0xf0}, - { OV5640_AWB_CTRL22, 0x03}, { OV5640_AWB_CTRL23, 0x01}, - { OV5640_AWB_CTRL24, 0x04}, { OV5640_AWB_CTRL25, 0x12}, - { OV5640_AWB_CTRL26, 0x04}, { OV5640_AWB_CTRL27, 0x00}, - { OV5640_AWB_CTRL28, 0x06}, { OV5640_AWB_CTRL29, 0x82}, - { OV5640_AWB_CTRL30, 0x38}, + {0x5180, 0xff}, + {0x5181, 0xf2}, + {0x5182, 0x00}, + {0x5183, 0x14}, + {0x5184, 0x25}, + {0x5185, 0x24}, + {0x5186, 0x09}, + {0x5187, 0x09}, + {0x5188, 0x09}, + {0x5189, 0x75}, + {0x518a, 0x54}, + {0x518b, 0xe0}, + {0x518c, 0xb2}, + {0x518d, 0x42}, + {0x518e, 0x3d}, + {0x518d, 0x56}, + {0x5190, 0x46}, + {0x5191, 0xf8}, + {0x5192, 0x04}, + {0x5193, 0x70}, + {0x5194, 0xf0}, + {0x5195, 0xf0}, + {0x5196, 0x03}, + {0x5197, 0x01}, + {0x5198, 0x04}, + {0x5199, 0x12}, + {0x519a, 0x04}, + {0x519b, 0x00}, + {0x519c, 0x06}, + {0x519d, 0x82}, + {0x519e, 0x38}, /* CMX Control */ - { OV5640_CMX1, 0x1e}, - { OV5640_CMX2, 0x5b}, - { OV5640_CMX3, 0x08}, - { OV5640_CMX4, 0x0a}, - { OV5640_CMX5, 0x7e}, - { OV5640_CMX6, 0x88}, - { OV5640_CMX7, 0x7c}, - { OV5640_CMX8, 0x6c}, - { OV5640_CMX9, 0x10}, - { OV5640_CMXSIGN_HI, 0x01}, - { OV5640_CMXSIGN_LO, 0x98}, + {0x5381, 0x1e}, + {0x5382, 0x5b}, + {0x5383, 0x08}, + {0x5384, 0x0a}, + {0x5385, 0x7e}, + {0x5386, 0x88}, + {0x5387, 0x7c}, + {0x5388, 0x6c}, + {0x5389, 0x10}, + {0x538a, 0x01}, + {0x538b, 0x98}, /* CIP Control */ - { OV5640_CIP_SHARPENMT_THRESHOLD_1, 0x08}, - { OV5640_CIP_SHARPENMT_THRESHOLD_2, 0x30}, - { OV5640_CIP_SHARPENMT_OFFSET_1, 0x10}, - { OV5640_CIP_SHARPENMT_OFFSET_2, 0x00}, - { OV5640_CIP_DNS_THRESHOLD_1, 0x08}, - { OV5640_CIP_DNS_THRESHOLD_2, 0x30}, - { OV5640_CIP_DNS_OFFSET_1, 0x08}, - { OV5640_CIP_DNS_OFFSET_2, 0x16}, - { OV5640_CIP_SHARPENTH_THRESHOLD_1, 0x08}, - { OV5640_CIP_SHARPENTH_THRESHOLD_2, 0x30}, - { OV5640_CIP_SHARPENTH_OFFSET_1, 0x04}, - { OV5640_CIP_SHARPENTH_OFFSET_2, 0x06}, + {0x5300, 0x08}, + {0x5301, 0x30}, + {0x5302, 0x10}, + {0x5303, 0x00}, + {0x5304, 0x08}, + {0x5305, 0x30}, + {0x5306, 0x08}, + {0x5307, 0x16}, + {0x5309, 0x08}, + {0x530a, 0x30}, + {0x530b, 0x04}, + {0x530c, 0x06}, /* Gamma Control */ - { OV5640_GAMMA_CTRL00, 0x01}, - { OV5640_YST00, 0x08}, { OV5640_YST01, 0x14}, - { OV5640_YST02, 0x28}, { OV5640_YST03, 0x51}, - { OV5640_YST04, 0x65}, { OV5640_YST05, 0x71}, - { OV5640_YST06, 0x7d}, { OV5640_YST07, 0x87}, - { OV5640_YST08, 0x91}, { OV5640_YST09, 0x9a}, - { OV5640_YST0A, 0xaa}, { OV5640_YST0B, 0xb8}, - { OV5640_YST0C, 0xcd}, { OV5640_YST0D, 0xdd}, - { OV5640_YST0E, 0xea}, { OV5640_YST0F, 0x1d}, + {0x5480, 0x01}, + {0x5481, 0x08}, + {0x5482, 0x14}, + {0x5483, 0x28}, + {0x5484, 0x51}, + {0x5485, 0x65}, + {0x5486, 0x71}, + {0x5487, 0x7d}, + {0x5488, 0x87}, + {0x5489, 0x91}, + {0x548a, 0x9a}, + {0x548b, 0xaa}, + {0x548c, 0xb8}, + {0x548d, 0xcd}, + {0x548e, 0xdd}, + {0x548f, 0xea}, + {0x5490, 0x1d}, /* SDE Control */ - { OV5640_SDE_CTRL_0, 0x02}, - { OV5640_SDE_CTRL_3, 0x40}, - { OV5640_SDE_CTRL_4, 0x10}, - { OV5640_SDE_CTRL_9, 0x10}, - { OV5640_SDE_CTRL_10, 0x00}, - { OV5640_SDE_CTRL_11, 0xf8}, + {0x5580, 0x02}, + {0x5583, 0x40}, + {0x5584, 0x10}, + {0x5589, 0x10}, + {0x558a, 0x00}, + {0x558b, 0xf8}, /* LENC Control */ - { OV5640_GMTRX00, 0x23}, { OV5640_GMTRX01, 0x14}, - { OV5640_GMTRX02, 0x0f}, { OV5640_GMTRX03, 0x0f}, - { OV5640_GMTRX04, 0x12}, { OV5640_GMTRX05, 0x26}, - { OV5640_GMTRX10, 0x0c}, { OV5640_GMTRX11, 0x08}, - { OV5640_GMTRX12, 0x05}, { OV5640_GMTRX13, 0x05}, - { OV5640_GMTRX14, 0x08}, { OV5640_GMTRX15, 0x0d}, - { OV5640_GMTRX20, 0x08}, { OV5640_GMTRX21, 0x03}, - { OV5640_GMTRX22, 0x00}, { OV5640_GMTRX23, 0x00}, - { OV5640_GMTRX24, 0x03}, { OV5640_GMTRX25, 0x09}, - { OV5640_GMTRX30, 0x07}, { OV5640_GMTRX31, 0x03}, - { OV5640_GMTRX32, 0x00}, { OV5640_GMTRX33, 0x01}, - { OV5640_GMTRX34, 0x03}, { OV5640_GMTRX35, 0x08}, - { OV5640_GMTRX40, 0x0d}, { OV5640_GMTRX41, 0x08}, - { OV5640_GMTRX42, 0x05}, { OV5640_GMTRX43, 0x06}, - { OV5640_GMTRX44, 0x08}, { OV5640_GMTRX45, 0x0e}, - { OV5640_GMTRX50, 0x29}, { OV5640_GMTRX51, 0x17}, - { OV5640_GMTRX52, 0x11}, { OV5640_GMTRX53, 0x11}, - { OV5640_GMTRX54, 0x15}, { OV5640_GMTRX55, 0x28}, - { OV5640_BRMATRX00, 0x46}, { OV5640_BRMATRX01, 0x26}, - { OV5640_BRMATRX02, 0x08}, { OV5640_BRMATRX03, 0x26}, - { OV5640_BRMATRX04, 0x64}, { OV5640_BRMATRX05, 0x26}, - { OV5640_BRMATRX06, 0x24}, { OV5640_BRMATRX07, 0x22}, - { OV5640_BRMATRX08, 0x24}, { OV5640_BRMATRX09, 0x24}, - { OV5640_BRMATRX20, 0x06}, { OV5640_BRMATRX21, 0x22}, - { OV5640_BRMATRX22, 0x40}, { OV5640_BRMATRX23, 0x42}, - { OV5640_BRMATRX24, 0x24}, { OV5640_BRMATRX30, 0x26}, - { OV5640_BRMATRX31, 0x24}, { OV5640_BRMATRX32, 0x22}, - { OV5640_BRMATRX33, 0x22}, { OV5640_BRMATRX34, 0x26}, - { OV5640_BRMATRX40, 0x44}, { OV5640_BRMATRX41, 0x24}, - { OV5640_BRMATRX42, 0x26}, { OV5640_BRMATRX43, 0x28}, - { OV5640_BRMATRX44, 0x42}, { OV5640_LENC_BR_OFFSET, 0xce}, - - { OV5640_ISP_CTRL37, 0x00}, - { OV5640_AEC_CTRL0F, 0x30}, - { OV5640_AEC_CTRL10, 0x28}, - { OV5640_AEC_CTRL1B, 0x30}, - { OV5640_AEC_CTRL1E, 0x26}, - { OV5640_AEC_CTRL11, 0x60}, - { OV5640_AEC_CTRL1F, 0x14}, - { OV5640_SYSTEM_CTRL, 0x02}, + {0x5800, 0x23}, + {0x5801, 0x14}, + {0x5802, 0x0f}, + {0x5803, 0x0f}, + {0x5804, 0x12}, + {0x5805, 0x26}, + {0x5806, 0x0c}, + {0x5807, 0x08}, + {0x5808, 0x05}, + {0x5809, 0x05}, + {0x580a, 0x08}, + {0x580b, 0x0d}, + {0x580c, 0x08}, + {0x580d, 0x03}, + {0x580e, 0x00}, + {0x580f, 0x00}, + {0x5810, 0x03}, + {0x5811, 0x09}, + {0x5812, 0x07}, + {0x5813, 0x03}, + {0x5814, 0x00}, + {0x5815, 0x01}, + {0x5816, 0x03}, + {0x5817, 0x08}, + {0x5818, 0x0d}, + {0x5819, 0x08}, + {0x581a, 0x05}, + {0x581b, 0x06}, + {0x581c, 0x08}, + {0x581d, 0x0e}, + {0x581e, 0x29}, + {0x581f, 0x17}, + {0x5820, 0x11}, + {0x5821, 0x11}, + {0x5822, 0x15}, + {0x5823, 0x28}, + {0x5824, 0x46}, + {0x5825, 0x26}, + {0x5826, 0x08}, + {0x5827, 0x26}, + {0x5828, 0x64}, + {0x5829, 0x26}, + {0x582a, 0x24}, + {0x582b, 0x22}, + {0x582c, 0x24}, + {0x582d, 0x24}, + {0x582e, 0x06}, + {0x582f, 0x22}, + {0x5830, 0x40}, + {0x5831, 0x42}, + {0x5832, 0x24}, + {0x5833, 0x26}, + {0x5834, 0x24}, + {0x5835, 0x22}, + {0x5836, 0x22}, + {0x5837, 0x26}, + {0x5838, 0x44}, + {0x5839, 0x24}, + {0x583a, 0x26}, + {0x583b, 0x28}, + {0x583c, 0x42}, + {0x583d, 0xce}, + + {0x5025, 0x00}, + {0x3a0f, 0x30}, + {0x3a10, 0x28}, + {0x3a1b, 0x30}, + {0x3a1e, 0x26}, + {0x3a11, 0x60}, + {0x3a1f, 0x14}, + {0x3008, 0x02}, + {OV5640_TABLE_END, 0x0000}, +}; + +enum { + OV5640_MODE_640x480, + OV5640_MODE_1296x972, + OV5640_MODE_1920x1080, + OV5640_MODE_2592x1944, + OV5640_SIZE_LAST, +}; + +static struct ov5640_reg *mode_table[] = { + [OV5640_MODE_640x480] = mode_640x480, + [OV5640_MODE_1296x972] = mode_1296x972, + [OV5640_MODE_1920x1080] = mode_1920x1080, + [OV5640_MODE_2592x1944] = mode_2592x1944, +}; + +static int test_pattern; +module_param(test_pattern, int, 0644); + +static struct ov5640_reg tp_cbars[] = { + {0x503D, 0x80}, + {0x503E, 0x00}, + {0x5046, 0x01}, + {OV5640_TABLE_END, 0x0000} +}; + +#define to_ov5640(sd) container_of(sd, struct ov5640_priv, subdev) + +#define SIZEOF_I2C_TRANSBUF 32 + +struct ov5640_priv { + struct v4l2_subdev subdev; + struct v4l2_mbus_framefmt mf; + + int ident; + u16 chip_id; + u8 revision; + + int mode; + + struct i2c_client *client; + u8 i2c_trans_buf[SIZEOF_I2C_TRANSBUF]; }; static enum v4l2_mbus_pixelcode ov5640_codes[] = { - V4L2_MBUS_FMT_YUYV8_2X8, + V4L2_MBUS_FMT_UYVY8_2X8, }; -static const struct v4l2_queryctrl ov5640_controls[] = { - { - .id = V4L2_CID_VFLIP, - .type = V4L2_CTRL_TYPE_BOOLEAN, - .name = "Flip Vertically", - .minimum = 0, - .maximum = 1, - .step = 1, - .default_value = 0, - }, - { - .id = V4L2_CID_HFLIP, - .type = V4L2_CTRL_TYPE_BOOLEAN, - .name = "Flip Horizontally", - .minimum = 0, - .maximum = 1, - .step = 1, - .default_value = 0, - }, +static const struct v4l2_frmsize_discrete ov5640_frmsizes[OV5640_SIZE_LAST] = { + {640, 480}, + {1296, 972}, + {1920, 1080}, + {2592, 1944}, }; -/* read a register */ -static int ov5640_reg_read(struct i2c_client *client, u16 reg, u8 *val) +static int ov5640_find_mode(u32 width, u32 height) { - int ret; - unsigned char data[2] = { reg >> 8, reg & 0xff }; + int i; - ret = i2c_master_send(client, data, 2); - if (ret < 2) { - dev_err(&client->dev, "%s: i2c read error, reg: %x\n", - __func__, reg); - return ret < 0 ? ret : -EIO; + for (i = 0; i < OV5640_SIZE_LAST; i++) { + if ((ov5640_frmsizes[i].width >= width) && + (ov5640_frmsizes[i].height >= height)) + break; } - ret = i2c_master_recv(client, val, 1); - if (ret < 1) { - dev_err(&client->dev, "%s: i2c read error, reg: %x\n", - __func__, reg); - return ret < 0 ? ret : -EIO; - } + /* If not found, select biggest */ + if (i >= OV5640_SIZE_LAST) + i = OV5640_SIZE_LAST - 1; - return 0; + return i; } -/* write a register */ -static int ov5640_reg_write(struct i2c_client *client, u16 reg, u8 val) +static int ov5640_read_reg(struct i2c_client *client, u16 addr, u8 *val) { - int ret; - unsigned char data[3] = { reg >> 8, reg & 0xff, val }; + int err; + struct i2c_msg msg[2]; + unsigned char data[3]; - ret = i2c_master_send(client, data, 3); - if (ret < 3) { - dev_err(&client->dev, "%s: i2c write error, reg: %x\n", - __func__, reg); - return ret < 0 ? ret : -EIO; - } + if (!client->adapter) + return -ENODEV; - return 0; -} + msg[0].addr = client->addr; + msg[0].flags = 0; + msg[0].len = 2; + msg[0].buf = data; + /* high byte goes out first */ + data[0] = (u8) (addr >> 8); + data[1] = (u8) (addr & 0xff); -/* Read a register, alter its bits, write it back */ -static int ov5640_reg_rmw(struct i2c_client *client, u16 reg, u8 set, u8 unset) -{ - u8 val; - int ret; + msg[1].addr = client->addr; + msg[1].flags = I2C_M_RD; + msg[1].len = 1; + msg[1].buf = data + 2; - ret = ov5640_reg_read(client, reg, &val); - if (ret < 0) { - dev_err(&client->dev, - "[Read]-Modify-Write of register 0x%04x failed!\n", - reg); - return ret; - } + err = i2c_transfer(client->adapter, msg, 2); - val |= set; - val &= ~unset; + if (err != 2) + return -EINVAL; - ret = ov5640_reg_write(client, reg, val); - if (ret < 0) { - dev_err(&client->dev, - "Read-Modify-[Write] of register 0x%04x failed!\n", - reg); - return ret; - } + *val = data[2]; return 0; } -static int ov5640_reg_write_array(struct i2c_client *client, - const struct ov5640_reg *regarray, - int regarraylen) +static int ov5640_write_reg(struct i2c_client *client, u16 addr, u8 value) { - int i; - int ret; + int count; + struct i2c_msg msg[1]; + unsigned char data[4]; - for (i = 0; i < regarraylen; i++) { - ret = ov5640_reg_write(client, - regarray[i].reg, regarray[i].val); - if (ret < 0) - return ret; - } + if (!client->adapter) + return -ENODEV; - return 0; + data[0] = addr; + data[1] = (u8) (addr & 0xff); + data[2] = value; + + msg[0].addr = client->addr; + msg[0].flags = 0; + msg[0].len = 3; + msg[0].buf = data; + + count = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg)); + if (count == ARRAY_SIZE(msg)) + return 0; + dev_err(&client->dev, + "ov5840: i2c transfer failed, addr: %x, value: %02x\n", + addr, (u32)value); + return -EIO; } -/* Start/Stop streaming from the device */ -static int ov5640_s_stream(struct v4l2_subdev *sd, int enable) +static int ov5640_write_bulk_reg(struct i2c_client *client, u8 *data, int len) { - struct i2c_client *client = v4l2_get_subdevdata(sd); - struct ov5640_priv *priv = to_ov5640(sd); - int ret; + int err; + struct i2c_msg msg; - /* Program orientation register. */ - if (priv->flag_vflip) - ret = ov5640_reg_rmw(client, OV5640_TIMING_TC_REG20, 0x2, 0); - else - ret = ov5640_reg_rmw(client, OV5640_TIMING_TC_REG20, 0, 0x2); - if (ret < 0) - return ret; + if (!client->adapter) + return -ENODEV; - if (priv->flag_hflip) - ret = ov5640_reg_rmw(client, OV5640_TIMING_TC_REG21, 0x2, 0); - else - ret = ov5640_reg_rmw(client, OV5640_TIMING_TC_REG21, 0, 0x2); - if (ret < 0) - return ret; + msg.addr = client->addr; + msg.flags = 0; + msg.len = len; + msg.buf = data; - if (!enable) { - /* Software Reset */ - ret = ov5640_reg_write(client, OV5640_SYSTEM_CTRL, 0x82); - if (!ret) - /* Setting Streaming to Standby */ - ret = ov5640_reg_write(client, OV5640_SYSTEM_CTRL, - 0x42); - } + err = i2c_transfer(client->adapter, &msg, 1); + if (err == 1) + return 0; - priv->current_enable = enable; + dev_err(&client->dev, "ov5640: i2c transfer failed at %x\n", + (int)data[0] << 8 | data[1]); - return ret; + return err; } -/* Alter bus settings on camera side */ -static int ov5640_set_bus_param(struct soc_camera_device *icd, - unsigned long flags) +static int ov5640_write_table(struct ov5640_priv *priv, + struct ov5640_reg table[]) { + int err; + struct ov5640_reg *next, *n_next; + u8 *b_ptr = priv->i2c_trans_buf; + unsigned int buf_filled = 0; + u16 val; + + for (next = table; next->addr != OV5640_TABLE_END; next++) { + if (next->addr == OV5640_TABLE_WAIT_MS) { + msleep(next->val); + continue; + } + + val = next->val; + + if (!buf_filled) { + b_ptr = priv->i2c_trans_buf; + *b_ptr++ = next->addr >> 8; + *b_ptr++ = next->addr & 0xff; + buf_filled = 2; + } + *b_ptr++ = val; + buf_filled++; + + n_next = next + 1; + if (n_next->addr != OV5640_TABLE_END && + n_next->addr != OV5640_TABLE_WAIT_MS && + buf_filled < SIZEOF_I2C_TRANSBUF && + n_next->addr == next->addr + 1) { + continue; + } + + err = ov5640_write_bulk_reg(priv->client, + priv->i2c_trans_buf, buf_filled); + if (err) + return err; + + buf_filled = 0; + } return 0; } -/* Request bus settings on camera side */ -static unsigned long ov5640_query_bus_param(struct soc_camera_device *icd) -{ - struct soc_camera_link *icl = to_soc_camera_link(icd); - - unsigned long flags = SOCAM_PCLK_SAMPLE_RISING | SOCAM_MASTER | - SOCAM_VSYNC_ACTIVE_HIGH | SOCAM_HSYNC_ACTIVE_HIGH | - SOCAM_DATA_ACTIVE_HIGH | SOCAM_DATAWIDTH_8; - - return soc_camera_apply_sensor_flags(icl, flags); -} - -/* select nearest higher resolution for capture */ -static void ov5640_res_roundup(u32 *width, u32 *height) +static void ov5640_set_default_fmt(struct ov5640_priv *priv) { - /* Width must be a multiple of 4 pixels. */ - *width = ALIGN(*width, 4); + struct v4l2_mbus_framefmt *mf = &priv->mf; - /* Max resolution is 1280x720 (720p). */ - if (*width > OV5640_MAX_WIDTH) - *width = OV5640_MAX_WIDTH; - - if (*height > OV5640_MAX_HEIGHT) - *height = OV5640_MAX_HEIGHT; + mf->width = ov5640_frmsizes[OV5640_MODE_2592x1944].width; + mf->height = ov5640_frmsizes[OV5640_MODE_2592x1944].height; + mf->code = V4L2_MBUS_FMT_UYVY8_2X8; + mf->field = V4L2_FIELD_NONE; + mf->colorspace = V4L2_COLORSPACE_SRGB; } -/* Setup registers according to resolution and color encoding */ -static int ov5640_set_res(struct i2c_client *client, u32 width, u32 height) +/* Start/Stop streaming from the device */ +static int ov5640_s_stream(struct v4l2_subdev *sd, int enable) { - /* Note, this stuff is bogus. It's just copied from ov9740.c. */ -#if 0 - u32 x_start; - u32 y_start; - u32 x_end; - u32 y_end; - bool scaling = 0; - u32 scale_input_x; - u32 scale_input_y; - int ret; - - if ((width != OV5640_MAX_WIDTH) || (height != OV5640_MAX_HEIGHT)) - scaling = 1; + struct ov5640_priv *priv = to_ov5640(sd); + int ret = 0; - /* - * Try to use as much of the sensor area as possible when supporting - * smaller resolutions. Depending on the aspect ratio of the - * chosen resolution, we can either use the full width of the sensor, - * or the full height of the sensor (or both if the aspect ratio is - * the same as 1280x720. - */ - if ((OV5640_MAX_WIDTH * height) > (OV5640_MAX_HEIGHT * width)) { - scale_input_x = (OV5640_MAX_HEIGHT * width) / height; - scale_input_y = OV5640_MAX_HEIGHT; - } else { - scale_input_x = OV5640_MAX_WIDTH; - scale_input_y = (OV5640_MAX_WIDTH * height) / width; + if (!enable) { + ov5640_set_default_fmt(priv); + return 0; } - /* These describe the area of the sensor to use. */ - x_start = (OV5640_MAX_WIDTH - scale_input_x) / 2; - y_start = (OV5640_MAX_HEIGHT - scale_input_y) / 2; - x_end = x_start + scale_input_x - 1; - y_end = y_start + scale_input_y - 1; - - ret = ov5640_reg_write(client, OV5640_X_ADDR_START_HI, x_start >> 8); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_X_ADDR_START_LO, x_start & 0xff); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_Y_ADDR_START_HI, y_start >> 8); + ret = ov5640_write_table(priv, mode_table[priv->mode]); if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_Y_ADDR_START_LO, y_start & 0xff); - if (ret) - goto done; + return ret; - ret = ov5640_reg_write(client, OV5640_X_ADDR_END_HI, x_end >> 8); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_X_ADDR_END_LO, x_end & 0xff); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_Y_ADDR_END_HI, y_end >> 8); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_Y_ADDR_END_LO, y_end & 0xff); - if (ret) - goto done; + if (test_pattern == 1) { + ret = ov5640_write_table(priv, tp_cbars); + if (ret) + return ret; + } - ret = ov5640_reg_write(client, OV5640_X_OUTPUT_SIZE_HI, width >> 8); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_X_OUTPUT_SIZE_LO, width & 0xff); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_Y_OUTPUT_SIZE_HI, height >> 8); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_Y_OUTPUT_SIZE_LO, height & 0xff); - if (ret) - goto done; + return ret; +} - ret = ov5640_reg_write(client, OV5640_ISP_CTRL1E, scale_input_x >> 8); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_ISP_CTRL1F, scale_input_x & 0xff); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_ISP_CTRL20, scale_input_y >> 8); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_ISP_CTRL21, scale_input_y & 0xff); - if (ret) - goto done; +static int ov5640_try_fmt(struct v4l2_subdev *sd, + struct v4l2_mbus_framefmt *mf) +{ + int mode; - ret = ov5640_reg_write(client, OV5640_VFIFO_READ_START_HI, - (scale_input_x - width) >> 8); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_VFIFO_READ_START_LO, - (scale_input_x - width) & 0xff); - if (ret) - goto done; + mode = ov5640_find_mode(mf->width, mf->height); + mf->width = ov5640_frmsizes[mode].width; + mf->height = ov5640_frmsizes[mode].height; - ret = ov5640_reg_write(client, OV5640_ISP_CTRL00, 0xff); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_ISP_CTRL01, 0xef | - (scaling << 4)); - if (ret) - goto done; - ret = ov5640_reg_write(client, OV5640_ISP_CTRL03, 0xff); + mf->field = V4L2_FIELD_NONE; + mf->code = V4L2_MBUS_FMT_UYVY8_2X8; + mf->colorspace = V4L2_COLORSPACE_SRGB; -done: - return ret; -#endif return 0; } @@ -815,47 +1347,16 @@ done: static int ov5640_s_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *mf) { - struct i2c_client *client = v4l2_get_subdevdata(sd); struct ov5640_priv *priv = to_ov5640(sd); - enum v4l2_colorspace cspace; - enum v4l2_mbus_pixelcode code = mf->code; int ret; - ov5640_res_roundup(&mf->width, &mf->height); - - switch (code) { - case V4L2_MBUS_FMT_YUYV8_2X8: - cspace = V4L2_COLORSPACE_SRGB; - break; - default: - return -EINVAL; - } - - ret = ov5640_reg_write_array(client, ov5640_defaults, - ARRAY_SIZE(ov5640_defaults)); - if (ret < 0) - return ret; - - ret = ov5640_set_res(client, mf->width, mf->height); + ret = ov5640_try_fmt(sd, mf); if (ret < 0) return ret; - mf->code = code; - mf->colorspace = cspace; + priv->mode = ov5640_find_mode(mf->width, mf->height); - memcpy(&priv->current_mf, mf, sizeof(struct v4l2_mbus_framefmt)); - - return ret; -} - -static int ov5640_try_fmt(struct v4l2_subdev *sd, - struct v4l2_mbus_framefmt *mf) -{ - ov5640_res_roundup(&mf->width, &mf->height); - - mf->field = V4L2_FIELD_NONE; - mf->code = V4L2_MBUS_FMT_YUYV8_2X8; - mf->colorspace = V4L2_COLORSPACE_SRGB; + memcpy(&priv->mf, mf, sizeof(struct v4l2_mbus_framefmt)); return 0; } @@ -875,8 +1376,8 @@ static int ov5640_cropcap(struct v4l2_subdev *sd, struct v4l2_cropcap *a) { a->bounds.left = 0; a->bounds.top = 0; - a->bounds.width = OV5640_MAX_WIDTH; - a->bounds.height = OV5640_MAX_HEIGHT; + a->bounds.width = ov5640_frmsizes[OV5640_MODE_2592x1944].width; + a->bounds.height = ov5640_frmsizes[OV5640_MODE_2592x1944].height; a->defrect = a->bounds; a->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; a->pixelaspect.numerator = 1; @@ -889,51 +1390,13 @@ static int ov5640_g_crop(struct v4l2_subdev *sd, struct v4l2_crop *a) { a->c.left = 0; a->c.top = 0; - a->c.width = OV5640_MAX_WIDTH; - a->c.height = OV5640_MAX_HEIGHT; + a->c.width = ov5640_frmsizes[OV5640_MODE_2592x1944].width; + a->c.height = ov5640_frmsizes[OV5640_MODE_2592x1944].height; a->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; return 0; } -/* Get status of additional camera capabilities */ -static int ov5640_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) -{ - struct ov5640_priv *priv = to_ov5640(sd); - - switch (ctrl->id) { - case V4L2_CID_VFLIP: - ctrl->value = priv->flag_vflip; - break; - case V4L2_CID_HFLIP: - ctrl->value = priv->flag_hflip; - break; - default: - return -EINVAL; - } - - return 0; -} - -/* Set status of additional camera capabilities */ -static int ov5640_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) -{ - struct ov5640_priv *priv = to_ov5640(sd); - - switch (ctrl->id) { - case V4L2_CID_VFLIP: - priv->flag_vflip = ctrl->value; - break; - case V4L2_CID_HFLIP: - priv->flag_hflip = ctrl->value; - break; - default: - return -EINVAL; - } - - return 0; -} - /* Get chip identification */ static int ov5640_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *id) @@ -946,24 +1409,6 @@ static int ov5640_g_chip_ident(struct v4l2_subdev *sd, return 0; } -static int ov5640_s_power(struct v4l2_subdev *sd, int on) -{ - struct ov5640_priv *priv = to_ov5640(sd); - - if (!priv->current_enable) - return 0; - - if (on) { - ov5640_s_fmt(sd, &priv->current_mf); - ov5640_s_stream(sd, priv->current_enable); - } else { - ov5640_s_stream(sd, 0); - priv->current_enable = true; - } - - return 0; -} - #ifdef CONFIG_VIDEO_ADV_DEBUG static int ov5640_get_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg) @@ -977,7 +1422,7 @@ static int ov5640_get_register(struct v4l2_subdev *sd, reg->size = 2; - ret = ov5640_reg_read(client, reg->reg, &val); + ret = ov5640_read_reg(client, reg->reg, &val); if (ret) return ret; @@ -994,53 +1439,32 @@ static int ov5640_set_register(struct v4l2_subdev *sd, if (reg->reg & ~0xffff || reg->val & ~0xff) return -EINVAL; - return ov5640_reg_write(client, reg->reg, reg->val); + return ov5640_write_reg(client, reg->reg, reg->val); } #endif -static int ov5640_video_probe(struct soc_camera_device *icd, - struct i2c_client *client) +/* Alter bus settings on camera side */ +static int ov5640_set_bus_param(struct soc_camera_device *icd, + unsigned long flags) { - struct v4l2_subdev *sd = i2c_get_clientdata(client); - struct ov5640_priv *priv = to_ov5640(sd); - u8 chip_id_hi, chip_id_lo; - int ret; - - /* We must have a parent by now. And it cannot be a wrong one. */ - BUG_ON(!icd->parent || - to_soc_camera_host(icd->parent)->nr != icd->iface); - - /* - * check and show product ID and manufacturer ID - */ - ret = ov5640_reg_read(client, OV5640_CHIP_ID_HI, &chip_id_hi); - if (ret < 0) - goto err; - - ret = ov5640_reg_read(client, OV5640_CHIP_ID_LO, &chip_id_lo); - if (ret < 0) - goto err; - - priv->chip_id = (chip_id_hi << 8) | chip_id_lo; - - if (priv->chip_id != 0x5640) { - ret = -ENODEV; - goto err; - } + return 0; +} - priv->ident = V4L2_IDENT_OV5640; +/* Request bus settings on camera side */ +static unsigned long ov5640_query_bus_param(struct soc_camera_device *icd) +{ + struct soc_camera_link *icl = to_soc_camera_link(icd); - dev_info(&client->dev, "Chip ID 0x%04x\n", priv->chip_id); + unsigned long flags = SOCAM_PCLK_SAMPLE_RISING | SOCAM_MASTER | + SOCAM_VSYNC_ACTIVE_HIGH | SOCAM_HSYNC_ACTIVE_HIGH | + SOCAM_DATA_ACTIVE_HIGH | SOCAM_DATAWIDTH_8; -err: - return ret; + return soc_camera_apply_sensor_flags(icl, flags); } static struct soc_camera_ops ov5640_ops = { .set_bus_param = ov5640_set_bus_param, .query_bus_param = ov5640_query_bus_param, - .controls = ov5640_controls, - .num_controls = ARRAY_SIZE(ov5640_controls), }; static struct v4l2_subdev_video_ops ov5640_video_ops = { @@ -1053,10 +1477,7 @@ static struct v4l2_subdev_video_ops ov5640_video_ops = { }; static struct v4l2_subdev_core_ops ov5640_core_ops = { - .g_ctrl = ov5640_g_ctrl, - .s_ctrl = ov5640_s_ctrl, .g_chip_ident = ov5640_g_chip_ident, - .s_power = ov5640_s_power, #ifdef CONFIG_VIDEO_ADV_DEBUG .g_register = ov5640_get_register, .s_register = ov5640_set_register, @@ -1077,6 +1498,7 @@ static int ov5640_probe(struct i2c_client *client, struct ov5640_priv *priv; struct soc_camera_device *icd = client->dev.platform_data; struct soc_camera_link *icl; + u8 chip_id_hi, chip_id_lo; int ret; if (!icd) { @@ -1090,31 +1512,52 @@ static int ov5640_probe(struct i2c_client *client, return -EINVAL; } - priv = kzalloc(sizeof(struct ov5640_priv), GFP_KERNEL); + priv = devm_kzalloc(&client->dev, sizeof(struct ov5640_priv), + GFP_KERNEL); if (!priv) { dev_err(&client->dev, "Failed to allocate private data!\n"); return -ENOMEM; } v4l2_i2c_subdev_init(&priv->subdev, client, &ov5640_subdev_ops); - icd->ops = &ov5640_ops; - ret = ov5640_video_probe(icd, client); + priv->client = client; + + priv->ident = V4L2_IDENT_OV5640; + + /* + * check and show product ID and manufacturer ID + */ + ret = ov5640_read_reg(client, 0x300A, &chip_id_hi); if (ret < 0) { - icd->ops = NULL; - kfree(priv); + dev_err(&client->dev, "Failure to read Chip ID (high byte)\n"); + return ret; } + ret = ov5640_read_reg(client, 0x300B, &chip_id_lo); + if (ret < 0) { + dev_err(&client->dev, "Failure to read Chip ID (low byte)\n"); + return ret; + } + + priv->chip_id = (chip_id_hi << 8) | chip_id_lo; + + if (priv->chip_id != 0x5640) { + dev_err(&client->dev, "Chip ID: %x not supported!\n", + priv->chip_id); + ret = -ENODEV; + return ret; + } + + ov5640_set_default_fmt(priv); + + dev_info(&client->dev, "Chip ID 0x%04x\n", priv->chip_id); return ret; } static int ov5640_remove(struct i2c_client *client) { - struct ov5640_priv *priv = i2c_get_clientdata(client); - - kfree(priv); - return 0; } -- cgit v1.2.3