Quelle  tvp514x.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/*
 * drivers/media/i2c/tvp514x.c
 *
 * TI TVP5146/47 decoder driver
 *
 * Copyright (C) 2008 Texas Instruments Inc
 * Author: Vaibhav Hiremath <hvaibhav@ti.com>
 *
 * Contributors:
 *     Sivaraj R <sivaraj@ti.com>
 *     Brijesh R Jadav <brijesh.j@ti.com>
 *     Hardik Shah <hardik.shah@ti.com>
 *     Manjunath Hadli <mrh@ti.com>
 *     Karicheri Muralidharan <m-karicheri2@ti.com>
 *     Prabhakar Lad <prabhakar.lad@ti.com>
 */

#include <linux/delay.h>
#include <linux/i2c.h>
#include <linux/mod_devicetable.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_graph.h>
#include <linux/slab.h>
#include <linux/v4l2-mediabus.h>
#include <linux/videodev2.h>

#include <media/i2c/tvp514x.h>
#include <media/media-entity.h>
#include <media/v4l2-async.h>
#include <media/v4l2-common.h>
#include <media/v4l2-ctrls.h>
#include <media/v4l2-device.h>
#include <media/v4l2-fwnode.h>
#include <media/v4l2-mediabus.h>

#include "tvp514x_regs.h"

/* Private macros for TVP */
#define I2C_RETRY_COUNT                 (5)
#define LOCK_RETRY_COUNT                (5)
#define LOCK_RETRY_DELAY                (200)

/* Debug functions */
static bool debug;
module_param(debug, bool, 0644);
MODULE_PARM_DESC(debug, "Debug level (0-1)");

MODULE_AUTHOR("Texas Instruments");
MODULE_DESCRIPTION("TVP514X linux decoder driver");
MODULE_LICENSE("GPL");

/* enum tvp514x_std - enum for supported standards */
enum tvp514x_std {
 STD_NTSC_MJ = 0,
 STD_PAL_BDGHIN,
 STD_INVALID
};

/**
 * struct tvp514x_std_info - Structure to store standard information
 * @width: Line width in pixels
 * @height:Number of active lines
 * @video_std: Value to write in REG_VIDEO_STD register
 * @standard: v4l2 standard structure information
 */
struct tvp514x_std_info {
 unsigned long width;
 unsigned long height;
 u8 video_std;
 struct v4l2_standard standard;
};

static struct tvp514x_reg tvp514x_reg_list_default[0x40];

static int tvp514x_s_stream(struct v4l2_subdev *sd, int enable);
/**
 * struct tvp514x_decoder - TVP5146/47 decoder object
 * @sd: Subdevice Slave handle
 * @hdl: embedded &struct v4l2_ctrl_handler
 * @tvp514x_regs: copy of hw's regs with preset values.
 * @pdata: Board specific
 * @ver: Chip version
 * @streaming: TVP5146/47 decoder streaming - enabled or disabled.
 * @pix: Current pixel format
 * @num_fmts: Number of formats
 * @fmt_list: Format list
 * @current_std: Current standard
 * @num_stds: Number of standards
 * @std_list: Standards list
 * @input: Input routing at chip level
 * @output: Output routing at chip level
 * @pad: subdev media pad associated with the decoder
 * @format: media bus frame format
 * @int_seq: driver's register init sequence
 */
struct tvp514x_decoder {
 struct v4l2_subdev sd;
 struct v4l2_ctrl_handler hdl;
 struct tvp514x_reg tvp514x_regs[ARRAY_SIZE(tvp514x_reg_list_default)];
 const struct tvp514x_platform_data *pdata;

 int ver;
 int streaming;

 struct v4l2_pix_format pix;
 int num_fmts;
 const struct v4l2_fmtdesc *fmt_list;

 enum tvp514x_std current_std;
 int num_stds;
 const struct tvp514x_std_info *std_list;
 /* Input and Output Routing parameters */
 u32 input;
 u32 output;

 /* mc related members */
 struct media_pad pad;
 struct v4l2_mbus_framefmt format;

 const struct tvp514x_reg *int_seq;
};

