xref: /linux/drivers/media/i2c/adv7183.c (revision 22d55f02b8922a097cd4be1e2f131dfa7ef65901)
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.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 
24 struct 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 	unsigned reset_pin;
32 	unsigned 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  */
40 static 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 
63 static inline struct adv7183 *to_adv7183(struct v4l2_subdev *sd)
64 {
65 	return container_of(sd, struct adv7183, sd);
66 }
67 static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl)
68 {
69 	return &container_of(ctrl->handler, struct adv7183, hdl)->sd;
70 }
71 
72 static 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 
79 static 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 
87 static 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 
108 static 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 
189 static 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 
197 static 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 
228 static 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 
239 static 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 
320 static 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 
349 static 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 
398 static 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 
411 static int adv7183_enum_mbus_code(struct v4l2_subdev *sd,
412 		struct v4l2_subdev_pad_config *cfg,
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 
422 static int adv7183_set_fmt(struct v4l2_subdev *sd,
423 		struct v4l2_subdev_pad_config *cfg,
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 		cfg->try_fmt = *fmt;
447 	return 0;
448 }
449 
450 static int adv7183_get_fmt(struct v4l2_subdev *sd,
451 		struct v4l2_subdev_pad_config *cfg,
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 
463 static int adv7183_s_stream(struct v4l2_subdev *sd, int enable)
464 {
465 	struct adv7183 *decoder = to_adv7183(sd);
466 
467 	if (enable)
468 		gpio_set_value(decoder->oe_pin, 0);
469 	else
470 		gpio_set_value(decoder->oe_pin, 1);
471 	udelay(1);
472 	return 0;
473 }
474 
475 #ifdef CONFIG_VIDEO_ADV_DEBUG
476 static 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 
483 static 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 
490 static const struct v4l2_ctrl_ops adv7183_ctrl_ops = {
491 	.s_ctrl = adv7183_s_ctrl,
492 };
493 
494 static 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 
503 static 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 
512 static 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 
518 static const struct v4l2_subdev_ops adv7183_ops = {
519 	.core = &adv7183_core_ops,
520 	.video = &adv7183_video_ops,
521 	.pad = &adv7183_pad_ops,
522 };
523 
524 static 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 	const unsigned *pin_array;
535 
536 	/* Check if the adapter supports the needed features */
537 	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
538 		return -EIO;
539 
540 	v4l_info(client, "chip found @ 0x%02x (%s)\n",
541 			client->addr << 1, client->adapter->name);
542 
543 	pin_array = client->dev.platform_data;
544 	if (pin_array == NULL)
545 		return -EINVAL;
546 
547 	decoder = devm_kzalloc(&client->dev, sizeof(*decoder), GFP_KERNEL);
548 	if (decoder == NULL)
549 		return -ENOMEM;
550 
551 	decoder->reset_pin = pin_array[0];
552 	decoder->oe_pin = pin_array[1];
553 
554 	if (devm_gpio_request_one(&client->dev, decoder->reset_pin,
555 				  GPIOF_OUT_INIT_LOW, "ADV7183 Reset")) {
556 		v4l_err(client, "failed to request GPIO %d\n", decoder->reset_pin);
557 		return -EBUSY;
558 	}
559 
560 	if (devm_gpio_request_one(&client->dev, decoder->oe_pin,
561 				  GPIOF_OUT_INIT_HIGH,
562 				  "ADV7183 Output Enable")) {
563 		v4l_err(client, "failed to request GPIO %d\n", decoder->oe_pin);
564 		return -EBUSY;
565 	}
566 
567 	sd = &decoder->sd;
568 	v4l2_i2c_subdev_init(sd, client, &adv7183_ops);
569 
570 	hdl = &decoder->hdl;
571 	v4l2_ctrl_handler_init(hdl, 4);
572 	v4l2_ctrl_new_std(hdl, &adv7183_ctrl_ops,
573 			V4L2_CID_BRIGHTNESS, -128, 127, 1, 0);
574 	v4l2_ctrl_new_std(hdl, &adv7183_ctrl_ops,
575 			V4L2_CID_CONTRAST, 0, 0xFF, 1, 0x80);
576 	v4l2_ctrl_new_std(hdl, &adv7183_ctrl_ops,
577 			V4L2_CID_SATURATION, 0, 0xFFFF, 1, 0x8080);
578 	v4l2_ctrl_new_std(hdl, &adv7183_ctrl_ops,
579 			V4L2_CID_HUE, 0, 0xFFFF, 1, 0x8080);
580 	/* hook the control handler into the driver */
581 	sd->ctrl_handler = hdl;
582 	if (hdl->error) {
583 		ret = hdl->error;
584 
585 		v4l2_ctrl_handler_free(hdl);
586 		return ret;
587 	}
588 
589 	/* v4l2 doesn't support an autodetect standard, pick PAL as default */
590 	decoder->std = V4L2_STD_PAL;
591 	decoder->input = ADV7183_COMPOSITE4;
592 	decoder->output = ADV7183_8BIT_OUT;
593 
594 	/* reset chip */
595 	/* reset pulse width at least 5ms */
596 	mdelay(10);
597 	gpio_set_value(decoder->reset_pin, 1);
598 	/* wait 5ms before any further i2c writes are performed */
599 	mdelay(5);
600 
601 	adv7183_writeregs(sd, adv7183_init_regs, ARRAY_SIZE(adv7183_init_regs));
602 	adv7183_s_std(sd, decoder->std);
603 	fmt.format.width = 720;
604 	fmt.format.height = 576;
605 	adv7183_set_fmt(sd, NULL, &fmt);
606 
607 	/* initialize the hardware to the default control values */
608 	ret = v4l2_ctrl_handler_setup(hdl);
609 	if (ret) {
610 		v4l2_ctrl_handler_free(hdl);
611 		return ret;
612 	}
613 
614 	return 0;
615 }
616 
617 static int adv7183_remove(struct i2c_client *client)
618 {
619 	struct v4l2_subdev *sd = i2c_get_clientdata(client);
620 
621 	v4l2_device_unregister_subdev(sd);
622 	v4l2_ctrl_handler_free(sd->ctrl_handler);
623 	return 0;
624 }
625 
626 static const struct i2c_device_id adv7183_id[] = {
627 	{"adv7183", 0},
628 	{},
629 };
630 
631 MODULE_DEVICE_TABLE(i2c, adv7183_id);
632 
633 static struct i2c_driver adv7183_driver = {
634 	.driver = {
635 		.name   = "adv7183",
636 	},
637 	.probe          = adv7183_probe,
638 	.remove         = adv7183_remove,
639 	.id_table       = adv7183_id,
640 };
641 
642 module_i2c_driver(adv7183_driver);
643 
644 MODULE_DESCRIPTION("Analog Devices ADV7183 video decoder driver");
645 MODULE_AUTHOR("Scott Jiang <Scott.Jiang.Linux@gmail.com>");
646 MODULE_LICENSE("GPL v2");
647