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