tvp514x.c

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