lists.openwall.net   lists  /  announce  owl-users  owl-dev  john-users  john-dev  passwdqc-users  yescrypt  popa3d-users  /  oss-security  kernel-hardening  musl  sabotage  tlsify  passwords  /  crypt-dev  xvendor  /  Bugtraq  Full-Disclosure  linux-kernel  linux-netdev  linux-ext4  linux-hardening  linux-cve-announce  PHC 
Open Source and information security mailing list archives
 
Hash Suite: Windows password security audit tool. GUI, reports in PDF.
[<prev] [next>] [<thread-prev] [day] [month] [year] [list]
Message-ID: <ZTY00Cc2RFwvegE1@tom-HP-ZBook-Fury-15-G7-Mobile-Workstation>
Date:   Mon, 23 Oct 2023 10:54:40 +0200
From:   Tommaso Merciai <tomm.merciai@...il.com>
To:     Sebastian Reichel <sre@...nel.org>
Cc:     Sakari Ailus <sakari.ailus@...ux.intel.com>,
        Jacopo Mondi <jacopo.mondi@...asonboard.com>,
        Mauro Carvalho Chehab <mchehab@...nel.org>,
        Rob Herring <robh+dt@...nel.org>,
        Krzysztof Kozlowski <krzysztof.kozlowski+dt@...aro.org>,
        Conor Dooley <conor+dt@...nel.org>,
        linux-media@...r.kernel.org, devicetree@...r.kernel.org,
        linux-kernel@...r.kernel.org
Subject: Re: [PATCH v1 3/3] media: i2c: gc0308: new driver

Hi Sebastian,
Thanks for the patch.

On Mon, Oct 23, 2023 at 02:22:09AM +0200, Sebastian Reichel wrote:
> Introduce new driver for GalaxyCore GC0308, which is a cheap
> 640x480 with an on-chip ISP sensor sold since 2010. Data is
> provided via parallel bus.
> 
> Signed-off-by: Sebastian Reichel <sre@...nel.org>
> ---
>  drivers/media/i2c/Kconfig  |   14 +
>  drivers/media/i2c/Makefile |    1 +
>  drivers/media/i2c/gc0308.c | 1451 ++++++++++++++++++++++++++++++++++++
>  3 files changed, 1466 insertions(+)
>  create mode 100644 drivers/media/i2c/gc0308.c

You are missing the new entry into MAINTAINERS file for this new driver
or I'm completely wrong?

Thanks & Regards,
Tommaso

