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