drivers/media/i2c/tvp514x.c

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