/* TVP514x default register values */
static struct tvp514x_reg tvp514x_reg_list_default[] = {
 /* Composite selected */
 {TOK_WRITE, REG_INPUT_SEL, 0x05},
 {TOK_WRITE, REG_AFE_GAIN_CTRL, 0x0F},
 /* Auto mode */
 {TOK_WRITE, REG_VIDEO_STD, 0x00},
 {TOK_WRITE, REG_OPERATION_MODE, 0x00},
 {TOK_SKIP, REG_AUTOSWITCH_MASK, 0x3F},
 {TOK_WRITE, REG_COLOR_KILLER, 0x10},
 {TOK_WRITE, REG_LUMA_CONTROL1, 0x00},
 {TOK_WRITE, REG_LUMA_CONTROL2, 0x00},
 {TOK_WRITE, REG_LUMA_CONTROL3, 0x02},
 {TOK_WRITE, REG_BRIGHTNESS, 0x80},
 {TOK_WRITE, REG_CONTRAST, 0x80},
 {TOK_WRITE, REG_SATURATION, 0x80},
 {TOK_WRITE, REG_HUE, 0x00},
 {TOK_WRITE, REG_CHROMA_CONTROL1, 0x00},
 {TOK_WRITE, REG_CHROMA_CONTROL2, 0x0E},
 /* Reserved */
 {TOK_SKIP, 0x0F, 0x00},
 {TOK_WRITE, REG_COMP_PR_SATURATION, 0x80},
 {TOK_WRITE, REG_COMP_Y_CONTRAST, 0x80},
 {TOK_WRITE, REG_COMP_PB_SATURATION, 0x80},
 /* Reserved */
 {TOK_SKIP, 0x13, 0x00},
 {TOK_WRITE, REG_COMP_Y_BRIGHTNESS, 0x80},
 /* Reserved */
 {TOK_SKIP, 0x15, 0x00},
 /* NTSC timing */
 {TOK_SKIP, REG_AVID_START_PIXEL_LSB, 0x55},
 {TOK_SKIP, REG_AVID_START_PIXEL_MSB, 0x00},
 {TOK_SKIP, REG_AVID_STOP_PIXEL_LSB, 0x25},
 {TOK_SKIP, REG_AVID_STOP_PIXEL_MSB, 0x03},
 /* NTSC timing */
 {TOK_SKIP, REG_HSYNC_START_PIXEL_LSB, 0x00},
 {TOK_SKIP, REG_HSYNC_START_PIXEL_MSB, 0x00},
 {TOK_SKIP, REG_HSYNC_STOP_PIXEL_LSB, 0x40},
 {TOK_SKIP, REG_HSYNC_STOP_PIXEL_MSB, 0x00},
 /* NTSC timing */
 {TOK_SKIP, REG_VSYNC_START_LINE_LSB, 0x04},
 {TOK_SKIP, REG_VSYNC_START_LINE_MSB, 0x00},
 {TOK_SKIP, REG_VSYNC_STOP_LINE_LSB, 0x07},
 {TOK_SKIP, REG_VSYNC_STOP_LINE_MSB, 0x00},
 /* NTSC timing */
 {TOK_SKIP, REG_VBLK_START_LINE_LSB, 0x01},
 {TOK_SKIP, REG_VBLK_START_LINE_MSB, 0x00},
 {TOK_SKIP, REG_VBLK_STOP_LINE_LSB, 0x15},
 {TOK_SKIP, REG_VBLK_STOP_LINE_MSB, 0x00},
 /* Reserved */
 {TOK_SKIP, 0x26, 0x00},
 /* Reserved */
 {TOK_SKIP, 0x27, 0x00},
 {TOK_SKIP, REG_FAST_SWTICH_CONTROL, 0xCC},
 /* Reserved */
 {TOK_SKIP, 0x29, 0x00},
 {TOK_SKIP, REG_FAST_SWTICH_SCART_DELAY, 0x00},
 /* Reserved */
 {TOK_SKIP, 0x2B, 0x00},
 {TOK_SKIP, REG_SCART_DELAY, 0x00},
 {TOK_SKIP, REG_CTI_DELAY, 0x00},
 {TOK_SKIP, REG_CTI_CONTROL, 0x00},
 /* Reserved */
 {TOK_SKIP, 0x2F, 0x00},
 /* Reserved */
 {TOK_SKIP, 0x30, 0x00},
 /* Reserved */
 {TOK_SKIP, 0x31, 0x00},
 /* HS, VS active high */
 {TOK_WRITE, REG_SYNC_CONTROL, 0x00},
 /* 10-bit BT.656 */
 {TOK_WRITE, REG_OUTPUT_FORMATTER1, 0x00},
 /* Enable clk & data */
 {TOK_WRITE, REG_OUTPUT_FORMATTER2, 0x11},
 /* Enable AVID & FLD */
 {TOK_WRITE, REG_OUTPUT_FORMATTER3, 0xEE},
 /* Enable VS & HS */
 {TOK_WRITE, REG_OUTPUT_FORMATTER4, 0xAF},
 {TOK_WRITE, REG_OUTPUT_FORMATTER5, 0xFF},
 {TOK_WRITE, REG_OUTPUT_FORMATTER6, 0xFF},
 /* Clear status */
 {TOK_WRITE, REG_CLEAR_LOST_LOCK, 0x01},
 {TOK_TERM, 0, 0},
};

/*
 * List of image formats supported by TVP5146/47 decoder
 * Currently we are using 8 bit mode only, but can be
 * extended to 10/20 bit mode.
 */
static const struct v4l2_fmtdesc tvp514x_fmt_list[] = {
 {
  .index  = 0,
  .type  = V4L2_BUF_TYPE_VIDEO_CAPTURE,
  .flags  = 0,
  .description = "8-bit UYVY 4:2:2 Format",
  .pixelformat = V4L2_PIX_FMT_UYVY,
 },
};

/*
 * Supported standards -
 *
 * Currently supports two standards only, need to add support for rest of the
 * modes, like SECAM, etc...
 */
static const struct tvp514x_std_info tvp514x_std_list[] = {
 /* Standard: STD_NTSC_MJ */
 [STD_NTSC_MJ] = {
  .width = NTSC_NUM_ACTIVE_PIXELS,
  .height = NTSC_NUM_ACTIVE_LINES,
  .video_std = VIDEO_STD_NTSC_MJ_BIT,
  .standard = {
        .index = 0,
        .id = V4L2_STD_NTSC,
        .name = "NTSC",
        .frameperiod = {1001, 30000},
        .framelines = 525
       },
 /* Standard: STD_PAL_BDGHIN */
 },
 [STD_PAL_BDGHIN] = {
  .width = PAL_NUM_ACTIVE_PIXELS,
  .height = PAL_NUM_ACTIVE_LINES,
  .video_std = VIDEO_STD_PAL_BDGHIN_BIT,
  .standard = {
        .index = 1,
        .id = V4L2_STD_PAL,
        .name = "PAL",
        .frameperiod = {1, 25},
        .framelines = 625
       },
 },
 /* Standard: need to add for additional standard */
};


static inline struct tvp514x_decoder *to_decoder(struct v4l2_subdev *sd)
{
 return container_of(sd, struct tvp514x_decoder, sd);
}

