cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

adv7183.c (16869B)


      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * adv7183.c Analog Devices ADV7183 video decoder driver
      4 *
      5 * Copyright (c) 2011 Analog Devices Inc.
      6 */
      7
      8#include <linux/delay.h>
      9#include <linux/errno.h>
     10#include <linux/gpio/consumer.h>
     11#include <linux/i2c.h>
     12#include <linux/init.h>
     13#include <linux/module.h>
     14#include <linux/slab.h>
     15#include <linux/types.h>
     16#include <linux/videodev2.h>
     17
     18#include <media/i2c/adv7183.h>
     19#include <media/v4l2-ctrls.h>
     20#include <media/v4l2-device.h>
     21
     22#include "adv7183_regs.h"
     23
     24struct adv7183 {
     25	struct v4l2_subdev sd;
     26	struct v4l2_ctrl_handler hdl;
     27
     28	v4l2_std_id std; /* Current set standard */
     29	u32 input;
     30	u32 output;
     31	struct gpio_desc *reset_pin;
     32	struct gpio_desc *oe_pin;
     33	struct v4l2_mbus_framefmt fmt;
     34};
     35
     36/* EXAMPLES USING 27 MHz CLOCK
     37 * Mode 1 CVBS Input (Composite Video on AIN5)
     38 * All standards are supported through autodetect, 8-bit, 4:2:2, ITU-R BT.656 output on P15 to P8.
     39 */
     40static const unsigned char adv7183_init_regs[] = {
     41	ADV7183_IN_CTRL, 0x04,           /* CVBS input on AIN5 */
     42	ADV7183_DIGI_CLAMP_CTRL_1, 0x00, /* Slow down digital clamps */
     43	ADV7183_SHAP_FILT_CTRL, 0x41,    /* Set CSFM to SH1 */
     44	ADV7183_ADC_CTRL, 0x16,          /* Power down ADC 1 and ADC 2 */
     45	ADV7183_CTI_DNR_CTRL_4, 0x04,    /* Set DNR threshold to 4 for flat response */
     46	/* ADI recommended programming sequence */
     47	ADV7183_ADI_CTRL, 0x80,
     48	ADV7183_CTI_DNR_CTRL_4, 0x20,
     49	0x52, 0x18,
     50	0x58, 0xED,
     51	0x77, 0xC5,
     52	0x7C, 0x93,
     53	0x7D, 0x00,
     54	0xD0, 0x48,
     55	0xD5, 0xA0,
     56	0xD7, 0xEA,
     57	ADV7183_SD_SATURATION_CR, 0x3E,
     58	ADV7183_PAL_V_END, 0x3E,
     59	ADV7183_PAL_F_TOGGLE, 0x0F,
     60	ADV7183_ADI_CTRL, 0x00,
     61};
     62
     63static inline struct adv7183 *to_adv7183(struct v4l2_subdev *sd)
     64{
     65	return container_of(sd, struct adv7183, sd);
     66}
     67static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl)
     68{
     69	return &container_of(ctrl->handler, struct adv7183, hdl)->sd;
     70}
     71
     72static inline int adv7183_read(struct v4l2_subdev *sd, unsigned char reg)
     73{
     74	struct i2c_client *client = v4l2_get_subdevdata(sd);
     75
     76	return i2c_smbus_read_byte_data(client, reg);
     77}
     78
     79static inline int adv7183_write(struct v4l2_subdev *sd, unsigned char reg,
     80				unsigned char value)
     81{
     82	struct i2c_client *client = v4l2_get_subdevdata(sd);
     83
     84	return i2c_smbus_write_byte_data(client, reg, value);
     85}
     86
     87static int adv7183_writeregs(struct v4l2_subdev *sd,
     88		const unsigned char *regs, unsigned int num)
     89{
     90	unsigned char reg, data;
     91	unsigned int cnt = 0;
     92
     93	if (num & 0x1) {
     94		v4l2_err(sd, "invalid regs array\n");
     95		return -1;
     96	}
     97
     98	while (cnt < num) {
     99		reg = *regs++;
    100		data = *regs++;
    101		cnt += 2;
    102
    103		adv7183_write(sd, reg, data);
    104	}
    105	return 0;
    106}
    107
    108static int adv7183_log_status(struct v4l2_subdev *sd)
    109{
    110	struct adv7183 *decoder = to_adv7183(sd);
    111
    112	v4l2_info(sd, "adv7183: Input control = 0x%02x\n",
    113			adv7183_read(sd, ADV7183_IN_CTRL));
    114	v4l2_info(sd, "adv7183: Video selection = 0x%02x\n",
    115			adv7183_read(sd, ADV7183_VD_SEL));
    116	v4l2_info(sd, "adv7183: Output control = 0x%02x\n",
    117			adv7183_read(sd, ADV7183_OUT_CTRL));
    118	v4l2_info(sd, "adv7183: Extended output control = 0x%02x\n",
    119			adv7183_read(sd, ADV7183_EXT_OUT_CTRL));
    120	v4l2_info(sd, "adv7183: Autodetect enable = 0x%02x\n",
    121			adv7183_read(sd, ADV7183_AUTO_DET_EN));
    122	v4l2_info(sd, "adv7183: Contrast = 0x%02x\n",
    123			adv7183_read(sd, ADV7183_CONTRAST));
    124	v4l2_info(sd, "adv7183: Brightness = 0x%02x\n",
    125			adv7183_read(sd, ADV7183_BRIGHTNESS));
    126	v4l2_info(sd, "adv7183: Hue = 0x%02x\n",
    127			adv7183_read(sd, ADV7183_HUE));
    128	v4l2_info(sd, "adv7183: Default value Y = 0x%02x\n",
    129			adv7183_read(sd, ADV7183_DEF_Y));
    130	v4l2_info(sd, "adv7183: Default value C = 0x%02x\n",
    131			adv7183_read(sd, ADV7183_DEF_C));
    132	v4l2_info(sd, "adv7183: ADI control = 0x%02x\n",
    133			adv7183_read(sd, ADV7183_ADI_CTRL));
    134	v4l2_info(sd, "adv7183: Power Management = 0x%02x\n",
    135			adv7183_read(sd, ADV7183_POW_MANAGE));
    136	v4l2_info(sd, "adv7183: Status 1 2 and 3 = 0x%02x 0x%02x 0x%02x\n",
    137			adv7183_read(sd, ADV7183_STATUS_1),
    138			adv7183_read(sd, ADV7183_STATUS_2),
    139			adv7183_read(sd, ADV7183_STATUS_3));
    140	v4l2_info(sd, "adv7183: Ident = 0x%02x\n",
    141			adv7183_read(sd, ADV7183_IDENT));
    142	v4l2_info(sd, "adv7183: Analog clamp control = 0x%02x\n",
    143			adv7183_read(sd, ADV7183_ANAL_CLAMP_CTRL));
    144	v4l2_info(sd, "adv7183: Digital clamp control 1 = 0x%02x\n",
    145			adv7183_read(sd, ADV7183_DIGI_CLAMP_CTRL_1));
    146	v4l2_info(sd, "adv7183: Shaping filter control 1 and 2 = 0x%02x 0x%02x\n",
    147			adv7183_read(sd, ADV7183_SHAP_FILT_CTRL),
    148			adv7183_read(sd, ADV7183_SHAP_FILT_CTRL_2));
    149	v4l2_info(sd, "adv7183: Comb filter control = 0x%02x\n",
    150			adv7183_read(sd, ADV7183_COMB_FILT_CTRL));
    151	v4l2_info(sd, "adv7183: ADI control 2 = 0x%02x\n",
    152			adv7183_read(sd, ADV7183_ADI_CTRL_2));
    153	v4l2_info(sd, "adv7183: Pixel delay control = 0x%02x\n",
    154			adv7183_read(sd, ADV7183_PIX_DELAY_CTRL));
    155	v4l2_info(sd, "adv7183: Misc gain control = 0x%02x\n",
    156			adv7183_read(sd, ADV7183_MISC_GAIN_CTRL));
    157	v4l2_info(sd, "adv7183: AGC mode control = 0x%02x\n",
    158			adv7183_read(sd, ADV7183_AGC_MODE_CTRL));
    159	v4l2_info(sd, "adv7183: Chroma gain control 1 and 2 = 0x%02x 0x%02x\n",
    160			adv7183_read(sd, ADV7183_CHRO_GAIN_CTRL_1),
    161			adv7183_read(sd, ADV7183_CHRO_GAIN_CTRL_2));
    162	v4l2_info(sd, "adv7183: Luma gain control 1 and 2 = 0x%02x 0x%02x\n",
    163			adv7183_read(sd, ADV7183_LUMA_GAIN_CTRL_1),
    164			adv7183_read(sd, ADV7183_LUMA_GAIN_CTRL_2));
    165	v4l2_info(sd, "adv7183: Vsync field control 1 2 and 3 = 0x%02x 0x%02x 0x%02x\n",
    166			adv7183_read(sd, ADV7183_VS_FIELD_CTRL_1),
    167			adv7183_read(sd, ADV7183_VS_FIELD_CTRL_2),
    168			adv7183_read(sd, ADV7183_VS_FIELD_CTRL_3));
    169	v4l2_info(sd, "adv7183: Hsync position control 1 2 and 3 = 0x%02x 0x%02x 0x%02x\n",
    170			adv7183_read(sd, ADV7183_HS_POS_CTRL_1),
    171			adv7183_read(sd, ADV7183_HS_POS_CTRL_2),
    172			adv7183_read(sd, ADV7183_HS_POS_CTRL_3));
    173	v4l2_info(sd, "adv7183: Polarity = 0x%02x\n",
    174			adv7183_read(sd, ADV7183_POLARITY));
    175	v4l2_info(sd, "adv7183: ADC control = 0x%02x\n",
    176			adv7183_read(sd, ADV7183_ADC_CTRL));
    177	v4l2_info(sd, "adv7183: SD offset Cb and Cr = 0x%02x 0x%02x\n",
    178			adv7183_read(sd, ADV7183_SD_OFFSET_CB),
    179			adv7183_read(sd, ADV7183_SD_OFFSET_CR));
    180	v4l2_info(sd, "adv7183: SD saturation Cb and Cr = 0x%02x 0x%02x\n",
    181			adv7183_read(sd, ADV7183_SD_SATURATION_CB),
    182			adv7183_read(sd, ADV7183_SD_SATURATION_CR));
    183	v4l2_info(sd, "adv7183: Drive strength = 0x%02x\n",
    184			adv7183_read(sd, ADV7183_DRIVE_STR));
    185	v4l2_ctrl_handler_log_status(&decoder->hdl, sd->name);
    186	return 0;
    187}
    188
    189static int adv7183_g_std(struct v4l2_subdev *sd, v4l2_std_id *std)
    190{
    191	struct adv7183 *decoder = to_adv7183(sd);
    192
    193	*std = decoder->std;
    194	return 0;
    195}
    196
    197static int adv7183_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
    198{
    199	struct adv7183 *decoder = to_adv7183(sd);
    200	int reg;
    201
    202	reg = adv7183_read(sd, ADV7183_IN_CTRL) & 0xF;
    203	if (std == V4L2_STD_PAL_60)
    204		reg |= 0x60;
    205	else if (std == V4L2_STD_NTSC_443)
    206		reg |= 0x70;
    207	else if (std == V4L2_STD_PAL_N)
    208		reg |= 0x90;
    209	else if (std == V4L2_STD_PAL_M)
    210		reg |= 0xA0;
    211	else if (std == V4L2_STD_PAL_Nc)
    212		reg |= 0xC0;
    213	else if (std & V4L2_STD_PAL)
    214		reg |= 0x80;
    215	else if (std & V4L2_STD_NTSC)
    216		reg |= 0x50;
    217	else if (std & V4L2_STD_SECAM)
    218		reg |= 0xE0;
    219	else
    220		return -EINVAL;
    221	adv7183_write(sd, ADV7183_IN_CTRL, reg);
    222
    223	decoder->std = std;
    224
    225	return 0;
    226}
    227
    228static int adv7183_reset(struct v4l2_subdev *sd, u32 val)
    229{
    230	int reg;
    231
    232	reg = adv7183_read(sd, ADV7183_POW_MANAGE) | 0x80;
    233	adv7183_write(sd, ADV7183_POW_MANAGE, reg);
    234	/* wait 5ms before any further i2c writes are performed */
    235	usleep_range(5000, 10000);
    236	return 0;
    237}
    238
    239static int adv7183_s_routing(struct v4l2_subdev *sd,
    240				u32 input, u32 output, u32 config)
    241{
    242	struct adv7183 *decoder = to_adv7183(sd);
    243	int reg;
    244
    245	if ((input > ADV7183_COMPONENT1) || (output > ADV7183_16BIT_OUT))
    246		return -EINVAL;
    247
    248	if (input != decoder->input) {
    249		decoder->input = input;
    250		reg = adv7183_read(sd, ADV7183_IN_CTRL) & 0xF0;
    251		switch (input) {
    252		case ADV7183_COMPOSITE1:
    253			reg |= 0x1;
    254			break;
    255		case ADV7183_COMPOSITE2:
    256			reg |= 0x2;
    257			break;
    258		case ADV7183_COMPOSITE3:
    259			reg |= 0x3;
    260			break;
    261		case ADV7183_COMPOSITE4:
    262			reg |= 0x4;
    263			break;
    264		case ADV7183_COMPOSITE5:
    265			reg |= 0x5;
    266			break;
    267		case ADV7183_COMPOSITE6:
    268			reg |= 0xB;
    269			break;
    270		case ADV7183_COMPOSITE7:
    271			reg |= 0xC;
    272			break;
    273		case ADV7183_COMPOSITE8:
    274			reg |= 0xD;
    275			break;
    276		case ADV7183_COMPOSITE9:
    277			reg |= 0xE;
    278			break;
    279		case ADV7183_COMPOSITE10:
    280			reg |= 0xF;
    281			break;
    282		case ADV7183_SVIDEO0:
    283			reg |= 0x6;
    284			break;
    285		case ADV7183_SVIDEO1:
    286			reg |= 0x7;
    287			break;
    288		case ADV7183_SVIDEO2:
    289			reg |= 0x8;
    290			break;
    291		case ADV7183_COMPONENT0:
    292			reg |= 0x9;
    293			break;
    294		case ADV7183_COMPONENT1:
    295			reg |= 0xA;
    296			break;
    297		default:
    298			break;
    299		}
    300		adv7183_write(sd, ADV7183_IN_CTRL, reg);
    301	}
    302
    303	if (output != decoder->output) {
    304		decoder->output = output;
    305		reg = adv7183_read(sd, ADV7183_OUT_CTRL) & 0xC0;
    306		switch (output) {
    307		case ADV7183_16BIT_OUT:
    308			reg |= 0x9;
    309			break;
    310		default:
    311			reg |= 0xC;
    312			break;
    313		}
    314		adv7183_write(sd, ADV7183_OUT_CTRL, reg);
    315	}
    316
    317	return 0;
    318}
    319
    320static int adv7183_s_ctrl(struct v4l2_ctrl *ctrl)
    321{
    322	struct v4l2_subdev *sd = to_sd(ctrl);
    323	int val = ctrl->val;
    324
    325	switch (ctrl->id) {
    326	case V4L2_CID_BRIGHTNESS:
    327		if (val < 0)
    328			val = 127 - val;
    329		adv7183_write(sd, ADV7183_BRIGHTNESS, val);
    330		break;
    331	case V4L2_CID_CONTRAST:
    332		adv7183_write(sd, ADV7183_CONTRAST, val);
    333		break;
    334	case V4L2_CID_SATURATION:
    335		adv7183_write(sd, ADV7183_SD_SATURATION_CB, val >> 8);
    336		adv7183_write(sd, ADV7183_SD_SATURATION_CR, (val & 0xFF));
    337		break;
    338	case V4L2_CID_HUE:
    339		adv7183_write(sd, ADV7183_SD_OFFSET_CB, val >> 8);
    340		adv7183_write(sd, ADV7183_SD_OFFSET_CR, (val & 0xFF));
    341		break;
    342	default:
    343		return -EINVAL;
    344	}
    345
    346	return 0;
    347}
    348
    349static int adv7183_querystd(struct v4l2_subdev *sd, v4l2_std_id *std)
    350{
    351	struct adv7183 *decoder = to_adv7183(sd);
    352	int reg;
    353
    354	/* enable autodetection block */
    355	reg = adv7183_read(sd, ADV7183_IN_CTRL) & 0xF;
    356	adv7183_write(sd, ADV7183_IN_CTRL, reg);
    357
    358	/* wait autodetection switch */
    359	mdelay(10);
    360
    361	/* get autodetection result */
    362	reg = adv7183_read(sd, ADV7183_STATUS_1);
    363	switch ((reg >> 0x4) & 0x7) {
    364	case 0:
    365		*std &= V4L2_STD_NTSC;
    366		break;
    367	case 1:
    368		*std &= V4L2_STD_NTSC_443;
    369		break;
    370	case 2:
    371		*std &= V4L2_STD_PAL_M;
    372		break;
    373	case 3:
    374		*std &= V4L2_STD_PAL_60;
    375		break;
    376	case 4:
    377		*std &= V4L2_STD_PAL;
    378		break;
    379	case 5:
    380		*std &= V4L2_STD_SECAM;
    381		break;
    382	case 6:
    383		*std &= V4L2_STD_PAL_Nc;
    384		break;
    385	case 7:
    386		*std &= V4L2_STD_SECAM;
    387		break;
    388	default:
    389		*std = V4L2_STD_UNKNOWN;
    390		break;
    391	}
    392
    393	/* after std detection, write back user set std */
    394	adv7183_s_std(sd, decoder->std);
    395	return 0;
    396}
    397
    398static int adv7183_g_input_status(struct v4l2_subdev *sd, u32 *status)
    399{
    400	int reg;
    401
    402	*status = V4L2_IN_ST_NO_SIGNAL;
    403	reg = adv7183_read(sd, ADV7183_STATUS_1);
    404	if (reg < 0)
    405		return reg;
    406	if (reg & 0x1)
    407		*status = 0;
    408	return 0;
    409}
    410
    411static int adv7183_enum_mbus_code(struct v4l2_subdev *sd,
    412		struct v4l2_subdev_state *sd_state,
    413		struct v4l2_subdev_mbus_code_enum *code)
    414{
    415	if (code->pad || code->index > 0)
    416		return -EINVAL;
    417
    418	code->code = MEDIA_BUS_FMT_UYVY8_2X8;
    419	return 0;
    420}
    421
    422static int adv7183_set_fmt(struct v4l2_subdev *sd,
    423		struct v4l2_subdev_state *sd_state,
    424		struct v4l2_subdev_format *format)
    425{
    426	struct adv7183 *decoder = to_adv7183(sd);
    427	struct v4l2_mbus_framefmt *fmt = &format->format;
    428
    429	if (format->pad)
    430		return -EINVAL;
    431
    432	fmt->code = MEDIA_BUS_FMT_UYVY8_2X8;
    433	fmt->colorspace = V4L2_COLORSPACE_SMPTE170M;
    434	if (decoder->std & V4L2_STD_525_60) {
    435		fmt->field = V4L2_FIELD_SEQ_TB;
    436		fmt->width = 720;
    437		fmt->height = 480;
    438	} else {
    439		fmt->field = V4L2_FIELD_SEQ_BT;
    440		fmt->width = 720;
    441		fmt->height = 576;
    442	}
    443	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE)
    444		decoder->fmt = *fmt;
    445	else
    446		sd_state->pads->try_fmt = *fmt;
    447	return 0;
    448}
    449
    450static int adv7183_get_fmt(struct v4l2_subdev *sd,
    451		struct v4l2_subdev_state *sd_state,
    452		struct v4l2_subdev_format *format)
    453{
    454	struct adv7183 *decoder = to_adv7183(sd);
    455
    456	if (format->pad)
    457		return -EINVAL;
    458
    459	format->format = decoder->fmt;
    460	return 0;
    461}
    462
    463static int adv7183_s_stream(struct v4l2_subdev *sd, int enable)
    464{
    465	struct adv7183 *decoder = to_adv7183(sd);
    466
    467	if (enable)
    468		gpiod_set_value(decoder->oe_pin, 1);
    469	else
    470		gpiod_set_value(decoder->oe_pin, 0);
    471	udelay(1);
    472	return 0;
    473}
    474
    475#ifdef CONFIG_VIDEO_ADV_DEBUG
    476static int adv7183_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg)
    477{
    478	reg->val = adv7183_read(sd, reg->reg & 0xff);
    479	reg->size = 1;
    480	return 0;
    481}
    482
    483static int adv7183_s_register(struct v4l2_subdev *sd, const struct v4l2_dbg_register *reg)
    484{
    485	adv7183_write(sd, reg->reg & 0xff, reg->val & 0xff);
    486	return 0;
    487}
    488#endif
    489
    490static const struct v4l2_ctrl_ops adv7183_ctrl_ops = {
    491	.s_ctrl = adv7183_s_ctrl,
    492};
    493
    494static const struct v4l2_subdev_core_ops adv7183_core_ops = {
    495	.log_status = adv7183_log_status,
    496	.reset = adv7183_reset,
    497#ifdef CONFIG_VIDEO_ADV_DEBUG
    498	.g_register = adv7183_g_register,
    499	.s_register = adv7183_s_register,
    500#endif
    501};
    502
    503static const struct v4l2_subdev_video_ops adv7183_video_ops = {
    504	.g_std = adv7183_g_std,
    505	.s_std = adv7183_s_std,
    506	.s_routing = adv7183_s_routing,
    507	.querystd = adv7183_querystd,
    508	.g_input_status = adv7183_g_input_status,
    509	.s_stream = adv7183_s_stream,
    510};
    511
    512static const struct v4l2_subdev_pad_ops adv7183_pad_ops = {
    513	.enum_mbus_code = adv7183_enum_mbus_code,
    514	.get_fmt = adv7183_get_fmt,
    515	.set_fmt = adv7183_set_fmt,
    516};
    517
    518static const struct v4l2_subdev_ops adv7183_ops = {
    519	.core = &adv7183_core_ops,
    520	.video = &adv7183_video_ops,
    521	.pad = &adv7183_pad_ops,
    522};
    523
    524static int adv7183_probe(struct i2c_client *client,
    525			const struct i2c_device_id *id)
    526{
    527	struct adv7183 *decoder;
    528	struct v4l2_subdev *sd;
    529	struct v4l2_ctrl_handler *hdl;
    530	int ret;
    531	struct v4l2_subdev_format fmt = {
    532		.which = V4L2_SUBDEV_FORMAT_ACTIVE,
    533	};
    534
    535	/* Check if the adapter supports the needed features */
    536	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
    537		return -EIO;
    538
    539	v4l_info(client, "chip found @ 0x%02x (%s)\n",
    540			client->addr << 1, client->adapter->name);
    541
    542	decoder = devm_kzalloc(&client->dev, sizeof(*decoder), GFP_KERNEL);
    543	if (decoder == NULL)
    544		return -ENOMEM;
    545
    546	/*
    547	 * Requesting high will assert reset, the line should be
    548	 * flagged as active low in descriptor table or machine description.
    549	 */
    550	decoder->reset_pin = devm_gpiod_get(&client->dev, "reset",
    551					    GPIOD_OUT_HIGH);
    552	if (IS_ERR(decoder->reset_pin))
    553		return PTR_ERR(decoder->reset_pin);
    554	gpiod_set_consumer_name(decoder->reset_pin, "ADV7183 Reset");
    555	/*
    556	 * Requesting low will start with output disabled, the line should be
    557	 * flagged as active low in descriptor table or machine description.
    558	 */
    559	decoder->oe_pin = devm_gpiod_get(&client->dev, "oe",
    560					 GPIOD_OUT_LOW);
    561	if (IS_ERR(decoder->oe_pin))
    562		return PTR_ERR(decoder->oe_pin);
    563	gpiod_set_consumer_name(decoder->reset_pin, "ADV7183 Output Enable");
    564
    565	sd = &decoder->sd;
    566	v4l2_i2c_subdev_init(sd, client, &adv7183_ops);
    567
    568	hdl = &decoder->hdl;
    569	v4l2_ctrl_handler_init(hdl, 4);
    570	v4l2_ctrl_new_std(hdl, &adv7183_ctrl_ops,
    571			V4L2_CID_BRIGHTNESS, -128, 127, 1, 0);
    572	v4l2_ctrl_new_std(hdl, &adv7183_ctrl_ops,
    573			V4L2_CID_CONTRAST, 0, 0xFF, 1, 0x80);
    574	v4l2_ctrl_new_std(hdl, &adv7183_ctrl_ops,
    575			V4L2_CID_SATURATION, 0, 0xFFFF, 1, 0x8080);
    576	v4l2_ctrl_new_std(hdl, &adv7183_ctrl_ops,
    577			V4L2_CID_HUE, 0, 0xFFFF, 1, 0x8080);
    578	/* hook the control handler into the driver */
    579	sd->ctrl_handler = hdl;
    580	if (hdl->error) {
    581		ret = hdl->error;
    582
    583		v4l2_ctrl_handler_free(hdl);
    584		return ret;
    585	}
    586
    587	/* v4l2 doesn't support an autodetect standard, pick PAL as default */
    588	decoder->std = V4L2_STD_PAL;
    589	decoder->input = ADV7183_COMPOSITE4;
    590	decoder->output = ADV7183_8BIT_OUT;
    591
    592	/* reset chip */
    593	/* reset pulse width at least 5ms */
    594	mdelay(10);
    595	/* De-assert reset line (descriptor tagged active low) */
    596	gpiod_set_value(decoder->reset_pin, 0);
    597	/* wait 5ms before any further i2c writes are performed */
    598	mdelay(5);
    599
    600	adv7183_writeregs(sd, adv7183_init_regs, ARRAY_SIZE(adv7183_init_regs));
    601	adv7183_s_std(sd, decoder->std);
    602	fmt.format.width = 720;
    603	fmt.format.height = 576;
    604	adv7183_set_fmt(sd, NULL, &fmt);
    605
    606	/* initialize the hardware to the default control values */
    607	ret = v4l2_ctrl_handler_setup(hdl);
    608	if (ret) {
    609		v4l2_ctrl_handler_free(hdl);
    610		return ret;
    611	}
    612
    613	return 0;
    614}
    615
    616static int adv7183_remove(struct i2c_client *client)
    617{
    618	struct v4l2_subdev *sd = i2c_get_clientdata(client);
    619
    620	v4l2_device_unregister_subdev(sd);
    621	v4l2_ctrl_handler_free(sd->ctrl_handler);
    622	return 0;
    623}
    624
    625static const struct i2c_device_id adv7183_id[] = {
    626	{"adv7183", 0},
    627	{},
    628};
    629
    630MODULE_DEVICE_TABLE(i2c, adv7183_id);
    631
    632static struct i2c_driver adv7183_driver = {
    633	.driver = {
    634		.name   = "adv7183",
    635	},
    636	.probe          = adv7183_probe,
    637	.remove         = adv7183_remove,
    638	.id_table       = adv7183_id,
    639};
    640
    641module_i2c_driver(adv7183_driver);
    642
    643MODULE_DESCRIPTION("Analog Devices ADV7183 video decoder driver");
    644MODULE_AUTHOR("Scott Jiang <Scott.Jiang.Linux@gmail.com>");
    645MODULE_LICENSE("GPL v2");