mirror of
https://github.com/torvalds/linux.git
synced 2024-11-25 05:32:00 +00:00
8774bed9ce
The g_std and s_std operations are video-related, move them to the video ops where they belong. Signed-off-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Acked-by: Hans Verkuil <hans.verkuil@cisco.com> Acked-by: Lad, Prabhakar <prabhakar.csengg@gmail.com> Acked-by: Sakari Ailus <sakari.ailus@linux.intel.com> Signed-off-by: Hans Verkuil <hans.verkuil@cisco.com> Signed-off-by: Mauro Carvalho Chehab <m.chehab@samsung.com>
1304 lines
35 KiB
C
1304 lines
35 KiB
C
/*
|
|
* drivers/media/i2c/tvp514x.c
|
|
*
|
|
* TI TVP5146/47 decoder driver
|
|
*
|
|
* Copyright (C) 2008 Texas Instruments Inc
|
|
* Author: Vaibhav Hiremath <hvaibhav@ti.com>
|
|
*
|
|
* Contributors:
|
|
* Sivaraj R <sivaraj@ti.com>
|
|
* Brijesh R Jadav <brijesh.j@ti.com>
|
|
* Hardik Shah <hardik.shah@ti.com>
|
|
* Manjunath Hadli <mrh@ti.com>
|
|
* Karicheri Muralidharan <m-karicheri2@ti.com>
|
|
* Prabhakar Lad <prabhakar.lad@ti.com>
|
|
*
|
|
* This package is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*
|
|
*/
|
|
|
|
#include <linux/i2c.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/videodev2.h>
|
|
#include <linux/module.h>
|
|
#include <linux/v4l2-mediabus.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_graph.h>
|
|
|
|
#include <media/v4l2-async.h>
|
|
#include <media/v4l2-device.h>
|
|
#include <media/v4l2-common.h>
|
|
#include <media/v4l2-mediabus.h>
|
|
#include <media/v4l2-of.h>
|
|
#include <media/v4l2-ctrls.h>
|
|
#include <media/tvp514x.h>
|
|
#include <media/media-entity.h>
|
|
|
|
#include "tvp514x_regs.h"
|
|
|
|
/* Private macros for TVP */
|
|
#define I2C_RETRY_COUNT (5)
|
|
#define LOCK_RETRY_COUNT (5)
|
|
#define LOCK_RETRY_DELAY (200)
|
|
|
|
/* Debug functions */
|
|
static bool debug;
|
|
module_param(debug, bool, 0644);
|
|
MODULE_PARM_DESC(debug, "Debug level (0-1)");
|
|
|
|
MODULE_AUTHOR("Texas Instruments");
|
|
MODULE_DESCRIPTION("TVP514X linux decoder driver");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
/* enum tvp514x_std - enum for supported standards */
|
|
enum tvp514x_std {
|
|
STD_NTSC_MJ = 0,
|
|
STD_PAL_BDGHIN,
|
|
STD_INVALID
|
|
};
|
|
|
|
/**
|
|
* struct tvp514x_std_info - Structure to store standard informations
|
|
* @width: Line width in pixels
|
|
* @height:Number of active lines
|
|
* @video_std: Value to write in REG_VIDEO_STD register
|
|
* @standard: v4l2 standard structure information
|
|
*/
|
|
struct tvp514x_std_info {
|
|
unsigned long width;
|
|
unsigned long height;
|
|
u8 video_std;
|
|
struct v4l2_standard standard;
|
|
};
|
|
|
|
static struct tvp514x_reg tvp514x_reg_list_default[0x40];
|
|
|
|
static int tvp514x_s_stream(struct v4l2_subdev *sd, int enable);
|
|
/**
|
|
* struct tvp514x_decoder - TVP5146/47 decoder object
|
|
* @sd: Subdevice Slave handle
|
|
* @tvp514x_regs: copy of hw's regs with preset values.
|
|
* @pdata: Board specific
|
|
* @ver: Chip version
|
|
* @streaming: TVP5146/47 decoder streaming - enabled or disabled.
|
|
* @pix: Current pixel format
|
|
* @num_fmts: Number of formats
|
|
* @fmt_list: Format list
|
|
* @current_std: Current standard
|
|
* @num_stds: Number of standards
|
|
* @std_list: Standards list
|
|
* @input: Input routing at chip level
|
|
* @output: Output routing at chip level
|
|
*/
|
|
struct tvp514x_decoder {
|
|
struct v4l2_subdev sd;
|
|
struct v4l2_ctrl_handler hdl;
|
|
struct tvp514x_reg tvp514x_regs[ARRAY_SIZE(tvp514x_reg_list_default)];
|
|
const struct tvp514x_platform_data *pdata;
|
|
|
|
int ver;
|
|
int streaming;
|
|
|
|
struct v4l2_pix_format pix;
|
|
int num_fmts;
|
|
const struct v4l2_fmtdesc *fmt_list;
|
|
|
|
enum tvp514x_std current_std;
|
|
int num_stds;
|
|
const struct tvp514x_std_info *std_list;
|
|
/* Input and Output Routing parameters */
|
|
u32 input;
|
|
u32 output;
|
|
|
|
/* mc related members */
|
|
struct media_pad pad;
|
|
struct v4l2_mbus_framefmt format;
|
|
|
|
struct tvp514x_reg *int_seq;
|
|
};
|
|
|
|
/* TVP514x default register values */
|
|
static struct tvp514x_reg tvp514x_reg_list_default[] = {
|
|
/* Composite selected */
|
|
{TOK_WRITE, REG_INPUT_SEL, 0x05},
|
|
{TOK_WRITE, REG_AFE_GAIN_CTRL, 0x0F},
|
|
/* Auto mode */
|
|
{TOK_WRITE, REG_VIDEO_STD, 0x00},
|
|
{TOK_WRITE, REG_OPERATION_MODE, 0x00},
|
|
{TOK_SKIP, REG_AUTOSWITCH_MASK, 0x3F},
|
|
{TOK_WRITE, REG_COLOR_KILLER, 0x10},
|
|
{TOK_WRITE, REG_LUMA_CONTROL1, 0x00},
|
|
{TOK_WRITE, REG_LUMA_CONTROL2, 0x00},
|
|
{TOK_WRITE, REG_LUMA_CONTROL3, 0x02},
|
|
{TOK_WRITE, REG_BRIGHTNESS, 0x80},
|
|
{TOK_WRITE, REG_CONTRAST, 0x80},
|
|
{TOK_WRITE, REG_SATURATION, 0x80},
|
|
{TOK_WRITE, REG_HUE, 0x00},
|
|
{TOK_WRITE, REG_CHROMA_CONTROL1, 0x00},
|
|
{TOK_WRITE, REG_CHROMA_CONTROL2, 0x0E},
|
|
/* Reserved */
|
|
{TOK_SKIP, 0x0F, 0x00},
|
|
{TOK_WRITE, REG_COMP_PR_SATURATION, 0x80},
|
|
{TOK_WRITE, REG_COMP_Y_CONTRAST, 0x80},
|
|
{TOK_WRITE, REG_COMP_PB_SATURATION, 0x80},
|
|
/* Reserved */
|
|
{TOK_SKIP, 0x13, 0x00},
|
|
{TOK_WRITE, REG_COMP_Y_BRIGHTNESS, 0x80},
|
|
/* Reserved */
|
|
{TOK_SKIP, 0x15, 0x00},
|
|
/* NTSC timing */
|
|
{TOK_SKIP, REG_AVID_START_PIXEL_LSB, 0x55},
|
|
{TOK_SKIP, REG_AVID_START_PIXEL_MSB, 0x00},
|
|
{TOK_SKIP, REG_AVID_STOP_PIXEL_LSB, 0x25},
|
|
{TOK_SKIP, REG_AVID_STOP_PIXEL_MSB, 0x03},
|
|
/* NTSC timing */
|
|
{TOK_SKIP, REG_HSYNC_START_PIXEL_LSB, 0x00},
|
|
{TOK_SKIP, REG_HSYNC_START_PIXEL_MSB, 0x00},
|
|
{TOK_SKIP, REG_HSYNC_STOP_PIXEL_LSB, 0x40},
|
|
{TOK_SKIP, REG_HSYNC_STOP_PIXEL_MSB, 0x00},
|
|
/* NTSC timing */
|
|
{TOK_SKIP, REG_VSYNC_START_LINE_LSB, 0x04},
|
|
{TOK_SKIP, REG_VSYNC_START_LINE_MSB, 0x00},
|
|
{TOK_SKIP, REG_VSYNC_STOP_LINE_LSB, 0x07},
|
|
{TOK_SKIP, REG_VSYNC_STOP_LINE_MSB, 0x00},
|
|
/* NTSC timing */
|
|
{TOK_SKIP, REG_VBLK_START_LINE_LSB, 0x01},
|
|
{TOK_SKIP, REG_VBLK_START_LINE_MSB, 0x00},
|
|
{TOK_SKIP, REG_VBLK_STOP_LINE_LSB, 0x15},
|
|
{TOK_SKIP, REG_VBLK_STOP_LINE_MSB, 0x00},
|
|
/* Reserved */
|
|
{TOK_SKIP, 0x26, 0x00},
|
|
/* Reserved */
|
|
{TOK_SKIP, 0x27, 0x00},
|
|
{TOK_SKIP, REG_FAST_SWTICH_CONTROL, 0xCC},
|
|
/* Reserved */
|
|
{TOK_SKIP, 0x29, 0x00},
|
|
{TOK_SKIP, REG_FAST_SWTICH_SCART_DELAY, 0x00},
|
|
/* Reserved */
|
|
{TOK_SKIP, 0x2B, 0x00},
|
|
{TOK_SKIP, REG_SCART_DELAY, 0x00},
|
|
{TOK_SKIP, REG_CTI_DELAY, 0x00},
|
|
{TOK_SKIP, REG_CTI_CONTROL, 0x00},
|
|
/* Reserved */
|
|
{TOK_SKIP, 0x2F, 0x00},
|
|
/* Reserved */
|
|
{TOK_SKIP, 0x30, 0x00},
|
|
/* Reserved */
|
|
{TOK_SKIP, 0x31, 0x00},
|
|
/* HS, VS active high */
|
|
{TOK_WRITE, REG_SYNC_CONTROL, 0x00},
|
|
/* 10-bit BT.656 */
|
|
{TOK_WRITE, REG_OUTPUT_FORMATTER1, 0x00},
|
|
/* Enable clk & data */
|
|
{TOK_WRITE, REG_OUTPUT_FORMATTER2, 0x11},
|
|
/* Enable AVID & FLD */
|
|
{TOK_WRITE, REG_OUTPUT_FORMATTER3, 0xEE},
|
|
/* Enable VS & HS */
|
|
{TOK_WRITE, REG_OUTPUT_FORMATTER4, 0xAF},
|
|
{TOK_WRITE, REG_OUTPUT_FORMATTER5, 0xFF},
|
|
{TOK_WRITE, REG_OUTPUT_FORMATTER6, 0xFF},
|
|
/* Clear status */
|
|
{TOK_WRITE, REG_CLEAR_LOST_LOCK, 0x01},
|
|
{TOK_TERM, 0, 0},
|
|
};
|
|
|
|
/**
|
|
* List of image formats supported by TVP5146/47 decoder
|
|
* Currently we are using 8 bit mode only, but can be
|
|
* extended to 10/20 bit mode.
|
|
*/
|
|
static const struct v4l2_fmtdesc tvp514x_fmt_list[] = {
|
|
{
|
|
.index = 0,
|
|
.type = V4L2_BUF_TYPE_VIDEO_CAPTURE,
|
|
.flags = 0,
|
|
.description = "8-bit UYVY 4:2:2 Format",
|
|
.pixelformat = V4L2_PIX_FMT_UYVY,
|
|
},
|
|
};
|
|
|
|
/**
|
|
* Supported standards -
|
|
*
|
|
* Currently supports two standards only, need to add support for rest of the
|
|
* modes, like SECAM, etc...
|
|
*/
|
|
static const struct tvp514x_std_info tvp514x_std_list[] = {
|
|
/* Standard: STD_NTSC_MJ */
|
|
[STD_NTSC_MJ] = {
|
|
.width = NTSC_NUM_ACTIVE_PIXELS,
|
|
.height = NTSC_NUM_ACTIVE_LINES,
|
|
.video_std = VIDEO_STD_NTSC_MJ_BIT,
|
|
.standard = {
|
|
.index = 0,
|
|
.id = V4L2_STD_NTSC,
|
|
.name = "NTSC",
|
|
.frameperiod = {1001, 30000},
|
|
.framelines = 525
|
|
},
|
|
/* Standard: STD_PAL_BDGHIN */
|
|
},
|
|
[STD_PAL_BDGHIN] = {
|
|
.width = PAL_NUM_ACTIVE_PIXELS,
|
|
.height = PAL_NUM_ACTIVE_LINES,
|
|
.video_std = VIDEO_STD_PAL_BDGHIN_BIT,
|
|
.standard = {
|
|
.index = 1,
|
|
.id = V4L2_STD_PAL,
|
|
.name = "PAL",
|
|
.frameperiod = {1, 25},
|
|
.framelines = 625
|
|
},
|
|
},
|
|
/* Standard: need to add for additional standard */
|
|
};
|
|
|
|
|
|
static inline struct tvp514x_decoder *to_decoder(struct v4l2_subdev *sd)
|
|
{
|
|
return container_of(sd, struct tvp514x_decoder, sd);
|
|
}
|
|
|
|
static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl)
|
|
{
|
|
return &container_of(ctrl->handler, struct tvp514x_decoder, hdl)->sd;
|
|
}
|
|
|
|
|
|
/**
|
|
* tvp514x_read_reg() - Read a value from a register in an TVP5146/47.
|
|
* @sd: ptr to v4l2_subdev struct
|
|
* @reg: TVP5146/47 register address
|
|
*
|
|
* Returns value read if successful, or non-zero (-1) otherwise.
|
|
*/
|
|
static int tvp514x_read_reg(struct v4l2_subdev *sd, u8 reg)
|
|
{
|
|
int err, retry = 0;
|
|
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
|
|
|
read_again:
|
|
|
|
err = i2c_smbus_read_byte_data(client, reg);
|
|
if (err < 0) {
|
|
if (retry <= I2C_RETRY_COUNT) {
|
|
v4l2_warn(sd, "Read: retry ... %d\n", retry);
|
|
retry++;
|
|
msleep_interruptible(10);
|
|
goto read_again;
|
|
}
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
/**
|
|
* dump_reg() - dump the register content of TVP5146/47.
|
|
* @sd: ptr to v4l2_subdev struct
|
|
* @reg: TVP5146/47 register address
|
|
*/
|
|
static void dump_reg(struct v4l2_subdev *sd, u8 reg)
|
|
{
|
|
u32 val;
|
|
|
|
val = tvp514x_read_reg(sd, reg);
|
|
v4l2_info(sd, "Reg(0x%.2X): 0x%.2X\n", reg, val);
|
|
}
|
|
|
|
/**
|
|
* tvp514x_write_reg() - Write a value to a register in TVP5146/47
|
|
* @sd: ptr to v4l2_subdev struct
|
|
* @reg: TVP5146/47 register address
|
|
* @val: value to be written to the register
|
|
*
|
|
* Write a value to a register in an TVP5146/47 decoder device.
|
|
* Returns zero if successful, or non-zero otherwise.
|
|
*/
|
|
static int tvp514x_write_reg(struct v4l2_subdev *sd, u8 reg, u8 val)
|
|
{
|
|
int err, retry = 0;
|
|
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
|
|
|
write_again:
|
|
|
|
err = i2c_smbus_write_byte_data(client, reg, val);
|
|
if (err) {
|
|
if (retry <= I2C_RETRY_COUNT) {
|
|
v4l2_warn(sd, "Write: retry ... %d\n", retry);
|
|
retry++;
|
|
msleep_interruptible(10);
|
|
goto write_again;
|
|
}
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_write_regs() : Initializes a list of TVP5146/47 registers
|
|
* @sd: ptr to v4l2_subdev struct
|
|
* @reglist: list of TVP5146/47 registers and values
|
|
*
|
|
* Initializes a list of TVP5146/47 registers:-
|
|
* if token is TOK_TERM, then entire write operation terminates
|
|
* if token is TOK_DELAY, then a delay of 'val' msec is introduced
|
|
* if token is TOK_SKIP, then the register write is skipped
|
|
* if token is TOK_WRITE, then the register write is performed
|
|
* Returns zero if successful, or non-zero otherwise.
|
|
*/
|
|
static int tvp514x_write_regs(struct v4l2_subdev *sd,
|
|
const struct tvp514x_reg reglist[])
|
|
{
|
|
int err;
|
|
const struct tvp514x_reg *next = reglist;
|
|
|
|
for (; next->token != TOK_TERM; next++) {
|
|
if (next->token == TOK_DELAY) {
|
|
msleep(next->val);
|
|
continue;
|
|
}
|
|
|
|
if (next->token == TOK_SKIP)
|
|
continue;
|
|
|
|
err = tvp514x_write_reg(sd, next->reg, (u8) next->val);
|
|
if (err) {
|
|
v4l2_err(sd, "Write failed. Err[%d]\n", err);
|
|
return err;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_query_current_std() : Query the current standard detected by TVP5146/47
|
|
* @sd: ptr to v4l2_subdev struct
|
|
*
|
|
* Returns the current standard detected by TVP5146/47, STD_INVALID if there is no
|
|
* standard detected.
|
|
*/
|
|
static enum tvp514x_std tvp514x_query_current_std(struct v4l2_subdev *sd)
|
|
{
|
|
u8 std, std_status;
|
|
|
|
std = tvp514x_read_reg(sd, REG_VIDEO_STD);
|
|
if ((std & VIDEO_STD_MASK) == VIDEO_STD_AUTO_SWITCH_BIT)
|
|
/* use the standard status register */
|
|
std_status = tvp514x_read_reg(sd, REG_VIDEO_STD_STATUS);
|
|
else
|
|
/* use the standard register itself */
|
|
std_status = std;
|
|
|
|
switch (std_status & VIDEO_STD_MASK) {
|
|
case VIDEO_STD_NTSC_MJ_BIT:
|
|
return STD_NTSC_MJ;
|
|
|
|
case VIDEO_STD_PAL_BDGHIN_BIT:
|
|
return STD_PAL_BDGHIN;
|
|
|
|
default:
|
|
return STD_INVALID;
|
|
}
|
|
|
|
return STD_INVALID;
|
|
}
|
|
|
|
/* TVP5146/47 register dump function */
|
|
static void tvp514x_reg_dump(struct v4l2_subdev *sd)
|
|
{
|
|
dump_reg(sd, REG_INPUT_SEL);
|
|
dump_reg(sd, REG_AFE_GAIN_CTRL);
|
|
dump_reg(sd, REG_VIDEO_STD);
|
|
dump_reg(sd, REG_OPERATION_MODE);
|
|
dump_reg(sd, REG_COLOR_KILLER);
|
|
dump_reg(sd, REG_LUMA_CONTROL1);
|
|
dump_reg(sd, REG_LUMA_CONTROL2);
|
|
dump_reg(sd, REG_LUMA_CONTROL3);
|
|
dump_reg(sd, REG_BRIGHTNESS);
|
|
dump_reg(sd, REG_CONTRAST);
|
|
dump_reg(sd, REG_SATURATION);
|
|
dump_reg(sd, REG_HUE);
|
|
dump_reg(sd, REG_CHROMA_CONTROL1);
|
|
dump_reg(sd, REG_CHROMA_CONTROL2);
|
|
dump_reg(sd, REG_COMP_PR_SATURATION);
|
|
dump_reg(sd, REG_COMP_Y_CONTRAST);
|
|
dump_reg(sd, REG_COMP_PB_SATURATION);
|
|
dump_reg(sd, REG_COMP_Y_BRIGHTNESS);
|
|
dump_reg(sd, REG_AVID_START_PIXEL_LSB);
|
|
dump_reg(sd, REG_AVID_START_PIXEL_MSB);
|
|
dump_reg(sd, REG_AVID_STOP_PIXEL_LSB);
|
|
dump_reg(sd, REG_AVID_STOP_PIXEL_MSB);
|
|
dump_reg(sd, REG_HSYNC_START_PIXEL_LSB);
|
|
dump_reg(sd, REG_HSYNC_START_PIXEL_MSB);
|
|
dump_reg(sd, REG_HSYNC_STOP_PIXEL_LSB);
|
|
dump_reg(sd, REG_HSYNC_STOP_PIXEL_MSB);
|
|
dump_reg(sd, REG_VSYNC_START_LINE_LSB);
|
|
dump_reg(sd, REG_VSYNC_START_LINE_MSB);
|
|
dump_reg(sd, REG_VSYNC_STOP_LINE_LSB);
|
|
dump_reg(sd, REG_VSYNC_STOP_LINE_MSB);
|
|
dump_reg(sd, REG_VBLK_START_LINE_LSB);
|
|
dump_reg(sd, REG_VBLK_START_LINE_MSB);
|
|
dump_reg(sd, REG_VBLK_STOP_LINE_LSB);
|
|
dump_reg(sd, REG_VBLK_STOP_LINE_MSB);
|
|
dump_reg(sd, REG_SYNC_CONTROL);
|
|
dump_reg(sd, REG_OUTPUT_FORMATTER1);
|
|
dump_reg(sd, REG_OUTPUT_FORMATTER2);
|
|
dump_reg(sd, REG_OUTPUT_FORMATTER3);
|
|
dump_reg(sd, REG_OUTPUT_FORMATTER4);
|
|
dump_reg(sd, REG_OUTPUT_FORMATTER5);
|
|
dump_reg(sd, REG_OUTPUT_FORMATTER6);
|
|
dump_reg(sd, REG_CLEAR_LOST_LOCK);
|
|
}
|
|
|
|
/**
|
|
* tvp514x_configure() - Configure the TVP5146/47 registers
|
|
* @sd: ptr to v4l2_subdev struct
|
|
* @decoder: ptr to tvp514x_decoder structure
|
|
*
|
|
* Returns zero if successful, or non-zero otherwise.
|
|
*/
|
|
static int tvp514x_configure(struct v4l2_subdev *sd,
|
|
struct tvp514x_decoder *decoder)
|
|
{
|
|
int err;
|
|
|
|
/* common register initialization */
|
|
err =
|
|
tvp514x_write_regs(sd, decoder->tvp514x_regs);
|
|
if (err)
|
|
return err;
|
|
|
|
if (debug)
|
|
tvp514x_reg_dump(sd);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_detect() - Detect if an tvp514x is present, and if so which revision.
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @decoder: pointer to tvp514x_decoder structure
|
|
*
|
|
* A device is considered to be detected if the chip ID (LSB and MSB)
|
|
* registers match the expected values.
|
|
* Any value of the rom version register is accepted.
|
|
* Returns ENODEV error number if no device is detected, or zero
|
|
* if a device is detected.
|
|
*/
|
|
static int tvp514x_detect(struct v4l2_subdev *sd,
|
|
struct tvp514x_decoder *decoder)
|
|
{
|
|
u8 chip_id_msb, chip_id_lsb, rom_ver;
|
|
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
|
|
|
chip_id_msb = tvp514x_read_reg(sd, REG_CHIP_ID_MSB);
|
|
chip_id_lsb = tvp514x_read_reg(sd, REG_CHIP_ID_LSB);
|
|
rom_ver = tvp514x_read_reg(sd, REG_ROM_VERSION);
|
|
|
|
v4l2_dbg(1, debug, sd,
|
|
"chip id detected msb:0x%x lsb:0x%x rom version:0x%x\n",
|
|
chip_id_msb, chip_id_lsb, rom_ver);
|
|
if ((chip_id_msb != TVP514X_CHIP_ID_MSB)
|
|
|| ((chip_id_lsb != TVP5146_CHIP_ID_LSB)
|
|
&& (chip_id_lsb != TVP5147_CHIP_ID_LSB))) {
|
|
/* We didn't read the values we expected, so this must not be
|
|
* an TVP5146/47.
|
|
*/
|
|
v4l2_err(sd, "chip id mismatch msb:0x%x lsb:0x%x\n",
|
|
chip_id_msb, chip_id_lsb);
|
|
return -ENODEV;
|
|
}
|
|
|
|
decoder->ver = rom_ver;
|
|
|
|
v4l2_info(sd, "%s (Version - 0x%.2x) found at 0x%x (%s)\n",
|
|
client->name, decoder->ver,
|
|
client->addr << 1, client->adapter->name);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_querystd() - V4L2 decoder interface handler for querystd
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @std_id: standard V4L2 std_id ioctl enum
|
|
*
|
|
* Returns the current standard detected by TVP5146/47. If no active input is
|
|
* detected then *std_id is set to 0 and the function returns 0.
|
|
*/
|
|
static int tvp514x_querystd(struct v4l2_subdev *sd, v4l2_std_id *std_id)
|
|
{
|
|
struct tvp514x_decoder *decoder = to_decoder(sd);
|
|
enum tvp514x_std current_std;
|
|
enum tvp514x_input input_sel;
|
|
u8 sync_lock_status, lock_mask;
|
|
|
|
if (std_id == NULL)
|
|
return -EINVAL;
|
|
|
|
/* To query the standard the TVP514x must power on the ADCs. */
|
|
if (!decoder->streaming) {
|
|
tvp514x_s_stream(sd, 1);
|
|
msleep(LOCK_RETRY_DELAY);
|
|
}
|
|
|
|
/* query the current standard */
|
|
current_std = tvp514x_query_current_std(sd);
|
|
if (current_std == STD_INVALID) {
|
|
*std_id = V4L2_STD_UNKNOWN;
|
|
return 0;
|
|
}
|
|
|
|
input_sel = decoder->input;
|
|
|
|
switch (input_sel) {
|
|
case INPUT_CVBS_VI1A:
|
|
case INPUT_CVBS_VI1B:
|
|
case INPUT_CVBS_VI1C:
|
|
case INPUT_CVBS_VI2A:
|
|
case INPUT_CVBS_VI2B:
|
|
case INPUT_CVBS_VI2C:
|
|
case INPUT_CVBS_VI3A:
|
|
case INPUT_CVBS_VI3B:
|
|
case INPUT_CVBS_VI3C:
|
|
case INPUT_CVBS_VI4A:
|
|
lock_mask = STATUS_CLR_SUBCAR_LOCK_BIT |
|
|
STATUS_HORZ_SYNC_LOCK_BIT |
|
|
STATUS_VIRT_SYNC_LOCK_BIT;
|
|
break;
|
|
|
|
case INPUT_SVIDEO_VI2A_VI1A:
|
|
case INPUT_SVIDEO_VI2B_VI1B:
|
|
case INPUT_SVIDEO_VI2C_VI1C:
|
|
case INPUT_SVIDEO_VI2A_VI3A:
|
|
case INPUT_SVIDEO_VI2B_VI3B:
|
|
case INPUT_SVIDEO_VI2C_VI3C:
|
|
case INPUT_SVIDEO_VI4A_VI1A:
|
|
case INPUT_SVIDEO_VI4A_VI1B:
|
|
case INPUT_SVIDEO_VI4A_VI1C:
|
|
case INPUT_SVIDEO_VI4A_VI3A:
|
|
case INPUT_SVIDEO_VI4A_VI3B:
|
|
case INPUT_SVIDEO_VI4A_VI3C:
|
|
lock_mask = STATUS_HORZ_SYNC_LOCK_BIT |
|
|
STATUS_VIRT_SYNC_LOCK_BIT;
|
|
break;
|
|
/*Need to add other interfaces*/
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
/* check whether signal is locked */
|
|
sync_lock_status = tvp514x_read_reg(sd, REG_STATUS1);
|
|
if (lock_mask != (sync_lock_status & lock_mask)) {
|
|
*std_id = V4L2_STD_UNKNOWN;
|
|
return 0; /* No input detected */
|
|
}
|
|
|
|
*std_id &= decoder->std_list[current_std].standard.id;
|
|
|
|
v4l2_dbg(1, debug, sd, "Current STD: %s\n",
|
|
decoder->std_list[current_std].standard.name);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_s_std() - V4L2 decoder interface handler for s_std
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @std_id: standard V4L2 v4l2_std_id ioctl enum
|
|
*
|
|
* If std_id is supported, sets the requested standard. Otherwise, returns
|
|
* -EINVAL
|
|
*/
|
|
static int tvp514x_s_std(struct v4l2_subdev *sd, v4l2_std_id std_id)
|
|
{
|
|
struct tvp514x_decoder *decoder = to_decoder(sd);
|
|
int err, i;
|
|
|
|
for (i = 0; i < decoder->num_stds; i++)
|
|
if (std_id & decoder->std_list[i].standard.id)
|
|
break;
|
|
|
|
if ((i == decoder->num_stds) || (i == STD_INVALID))
|
|
return -EINVAL;
|
|
|
|
err = tvp514x_write_reg(sd, REG_VIDEO_STD,
|
|
decoder->std_list[i].video_std);
|
|
if (err)
|
|
return err;
|
|
|
|
decoder->current_std = i;
|
|
decoder->tvp514x_regs[REG_VIDEO_STD].val =
|
|
decoder->std_list[i].video_std;
|
|
|
|
v4l2_dbg(1, debug, sd, "Standard set to: %s\n",
|
|
decoder->std_list[i].standard.name);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_s_routing() - V4L2 decoder interface handler for s_routing
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @input: input selector for routing the signal
|
|
* @output: output selector for routing the signal
|
|
* @config: config value. Not used
|
|
*
|
|
* If index is valid, selects the requested input. Otherwise, returns -EINVAL if
|
|
* the input is not supported or there is no active signal present in the
|
|
* selected input.
|
|
*/
|
|
static int tvp514x_s_routing(struct v4l2_subdev *sd,
|
|
u32 input, u32 output, u32 config)
|
|
{
|
|
struct tvp514x_decoder *decoder = to_decoder(sd);
|
|
int err;
|
|
enum tvp514x_input input_sel;
|
|
enum tvp514x_output output_sel;
|
|
|
|
if ((input >= INPUT_INVALID) ||
|
|
(output >= OUTPUT_INVALID))
|
|
/* Index out of bound */
|
|
return -EINVAL;
|
|
|
|
input_sel = input;
|
|
output_sel = output;
|
|
|
|
err = tvp514x_write_reg(sd, REG_INPUT_SEL, input_sel);
|
|
if (err)
|
|
return err;
|
|
|
|
output_sel |= tvp514x_read_reg(sd,
|
|
REG_OUTPUT_FORMATTER1) & 0x7;
|
|
err = tvp514x_write_reg(sd, REG_OUTPUT_FORMATTER1,
|
|
output_sel);
|
|
if (err)
|
|
return err;
|
|
|
|
decoder->tvp514x_regs[REG_INPUT_SEL].val = input_sel;
|
|
decoder->tvp514x_regs[REG_OUTPUT_FORMATTER1].val = output_sel;
|
|
decoder->input = input;
|
|
decoder->output = output;
|
|
|
|
v4l2_dbg(1, debug, sd, "Input set to: %d\n", input_sel);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_s_ctrl() - V4L2 decoder interface handler for s_ctrl
|
|
* @ctrl: pointer to v4l2_ctrl structure
|
|
*
|
|
* If the requested control is supported, sets the control's current
|
|
* value in HW. Otherwise, returns -EINVAL if the control is not supported.
|
|
*/
|
|
static int tvp514x_s_ctrl(struct v4l2_ctrl *ctrl)
|
|
{
|
|
struct v4l2_subdev *sd = to_sd(ctrl);
|
|
struct tvp514x_decoder *decoder = to_decoder(sd);
|
|
int err = -EINVAL, value;
|
|
|
|
value = ctrl->val;
|
|
|
|
switch (ctrl->id) {
|
|
case V4L2_CID_BRIGHTNESS:
|
|
err = tvp514x_write_reg(sd, REG_BRIGHTNESS, value);
|
|
if (!err)
|
|
decoder->tvp514x_regs[REG_BRIGHTNESS].val = value;
|
|
break;
|
|
case V4L2_CID_CONTRAST:
|
|
err = tvp514x_write_reg(sd, REG_CONTRAST, value);
|
|
if (!err)
|
|
decoder->tvp514x_regs[REG_CONTRAST].val = value;
|
|
break;
|
|
case V4L2_CID_SATURATION:
|
|
err = tvp514x_write_reg(sd, REG_SATURATION, value);
|
|
if (!err)
|
|
decoder->tvp514x_regs[REG_SATURATION].val = value;
|
|
break;
|
|
case V4L2_CID_HUE:
|
|
if (value == 180)
|
|
value = 0x7F;
|
|
else if (value == -180)
|
|
value = 0x80;
|
|
err = tvp514x_write_reg(sd, REG_HUE, value);
|
|
if (!err)
|
|
decoder->tvp514x_regs[REG_HUE].val = value;
|
|
break;
|
|
case V4L2_CID_AUTOGAIN:
|
|
err = tvp514x_write_reg(sd, REG_AFE_GAIN_CTRL, value ? 0x0f : 0x0c);
|
|
if (!err)
|
|
decoder->tvp514x_regs[REG_AFE_GAIN_CTRL].val = value;
|
|
break;
|
|
}
|
|
|
|
v4l2_dbg(1, debug, sd, "Set Control: ID - %d - %d\n",
|
|
ctrl->id, ctrl->val);
|
|
return err;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_enum_mbus_fmt() - V4L2 decoder interface handler for enum_mbus_fmt
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @index: index of pixelcode to retrieve
|
|
* @code: receives the pixelcode
|
|
*
|
|
* Enumerates supported mediabus formats
|
|
*/
|
|
static int
|
|
tvp514x_enum_mbus_fmt(struct v4l2_subdev *sd, unsigned index,
|
|
enum v4l2_mbus_pixelcode *code)
|
|
{
|
|
if (index)
|
|
return -EINVAL;
|
|
|
|
*code = V4L2_MBUS_FMT_YUYV10_2X10;
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_mbus_fmt() - V4L2 decoder interface handler for try/s/g_mbus_fmt
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @f: pointer to the mediabus format structure
|
|
*
|
|
* Negotiates the image capture size and mediabus format.
|
|
*/
|
|
static int
|
|
tvp514x_mbus_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *f)
|
|
{
|
|
struct tvp514x_decoder *decoder = to_decoder(sd);
|
|
enum tvp514x_std current_std;
|
|
|
|
if (f == NULL)
|
|
return -EINVAL;
|
|
|
|
/* Calculate height and width based on current standard */
|
|
current_std = decoder->current_std;
|
|
|
|
f->code = V4L2_MBUS_FMT_YUYV8_2X8;
|
|
f->width = decoder->std_list[current_std].width;
|
|
f->height = decoder->std_list[current_std].height;
|
|
f->field = V4L2_FIELD_INTERLACED;
|
|
f->colorspace = V4L2_COLORSPACE_SMPTE170M;
|
|
v4l2_dbg(1, debug, sd, "MBUS_FMT: Width - %d, Height - %d\n",
|
|
f->width, f->height);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_g_parm() - V4L2 decoder interface handler for g_parm
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @a: pointer to standard V4L2 VIDIOC_G_PARM ioctl structure
|
|
*
|
|
* Returns the decoder's video CAPTURE parameters.
|
|
*/
|
|
static int
|
|
tvp514x_g_parm(struct v4l2_subdev *sd, struct v4l2_streamparm *a)
|
|
{
|
|
struct tvp514x_decoder *decoder = to_decoder(sd);
|
|
struct v4l2_captureparm *cparm;
|
|
enum tvp514x_std current_std;
|
|
|
|
if (a == NULL)
|
|
return -EINVAL;
|
|
|
|
if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
|
|
/* only capture is supported */
|
|
return -EINVAL;
|
|
|
|
/* get the current standard */
|
|
current_std = decoder->current_std;
|
|
|
|
cparm = &a->parm.capture;
|
|
cparm->capability = V4L2_CAP_TIMEPERFRAME;
|
|
cparm->timeperframe =
|
|
decoder->std_list[current_std].standard.frameperiod;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_s_parm() - V4L2 decoder interface handler for s_parm
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @a: pointer to standard V4L2 VIDIOC_S_PARM ioctl structure
|
|
*
|
|
* Configures the decoder to use the input parameters, if possible. If
|
|
* not possible, returns the appropriate error code.
|
|
*/
|
|
static int
|
|
tvp514x_s_parm(struct v4l2_subdev *sd, struct v4l2_streamparm *a)
|
|
{
|
|
struct tvp514x_decoder *decoder = to_decoder(sd);
|
|
struct v4l2_fract *timeperframe;
|
|
enum tvp514x_std current_std;
|
|
|
|
if (a == NULL)
|
|
return -EINVAL;
|
|
|
|
if (a->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
|
|
/* only capture is supported */
|
|
return -EINVAL;
|
|
|
|
timeperframe = &a->parm.capture.timeperframe;
|
|
|
|
/* get the current standard */
|
|
current_std = decoder->current_std;
|
|
|
|
*timeperframe =
|
|
decoder->std_list[current_std].standard.frameperiod;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_s_stream() - V4L2 decoder i/f handler for s_stream
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @enable: streaming enable or disable
|
|
*
|
|
* Sets streaming to enable or disable, if possible.
|
|
*/
|
|
static int tvp514x_s_stream(struct v4l2_subdev *sd, int enable)
|
|
{
|
|
int err = 0;
|
|
struct tvp514x_decoder *decoder = to_decoder(sd);
|
|
|
|
if (decoder->streaming == enable)
|
|
return 0;
|
|
|
|
switch (enable) {
|
|
case 0:
|
|
{
|
|
/* Power Down Sequence */
|
|
err = tvp514x_write_reg(sd, REG_OPERATION_MODE, 0x01);
|
|
if (err) {
|
|
v4l2_err(sd, "Unable to turn off decoder\n");
|
|
return err;
|
|
}
|
|
decoder->streaming = enable;
|
|
break;
|
|
}
|
|
case 1:
|
|
{
|
|
/* Power Up Sequence */
|
|
err = tvp514x_write_regs(sd, decoder->int_seq);
|
|
if (err) {
|
|
v4l2_err(sd, "Unable to turn on decoder\n");
|
|
return err;
|
|
}
|
|
/* Detect if not already detected */
|
|
err = tvp514x_detect(sd, decoder);
|
|
if (err) {
|
|
v4l2_err(sd, "Unable to detect decoder\n");
|
|
return err;
|
|
}
|
|
err = tvp514x_configure(sd, decoder);
|
|
if (err) {
|
|
v4l2_err(sd, "Unable to configure decoder\n");
|
|
return err;
|
|
}
|
|
decoder->streaming = enable;
|
|
break;
|
|
}
|
|
default:
|
|
err = -ENODEV;
|
|
break;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
static const struct v4l2_ctrl_ops tvp514x_ctrl_ops = {
|
|
.s_ctrl = tvp514x_s_ctrl,
|
|
};
|
|
|
|
/**
|
|
* tvp514x_enum_mbus_code() - V4L2 decoder interface handler for enum_mbus_code
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @fh: file handle
|
|
* @code: pointer to v4l2_subdev_mbus_code_enum structure
|
|
*
|
|
* Enumertaes mbus codes supported
|
|
*/
|
|
static int tvp514x_enum_mbus_code(struct v4l2_subdev *sd,
|
|
struct v4l2_subdev_fh *fh,
|
|
struct v4l2_subdev_mbus_code_enum *code)
|
|
{
|
|
u32 pad = code->pad;
|
|
u32 index = code->index;
|
|
|
|
memset(code, 0, sizeof(*code));
|
|
code->index = index;
|
|
code->pad = pad;
|
|
|
|
if (index != 0)
|
|
return -EINVAL;
|
|
|
|
code->code = V4L2_MBUS_FMT_YUYV8_2X8;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_get_pad_format() - V4L2 decoder interface handler for get pad format
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @fh: file handle
|
|
* @format: pointer to v4l2_subdev_format structure
|
|
*
|
|
* Retrieves pad format which is active or tried based on requirement
|
|
*/
|
|
static int tvp514x_get_pad_format(struct v4l2_subdev *sd,
|
|
struct v4l2_subdev_fh *fh,
|
|
struct v4l2_subdev_format *format)
|
|
{
|
|
struct tvp514x_decoder *decoder = to_decoder(sd);
|
|
__u32 which = format->which;
|
|
|
|
if (which == V4L2_SUBDEV_FORMAT_ACTIVE) {
|
|
format->format = decoder->format;
|
|
return 0;
|
|
}
|
|
|
|
format->format.code = V4L2_MBUS_FMT_YUYV8_2X8;
|
|
format->format.width = tvp514x_std_list[decoder->current_std].width;
|
|
format->format.height = tvp514x_std_list[decoder->current_std].height;
|
|
format->format.colorspace = V4L2_COLORSPACE_SMPTE170M;
|
|
format->format.field = V4L2_FIELD_INTERLACED;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_set_pad_format() - V4L2 decoder interface handler for set pad format
|
|
* @sd: pointer to standard V4L2 sub-device structure
|
|
* @fh: file handle
|
|
* @format: pointer to v4l2_subdev_format structure
|
|
*
|
|
* Set pad format for the output pad
|
|
*/
|
|
static int tvp514x_set_pad_format(struct v4l2_subdev *sd,
|
|
struct v4l2_subdev_fh *fh,
|
|
struct v4l2_subdev_format *fmt)
|
|
{
|
|
struct tvp514x_decoder *decoder = to_decoder(sd);
|
|
|
|
if (fmt->format.field != V4L2_FIELD_INTERLACED ||
|
|
fmt->format.code != V4L2_MBUS_FMT_YUYV8_2X8 ||
|
|
fmt->format.colorspace != V4L2_COLORSPACE_SMPTE170M ||
|
|
fmt->format.width != tvp514x_std_list[decoder->current_std].width ||
|
|
fmt->format.height != tvp514x_std_list[decoder->current_std].height)
|
|
return -EINVAL;
|
|
|
|
decoder->format = fmt->format;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct v4l2_subdev_core_ops tvp514x_core_ops = {
|
|
.g_ext_ctrls = v4l2_subdev_g_ext_ctrls,
|
|
.try_ext_ctrls = v4l2_subdev_try_ext_ctrls,
|
|
.s_ext_ctrls = v4l2_subdev_s_ext_ctrls,
|
|
.g_ctrl = v4l2_subdev_g_ctrl,
|
|
.s_ctrl = v4l2_subdev_s_ctrl,
|
|
.queryctrl = v4l2_subdev_queryctrl,
|
|
.querymenu = v4l2_subdev_querymenu,
|
|
};
|
|
|
|
static const struct v4l2_subdev_video_ops tvp514x_video_ops = {
|
|
.s_std = tvp514x_s_std,
|
|
.s_routing = tvp514x_s_routing,
|
|
.querystd = tvp514x_querystd,
|
|
.enum_mbus_fmt = tvp514x_enum_mbus_fmt,
|
|
.g_mbus_fmt = tvp514x_mbus_fmt,
|
|
.try_mbus_fmt = tvp514x_mbus_fmt,
|
|
.s_mbus_fmt = tvp514x_mbus_fmt,
|
|
.g_parm = tvp514x_g_parm,
|
|
.s_parm = tvp514x_s_parm,
|
|
.s_stream = tvp514x_s_stream,
|
|
};
|
|
|
|
static const struct v4l2_subdev_pad_ops tvp514x_pad_ops = {
|
|
.enum_mbus_code = tvp514x_enum_mbus_code,
|
|
.get_fmt = tvp514x_get_pad_format,
|
|
.set_fmt = tvp514x_set_pad_format,
|
|
};
|
|
|
|
static const struct v4l2_subdev_ops tvp514x_ops = {
|
|
.core = &tvp514x_core_ops,
|
|
.video = &tvp514x_video_ops,
|
|
.pad = &tvp514x_pad_ops,
|
|
};
|
|
|
|
static struct tvp514x_decoder tvp514x_dev = {
|
|
.streaming = 0,
|
|
.fmt_list = tvp514x_fmt_list,
|
|
.num_fmts = ARRAY_SIZE(tvp514x_fmt_list),
|
|
.pix = {
|
|
/* Default to NTSC 8-bit YUV 422 */
|
|
.width = NTSC_NUM_ACTIVE_PIXELS,
|
|
.height = NTSC_NUM_ACTIVE_LINES,
|
|
.pixelformat = V4L2_PIX_FMT_UYVY,
|
|
.field = V4L2_FIELD_INTERLACED,
|
|
.bytesperline = NTSC_NUM_ACTIVE_PIXELS * 2,
|
|
.sizeimage = NTSC_NUM_ACTIVE_PIXELS * 2 *
|
|
NTSC_NUM_ACTIVE_LINES,
|
|
.colorspace = V4L2_COLORSPACE_SMPTE170M,
|
|
},
|
|
.current_std = STD_NTSC_MJ,
|
|
.std_list = tvp514x_std_list,
|
|
.num_stds = ARRAY_SIZE(tvp514x_std_list),
|
|
|
|
};
|
|
|
|
static struct tvp514x_platform_data *
|
|
tvp514x_get_pdata(struct i2c_client *client)
|
|
{
|
|
struct tvp514x_platform_data *pdata;
|
|
struct v4l2_of_endpoint bus_cfg;
|
|
struct device_node *endpoint;
|
|
unsigned int flags;
|
|
|
|
if (!IS_ENABLED(CONFIG_OF) || !client->dev.of_node)
|
|
return client->dev.platform_data;
|
|
|
|
endpoint = of_graph_get_next_endpoint(client->dev.of_node, NULL);
|
|
if (!endpoint)
|
|
return NULL;
|
|
|
|
pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);
|
|
if (!pdata)
|
|
goto done;
|
|
|
|
v4l2_of_parse_endpoint(endpoint, &bus_cfg);
|
|
flags = bus_cfg.bus.parallel.flags;
|
|
|
|
if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH)
|
|
pdata->hs_polarity = 1;
|
|
|
|
if (flags & V4L2_MBUS_VSYNC_ACTIVE_HIGH)
|
|
pdata->vs_polarity = 1;
|
|
|
|
if (flags & V4L2_MBUS_PCLK_SAMPLE_RISING)
|
|
pdata->clk_polarity = 1;
|
|
|
|
done:
|
|
of_node_put(endpoint);
|
|
return pdata;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_probe() - decoder driver i2c probe handler
|
|
* @client: i2c driver client device structure
|
|
* @id: i2c driver id table
|
|
*
|
|
* Register decoder as an i2c client device and V4L2
|
|
* device.
|
|
*/
|
|
static int
|
|
tvp514x_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
|
{
|
|
struct tvp514x_platform_data *pdata = tvp514x_get_pdata(client);
|
|
struct tvp514x_decoder *decoder;
|
|
struct v4l2_subdev *sd;
|
|
int ret;
|
|
|
|
if (pdata == NULL) {
|
|
dev_err(&client->dev, "No platform data\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Check if the adapter supports the needed features */
|
|
if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
|
|
return -EIO;
|
|
|
|
decoder = devm_kzalloc(&client->dev, sizeof(*decoder), GFP_KERNEL);
|
|
if (!decoder)
|
|
return -ENOMEM;
|
|
|
|
/* Initialize the tvp514x_decoder with default configuration */
|
|
*decoder = tvp514x_dev;
|
|
/* Copy default register configuration */
|
|
memcpy(decoder->tvp514x_regs, tvp514x_reg_list_default,
|
|
sizeof(tvp514x_reg_list_default));
|
|
|
|
decoder->int_seq = (struct tvp514x_reg *)id->driver_data;
|
|
|
|
/* Copy board specific information here */
|
|
decoder->pdata = pdata;
|
|
|
|
/**
|
|
* Fetch platform specific data, and configure the
|
|
* tvp514x_reg_list[] accordingly. Since this is one
|
|
* time configuration, no need to preserve.
|
|
*/
|
|
decoder->tvp514x_regs[REG_OUTPUT_FORMATTER2].val |=
|
|
(decoder->pdata->clk_polarity << 1);
|
|
decoder->tvp514x_regs[REG_SYNC_CONTROL].val |=
|
|
((decoder->pdata->hs_polarity << 2) |
|
|
(decoder->pdata->vs_polarity << 3));
|
|
/* Set default standard to auto */
|
|
decoder->tvp514x_regs[REG_VIDEO_STD].val =
|
|
VIDEO_STD_AUTO_SWITCH_BIT;
|
|
|
|
/* Register with V4L2 layer as slave device */
|
|
sd = &decoder->sd;
|
|
v4l2_i2c_subdev_init(sd, client, &tvp514x_ops);
|
|
|
|
#if defined(CONFIG_MEDIA_CONTROLLER)
|
|
decoder->pad.flags = MEDIA_PAD_FL_SOURCE;
|
|
decoder->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
|
|
decoder->sd.entity.flags |= MEDIA_ENT_T_V4L2_SUBDEV_DECODER;
|
|
|
|
ret = media_entity_init(&decoder->sd.entity, 1, &decoder->pad, 0);
|
|
if (ret < 0) {
|
|
v4l2_err(sd, "%s decoder driver failed to register !!\n",
|
|
sd->name);
|
|
return ret;
|
|
}
|
|
#endif
|
|
v4l2_ctrl_handler_init(&decoder->hdl, 5);
|
|
v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
|
|
V4L2_CID_BRIGHTNESS, 0, 255, 1, 128);
|
|
v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
|
|
V4L2_CID_CONTRAST, 0, 255, 1, 128);
|
|
v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
|
|
V4L2_CID_SATURATION, 0, 255, 1, 128);
|
|
v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
|
|
V4L2_CID_HUE, -180, 180, 180, 0);
|
|
v4l2_ctrl_new_std(&decoder->hdl, &tvp514x_ctrl_ops,
|
|
V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
|
|
sd->ctrl_handler = &decoder->hdl;
|
|
if (decoder->hdl.error) {
|
|
ret = decoder->hdl.error;
|
|
goto done;
|
|
}
|
|
v4l2_ctrl_handler_setup(&decoder->hdl);
|
|
|
|
ret = v4l2_async_register_subdev(&decoder->sd);
|
|
if (!ret)
|
|
v4l2_info(sd, "%s decoder driver registered !!\n", sd->name);
|
|
|
|
done:
|
|
if (ret < 0) {
|
|
v4l2_ctrl_handler_free(&decoder->hdl);
|
|
#if defined(CONFIG_MEDIA_CONTROLLER)
|
|
media_entity_cleanup(&decoder->sd.entity);
|
|
#endif
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* tvp514x_remove() - decoder driver i2c remove handler
|
|
* @client: i2c driver client device structure
|
|
*
|
|
* Unregister decoder as an i2c client device and V4L2
|
|
* device. Complement of tvp514x_probe().
|
|
*/
|
|
static int tvp514x_remove(struct i2c_client *client)
|
|
{
|
|
struct v4l2_subdev *sd = i2c_get_clientdata(client);
|
|
struct tvp514x_decoder *decoder = to_decoder(sd);
|
|
|
|
v4l2_async_unregister_subdev(&decoder->sd);
|
|
v4l2_device_unregister_subdev(sd);
|
|
#if defined(CONFIG_MEDIA_CONTROLLER)
|
|
media_entity_cleanup(&decoder->sd.entity);
|
|
#endif
|
|
v4l2_ctrl_handler_free(&decoder->hdl);
|
|
return 0;
|
|
}
|
|
/* TVP5146 Init/Power on Sequence */
|
|
static const struct tvp514x_reg tvp5146_init_reg_seq[] = {
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x02},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0x80},
|
|
{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0},
|
|
{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
|
|
{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x00},
|
|
{TOK_WRITE, REG_OPERATION_MODE, 0x01},
|
|
{TOK_WRITE, REG_OPERATION_MODE, 0x00},
|
|
{TOK_TERM, 0, 0},
|
|
};
|
|
|
|
/* TVP5147 Init/Power on Sequence */
|
|
static const struct tvp514x_reg tvp5147_init_reg_seq[] = {
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x02},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0x80},
|
|
{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0},
|
|
{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x01},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x16},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xA0},
|
|
{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x16},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS1, 0x60},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS2, 0x00},
|
|
{TOK_WRITE, REG_VBUS_ADDRESS_ACCESS3, 0xB0},
|
|
{TOK_WRITE, REG_VBUS_DATA_ACCESS_NO_VBUS_ADDR_INCR, 0x00},
|
|
{TOK_WRITE, REG_OPERATION_MODE, 0x01},
|
|
{TOK_WRITE, REG_OPERATION_MODE, 0x00},
|
|
{TOK_TERM, 0, 0},
|
|
};
|
|
|
|
/* TVP5146M2/TVP5147M1 Init/Power on Sequence */
|
|
static const struct tvp514x_reg tvp514xm_init_reg_seq[] = {
|
|
{TOK_WRITE, REG_OPERATION_MODE, 0x01},
|
|
{TOK_WRITE, REG_OPERATION_MODE, 0x00},
|
|
{TOK_TERM, 0, 0},
|
|
};
|
|
|
|
/**
|
|
* I2C Device Table -
|
|
*
|
|
* name - Name of the actual device/chip.
|
|
* driver_data - Driver data
|
|
*/
|
|
static const struct i2c_device_id tvp514x_id[] = {
|
|
{"tvp5146", (unsigned long)tvp5146_init_reg_seq},
|
|
{"tvp5146m2", (unsigned long)tvp514xm_init_reg_seq},
|
|
{"tvp5147", (unsigned long)tvp5147_init_reg_seq},
|
|
{"tvp5147m1", (unsigned long)tvp514xm_init_reg_seq},
|
|
{},
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(i2c, tvp514x_id);
|
|
|
|
#if IS_ENABLED(CONFIG_OF)
|
|
static const struct of_device_id tvp514x_of_match[] = {
|
|
{ .compatible = "ti,tvp5146", },
|
|
{ .compatible = "ti,tvp5146m2", },
|
|
{ .compatible = "ti,tvp5147", },
|
|
{ .compatible = "ti,tvp5147m1", },
|
|
{ /* sentinel */ },
|
|
};
|
|
MODULE_DEVICE_TABLE(of, tvp514x_of_match);
|
|
#endif
|
|
|
|
static struct i2c_driver tvp514x_driver = {
|
|
.driver = {
|
|
.of_match_table = of_match_ptr(tvp514x_of_match),
|
|
.owner = THIS_MODULE,
|
|
.name = TVP514X_MODULE_NAME,
|
|
},
|
|
.probe = tvp514x_probe,
|
|
.remove = tvp514x_remove,
|
|
.id_table = tvp514x_id,
|
|
};
|
|
|
|
module_i2c_driver(tvp514x_driver);
|