2 * tvp5150 - Texas Instruments TVP5150A/AM1 video decoder driver
4 * Copyright (c) 2005,2006 Mauro Carvalho Chehab (mchehab@infradead.org)
5 * This code is placed under the terms of the GNU General Public License v2
9 #include <linux/videodev.h>
10 #include <linux/delay.h>
11 #include <linux/video_decoder.h>
12 #include <media/v4l2-common.h>
13 #include <media/tvp5150.h>
15 #include "tvp5150_reg.h"
17 MODULE_DESCRIPTION("Texas Instruments TVP5150A video decoder driver");
18 MODULE_AUTHOR("Mauro Carvalho Chehab");
19 MODULE_LICENSE("GPL");
21 /* standard i2c insmod options */
22 static unsigned short normal_i2c
[] = {
31 module_param(debug
, int, 0);
32 MODULE_PARM_DESC(debug
, "Debug level (0-1)");
34 #define tvp5150_err(fmt, arg...) do { \
35 printk(KERN_ERR "%s %d-%04x: " fmt, c->driver->driver.name, \
36 i2c_adapter_id(c->adapter), c->addr , ## arg); } while (0)
37 #define tvp5150_info(fmt, arg...) do { \
38 printk(KERN_INFO "%s %d-%04x: " fmt, c->driver->driver.name, \
39 i2c_adapter_id(c->adapter), c->addr , ## arg); } while (0)
40 #define tvp5150_dbg(num, fmt, arg...) \
43 printk(KERN_DEBUG "%s debug %d-%04x: " fmt,\
44 c->driver->driver.name, \
45 i2c_adapter_id(c->adapter), \
46 c->addr , ## arg); } while (0)
48 /* supported controls */
49 static struct v4l2_queryctrl tvp5150_qctrl
[] = {
51 .id
= V4L2_CID_BRIGHTNESS
,
52 .type
= V4L2_CTRL_TYPE_INTEGER
,
60 .id
= V4L2_CID_CONTRAST
,
61 .type
= V4L2_CTRL_TYPE_INTEGER
,
69 .id
= V4L2_CID_SATURATION
,
70 .type
= V4L2_CTRL_TYPE_INTEGER
,
79 .type
= V4L2_CTRL_TYPE_INTEGER
,
90 struct i2c_client
*client
;
92 v4l2_std_id norm
; /* Current set standard */
93 struct v4l2_routing route
;
101 static int tvp5150_read(struct i2c_client
*c
, unsigned char addr
)
103 unsigned char buffer
[1];
107 if (1 != (rc
= i2c_master_send(c
, buffer
, 1)))
108 tvp5150_dbg(0, "i2c i/o error: rc == %d (should be 1)\n", rc
);
112 if (1 != (rc
= i2c_master_recv(c
, buffer
, 1)))
113 tvp5150_dbg(0, "i2c i/o error: rc == %d (should be 1)\n", rc
);
115 tvp5150_dbg(2, "tvp5150: read 0x%02x = 0x%02x\n", addr
, buffer
[0]);
120 static inline void tvp5150_write(struct i2c_client
*c
, unsigned char addr
,
123 unsigned char buffer
[2];
128 tvp5150_dbg(2, "tvp5150: writing 0x%02x 0x%02x\n", buffer
[0], buffer
[1]);
129 if (2 != (rc
= i2c_master_send(c
, buffer
, 2)))
130 tvp5150_dbg(0, "i2c i/o error: rc == %d (should be 2)\n", rc
);
133 static void dump_reg_range(struct i2c_client
*c
, char *s
, u8 init
, const u8 end
,int max_line
)
137 while (init
!=(u8
)(end
+1)) {
138 if ((i
%max_line
) == 0) {
141 printk("tvp5150: %s reg 0x%02x = ",s
,init
);
143 printk("%02x ",tvp5150_read(c
, init
));
151 static void dump_reg(struct i2c_client
*c
)
153 printk("tvp5150: Video input source selection #1 = 0x%02x\n",
154 tvp5150_read(c
, TVP5150_VD_IN_SRC_SEL_1
));
155 printk("tvp5150: Analog channel controls = 0x%02x\n",
156 tvp5150_read(c
, TVP5150_ANAL_CHL_CTL
));
157 printk("tvp5150: Operation mode controls = 0x%02x\n",
158 tvp5150_read(c
, TVP5150_OP_MODE_CTL
));
159 printk("tvp5150: Miscellaneous controls = 0x%02x\n",
160 tvp5150_read(c
, TVP5150_MISC_CTL
));
161 printk("tvp5150: Autoswitch mask= 0x%02x\n",
162 tvp5150_read(c
, TVP5150_AUTOSW_MSK
));
163 printk("tvp5150: Color killer threshold control = 0x%02x\n",
164 tvp5150_read(c
, TVP5150_COLOR_KIL_THSH_CTL
));
165 printk("tvp5150: Luminance processing controls #1 #2 and #3 = %02x %02x %02x\n",
166 tvp5150_read(c
, TVP5150_LUMA_PROC_CTL_1
),
167 tvp5150_read(c
, TVP5150_LUMA_PROC_CTL_2
),
168 tvp5150_read(c
, TVP5150_LUMA_PROC_CTL_3
));
169 printk("tvp5150: Brightness control = 0x%02x\n",
170 tvp5150_read(c
, TVP5150_BRIGHT_CTL
));
171 printk("tvp5150: Color saturation control = 0x%02x\n",
172 tvp5150_read(c
, TVP5150_SATURATION_CTL
));
173 printk("tvp5150: Hue control = 0x%02x\n",
174 tvp5150_read(c
, TVP5150_HUE_CTL
));
175 printk("tvp5150: Contrast control = 0x%02x\n",
176 tvp5150_read(c
, TVP5150_CONTRAST_CTL
));
177 printk("tvp5150: Outputs and data rates select = 0x%02x\n",
178 tvp5150_read(c
, TVP5150_DATA_RATE_SEL
));
179 printk("tvp5150: Configuration shared pins = 0x%02x\n",
180 tvp5150_read(c
, TVP5150_CONF_SHARED_PIN
));
181 printk("tvp5150: Active video cropping start = 0x%02x%02x\n",
182 tvp5150_read(c
, TVP5150_ACT_VD_CROP_ST_MSB
),
183 tvp5150_read(c
, TVP5150_ACT_VD_CROP_ST_LSB
));
184 printk("tvp5150: Active video cropping stop = 0x%02x%02x\n",
185 tvp5150_read(c
, TVP5150_ACT_VD_CROP_STP_MSB
),
186 tvp5150_read(c
, TVP5150_ACT_VD_CROP_STP_LSB
));
187 printk("tvp5150: Genlock/RTC = 0x%02x\n",
188 tvp5150_read(c
, TVP5150_GENLOCK
));
189 printk("tvp5150: Horizontal sync start = 0x%02x\n",
190 tvp5150_read(c
, TVP5150_HORIZ_SYNC_START
));
191 printk("tvp5150: Vertical blanking start = 0x%02x\n",
192 tvp5150_read(c
, TVP5150_VERT_BLANKING_START
));
193 printk("tvp5150: Vertical blanking stop = 0x%02x\n",
194 tvp5150_read(c
, TVP5150_VERT_BLANKING_STOP
));
195 printk("tvp5150: Chrominance processing control #1 and #2 = %02x %02x\n",
196 tvp5150_read(c
, TVP5150_CHROMA_PROC_CTL_1
),
197 tvp5150_read(c
, TVP5150_CHROMA_PROC_CTL_2
));
198 printk("tvp5150: Interrupt reset register B = 0x%02x\n",
199 tvp5150_read(c
, TVP5150_INT_RESET_REG_B
));
200 printk("tvp5150: Interrupt enable register B = 0x%02x\n",
201 tvp5150_read(c
, TVP5150_INT_ENABLE_REG_B
));
202 printk("tvp5150: Interrupt configuration register B = 0x%02x\n",
203 tvp5150_read(c
, TVP5150_INTT_CONFIG_REG_B
));
204 printk("tvp5150: Video standard = 0x%02x\n",
205 tvp5150_read(c
, TVP5150_VIDEO_STD
));
206 printk("tvp5150: Chroma gain factor: Cb=0x%02x Cr=0x%02x\n",
207 tvp5150_read(c
, TVP5150_CB_GAIN_FACT
),
208 tvp5150_read(c
, TVP5150_CR_GAIN_FACTOR
));
209 printk("tvp5150: Macrovision on counter = 0x%02x\n",
210 tvp5150_read(c
, TVP5150_MACROVISION_ON_CTR
));
211 printk("tvp5150: Macrovision off counter = 0x%02x\n",
212 tvp5150_read(c
, TVP5150_MACROVISION_OFF_CTR
));
213 printk("tvp5150: ITU-R BT.656.%d timing(TVP5150AM1 only)\n",
214 (tvp5150_read(c
, TVP5150_REV_SELECT
)&1)?3:4);
215 printk("tvp5150: Device ID = %02x%02x\n",
216 tvp5150_read(c
, TVP5150_MSB_DEV_ID
),
217 tvp5150_read(c
, TVP5150_LSB_DEV_ID
));
218 printk("tvp5150: ROM version = (hex) %02x.%02x\n",
219 tvp5150_read(c
, TVP5150_ROM_MAJOR_VER
),
220 tvp5150_read(c
, TVP5150_ROM_MINOR_VER
));
221 printk("tvp5150: Vertical line count = 0x%02x%02x\n",
222 tvp5150_read(c
, TVP5150_VERT_LN_COUNT_MSB
),
223 tvp5150_read(c
, TVP5150_VERT_LN_COUNT_LSB
));
224 printk("tvp5150: Interrupt status register B = 0x%02x\n",
225 tvp5150_read(c
, TVP5150_INT_STATUS_REG_B
));
226 printk("tvp5150: Interrupt active register B = 0x%02x\n",
227 tvp5150_read(c
, TVP5150_INT_ACTIVE_REG_B
));
228 printk("tvp5150: Status regs #1 to #5 = %02x %02x %02x %02x %02x\n",
229 tvp5150_read(c
, TVP5150_STATUS_REG_1
),
230 tvp5150_read(c
, TVP5150_STATUS_REG_2
),
231 tvp5150_read(c
, TVP5150_STATUS_REG_3
),
232 tvp5150_read(c
, TVP5150_STATUS_REG_4
),
233 tvp5150_read(c
, TVP5150_STATUS_REG_5
));
235 dump_reg_range(c
,"Teletext filter 1", TVP5150_TELETEXT_FIL1_INI
,
236 TVP5150_TELETEXT_FIL1_END
,8);
237 dump_reg_range(c
,"Teletext filter 2", TVP5150_TELETEXT_FIL2_INI
,
238 TVP5150_TELETEXT_FIL2_END
,8);
240 printk("tvp5150: Teletext filter enable = 0x%02x\n",
241 tvp5150_read(c
, TVP5150_TELETEXT_FIL_ENA
));
242 printk("tvp5150: Interrupt status register A = 0x%02x\n",
243 tvp5150_read(c
, TVP5150_INT_STATUS_REG_A
));
244 printk("tvp5150: Interrupt enable register A = 0x%02x\n",
245 tvp5150_read(c
, TVP5150_INT_ENABLE_REG_A
));
246 printk("tvp5150: Interrupt configuration = 0x%02x\n",
247 tvp5150_read(c
, TVP5150_INT_CONF
));
248 printk("tvp5150: VDP status register = 0x%02x\n",
249 tvp5150_read(c
, TVP5150_VDP_STATUS_REG
));
250 printk("tvp5150: FIFO word count = 0x%02x\n",
251 tvp5150_read(c
, TVP5150_FIFO_WORD_COUNT
));
252 printk("tvp5150: FIFO interrupt threshold = 0x%02x\n",
253 tvp5150_read(c
, TVP5150_FIFO_INT_THRESHOLD
));
254 printk("tvp5150: FIFO reset = 0x%02x\n",
255 tvp5150_read(c
, TVP5150_FIFO_RESET
));
256 printk("tvp5150: Line number interrupt = 0x%02x\n",
257 tvp5150_read(c
, TVP5150_LINE_NUMBER_INT
));
258 printk("tvp5150: Pixel alignment register = 0x%02x%02x\n",
259 tvp5150_read(c
, TVP5150_PIX_ALIGN_REG_HIGH
),
260 tvp5150_read(c
, TVP5150_PIX_ALIGN_REG_LOW
));
261 printk("tvp5150: FIFO output control = 0x%02x\n",
262 tvp5150_read(c
, TVP5150_FIFO_OUT_CTRL
));
263 printk("tvp5150: Full field enable = 0x%02x\n",
264 tvp5150_read(c
, TVP5150_FULL_FIELD_ENA
));
265 printk("tvp5150: Full field mode register = 0x%02x\n",
266 tvp5150_read(c
, TVP5150_FULL_FIELD_MODE_REG
));
268 dump_reg_range(c
,"CC data", TVP5150_CC_DATA_INI
,
269 TVP5150_CC_DATA_END
,8);
271 dump_reg_range(c
,"WSS data", TVP5150_WSS_DATA_INI
,
272 TVP5150_WSS_DATA_END
,8);
274 dump_reg_range(c
,"VPS data", TVP5150_VPS_DATA_INI
,
275 TVP5150_VPS_DATA_END
,8);
277 dump_reg_range(c
,"VITC data", TVP5150_VITC_DATA_INI
,
278 TVP5150_VITC_DATA_END
,10);
280 dump_reg_range(c
,"Line mode", TVP5150_LINE_MODE_INI
,
281 TVP5150_LINE_MODE_END
,8);
284 /****************************************************************************
286 ****************************************************************************/
288 static inline void tvp5150_selmux(struct i2c_client
*c
)
291 struct tvp5150
*decoder
= i2c_get_clientdata(c
);
295 if ((decoder
->route
.output
& TVP5150_BLACK_SCREEN
) || !decoder
->enable
)
298 switch (decoder
->route
.input
) {
299 case TVP5150_COMPOSITE1
:
302 case TVP5150_COMPOSITE0
:
303 opmode
=0x30; /* TV Mode */
308 opmode
=0; /* Auto Mode */
312 tvp5150_dbg( 1, "Selecting video route: route input=%i, output=%i "
313 "=> tvp5150 input=%i, opmode=%i\n",
314 decoder
->route
.input
,decoder
->route
.output
,
317 tvp5150_write(c
, TVP5150_OP_MODE_CTL
, opmode
);
318 tvp5150_write(c
, TVP5150_VD_IN_SRC_SEL_1
, input
);
320 /* Svideo should enable YCrCb output and disable GPCL output
321 * For Composite and TV, it should be the reverse
323 val
= tvp5150_read(c
, TVP5150_MISC_CTL
);
324 if (decoder
->route
.input
== TVP5150_SVIDEO
)
325 val
= (val
& ~0x40) | 0x10;
327 val
= (val
& ~0x10) | 0x40;
328 tvp5150_write(c
, TVP5150_MISC_CTL
, val
);
331 struct i2c_reg_value
{
336 /* Default values as sugested at TVP5150AM1 datasheet */
337 static const struct i2c_reg_value tvp5150_init_default
[] = {
339 TVP5150_VD_IN_SRC_SEL_1
,0x00
342 TVP5150_ANAL_CHL_CTL
,0x15
345 TVP5150_OP_MODE_CTL
,0x00
348 TVP5150_MISC_CTL
,0x01
351 TVP5150_COLOR_KIL_THSH_CTL
,0x10
354 TVP5150_LUMA_PROC_CTL_1
,0x60
357 TVP5150_LUMA_PROC_CTL_2
,0x00
360 TVP5150_BRIGHT_CTL
,0x80
363 TVP5150_SATURATION_CTL
,0x80
369 TVP5150_CONTRAST_CTL
,0x80
372 TVP5150_DATA_RATE_SEL
,0x47
375 TVP5150_LUMA_PROC_CTL_3
,0x00
378 TVP5150_CONF_SHARED_PIN
,0x08
381 TVP5150_ACT_VD_CROP_ST_MSB
,0x00
384 TVP5150_ACT_VD_CROP_ST_LSB
,0x00
387 TVP5150_ACT_VD_CROP_STP_MSB
,0x00
390 TVP5150_ACT_VD_CROP_STP_LSB
,0x00
396 TVP5150_HORIZ_SYNC_START
,0x80
399 TVP5150_VERT_BLANKING_START
,0x00
402 TVP5150_VERT_BLANKING_STOP
,0x00
405 TVP5150_CHROMA_PROC_CTL_1
,0x0c
408 TVP5150_CHROMA_PROC_CTL_2
,0x14
411 TVP5150_INT_RESET_REG_B
,0x00
414 TVP5150_INT_ENABLE_REG_B
,0x00
417 TVP5150_INTT_CONFIG_REG_B
,0x00
420 TVP5150_VIDEO_STD
,0x00
423 TVP5150_MACROVISION_ON_CTR
,0x0f
426 TVP5150_MACROVISION_OFF_CTR
,0x01
429 TVP5150_TELETEXT_FIL_ENA
,0x00
432 TVP5150_INT_STATUS_REG_A
,0x00
435 TVP5150_INT_ENABLE_REG_A
,0x00
438 TVP5150_INT_CONF
,0x04
441 TVP5150_FIFO_INT_THRESHOLD
,0x80
444 TVP5150_FIFO_RESET
,0x00
447 TVP5150_LINE_NUMBER_INT
,0x00
450 TVP5150_PIX_ALIGN_REG_LOW
,0x4e
453 TVP5150_PIX_ALIGN_REG_HIGH
,0x00
456 TVP5150_FIFO_OUT_CTRL
,0x01
459 TVP5150_FULL_FIELD_ENA
,0x00
462 TVP5150_LINE_MODE_INI
,0x00
465 TVP5150_FULL_FIELD_MODE_REG
,0x7f
472 /* Default values as sugested at TVP5150AM1 datasheet */
473 static const struct i2c_reg_value tvp5150_init_enable
[] = {
475 TVP5150_CONF_SHARED_PIN
, 2
476 },{ /* Automatic offset and AGC enabled */
477 TVP5150_ANAL_CHL_CTL
, 0x15
478 },{ /* Activate YCrCb output 0x9 or 0xd ? */
479 TVP5150_MISC_CTL
, 0x6f
480 },{ /* Activates video std autodetection for all standards */
481 TVP5150_AUTOSW_MSK
, 0x0
482 },{ /* Default format: 0x47. For 4:2:2: 0x40 */
483 TVP5150_DATA_RATE_SEL
, 0x47
485 TVP5150_CHROMA_PROC_CTL_1
, 0x0c
487 TVP5150_CHROMA_PROC_CTL_2
, 0x54
488 },{ /* Non documented, but initialized on WinTV USB2 */
495 struct tvp5150_vbi_type
{
496 unsigned int vbi_type
;
497 unsigned int ini_line
;
498 unsigned int end_line
;
499 unsigned int by_field
:1;
502 struct i2c_vbi_ram_value
{
504 struct tvp5150_vbi_type type
;
505 unsigned char values
[16];
508 /* This struct have the values for each supported VBI Standard
510 tvp5150_vbi_types should follow the same order as vbi_ram_default
511 * value 0 means rom position 0x10, value 1 means rom position 0x30
512 * and so on. There are 16 possible locations from 0 to 15.
515 static struct i2c_vbi_ram_value vbi_ram_default
[] =
517 /* FIXME: Current api doesn't handle all VBI types, those not
518 yet supported are placed under #if 0 */
520 {0x010, /* Teletext, SECAM, WST System A */
521 {V4L2_SLICED_TELETEXT_SECAM
,6,23,1},
522 { 0xaa, 0xaa, 0xff, 0xff, 0xe7, 0x2e, 0x20, 0x26,
523 0xe6, 0xb4, 0x0e, 0x00, 0x00, 0x00, 0x10, 0x00 }
526 {0x030, /* Teletext, PAL, WST System B */
527 {V4L2_SLICED_TELETEXT_B
,6,22,1},
528 { 0xaa, 0xaa, 0xff, 0xff, 0x27, 0x2e, 0x20, 0x2b,
529 0xa6, 0x72, 0x10, 0x00, 0x00, 0x00, 0x10, 0x00 }
532 {0x050, /* Teletext, PAL, WST System C */
533 {V4L2_SLICED_TELETEXT_PAL_C
,6,22,1},
534 { 0xaa, 0xaa, 0xff, 0xff, 0xe7, 0x2e, 0x20, 0x22,
535 0xa6, 0x98, 0x0d, 0x00, 0x00, 0x00, 0x10, 0x00 }
537 {0x070, /* Teletext, NTSC, WST System B */
538 {V4L2_SLICED_TELETEXT_NTSC_B
,10,21,1},
539 { 0xaa, 0xaa, 0xff, 0xff, 0x27, 0x2e, 0x20, 0x23,
540 0x69, 0x93, 0x0d, 0x00, 0x00, 0x00, 0x10, 0x00 }
542 {0x090, /* Tetetext, NTSC NABTS System C */
543 {V4L2_SLICED_TELETEXT_NTSC_C
,10,21,1},
544 { 0xaa, 0xaa, 0xff, 0xff, 0xe7, 0x2e, 0x20, 0x22,
545 0x69, 0x93, 0x0d, 0x00, 0x00, 0x00, 0x15, 0x00 }
547 {0x0b0, /* Teletext, NTSC-J, NABTS System D */
548 {V4L2_SLICED_TELETEXT_NTSC_D
,10,21,1},
549 { 0xaa, 0xaa, 0xff, 0xff, 0xa7, 0x2e, 0x20, 0x23,
550 0x69, 0x93, 0x0d, 0x00, 0x00, 0x00, 0x10, 0x00 }
552 {0x0d0, /* Closed Caption, PAL/SECAM */
553 {V4L2_SLICED_CAPTION_625
,22,22,1},
554 { 0xaa, 0x2a, 0xff, 0x3f, 0x04, 0x51, 0x6e, 0x02,
555 0xa6, 0x7b, 0x09, 0x00, 0x00, 0x00, 0x27, 0x00 }
558 {0x0f0, /* Closed Caption, NTSC */
559 {V4L2_SLICED_CAPTION_525
,21,21,1},
560 { 0xaa, 0x2a, 0xff, 0x3f, 0x04, 0x51, 0x6e, 0x02,
561 0x69, 0x8c, 0x09, 0x00, 0x00, 0x00, 0x27, 0x00 }
563 {0x110, /* Wide Screen Signal, PAL/SECAM */
564 {V4L2_SLICED_WSS_625
,23,23,1},
565 { 0x5b, 0x55, 0xc5, 0xff, 0x00, 0x71, 0x6e, 0x42,
566 0xa6, 0xcd, 0x0f, 0x00, 0x00, 0x00, 0x3a, 0x00 }
569 {0x130, /* Wide Screen Signal, NTSC C */
570 {V4L2_SLICED_WSS_525
,20,20,1},
571 { 0x38, 0x00, 0x3f, 0x00, 0x00, 0x71, 0x6e, 0x43,
572 0x69, 0x7c, 0x08, 0x00, 0x00, 0x00, 0x39, 0x00 }
574 {0x150, /* Vertical Interval Timecode (VITC), PAL/SECAM */
575 {V4l2_SLICED_VITC_625
,6,22,0},
576 { 0x00, 0x00, 0x00, 0x00, 0x00, 0x8f, 0x6d, 0x49,
577 0xa6, 0x85, 0x08, 0x00, 0x00, 0x00, 0x4c, 0x00 }
579 {0x170, /* Vertical Interval Timecode (VITC), NTSC */
580 {V4l2_SLICED_VITC_525
,10,20,0},
581 { 0x00, 0x00, 0x00, 0x00, 0x00, 0x8f, 0x6d, 0x49,
582 0x69, 0x94, 0x08, 0x00, 0x00, 0x00, 0x4c, 0x00 }
585 {0x190, /* Video Program System (VPS), PAL */
586 {V4L2_SLICED_VPS
,16,16,0},
587 { 0xaa, 0xaa, 0xff, 0xff, 0xba, 0xce, 0x2b, 0x0d,
588 0xa6, 0xda, 0x0b, 0x00, 0x00, 0x00, 0x60, 0x00 }
590 /* 0x1d0 User programmable */
596 static int tvp5150_write_inittab(struct i2c_client
*c
,
597 const struct i2c_reg_value
*regs
)
599 while (regs
->reg
!= 0xff) {
600 tvp5150_write(c
, regs
->reg
, regs
->value
);
606 static int tvp5150_vdp_init(struct i2c_client
*c
,
607 const struct i2c_vbi_ram_value
*regs
)
611 /* Disable Full Field */
612 tvp5150_write(c
, TVP5150_FULL_FIELD_ENA
, 0);
614 /* Before programming, Line mode should be at 0xff */
615 for (i
=TVP5150_LINE_MODE_INI
; i
<=TVP5150_LINE_MODE_END
; i
++)
616 tvp5150_write(c
, i
, 0xff);
619 while (regs
->reg
!= (u16
)-1 ) {
620 tvp5150_write(c
, TVP5150_CONF_RAM_ADDR_HIGH
,regs
->reg
>>8);
621 tvp5150_write(c
, TVP5150_CONF_RAM_ADDR_LOW
,regs
->reg
);
624 tvp5150_write(c
, TVP5150_VDP_CONF_RAM_DATA
,regs
->values
[i
]);
631 /* Fills VBI capabilities based on i2c_vbi_ram_value struct */
632 static void tvp5150_vbi_get_cap(const struct i2c_vbi_ram_value
*regs
,
633 struct v4l2_sliced_vbi_cap
*cap
)
637 memset(cap
, 0, sizeof *cap
);
639 while (regs
->reg
!= (u16
)-1 ) {
640 for (line
=regs
->type
.ini_line
;line
<=regs
->type
.end_line
;line
++) {
641 cap
->service_lines
[0][line
] |= regs
->type
.vbi_type
;
643 cap
->service_set
|= regs
->type
.vbi_type
;
649 /* Set vbi processing
650 * type - one of tvp5150_vbi_types
651 * line - line to gather data
652 * fields: bit 0 field1, bit 1, field2
653 * flags (default=0xf0) is a bitmask, were set means:
654 * bit 7: enable filtering null bytes on CC
655 * bit 6: send data also to FIFO
656 * bit 5: don't allow data with errors on FIFO
657 * bit 4: enable ECC when possible
658 * pix_align = pix alignment:
662 static int tvp5150_set_vbi(struct i2c_client
*c
,
663 const struct i2c_vbi_ram_value
*regs
,
664 unsigned int type
,u8 flags
, int line
,
667 struct tvp5150
*decoder
= i2c_get_clientdata(c
);
668 v4l2_std_id std
=decoder
->norm
;
672 if (std
== V4L2_STD_ALL
) {
673 tvp5150_err("VBI can't be configured without knowing number of lines\n");
675 } else if (std
& V4L2_STD_625_50
) {
676 /* Don't follow NTSC Line number convension */
683 while (regs
->reg
!= (u16
)-1 ) {
684 if ((type
& regs
->type
.vbi_type
) &&
685 (line
>=regs
->type
.ini_line
) &&
686 (line
<=regs
->type
.end_line
)) {
687 type
=regs
->type
.vbi_type
;
694 if (regs
->reg
== (u16
)-1)
697 type
=pos
| (flags
& 0xf0);
698 reg
=((line
-6)<<1)+TVP5150_LINE_MODE_INI
;
701 tvp5150_write(c
, reg
, type
);
705 tvp5150_write(c
, reg
+1, type
);
711 static int tvp5150_get_vbi(struct i2c_client
*c
,
712 const struct i2c_vbi_ram_value
*regs
, int line
)
714 struct tvp5150
*decoder
= i2c_get_clientdata(c
);
715 v4l2_std_id std
=decoder
->norm
;
719 if (std
== V4L2_STD_ALL
) {
720 tvp5150_err("VBI can't be configured without knowing number of lines\n");
722 } else if (std
& V4L2_STD_625_50
) {
723 /* Don't follow NTSC Line number convension */
730 reg
=((line
-6)<<1)+TVP5150_LINE_MODE_INI
;
732 pos
=tvp5150_read(c
, reg
)&0x0f;
734 type
=regs
[pos
].type
.vbi_type
;
736 pos
=tvp5150_read(c
, reg
+1)&0x0f;
738 type
|=regs
[pos
].type
.vbi_type
;
742 static int tvp5150_set_std(struct i2c_client
*c
, v4l2_std_id std
)
744 struct tvp5150
*decoder
= i2c_get_clientdata(c
);
749 /* First tests should be against specific std */
751 if (std
== V4L2_STD_ALL
) {
752 fmt
=0; /* Autodetect mode */
753 } else if (std
& V4L2_STD_NTSC_443
) {
755 } else if (std
& V4L2_STD_PAL_M
) {
757 } else if (std
& (V4L2_STD_PAL_N
| V4L2_STD_PAL_Nc
)) {
760 /* Then, test against generic ones */
761 if (std
& V4L2_STD_NTSC
) {
763 } else if (std
& V4L2_STD_PAL
) {
765 } else if (std
& V4L2_STD_SECAM
) {
770 tvp5150_dbg(1,"Set video std register to %d.\n",fmt
);
771 tvp5150_write(c
, TVP5150_VIDEO_STD
, fmt
);
776 static inline void tvp5150_reset(struct i2c_client
*c
)
778 u8 msb_id
, lsb_id
, msb_rom
, lsb_rom
;
779 struct tvp5150
*decoder
= i2c_get_clientdata(c
);
781 msb_id
=tvp5150_read(c
,TVP5150_MSB_DEV_ID
);
782 lsb_id
=tvp5150_read(c
,TVP5150_LSB_DEV_ID
);
783 msb_rom
=tvp5150_read(c
,TVP5150_ROM_MAJOR_VER
);
784 lsb_rom
=tvp5150_read(c
,TVP5150_ROM_MINOR_VER
);
786 if ((msb_rom
==4)&&(lsb_rom
==0)) { /* Is TVP5150AM1 */
787 tvp5150_info("tvp%02x%02xam1 detected.\n",msb_id
, lsb_id
);
789 /* ITU-T BT.656.4 timing */
790 tvp5150_write(c
,TVP5150_REV_SELECT
,0);
792 if ((msb_rom
==3)||(lsb_rom
==0x21)) { /* Is TVP5150A */
793 tvp5150_info("tvp%02x%02xa detected.\n",msb_id
, lsb_id
);
795 tvp5150_info("*** unknown tvp%02x%02x chip detected.\n",msb_id
,lsb_id
);
796 tvp5150_info("*** Rom ver is %d.%d\n",msb_rom
,lsb_rom
);
800 /* Initializes TVP5150 to its default values */
801 tvp5150_write_inittab(c
, tvp5150_init_default
);
803 /* Initializes VDP registers */
804 tvp5150_vdp_init(c
, vbi_ram_default
);
806 /* Selects decoder input */
809 /* Initializes TVP5150 to stream enabled values */
810 tvp5150_write_inittab(c
, tvp5150_init_enable
);
812 /* Initialize image preferences */
813 tvp5150_write(c
, TVP5150_BRIGHT_CTL
, decoder
->bright
);
814 tvp5150_write(c
, TVP5150_CONTRAST_CTL
, decoder
->contrast
);
815 tvp5150_write(c
, TVP5150_SATURATION_CTL
, decoder
->contrast
);
816 tvp5150_write(c
, TVP5150_HUE_CTL
, decoder
->hue
);
818 tvp5150_set_std(c
, decoder
->norm
);
821 static int tvp5150_get_ctrl(struct i2c_client
*c
, struct v4l2_control
*ctrl
)
823 /* struct tvp5150 *decoder = i2c_get_clientdata(c); */
826 case V4L2_CID_BRIGHTNESS
:
827 ctrl
->value
= tvp5150_read(c
, TVP5150_BRIGHT_CTL
);
829 case V4L2_CID_CONTRAST
:
830 ctrl
->value
= tvp5150_read(c
, TVP5150_CONTRAST_CTL
);
832 case V4L2_CID_SATURATION
:
833 ctrl
->value
= tvp5150_read(c
, TVP5150_SATURATION_CTL
);
836 ctrl
->value
= tvp5150_read(c
, TVP5150_HUE_CTL
);
842 static int tvp5150_set_ctrl(struct i2c_client
*c
, struct v4l2_control
*ctrl
)
844 /* struct tvp5150 *decoder = i2c_get_clientdata(c); */
847 case V4L2_CID_BRIGHTNESS
:
848 tvp5150_write(c
, TVP5150_BRIGHT_CTL
, ctrl
->value
);
850 case V4L2_CID_CONTRAST
:
851 tvp5150_write(c
, TVP5150_CONTRAST_CTL
, ctrl
->value
);
853 case V4L2_CID_SATURATION
:
854 tvp5150_write(c
, TVP5150_SATURATION_CTL
, ctrl
->value
);
857 tvp5150_write(c
, TVP5150_HUE_CTL
, ctrl
->value
);
863 /****************************************************************************
865 ****************************************************************************/
866 static int tvp5150_command(struct i2c_client
*c
,
867 unsigned int cmd
, void *arg
)
869 struct tvp5150
*decoder
= i2c_get_clientdata(c
);
874 case VIDIOC_INT_RESET
:
877 case VIDIOC_INT_G_VIDEO_ROUTING
:
879 struct v4l2_routing
*route
= arg
;
881 *route
= decoder
->route
;
884 case VIDIOC_INT_S_VIDEO_ROUTING
:
886 struct v4l2_routing
*route
= arg
;
888 decoder
->route
= *route
;
893 if (decoder
->norm
== *(v4l2_std_id
*)arg
)
895 return tvp5150_set_std(c
, *(v4l2_std_id
*)arg
);
897 *(v4l2_std_id
*)arg
= decoder
->norm
;
900 case VIDIOC_G_SLICED_VBI_CAP
:
902 struct v4l2_sliced_vbi_cap
*cap
= arg
;
903 tvp5150_dbg(1, "VIDIOC_G_SLICED_VBI_CAP\n");
905 tvp5150_vbi_get_cap(vbi_ram_default
, cap
);
910 struct v4l2_format
*fmt
;
911 struct v4l2_sliced_vbi_format
*svbi
;
915 if (fmt
->type
!= V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
)
917 svbi
= &fmt
->fmt
.sliced
;
918 if (svbi
->service_set
!= 0) {
919 for (i
= 0; i
<= 23; i
++) {
920 svbi
->service_lines
[1][i
] = 0;
922 svbi
->service_lines
[0][i
]=tvp5150_set_vbi(c
,
924 svbi
->service_lines
[0][i
],0xf0,i
,3);
927 tvp5150_write(c
, TVP5150_FIFO_OUT_CTRL
,1);
930 tvp5150_write(c
, TVP5150_FIFO_OUT_CTRL
,0);
932 /* Disable Full Field */
933 tvp5150_write(c
, TVP5150_FULL_FIELD_ENA
, 0);
935 /* Disable Line modes */
936 for (i
=TVP5150_LINE_MODE_INI
; i
<=TVP5150_LINE_MODE_END
; i
++)
937 tvp5150_write(c
, i
, 0xff);
943 struct v4l2_format
*fmt
;
944 struct v4l2_sliced_vbi_format
*svbi
;
949 if (fmt
->type
!= V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
)
951 svbi
= &fmt
->fmt
.sliced
;
952 memset(svbi
, 0, sizeof(*svbi
));
954 for (i
= 0; i
<= 23; i
++) {
955 svbi
->service_lines
[0][i
]=tvp5150_get_vbi(c
,
957 mask
|=svbi
->service_lines
[0][i
];
959 svbi
->service_set
=mask
;
963 #ifdef CONFIG_VIDEO_ADV_DEBUG
964 case VIDIOC_DBG_G_REGISTER
:
965 case VIDIOC_DBG_S_REGISTER
:
967 struct v4l2_register
*reg
= arg
;
969 if (!v4l2_chip_match_i2c_client(c
, reg
->match_type
, reg
->match_chip
))
971 if (!capable(CAP_SYS_ADMIN
))
973 if (cmd
== VIDIOC_DBG_G_REGISTER
)
974 reg
->val
= tvp5150_read(c
, reg
->reg
& 0xff);
976 tvp5150_write(c
, reg
->reg
& 0xff, reg
->val
& 0xff);
981 case VIDIOC_LOG_STATUS
:
987 struct v4l2_tuner
*vt
= arg
;
988 int status
= tvp5150_read(c
, 0x88);
990 vt
->signal
= ((status
& 0x04) && (status
& 0x02)) ? 0xffff : 0x0;
993 case VIDIOC_QUERYCTRL
:
995 struct v4l2_queryctrl
*qc
= arg
;
998 tvp5150_dbg(1, "VIDIOC_QUERYCTRL called\n");
1000 for (i
= 0; i
< ARRAY_SIZE(tvp5150_qctrl
); i
++)
1001 if (qc
->id
&& qc
->id
== tvp5150_qctrl
[i
].id
) {
1002 memcpy(qc
, &(tvp5150_qctrl
[i
]),
1011 struct v4l2_control
*ctrl
= arg
;
1012 tvp5150_dbg(1, "VIDIOC_G_CTRL called\n");
1014 return tvp5150_get_ctrl(c
, ctrl
);
1018 struct v4l2_control
*ctrl
= arg
;
1020 n
= ARRAY_SIZE(tvp5150_qctrl
);
1021 for (i
= 0; i
< n
; i
++)
1022 if (ctrl
->id
== tvp5150_qctrl
[i
].id
) {
1024 tvp5150_qctrl
[i
].minimum
1026 tvp5150_qctrl
[i
].maximum
)
1029 "VIDIOC_S_CTRL: id=%d, value=%d\n",
1030 ctrl
->id
, ctrl
->value
);
1031 return tvp5150_set_ctrl(c
, ctrl
);
1043 /****************************************************************************
1045 ****************************************************************************/
1046 static struct i2c_driver driver
;
1048 static struct i2c_client client_template
= {
1053 static int tvp5150_detect_client(struct i2c_adapter
*adapter
,
1054 int address
, int kind
)
1056 struct i2c_client
*c
;
1057 struct tvp5150
*core
;
1062 "tvp5150.c: detecting tvp5150 client on address 0x%x\n",
1065 client_template
.adapter
= adapter
;
1066 client_template
.addr
= address
;
1068 /* Check if the adapter supports the needed features */
1069 if (!i2c_check_functionality
1071 I2C_FUNC_SMBUS_READ_BYTE
| I2C_FUNC_SMBUS_WRITE_BYTE_DATA
))
1074 c
= kmalloc(sizeof(struct i2c_client
), GFP_KERNEL
);
1077 memcpy(c
, &client_template
, sizeof(struct i2c_client
));
1079 core
= kzalloc(sizeof(struct tvp5150
), GFP_KERNEL
);
1084 i2c_set_clientdata(c
, core
);
1086 rv
= i2c_attach_client(c
);
1088 core
->norm
= V4L2_STD_ALL
; /* Default is autodetect */
1089 core
->route
.input
= TVP5150_COMPOSITE1
;
1092 core
->contrast
= 128;
1107 static int tvp5150_attach_adapter(struct i2c_adapter
*adapter
)
1111 "tvp5150.c: starting probe for adapter %s (0x%x)\n",
1112 adapter
->name
, adapter
->id
);
1113 return i2c_probe(adapter
, &addr_data
, &tvp5150_detect_client
);
1116 static int tvp5150_detach_client(struct i2c_client
*c
)
1118 struct tvp5150
*decoder
= i2c_get_clientdata(c
);
1122 "tvp5150.c: removing tvp5150 adapter on address 0x%x\n",
1125 err
= i2c_detach_client(c
);
1136 /* ----------------------------------------------------------------------- */
1138 static struct i2c_driver driver
= {
1142 .id
= I2C_DRIVERID_TVP5150
,
1144 .attach_adapter
= tvp5150_attach_adapter
,
1145 .detach_client
= tvp5150_detach_client
,
1147 .command
= tvp5150_command
,
1150 static int __init
tvp5150_init(void)
1152 return i2c_add_driver(&driver
);
1155 static void __exit
tvp5150_exit(void)
1157 i2c_del_driver(&driver
);
1160 module_init(tvp5150_init
);
1161 module_exit(tvp5150_exit
);