static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl)
{
 return &container_of(ctrl->handler, struct tvp514x_decoder, hdl)->sd;
}


/**
 * tvp514x_read_reg() - Read a value from a register in an TVP5146/47.
 * @sd: ptr to v4l2_subdev struct
 * @reg: TVP5146/47 register address
 *
 * Returns value read if successful, or non-zero (-1) otherwise.
 */
static int tvp514x_read_reg(struct v4l2_subdev *sd, u8 reg)
{
 int err, retry = 0;
 struct i2c_client *client = v4l2_get_subdevdata(sd);

read_again:

 err = i2c_smbus_read_byte_data(client, reg);
 if (err < 0) {
  if (retry <= I2C_RETRY_COUNT) {
   v4l2_warn(sd, "Read: retry ... %d\n", retry);
   retry++;
   msleep_interruptible(10);
   goto read_again;
  }
 }

 return err;
}

/**
 * dump_reg() - dump the register content of TVP5146/47.
 * @sd: ptr to v4l2_subdev struct
 * @reg: TVP5146/47 register address
 */
static void dump_reg(struct v4l2_subdev *sd, u8 reg)
{
 u32 val;

 val = tvp514x_read_reg(sd, reg);
 v4l2_info(sd, "Reg(0x%.2X): 0x%.2X\n", reg, val);
}

/**
 * tvp514x_write_reg() - Write a value to a register in TVP5146/47
 * @sd: ptr to v4l2_subdev struct
 * @reg: TVP5146/47 register address
 * @val: value to be written to the register
 *
 * Write a value to a register in an TVP5146/47 decoder device.
 * Returns zero if successful, or non-zero otherwise.
 */
static int tvp514x_write_reg(struct v4l2_subdev *sd, u8 reg, u8 val)
{
 int err, retry = 0;
 struct i2c_client *client = v4l2_get_subdevdata(sd);

write_again:

 err = i2c_smbus_write_byte_data(client, reg, val);
 if (err) {
  if (retry <= I2C_RETRY_COUNT) {
   v4l2_warn(sd, "Write: retry ... %d\n", retry);
   retry++;
   msleep_interruptible(10);
   goto write_again;
  }
 }

 return err;
}

/**
 * tvp514x_write_regs() : Initializes a list of TVP5146/47 registers
 * @sd: ptr to v4l2_subdev struct
 * @reglist: list of TVP5146/47 registers and values
 *
 * Initializes a list of TVP5146/47 registers:-
 * if token is TOK_TERM, then entire write operation terminates
 * if token is TOK_DELAY, then a delay of 'val' msec is introduced
 * if token is TOK_SKIP, then the register write is skipped
 * if token is TOK_WRITE, then the register write is performed
 * Returns zero if successful, or non-zero otherwise.
 */
static int tvp514x_write_regs(struct v4l2_subdev *sd,
         const struct tvp514x_reg reglist[])
{
 int err;
 const struct tvp514x_reg *next = reglist;

 for (; next->token != TOK_TERM; next++) {
  if (next->token == TOK_DELAY) {
   msleep(next->val);
   continue;
  }

  if (next->token == TOK_SKIP)
   continue;

  err = tvp514x_write_reg(sd, next->reg, (u8) next->val);
  if (err) {
   v4l2_err(sd, "Write failed. Err[%d]\n", err);
   return err;
  }
 }
 return 0;
}

/**
 * tvp514x_query_current_std() : Query the current standard detected by TVP5146/47
 * @sd: ptr to v4l2_subdev struct
 *
 * Returns the current standard detected by TVP5146/47, STD_INVALID if there is no
 * standard detected.
 */
static enum tvp514x_std tvp514x_query_current_std(struct v4l2_subdev *sd)
{
 u8 std, std_status;

 std = tvp514x_read_reg(sd, REG_VIDEO_STD);
 if ((std & VIDEO_STD_MASK) == VIDEO_STD_AUTO_SWITCH_BIT)
  /* use the standard status register */
  std_status = tvp514x_read_reg(sd, REG_VIDEO_STD_STATUS);
 else
  /* use the standard register itself */
  std_status = std;

 switch (std_status & VIDEO_STD_MASK) {
 case VIDEO_STD_NTSC_MJ_BIT:
  return STD_NTSC_MJ;

 case VIDEO_STD_PAL_BDGHIN_BIT:
  return STD_PAL_BDGHIN;

 default:
  return STD_INVALID;
 }

 return STD_INVALID;
}

/* TVP5146/47 register dump function */
static void tvp514x_reg_dump(struct v4l2_subdev *sd)
{
 dump_reg(sd, REG_INPUT_SEL);
 dump_reg(sd, REG_AFE_GAIN_CTRL);
 dump_reg(sd, REG_VIDEO_STD);
 dump_reg(sd, REG_OPERATION_MODE);
 dump_reg(sd, REG_COLOR_KILLER);
 dump_reg(sd, REG_LUMA_CONTROL1);
 dump_reg(sd, REG_LUMA_CONTROL2);
 dump_reg(sd, REG_LUMA_CONTROL3);
 dump_reg(sd, REG_BRIGHTNESS);
 dump_reg(sd, REG_CONTRAST);
 dump_reg(sd, REG_SATURATION);
 dump_reg(sd, REG_HUE);
 dump_reg(sd, REG_CHROMA_CONTROL1);
 dump_reg(sd, REG_CHROMA_CONTROL2);
 dump_reg(sd, REG_COMP_PR_SATURATION);
 dump_reg(sd, REG_COMP_Y_CONTRAST);
 dump_reg(sd, REG_COMP_PB_SATURATION);
 dump_reg(sd, REG_COMP_Y_BRIGHTNESS);
 dump_reg(sd, REG_AVID_START_PIXEL_LSB);
 dump_reg(sd, REG_AVID_START_PIXEL_MSB);
 dump_reg(sd, REG_AVID_STOP_PIXEL_LSB);
 dump_reg(sd, REG_AVID_STOP_PIXEL_MSB);
 dump_reg(sd, REG_HSYNC_START_PIXEL_LSB);
 dump_reg(sd, REG_HSYNC_START_PIXEL_MSB);
 dump_reg(sd, REG_HSYNC_STOP_PIXEL_LSB);
 dump_reg(sd, REG_HSYNC_STOP_PIXEL_MSB);
 dump_reg(sd, REG_VSYNC_START_LINE_LSB);
 dump_reg(sd, REG_VSYNC_START_LINE_MSB);
 dump_reg(sd, REG_VSYNC_STOP_LINE_LSB);
 dump_reg(sd, REG_VSYNC_STOP_LINE_MSB);
 dump_reg(sd, REG_VBLK_START_LINE_LSB);
 dump_reg(sd, REG_VBLK_START_LINE_MSB);
 dump_reg(sd, REG_VBLK_STOP_LINE_LSB);
 dump_reg(sd, REG_VBLK_STOP_LINE_MSB);
 dump_reg(sd, REG_SYNC_CONTROL);
 dump_reg(sd, REG_OUTPUT_FORMATTER1);
 dump_reg(sd, REG_OUTPUT_FORMATTER2);
 dump_reg(sd, REG_OUTPUT_FORMATTER3);
 dump_reg(sd, REG_OUTPUT_FORMATTER4);
 dump_reg(sd, REG_OUTPUT_FORMATTER5);
 dump_reg(sd, REG_OUTPUT_FORMATTER6);
 dump_reg(sd, REG_CLEAR_LOST_LOCK);
}

/**
 * tvp514x_configure() - Configure the TVP5146/47 registers
 * @sd: ptr to v4l2_subdev struct
 * @decoder: ptr to tvp514x_decoder structure
 *
 * Returns zero if successful, or non-zero otherwise.
 */
static int tvp514x_configure(struct v4l2_subdev *sd,
  struct tvp514x_decoder *decoder)
{
 int err;

 /* common register initialization */
 err =
     tvp514x_write_regs(sd, decoder->tvp514x_regs);
 if (err)
  return err;

 if (debug)
  tvp514x_reg_dump(sd);

 return 0;
}

/**
 * tvp514x_detect() - Detect if an tvp514x is present, and if so which revision.
 * @sd: pointer to standard V4L2 sub-device structure
 * @decoder: pointer to tvp514x_decoder structure
 *
 * A device is considered to be detected if the chip ID (LSB and MSB)
 * registers match the expected values.
 * Any value of the rom version register is accepted.
 * Returns ENODEV error number if no device is detected, or zero
 * if a device is detected.
 */
static int tvp514x_detect(struct v4l2_subdev *sd,
  struct tvp514x_decoder *decoder)
{
 u8 chip_id_msb, chip_id_lsb, rom_ver;
 struct i2c_client *client = v4l2_get_subdevdata(sd);

 chip_id_msb = tvp514x_read_reg(sd, REG_CHIP_ID_MSB);
 chip_id_lsb = tvp514x_read_reg(sd, REG_CHIP_ID_LSB);
 rom_ver = tvp514x_read_reg(sd, REG_ROM_VERSION);

 v4l2_dbg(1, debug, sd,
   "chip id detected msb:0x%x lsb:0x%x rom version:0x%x\n",
   chip_id_msb, chip_id_lsb, rom_ver);
 if ((chip_id_msb != TVP514X_CHIP_ID_MSB)
  || ((chip_id_lsb != TVP5146_CHIP_ID_LSB)
  && (chip_id_lsb != TVP5147_CHIP_ID_LSB))) {
  /* We didn't read the values we expected, so this must not be
 * an TVP5146/47.
 */
  v4l2_err(sd, "chip id mismatch msb:0x%x lsb:0x%x\n",
    chip_id_msb, chip_id_lsb);
  return -ENODEV;
 }

 decoder->ver = rom_ver;

 v4l2_info(sd, "%s (Version - 0x%.2x) found at 0x%x (%s)\n",
   client->name, decoder->ver,
   client->addr << 1, client->adapter->name);
 return 0;
}

/**
 * tvp514x_querystd() - V4L2 decoder interface handler for querystd
 * @sd: pointer to standard V4L2 sub-device structure
 * @std_id: standard V4L2 std_id ioctl enum
 *
 * Returns the current standard detected by TVP5146/47. If no active input is
 * detected then *std_id is set to 0 and the function returns 0.
 */
