xref: /openbmc/linux/drivers/media/i2c/tvp514x.c (revision e2f1cf25)
1 /*
2  * drivers/media/i2c/tvp514x.c
3  *
4  * TI TVP5146/47 decoder driver
5  *
6  * Copyright (C) 2008 Texas Instruments Inc
7  * Author: Vaibhav Hiremath <hvaibhav@ti.com>
8  *
9  * Contributors:
10  *     Sivaraj R <sivaraj@ti.com>
11  *     Brijesh R Jadav <brijesh.j@ti.com>
12  *     Hardik Shah <hardik.shah@ti.com>
13  *     Manjunath Hadli <mrh@ti.com>
14  *     Karicheri Muralidharan <m-karicheri2@ti.com>
15  *     Prabhakar Lad <prabhakar.lad@ti.com>
16  *
17  * This package is free software; you can redistribute it and/or modify
18  * it under the terms of the GNU General Public License version 2 as
19  * published by the Free Software Foundation.
20  *
21  * This program is distributed in the hope that it will be useful,
22  * but WITHOUT ANY WARRANTY; without even the implied warranty of
23  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
24  * GNU General Public License for more details.
25  *
26  * You should have received a copy of the GNU General Public License
27  * along with this program; if not, write to the Free Software
28  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
29  *
30  */
31 
32 #include <linux/i2c.h>
33 #include <linux/slab.h>
34 #include <linux/delay.h>
35 #include <linux/videodev2.h>
36 #include <linux/module.h>
37 #include <linux/v4l2-mediabus.h>
38 #include <linux/of.h>
39 #include <linux/of_graph.h>
40 
41 #include <media/v4l2-async.h>
42 #include <media/v4l2-device.h>
43 #include <media/v4l2-common.h>
44 #include <media/v4l2-mediabus.h>
45 #include <media/v4l2-of.h>
46 #include <media/v4l2-ctrls.h>
47 #include <media/tvp514x.h>
48 #include <media/media-entity.h>
49 
50 #include "tvp514x_regs.h"
51 
52 /* Private macros for TVP */
53 #define I2C_RETRY_COUNT                 (5)
54 #define LOCK_RETRY_COUNT                (5)
55 #define LOCK_RETRY_DELAY                (200)
56 
57 /* Debug functions */
58 static bool debug;
59 module_param(debug, bool, 0644);
60 MODULE_PARM_DESC(debug, "Debug level (0-1)");
61 
62 MODULE_AUTHOR("Texas Instruments");
63 MODULE_DESCRIPTION("TVP514X linux decoder driver");
64 MODULE_LICENSE("GPL");
65 
66 /* enum tvp514x_std - enum for supported standards */
67 enum tvp514x_std {
68 	STD_NTSC_MJ = 0,
69 	STD_PAL_BDGHIN,
70 	STD_INVALID
71 };
72 
73 /**
74  * struct tvp514x_std_info - Structure to store standard informations
75  * @width: Line width in pixels
76  * @height:Number of active lines
77  * @video_std: Value to write in REG_VIDEO_STD register
78  * @standard: v4l2 standard structure information
79  */
80 struct tvp514x_std_info {
81 	unsigned long width;
82 	unsigned long height;
83 	u8 video_std;
84 	struct v4l2_standard standard;
85 };
86 
87 static struct tvp514x_reg tvp514x_reg_list_default[0x40];
88 
89 static int tvp514x_s_stream(struct v4l2_subdev *sd, int enable);
90 /**
91  * struct tvp514x_decoder - TVP5146/47 decoder object
92  * @sd: Subdevice Slave handle
93  * @tvp514x_regs: copy of hw's regs with preset values.
94  * @pdata: Board specific
95  * @ver: Chip version
96  * @streaming: TVP5146/47 decoder streaming - enabled or disabled.
97  * @pix: Current pixel format
98  * @num_fmts: Number of formats
99  * @fmt_list: Format list
100  * @current_std: Current standard
101  * @num_stds: Number of standards
102  * @std_list: Standards list
103  * @input: Input routing at chip level
104  * @output: Output routing at chip level
105  */
106 struct tvp514x_decoder {
107 	struct v4l2_subdev sd;
108 	struct v4l2_ctrl_handler hdl;
109 	struct tvp514x_reg tvp514x_regs[ARRAY_SIZE(tvp514x_reg_list_default)];
110 	const struct tvp514x_platform_data *pdata;
111 
112 	int ver;
113 	int streaming;
114 
115 	struct v4l2_pix_format pix;
116 	int num_fmts;
117 	const struct v4l2_fmtdesc *fmt_list;
118 
119 	enum tvp514x_std current_std;
120 	int num_stds;
121 	const struct tvp514x_std_info *std_list;
122 	/* Input and Output Routing parameters */
123 	u32 input;
124 	u32 output;
125 
126 	/* mc related members */
127 	struct media_pad pad;
128 	struct v4l2_mbus_framefmt format;
129 
130 	struct tvp514x_reg *int_seq;
131 };
132 
133 /* TVP514x default register values */
134 static struct tvp514x_reg tvp514x_reg_list_default[] = {
135 	/* Composite selected */
136 	{TOK_WRITE, REG_INPUT_SEL, 0x05},
137 	{TOK_WRITE, REG_AFE_GAIN_CTRL, 0x0F},
138 	/* Auto mode */
139 	{TOK_WRITE, REG_VIDEO_STD, 0x00},
140 	{TOK_WRITE, REG_OPERATION_MODE, 0x00},
141 	{TOK_SKIP, REG_AUTOSWITCH_MASK, 0x3F},
142 	{TOK_WRITE, REG_COLOR_KILLER, 0x10},
143 	{TOK_WRITE, REG_LUMA_CONTROL1, 0x00},
144 	{TOK_WRITE, REG_LUMA_CONTROL2, 0x00},
145 	{TOK_WRITE, REG_LUMA_CONTROL3, 0x02},
146 	{TOK_WRITE, REG_BRIGHTNESS, 0x80},
147 	{TOK_WRITE, REG_CONTRAST, 0x80},
148 	{TOK_WRITE, REG_SATURATION, 0x80},
149 	{TOK_WRITE, REG_HUE, 0x00},
150 	{TOK_WRITE, REG_CHROMA_CONTROL1, 0x00},
151 	{TOK_WRITE, REG_CHROMA_CONTROL2, 0x0E},
152 	/* Reserved */
153 	{TOK_SKIP, 0x0F, 0x00},
154 	{TOK_WRITE, REG_COMP_PR_SATURATION, 0x80},
155 	{TOK_WRITE, REG_COMP_Y_CONTRAST, 0x80},
156 	{TOK_WRITE, REG_COMP_PB_SATURATION, 0x80},
157 	/* Reserved */
158 	{TOK_SKIP, 0x13, 0x00},
159 	{TOK_WRITE, REG_COMP_Y_BRIGHTNESS, 0x80},
160 	/* Reserved */
161 	{TOK_SKIP, 0x15, 0x00},
162 	/* NTSC timing */
163 	{TOK_SKIP, REG_AVID_START_PIXEL_LSB, 0x55},
164 	{TOK_SKIP, REG_AVID_START_PIXEL_MSB, 0x00},
165 	{TOK_SKIP, REG_AVID_STOP_PIXEL_LSB, 0x25},
166 	{TOK_SKIP, REG_AVID_STOP_PIXEL_MSB, 0x03},
167 	/* NTSC timing */
168 	{TOK_SKIP, REG_HSYNC_START_PIXEL_LSB, 0x00},
169 	{TOK_SKIP, REG_HSYNC_START_PIXEL_MSB, 0x00},
170 	{TOK_SKIP, REG_HSYNC_STOP_PIXEL_LSB, 0x40},
171 	{TOK_SKIP, REG_HSYNC_STOP_PIXEL_MSB, 0x00},
172 	/* NTSC timing */
173 	{TOK_SKIP, REG_VSYNC_START_LINE_LSB, 0x04},
174 	{TOK_SKIP, REG_VSYNC_START_LINE_MSB, 0x00},
175 	{TOK_SKIP, REG_VSYNC_STOP_LINE_LSB, 0x07},
176 	{TOK_SKIP, REG_VSYNC_STOP_LINE_MSB, 0x00},
177 	/* NTSC timing */
178 	{TOK_SKIP, REG_VBLK_START_LINE_LSB, 0x01},
179 	{TOK_SKIP, REG_VBLK_START_LINE_MSB, 0x00},
180 	{TOK_SKIP, REG_VBLK_STOP_LINE_LSB, 0x15},
181 	{TOK_SKIP, REG_VBLK_STOP_LINE_MSB, 0x00},
182 	/* Reserved */
183 	{TOK_SKIP, 0x26, 0x00},
184 	/* Reserved */
185 	{TOK_SKIP, 0x27, 0x00},
186 	{TOK_SKIP, REG_FAST_SWTICH_CONTROL, 0xCC},
187 	/* Reserved */
188 	{TOK_SKIP, 0x29, 0x00},
189 	{TOK_SKIP, REG_FAST_SWTICH_SCART_DELAY, 0x00},
190 	/* Reserved */
191 	{TOK_SKIP, 0x2B, 0x00},
192 	{TOK_SKIP, REG_SCART_DELAY, 0x00},
193 	{TOK_SKIP, REG_CTI_DELAY, 0x00},
194 	{TOK_SKIP, REG_CTI_CONTROL, 0x00},
195 	/* Reserved */
196 	{TOK_SKIP, 0x2F, 0x00},
197 	/* Reserved */
198 	{TOK_SKIP, 0x30, 0x00},
199 	/* Reserved */
200 	{TOK_SKIP, 0x31, 0x00},
201 	/* HS, VS active high */
202 	{TOK_WRITE, REG_SYNC_CONTROL, 0x00},
203 	/* 10-bit BT.656 */
204 	{TOK_WRITE, REG_OUTPUT_FORMATTER1, 0x00},
205 	/* Enable clk & data */
206 	{TOK_WRITE, REG_OUTPUT_FORMATTER2, 0x11},
207 	/* Enable AVID & FLD */
208 	{TOK_WRITE, REG_OUTPUT_FORMATTER3, 0xEE},
209 	/* Enable VS & HS */
210 	{TOK_WRITE, REG_OUTPUT_FORMATTER4, 0xAF},
211 	{TOK_WRITE, REG_OUTPUT_FORMATTER5, 0xFF},
212 	{TOK_WRITE, REG_OUTPUT_FORMATTER6, 0xFF},
213 	/* Clear status */
214 	{TOK_WRITE, REG_CLEAR_LOST_LOCK, 0x01},
215 	{TOK_TERM, 0, 0},
216 };
217 
218 /**
219  * List of image formats supported by TVP5146/47 decoder
220  * Currently we are using 8 bit mode only, but can be
221  * extended to 10/20 bit mode.
222  */
223 static const struct v4l2_fmtdesc tvp514x_fmt_list[] = {
224 	{
225 	 .index		= 0,
226 	 .type		= V4L2_BUF_TYPE_VIDEO_CAPTURE,
227 	 .flags		= 0,
228 	 .description	= "8-bit UYVY 4:2:2 Format",
229 	 .pixelformat	= V4L2_PIX_FMT_UYVY,
230 	},
231 };
232 
233 /**
234  * Supported standards -
235  *
236  * Currently supports two standards only, need to add support for rest of the
237  * modes, like SECAM, etc...
238  */
239 static const struct tvp514x_std_info tvp514x_std_list[] = {
240 	/* Standard: STD_NTSC_MJ */
241 	[STD_NTSC_MJ] = {
242 	 .width = NTSC_NUM_ACTIVE_PIXELS,
243 	 .height = NTSC_NUM_ACTIVE_LINES,
244 	 .video_std = VIDEO_STD_NTSC_MJ_BIT,
245 	 .standard = {
246 		      .index = 0,
247 		      .id = V4L2_STD_NTSC,
248 		      .name = "NTSC",
249 		      .frameperiod = {1001, 30000},
250 		      .framelines = 525
251 		     },
252 	/* Standard: STD_PAL_BDGHIN */
253 	},
254 	[STD_PAL_BDGHIN] = {
255 	 .width = PAL_NUM_ACTIVE_PIXELS,
256 	 .height = PAL_NUM_ACTIVE_LINES,
257 	 .video_std = VIDEO_STD_PAL_BDGHIN_BIT,
258 	 .standard = {
259 		      .index = 1,
260 		      .id = V4L2_STD_PAL,
261 		      .name = "PAL",
262 		      .frameperiod = {1, 25},
263 		      .framelines = 625
264 		     },
265 	},
266 	/* Standard: need to add for additional standard */
267 };
268 
269 
270 static inline struct tvp514x_decoder *to_decoder(struct v4l2_subdev *sd)
271 {
272 	return container_of(sd, struct tvp514x_decoder, sd);
273 }
274 
275 static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl)
276 {
277 	return &container_of(ctrl->handler, struct tvp514x_decoder, hdl)->sd;
278 }
279 
280 
281 /**
282  * tvp514x_read_reg() - Read a value from a register in an TVP5146/47.
283  * @sd: ptr to v4l2_subdev struct
284  * @reg: TVP5146/47 register address
285  *
286  * Returns value read if successful, or non-zero (-1) otherwise.
287  */
288 static int tvp514x_read_reg(struct v4l2_subdev *sd, u8 reg)
289 {
290 	int err, retry = 0;
291 	struct i2c_client *client = v4l2_get_subdevdata(sd);
292 
293 read_again:
294 
295 	err = i2c_smbus_read_byte_data(client, reg);
296 	if (err < 0) {
297 		if (retry <= I2C_RETRY_COUNT) {
298 			v4l2_warn(sd, "Read: retry ... %d\n", retry);
299 			retry++;
300 			msleep_interruptible(10);
301 			goto read_again;
302 		}
303 	}
304 
305 	return err;
306 }
307 
308 /**
309  * dump_reg() - dump the register content of TVP5146/47.
310  * @sd: ptr to v4l2_subdev struct
311  * @reg: TVP5146/47 register address
312  */
313 static void dump_reg(struct v4l2_subdev *sd, u8 reg)
314 {
315 	u32 val;
316 
317 	val = tvp514x_read_reg(sd, reg);
318 	v4l2_info(sd, "Reg(0x%.2X): 0x%.2X\n", reg, val);
319 }
320 
321 /**
322  * tvp514x_write_reg() - Write a value to a register in TVP5146/47
323  * @sd: ptr to v4l2_subdev struct
324  * @reg: TVP5146/47 register address
325  * @val: value to be written to the register
326  *
327  * Write a value to a register in an TVP5146/47 decoder device.
328  * Returns zero if successful, or non-zero otherwise.
329  */
330 static int tvp514x_write_reg(struct v4l2_subdev *sd, u8 reg, u8 val)
331 {
332 	int err, retry = 0;
333 	struct i2c_client *client = v4l2_get_subdevdata(sd);
334 
335 write_again:
336 
337 	err = i2c_smbus_write_byte_data(client, reg, val);
338 	if (err) {
339 		if (retry <= I2C_RETRY_COUNT) {
340 			v4l2_warn(sd, "Write: retry ... %d\n", retry);
341 			retry++;
342 			msleep_interruptible(10);
343 			goto write_again;
344 		}
345 	}
346 
347 	return err;
348 }
349 
350 /**
351  * tvp514x_write_regs() : Initializes a list of TVP5146/47 registers
352  * @sd: ptr to v4l2_subdev struct
353  * @reglist: list of TVP5146/47 registers and values
354  *
355  * Initializes a list of TVP5146/47 registers:-
356  *		if token is TOK_TERM, then entire write operation terminates
357  *		if token is TOK_DELAY, then a delay of 'val' msec is introduced
358  *		if token is TOK_SKIP, then the register write is skipped
359  *		if token is TOK_WRITE, then the register write is performed
360  * Returns zero if successful, or non-zero otherwise.
361  */
362 static int tvp514x_write_regs(struct v4l2_subdev *sd,
363 			      const struct tvp514x_reg reglist[])
364 {
365 	int err;
366 	const struct tvp514x_reg *next = reglist;
367 
368 	for (; next->token != TOK_TERM; next++) {
369 		if (next->token == TOK_DELAY) {
370 			msleep(next->val);
371 			continue;
372 		}
373 
374 		if (next->token == TOK_SKIP)
375 			continue;
376 
377 		err = tvp514x_write_reg(sd, next->reg, (u8) next->val);
378 		if (err) {
379 			v4l2_err(sd, "Write failed. Err[%d]\n", err);
380 			return err;
381 		}
382 	}
383 	return 0;
384 }
385 
386 /**
387  * tvp514x_query_current_std() : Query the current standard detected by TVP5146/47
388  * @sd: ptr to v4l2_subdev struct
389  *
390  * Returns the current standard detected by TVP5146/47, STD_INVALID if there is no
391  * standard detected.
392  */
393 static enum tvp514x_std tvp514x_query_current_std(struct v4l2_subdev *sd)
394 {
395 	u8 std, std_status;
396 
397 	std = tvp514x_read_reg(sd, REG_VIDEO_STD);
398 	if ((std & VIDEO_STD_MASK) == VIDEO_STD_AUTO_SWITCH_BIT)
399 		/* use the standard status register */
400 		std_status = tvp514x_read_reg(sd, REG_VIDEO_STD_STATUS);
401 	else
402 		/* use the standard register itself */
403 		std_status = std;
404 
405 	switch (std_status & VIDEO_STD_MASK) {
406 	case VIDEO_STD_NTSC_MJ_BIT:
407 		return STD_NTSC_MJ;
408 
409 	case VIDEO_STD_PAL_BDGHIN_BIT:
410 		return STD_PAL_BDGHIN;
411 
412 	default:
413 		return STD_INVALID;
414 	}
415 
416 	return STD_INVALID;
417 }
418 
419 /* TVP5146/47 register dump function */
420 static void tvp514x_reg_dump(struct v4l2_subdev *sd)
421 {
422 	dump_reg(sd, REG_INPUT_SEL);
423 	dump_reg(sd, REG_AFE_GAIN_CTRL);
424 	dump_reg(sd, REG_VIDEO_STD);
425 	dump_reg(sd, REG_OPERATION_MODE);
426 	dump_reg(sd, REG_COLOR_KILLER);
427 	dump_reg(sd, REG_LUMA_CONTROL1);
428 	dump_reg(sd, REG_LUMA_CONTROL2);
429 	dump_reg(sd, REG_LUMA_CONTROL3);
430 	dump_reg(sd, REG_BRIGHTNESS);
431 	dump_reg(sd, REG_CONTRAST);
432 	dump_reg(sd, REG_SATURATION);
433 	dump_reg(sd, REG_HUE);
434 	dump_reg(sd, REG_CHROMA_CONTROL1);
435 	dump_reg(sd, REG_CHROMA_CONTROL2);
436 	dump_reg(sd, REG_COMP_PR_SATURATION);
437 	dump_reg(sd, REG_COMP_Y_CONTRAST);
438 	dump_reg(sd, REG_COMP_PB_SATURATION);
439 	dump_reg(sd, REG_COMP_Y_BRIGHTNESS);
440 	dump_reg(sd, REG_AVID_START_PIXEL_LSB);
441 	dump_reg(sd, REG_AVID_START_PIXEL_MSB);
442 	dump_reg(sd, REG_AVID_STOP_PIXEL_LSB);
443 	dump_reg(sd, REG_AVID_STOP_PIXEL_MSB);
444 	dump_reg(sd, REG_HSYNC_START_PIXEL_LSB);
445 	dump_reg(sd, REG_HSYNC_START_PIXEL_MSB);
446 	dump_reg(sd, REG_HSYNC_STOP_PIXEL_LSB);
447 	dump_reg(sd, REG_HSYNC_STOP_PIXEL_MSB);
448 	dump_reg(sd, REG_VSYNC_START_LINE_LSB);
449 	dump_reg(sd, REG_VSYNC_START_LINE_MSB);
450 	dump_reg(sd, REG_VSYNC_STOP_LINE_LSB);
451 	dump_reg(sd, REG_VSYNC_STOP_LINE_MSB);
452 	dump_reg(sd, REG_VBLK_START_LINE_LSB);
453 	dump_reg(sd, REG_VBLK_START_LINE_MSB);
454 	dump_reg(sd, REG_VBLK_STOP_LINE_LSB);
455 	dump_reg(sd, REG_VBLK_STOP_LINE_MSB);
456 	dump_reg(sd, REG_SYNC_CONTROL);
457 	dump_reg(sd, REG_OUTPUT_FORMATTER1);
458 	dump_reg(sd, REG_OUTPUT_FORMATTER2);
459 	dump_reg(sd, REG_OUTPUT_FORMATTER3);
460 	dump_reg(sd, REG_OUTPUT_FORMATTER4);
461 	dump_reg(sd, REG_OUTPUT_FORMATTER5);
462 	dump_reg(sd, REG_OUTPUT_FORMATTER6);
463 	dump_reg(sd, REG_CLEAR_LOST_LOCK);
464 }
465 
466 /**
467  * tvp514x_configure() - Configure the TVP5146/47 registers
468  * @sd: ptr to v4l2_subdev struct
469  * @decoder: ptr to tvp514x_decoder structure
470  *
471  * Returns zero if successful, or non-zero otherwise.
472  */
473 static int tvp514x_configure(struct v4l2_subdev *sd,
474 		struct tvp514x_decoder *decoder)
475 {
476 	int err;
477 
478 	/* common register initialization */
479 	err =
480 	    tvp514x_write_regs(sd, decoder->tvp514x_regs);
481 	if (err)
482 		return err;
483 
484 	if (debug)
485 		tvp514x_reg_dump(sd);
486 
487 	return 0;
488 }
489 
490 /**
491  * tvp514x_detect() - Detect if an tvp514x is present, and if so which revision.
492  * @sd: pointer to standard V4L2 sub-device structure
493  * @decoder: pointer to tvp514x_decoder structure
494  *
495  * A device is considered to be detected if the chip ID (LSB and MSB)
496  * registers match the expected values.
497  * Any value of the rom version register is accepted.
498  * Returns ENODEV error number if no device is detected, or zero
499  * if a device is detected.
500  */
501 static int tvp514x_detect(struct v4l2_subdev *sd,
502 		struct tvp514x_decoder *decoder)
503 {
504 	u8 chip_id_msb, chip_id_lsb, rom_ver;
505 	struct i2c_client *client = v4l2_get_subdevdata(sd);
506 
507 	chip_id_msb = tvp514x_read_reg(sd, REG_CHIP_ID_MSB);
508 	chip_id_lsb = tvp514x_read_reg(sd, REG_CHIP_ID_LSB);
509 	rom_ver = tvp514x_read_reg(sd, REG_ROM_VERSION);
510 
511 	v4l2_dbg(1, debug, sd,
512 		 "chip id detected msb:0x%x lsb:0x%x rom version:0x%x\n",
513 		 chip_id_msb, chip_id_lsb, rom_ver);
514 	if ((chip_id_msb != TVP514X_CHIP_ID_MSB)
515 		|| ((chip_id_lsb != TVP5146_CHIP_ID_LSB)
516 		&& (chip_id_lsb != TVP5147_CHIP_ID_LSB))) {
517 		/* We didn't read the values we expected, so this must not be
518 		 * an TVP5146/47.
519 		 */
520 		v4l2_err(sd, "chip id mismatch msb:0x%x lsb:0x%x\n",
521 				chip_id_msb, chip_id_lsb);
522 		return -ENODEV;
523 	}
524 
525 	decoder->ver = rom_ver;
526 
527 	v4l2_info(sd, "%s (Version - 0x%.2x) found at 0x%x (%s)\n",
528 			client->name, decoder->ver,
529 			client->addr << 1, client->adapter->name);
530 	return 0;
531 }
532 
533 /**
534  * tvp514x_querystd() - V4L2 decoder interface handler for querystd
535  * @sd: pointer to standard V4L2 sub-device structure
536  * @std_id: standard V4L2 std_id ioctl enum
537  *
538  * Returns the current standard detected by TVP5146/47. If no active input is
539  * detected then *std_id is set to 0 and the function returns 0.
540  */
541 static int tvp514x_querystd(struct v4l2_subdev *sd, v4l2_std_id *std_id)
542 {
543 	struct tvp514x_decoder *decoder = to_decoder(sd);
544 	enum tvp514x_std current_std;
545 	enum tvp514x_input input_sel;
546 	u8 sync_lock_status, lock_mask;
547 
548 	if (std_id == NULL)
549 		return -EINVAL;
550 
551 	/* To query the standard the TVP514x must power on the ADCs. */
552 	if (!decoder->streaming) {
553 		tvp514x_s_stream(sd, 1);
554 		msleep(LOCK_RETRY_DELAY);
555 	}
556 
557 	/* query the current standard */
558 	current_std = tvp514x_query_current_std(sd);
559 	if (current_std == STD_INVALID) {
560 		*std_id = V4L2_STD_UNKNOWN;
561 		return 0;
562 	}
563 
564 	input_sel = decoder->input;
565 
566 	switch (input_sel) {
567 	case INPUT_CVBS_VI1A:
568 	case INPUT_CVBS_VI1B:
569 	case INPUT_CVBS_VI1C:
570 	case INPUT_CVBS_VI2A:
571 	case INPUT_CVBS_VI2B:
572 	case INPUT_CVBS_VI2C:
573 	case INPUT_CVBS_VI3A:
574 	case INPUT_CVBS_VI3B:
575 	case INPUT_CVBS_VI3C:
576 	case INPUT_CVBS_VI4A:
577 		lock_mask = STATUS_CLR_SUBCAR_LOCK_BIT |
578 			STATUS_HORZ_SYNC_LOCK_BIT |
579 			STATUS_VIRT_SYNC_LOCK_BIT;
580 		break;
581 
582 	case INPUT_SVIDEO_VI2A_VI1A:
583 	case INPUT_SVIDEO_VI2B_VI1B:
584 	case INPUT_SVIDEO_VI2C_VI1C:
585 	case INPUT_SVIDEO_VI2A_VI3A:
586 	case INPUT_SVIDEO_VI2B_VI3B:
587 	case INPUT_SVIDEO_VI2C_VI3C:
588 	case INPUT_SVIDEO_VI4A_VI1A:
589 	case INPUT_SVIDEO_VI4A_VI1B:
590 	case INPUT_SVIDEO_VI4A_VI1C:
591 	case INPUT_SVIDEO_VI4A_VI3A:
592 	case INPUT_SVIDEO_VI4A_VI3B:
593 	case INPUT_SVIDEO_VI4A_VI3C:
594 		lock_mask = STATUS_HORZ_SYNC_LOCK_BIT |
595 			STATUS_VIRT_SYNC_LOCK_BIT;
596 		break;
597 		/*Need to add other interfaces*/
598 	default:
599 		return -EINVAL;
600 	}
601 	/* check whether signal is locked */
602 	sync_lock_status = tvp514x_read_reg(sd, REG_STATUS1);
603 	if (lock_mask != (sync_lock_status & lock_mask)) {
604 		*std_id = V4L2_STD_UNKNOWN;
605 		return 0;	/* No input detected */
606 	}
607 
608 	*std_id &= decoder->std_list[current_std].standard.id;
609 
610 	v4l2_dbg(1, debug, sd, "Current STD: %s\n",
611 			decoder->std_list[current_std].standard.name);
612 	return 0;
613 }
614 
615 /**
616  * tvp514x_s_std() - V4L2 decoder interface handler for s_std
617  * @sd: pointer to standard V4L2 sub-device structure
618  * @std_id: standard V4L2 v4l2_std_id ioctl enum
619  *
620  * If std_id is supported, sets the requested standard. Otherwise, returns
621  * -EINVAL
622  */
623 static int tvp514x_s_std(struct v4l2_subdev *sd, v4l2_std_id std_id)
624 {
625 	struct tvp514x_decoder *decoder = to_decoder(sd);
626 	int err, i;
627 
628 	for (i = 0; i < decoder->num_stds; i++)
629 		if (std_id & decoder->std_list[i].standard.id)
630 			break;
631 
632 	if ((i == decoder->num_stds) || (i == STD_INVALID))
633 		return -EINVAL;
634 
635 	err = tvp514x_write_reg(sd, REG_VIDEO_STD,
636 				decoder->std_list[i].video_std);
637 	if (err)
638 		return err;
639 
640 	decoder->current_std = i;
641 	decoder->tvp514x_regs[REG_VIDEO_STD].val =
642 		decoder->std_list[i].video_std;
643 
644 	v4l2_dbg(1, debug, sd, "Standard set to: %s\n",
645 			decoder->std_list[i].standard.name);
646 	return 0;
647 }
648 
649 /**
650  * tvp514x_s_routing() - V4L2 decoder interface handler for s_routing
651  * @sd: pointer to standard V4L2 sub-device structure
652  * @input: input selector for routing the signal
653  * @output: output selector for routing the signal
654  * @config: config value. Not used
655  *
656  * If index is valid, selects the requested input. Otherwise, returns -EINVAL if
657  * the input is not supported or there is no active signal present in the
658  * selected input.
659  */
660 static int tvp514x_s_routing(struct v4l2_subdev *sd,
661 				u32 input, u32 output, u32 config)
662 {
663 	struct tvp514x_decoder *decoder = to_decoder(sd);
664 	int err;
665 	enum tvp514x_input input_sel;
666 	enum tvp514x_output output_sel;
667 
668 	if ((input >= INPUT_INVALID) ||
669 			(output >= OUTPUT_INVALID))
670 		/* Index out of bound */
671 		return -EINVAL;
672 
673 	input_sel = input;
674 	output_sel = output;
675 
676 	err = tvp514x_write_reg(sd, REG_INPUT_SEL, input_sel);
677 	if (err)
678 		return err;
679 
680 	output_sel |= tvp514x_read_reg(sd,
681 			REG_OUTPUT_FORMATTER1) & 0x7;
682 	err = tvp514x_write_reg(sd, REG_OUTPUT_FORMATTER1,
683 			output_sel);
684 	if (err)
685 		return err;
686 
687 	decoder->tvp514x_regs[REG_INPUT_SEL].val = input_sel;
688 	decoder->tvp514x_regs[REG_OUTPUT_FORMATTER1].val = output_sel;
689 	decoder->input = input;
690 	decoder->output = output;
691 
692 	v4l2_dbg(1, debug, sd, "Input set to: %d\n", input_sel);
693 
694 	return 0;
695 }
696 
697 /**
698  * tvp514x_s_ctrl() - V4L2 decoder interface handler for s_ctrl
699  * @ctrl: pointer to v4l2_ctrl structure
700  *
701  * If the requested control is supported, sets the control's current
702  * value in HW. Otherwise, returns -EINVAL if the control is not supported.
703  */
704 static int tvp514x_s_ctrl(struct v4l2_ctrl *ctrl)
705 {
706 	struct v4l2_subdev *sd = to_sd(ctrl);
707 	struct tvp514x_decoder *decoder = to_decoder(sd);
708 	int err = -EINVAL, value;
709 
710 	value = ctrl->val;
711 
712 	switch (ctrl->id) {
713 	case V4L2_CID_BRIGHTNESS:
714 		err = tvp514x_write_reg(sd, REG_BRIGHTNESS, value);
715 		if (!err)
716 			decoder->tvp514x_regs[REG_BRIGHTNESS].val = value;
717 		break;
718 	case V4L2_CID_CONTRAST:
719 		err = tvp514x_write_reg(sd, REG_CONTRAST, value);
720 		if (!err)
721 			decoder->tvp514x_regs[REG_CONTRAST].val = value;
722 		break;
723 	case V4L2_CID_SATURATION:
724 		err = tvp514x_write_reg(sd, REG_SATURATION, value);
725 		if (!err)
726 			decoder->tvp514x_regs[REG_SATURATION].val = value;
727 		break;
728 	case V4L2_CID_HUE:
729 		if (value == 180)
730 			value = 0x7F;
731 		else if (value == -180)
732 			value = 0x80;
733 		err = tvp514x_write_reg(sd, REG_HUE, value);
734 		if (!err)
735 			decoder->tvp514x_regs[REG_HUE].val = value;
736 		break;
737 	case V4L2_CID_AUTOGAIN:
738 		err = tvp514x_write_reg(sd, REG_AFE_GAIN_CTRL, value ? 0x0f : 0x0c);
739 		if (!err)
740 			decoder->tvp514x_regs[REG_AFE_GAIN_CTRL].val = value;
741 		break;
742 	}
743 
744 	v4l2_dbg(1, debug, sd, "Set Control: ID - %d - %d\n",
745 			ctrl->id, ctrl->val);
746 	return err;
747 }
748 
749 /**
750  * tvp514x_g_parm() - V4L2 decoder interface handler for g_parm
751  * @sd: pointer to standard V4L2 sub-device structure
752  * @a: pointer to standard V4L2 VIDIOC_G_PARM ioctl structure
753  *
754  * Returns the decoder's video CAPTURE parameters.
755  */
756 static int
757 tvp514x_g_parm(struct v4l2_subdev *sd, struct v4l2_streamparm *a)
758 {
759 	struct tvp514x_decoder *decoder = to_decoder(sd);
760 	struct v4l2_captureparm *cparm;
761 	enum tvp514x_std current_std;
762 
763 	if (a == NULL)
764 		return -EINVAL;
765 
766 	if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
767 		/* only capture is supported */
768 		return -EINVAL;
769 
770 	/* get the current standard */
771 	current_std = decoder->current_std;
772 
773 	cparm = &a->parm.capture;
774 	cparm->capability = V4L2_CAP_TIMEPERFRAME;
775 	cparm->timeperframe =
776 		decoder->std_list[current_std].standard.frameperiod;
777 
778 	return 0;
779 }
780 
781 /**
782  * tvp514x_s_parm() - V4L2 decoder interface handler for s_parm
783  * @sd: pointer to standard V4L2 sub-device structure
784  * @a: pointer to standard V4L2 VIDIOC_S_PARM ioctl structure
785  *
786  * Configures the decoder to use the input parameters, if possible. If
787  * not possible, returns the appropriate error code.
788  */
789 static int
790 tvp514x_s_parm(struct v4l2_subdev *sd, struct v4l2_streamparm *a)
791 {
792 	struct tvp514x_decoder *decoder = to_decoder(sd);
793 	struct v4l2_fract *timeperframe;
794 	enum tvp514x_std current_std;
795 
796 	if (a == NULL)
797 		return -EINVAL;
798 
799 	if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
800 		/* only capture is supported */
801 		return -EINVAL;
802 
803 	timeperframe = &a->parm.capture.timeperframe;
804 
805 	/* get the current standard */
806 	current_std = decoder->current_std;
807 
808 	*timeperframe =
809 	    decoder->std_list[current_std].standard.frameperiod;
810 
811 	return 0;
812 }
813 
814 /**
815  * tvp514x_s_stream() - V4L2 decoder i/f handler for s_stream
816  * @sd: pointer to standard V4L2 sub-device structure
817  * @enable: streaming enable or disable
818  *
819  * Sets streaming to enable or disable, if possible.
820  */
821 static int tvp514x_s_stream(struct v4l2_subdev *sd, int enable)
822 {
823 	int err = 0;
824 	struct tvp514x_decoder *decoder = to_decoder(sd);
825 
826 	if (decoder->streaming == enable)
827 		return 0;
828 
829 	switch (enable) {
830 	case 0:
831 	{
832 		/* Power Down Sequence */
833 		err = tvp514x_write_reg(sd, REG_OPERATION_MODE, 0x01);
834 		if (err) {
835 			v4l2_err(sd, "Unable to turn off decoder\n");
836 			return err;
837 		}
838 		decoder->streaming = enable;
839 		break;
840 	}
841 	case 1:
842 	{
843 		/* Power Up Sequence */
844 		err = tvp514x_write_regs(sd, decoder->int_seq);
845 		if (err) {
846 			v4l2_err(sd, "Unable to turn on decoder\n");
847 			return err;
848 		}
849 		/* Detect if not already detected */
850 		err = tvp514x_detect(sd, decoder);
851 		if (err) {
852 			v4l2_err(sd, "Unable to detect decoder\n");
853 			return err;
854 		}
855 		err = tvp514x_configure(sd, decoder);
856 		if (err) {
857 			v4l2_err(sd, "Unable to configure decoder\n");
858 			return err;
859 		}
860 		decoder->streaming = enable;
861 		break;
862 	}
863 	default:
864 		err = -ENODEV;
865 		break;
866 	}
867 
868 	return err;
869 }
870 
871 static const struct v4l2_ctrl_ops tvp514x_ctrl_ops = {
872 	.s_ctrl = tvp514x_s_ctrl,
873 };
874 
875 /**
876  * tvp514x_enum_mbus_code() - V4L2 decoder interface handler for enum_mbus_code
877  * @sd: pointer to standard V4L2 sub-device structure
878  * @cfg: pad configuration
879  * @code: pointer to v4l2_subdev_mbus_code_enum structure
880  *
881  * Enumertaes mbus codes supported
882  */
883 static int tvp514x_enum_mbus_code(struct v4l2_subdev *sd,
884 				  struct v4l2_subdev_pad_config *cfg,
885 				  struct v4l2_subdev_mbus_code_enum *code)
886 {
887 	u32 pad = code->pad;
888 	u32 index = code->index;
889 
890 	memset(code, 0, sizeof(*code));
891 	code->index = index;
892 	code->pad = pad;
893 
894 	if (index != 0)
895 		return -EINVAL;
896 
897 	code->code = MEDIA_BUS_FMT_YUYV8_2X8;
898 
899 	return 0;
900 }
901 
902 /**
903  * tvp514x_get_pad_format() - V4L2 decoder interface handler for get pad format
904  * @sd: pointer to standard V4L2 sub-device structure
905  * @cfg: pad configuration
906  * @format: pointer to v4l2_subdev_format structure
907  *
908  * Retrieves pad format which is active or tried based on requirement
909  */
910 static int tvp514x_get_pad_format(struct v4l2_subdev *sd,
911 				  struct v4l2_subdev_pad_config *cfg,
912 				  struct v4l2_subdev_format *format)
913 {
914 	struct tvp514x_decoder *decoder = to_decoder(sd);
915 	__u32 which = format->which;
916 
917 	if (format->pad)
918 		return -EINVAL;
919 
920 	if (which == V4L2_SUBDEV_FORMAT_ACTIVE) {
921 		format->format = decoder->format;
922 		return 0;
923 	}
924 
925 	format->format.code = MEDIA_BUS_FMT_YUYV8_2X8;
926 	format->format.width = tvp514x_std_list[decoder->current_std].width;
927 	format->format.height = tvp514x_std_list[decoder->current_std].height;
928 	format->format.colorspace = V4L2_COLORSPACE_SMPTE170M;
929 	format->format.field = V4L2_FIELD_INTERLACED;
930 
931 	return 0;
932 }
933 
934 /**
935  * tvp514x_set_pad_format() - V4L2 decoder interface handler for set pad format
936  * @sd: pointer to standard V4L2 sub-device structure
937  * @cfg: pad configuration
938  * @format: pointer to v4l2_subdev_format structure
939  *
940  * Set pad format for the output pad
941  */
942 static int tvp514x_set_pad_format(struct v4l2_subdev *sd,
943 				  struct v4l2_subdev_pad_config *cfg,
944 				  struct v4l2_subdev_format *fmt)
945 {
946 	struct tvp514x_decoder *decoder = to_decoder(sd);
947 
948 	if (fmt->format.field != V4L2_FIELD_INTERLACED ||
949 	    fmt->format.code != MEDIA_BUS_FMT_YUYV8_2X8 ||
950 	    fmt->format.colorspace != V4L2_COLORSPACE_SMPTE170M ||
951 	    fmt->format.width != tvp514x_std_list[decoder->current_std].width ||
952 	    fmt->format.height != tvp514x_std_list[decoder->current_std].height)
953 		return -EINVAL;
954 
955 	decoder->format = fmt->format;
956 
957 	return 0;
958 }
959 
960 static const struct v4l2_subdev_core_ops tvp514x_core_ops = {
961 	.g_ext_ctrls = v4l2_subdev_g_ext_ctrls,
962 	.try_ext_ctrls = v4l2_subdev_try_ext_ctrls,
963 	.s_ext_ctrls = v4l2_subdev_s_ext_ctrls,
964 	.g_ctrl = v4l2_subdev_g_ctrl,
965 	.s_ctrl = v4l2_subdev_s_ctrl,
966 	.queryctrl = v4l2_subdev_queryctrl,
967 	.querymenu = v4l2_subdev_querymenu,
968 };
969 
970 static const struct v4l2_subdev_video_ops tvp514x_video_ops = {
971 	.s_std = tvp514x_s_std,
972 	.s_routing = tvp514x_s_routing,
973 	.querystd = tvp514x_querystd,
974 	.g_parm = tvp514x_g_parm,
975 	.s_parm = tvp514x_s_parm,
976 	.s_stream = tvp514x_s_stream,
977 };
978 
979 static const struct v4l2_subdev_pad_ops tvp514x_pad_ops = {
980 	.enum_mbus_code = tvp514x_enum_mbus_code,
981 	.get_fmt = tvp514x_get_pad_format,
982 	.set_fmt = tvp514x_set_pad_format,
983 };
984 
985 static const struct v4l2_subdev_ops tvp514x_ops = {
986 	.core = &tvp514x_core_ops,
987 	.video = &tvp514x_video_ops,
988 	.pad = &tvp514x_pad_ops,
989 };
990 
991 static struct tvp514x_decoder tvp514x_dev = {
992 	.streaming = 0,
993 	.fmt_list = tvp514x_fmt_list,
994 	.num_fmts = ARRAY_SIZE(tvp514x_fmt_list),
995 	.pix = {
996 		/* Default to NTSC 8-bit YUV 422 */
997 		.width		= NTSC_NUM_ACTIVE_PIXELS,
998 		.height		= NTSC_NUM_ACTIVE_LINES,
999 		.pixelformat	= V4L2_PIX_FMT_UYVY,
1000 		.field		= V4L2_FIELD_INTERLACED,
1001 		.bytesperline	= NTSC_NUM_ACTIVE_PIXELS * 2,
1002 		.sizeimage	= NTSC_NUM_ACTIVE_PIXELS * 2 *
1003 					NTSC_NUM_ACTIVE_LINES,
1004 		.colorspace	= V4L2_COLORSPACE_SMPTE170M,
1005 		},
1006 	.current_std = STD_NTSC_MJ,
1007 	.std_list = tvp514x_std_list,
1008 	.num_stds = ARRAY_SIZE(tvp514x_std_list),
1009 
1010 };
1011 
1012 static struct tvp514x_platform_data *
1013 tvp514x_get_pdata(struct i2c_client *client)
1014 {
1015 	struct tvp514x_platform_data *pdata;
1016 	struct v4l2_of_endpoint bus_cfg;
1017 	struct device_node *endpoint;
1018 	unsigned int flags;
1019 
1020 	if (!IS_ENABLED(CONFIG_OF) || !client->dev.of_node)
1021 		return client->dev.platform_data;
1022 
1023 	endpoint = of_graph_get_next_endpoint(client->dev.of_node, NULL);
1024 	if (!endpoint)
1025 		return NULL;
1026 
1027 	pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);
1028 	if (!pdata)
1029 		goto done;
1030 
1031 	v4l2_of_parse_endpoint(endpoint, &bus_cfg);
1032 	flags = bus_cfg.bus.parallel.flags;
1033 
1034 	if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH)
1035 		pdata->hs_polarity = 1;
1036 
1037 	if (flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH)
1038 		pdata->vs_polarity = 1;
1039 
1040 	if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING)
1041 		pdata->clk_polarity = 1;
1042 
1043 done:
1044 	of_node_put(endpoint);
1045 	return pdata;
1046 }
1047 
1048 /**
1049  * tvp514x_probe() - decoder driver i2c probe handler
1050  * @client: i2c driver client device structure
1051  * @id: i2c driver id table
1052  *
1053  * Register decoder as an i2c client device and V4L2
1054  * device.
1055  */
1056 static int
1057 tvp514x_probe(struct i2c_client *client, const struct i2c_device_id *id)
1058 {
1059 	struct tvp514x_platform_data *pdata = tvp514x_get_pdata(client);
1060 	struct tvp514x_decoder *decoder;
1061 	struct v4l2_subdev *sd;
1062 	int ret;
1063 
1064 	if (pdata == NULL) {
1065 		dev_err(&client->dev, "No platform data\n");
1066 		return -EINVAL;
1067 	}
1068 
1069 	/* Check if the adapter supports the needed features */
1070 	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
1071 		return -EIO;
1072 
1073 	decoder = devm_kzalloc(&client->dev, sizeof(*decoder), GFP_KERNEL);
1074 	if (!decoder)
1075 		return -ENOMEM;
1076 
1077 	/* Initialize the tvp514x_decoder with default configuration */
1078 	*decoder = tvp514x_dev;
1079 	/* Copy default register configuration */
1080 	memcpy(decoder->tvp514x_regs, tvp514x_reg_list_default,
1081 			sizeof(tvp514x_reg_list_default));
1082 
1083 	decoder->int_seq = (struct tvp514x_reg *)id->driver_data;
1084 
1085 	/* Copy board specific information here */
1086 	decoder->pdata = pdata;
1087 
1088 	/**
1089 	 * Fetch platform specific data, and configure the
1090 	 * tvp514x_reg_list[] accordingly. Since this is one
1091 	 * time configuration, no need to preserve.
1092 	 */
1093 	decoder->tvp514x_regs[REG_OUTPUT_FORMATTER2].val |=
1094 		(decoder->pdata->clk_polarity << 1);
1095 	decoder->tvp514x_regs[REG_SYNC_CONTROL].val |=
1096 		((decoder->pdata->hs_polarity << 2) |
1097 		 (decoder->pdata->vs_polarity << 3));
1098 	/* Set default standard to auto */
1099 	decoder->tvp514x_regs[REG_VIDEO_STD].val =
1100 		VIDEO_STD_AUTO_SWITCH_BIT;
1101 
1102 	/* Register with V4L2 layer as slave device */
1103 	sd = &decoder->sd;
1104 	v4l2_i2c_subdev_init(sd, client, &tvp514x_ops);
1105 
1106 #if defined(CONFIG_MEDIA_CONTROLLER)
1107 	decoder->pad.flags = MEDIA_PAD_FL_SOURCE;
1108 	decoder->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
1109 	decoder->sd.entity.flags |= MEDIA_ENT_T_V4L2_SUBDEV_DECODER;
1110 
1111 	ret = media_entity_init(&decoder->sd.entity, 1, &decoder->pad, 0);
1112 	if (ret < 0) {
1113 		v4l2_err(sd, "%s decoder driver failed to register !!\n",
1114 			 sd->name);
1115 		return ret;
1116 	}
1117 #endif
1118 	v4l2_ctrl_handler_init(&decoder->hdl, 5);
1119 	v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
1120 		V4L2_CID_BRIGHTNESS, 0, 255, 1, 128);
1121 	v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
1122 		V4L2_CID_CONTRAST, 0, 255, 1, 128);
1123 	v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
1124 		V4L2_CID_SATURATION, 0, 255, 1, 128);
1125 	v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
1126 		V4L2_CID_HUE, -180, 180, 180, 0);
1127 	v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
1128 		V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
1129 	sd->ctrl_handler = &decoder->hdl;
1130 	if (decoder->hdl.error) {
1131 		ret = decoder->hdl.error;
1132 		goto done;
1133 	}
1134 	v4l2_ctrl_handler_setup(&decoder->hdl);
1135 
1136 	ret = v4l2_async_register_subdev(&decoder->sd);
1137 	if (!ret)
1138 		v4l2_info(sd, "%s decoder driver registered !!\n", sd->name);
1139 
1140 done:
1141 	if (ret < 0) {
1142 		v4l2_ctrl_handler_free(&decoder->hdl);
1143 #if defined(CONFIG_MEDIA_CONTROLLER)
1144 		media_entity_cleanup(&decoder->sd.entity);
1145 #endif
1146 	}
1147 	return ret;
1148 }
1149 
1150 /**
1151  * tvp514x_remove() - decoder driver i2c remove handler
1152  * @client: i2c driver client device structure
1153  *
1154  * Unregister decoder as an i2c client device and V4L2
1155  * device. Complement of tvp514x_probe().
1156  */
1157 static int tvp514x_remove(struct i2c_client *client)
1158 {
1159 	struct v4l2_subdev *sd = i2c_get_clientdata(client);
1160 	struct tvp514x_decoder *decoder = to_decoder(sd);
1161 
1162 	v4l2_async_unregister_subdev(&decoder->sd);
1163 #if defined(CONFIG_MEDIA_CONTROLLER)
1164 	media_entity_cleanup(&decoder->sd.entity);
1165 #endif
1166 	v4l2_ctrl_handler_free(&decoder->hdl);
1167 	return 0;
1168 }
1169 /* TVP5146 Init/Power on Sequence */
1170 static const struct tvp514x_reg tvp5146_init_reg_seq[] = {
1171 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x02},
1172 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
1173 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0x80},
1174 	{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
1175 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60},
1176 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
1177 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0},
1178 	{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
1179 	{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x00},
1180 	{TOK_WRITE, REG_OPERATION_MODE, 0x01},
1181 	{TOK_WRITE, REG_OPERATION_MODE, 0x00},
1182 	{TOK_TERM, 0, 0},
1183 };
1184 
1185 /* TVP5147 Init/Power on Sequence */
1186 static const struct tvp514x_reg tvp5147_init_reg_seq[] =	{
1187 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x02},
1188 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
1189 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0x80},
1190 	{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
1191 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60},
1192 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
1193 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0},
1194 	{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
1195 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x16},
1196 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
1197 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xA0},
1198 	{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x16},
1199 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60},
1200 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
1201 	{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0},
1202 	{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x00},
1203 	{TOK_WRITE, REG_OPERATION_MODE, 0x01},
1204 	{TOK_WRITE, REG_OPERATION_MODE, 0x00},
1205 	{TOK_TERM, 0, 0},
1206 };
1207 
1208 /* TVP5146M2/TVP5147M1 Init/Power on Sequence */
1209 static const struct tvp514x_reg tvp514xm_init_reg_seq[] = {
1210 	{TOK_WRITE, REG_OPERATION_MODE, 0x01},
1211 	{TOK_WRITE, REG_OPERATION_MODE, 0x00},
1212 	{TOK_TERM, 0, 0},
1213 };
1214 
1215 /**
1216  * I2C Device Table -
1217  *
1218  * name - Name of the actual device/chip.
1219  * driver_data - Driver data
1220  */
1221 static const struct i2c_device_id tvp514x_id[] = {
1222 	{"tvp5146", (unsigned long)tvp5146_init_reg_seq},
1223 	{"tvp5146m2", (unsigned long)tvp514xm_init_reg_seq},
1224 	{"tvp5147", (unsigned long)tvp5147_init_reg_seq},
1225 	{"tvp5147m1", (unsigned long)tvp514xm_init_reg_seq},
1226 	{},
1227 };
1228 
1229 MODULE_DEVICE_TABLE(i2c, tvp514x_id);
1230 
1231 #if IS_ENABLED(CONFIG_OF)
1232 static const struct of_device_id tvp514x_of_match[] = {
1233 	{ .compatible = "ti,tvp5146", },
1234 	{ .compatible = "ti,tvp5146m2", },
1235 	{ .compatible = "ti,tvp5147", },
1236 	{ .compatible = "ti,tvp5147m1", },
1237 	{ /* sentinel */ },
1238 };
1239 MODULE_DEVICE_TABLE(of, tvp514x_of_match);
1240 #endif
1241 
1242 static struct i2c_driver tvp514x_driver = {
1243 	.driver = {
1244 		.of_match_table = of_match_ptr(tvp514x_of_match),
1245 		.owner = THIS_MODULE,
1246 		.name = TVP514X_MODULE_NAME,
1247 	},
1248 	.probe = tvp514x_probe,
1249 	.remove = tvp514x_remove,
1250 	.id_table = tvp514x_id,
1251 };
1252 
1253 module_i2c_driver(tvp514x_driver);
1254