> 
> diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig
> index 74ff833ff48c..7db4abc0ef88 100644
> --- a/drivers/media/i2c/Kconfig
> +++ b/drivers/media/i2c/Kconfig
> @@ -50,6 +50,20 @@ config VIDEO_AR0521
>  	  To compile this driver as a module, choose M here: the
>  	  module will be called ar0521.
>  
> +config VIDEO_GC0308
> +	tristate "GalaxyCore GC0308 sensor support"
> +	depends on I2C && VIDEO_DEV
> +	select MEDIA_CONTROLLER
> +	select VIDEO_V4L2_SUBDEV_API
> +	select V4L2_FWNODE
> +	select REGMAP_I2C
> +	help
> +	  This is a Video4Linux2 sensor driver for the GalaxyCore
> +	  GC0308 camera.
> +
> +	  To compile this driver as a module, choose M here: the
> +	  module will be called gc0308.
> +
>  config VIDEO_HI556
>  	tristate "Hynix Hi-556 sensor support"
>  	help
> diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile
> index 80b00d39b48f..f03a21f2962a 100644
> --- a/drivers/media/i2c/Makefile
> +++ b/drivers/media/i2c/Makefile
> @@ -36,6 +36,7 @@ obj-$(CONFIG_VIDEO_DW9719) += dw9719.o
>  obj-$(CONFIG_VIDEO_DW9768) += dw9768.o
>  obj-$(CONFIG_VIDEO_DW9807_VCM) += dw9807-vcm.o
>  obj-$(CONFIG_VIDEO_ET8EK8) += et8ek8/
> +obj-$(CONFIG_VIDEO_GC0308) += gc0308.o
>  obj-$(CONFIG_VIDEO_HI556) += hi556.o
>  obj-$(CONFIG_VIDEO_HI846) += hi846.o
>  obj-$(CONFIG_VIDEO_HI847) += hi847.o
> diff --git a/drivers/media/i2c/gc0308.c b/drivers/media/i2c/gc0308.c
> new file mode 100644
> index 000000000000..c92370aed43b
> --- /dev/null
> +++ b/drivers/media/i2c/gc0308.c
> @@ -0,0 +1,1451 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Driver for the GalaxyCore GC0308/GC0309 camera sensor.
> + *
> + * Copyright (c) 2023 Sebastian Reichel <sre@...nel.org>
> + */
> +
> +#include <linux/clk.h>
> +#include <linux/device.h>
> +#include <linux/gpio/consumer.h>
> +#include <linux/i2c.h>
> +#include <linux/module.h>
> +#include <linux/mod_devicetable.h>
> +#include <linux/pm_runtime.h>
> +#include <linux/regmap.h>
> +#include <linux/regulator/consumer.h>
> +
> +#include <media/v4l2-ctrls.h>
> +#include <media/v4l2-device.h>
> +#include <media/v4l2-event.h>
> +#include <media/v4l2-fwnode.h>
> +#include <media/v4l2-subdev.h>
> +
> +/* Analog & CISCTL*/
> +#define GC0308_CHIP_ID			0x000
> +#define GC0308_HBLANK			0x001
> +#define GC0308_VBLANK			0x002
> +#define GC0308_EXPH			0x003
> +#define GC0308_EXPL			0x004
> +#define GC0308_ROW_STARTH		0x005
> +#define GC0308_ROW_STARTL		0x006
> +#define GC0308_COL_STARTH		0x007
> +#define GC0308_COL_STARTL		0x008
> +#define GC0308_WIN_HEIGHTH		0x009
> +#define GC0308_WIN_HEIGHTL		0x00a
> +#define GC0308_WIN_WIDTHH		0x00b
> +#define GC0308_WIN_WIDTHL		0x00c
> +#define GC0308_VS_ST			0x00d
> +#define GC0308_VS_ET			0x00e
> +#define GC0308_VB_HB			0x00f
> +#define GC0308_RSH_WIDTH		0x010
> +#define GC0308_TSP_WIDTH		0x011
> +#define GC0308_SH_DELAY			0x012
> +#define GC0308_ROW_TAIL_WIDTH		0x013
> +#define GC0308_CISCTL_MODE1		0x014
> +#define GC0308_CISCTL_MODE2		0x015
> +#define GC0308_CISCTL_MODE3		0x016
> +#define GC0308_CISCTL_MODE4		0x017
> +#define GC0308_ANALOG_MODE1		0x01a
> +#define GC0308_ANALOG_MODE2		0x01b
> +#define GC0308_HRST_RSG_V18		0x01c
> +#define GC0308_VREF_V25			0x01d
> +#define GC0308_ADC_R			0x01e
> +#define GC0308_PAD_DRV			0x01f
> +#define GC0308_SOFT_RESET		0x0fe
> +
> +/* ISP */
> +#define GC0308_BLOCK_EN1		0x020
> +#define GC0308_BLOCK_EN2		0x021
> +#define GC0308_AAAA_EN			0x022
> +#define GC0308_SPECIAL_EFFECT		0x023
> +#define GC0308_OUT_FORMAT		0x024
> +#define GC0308_OUT_EN			0x025
> +#define GC0308_SYNC_MODE		0x026
> +#define GC0308_CLK_DIV_MODE		0x028
> +#define GC0308_BYPASS_MODE		0x029
> +#define GC0308_CLK_GATING		0x02a
> +#define GC0308_DITHER_MODE		0x02b
> +#define GC0308_DITHER_BIT		0x02c
> +#define GC0308_DEBUG_MODE1		0x02d
> +#define GC0308_DEBUG_MODE2		0x02e
> +#define GC0308_DEBUG_MODE3		0x02f
> +#define GC0308_CROP_WIN_MODE		0x046
> +#define GC0308_CROP_WIN_Y1		0x047
> +#define GC0308_CROP_WIN_X1		0x048
> +#define GC0308_CROP_WIN_HEIGHTH		0x049
> +#define GC0308_CROP_WIN_HEIGHTL		0x04a
> +#define GC0308_CROP_WIN_WIDTHH		0x04b
> +#define GC0308_CROP_WIN_WIDTHL		0x04c
> +
> +/* BLK */
> +#define GC0308_BLK_MODE			0x030
> +#define GC0308_BLK_LIMIT_VAL		0x031
> +#define GC0308_GLOBAL_OFF		0x032
> +#define GC0308_CURRENT_R_OFF		0x033
> +#define GC0308_CURRENT_G_OFF		0x034
> +#define GC0308_CURRENT_B_OFF		0x035
> +#define GC0308_CURRENT_R_DARK_CURRENT	0x036
> +#define GC0308_CURRENT_G_DARK_CURRENT	0x037
> +#define GC0308_CURRENT_B_DARK_CURRENT	0x038
> +#define GC0308_EXP_RATE_DARKC		0x039
> +#define GC0308_OFF_SUBMODE		0x03a
> +#define GC0308_DARKC_SUBMODE		0x03b
> +#define GC0308_MANUAL_G1_OFF		0x03c
> +#define GC0308_MANUAL_R1_OFF		0x03d
> +#define GC0308_MANUAL_B2_OFF		0x03e
> +#define GC0308_MANUAL_G2_OFF		0x03f
> +
> +/* PREGAIN */
> +#define GC0308_GLOBAL_GAIN		0x050
> +#define GC0308_AUTO_PREGAIN		0x051
> +#define GC0308_AUTO_POSTGAIN		0x052
> +#define GC0308_CHANNEL_GAIN_G1		0x053
> +#define GC0308_CHANNEL_GAIN_R		0x054
> +#define GC0308_CHANNEL_GAIN_B		0x055
> +#define GC0308_CHANNEL_GAIN_G2		0x056
> +#define GC0308_R_RATIO			0x057
> +#define GC0308_G_RATIO			0x058
> +#define GC0308_B_RATIO			0x059
> +#define GC0308_AWB_R_GAIN		0x05a
> +#define GC0308_AWB_G_GAIN		0x05b
> +#define GC0308_AWB_B_GAIN		0x05c
> +#define GC0308_LSC_DEC_LVL1		0x05d
> +#define GC0308_LSC_DEC_LVL2		0x05e
> +#define GC0308_LSC_DEC_LVL3		0x05f
> +
> +/* DNDD */
> +#define GC0308_DN_MODE_EN		0x060
> +#define GC0308_DN_MODE_RATIO		0x061
> +#define GC0308_DN_BILAT_B_BASE		0x062
> +#define GC0308_DN_B_INCR		0x063
> +#define GC0308_DN_BILAT_N_BASE		0x064
> +#define GC0308_DN_N_INCR		0x065
> +#define GC0308_DD_DARK_BRIGHT_TH	0x066
> +#define GC0308_DD_FLAT_TH		0x067
> +#define GC0308_DD_LIMIT			0x068
> +
> +/* ASDE - Auto Saturation De-noise and Edge-Enhancement */
> +#define GC0308_ASDE_GAIN_TRESH		0x069
> +#define GC0308_ASDE_GAIN_MODE		0x06a
> +#define GC0308_ASDE_DN_SLOPE		0x06b
> +#define GC0308_ASDE_DD_BRIGHT		0x06c
> +#define GC0308_ASDE_DD_LIMIT		0x06d
> +#define GC0308_ASDE_AUTO_EE1		0x06e
> +#define GC0308_ASDE_AUTO_EE2		0x06f
> +#define GC0308_ASDE_AUTO_SAT_DEC_SLOPE	0x070
> +#define GC0308_ASDE_AUTO_SAT_LOW_LIMIT	0x071
> +
> +/* INTPEE - Interpolation and Edge-Enhancement */
> +#define GC0308_EEINTP_MODE_1		0x072
> +#define GC0308_EEINTP_MODE_2		0x073
> +#define GC0308_DIRECTION_TH1		0x074
> +#define GC0308_DIRECTION_TH2		0x075
> +#define GC0308_DIFF_HV_TI_TH		0x076
> +#define GC0308_EDGE12_EFFECT		0x077
> +#define GC0308_EDGE_POS_RATIO		0x078
> +#define GC0308_EDGE1_MINMAX		0x079
> +#define GC0308_EDGE2_MINMAX		0x07a
> +#define GC0308_EDGE12_TH		0x07b
> +#define GC0308_EDGE_MAX			0x07c
> +
> +/* ABB - Auto Black Balance */
> +#define GC0308_ABB_MODE			0x080
> +#define GC0308_ABB_TARGET_AVGH		0x081
> +#define GC0308_ABB_TARGET_AVGL		0x082
> +#define GC0308_ABB_LIMIT_VAL		0x083
> +#define GC0308_ABB_SPEED		0x084
> +#define GC0308_CURR_R_BLACK_LVL		0x085
> +#define GC0308_CURR_G_BLACK_LVL		0x086
> +#define GC0308_CURR_B_BLACK_LVL		0x087
> +#define GC0308_CURR_R_BLACK_FACTOR	0x088
> +#define GC0308_CURR_G_BLACK_FACTOR	0x089
> +#define GC0308_CURR_B_BLACK_FACTOR	0x08a
> +
> +/* LSC - Lens Shading Correction */
> +#define GC0308_LSC_RED_B2		0x08b
> +#define GC0308_LSC_GREEN_B2		0x08c
> +#define GC0308_LSC_BLUE_B2		0x08d
> +#define GC0308_LSC_RED_B4		0x08e
> +#define GC0308_LSC_GREEN_B4		0x08f
> +#define GC0308_LSC_BLUE_B4		0x090
> +#define GC0308_LSC_ROW_CENTER		0x091
> +#define GC0308_LSC_COL_CENTER		0x092
> +
> +/* CC - Channel Coefficient */
> +#define GC0308_CC_MATRIX_C11		0x093
> +#define GC0308_CC_MATRIX_C12		0x094
> +#define GC0308_CC_MATRIX_C13		0x095
> +#define GC0308_CC_MATRIX_C21		0x096
> +#define GC0308_CC_MATRIX_C22		0x097
> +#define GC0308_CC_MATRIX_C23		0x098
> +#define GC0308_CC_MATRIX_C41		0x09c
> +#define GC0308_CC_MATRIX_C42		0x09d
> +#define GC0308_CC_MATRIX_C43		0x09e
> +
> +/* GAMMA */
> +#define GC0308_GAMMA_OUT0		0x09f
> +#define GC0308_GAMMA_OUT1		0x0a0
> +#define GC0308_GAMMA_OUT2		0x0a1
> +#define GC0308_GAMMA_OUT3		0x0a2
> +#define GC0308_GAMMA_OUT4		0x0a3
> +#define GC0308_GAMMA_OUT5		0x0a4
> +#define GC0308_GAMMA_OUT6		0x0a5
> +#define GC0308_GAMMA_OUT7		0x0a6
> +#define GC0308_GAMMA_OUT8		0x0a7
> +#define GC0308_GAMMA_OUT9		0x0a8
> +#define GC0308_GAMMA_OUT10		0x0a9
> +#define GC0308_GAMMA_OUT11		0x0aa
> +#define GC0308_GAMMA_OUT12		0x0ab
> +#define GC0308_GAMMA_OUT13		0x0ac
> +#define GC0308_GAMMA_OUT14		0x0ad
> +#define GC0308_GAMMA_OUT15		0x0ae
> +#define GC0308_GAMMA_OUT16		0x0af
> +
> +/* YCP */
> +#define GC0308_GLOBAL_SATURATION	0x0b0
> +#define GC0308_SATURATION_CB		0x0b1
> +#define GC0308_SATURATION_CR		0x0b2
> +#define GC0308_LUMA_CONTRAST		0x0b3
> +#define GC0308_CONTRAST_CENTER		0x0b4
> +#define GC0308_LUMA_OFFSET		0x0b5
> +#define GC0308_SKIN_CB_CENTER		0x0b6
> +#define GC0308_SKIN_CR_CENTER		0x0b7
> +#define GC0308_SKIN_RADIUS_SQUARE	0x0b8
> +#define GC0308_SKIN_BRIGHTNESS		0x0b9
> +#define GC0308_FIXED_CB			0x0ba
> +#define GC0308_FIXED_CR			0x0bb
> +#define GC0308_EDGE_DEC_SA		0x0bd
> +#define GC0308_AUTO_GRAY_MODE		0x0be
> +#define GC0308_SATURATION_SUB_STRENGTH	0x0bf
> +#define GC0308_Y_GAMMA_OUT0		0x0c0
> +#define GC0308_Y_GAMMA_OUT1		0x0c1
> +#define GC0308_Y_GAMMA_OUT2		0x0c2
> +#define GC0308_Y_GAMMA_OUT3		0x0c3
> +#define GC0308_Y_GAMMA_OUT4		0x0c4
> +#define GC0308_Y_GAMMA_OUT5		0x0c5
> +#define GC0308_Y_GAMMA_OUT6		0x0c6
> +#define GC0308_Y_GAMMA_OUT7		0x0c7
> +#define GC0308_Y_GAMMA_OUT8		0x0c8
> +#define GC0308_Y_GAMMA_OUT9		0x0c9
> +#define GC0308_Y_GAMMA_OUT10		0x0ca
> +#define GC0308_Y_GAMMA_OUT11		0x0cb
> +#define GC0308_Y_GAMMA_OUT12		0x0cc
> +
> +/* AEC - Automatic Exposure Control */
> +#define GC0308_AEC_MODE1		0x0d0
> +#define GC0308_AEC_MODE2		0x0d1
> +#define GC0308_AEC_MODE3		0x0d2
> +#define GC0308_AEC_TARGET_Y		0x0d3
> +#define GC0308_Y_AVG			0x0d4
> +#define GC0308_AEC_HIGH_LOW_RANGE	0x0d5
> +#define GC0308_AEC_IGNORE		0x0d6
> +#define GC0308_AEC_LIMIT_HIGH_RANGE	0x0d7
> +#define GC0308_AEC_R_OFFSET		0x0d9
> +#define GC0308_AEC_GB_OFFSET		0x0da
> +#define GC0308_AEC_SLOW_MARGIN		0x0db
> +#define GC0308_AEC_FAST_MARGIN		0x0dc
> +#define GC0308_AEC_EXP_CHANGE_GAIN	0x0dd
> +#define GC0308_AEC_STEP2_SUNLIGHT	0x0de
> +#define GC0308_AEC_I_FRAMES		0x0df
> +#define GC0308_AEC_I_STOP_L_MARGIN	0x0e0
> +#define GC0308_AEC_I_STOP_MARGIN	0x0e1
> +#define GC0308_ANTI_FLICKER_STEP_H	0x0e2
> +#define GC0308_ANTI_FLICKER_STEP_L	0x0e3
> +#define GC0308_EXP_LVL_1H		0x0e4
> +#define GC0308_EXP_LVL_1L		0x0e5
> +#define GC0308_EXP_LVL_2H		0x0e6
> +#define GC0308_EXP_LVL_2L		0x0e7
> +#define GC0308_EXP_LVL_3H		0x0e8
> +#define GC0308_EXP_LVL_3L		0x0e9
> +#define GC0308_EXP_LVL_4H		0x0ea
> +#define GC0308_EXP_LVL_4L		0x0eb
> +#define GC0308_MAX_EXP_LVL		0x0ec
> +#define GC0308_EXP_MIN_L		0x0ed
> +#define GC0308_MAX_POST_DF_GAIN		0x0ee
> +#define GC0308_MAX_PRE_DG_GAIN		0x0ef
> +
> +/* ABS */
> +#define GC0308_ABS_RANGE_COMP		0x0f0
> +#define GC0308_ABS_STOP_MARGIN		0x0f1
> +#define GC0308_Y_S_COMP			0x0f2
> +#define GC0308_Y_STRETCH_LIMIT		0x0f3
> +#define GC0308_Y_TILT			0x0f4
> +#define GC0308_Y_STRETCH		0x0f5
> +
> +/* Measure Window */
> +#define GC0308_BIG_WIN_X0		0x0f7
> +#define GC0308_BIG_WIN_Y0		0x0f8
> +#define GC0308_BIG_WIN_X1		0x0f9
> +#define GC0308_BIG_WIN_Y1		0x0fa
> +#define GC0308_DIFF_Y_BIG_THD		0x0fb
> +
> +/* OUT Module (P1) */
> +#define GC0308_CLOSE_FRAME_EN		0x150
> +#define GC0308_CLOSE_FRAME_NUM1		0x151
> +#define GC0308_CLOSE_FRAME_NUM2		0x152
> +#define GC0308_BAYER_MODE		0x153
> +#define GC0308_SUBSAMPLE		0x154
> +#define GC0308_SUBMODE			0x155
> +#define GC0308_SUB_ROW_N1		0x156
> +#define GC0308_SUB_ROW_N2		0x157
> +#define GC0308_SUB_COL_N1		0x158
> +#define GC0308_SUB_COL_N2		0x159
> +
> +/* AWB (P1) - Auto White Balance */
> +#define GC0308_AWB_RGB_HIGH_LOW		0x100
> +#define GC0308_AWB_Y_TO_C_DIFF2		0x102
> +#define GC0308_AWB_C_MAX		0x104
> +#define GC0308_AWB_C_INTER		0x105
> +#define GC0308_AWB_C_INTER2		0x106
> +#define GC0308_AWB_C_MAX_BIG		0x108
> +#define GC0308_AWB_Y_HIGH		0x109
> +#define GC0308_AWB_NUMBER_LIMIT		0x10a
> +#define GC0308_KWIN_RATIO		0x10b
> +#define GC0308_KWIN_THD			0x10c
> +#define GC0308_LIGHT_GAIN_RANGE		0x10d
> +#define GC0308_SMALL_WIN_WIDTH_STEP	0x10e
> +#define GC0308_SMALL_WIN_HEIGHT_STEP	0x10f
> +#define GC0308_AWB_YELLOW_TH		0x110
> +#define GC0308_AWB_MODE			0x111
> +#define GC0308_AWB_ADJUST_SPEED		0x112
> +#define GC0308_AWB_EVERY_N		0x113
> +#define GC0308_R_AVG_USE		0x1d0
> +#define GC0308_G_AVG_USE		0x1d1
> +#define GC0308_B_AVG_USE		0x1d2
> +
> +#define GC0308_FRAME_RATE		29
> +
> +enum gc0308_exp_val {
> +	GC0308_EXP_M4 = 0,
> +	GC0308_EXP_M3,
> +	GC0308_EXP_M2,
> +	GC0308_EXP_M1,
> +	GC0308_EXP_0,
> +	GC0308_EXP_P1,
> +	GC0308_EXP_P2,
> +	GC0308_EXP_P3,
> +	GC0308_EXP_P4,
> +};
> +
> +struct gc0308_exposure {
> +	u8 luma_offset;
> +	u8 aec_target_y;
> +};
> +
> +#define GC0308_EXPOSURE(luma_offset_reg, aec_target_y_reg) \
> +	{ .luma_offset = luma_offset_reg, .aec_target_y = aec_target_y_reg }
> +
> +static const struct gc0308_exposure gc0308_exposure_values[] = {
> +	[GC0308_EXP_M4] = GC0308_EXPOSURE(0xc0, 0x30),
> +	[GC0308_EXP_M3] = GC0308_EXPOSURE(0xd0, 0x38),
> +	[GC0308_EXP_M2] = GC0308_EXPOSURE(0xe0, 0x40),
> +	[GC0308_EXP_M1] = GC0308_EXPOSURE(0xf0, 0x48),
> +	[GC0308_EXP_0]  = GC0308_EXPOSURE(0x08, 0x50),
> +	[GC0308_EXP_P1] = GC0308_EXPOSURE(0x10, 0x5c),
> +	[GC0308_EXP_P2] = GC0308_EXPOSURE(0x20, 0x60),
> +	[GC0308_EXP_P3] = GC0308_EXPOSURE(0x30, 0x68),
> +	[GC0308_EXP_P4] = GC0308_EXPOSURE(0x40, 0x70),
> +};
> +
> +struct gc0308_awb_gains {
> +	u8 r;
> +	u8 g;
> +	u8 b;
> +};
> +
> +#define GC0308_AWB_GAINS(red, green, blue) \
> +	{ .r = red, .g = green, .b = blue }
> +
> +static const struct gc0308_awb_gains gc0308_awb_gains[] = {
> +	[V4L2_WHITE_BALANCE_AUTO]         = GC0308_AWB_GAINS(0x56, 0x40, 0x4a),
> +	[V4L2_WHITE_BALANCE_CLOUDY]       = GC0308_AWB_GAINS(0x8c, 0x50, 0x40),
> +	[V4L2_WHITE_BALANCE_DAYLIGHT]     = GC0308_AWB_GAINS(0x74, 0x52, 0x40),
> +	[V4L2_WHITE_BALANCE_INCANDESCENT] = GC0308_AWB_GAINS(0x48, 0x40, 0x5c),
> +	[V4L2_WHITE_BALANCE_FLUORESCENT]  = GC0308_AWB_GAINS(0x40, 0x42, 0x50),
> +};
> +
> +struct gc0308_format {
> +	u32 code;
> +	u8 regval;
> +};
> +
> +#define GC0308_FORMAT(v4l2_code, gc0308_regval) \
> +	{ .code = v4l2_code, .regval = gc0308_regval }
> +
> +static const struct gc0308_format gc0308_formats[] = {
> +	GC0308_FORMAT(MEDIA_BUS_FMT_UYVY8_2X8, 0x00),
> +	GC0308_FORMAT(MEDIA_BUS_FMT_VYUY8_2X8, 0x01),
> +	GC0308_FORMAT(MEDIA_BUS_FMT_YUYV8_2X8, 0x02),
> +	GC0308_FORMAT(MEDIA_BUS_FMT_YVYU8_2X8, 0x03),
> +	GC0308_FORMAT(MEDIA_BUS_FMT_RGB565_2X8_BE, 0x06),
> +	GC0308_FORMAT(MEDIA_BUS_FMT_RGB555_2X8_PADHI_BE, 0x07),
> +	GC0308_FORMAT(MEDIA_BUS_FMT_RGB444_2X8_PADHI_BE, 0x09),
> +};
> +
> +struct gc0308_frame_size {
> +	u8 subsample;
> +	u16 width;
> +	u16 height;
> +};
> +
> +#define GC0308_FRAME_SIZE(s, w, h) \
> +	{ .subsample = s, .width = w, .height = h }
> +
> +static const struct gc0308_frame_size gc0308_frame_sizes[] = {
> +	GC0308_FRAME_SIZE(0x11, 640, 480),
> +	GC0308_FRAME_SIZE(0x22, 320, 240),
> +	GC0308_FRAME_SIZE(0x44, 160, 120),
> +};
> +
> +struct gc0308 {
> +	struct v4l2_subdev sd;
> +	struct v4l2_ctrl_handler hdl;
> +	struct media_pad pad;
> +	struct v4l2_mbus_framefmt format;
> +	struct device *dev;
> +	struct clk *clk;
> +	struct regmap *regmap;
> +	struct regulator *vdd;
> +	struct gpio_desc *pwdn_gpio;
> +	struct gpio_desc *reset_gpio;
> +	struct mutex lock; /* mutex lock for operations */
> +	bool streaming;
> +	unsigned int mbus_config;
> +	struct v4l2_fract frame_interval;
> +};
> +
> +static inline struct gc0308 *to_gc0308(struct v4l2_subdev *sd)
> +{
> +	return container_of(sd, struct gc0308, sd);
> +}
> +
> +static const struct regmap_range_cfg gc0308_ranges[] = {
> +	{
> +		.range_min	= 0x0000,
> +		.range_max	= 0x01ff,
> +		.selector_reg	= 0xfe,
> +		.selector_mask	= 0x01,
> +		.selector_shift	= 0x00,
> +		.window_start	= 0x00,
> +		.window_len	= 0x100,
> +	},
> +};
> +
> +static const struct regmap_config gc0308_regmap_config = {
> +	.reg_bits = 8,
> +	.val_bits = 8,
> +	.max_register = 0x1ff,
> +	.ranges = gc0308_ranges,
> +	.num_ranges = ARRAY_SIZE(gc0308_ranges),
> +	.cache_type = REGCACHE_RBTREE,
> +};
> +
> +static const struct reg_sequence sensor_default_regs[] = {
> +	REG_SEQ0(GC0308_VB_HB, 0x00),
> +	REG_SEQ0(GC0308_HBLANK, 0x40),
> +	REG_SEQ0(GC0308_VBLANK, 0x20),
> +	REG_SEQ0(GC0308_EXPH, 0x02),
> +	REG_SEQ0(GC0308_EXPL, 0x58),
> +	REG_SEQ0(GC0308_AWB_R_GAIN, 0x56),
> +	REG_SEQ0(GC0308_AWB_G_GAIN, 0x40),
> +	REG_SEQ0(GC0308_AWB_B_GAIN, 0x4a),
> +	REG_SEQ0(GC0308_ANTI_FLICKER_STEP_H, 0x00),
> +	REG_SEQ0(GC0308_ANTI_FLICKER_STEP_L, 0x78),
> +	REG_SEQ0(GC0308_EXP_LVL_1H, 0x02),
> +	REG_SEQ0(GC0308_EXP_LVL_1L, 0x58),
> +	REG_SEQ0(GC0308_EXP_LVL_2H, 0x02),
> +	REG_SEQ0(GC0308_EXP_LVL_2L, 0x58),
> +	REG_SEQ0(GC0308_EXP_LVL_3H, 0x02),
> +	REG_SEQ0(GC0308_EXP_LVL_3L, 0x58),
> +	REG_SEQ0(GC0308_EXP_LVL_4H, 0x0e),
> +	REG_SEQ0(GC0308_EXP_LVL_4L, 0xa6),
> +	REG_SEQ0(GC0308_MAX_EXP_LVL, 0x20),
> +	REG_SEQ0(GC0308_ROW_STARTH, 0x00),
> +	REG_SEQ0(GC0308_ROW_STARTL, 0x00),
> +	REG_SEQ0(GC0308_COL_STARTH, 0x00),
> +	REG_SEQ0(GC0308_COL_STARTL, 0x00),
> +	REG_SEQ0(GC0308_WIN_HEIGHTH, 0x01), /* 0x1e8 = 488 => VT=480 */
> +	REG_SEQ0(GC0308_WIN_HEIGHTL, 0xe8),
> +	REG_SEQ0(GC0308_WIN_WIDTHH, 0x02), /* 0x288 = 648 => VH=640 */
> +	REG_SEQ0(GC0308_WIN_WIDTHL, 0x88),
> +	REG_SEQ0(GC0308_VS_ST, 0x02), /* Start Time (in rows) */
> +	REG_SEQ0(GC0308_VS_ET, 0x02), /* End Time (in rows) */
> +	REG_SEQ0(GC0308_RSH_WIDTH, 0x22),
> +	REG_SEQ0(GC0308_TSP_WIDTH, 0x0d),
> +	REG_SEQ0(GC0308_SH_DELAY, 0x50), /* sample hold delay post row finish */
> +	REG_SEQ0(GC0308_ROW_TAIL_WIDTH, 0x0f),
> +	REG_SEQ0(GC0308_CISCTL_MODE1, 0x10),
> +	REG_SEQ0(GC0308_CISCTL_MODE2, 0x0a),
> +	REG_SEQ0(GC0308_CISCTL_MODE3, 0x05),
> +	REG_SEQ0(GC0308_CISCTL_MODE4, 0x01),
> +	REG_SEQ0(0x018, 0x44), /* undocumented */
> +	REG_SEQ0(0x019, 0x44), /* undocumented */
> +	REG_SEQ0(GC0308_ANALOG_MODE1, 0x2a),
> +	REG_SEQ0(GC0308_ANALOG_MODE2, 0x00),
> +	REG_SEQ0(GC0308_HRST_RSG_V18, 0x49),
> +	REG_SEQ0(GC0308_VREF_V25, 0x9a),
> +	REG_SEQ0(GC0308_ADC_R, 0x61),
> +	REG_SEQ0(GC0308_PAD_DRV, 0x01), /* drv strength: pclk=4mA */
> +	REG_SEQ0(GC0308_BLOCK_EN1, 0x7f),
> +	REG_SEQ0(GC0308_BLOCK_EN2, 0xfa),
> +	REG_SEQ0(GC0308_AAAA_EN, 0x57),
> +	REG_SEQ0(GC0308_OUT_FORMAT, 0xa2), /* YCbYCr */
> +	REG_SEQ0(GC0308_OUT_EN, 0x0f),
> +	REG_SEQ0(GC0308_SYNC_MODE, 0x03),
> +	REG_SEQ0(GC0308_CLK_DIV_MODE, 0x00),
> +	REG_SEQ0(GC0308_DEBUG_MODE1, 0x0a),
> +	REG_SEQ0(GC0308_DEBUG_MODE2, 0x00),
> +	REG_SEQ0(GC0308_DEBUG_MODE3, 0x01),
> +	REG_SEQ0(GC0308_BLK_MODE, 0xf7),
> +	REG_SEQ0(GC0308_BLK_LIMIT_VAL, 0x50),
> +	REG_SEQ0(GC0308_GLOBAL_OFF, 0x00),
> +	REG_SEQ0(GC0308_CURRENT_R_OFF, 0x28),
> +	REG_SEQ0(GC0308_CURRENT_G_OFF, 0x2a),
> +	REG_SEQ0(GC0308_CURRENT_B_OFF, 0x28),
> +	REG_SEQ0(GC0308_EXP_RATE_DARKC, 0x04),
> +	REG_SEQ0(GC0308_OFF_SUBMODE, 0x20),
> +	REG_SEQ0(GC0308_DARKC_SUBMODE, 0x20),
> +	REG_SEQ0(GC0308_MANUAL_G1_OFF, 0x00),
> +	REG_SEQ0(GC0308_MANUAL_R1_OFF, 0x00),
> +	REG_SEQ0(GC0308_MANUAL_B2_OFF, 0x00),
> +	REG_SEQ0(GC0308_MANUAL_G2_OFF, 0x00),
> +	REG_SEQ0(GC0308_GLOBAL_GAIN, 0x14),
> +	REG_SEQ0(GC0308_AUTO_POSTGAIN, 0x41),
> +	REG_SEQ0(GC0308_CHANNEL_GAIN_G1, 0x80),
> +	REG_SEQ0(GC0308_CHANNEL_GAIN_R, 0x80),
> +	REG_SEQ0(GC0308_CHANNEL_GAIN_B, 0x80),
> +	REG_SEQ0(GC0308_CHANNEL_GAIN_G2, 0x80),
> +	REG_SEQ0(GC0308_LSC_RED_B2, 0x20),
> +	REG_SEQ0(GC0308_LSC_GREEN_B2, 0x20),
> +	REG_SEQ0(GC0308_LSC_BLUE_B2, 0x20),
> +	REG_SEQ0(GC0308_LSC_RED_B4, 0x14),
> +	REG_SEQ0(GC0308_LSC_GREEN_B4, 0x10),
> +	REG_SEQ0(GC0308_LSC_BLUE_B4, 0x14),
> +	REG_SEQ0(GC0308_LSC_ROW_CENTER, 0x3c),
> +	REG_SEQ0(GC0308_LSC_COL_CENTER, 0x50),
> +	REG_SEQ0(GC0308_LSC_DEC_LVL1, 0x12),
> +	REG_SEQ0(GC0308_LSC_DEC_LVL2, 0x1a),
> +	REG_SEQ0(GC0308_LSC_DEC_LVL3, 0x24),
> +	REG_SEQ0(GC0308_DN_MODE_EN, 0x07),
> +	REG_SEQ0(GC0308_DN_MODE_RATIO, 0x15),
> +	REG_SEQ0(GC0308_DN_BILAT_B_BASE, 0x08),
> +	REG_SEQ0(GC0308_DN_BILAT_N_BASE, 0x03),
> +	REG_SEQ0(GC0308_DD_DARK_BRIGHT_TH, 0xe8),
> +	REG_SEQ0(GC0308_DD_FLAT_TH, 0x86),
> +	REG_SEQ0(GC0308_DD_LIMIT, 0x82),
> +	REG_SEQ0(GC0308_ASDE_GAIN_TRESH, 0x18),
> +	REG_SEQ0(GC0308_ASDE_GAIN_MODE, 0x0f),
> +	REG_SEQ0(GC0308_ASDE_DN_SLOPE, 0x00),
> +	REG_SEQ0(GC0308_ASDE_DD_BRIGHT, 0x5f),
> +	REG_SEQ0(GC0308_ASDE_DD_LIMIT, 0x8f),
> +	REG_SEQ0(GC0308_ASDE_AUTO_EE1, 0x55),
> +	REG_SEQ0(GC0308_ASDE_AUTO_EE2, 0x38),
> +	REG_SEQ0(GC0308_ASDE_AUTO_SAT_DEC_SLOPE, 0x15),
> +	REG_SEQ0(GC0308_ASDE_AUTO_SAT_LOW_LIMIT, 0x33),
> +	REG_SEQ0(GC0308_EEINTP_MODE_1, 0xdc),
> +	REG_SEQ0(GC0308_EEINTP_MODE_2, 0x00),
> +	REG_SEQ0(GC0308_DIRECTION_TH1, 0x02),
> +	REG_SEQ0(GC0308_DIRECTION_TH2, 0x3f),
> +	REG_SEQ0(GC0308_DIFF_HV_TI_TH, 0x02),
> +	REG_SEQ0(GC0308_EDGE12_EFFECT, 0x38),
> +	REG_SEQ0(GC0308_EDGE_POS_RATIO, 0x88),
> +	REG_SEQ0(GC0308_EDGE1_MINMAX, 0x81),
> +	REG_SEQ0(GC0308_EDGE2_MINMAX, 0x81),
> +	REG_SEQ0(GC0308_EDGE12_TH, 0x22),
> +	REG_SEQ0(GC0308_EDGE_MAX, 0xff),
> +	REG_SEQ0(GC0308_CC_MATRIX_C11, 0x48),
> +	REG_SEQ0(GC0308_CC_MATRIX_C12, 0x02),
> +	REG_SEQ0(GC0308_CC_MATRIX_C13, 0x07),
> +	REG_SEQ0(GC0308_CC_MATRIX_C21, 0xe0),
> +	REG_SEQ0(GC0308_CC_MATRIX_C22, 0x40),
> +	REG_SEQ0(GC0308_CC_MATRIX_C23, 0xf0),
> +	REG_SEQ0(GC0308_SATURATION_CB, 0x40),
> +	REG_SEQ0(GC0308_SATURATION_CR, 0x40),
> +	REG_SEQ0(GC0308_LUMA_CONTRAST, 0x40),
> +	REG_SEQ0(GC0308_SKIN_CB_CENTER, 0xe0),
> +	REG_SEQ0(GC0308_EDGE_DEC_SA, 0x38),
> +	REG_SEQ0(GC0308_AUTO_GRAY_MODE, 0x36),
> +	REG_SEQ0(GC0308_AEC_MODE1, 0xcb),
> +	REG_SEQ0(GC0308_AEC_MODE2, 0x10),
> +	REG_SEQ0(GC0308_AEC_MODE3, 0x90),
> +	REG_SEQ0(GC0308_AEC_TARGET_Y, 0x48),
> +	REG_SEQ0(GC0308_AEC_HIGH_LOW_RANGE, 0xf2),
> +	REG_SEQ0(GC0308_AEC_IGNORE, 0x16),
> +	REG_SEQ0(GC0308_AEC_SLOW_MARGIN, 0x92),
> +	REG_SEQ0(GC0308_AEC_FAST_MARGIN, 0xa5),
> +	REG_SEQ0(GC0308_AEC_I_FRAMES, 0x23),
> +	REG_SEQ0(GC0308_AEC_R_OFFSET, 0x00),
> +	REG_SEQ0(GC0308_AEC_GB_OFFSET, 0x00),
> +	REG_SEQ0(GC0308_AEC_I_STOP_L_MARGIN, 0x09),
> +	REG_SEQ0(GC0308_EXP_MIN_L, 0x04),
> +	REG_SEQ0(GC0308_MAX_POST_DF_GAIN, 0xa0),
> +	REG_SEQ0(GC0308_MAX_PRE_DG_GAIN, 0x40),
> +	REG_SEQ0(GC0308_ABB_MODE, 0x03),
> +	REG_SEQ0(GC0308_GAMMA_OUT0, 0x10),
> +	REG_SEQ0(GC0308_GAMMA_OUT1, 0x20),
> +	REG_SEQ0(GC0308_GAMMA_OUT2, 0x38),
> +	REG_SEQ0(GC0308_GAMMA_OUT3, 0x4e),
> +	REG_SEQ0(GC0308_GAMMA_OUT4, 0x63),
> +	REG_SEQ0(GC0308_GAMMA_OUT5, 0x76),
> +	REG_SEQ0(GC0308_GAMMA_OUT6, 0x87),
> +	REG_SEQ0(GC0308_GAMMA_OUT7, 0xa2),
> +	REG_SEQ0(GC0308_GAMMA_OUT8, 0xb8),
> +	REG_SEQ0(GC0308_GAMMA_OUT9, 0xca),
> +	REG_SEQ0(GC0308_GAMMA_OUT10, 0xd8),
> +	REG_SEQ0(GC0308_GAMMA_OUT11, 0xe3),
> +	REG_SEQ0(GC0308_GAMMA_OUT12, 0xeb),
> +	REG_SEQ0(GC0308_GAMMA_OUT13, 0xf0),
> +	REG_SEQ0(GC0308_GAMMA_OUT14, 0xf8),
> +	REG_SEQ0(GC0308_GAMMA_OUT15, 0xfd),
> +	REG_SEQ0(GC0308_GAMMA_OUT16, 0xff),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT0, 0x00),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT1, 0x10),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT2, 0x1c),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT3, 0x30),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT4, 0x43),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT5, 0x54),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT6, 0x65),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT7, 0x75),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT8, 0x93),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT9, 0xb0),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT10, 0xcb),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT11, 0xe6),
> +	REG_SEQ0(GC0308_Y_GAMMA_OUT12, 0xff),
> +	REG_SEQ0(GC0308_ABS_RANGE_COMP, 0x02),
> +	REG_SEQ0(GC0308_ABS_STOP_MARGIN, 0x01),
> +	REG_SEQ0(GC0308_Y_S_COMP, 0x02),
> +	REG_SEQ0(GC0308_Y_STRETCH_LIMIT, 0x30),
> +	REG_SEQ0(GC0308_BIG_WIN_X0, 0x12),
> +	REG_SEQ0(GC0308_BIG_WIN_Y0, 0x0a),
> +	REG_SEQ0(GC0308_BIG_WIN_X1, 0x9f),
> +	REG_SEQ0(GC0308_BIG_WIN_Y1, 0x78),
> +	REG_SEQ0(GC0308_AWB_RGB_HIGH_LOW, 0xf5),
> +	REG_SEQ0(GC0308_AWB_Y_TO_C_DIFF2, 0x20),
> +	REG_SEQ0(GC0308_AWB_C_MAX, 0x10),
> +	REG_SEQ0(GC0308_AWB_C_INTER, 0x08),
> +	REG_SEQ0(GC0308_AWB_C_INTER2, 0x20),
> +	REG_SEQ0(GC0308_AWB_C_MAX_BIG, 0x0a),
> +	REG_SEQ0(GC0308_AWB_NUMBER_LIMIT, 0xa0),
> +	REG_SEQ0(GC0308_KWIN_RATIO, 0x60),
> +	REG_SEQ0(GC0308_KWIN_THD, 0x08),
> +	REG_SEQ0(GC0308_SMALL_WIN_WIDTH_STEP, 0x44),
> +	REG_SEQ0(GC0308_SMALL_WIN_HEIGHT_STEP, 0x32),
> +	REG_SEQ0(GC0308_AWB_YELLOW_TH, 0x41),
> +	REG_SEQ0(GC0308_AWB_MODE, 0x37),
> +	REG_SEQ0(GC0308_AWB_ADJUST_SPEED, 0x22),
> +	REG_SEQ0(GC0308_AWB_EVERY_N, 0x19),
> +	REG_SEQ0(0x114, 0x44), /* AWB set1 */
> +	REG_SEQ0(0x115, 0x44), /* AWB set1 */
> +	REG_SEQ0(0x116, 0xc2), /* AWB set1 */
> +	REG_SEQ0(0x117, 0xa8), /* AWB set1 */
> +	REG_SEQ0(0x118, 0x18), /* AWB set1 */
> +	REG_SEQ0(0x119, 0x50), /* AWB set1 */
> +	REG_SEQ0(0x11a, 0xd8), /* AWB set1 */
> +	REG_SEQ0(0x11b, 0xf5), /* AWB set1 */
> +	REG_SEQ0(0x170, 0x40), /* AWB set2 */
> +	REG_SEQ0(0x171, 0x58), /* AWB set2 */
> +	REG_SEQ0(0x172, 0x30), /* AWB set2 */
> +	REG_SEQ0(0x173, 0x48), /* AWB set2 */
> +	REG_SEQ0(0x174, 0x20), /* AWB set2 */
> +	REG_SEQ0(0x175, 0x60), /* AWB set2 */
> +	REG_SEQ0(0x177, 0x20), /* AWB set2 */
> +	REG_SEQ0(0x178, 0x32), /* AWB set2 */
> +	REG_SEQ0(0x130, 0x03), /* undocumented */
> +	REG_SEQ0(0x131, 0x40), /* undocumented */
> +	REG_SEQ0(0x132, 0x10), /* undocumented */
> +	REG_SEQ0(0x133, 0xe0), /* undocumented */
> +	REG_SEQ0(0x134, 0xe0), /* undocumented */
> +	REG_SEQ0(0x135, 0x00), /* undocumented */
> +	REG_SEQ0(0x136, 0x80), /* undocumented */
> +	REG_SEQ0(0x137, 0x00), /* undocumented */
> +	REG_SEQ0(0x138, 0x04), /* undocumented */
> +	REG_SEQ0(0x139, 0x09), /* undocumented */
> +	REG_SEQ0(0x13a, 0x12), /* undocumented */
> +	REG_SEQ0(0x13b, 0x1c), /* undocumented */
> +	REG_SEQ0(0x13c, 0x28), /* undocumented */
> +	REG_SEQ0(0x13d, 0x31), /* undocumented */
> +	REG_SEQ0(0x13e, 0x44), /* undocumented */
> +	REG_SEQ0(0x13f, 0x57), /* undocumented */
> +	REG_SEQ0(0x140, 0x6c), /* undocumented */
> +	REG_SEQ0(0x141, 0x81), /* undocumented */
> +	REG_SEQ0(0x142, 0x94), /* undocumented */
> +	REG_SEQ0(0x143, 0xa7), /* undocumented */
> +	REG_SEQ0(0x144, 0xb8), /* undocumented */
> +	REG_SEQ0(0x145, 0xd6), /* undocumented */
> +	REG_SEQ0(0x146, 0xee), /* undocumented */
> +	REG_SEQ0(0x147, 0x0d), /* undocumented */
> +	REG_SEQ0(0x162, 0xf7), /* undocumented */
> +	REG_SEQ0(0x163, 0x68), /* undocumented */
> +	REG_SEQ0(0x164, 0xd3), /* undocumented */
> +	REG_SEQ0(0x165, 0xd3), /* undocumented */
> +	REG_SEQ0(0x166, 0x60), /* undocumented */
> +};
> +
> +struct gc0308_colormode {
> +	u8 special_effect;
> +	u8 dbg_mode1;
> +	u8 block_en1;
> +	u8 aec_mode3;
> +	u8 eeintp_mode_2;
> +	u8 edge12_effect;
> +	u8 luma_contrast;
> +	u8 contrast_center;
> +	u8 fixed_cb;
> +	u8 fixed_cr;
> +};
> +
> +#define GC0308_COLOR_FX(reg_special_effect, reg_dbg_mode1, reg_block_en1, \
> +			reg_aec_mode3, reg_eeintp_mode_2, reg_edge12_effect, \
> +			reg_luma_contrast, reg_contrast_center, \
> +			reg_fixed_cb, reg_fixed_cr) \
> +	{ \
> +		.special_effect = reg_special_effect, \
> +		.dbg_mode1 = reg_dbg_mode1, \
> +		.block_en1 = reg_block_en1, \
> +		.aec_mode3 = reg_aec_mode3, \
> +		.eeintp_mode_2 = reg_eeintp_mode_2, \
> +		.edge12_effect = reg_edge12_effect, \
> +		.luma_contrast = reg_luma_contrast, \
> +		.contrast_center = reg_contrast_center, \
> +		.fixed_cb = reg_fixed_cb, \
> +		.fixed_cr = reg_fixed_cr, \
> +	}
> +
> +static const struct gc0308_colormode gc0308_colormodes[] = {
> +	[V4L2_COLORFX_NONE] =
> +		GC0308_COLOR_FX(0x00, 0x0a, 0xff, 0x90, 0x00,
> +				0x54, 0x3c, 0x80, 0x00, 0x00),
> +	[V4L2_COLORFX_BW] =
> +		GC0308_COLOR_FX(0x02, 0x0a, 0xff, 0x90, 0x00,
> +				0x54, 0x40, 0x80, 0x00, 0x00),
> +	[V4L2_COLORFX_SEPIA] =
> +		GC0308_COLOR_FX(0x02, 0x0a, 0xff, 0x90, 0x00,
> +				0x38, 0x40, 0x80, 0xd0, 0x28),
> +	[V4L2_COLORFX_NEGATIVE] =
> +		GC0308_COLOR_FX(0x01, 0x0a, 0xff, 0x90, 0x00,
> +				0x38, 0x40, 0x80, 0x00, 0x00),
> +	[V4L2_COLORFX_EMBOSS] =
> +		GC0308_COLOR_FX(0x02, 0x0a, 0xbf, 0x10, 0x01,
> +				0x38, 0x40, 0x80, 0x00, 0x00),
> +	[V4L2_COLORFX_SKETCH] =
> +		GC0308_COLOR_FX(0x02, 0x0a, 0xff, 0x10, 0x80,
> +				0x38, 0x80, 0x90, 0x00, 0x00),
> +	[V4L2_COLORFX_SKY_BLUE] =
> +		GC0308_COLOR_FX(0x02, 0x0a, 0xff, 0x90, 0x00,
> +				0x38, 0x40, 0x80, 0x50, 0xe0),
> +	[V4L2_COLORFX_GRASS_GREEN] =
> +		GC0308_COLOR_FX(0x02, 0x0a, 0xff, 0x90, 0x01,
> +				0x38, 0x40, 0x80, 0xc0, 0xc0),
> +	[V4L2_COLORFX_SKIN_WHITEN] =
> +		GC0308_COLOR_FX(0x02, 0x0a, 0xbf, 0x10, 0x01,
> +				0x38, 0x60, 0x40, 0x00, 0x00),
> +};
> +
> +static const struct reg_sequence sensor_banding_50hz[] = {
> +	REG_SEQ0(GC0308_ANTI_FLICKER_STEP_L, 0x78),
> +	REG_SEQ0(GC0308_EXP_LVL_1H, 0x02),
> +	REG_SEQ0(GC0308_EXP_LVL_1L, 0x58),
> +	REG_SEQ0(GC0308_EXP_LVL_2H, 0x03),
> +	REG_SEQ0(GC0308_EXP_LVL_2L, 0x48),
> +	REG_SEQ0(GC0308_EXP_LVL_3H, 0x04),
> +	REG_SEQ0(GC0308_EXP_LVL_3L, 0xb0),
> +	REG_SEQ0(GC0308_EXP_LVL_4H, 0x05),
> +	REG_SEQ0(GC0308_EXP_LVL_4L, 0xa0),
> +};
> +
> +static const struct reg_sequence sensor_banding_60hz[] = {
> +	REG_SEQ0(GC0308_ANTI_FLICKER_STEP_L, 0x64),
> +	REG_SEQ0(GC0308_EXP_LVL_1H, 0x02),
> +	REG_SEQ0(GC0308_EXP_LVL_1L, 0x58),
> +	REG_SEQ0(GC0308_EXP_LVL_2H, 0x03),
> +	REG_SEQ0(GC0308_EXP_LVL_2L, 0x84),
> +	REG_SEQ0(GC0308_EXP_LVL_3H, 0x04),
> +	REG_SEQ0(GC0308_EXP_LVL_3L, 0xb0),
> +	REG_SEQ0(GC0308_EXP_LVL_4H, 0x05),
> +	REG_SEQ0(GC0308_EXP_LVL_4L, 0xdc),
> +};
> +
> +static int gc0308_power_on(struct device *dev)
> +{
> +	struct gc0308 *gc0308 = dev_get_drvdata(dev);
> +	int ret;
> +
> +	ret = clk_prepare_enable(gc0308->clk);
> +	if (ret)
> +		return ret;
> +
> +	gpiod_set_value_cansleep(gc0308->pwdn_gpio, 0);
> +	usleep_range(10000, 20000);
> +
> +	gpiod_set_value_cansleep(gc0308->reset_gpio, 1);
> +	msleep(100);
> +	gpiod_set_value_cansleep(gc0308->reset_gpio, 0);
> +	msleep(100);
> +
> +	return 0;
> +}
> +
> +static int gc0308_power_off(struct device *dev)
> +{
> +	struct gc0308 *gc0308 = dev_get_drvdata(dev);
> +
> +	gpiod_set_value_cansleep(gc0308->pwdn_gpio, 1);
> +	clk_disable_unprepare(gc0308->clk);
> +
> +	return 0;
> +}
> +
> +#ifdef CONFIG_VIDEO_ADV_DEBUG
> +static int gc0308_g_register(struct v4l2_subdev *sd,
> +			     struct v4l2_dbg_register *reg)
> +{
> +	struct gc0308 *gc0308 = to_gc0308(sd);
> +	int ret, val;
> +
> +	ret = regmap_read(gc0308->regmap, reg->reg, &val);
> +	if (ret)
> +		return ret;
> +
> +	reg->val = val;
> +	return 0;
> +}
> +
> +static int gc0308_s_register(struct v4l2_subdev *sd,
> +			     const struct v4l2_dbg_register *reg)
> +{
> +	struct gc0308 *gc0308 = to_gc0308(sd);
> +
> +	return regmap_write(gc0308->regmap, reg->reg, reg->val);
> +}
> +#endif
> +
> +static int gc0308_s_format(struct gc0308 *gc0308)
> +{
> +	u32 i;
> +
> +	for (i = 0; i < ARRAY_SIZE(gc0308_formats); i++) {
> +		if (gc0308->format.code != gc0308_formats[i].code)
> +			continue;
> +		return regmap_update_bits(gc0308->regmap,
> +					  GC0308_OUT_FORMAT, GENMASK(4, 0),
> +					  gc0308_formats[i].regval);
> +	}
> +
> +	return -EINVAL;
> +}
> +
> +static int gc0308_set_exposure(struct gc0308 *gc0308, enum gc0308_exp_val exp)
> +{
> +	const struct gc0308_exposure *regs = &gc0308_exposure_values[exp];
> +	struct reg_sequence exposure_reg_seq[] = {
> +		REG_SEQ0(GC0308_LUMA_OFFSET, regs->luma_offset),
> +		REG_SEQ0(GC0308_AEC_TARGET_Y, regs->aec_target_y),
> +	};
> +
> +	return regmap_multi_reg_write(gc0308->regmap,
> +		exposure_reg_seq, ARRAY_SIZE(exposure_reg_seq));
> +}
> +
> +static int gc0308_set_awb_mode(struct gc0308 *gc0308,
> +			       enum v4l2_auto_n_preset_white_balance val)
> +{
> +	const struct gc0308_awb_gains *regs = &gc0308_awb_gains[val];
> +	struct reg_sequence awb_reg_seq[] = {
> +		REG_SEQ0(GC0308_AWB_R_GAIN, regs->r),
> +		REG_SEQ0(GC0308_AWB_G_GAIN, regs->g),
> +		REG_SEQ0(GC0308_AWB_B_GAIN, regs->b),
> +	};
> +	int ret;
> +
> +	ret = regmap_update_bits(gc0308->regmap, GC0308_AAAA_EN,
> +				 BIT(1), val == V4L2_WHITE_BALANCE_AUTO);
> +	if (ret)
> +		return ret;
> +
> +	return regmap_multi_reg_write(gc0308->regmap,
> +		awb_reg_seq, ARRAY_SIZE(awb_reg_seq));
> +
> +	return 0;
> +}
> +
> +static int gc0308_set_colormode(struct gc0308 *gc0308, enum v4l2_colorfx mode)
> +{
> +	const struct gc0308_colormode *regs = &gc0308_colormodes[mode];
> +	struct reg_sequence colormode_reg_seq[] = {
> +		REG_SEQ0(GC0308_SPECIAL_EFFECT, regs->special_effect),
> +		REG_SEQ0(GC0308_DEBUG_MODE1, regs->dbg_mode1),
> +		REG_SEQ0(GC0308_BLOCK_EN1, regs->block_en1),
> +		REG_SEQ0(GC0308_AEC_MODE3, regs->aec_mode3),
> +		REG_SEQ0(GC0308_EEINTP_MODE_2, regs->eeintp_mode_2),
> +		REG_SEQ0(GC0308_EDGE12_EFFECT, regs->edge12_effect),
> +		REG_SEQ0(GC0308_LUMA_CONTRAST, regs->luma_contrast),
> +		REG_SEQ0(GC0308_CONTRAST_CENTER, regs->contrast_center),
> +		REG_SEQ0(GC0308_FIXED_CB, regs->fixed_cb),
> +		REG_SEQ0(GC0308_FIXED_CR, regs->fixed_cr),
> +	};
> +
> +	return regmap_multi_reg_write(gc0308->regmap,
> +		colormode_reg_seq, ARRAY_SIZE(colormode_reg_seq));
> +}
> +
> +static int _gc0308_s_ctrl(struct v4l2_ctrl *ctrl)
> +{
> +	struct gc0308 *gc0308 = container_of(ctrl->handler, struct gc0308, hdl);
> +	uint8_t flipval = ctrl->val ? 0xff : 0x00;
> +
> +	switch (ctrl->id) {
> +	case V4L2_CID_VFLIP:
> +		return regmap_update_bits(gc0308->regmap,
> +			GC0308_CISCTL_MODE1, BIT(1), flipval);
> +	case V4L2_CID_HFLIP:
> +		return regmap_update_bits(gc0308->regmap,
> +			GC0308_CISCTL_MODE1, BIT(0), flipval);
> +	case V4L2_CID_AUTO_WHITE_BALANCE:
> +		return regmap_update_bits(gc0308->regmap,
> +			GC0308_AAAA_EN, BIT(1), flipval);
> +	case V4L2_CID_AUTO_N_PRESET_WHITE_BALANCE:
> +		if (ctrl->val < 0 || ctrl->val > V4L2_WHITE_BALANCE_CLOUDY)
> +			return -EINVAL;
> +		return gc0308_set_awb_mode(gc0308, ctrl->val);
> +	case V4L2_CID_POWER_LINE_FREQUENCY:
> +		switch (ctrl->val) {
> +		case V4L2_CID_POWER_LINE_FREQUENCY_60HZ:
> +			return regmap_multi_reg_write(gc0308->regmap,
> +				sensor_banding_60hz,
> +				ARRAY_SIZE(sensor_banding_60hz));
> +		case V4L2_CID_POWER_LINE_FREQUENCY_50HZ:
> +		default:
> +			return regmap_multi_reg_write(gc0308->regmap,
> +				sensor_banding_50hz,
> +				ARRAY_SIZE(sensor_banding_50hz));
> +		}
> +	case V4L2_CID_COLORFX:
> +		if (ctrl->val < 0 || ctrl->val >= ARRAY_SIZE(gc0308_colormodes))
> +			return -EINVAL;
> +		return gc0308_set_colormode(gc0308, ctrl->val);
> +	case V4L2_CID_TEST_PATTERN:
> +		if (ctrl->val < 0 || ctrl->val > 2)
> +			return -EINVAL;
> +		return regmap_update_bits(gc0308->regmap,
> +			GC0308_DEBUG_MODE2, GENMASK(1, 0), ctrl->val);
> +	case V4L2_CID_EXPOSURE:
> +		if (ctrl->val < -4 || ctrl->val > 4)
> +			return -EINVAL;
> +		return gc0308_set_exposure(gc0308, ctrl->val + 4);
> +	}
> +
> +	return -EINVAL;
> +}
> +
> +static int gc0308_s_ctrl(struct v4l2_ctrl *ctrl)
> +{
> +	struct gc0308 *gc0308 = container_of(ctrl->handler, struct gc0308, hdl);
> +	int ret;
> +
> +	ret = pm_runtime_resume_and_get(gc0308->dev);
> +	if (ret < 0)
> +		return ret;
> +
> +	ret = _gc0308_s_ctrl(ctrl);
> +
> +	pm_runtime_put(gc0308->dev);
> +
> +	if (ret)
> +		dev_err(gc0308->dev, "s_ctrl failed: %d\n", ret);
> +
> +	return ret;
> +}
> +
> +
> +static const struct v4l2_ctrl_ops gc0308_ctrl_ops = {
> +	.s_ctrl = gc0308_s_ctrl,
> +};
> +
> +static const struct v4l2_subdev_core_ops gc0308_core_ops = {
> +	.log_status = v4l2_ctrl_subdev_log_status,
> +	.subscribe_event = v4l2_ctrl_subdev_subscribe_event,
> +	.unsubscribe_event = v4l2_event_subdev_unsubscribe,
> +#ifdef CONFIG_VIDEO_ADV_DEBUG
> +	.g_register	= gc0308_g_register,
> +	.s_register	= gc0308_s_register,
> +#endif
> +};
> +
> +static int gc0308_enum_mbus_code(struct v4l2_subdev *sd,
> +				 struct v4l2_subdev_state *sd_state,
> +				 struct v4l2_subdev_mbus_code_enum *code)
> +{
> +	if (code->index >= ARRAY_SIZE(gc0308_formats))
> +		return -EINVAL;
> +
> +	code->code = gc0308_formats[code->index].code;
> +
> +	return 0;
> +}
> +
> +static int gc0308_enum_frame_size(struct v4l2_subdev *subdev,
> +				  struct v4l2_subdev_state *sd_state,
> +				  struct v4l2_subdev_frame_size_enum *fse)
> +{
> +	if (fse->pad || fse->index >= ARRAY_SIZE(gc0308_frame_sizes))
> +		return -EINVAL;
> +
> +	fse->min_width = gc0308_frame_sizes[fse->index].width;
> +	fse->max_width = gc0308_frame_sizes[fse->index].width;
> +	fse->min_height = gc0308_frame_sizes[fse->index].height;
> +	fse->max_height = gc0308_frame_sizes[fse->index].height;
> +
> +	return 0;
> +}
> +
> +static int gc0308_get_format(struct v4l2_subdev *sd,
> +			     struct v4l2_subdev_state *sd_state,
> +			     struct v4l2_subdev_format *fmt)
> +{
> +	struct gc0308 *gc0308 = to_gc0308(sd);
> +
> +	mutex_lock(&gc0308->lock);
> +	fmt->format = gc0308->format;
> +	mutex_unlock(&gc0308->lock);
> +
> +	return 0;
> +}
> +
> +static int gc0308_set_format(struct v4l2_subdev *sd,
> +			     struct v4l2_subdev_state *sd_state,
> +			     struct v4l2_subdev_format *format)
> +{
> +	struct gc0308 *gc0308 = to_gc0308(sd);
> +	int format_idx = -1;
> +	unsigned int best_fit = ~0L;
> +	unsigned int idx = 0;
> +	unsigned int i;
> +
> +	mutex_lock(&gc0308->lock);
> +	if (gc0308->streaming) {
> +		mutex_unlock(&gc0308->lock);
> +		return -EBUSY;
> +	}
> +
> +	if (format->pad) {
> +		mutex_unlock(&gc0308->lock);
> +		dev_err(gc0308->dev, "invalid pad: %d\n", format->pad);
> +		return -EINVAL;
> +	}
> +
> +	for (i = 0; i < ARRAY_SIZE(gc0308_formats); i++) {
> +		if (format->format.code == gc0308_formats[i].code) {
> +			format_idx = i;
> +			break;
> +		}
> +	}
> +	if (format_idx < 0) {
> +		mutex_unlock(&gc0308->lock);
> +		dev_err(gc0308->dev, "unsupported format code: %08x\n",
> +			format->format.code);
> +		return -EINVAL;
> +	}
> +
> +	for (i = 0; i < ARRAY_SIZE(gc0308_frame_sizes); i++) {
> +		unsigned int width = gc0308_frame_sizes[i].width;
> +		unsigned int height = gc0308_frame_sizes[i].height;
> +		unsigned int fit = abs(width - format->format.width) +
> +				   abs(height - format->format.height);
> +		if (fit < best_fit) {
> +			best_fit = fit;
> +			idx = i;
> +
> +			if (fit == 0)
> +				break;
> +		}
> +	}
> +
> +	gc0308->format.width = gc0308_frame_sizes[idx].width;
> +	gc0308->format.height = gc0308_frame_sizes[idx].height;
> +	gc0308->format.code = gc0308_formats[format_idx].code;
> +	gc0308->format.field = V4L2_FIELD_NONE;
> +	gc0308->format.colorspace = V4L2_COLORSPACE_SRGB;
> +
> +	mutex_unlock(&gc0308->lock);
> +
> +	return 0;
> +}
> +
> +static int gc0308_get_mbus_config(struct v4l2_subdev *sd,
> +				  unsigned int pad,
> +				  struct v4l2_mbus_config *cfg)
> +{
> +	struct gc0308 *gc0308 = to_gc0308(sd);
> +
> +	mutex_lock(&gc0308->lock);
> +	cfg->type = V4L2_MBUS_PARALLEL,
> +	cfg->bus.parallel.flags = V4L2_MBUS_PCLK_SAMPLE_RISING |
> +				  V4L2_MBUS_DATA_ACTIVE_HIGH |
> +				  V4L2_MBUS_MASTER;
> +
> +	if (gc0308->mbus_config & V4L2_MBUS_VSYNC_ACTIVE_LOW)
> +		cfg->bus.parallel.flags |= V4L2_MBUS_VSYNC_ACTIVE_LOW;
> +	else
> +		cfg->bus.parallel.flags |= V4L2_MBUS_VSYNC_ACTIVE_HIGH;
> +
> +	if (gc0308->mbus_config & V4L2_MBUS_HSYNC_ACTIVE_LOW)
> +		cfg->bus.parallel.flags |= V4L2_MBUS_HSYNC_ACTIVE_LOW;
> +	else
> +		cfg->bus.parallel.flags |= V4L2_MBUS_HSYNC_ACTIVE_HIGH;
> +
> +
> +	mutex_unlock(&gc0308->lock);
> +
> +	return 0;
> +}
> +
> +static const struct v4l2_subdev_pad_ops gc0308_pad_ops = {
> +	.enum_mbus_code = gc0308_enum_mbus_code,
> +	.enum_frame_size = gc0308_enum_frame_size,
> +	.get_fmt = gc0308_get_format,
> +	.set_fmt = gc0308_set_format,
> +	.get_mbus_config = gc0308_get_mbus_config,
> +};
> +
> +static int gc0308_set_resolution(struct gc0308 *gc0308,
> +				 u8 subsample, u16 w, u16 h)
> +{
> +	struct reg_sequence resolution_regs[] = {
> +		REG_SEQ0(GC0308_SUBSAMPLE, subsample),
> +		REG_SEQ0(GC0308_SUBMODE, 0x03),
> +		REG_SEQ0(GC0308_SUB_ROW_N1, 0x00),
> +		REG_SEQ0(GC0308_SUB_ROW_N2, 0x00),
> +		REG_SEQ0(GC0308_SUB_COL_N1, 0x00),
> +		REG_SEQ0(GC0308_SUB_COL_N2, 0x00),
> +		REG_SEQ0(GC0308_CROP_WIN_MODE, 0x80),
> +		REG_SEQ0(GC0308_CROP_WIN_Y1, 0x00),
> +		REG_SEQ0(GC0308_CROP_WIN_X1, 0x00),
> +		REG_SEQ0(GC0308_CROP_WIN_HEIGHTH, (h >> 8) & 0xFF),
> +		REG_SEQ0(GC0308_CROP_WIN_HEIGHTL, (h >> 0) & 0xFF),
> +		REG_SEQ0(GC0308_CROP_WIN_WIDTHH, (w >> 8) & 0xFF),
> +		REG_SEQ0(GC0308_CROP_WIN_WIDTHL, (w >> 0) & 0xFF),
> +	};
> +
> +	return regmap_multi_reg_write(gc0308->regmap, resolution_regs,
> +				      ARRAY_SIZE(resolution_regs));
> +}
> +
> +static int gc0308_start_stream(struct gc0308 *gc0308)
> +{
> +	int ret, sync_mode;
> +	u16 width = 0, height = 0;
> +	u8 subsample = 0;
> +	int i;
> +
> +	ret = pm_runtime_resume_and_get(gc0308->dev);
> +	if (ret < 0)
> +		return ret;
> +
> +	ret = regmap_multi_reg_write(gc0308->regmap, sensor_default_regs,
> +				     ARRAY_SIZE(sensor_default_regs));
> +	if (ret) {
> +		dev_err(gc0308->dev, "failed to write default regs\n");
> +		goto disable_pm;
> +	}
> +
> +	ret = gc0308_s_format(gc0308);
> +	if (ret) {
> +		dev_err(gc0308->dev, "failed to set format\n");
> +		goto disable_pm;
> +	}
> +
> +	for (i = 0; i < ARRAY_SIZE(gc0308_frame_sizes); i++) {
> +		if (gc0308_frame_sizes[i].width == gc0308->format.width &&
> +		    gc0308_frame_sizes[i].height == gc0308->format.height) {
> +			width = gc0308_frame_sizes[i].width;
> +			height = gc0308_frame_sizes[i].height;
> +			subsample = gc0308_frame_sizes[i].subsample;
> +		}
> +	}
> +
> +	if (!width || !height) {
> +		dev_err(gc0308->dev, "invalid resolution\n");
> +		goto disable_pm;
> +	}
> +
> +	ret = gc0308_set_resolution(gc0308, subsample, width, height);
> +	if (ret) {
> +		dev_err(gc0308->dev, "failed to write resolution regs\n");
> +		goto disable_pm;
> +	}
> +
> +	ret = __v4l2_ctrl_handler_setup(&gc0308->hdl);
> +	if (ret) {
> +		dev_err(gc0308->dev, "failed to setup controls\n");
> +		goto disable_pm;
> +	}
> +
> +	/* HSYNC/VSYNC polarity */
> +	sync_mode = 0x3;
> +	if (gc0308->mbus_config & V4L2_MBUS_VSYNC_ACTIVE_LOW)
> +		sync_mode &= ~BIT(0);
> +	if (gc0308->mbus_config & V4L2_MBUS_HSYNC_ACTIVE_LOW)
> +		sync_mode &= ~BIT(1);
> +	ret = regmap_write(gc0308->regmap, GC0308_SYNC_MODE, sync_mode);
> +	if (ret)
> +		goto disable_pm;
> +
> +	return 0;
> +
> +disable_pm:
> +	pm_runtime_put(gc0308->dev);
> +	return ret;
> +}
> +
> +static int gc0308_stop_stream(struct gc0308 *gc0308)
> +{
> +	pm_runtime_put(gc0308->dev);
> +	return 0;
> +}
> +
> +static int gc0308_s_stream(struct v4l2_subdev *sd, int enable)
> +{
> +	struct gc0308 *gc0308 = to_gc0308(sd);
> +	int ret = 0;
> +
> +	mutex_lock(&gc0308->lock);
> +
> +	if (gc0308->streaming == enable)
> +		goto exit;
> +
> +	if (enable)
> +		ret = gc0308_start_stream(gc0308);
> +	else
> +		ret = gc0308_stop_stream(gc0308);
> +
> +	if (!ret)
> +		gc0308->streaming = enable;
> +
> +exit:
> +	mutex_unlock(&gc0308->lock);
> +	return ret;
> +}
> +
> +static int gc0308_g_frame_interval(struct v4l2_subdev *sd,
> +				   struct v4l2_subdev_frame_interval *fi)
> +{
> +	struct gc0308 *gc0308 = to_gc0308(sd);
> +
> +	mutex_lock(&gc0308->lock);
> +	fi->interval = gc0308->frame_interval;
> +	mutex_unlock(&gc0308->lock);
> +
> +	return 0;
> +}
> +
> +static const struct v4l2_subdev_video_ops gc0308_video_ops = {
> +	.g_frame_interval	= gc0308_g_frame_interval,
> +	.s_stream		= gc0308_s_stream,
> +};
> +
> +static const struct v4l2_subdev_ops gc0308_subdev_ops = {
> +	.core	= &gc0308_core_ops,
> +	.pad	= &gc0308_pad_ops,
> +	.video	= &gc0308_video_ops,
> +};
> +
> +static int gc0308_bus_config(struct gc0308 *gc0308)
> +{
> +	struct device *dev = gc0308->dev;
> +	struct v4l2_fwnode_endpoint bus_cfg = {
> +		.bus_type = V4L2_MBUS_PARALLEL
> +	};
> +	struct fwnode_handle *ep;
> +	int ret;
> +
> +	ep = fwnode_graph_get_next_endpoint(dev_fwnode(dev), NULL);
> +	if (!ep)
> +		return -EINVAL;
> +
> +	ret = v4l2_fwnode_endpoint_parse(ep, &bus_cfg);
> +	fwnode_handle_put(ep);
> +	if (ret)
> +		return ret;
> +
> +	gc0308->mbus_config = bus_cfg.bus.parallel.flags;
> +
> +	return 0;
> +}
> +
> +static const char * const gc0308_test_pattern_menu[] = {
> +	"Disabled",
> +	"Test Image 1",
> +	"Test Image 2",
> +};
> +
> +static void gc0308_mutex_destroy(void *data)
> +{
> +	struct gc0308 *gc0308 = data;
> +
> +	mutex_destroy(&gc0308->lock);
> +}
> +
> +static int gc0308_probe(struct i2c_client *client)
> +{
> +	struct device *dev = &client->dev;
> +	struct gc0308 *gc0308;
> +	int ret, regval;
> +
> +	gc0308 = devm_kzalloc(dev, sizeof(*gc0308), GFP_KERNEL);
> +	if (!gc0308)
> +		return -ENOMEM;
> +
> +	gc0308->dev = dev;
> +	dev_set_drvdata(dev, gc0308);
> +
> +	ret = gc0308_bus_config(gc0308);
> +	if (ret)
> +		return dev_err_probe(dev, ret, "failed to get bus config\n");
> +
> +	gc0308->format.width = gc0308_frame_sizes[0].width;
> +	gc0308->format.height = gc0308_frame_sizes[0].height;
> +	gc0308->format.field = V4L2_FIELD_NONE;
> +	gc0308->format.code = gc0308_formats[2].code;
> +	gc0308->format.colorspace = V4L2_COLORSPACE_SRGB;
> +	gc0308->frame_interval.numerator = 1;
> +	gc0308->frame_interval.denominator = GC0308_FRAME_RATE;
> +
> +	gc0308->clk = devm_clk_get_optional(dev, NULL);
> +	if (IS_ERR(gc0308->clk))
> +		return dev_err_probe(dev, PTR_ERR(gc0308->clk),
> +				     "could not get clk\n");
> +
> +	ret = clk_set_rate(gc0308->clk, 24000000);
> +	if (ret)
> +		return dev_err_probe(dev, ret, "failed to set clock rate\n");
> +
> +	gc0308->vdd = devm_regulator_get(dev, "vdd28");
> +	if (IS_ERR(gc0308->vdd))
> +		return dev_err_probe(dev, PTR_ERR(gc0308->vdd),
> +				     "failed to get vdd28 regulator\n");
> +
> +	gc0308->pwdn_gpio = devm_gpiod_get(dev, "powerdown", GPIOD_OUT_LOW);
> +	if (IS_ERR(gc0308->pwdn_gpio))
> +		return dev_err_probe(dev, PTR_ERR(gc0308->pwdn_gpio),
> +				     "failed to get powerdown gpio\n");
> +
> +	gc0308->reset_gpio = devm_gpiod_get(dev, "reset", GPIOD_OUT_LOW);
> +	if (IS_ERR(gc0308->reset_gpio))
> +		return dev_err_probe(dev, PTR_ERR(gc0308->reset_gpio),
> +				     "failed to get reset gpio\n");
> +
> +	gc0308->regmap = devm_regmap_init_i2c(client, &gc0308_regmap_config);
> +	if (IS_ERR(gc0308->regmap))
> +		return dev_err_probe(dev, PTR_ERR(gc0308->regmap),
> +				     "failed to init regmap\n");
> +
> +	mutex_init(&gc0308->lock);
> +	ret = devm_add_action_or_reset(dev, gc0308_mutex_destroy, gc0308);
> +	if (ret)
> +		return ret;
> +
> +	v4l2_i2c_subdev_init(&gc0308->sd, client, &gc0308_subdev_ops);
> +	gc0308->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> +	gc0308->sd.flags |= V4L2_SUBDEV_FL_HAS_EVENTS;
> +
> +	v4l2_ctrl_handler_init(&gc0308->hdl, 8);
> +	v4l2_ctrl_new_std(&gc0308->hdl, &gc0308_ctrl_ops,
> +			  V4L2_CID_VFLIP, 0, 1, 1, 0);
> +	v4l2_ctrl_new_std(&gc0308->hdl, &gc0308_ctrl_ops,
> +			  V4L2_CID_HFLIP, 0, 1, 1, 0);
> +	v4l2_ctrl_new_std(&gc0308->hdl, &gc0308_ctrl_ops,
> +			  V4L2_CID_AUTO_WHITE_BALANCE, 0, 1, 1, 1);
> +	v4l2_ctrl_new_std_menu_items(&gc0308->hdl, &gc0308_ctrl_ops,
> +				     V4L2_CID_TEST_PATTERN,
> +				     ARRAY_SIZE(gc0308_test_pattern_menu) - 1,
> +				     0, 0, gc0308_test_pattern_menu);
> +	v4l2_ctrl_new_std_menu(&gc0308->hdl, &gc0308_ctrl_ops,
> +			       V4L2_CID_AUTO_N_PRESET_WHITE_BALANCE,
> +			       8, ~0x14e, V4L2_WHITE_BALANCE_AUTO);
> +	v4l2_ctrl_new_std_menu(&gc0308->hdl, &gc0308_ctrl_ops,
> +			       V4L2_CID_COLORFX, 8, 0, V4L2_COLORFX_NONE);
> +	v4l2_ctrl_new_std_menu(&gc0308->hdl, &gc0308_ctrl_ops,
> +			       V4L2_CID_POWER_LINE_FREQUENCY,
> +			       V4L2_CID_POWER_LINE_FREQUENCY_60HZ,
> +			       ~0x6, V4L2_CID_POWER_LINE_FREQUENCY_50HZ);
> +	v4l2_ctrl_new_std(&gc0308->hdl, &gc0308_ctrl_ops,
> +			  V4L2_CID_EXPOSURE, -4, 4, 1, 0);
> +
> +	gc0308->hdl.lock = &gc0308->lock;
> +	gc0308->sd.ctrl_handler = &gc0308->hdl;
> +	if (gc0308->hdl.error) {
> +		ret = gc0308->hdl.error;
> +		return ret;
> +	}
> +
> +	gc0308->pad.flags = MEDIA_PAD_FL_SOURCE;
> +	gc0308->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR;
> +	ret = media_entity_pads_init(&gc0308->sd.entity, 1, &gc0308->pad);
> +	if (ret < 0)
> +		return ret;
> +
> +	ret = gc0308_power_on(dev);
> +	if (ret)
> +		return ret;
> +
> +	ret = regmap_read(gc0308->regmap, GC0308_CHIP_ID, &regval);
> +	if (ret < 0)
> +		return dev_err_probe(dev, ret, "failed to read chip ID\n");
> +
> +	if (regval != 0x9b)
> +		return dev_err_probe(dev, -EINVAL, "invalid chip ID (%02x)\n",
> +				     regval);
> +
> +	ret = v4l2_async_register_subdev(&gc0308->sd);
> +	if (ret)
> +		return dev_err_probe(dev, ret, "failed to register v4l subdev\n");
> +
> +	pm_runtime_set_active(dev);
> +	pm_runtime_enable(dev);
> +	pm_runtime_idle(dev);
> +
> +	return 0;
> +}
> +
> +static void gc0308_remove(struct i2c_client *client)
> +{
> +	struct gc0308 *gc0308 = i2c_get_clientdata(client);
> +	struct device *dev = &client->dev;
> +
> +	pm_runtime_get_sync(dev);
> +
> +	v4l2_async_unregister_subdev(&gc0308->sd);
> +	v4l2_ctrl_handler_free(&gc0308->hdl);
> +
> +	pm_runtime_disable(dev);
> +	pm_runtime_set_suspended(dev);
> +	pm_runtime_put_noidle(dev);
> +	gc0308_power_off(dev);
> +}
> +
> +static const struct dev_pm_ops gc0308_pm_ops = {
> +	SET_RUNTIME_PM_OPS(gc0308_power_off, gc0308_power_on, NULL)
> +};
> +
> +static const struct of_device_id gc0308_of_match[] = {
> +	{ .compatible = "galaxycore,gc0308" },
> +	{ .compatible = "galaxycore,gc0309" },
> +	{ /* sentinel */ }
> +};
> +MODULE_DEVICE_TABLE(of, gc0308_of_match);
> +
> +static struct i2c_driver gc0308_i2c_driver = {
> +	.driver = {
> +		.name  = "gc0308",
> +		.pm = &gc0308_pm_ops,
> +		.of_match_table = gc0308_of_match,
> +	},
> +	.probe  = gc0308_probe,
> +	.remove = gc0308_remove,
> +};
> +module_i2c_driver(gc0308_i2c_driver);
> +
> +MODULE_DESCRIPTION("GalaxyCore GC0308 Camera Driver");
> +MODULE_AUTHOR("Sebastian Reichel <sre@...nel.org>");
> +MODULE_LICENSE("GPL");
> -- 
> 2.42.0
> 

Powered by blists - more mailing lists

Powered by Openwall GNU/*/Linux Powered by OpenVZ