static int tvp514x_querystd(struct v4l2_subdev *sd, v4l2_std_id *std_id)
{
 struct tvp514x_decoder *decoder = to_decoder(sd);
 enum tvp514x_std current_std;
 enum tvp514x_input input_sel;
 u8 sync_lock_status, lock_mask;

 if (std_id == NULL)
  return -EINVAL;

 /* To query the standard the TVP514x must power on the ADCs. */
 if (!decoder->streaming) {
  tvp514x_s_stream(sd, 1);
  msleep(LOCK_RETRY_DELAY);
 }

 /* query the current standard */
 current_std = tvp514x_query_current_std(sd);
 if (current_std == STD_INVALID) {
  *std_id = V4L2_STD_UNKNOWN;
  return 0;
 }

 input_sel = decoder->input;

 switch (input_sel) {
 case INPUT_CVBS_VI1A:
 case INPUT_CVBS_VI1B:
 case INPUT_CVBS_VI1C:
 case INPUT_CVBS_VI2A:
 case INPUT_CVBS_VI2B:
 case INPUT_CVBS_VI2C:
 case INPUT_CVBS_VI3A:
 case INPUT_CVBS_VI3B:
 case INPUT_CVBS_VI3C:
 case INPUT_CVBS_VI4A:
  lock_mask = STATUS_CLR_SUBCAR_LOCK_BIT |
   STATUS_HORZ_SYNC_LOCK_BIT |
   STATUS_VIRT_SYNC_LOCK_BIT;
  break;

 case INPUT_SVIDEO_VI2A_VI1A:
 case INPUT_SVIDEO_VI2B_VI1B:
 case INPUT_SVIDEO_VI2C_VI1C:
 case INPUT_SVIDEO_VI2A_VI3A:
 case INPUT_SVIDEO_VI2B_VI3B:
 case INPUT_SVIDEO_VI2C_VI3C:
 case INPUT_SVIDEO_VI4A_VI1A:
 case INPUT_SVIDEO_VI4A_VI1B:
 case INPUT_SVIDEO_VI4A_VI1C:
 case INPUT_SVIDEO_VI4A_VI3A:
 case INPUT_SVIDEO_VI4A_VI3B:
 case INPUT_SVIDEO_VI4A_VI3C:
  lock_mask = STATUS_HORZ_SYNC_LOCK_BIT |
   STATUS_VIRT_SYNC_LOCK_BIT;
  break;
  /*Need to add other interfaces*/
 default:
  return -EINVAL;
 }
 /* check whether signal is locked */
 sync_lock_status = tvp514x_read_reg(sd, REG_STATUS1);
 if (lock_mask != (sync_lock_status & lock_mask)) {
  *std_id = V4L2_STD_UNKNOWN;
  return 0; /* No input detected */
 }

 *std_id &= decoder->std_list[current_std].standard.id;

 v4l2_dbg(1, debug, sd, "Current STD: %s\n",
   decoder->std_list[current_std].standard.name);
 return 0;
}

/**
 * tvp514x_s_std() - V4L2 decoder interface handler for s_std
 * @sd: pointer to standard V4L2 sub-device structure
 * @std_id: standard V4L2 v4l2_std_id ioctl enum
 *
 * If std_id is supported, sets the requested standard. Otherwise, returns
 * -EINVAL
 */
static int tvp514x_s_std(struct v4l2_subdev *sd, v4l2_std_id std_id)
{
 struct tvp514x_decoder *decoder = to_decoder(sd);
 int err, i;

 for (i = 0; i < decoder->num_stds; i++)
  if (std_id & decoder->std_list[i].standard.id)
   break;

 if ((i == decoder->num_stds) || (i == STD_INVALID))
  return -EINVAL;

 err = tvp514x_write_reg(sd, REG_VIDEO_STD,
    decoder->std_list[i].video_std);
 if (err)
  return err;

 decoder->current_std = i;
 decoder->tvp514x_regs[REG_VIDEO_STD].val =
  decoder->std_list[i].video_std;

 v4l2_dbg(1, debug, sd, "Standard set to: %s\n",
   decoder->std_list[i].standard.name);
 return 0;
}

/**
 * tvp514x_s_routing() - V4L2 decoder interface handler for s_routing
 * @sd: pointer to standard V4L2 sub-device structure
 * @input: input selector for routing the signal
 * @output: output selector for routing the signal
 * @config: config value. Not used
 *
 * If index is valid, selects the requested input. Otherwise, returns -EINVAL if
 * the input is not supported or there is no active signal present in the
 * selected input.
 */
static int tvp514x_s_routing(struct v4l2_subdev *sd,
    u32 input, u32 output, u32 config)
{
 struct tvp514x_decoder *decoder = to_decoder(sd);
 int err;
 enum tvp514x_input input_sel;
 enum tvp514x_output output_sel;

 if ((input >= INPUT_INVALID) ||
   (output >= OUTPUT_INVALID))
  /* Index out of bound */
  return -EINVAL;

 input_sel = input;
 output_sel = output;

 err = tvp514x_write_reg(sd, REG_INPUT_SEL, input_sel);
 if (err)
  return err;

 output_sel |= tvp514x_read_reg(sd,
   REG_OUTPUT_FORMATTER1) & 0x7;
 err = tvp514x_write_reg(sd, REG_OUTPUT_FORMATTER1,
   output_sel);
 if (err)
  return err;

 decoder->tvp514x_regs[REG_INPUT_SEL].val = input_sel;
 decoder->tvp514x_regs[REG_OUTPUT_FORMATTER1].val = output_sel;
 decoder->input = input;
 decoder->output = output;

 v4l2_dbg(1, debug, sd, "Input set to: %d\n", input_sel);

 return 0;
}

/**
 * tvp514x_s_ctrl() - V4L2 decoder interface handler for s_ctrl
 * @ctrl: pointer to v4l2_ctrl structure
 *
 * If the requested control is supported, sets the control's current
 * value in HW. Otherwise, returns -EINVAL if the control is not supported.
 */
static int tvp514x_s_ctrl(struct v4l2_ctrl *ctrl)
{
 struct v4l2_subdev *sd = to_sd(ctrl);
 struct tvp514x_decoder *decoder = to_decoder(sd);
 int err = -EINVAL, value;

 value = ctrl->val;

 switch (ctrl->id) {
 case V4L2_CID_BRIGHTNESS:
  err = tvp514x_write_reg(sd, REG_BRIGHTNESS, value);
  if (!err)
   decoder->tvp514x_regs[REG_BRIGHTNESS].val = value;
  break;
 case V4L2_CID_CONTRAST:
  err = tvp514x_write_reg(sd, REG_CONTRAST, value);
  if (!err)
   decoder->tvp514x_regs[REG_CONTRAST].val = value;
  break;
 case V4L2_CID_SATURATION:
  err = tvp514x_write_reg(sd, REG_SATURATION, value);
  if (!err)
   decoder->tvp514x_regs[REG_SATURATION].val = value;
  break;
 case V4L2_CID_HUE:
  if (value == 180)
   value = 0x7F;
  else if (value == -180)
   value = 0x80;
  err = tvp514x_write_reg(sd, REG_HUE, value);
  if (!err)
   decoder->tvp514x_regs[REG_HUE].val = value;
  break;
 case V4L2_CID_AUTOGAIN:
  err = tvp514x_write_reg(sd, REG_AFE_GAIN_CTRL, value ? 0x0f : 0x0c);
  if (!err)
   decoder->tvp514x_regs[REG_AFE_GAIN_CTRL].val = value;
  break;
 }

 v4l2_dbg(1, debug, sd, "Set Control: ID - %d - %d\n",
   ctrl->id, ctrl->val);
 return err;
}

static int
tvp514x_get_frame_interval(struct v4l2_subdev *sd,
      struct v4l2_subdev_state *sd_state,
      struct v4l2_subdev_frame_interval *ival)
{
 struct tvp514x_decoder *decoder = to_decoder(sd);
 enum tvp514x_std current_std;

 /*
 * FIXME: Implement support for V4L2_SUBDEV_FORMAT_TRY, using the V4L2
 * subdev active state API.
 */
 if (ival->which != V4L2_SUBDEV_FORMAT_ACTIVE)
  return -EINVAL;

 /* get the current standard */
 current_std = decoder->current_std;

 ival->interval =
  decoder->std_list[current_std].standard.frameperiod;

 return 0;
}

static int
tvp514x_set_frame_interval(struct v4l2_subdev *sd,
      struct v4l2_subdev_state *sd_state,
      struct v4l2_subdev_frame_interval *ival)
{
 struct tvp514x_decoder *decoder = to_decoder(sd);
 struct v4l2_fract *timeperframe;
 enum tvp514x_std current_std;

 /*
 * FIXME: Implement support for V4L2_SUBDEV_FORMAT_TRY, using the V4L2
 * subdev active state API.
 */
 if (ival->which != V4L2_SUBDEV_FORMAT_ACTIVE)
  return -EINVAL;

 timeperframe = &ival->interval;

 /* get the current standard */
 current_std = decoder->current_std;

 *timeperframe =
     decoder->std_list[current_std].standard.frameperiod;

 return 0;
}

/**
 * tvp514x_s_stream() - V4L2 decoder i/f handler for s_stream
 * @sd: pointer to standard V4L2 sub-device structure
 * @enable: streaming enable or disable
 *
 * Sets streaming to enable or disable, if possible.
 */
static int tvp514x_s_stream(struct v4l2_subdev *sd, int enable)
{
 int err = 0;
 struct tvp514x_decoder *decoder = to_decoder(sd);

 if (decoder->streaming == enable)
  return 0;

 switch (enable) {
 case 0:
 {
  /* Power Down Sequence */
  err = tvp514x_write_reg(sd, REG_OPERATION_MODE, 0x01);
  if (err) {
   v4l2_err(sd, "Unable to turn off decoder\n");
   return err;
  }
  decoder->streaming = enable;
  break;
 }
 case 1:
 {
  /* Power Up Sequence */
  err = tvp514x_write_regs(sd, decoder->int_seq);
  if (err) {
   v4l2_err(sd, "Unable to turn on decoder\n");
   return err;
  }
  /* Detect if not already detected */
  err = tvp514x_detect(sd, decoder);
  if (err) {
   v4l2_err(sd, "Unable to detect decoder\n");
   return err;
  }
  err = tvp514x_configure(sd, decoder);
  if (err) {
   v4l2_err(sd, "Unable to configure decoder\n");
   return err;
  }
  decoder->streaming = enable;
  break;
 }
 default:
  err = -ENODEV;
  break;
 }

 return err;
}

static const struct v4l2_ctrl_ops tvp514x_ctrl_ops = {
 .s_ctrl = tvp514x_s_ctrl,
};

/**
 * tvp514x_enum_mbus_code() - V4L2 decoder interface handler for enum_mbus_code
 * @sd: pointer to standard V4L2 sub-device structure
 * @sd_state: subdev state
 * @code: pointer to v4l2_subdev_mbus_code_enum structure
 *
 * Enumertaes mbus codes supported
 */
static int tvp514x_enum_mbus_code(struct v4l2_subdev *sd,
      struct v4l2_subdev_state *sd_state,
      struct v4l2_subdev_mbus_code_enum *code)
{
 u32 pad = code->pad;
 u32 index = code->index;

 memset(code, 0, sizeof(*code));
 code->index = index;
 code->pad = pad;

 if (index != 0)
  return -EINVAL;

 code->code = MEDIA_BUS_FMT_UYVY8_2X8;

 return 0;
}

/**
 * tvp514x_get_pad_format() - V4L2 decoder interface handler for get pad format
 * @sd: pointer to standard V4L2 sub-device structure
 * @sd_state: subdev state
 * @format: pointer to v4l2_subdev_format structure
 *
 * Retrieves pad format which is active or tried based on requirement
 */
static int tvp514x_get_pad_format(struct v4l2_subdev *sd,
      struct v4l2_subdev_state *sd_state,
      struct v4l2_subdev_format *format)
{
 struct tvp514x_decoder *decoder = to_decoder(sd);
 __u32 which = format->which;

 if (format->pad)
  return -EINVAL;

 if (which == V4L2_SUBDEV_FORMAT_ACTIVE) {
  format->format = decoder->format;
  return 0;
 }

 format->format.code = MEDIA_BUS_FMT_UYVY8_2X8;
 format->format.width = tvp514x_std_list[decoder->current_std].width;
 format->format.height = tvp514x_std_list[decoder->current_std].height;
 format->format.colorspace = V4L2_COLORSPACE_SMPTE170M;
 format->format.field = V4L2_FIELD_INTERLACED;

 return 0;
}

/**
 * tvp514x_set_pad_format() - V4L2 decoder interface handler for set pad format
 * @sd: pointer to standard V4L2 sub-device structure
 * @sd_state: subdev state
 * @fmt: pointer to v4l2_subdev_format structure
 *
 * Set pad format for the output pad
 */
static int tvp514x_set_pad_format(struct v4l2_subdev *sd,
      struct v4l2_subdev_state *sd_state,
      struct v4l2_subdev_format *fmt)
{
 struct tvp514x_decoder *decoder = to_decoder(sd);

 if (fmt->format.field != V4L2_FIELD_INTERLACED ||
     fmt->format.code != MEDIA_BUS_FMT_UYVY8_2X8 ||
     fmt->format.colorspace != V4L2_COLORSPACE_SMPTE170M ||
     fmt->format.width != tvp514x_std_list[decoder->current_std].width ||
     fmt->format.height != tvp514x_std_list[decoder->current_std].height)
  return -EINVAL;

 decoder->format = fmt->format;

 return 0;
}

static const struct v4l2_subdev_video_ops tvp514x_video_ops = {
 .s_std = tvp514x_s_std,
 .s_routing = tvp514x_s_routing,
 .querystd = tvp514x_querystd,
 .s_stream = tvp514x_s_stream,
};

static const struct v4l2_subdev_pad_ops tvp514x_pad_ops = {
 .enum_mbus_code = tvp514x_enum_mbus_code,
 .get_fmt = tvp514x_get_pad_format,
 .set_fmt = tvp514x_set_pad_format,
 .get_frame_interval = tvp514x_get_frame_interval,
 .set_frame_interval = tvp514x_set_frame_interval,
};

static const struct v4l2_subdev_ops tvp514x_ops = {
 .video = &tvp514x_video_ops,
 .pad = &tvp514x_pad_ops,
};

static const struct tvp514x_decoder tvp514x_dev = {
 .streaming = 0,
 .fmt_list = tvp514x_fmt_list,
 .num_fmts = ARRAY_SIZE(tvp514x_fmt_list),
 .pix = {
  /* Default to NTSC 8-bit YUV 422 */
  .width  = NTSC_NUM_ACTIVE_PIXELS,
  .height  = NTSC_NUM_ACTIVE_LINES,
  .pixelformat = V4L2_PIX_FMT_UYVY,
  .field  = V4L2_FIELD_INTERLACED,
  .bytesperline = NTSC_NUM_ACTIVE_PIXELS * 2,
  .sizeimage = NTSC_NUM_ACTIVE_PIXELS * 2 *
     NTSC_NUM_ACTIVE_LINES,
  .colorspace = V4L2_COLORSPACE_SMPTE170M,
  },
 .current_std = STD_NTSC_MJ,
 .std_list = tvp514x_std_list,
 .num_stds = ARRAY_SIZE(tvp514x_std_list),

};

static struct tvp514x_platform_data *
tvp514x_get_pdata(struct i2c_client *client)
{
 struct tvp514x_platform_data *pdata = NULL;
 struct v4l2_fwnode_endpoint bus_cfg = { .bus_type = 0 };
 struct device_node *endpoint;
 unsigned int flags;

 if (!IS_ENABLED(CONFIG_OF) || !client->dev.of_node)
  return client->dev.platform_data;

 endpoint = of_graph_get_endpoint_by_regs(client->dev.of_node, 0, -1);
 if (!endpoint)
  return NULL;

 if (v4l2_fwnode_endpoint_parse(of_fwnode_handle(endpoint), &bus_cfg))
  goto done;

 pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);
 if (!pdata)
  goto done;

 flags = bus_cfg.bus.parallel.flags;

 if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH)
  pdata->hs_polarity = 1;

 if (flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH)
  pdata->vs_polarity = 1;

 if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING)
  pdata->clk_polarity = 1;

done:
 of_node_put(endpoint);
 return pdata;
}

/**
 * tvp514x_probe() - decoder driver i2c probe handler
 * @client: i2c driver client device structure
 *
 * Register decoder as an i2c client device and V4L2
 * device.
 */
