📄 tvp5150.c
字号:
/* * tvp5150 - Texas Instruments TVP5150A/AM1 video decoder driver * * Copyright (c) 2005,2006 Mauro Carvalho Chehab (mchehab@infradead.org) * This code is placed under the terms of the GNU General Public License v2 */#include <linux/i2c.h>#include <linux/videodev.h>#include <linux/delay.h>#include <linux/video_decoder.h>#include <media/v4l2-common.h>#include <media/tvp5150.h>#include "tvp5150_reg.h"MODULE_DESCRIPTION("Texas Instruments TVP5150A video decoder driver");MODULE_AUTHOR("Mauro Carvalho Chehab");MODULE_LICENSE("GPL");/* standard i2c insmod options */static unsigned short normal_i2c[] = { 0xb8 >> 1, 0xba >> 1, I2C_CLIENT_END};I2C_CLIENT_INSMOD;static int debug;module_param(debug, int, 0);MODULE_PARM_DESC(debug, "Debug level (0-1)");#define tvp5150_err(fmt, arg...) do { \ printk(KERN_ERR "%s %d-%04x: " fmt, c->driver->driver.name, \ i2c_adapter_id(c->adapter), c->addr , ## arg); } while (0)#define tvp5150_info(fmt, arg...) do { \ printk(KERN_INFO "%s %d-%04x: " fmt, c->driver->driver.name, \ i2c_adapter_id(c->adapter), c->addr , ## arg); } while (0)#define tvp5150_dbg(num, fmt, arg...) \ do { \ if (debug >= num) \ printk(KERN_DEBUG "%s debug %d-%04x: " fmt,\ c->driver->driver.name, \ i2c_adapter_id(c->adapter), \ c->addr , ## arg); } while (0)/* supported controls */static struct v4l2_queryctrl tvp5150_qctrl[] = { { .id = V4L2_CID_BRIGHTNESS, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Brightness", .minimum = 0, .maximum = 255, .step = 1, .default_value = 128, .flags = 0, }, { .id = V4L2_CID_CONTRAST, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Contrast", .minimum = 0, .maximum = 255, .step = 0x1, .default_value = 128, .flags = 0, }, { .id = V4L2_CID_SATURATION, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Saturation", .minimum = 0, .maximum = 255, .step = 0x1, .default_value = 128, .flags = 0, }, { .id = V4L2_CID_HUE, .type = V4L2_CTRL_TYPE_INTEGER, .name = "Hue", .minimum = -128, .maximum = 127, .step = 0x1, .default_value = 0, .flags = 0, }};struct tvp5150 { struct i2c_client *client; v4l2_std_id norm; /* Current set standard */ struct v4l2_routing route; int enable; int bright; int contrast; int hue; int sat;};static int tvp5150_read(struct i2c_client *c, unsigned char addr){ unsigned char buffer[1]; int rc; buffer[0] = addr; if (1 != (rc = i2c_master_send(c, buffer, 1))) tvp5150_dbg(0, "i2c i/o error: rc == %d (should be 1)\n", rc); msleep(10); if (1 != (rc = i2c_master_recv(c, buffer, 1))) tvp5150_dbg(0, "i2c i/o error: rc == %d (should be 1)\n", rc); tvp5150_dbg(2, "tvp5150: read 0x%02x = 0x%02x\n", addr, buffer[0]); return (buffer[0]);}static inline void tvp5150_write(struct i2c_client *c, unsigned char addr, unsigned char value){ unsigned char buffer[2]; int rc; buffer[0] = addr; buffer[1] = value; tvp5150_dbg(2, "tvp5150: writing 0x%02x 0x%02x\n", buffer[0], buffer[1]); if (2 != (rc = i2c_master_send(c, buffer, 2))) tvp5150_dbg(0, "i2c i/o error: rc == %d (should be 2)\n", rc);}static void dump_reg_range(struct i2c_client *c, char *s, u8 init, const u8 end,int max_line){ int i=0; while (init!=(u8)(end+1)) { if ((i%max_line) == 0) { if (i>0) printk("\n"); printk("tvp5150: %s reg 0x%02x = ",s,init); } printk("%02x ",tvp5150_read(c, init)); init++; i++; } printk("\n");}static void dump_reg(struct i2c_client *c){ printk("tvp5150: Video input source selection #1 = 0x%02x\n", tvp5150_read(c, TVP5150_VD_IN_SRC_SEL_1)); printk("tvp5150: Analog channel controls = 0x%02x\n", tvp5150_read(c, TVP5150_ANAL_CHL_CTL)); printk("tvp5150: Operation mode controls = 0x%02x\n", tvp5150_read(c, TVP5150_OP_MODE_CTL)); printk("tvp5150: Miscellaneous controls = 0x%02x\n", tvp5150_read(c, TVP5150_MISC_CTL)); printk("tvp5150: Autoswitch mask= 0x%02x\n", tvp5150_read(c, TVP5150_AUTOSW_MSK)); printk("tvp5150: Color killer threshold control = 0x%02x\n", tvp5150_read(c, TVP5150_COLOR_KIL_THSH_CTL)); printk("tvp5150: Luminance processing controls #1 #2 and #3 = %02x %02x %02x\n", tvp5150_read(c, TVP5150_LUMA_PROC_CTL_1), tvp5150_read(c, TVP5150_LUMA_PROC_CTL_2), tvp5150_read(c, TVP5150_LUMA_PROC_CTL_3)); printk("tvp5150: Brightness control = 0x%02x\n", tvp5150_read(c, TVP5150_BRIGHT_CTL)); printk("tvp5150: Color saturation control = 0x%02x\n", tvp5150_read(c, TVP5150_SATURATION_CTL)); printk("tvp5150: Hue control = 0x%02x\n", tvp5150_read(c, TVP5150_HUE_CTL)); printk("tvp5150: Contrast control = 0x%02x\n", tvp5150_read(c, TVP5150_CONTRAST_CTL)); printk("tvp5150: Outputs and data rates select = 0x%02x\n", tvp5150_read(c, TVP5150_DATA_RATE_SEL)); printk("tvp5150: Configuration shared pins = 0x%02x\n", tvp5150_read(c, TVP5150_CONF_SHARED_PIN)); printk("tvp5150: Active video cropping start = 0x%02x%02x\n", tvp5150_read(c, TVP5150_ACT_VD_CROP_ST_MSB), tvp5150_read(c, TVP5150_ACT_VD_CROP_ST_LSB)); printk("tvp5150: Active video cropping stop = 0x%02x%02x\n", tvp5150_read(c, TVP5150_ACT_VD_CROP_STP_MSB), tvp5150_read(c, TVP5150_ACT_VD_CROP_STP_LSB)); printk("tvp5150: Genlock/RTC = 0x%02x\n", tvp5150_read(c, TVP5150_GENLOCK)); printk("tvp5150: Horizontal sync start = 0x%02x\n", tvp5150_read(c, TVP5150_HORIZ_SYNC_START)); printk("tvp5150: Vertical blanking start = 0x%02x\n", tvp5150_read(c, TVP5150_VERT_BLANKING_START)); printk("tvp5150: Vertical blanking stop = 0x%02x\n", tvp5150_read(c, TVP5150_VERT_BLANKING_STOP)); printk("tvp5150: Chrominance processing control #1 and #2 = %02x %02x\n", tvp5150_read(c, TVP5150_CHROMA_PROC_CTL_1), tvp5150_read(c, TVP5150_CHROMA_PROC_CTL_2)); printk("tvp5150: Interrupt reset register B = 0x%02x\n", tvp5150_read(c, TVP5150_INT_RESET_REG_B)); printk("tvp5150: Interrupt enable register B = 0x%02x\n", tvp5150_read(c, TVP5150_INT_ENABLE_REG_B)); printk("tvp5150: Interrupt configuration register B = 0x%02x\n", tvp5150_read(c, TVP5150_INTT_CONFIG_REG_B)); printk("tvp5150: Video standard = 0x%02x\n", tvp5150_read(c, TVP5150_VIDEO_STD)); printk("tvp5150: Chroma gain factor: Cb=0x%02x Cr=0x%02x\n", tvp5150_read(c, TVP5150_CB_GAIN_FACT), tvp5150_read(c, TVP5150_CR_GAIN_FACTOR)); printk("tvp5150: Macrovision on counter = 0x%02x\n", tvp5150_read(c, TVP5150_MACROVISION_ON_CTR)); printk("tvp5150: Macrovision off counter = 0x%02x\n", tvp5150_read(c, TVP5150_MACROVISION_OFF_CTR)); printk("tvp5150: ITU-R BT.656.%d timing(TVP5150AM1 only)\n", (tvp5150_read(c, TVP5150_REV_SELECT)&1)?3:4); printk("tvp5150: Device ID = %02x%02x\n", tvp5150_read(c, TVP5150_MSB_DEV_ID), tvp5150_read(c, TVP5150_LSB_DEV_ID)); printk("tvp5150: ROM version = (hex) %02x.%02x\n", tvp5150_read(c, TVP5150_ROM_MAJOR_VER), tvp5150_read(c, TVP5150_ROM_MINOR_VER)); printk("tvp5150: Vertical line count = 0x%02x%02x\n", tvp5150_read(c, TVP5150_VERT_LN_COUNT_MSB), tvp5150_read(c, TVP5150_VERT_LN_COUNT_LSB)); printk("tvp5150: Interrupt status register B = 0x%02x\n", tvp5150_read(c, TVP5150_INT_STATUS_REG_B)); printk("tvp5150: Interrupt active register B = 0x%02x\n", tvp5150_read(c, TVP5150_INT_ACTIVE_REG_B)); printk("tvp5150: Status regs #1 to #5 = %02x %02x %02x %02x %02x\n", tvp5150_read(c, TVP5150_STATUS_REG_1), tvp5150_read(c, TVP5150_STATUS_REG_2), tvp5150_read(c, TVP5150_STATUS_REG_3), tvp5150_read(c, TVP5150_STATUS_REG_4), tvp5150_read(c, TVP5150_STATUS_REG_5)); dump_reg_range(c,"Teletext filter 1", TVP5150_TELETEXT_FIL1_INI, TVP5150_TELETEXT_FIL1_END,8); dump_reg_range(c,"Teletext filter 2", TVP5150_TELETEXT_FIL2_INI, TVP5150_TELETEXT_FIL2_END,8); printk("tvp5150: Teletext filter enable = 0x%02x\n", tvp5150_read(c, TVP5150_TELETEXT_FIL_ENA)); printk("tvp5150: Interrupt status register A = 0x%02x\n", tvp5150_read(c, TVP5150_INT_STATUS_REG_A)); printk("tvp5150: Interrupt enable register A = 0x%02x\n", tvp5150_read(c, TVP5150_INT_ENABLE_REG_A)); printk("tvp5150: Interrupt configuration = 0x%02x\n", tvp5150_read(c, TVP5150_INT_CONF)); printk("tvp5150: VDP status register = 0x%02x\n", tvp5150_read(c, TVP5150_VDP_STATUS_REG)); printk("tvp5150: FIFO word count = 0x%02x\n", tvp5150_read(c, TVP5150_FIFO_WORD_COUNT)); printk("tvp5150: FIFO interrupt threshold = 0x%02x\n", tvp5150_read(c, TVP5150_FIFO_INT_THRESHOLD)); printk("tvp5150: FIFO reset = 0x%02x\n", tvp5150_read(c, TVP5150_FIFO_RESET)); printk("tvp5150: Line number interrupt = 0x%02x\n", tvp5150_read(c, TVP5150_LINE_NUMBER_INT)); printk("tvp5150: Pixel alignment register = 0x%02x%02x\n", tvp5150_read(c, TVP5150_PIX_ALIGN_REG_HIGH), tvp5150_read(c, TVP5150_PIX_ALIGN_REG_LOW)); printk("tvp5150: FIFO output control = 0x%02x\n", tvp5150_read(c, TVP5150_FIFO_OUT_CTRL)); printk("tvp5150: Full field enable = 0x%02x\n", tvp5150_read(c, TVP5150_FULL_FIELD_ENA)); printk("tvp5150: Full field mode register = 0x%02x\n", tvp5150_read(c, TVP5150_FULL_FIELD_MODE_REG)); dump_reg_range(c,"CC data", TVP5150_CC_DATA_INI, TVP5150_CC_DATA_END,8); dump_reg_range(c,"WSS data", TVP5150_WSS_DATA_INI, TVP5150_WSS_DATA_END,8); dump_reg_range(c,"VPS data", TVP5150_VPS_DATA_INI, TVP5150_VPS_DATA_END,8); dump_reg_range(c,"VITC data", TVP5150_VITC_DATA_INI, TVP5150_VITC_DATA_END,10); dump_reg_range(c,"Line mode", TVP5150_LINE_MODE_INI, TVP5150_LINE_MODE_END,8);}/**************************************************************************** Basic functions ****************************************************************************/static inline void tvp5150_selmux(struct i2c_client *c){ int opmode=0; struct tvp5150 *decoder = i2c_get_clientdata(c); int input = 0; unsigned char val; if ((decoder->route.output & TVP5150_BLACK_SCREEN) || !decoder->enable) input = 8; switch (decoder->route.input) { case TVP5150_COMPOSITE1: input |= 2; /* fall through */ case TVP5150_COMPOSITE0: opmode=0x30; /* TV Mode */ break; case TVP5150_SVIDEO: default: input |= 1; opmode=0; /* Auto Mode */ break; } tvp5150_dbg( 1, "Selecting video route: route input=%i, output=%i " "=> tvp5150 input=%i, opmode=%i\n", decoder->route.input,decoder->route.output, input, opmode ); tvp5150_write(c, TVP5150_OP_MODE_CTL, opmode); tvp5150_write(c, TVP5150_VD_IN_SRC_SEL_1, input); /* Svideo should enable YCrCb output and disable GPCL output * For Composite and TV, it should be the reverse */ val = tvp5150_read(c, TVP5150_MISC_CTL); if (decoder->route.input == TVP5150_SVIDEO) val = (val & ~0x40) | 0x10; else val = (val & ~0x10) | 0x40; tvp5150_write(c, TVP5150_MISC_CTL, val);};struct i2c_reg_value { unsigned char reg; unsigned char value;};/* Default values as sugested at TVP5150AM1 datasheet */static const struct i2c_reg_value tvp5150_init_default[] = { { /* 0x00 */ TVP5150_VD_IN_SRC_SEL_1,0x00 }, { /* 0x01 */ TVP5150_ANAL_CHL_CTL,0x15 }, { /* 0x02 */ TVP5150_OP_MODE_CTL,0x00 }, { /* 0x03 */ TVP5150_MISC_CTL,0x01 }, { /* 0x06 */ TVP5150_COLOR_KIL_THSH_CTL,0x10 }, { /* 0x07 */ TVP5150_LUMA_PROC_CTL_1,0x60 }, { /* 0x08 */ TVP5150_LUMA_PROC_CTL_2,0x00 }, { /* 0x09 */ TVP5150_BRIGHT_CTL,0x80 }, { /* 0x0a */ TVP5150_SATURATION_CTL,0x80 }, { /* 0x0b */ TVP5150_HUE_CTL,0x00 }, { /* 0x0c */ TVP5150_CONTRAST_CTL,0x80 }, { /* 0x0d */ TVP5150_DATA_RATE_SEL,0x47 }, { /* 0x0e */ TVP5150_LUMA_PROC_CTL_3,0x00 }, { /* 0x0f */ TVP5150_CONF_SHARED_PIN,0x08 }, { /* 0x11 */ TVP5150_ACT_VD_CROP_ST_MSB,0x00 }, { /* 0x12 */ TVP5150_ACT_VD_CROP_ST_LSB,0x00 }, { /* 0x13 */ TVP5150_ACT_VD_CROP_STP_MSB,0x00 }, { /* 0x14 */ TVP5150_ACT_VD_CROP_STP_LSB,0x00 }, { /* 0x15 */ TVP5150_GENLOCK,0x01 }, { /* 0x16 */ TVP5150_HORIZ_SYNC_START,0x80 }, { /* 0x18 */ TVP5150_VERT_BLANKING_START,0x00 }, { /* 0x19 */ TVP5150_VERT_BLANKING_STOP,0x00 }, { /* 0x1a */ TVP5150_CHROMA_PROC_CTL_1,0x0c }, { /* 0x1b */ TVP5150_CHROMA_PROC_CTL_2,0x14 }, { /* 0x1c */ TVP5150_INT_RESET_REG_B,0x00 }, { /* 0x1d */ TVP5150_INT_ENABLE_REG_B,0x00 }, { /* 0x1e */ TVP5150_INTT_CONFIG_REG_B,0x00 }, { /* 0x28 */ TVP5150_VIDEO_STD,0x00 }, { /* 0x2e */ TVP5150_MACROVISION_ON_CTR,0x0f }, { /* 0x2f */ TVP5150_MACROVISION_OFF_CTR,0x01 }, { /* 0xbb */ TVP5150_TELETEXT_FIL_ENA,0x00 }, { /* 0xc0 */ TVP5150_INT_STATUS_REG_A,0x00 }, { /* 0xc1 */ TVP5150_INT_ENABLE_REG_A,0x00 }, { /* 0xc2 */ TVP5150_INT_CONF,0x04 }, { /* 0xc8 */ TVP5150_FIFO_INT_THRESHOLD,0x80 }, { /* 0xc9 */ TVP5150_FIFO_RESET,0x00 }, { /* 0xca */ TVP5150_LINE_NUMBER_INT,0x00 }, { /* 0xcb */ TVP5150_PIX_ALIGN_REG_LOW,0x4e }, { /* 0xcc */ TVP5150_PIX_ALIGN_REG_HIGH,0x00 }, { /* 0xcd */ TVP5150_FIFO_OUT_CTRL,0x01 }, { /* 0xcf */ TVP5150_FULL_FIELD_ENA,0x00 }, { /* 0xd0 */ TVP5150_LINE_MODE_INI,0x00 }, { /* 0xfc */ TVP5150_FULL_FIELD_MODE_REG,0x7f }, { /* end of data */ 0xff,0xff }};/* Default values as sugested at TVP5150AM1 datasheet */static const struct i2c_reg_value tvp5150_init_enable[] = { { TVP5150_CONF_SHARED_PIN, 2 },{ /* Automatic offset and AGC enabled */ TVP5150_ANAL_CHL_CTL, 0x15 },{ /* Activate YCrCb output 0x9 or 0xd ? */ TVP5150_MISC_CTL, 0x6f },{ /* Activates video std autodetection for all standards */ TVP5150_AUTOSW_MSK, 0x0 },{ /* Default format: 0x47. For 4:2:2: 0x40 */ TVP5150_DATA_RATE_SEL, 0x47 },{ TVP5150_CHROMA_PROC_CTL_1, 0x0c },{ TVP5150_CHROMA_PROC_CTL_2, 0x54 },{ /* Non documented, but initialized on WinTV USB2 */ 0x27, 0x20 },{ 0xff,0xff }};struct tvp5150_vbi_type { unsigned int vbi_type; unsigned int ini_line; unsigned int end_line; unsigned int by_field :1;};struct i2c_vbi_ram_value { u16 reg; struct tvp5150_vbi_type type; unsigned char values[16];};/* This struct have the values for each supported VBI Standard * by tvp5150_vbi_types should follow the same order as vbi_ram_default * value 0 means rom position 0x10, value 1 means rom position 0x30 * and so on. There are 16 possible locations from 0 to 15. */static struct i2c_vbi_ram_value vbi_ram_default[] ={ /* FIXME: Current api doesn't handle all VBI types, those not yet supported are placed under #if 0 */#if 0 {0x010, /* Teletext, SECAM, WST System A */ {V4L2_SLICED_TELETEXT_SECAM,6,23,1}, { 0xaa, 0xaa, 0xff, 0xff, 0xe7, 0x2e, 0x20, 0x26, 0xe6, 0xb4, 0x0e, 0x00, 0x00, 0x00, 0x10, 0x00 } },#endif {0x030, /* Teletext, PAL, WST System B */ {V4L2_SLICED_TELETEXT_B,6,22,1}, { 0xaa, 0xaa, 0xff, 0xff, 0x27, 0x2e, 0x20, 0x2b, 0xa6, 0x72, 0x10, 0x00, 0x00, 0x00, 0x10, 0x00 } },#if 0 {0x050, /* Teletext, PAL, WST System C */ {V4L2_SLICED_TELETEXT_PAL_C,6,22,1}, { 0xaa, 0xaa, 0xff, 0xff, 0xe7, 0x2e, 0x20, 0x22, 0xa6, 0x98, 0x0d, 0x00, 0x00, 0x00, 0x10, 0x00 } }, {0x070, /* Teletext, NTSC, WST System B */ {V4L2_SLICED_TELETEXT_NTSC_B,10,21,1}, { 0xaa, 0xaa, 0xff, 0xff, 0x27, 0x2e, 0x20, 0x23, 0x69, 0x93, 0x0d, 0x00, 0x00, 0x00, 0x10, 0x00 } }, {0x090, /* Tetetext, NTSC NABTS System C */ {V4L2_SLICED_TELETEXT_NTSC_C,10,21,1}, { 0xaa, 0xaa, 0xff, 0xff, 0xe7, 0x2e, 0x20, 0x22, 0x69, 0x93, 0x0d, 0x00, 0x00, 0x00, 0x15, 0x00 } }, {0x0b0, /* Teletext, NTSC-J, NABTS System D */ {V4L2_SLICED_TELETEXT_NTSC_D,10,21,1}, { 0xaa, 0xaa, 0xff, 0xff, 0xa7, 0x2e, 0x20, 0x23, 0x69, 0x93, 0x0d, 0x00, 0x00, 0x00, 0x10, 0x00 } }, {0x0d0, /* Closed Caption, PAL/SECAM */ {V4L2_SLICED_CAPTION_625,22,22,1}, { 0xaa, 0x2a, 0xff, 0x3f, 0x04, 0x51, 0x6e, 0x02, 0xa6, 0x7b, 0x09, 0x00, 0x00, 0x00, 0x27, 0x00 } },#endif {0x0f0, /* Closed Caption, NTSC */ {V4L2_SLICED_CAPTION_525,21,21,1}, { 0xaa, 0x2a, 0xff, 0x3f, 0x04, 0x51, 0x6e, 0x02, 0x69, 0x8c, 0x09, 0x00, 0x00, 0x00, 0x27, 0x00 } }, {0x110, /* Wide Screen Signal, PAL/SECAM */ {V4L2_SLICED_WSS_625,23,23,1}, { 0x5b, 0x55, 0xc5, 0xff, 0x00, 0x71, 0x6e, 0x42, 0xa6, 0xcd, 0x0f, 0x00, 0x00, 0x00, 0x3a, 0x00 } },#if 0 {0x130, /* Wide Screen Signal, NTSC C */ {V4L2_SLICED_WSS_525,20,20,1}, { 0x38, 0x00, 0x3f, 0x00, 0x00, 0x71, 0x6e, 0x43, 0x69, 0x7c, 0x08, 0x00, 0x00, 0x00, 0x39, 0x00 } }, {0x150, /* Vertical Interval Timecode (VITC), PAL/SECAM */ {V4l2_SLICED_VITC_625,6,22,0}, { 0x00, 0x00, 0x00, 0x00, 0x00, 0x8f, 0x6d, 0x49, 0xa6, 0x85, 0x08, 0x00, 0x00, 0x00, 0x4c, 0x00 } }, {0x170, /* Vertical Interval Timecode (VITC), NTSC */ {V4l2_SLICED_VITC_525,10,20,0}, { 0x00, 0x00, 0x00, 0x00, 0x00, 0x8f, 0x6d, 0x49,
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -