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/i2c/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_video_ops tvp514x_video_ops = { 961 .s_std = tvp514x_s_std, 962 .s_routing = tvp514x_s_routing, 963 .querystd = tvp514x_querystd, 964 .g_parm = tvp514x_g_parm, 965 .s_parm = tvp514x_s_parm, 966 .s_stream = tvp514x_s_stream, 967 }; 968 969 static const struct v4l2_subdev_pad_ops tvp514x_pad_ops = { 970 .enum_mbus_code = tvp514x_enum_mbus_code, 971 .get_fmt = tvp514x_get_pad_format, 972 .set_fmt = tvp514x_set_pad_format, 973 }; 974 975 static const struct v4l2_subdev_ops tvp514x_ops = { 976 .video = &tvp514x_video_ops, 977 .pad = &tvp514x_pad_ops, 978 }; 979 980 static struct tvp514x_decoder tvp514x_dev = { 981 .streaming = 0, 982 .fmt_list = tvp514x_fmt_list, 983 .num_fmts = ARRAY_SIZE(tvp514x_fmt_list), 984 .pix = { 985 /* Default to NTSC 8-bit YUV 422 */ 986 .width = NTSC_NUM_ACTIVE_PIXELS, 987 .height = NTSC_NUM_ACTIVE_LINES, 988 .pixelformat = V4L2_PIX_FMT_UYVY, 989 .field = V4L2_FIELD_INTERLACED, 990 .bytesperline = NTSC_NUM_ACTIVE_PIXELS * 2, 991 .sizeimage = NTSC_NUM_ACTIVE_PIXELS * 2 * 992 NTSC_NUM_ACTIVE_LINES, 993 .colorspace = V4L2_COLORSPACE_SMPTE170M, 994 }, 995 .current_std = STD_NTSC_MJ, 996 .std_list = tvp514x_std_list, 997 .num_stds = ARRAY_SIZE(tvp514x_std_list), 998 999 }; 1000 1001 static struct tvp514x_platform_data * 1002 tvp514x_get_pdata(struct i2c_client *client) 1003 { 1004 struct tvp514x_platform_data *pdata; 1005 struct v4l2_of_endpoint bus_cfg; 1006 struct device_node *endpoint; 1007 unsigned int flags; 1008 1009 if (!IS_ENABLED(CONFIG_OF) || !client->dev.of_node) 1010 return client->dev.platform_data; 1011 1012 endpoint = of_graph_get_next_endpoint(client->dev.of_node, NULL); 1013 if (!endpoint) 1014 return NULL; 1015 1016 pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL); 1017 if (!pdata) 1018 goto done; 1019 1020 v4l2_of_parse_endpoint(endpoint, &bus_cfg); 1021 flags = bus_cfg.bus.parallel.flags; 1022 1023 if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH) 1024 pdata->hs_polarity = 1; 1025 1026 if (flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH) 1027 pdata->vs_polarity = 1; 1028 1029 if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING) 1030 pdata->clk_polarity = 1; 1031 1032 done: 1033 of_node_put(endpoint); 1034 return pdata; 1035 } 1036 1037 /** 1038 * tvp514x_probe() - decoder driver i2c probe handler 1039 * @client: i2c driver client device structure 1040 * @id: i2c driver id table 1041 * 1042 * Register decoder as an i2c client device and V4L2 1043 * device. 1044 */ 1045 static int 1046 tvp514x_probe(struct i2c_client *client, const struct i2c_device_id *id) 1047 { 1048 struct tvp514x_platform_data *pdata = tvp514x_get_pdata(client); 1049 struct tvp514x_decoder *decoder; 1050 struct v4l2_subdev *sd; 1051 int ret; 1052 1053 if (pdata == NULL) { 1054 dev_err(&client->dev, "No platform data\n"); 1055 return -EINVAL; 1056 } 1057 1058 /* Check if the adapter supports the needed features */ 1059 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 1060 return -EIO; 1061 1062 decoder = devm_kzalloc(&client->dev, sizeof(*decoder), GFP_KERNEL); 1063 if (!decoder) 1064 return -ENOMEM; 1065 1066 /* Initialize the tvp514x_decoder with default configuration */ 1067 *decoder = tvp514x_dev; 1068 /* Copy default register configuration */ 1069 memcpy(decoder->tvp514x_regs, tvp514x_reg_list_default, 1070 sizeof(tvp514x_reg_list_default)); 1071 1072 decoder->int_seq = (struct tvp514x_reg *)id->driver_data; 1073 1074 /* Copy board specific information here */ 1075 decoder->pdata = pdata; 1076 1077 /** 1078 * Fetch platform specific data, and configure the 1079 * tvp514x_reg_list[] accordingly. Since this is one 1080 * time configuration, no need to preserve. 1081 */ 1082 decoder->tvp514x_regs[REG_OUTPUT_FORMATTER2].val |= 1083 (decoder->pdata->clk_polarity << 1); 1084 decoder->tvp514x_regs[REG_SYNC_CONTROL].val |= 1085 ((decoder->pdata->hs_polarity << 2) | 1086 (decoder->pdata->vs_polarity << 3)); 1087 /* Set default standard to auto */ 1088 decoder->tvp514x_regs[REG_VIDEO_STD].val = 1089 VIDEO_STD_AUTO_SWITCH_BIT; 1090 1091 /* Register with V4L2 layer as slave device */ 1092 sd = &decoder->sd; 1093 v4l2_i2c_subdev_init(sd, client, &tvp514x_ops); 1094 1095 #if defined(CONFIG_MEDIA_CONTROLLER) 1096 decoder->pad.flags = MEDIA_PAD_FL_SOURCE; 1097 decoder->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; 1098 decoder->sd.entity.flags |= MEDIA_ENT_F_ATV_DECODER; 1099 1100 ret = media_entity_pads_init(&decoder->sd.entity, 1, &decoder->pad); 1101 if (ret < 0) { 1102 v4l2_err(sd, "%s decoder driver failed to register !!\n", 1103 sd->name); 1104 return ret; 1105 } 1106 #endif 1107 v4l2_ctrl_handler_init(&decoder->hdl, 5); 1108 v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops, 1109 V4L2_CID_BRIGHTNESS, 0, 255, 1, 128); 1110 v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops, 1111 V4L2_CID_CONTRAST, 0, 255, 1, 128); 1112 v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops, 1113 V4L2_CID_SATURATION, 0, 255, 1, 128); 1114 v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops, 1115 V4L2_CID_HUE, -180, 180, 180, 0); 1116 v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops, 1117 V4L2_CID_AUTOGAIN, 0, 1, 1, 1); 1118 sd->ctrl_handler = &decoder->hdl; 1119 if (decoder->hdl.error) { 1120 ret = decoder->hdl.error; 1121 goto done; 1122 } 1123 v4l2_ctrl_handler_setup(&decoder->hdl); 1124 1125 ret = v4l2_async_register_subdev(&decoder->sd); 1126 if (!ret) 1127 v4l2_info(sd, "%s decoder driver registered !!\n", sd->name); 1128 1129 done: 1130 if (ret < 0) { 1131 v4l2_ctrl_handler_free(&decoder->hdl); 1132 #if defined(CONFIG_MEDIA_CONTROLLER) 1133 media_entity_cleanup(&decoder->sd.entity); 1134 #endif 1135 } 1136 return ret; 1137 } 1138 1139 /** 1140 * tvp514x_remove() - decoder driver i2c remove handler 1141 * @client: i2c driver client device structure 1142 * 1143 * Unregister decoder as an i2c client device and V4L2 1144 * device. Complement of tvp514x_probe(). 1145 */ 1146 static int tvp514x_remove(struct i2c_client *client) 1147 { 1148 struct v4l2_subdev *sd = i2c_get_clientdata(client); 1149 struct tvp514x_decoder *decoder = to_decoder(sd); 1150 1151 v4l2_async_unregister_subdev(&decoder->sd); 1152 #if defined(CONFIG_MEDIA_CONTROLLER) 1153 media_entity_cleanup(&decoder->sd.entity); 1154 #endif 1155 v4l2_ctrl_handler_free(&decoder->hdl); 1156 return 0; 1157 } 1158 /* TVP5146 Init/Power on Sequence */ 1159 static const struct tvp514x_reg tvp5146_init_reg_seq[] = { 1160 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x02}, 1161 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00}, 1162 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0x80}, 1163 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01}, 1164 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60}, 1165 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00}, 1166 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0}, 1167 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01}, 1168 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x00}, 1169 {TOK_WRITE, REG_OPERATION_MODE, 0x01}, 1170 {TOK_WRITE, REG_OPERATION_MODE, 0x00}, 1171 {TOK_TERM, 0, 0}, 1172 }; 1173 1174 /* TVP5147 Init/Power on Sequence */ 1175 static const struct tvp514x_reg tvp5147_init_reg_seq[] = { 1176 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x02}, 1177 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00}, 1178 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0x80}, 1179 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01}, 1180 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60}, 1181 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00}, 1182 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0}, 1183 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01}, 1184 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x16}, 1185 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00}, 1186 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xA0}, 1187 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x16}, 1188 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60}, 1189 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00}, 1190 {TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0}, 1191 {TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x00}, 1192 {TOK_WRITE, REG_OPERATION_MODE, 0x01}, 1193 {TOK_WRITE, REG_OPERATION_MODE, 0x00}, 1194 {TOK_TERM, 0, 0}, 1195 }; 1196 1197 /* TVP5146M2/TVP5147M1 Init/Power on Sequence */ 1198 static const struct tvp514x_reg tvp514xm_init_reg_seq[] = { 1199 {TOK_WRITE, REG_OPERATION_MODE, 0x01}, 1200 {TOK_WRITE, REG_OPERATION_MODE, 0x00}, 1201 {TOK_TERM, 0, 0}, 1202 }; 1203 1204 /** 1205 * I2C Device Table - 1206 * 1207 * name - Name of the actual device/chip. 1208 * driver_data - Driver data 1209 */ 1210 static const struct i2c_device_id tvp514x_id[] = { 1211 {"tvp5146", (unsigned long)tvp5146_init_reg_seq}, 1212 {"tvp5146m2", (unsigned long)tvp514xm_init_reg_seq}, 1213 {"tvp5147", (unsigned long)tvp5147_init_reg_seq}, 1214 {"tvp5147m1", (unsigned long)tvp514xm_init_reg_seq}, 1215 {}, 1216 }; 1217 1218 MODULE_DEVICE_TABLE(i2c, tvp514x_id); 1219 1220 #if IS_ENABLED(CONFIG_OF) 1221 static const struct of_device_id tvp514x_of_match[] = { 1222 { .compatible = "ti,tvp5146", }, 1223 { .compatible = "ti,tvp5146m2", }, 1224 { .compatible = "ti,tvp5147", }, 1225 { .compatible = "ti,tvp5147m1", }, 1226 { /* sentinel */ }, 1227 }; 1228 MODULE_DEVICE_TABLE(of, tvp514x_of_match); 1229 #endif 1230 1231 static struct i2c_driver tvp514x_driver = { 1232 .driver = { 1233 .of_match_table = of_match_ptr(tvp514x_of_match), 1234 .owner = THIS_MODULE, 1235 .name = TVP514X_MODULE_NAME, 1236 }, 1237 .probe = tvp514x_probe, 1238 .remove = tvp514x_remove, 1239 .id_table = tvp514x_id, 1240 }; 1241 1242 module_i2c_driver(tvp514x_driver); 1243