static int
tvp514x_probe(struct i2c_client *client)
{
 struct tvp514x_platform_data *pdata = tvp514x_get_pdata(client);
 struct tvp514x_decoder *decoder;
 struct v4l2_subdev *sd;
 int ret;

 if (pdata == NULL) {
  dev_err(&client->dev, "No platform data\n");
  return -EINVAL;
 }

 /* Check if the adapter supports the needed features */
 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
  return -EIO;

 decoder = devm_kzalloc(&client->dev, sizeof(*decoder), GFP_KERNEL);
 if (!decoder)
  return -ENOMEM;

 /* Initialize the tvp514x_decoder with default configuration */
 *decoder = tvp514x_dev;
 /* Copy default register configuration */
 memcpy(decoder->tvp514x_regs, tvp514x_reg_list_default,
   sizeof(tvp514x_reg_list_default));

 decoder->int_seq = i2c_get_match_data(client);

 /* Copy board specific information here */
 decoder->pdata = pdata;

 /**
 * Fetch platform specific data, and configure the
 * tvp514x_reg_list[] accordingly. Since this is one
 * time configuration, no need to preserve.
 */
 decoder->tvp514x_regs[REG_OUTPUT_FORMATTER2].val |=
  (decoder->pdata->clk_polarity << 1);
 decoder->tvp514x_regs[REG_SYNC_CONTROL].val |=
  ((decoder->pdata->hs_polarity << 2) |
   (decoder->pdata->vs_polarity << 3));
 /* Set default standard to auto */
 decoder->tvp514x_regs[REG_VIDEO_STD].val =
  VIDEO_STD_AUTO_SWITCH_BIT;

 /* Register with V4L2 layer as slave device */
 sd = &decoder->sd;
 v4l2_i2c_subdev_init(sd, client, &tvp514x_ops);

#if defined(CONFIG_MEDIA_CONTROLLER)
 decoder->pad.flags = MEDIA_PAD_FL_SOURCE;
 decoder->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
 decoder->sd.entity.function = MEDIA_ENT_F_ATV_DECODER;

 ret = media_entity_pads_init(&decoder->sd.entity, 1, &decoder->pad);
 if (ret < 0) {
  v4l2_err(sd, "%s decoder driver failed to register !!\n",
    sd->name);
  return ret;
 }
#endif
 v4l2_ctrl_handler_init(&decoder->hdl, 5);
 v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
  V4L2_CID_BRIGHTNESS, 0, 255, 1, 128);
 v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
  V4L2_CID_CONTRAST, 0, 255, 1, 128);
 v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
  V4L2_CID_SATURATION, 0, 255, 1, 128);
 v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
  V4L2_CID_HUE, -180, 180, 180, 0);
 v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
  V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
 sd->ctrl_handler = &decoder->hdl;
 if (decoder->hdl.error) {
  ret = decoder->hdl.error;
  goto done;
 }
 v4l2_ctrl_handler_setup(&decoder->hdl);

 ret = v4l2_async_register_subdev(&decoder->sd);
 if (!ret)
  v4l2_info(sd, "%s decoder driver registered !!\n", sd->name);

done:
 if (ret < 0) {
  v4l2_ctrl_handler_free(&decoder->hdl);
  media_entity_cleanup(&decoder->sd.entity);
 }
 return ret;
}

/**
 * tvp514x_remove() - decoder driver i2c remove handler
 * @client: i2c driver client device structure
 *
 * Unregister decoder as an i2c client device and V4L2
 * device. Complement of tvp514x_probe().
 */
static void tvp514x_remove(struct i2c_client *client)
{
 struct v4l2_subdev *sd = i2c_get_clientdata(client);
 struct tvp514x_decoder *decoder = to_decoder(sd);

 v4l2_async_unregister_subdev(&decoder->sd);
 media_entity_cleanup(&decoder->sd.entity);
 v4l2_ctrl_handler_free(&decoder->hdl);
}
/* TVP5146 Init/Power on Sequence */
static const struct tvp514x_reg tvp5146_init_reg_seq[] = {
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x02},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0x80},
 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0},
 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x00},
 {TOK_WRITE, REG_OPERATION_MODE, 0x01},
 {TOK_WRITE, REG_OPERATION_MODE, 0x00},
 {TOK_TERM, 0, 0},
};

/* TVP5147 Init/Power on Sequence */
static const struct tvp514x_reg tvp5147_init_reg_seq[] = {
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x02},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0x80},
 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0},
 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x16},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xA0},
 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x16},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0},
 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x00},
 {TOK_WRITE, REG_OPERATION_MODE, 0x01},
 {TOK_WRITE, REG_OPERATION_MODE, 0x00},
 {TOK_TERM, 0, 0},
};

/* TVP5146M2/TVP5147M1 Init/Power on Sequence */
static const struct tvp514x_reg tvp514xm_init_reg_seq[] = {
 {TOK_WRITE, REG_OPERATION_MODE, 0x01},
 {TOK_WRITE, REG_OPERATION_MODE, 0x00},
 {TOK_TERM, 0, 0},
};

/*
 * I2C Device Table -
 *
 * name - Name of the actual device/chip.
 * driver_data - Driver data
 */
static const struct i2c_device_id tvp514x_id[] = {
 {"tvp5146", (kernel_ulong_t)tvp5146_init_reg_seq },
 {"tvp5146m2", (kernel_ulong_t)tvp514xm_init_reg_seq },
 {"tvp5147", (kernel_ulong_t)tvp5147_init_reg_seq },
 {"tvp5147m1", (kernel_ulong_t)tvp514xm_init_reg_seq },
 { /* sentinel */ }
};
MODULE_DEVICE_TABLE(i2c, tvp514x_id);

static const struct of_device_id tvp514x_of_match[] = {
 { .compatible = "ti,tvp5146", .data = tvp5146_init_reg_seq },
 { .compatible = "ti,tvp5146m2", .data = tvp514xm_init_reg_seq },
 { .compatible = "ti,tvp5147", .data = tvp5147_init_reg_seq },
 { .compatible = "ti,tvp5147m1", .data = tvp514xm_init_reg_seq },
 { /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, tvp514x_of_match);

static struct i2c_driver tvp514x_driver = {
 .driver = {
  .of_match_table = tvp514x_of_match,
  .name = TVP514X_MODULE_NAME,
 },
 .probe = tvp514x_probe,
 .remove = tvp514x_remove,
 .id_table = tvp514x_id,
};

module_i2c_driver(tvp514x_driver);