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/slab.h>
10 #include <linux/videodev2.h>
11 #include <linux/delay.h>
12 #include <media/v4l2-device.h>
13 #include <media/tvp5150.h>
14 #include <media/v4l2-i2c-drv.h>
15 #include <media/v4l2-chip-ident.h>
17 #include "tvp5150_reg.h"
19 MODULE_DESCRIPTION("Texas Instruments TVP5150A video decoder driver");
20 MODULE_AUTHOR("Mauro Carvalho Chehab");
21 MODULE_LICENSE("GPL");
25 module_param(debug
, int, 0);
26 MODULE_PARM_DESC(debug
, "Debug level (0-2)");
28 /* supported controls */
29 static struct v4l2_queryctrl tvp5150_qctrl
[] = {
31 .id
= V4L2_CID_BRIGHTNESS
,
32 .type
= V4L2_CTRL_TYPE_INTEGER
,
40 .id
= V4L2_CID_CONTRAST
,
41 .type
= V4L2_CTRL_TYPE_INTEGER
,
49 .id
= V4L2_CID_SATURATION
,
50 .type
= V4L2_CTRL_TYPE_INTEGER
,
59 .type
= V4L2_CTRL_TYPE_INTEGER
,
70 struct v4l2_subdev sd
;
72 v4l2_std_id norm
; /* Current set standard */
82 static inline struct tvp5150
*to_tvp5150(struct v4l2_subdev
*sd
)
84 return container_of(sd
, struct tvp5150
, sd
);
87 static int tvp5150_read(struct v4l2_subdev
*sd
, unsigned char addr
)
89 struct i2c_client
*c
= v4l2_get_subdevdata(sd
);
90 unsigned char buffer
[1];
94 if (1 != (rc
= i2c_master_send(c
, buffer
, 1)))
95 v4l2_dbg(0, debug
, sd
, "i2c i/o error: rc == %d (should be 1)\n", rc
);
99 if (1 != (rc
= i2c_master_recv(c
, buffer
, 1)))
100 v4l2_dbg(0, debug
, sd
, "i2c i/o error: rc == %d (should be 1)\n", rc
);
102 v4l2_dbg(2, debug
, sd
, "tvp5150: read 0x%02x = 0x%02x\n", addr
, buffer
[0]);
107 static inline void tvp5150_write(struct v4l2_subdev
*sd
, unsigned char addr
,
110 struct i2c_client
*c
= v4l2_get_subdevdata(sd
);
111 unsigned char buffer
[2];
116 v4l2_dbg(2, debug
, sd
, "tvp5150: writing 0x%02x 0x%02x\n", buffer
[0], buffer
[1]);
117 if (2 != (rc
= i2c_master_send(c
, buffer
, 2)))
118 v4l2_dbg(0, debug
, sd
, "i2c i/o error: rc == %d (should be 2)\n", rc
);
121 static void dump_reg_range(struct v4l2_subdev
*sd
, char *s
, u8 init
,
122 const u8 end
, int max_line
)
126 while (init
!= (u8
)(end
+ 1)) {
127 if ((i
% max_line
) == 0) {
130 printk("tvp5150: %s reg 0x%02x = ", s
, init
);
132 printk("%02x ", tvp5150_read(sd
, init
));
140 static int tvp5150_log_status(struct v4l2_subdev
*sd
)
142 printk("tvp5150: Video input source selection #1 = 0x%02x\n",
143 tvp5150_read(sd
, TVP5150_VD_IN_SRC_SEL_1
));
144 printk("tvp5150: Analog channel controls = 0x%02x\n",
145 tvp5150_read(sd
, TVP5150_ANAL_CHL_CTL
));
146 printk("tvp5150: Operation mode controls = 0x%02x\n",
147 tvp5150_read(sd
, TVP5150_OP_MODE_CTL
));
148 printk("tvp5150: Miscellaneous controls = 0x%02x\n",
149 tvp5150_read(sd
, TVP5150_MISC_CTL
));
150 printk("tvp5150: Autoswitch mask= 0x%02x\n",
151 tvp5150_read(sd
, TVP5150_AUTOSW_MSK
));
152 printk("tvp5150: Color killer threshold control = 0x%02x\n",
153 tvp5150_read(sd
, TVP5150_COLOR_KIL_THSH_CTL
));
154 printk("tvp5150: Luminance processing controls #1 #2 and #3 = %02x %02x %02x\n",
155 tvp5150_read(sd
, TVP5150_LUMA_PROC_CTL_1
),
156 tvp5150_read(sd
, TVP5150_LUMA_PROC_CTL_2
),
157 tvp5150_read(sd
, TVP5150_LUMA_PROC_CTL_3
));
158 printk("tvp5150: Brightness control = 0x%02x\n",
159 tvp5150_read(sd
, TVP5150_BRIGHT_CTL
));
160 printk("tvp5150: Color saturation control = 0x%02x\n",
161 tvp5150_read(sd
, TVP5150_SATURATION_CTL
));
162 printk("tvp5150: Hue control = 0x%02x\n",
163 tvp5150_read(sd
, TVP5150_HUE_CTL
));
164 printk("tvp5150: Contrast control = 0x%02x\n",
165 tvp5150_read(sd
, TVP5150_CONTRAST_CTL
));
166 printk("tvp5150: Outputs and data rates select = 0x%02x\n",
167 tvp5150_read(sd
, TVP5150_DATA_RATE_SEL
));
168 printk("tvp5150: Configuration shared pins = 0x%02x\n",
169 tvp5150_read(sd
, TVP5150_CONF_SHARED_PIN
));
170 printk("tvp5150: Active video cropping start = 0x%02x%02x\n",
171 tvp5150_read(sd
, TVP5150_ACT_VD_CROP_ST_MSB
),
172 tvp5150_read(sd
, TVP5150_ACT_VD_CROP_ST_LSB
));
173 printk("tvp5150: Active video cropping stop = 0x%02x%02x\n",
174 tvp5150_read(sd
, TVP5150_ACT_VD_CROP_STP_MSB
),
175 tvp5150_read(sd
, TVP5150_ACT_VD_CROP_STP_LSB
));
176 printk("tvp5150: Genlock/RTC = 0x%02x\n",
177 tvp5150_read(sd
, TVP5150_GENLOCK
));
178 printk("tvp5150: Horizontal sync start = 0x%02x\n",
179 tvp5150_read(sd
, TVP5150_HORIZ_SYNC_START
));
180 printk("tvp5150: Vertical blanking start = 0x%02x\n",
181 tvp5150_read(sd
, TVP5150_VERT_BLANKING_START
));
182 printk("tvp5150: Vertical blanking stop = 0x%02x\n",
183 tvp5150_read(sd
, TVP5150_VERT_BLANKING_STOP
));
184 printk("tvp5150: Chrominance processing control #1 and #2 = %02x %02x\n",
185 tvp5150_read(sd
, TVP5150_CHROMA_PROC_CTL_1
),
186 tvp5150_read(sd
, TVP5150_CHROMA_PROC_CTL_2
));
187 printk("tvp5150: Interrupt reset register B = 0x%02x\n",
188 tvp5150_read(sd
, TVP5150_INT_RESET_REG_B
));
189 printk("tvp5150: Interrupt enable register B = 0x%02x\n",
190 tvp5150_read(sd
, TVP5150_INT_ENABLE_REG_B
));
191 printk("tvp5150: Interrupt configuration register B = 0x%02x\n",
192 tvp5150_read(sd
, TVP5150_INTT_CONFIG_REG_B
));
193 printk("tvp5150: Video standard = 0x%02x\n",
194 tvp5150_read(sd
, TVP5150_VIDEO_STD
));
195 printk("tvp5150: Chroma gain factor: Cb=0x%02x Cr=0x%02x\n",
196 tvp5150_read(sd
, TVP5150_CB_GAIN_FACT
),
197 tvp5150_read(sd
, TVP5150_CR_GAIN_FACTOR
));
198 printk("tvp5150: Macrovision on counter = 0x%02x\n",
199 tvp5150_read(sd
, TVP5150_MACROVISION_ON_CTR
));
200 printk("tvp5150: Macrovision off counter = 0x%02x\n",
201 tvp5150_read(sd
, TVP5150_MACROVISION_OFF_CTR
));
202 printk("tvp5150: ITU-R BT.656.%d timing(TVP5150AM1 only)\n",
203 (tvp5150_read(sd
, TVP5150_REV_SELECT
) & 1) ? 3 : 4);
204 printk("tvp5150: Device ID = %02x%02x\n",
205 tvp5150_read(sd
, TVP5150_MSB_DEV_ID
),
206 tvp5150_read(sd
, TVP5150_LSB_DEV_ID
));
207 printk("tvp5150: ROM version = (hex) %02x.%02x\n",
208 tvp5150_read(sd
, TVP5150_ROM_MAJOR_VER
),
209 tvp5150_read(sd
, TVP5150_ROM_MINOR_VER
));
210 printk("tvp5150: Vertical line count = 0x%02x%02x\n",
211 tvp5150_read(sd
, TVP5150_VERT_LN_COUNT_MSB
),
212 tvp5150_read(sd
, TVP5150_VERT_LN_COUNT_LSB
));
213 printk("tvp5150: Interrupt status register B = 0x%02x\n",
214 tvp5150_read(sd
, TVP5150_INT_STATUS_REG_B
));
215 printk("tvp5150: Interrupt active register B = 0x%02x\n",
216 tvp5150_read(sd
, TVP5150_INT_ACTIVE_REG_B
));
217 printk("tvp5150: Status regs #1 to #5 = %02x %02x %02x %02x %02x\n",
218 tvp5150_read(sd
, TVP5150_STATUS_REG_1
),
219 tvp5150_read(sd
, TVP5150_STATUS_REG_2
),
220 tvp5150_read(sd
, TVP5150_STATUS_REG_3
),
221 tvp5150_read(sd
, TVP5150_STATUS_REG_4
),
222 tvp5150_read(sd
, TVP5150_STATUS_REG_5
));
224 dump_reg_range(sd
, "Teletext filter 1", TVP5150_TELETEXT_FIL1_INI
,
225 TVP5150_TELETEXT_FIL1_END
, 8);
226 dump_reg_range(sd
, "Teletext filter 2", TVP5150_TELETEXT_FIL2_INI
,
227 TVP5150_TELETEXT_FIL2_END
, 8);
229 printk("tvp5150: Teletext filter enable = 0x%02x\n",
230 tvp5150_read(sd
, TVP5150_TELETEXT_FIL_ENA
));
231 printk("tvp5150: Interrupt status register A = 0x%02x\n",
232 tvp5150_read(sd
, TVP5150_INT_STATUS_REG_A
));
233 printk("tvp5150: Interrupt enable register A = 0x%02x\n",
234 tvp5150_read(sd
, TVP5150_INT_ENABLE_REG_A
));
235 printk("tvp5150: Interrupt configuration = 0x%02x\n",
236 tvp5150_read(sd
, TVP5150_INT_CONF
));
237 printk("tvp5150: VDP status register = 0x%02x\n",
238 tvp5150_read(sd
, TVP5150_VDP_STATUS_REG
));
239 printk("tvp5150: FIFO word count = 0x%02x\n",
240 tvp5150_read(sd
, TVP5150_FIFO_WORD_COUNT
));
241 printk("tvp5150: FIFO interrupt threshold = 0x%02x\n",
242 tvp5150_read(sd
, TVP5150_FIFO_INT_THRESHOLD
));
243 printk("tvp5150: FIFO reset = 0x%02x\n",
244 tvp5150_read(sd
, TVP5150_FIFO_RESET
));
245 printk("tvp5150: Line number interrupt = 0x%02x\n",
246 tvp5150_read(sd
, TVP5150_LINE_NUMBER_INT
));
247 printk("tvp5150: Pixel alignment register = 0x%02x%02x\n",
248 tvp5150_read(sd
, TVP5150_PIX_ALIGN_REG_HIGH
),
249 tvp5150_read(sd
, TVP5150_PIX_ALIGN_REG_LOW
));
250 printk("tvp5150: FIFO output control = 0x%02x\n",
251 tvp5150_read(sd
, TVP5150_FIFO_OUT_CTRL
));
252 printk("tvp5150: Full field enable = 0x%02x\n",
253 tvp5150_read(sd
, TVP5150_FULL_FIELD_ENA
));
254 printk("tvp5150: Full field mode register = 0x%02x\n",
255 tvp5150_read(sd
, TVP5150_FULL_FIELD_MODE_REG
));
257 dump_reg_range(sd
, "CC data", TVP5150_CC_DATA_INI
,
258 TVP5150_CC_DATA_END
, 8);
260 dump_reg_range(sd
, "WSS data", TVP5150_WSS_DATA_INI
,
261 TVP5150_WSS_DATA_END
, 8);
263 dump_reg_range(sd
, "VPS data", TVP5150_VPS_DATA_INI
,
264 TVP5150_VPS_DATA_END
, 8);
266 dump_reg_range(sd
, "VITC data", TVP5150_VITC_DATA_INI
,
267 TVP5150_VITC_DATA_END
, 10);
269 dump_reg_range(sd
, "Line mode", TVP5150_LINE_MODE_INI
,
270 TVP5150_LINE_MODE_END
, 8);
274 /****************************************************************************
276 ****************************************************************************/
278 static inline void tvp5150_selmux(struct v4l2_subdev
*sd
)
281 struct tvp5150
*decoder
= to_tvp5150(sd
);
285 if ((decoder
->output
& TVP5150_BLACK_SCREEN
) || !decoder
->enable
)
288 switch (decoder
->input
) {
289 case TVP5150_COMPOSITE1
:
292 case TVP5150_COMPOSITE0
:
293 opmode
=0x30; /* TV Mode */
298 opmode
=0; /* Auto Mode */
302 v4l2_dbg(1, debug
, sd
, "Selecting video route: route input=%i, output=%i "
303 "=> tvp5150 input=%i, opmode=%i\n",
304 decoder
->input
, decoder
->output
,
307 tvp5150_write(sd
, TVP5150_OP_MODE_CTL
, opmode
);
308 tvp5150_write(sd
, TVP5150_VD_IN_SRC_SEL_1
, input
);
310 /* Svideo should enable YCrCb output and disable GPCL output
311 * For Composite and TV, it should be the reverse
313 val
= tvp5150_read(sd
, TVP5150_MISC_CTL
);
314 if (decoder
->input
== TVP5150_SVIDEO
)
315 val
= (val
& ~0x40) | 0x10;
317 val
= (val
& ~0x10) | 0x40;
318 tvp5150_write(sd
, TVP5150_MISC_CTL
, val
);
321 struct i2c_reg_value
{
326 /* Default values as sugested at TVP5150AM1 datasheet */
327 static const struct i2c_reg_value tvp5150_init_default
[] = {
329 TVP5150_VD_IN_SRC_SEL_1
,0x00
332 TVP5150_ANAL_CHL_CTL
,0x15
335 TVP5150_OP_MODE_CTL
,0x00
338 TVP5150_MISC_CTL
,0x01
341 TVP5150_COLOR_KIL_THSH_CTL
,0x10
344 TVP5150_LUMA_PROC_CTL_1
,0x60
347 TVP5150_LUMA_PROC_CTL_2
,0x00
350 TVP5150_BRIGHT_CTL
,0x80
353 TVP5150_SATURATION_CTL
,0x80
359 TVP5150_CONTRAST_CTL
,0x80
362 TVP5150_DATA_RATE_SEL
,0x47
365 TVP5150_LUMA_PROC_CTL_3
,0x00
368 TVP5150_CONF_SHARED_PIN
,0x08
371 TVP5150_ACT_VD_CROP_ST_MSB
,0x00
374 TVP5150_ACT_VD_CROP_ST_LSB
,0x00
377 TVP5150_ACT_VD_CROP_STP_MSB
,0x00
380 TVP5150_ACT_VD_CROP_STP_LSB
,0x00
386 TVP5150_HORIZ_SYNC_START
,0x80
389 TVP5150_VERT_BLANKING_START
,0x00
392 TVP5150_VERT_BLANKING_STOP
,0x00
395 TVP5150_CHROMA_PROC_CTL_1
,0x0c
398 TVP5150_CHROMA_PROC_CTL_2
,0x14
401 TVP5150_INT_RESET_REG_B
,0x00
404 TVP5150_INT_ENABLE_REG_B
,0x00
407 TVP5150_INTT_CONFIG_REG_B
,0x00
410 TVP5150_VIDEO_STD
,0x00
413 TVP5150_MACROVISION_ON_CTR
,0x0f
416 TVP5150_MACROVISION_OFF_CTR
,0x01
419 TVP5150_TELETEXT_FIL_ENA
,0x00
422 TVP5150_INT_STATUS_REG_A
,0x00
425 TVP5150_INT_ENABLE_REG_A
,0x00
428 TVP5150_INT_CONF
,0x04
431 TVP5150_FIFO_INT_THRESHOLD
,0x80
434 TVP5150_FIFO_RESET
,0x00
437 TVP5150_LINE_NUMBER_INT
,0x00
440 TVP5150_PIX_ALIGN_REG_LOW
,0x4e
443 TVP5150_PIX_ALIGN_REG_HIGH
,0x00
446 TVP5150_FIFO_OUT_CTRL
,0x01
449 TVP5150_FULL_FIELD_ENA
,0x00
452 TVP5150_LINE_MODE_INI
,0x00
455 TVP5150_FULL_FIELD_MODE_REG
,0x7f
462 /* Default values as sugested at TVP5150AM1 datasheet */
463 static const struct i2c_reg_value tvp5150_init_enable
[] = {
465 TVP5150_CONF_SHARED_PIN
, 2
466 },{ /* Automatic offset and AGC enabled */
467 TVP5150_ANAL_CHL_CTL
, 0x15
468 },{ /* Activate YCrCb output 0x9 or 0xd ? */
469 TVP5150_MISC_CTL
, 0x6f
470 },{ /* Activates video std autodetection for all standards */
471 TVP5150_AUTOSW_MSK
, 0x0
472 },{ /* Default format: 0x47. For 4:2:2: 0x40 */
473 TVP5150_DATA_RATE_SEL
, 0x47
475 TVP5150_CHROMA_PROC_CTL_1
, 0x0c
477 TVP5150_CHROMA_PROC_CTL_2
, 0x54
478 },{ /* Non documented, but initialized on WinTV USB2 */
485 struct tvp5150_vbi_type
{
486 unsigned int vbi_type
;
487 unsigned int ini_line
;
488 unsigned int end_line
;
489 unsigned int by_field
:1;
492 struct i2c_vbi_ram_value
{
494 struct tvp5150_vbi_type type
;
495 unsigned char values
[16];
498 /* This struct have the values for each supported VBI Standard
500 tvp5150_vbi_types should follow the same order as vbi_ram_default
501 * value 0 means rom position 0x10, value 1 means rom position 0x30
502 * and so on. There are 16 possible locations from 0 to 15.
505 static struct i2c_vbi_ram_value vbi_ram_default
[] =
507 {0x030, /* Teletext, PAL, WST System B */
508 {V4L2_SLICED_TELETEXT_B
,6,22,1},
509 { 0xaa, 0xaa, 0xff, 0xff, 0x27, 0x2e, 0x20, 0x2b,
510 0xa6, 0x72, 0x10, 0x00, 0x00, 0x00, 0x10, 0x00 }
512 {0x0f0, /* Closed Caption, NTSC */
513 {V4L2_SLICED_CAPTION_525
,21,21,1},
514 { 0xaa, 0x2a, 0xff, 0x3f, 0x04, 0x51, 0x6e, 0x02,
515 0x69, 0x8c, 0x09, 0x00, 0x00, 0x00, 0x27, 0x00 }
517 {0x110, /* Wide Screen Signal, PAL/SECAM */
518 {V4L2_SLICED_WSS_625
,23,23,1},
519 { 0x5b, 0x55, 0xc5, 0xff, 0x00, 0x71, 0x6e, 0x42,
520 0xa6, 0xcd, 0x0f, 0x00, 0x00, 0x00, 0x3a, 0x00 }
522 {0x190, /* Video Program System (VPS), PAL */
523 {V4L2_SLICED_VPS
,16,16,0},
524 { 0xaa, 0xaa, 0xff, 0xff, 0xba, 0xce, 0x2b, 0x0d,
525 0xa6, 0xda, 0x0b, 0x00, 0x00, 0x00, 0x60, 0x00 }
527 /* 0x1d0 User programmable */
533 static int tvp5150_write_inittab(struct v4l2_subdev
*sd
,
534 const struct i2c_reg_value
*regs
)
536 while (regs
->reg
!= 0xff) {
537 tvp5150_write(sd
, regs
->reg
, regs
->value
);
543 static int tvp5150_vdp_init(struct v4l2_subdev
*sd
,
544 const struct i2c_vbi_ram_value
*regs
)
548 /* Disable Full Field */
549 tvp5150_write(sd
, TVP5150_FULL_FIELD_ENA
, 0);
551 /* Before programming, Line mode should be at 0xff */
552 for (i
= TVP5150_LINE_MODE_INI
; i
<= TVP5150_LINE_MODE_END
; i
++)
553 tvp5150_write(sd
, i
, 0xff);
556 while (regs
->reg
!= (u16
)-1) {
557 tvp5150_write(sd
, TVP5150_CONF_RAM_ADDR_HIGH
, regs
->reg
>> 8);
558 tvp5150_write(sd
, TVP5150_CONF_RAM_ADDR_LOW
, regs
->reg
);
560 for (i
= 0; i
< 16; i
++)
561 tvp5150_write(sd
, TVP5150_VDP_CONF_RAM_DATA
, regs
->values
[i
]);
568 /* Fills VBI capabilities based on i2c_vbi_ram_value struct */
569 static int tvp5150_g_sliced_vbi_cap(struct v4l2_subdev
*sd
,
570 struct v4l2_sliced_vbi_cap
*cap
)
572 const struct i2c_vbi_ram_value
*regs
= vbi_ram_default
;
575 v4l2_dbg(1, debug
, sd
, "g_sliced_vbi_cap\n");
576 memset(cap
, 0, sizeof *cap
);
578 while (regs
->reg
!= (u16
)-1 ) {
579 for (line
=regs
->type
.ini_line
;line
<=regs
->type
.end_line
;line
++) {
580 cap
->service_lines
[0][line
] |= regs
->type
.vbi_type
;
582 cap
->service_set
|= regs
->type
.vbi_type
;
589 /* Set vbi processing
590 * type - one of tvp5150_vbi_types
591 * line - line to gather data
592 * fields: bit 0 field1, bit 1, field2
593 * flags (default=0xf0) is a bitmask, were set means:
594 * bit 7: enable filtering null bytes on CC
595 * bit 6: send data also to FIFO
596 * bit 5: don't allow data with errors on FIFO
597 * bit 4: enable ECC when possible
598 * pix_align = pix alignment:
602 static int tvp5150_set_vbi(struct v4l2_subdev
*sd
,
603 const struct i2c_vbi_ram_value
*regs
,
604 unsigned int type
,u8 flags
, int line
,
607 struct tvp5150
*decoder
= to_tvp5150(sd
);
608 v4l2_std_id std
= decoder
->norm
;
612 if (std
== V4L2_STD_ALL
) {
613 v4l2_err(sd
, "VBI can't be configured without knowing number of lines\n");
615 } else if (std
& V4L2_STD_625_50
) {
616 /* Don't follow NTSC Line number convension */
623 while (regs
->reg
!= (u16
)-1 ) {
624 if ((type
& regs
->type
.vbi_type
) &&
625 (line
>=regs
->type
.ini_line
) &&
626 (line
<=regs
->type
.end_line
)) {
627 type
=regs
->type
.vbi_type
;
634 if (regs
->reg
== (u16
)-1)
637 type
=pos
| (flags
& 0xf0);
638 reg
=((line
-6)<<1)+TVP5150_LINE_MODE_INI
;
641 tvp5150_write(sd
, reg
, type
);
645 tvp5150_write(sd
, reg
+1, type
);
651 static int tvp5150_get_vbi(struct v4l2_subdev
*sd
,
652 const struct i2c_vbi_ram_value
*regs
, int line
)
654 struct tvp5150
*decoder
= to_tvp5150(sd
);
655 v4l2_std_id std
= decoder
->norm
;
659 if (std
== V4L2_STD_ALL
) {
660 v4l2_err(sd
, "VBI can't be configured without knowing number of lines\n");
662 } else if (std
& V4L2_STD_625_50
) {
663 /* Don't follow NTSC Line number convension */
667 if (line
< 6 || line
> 27)
670 reg
= ((line
- 6) << 1) + TVP5150_LINE_MODE_INI
;
672 pos
= tvp5150_read(sd
, reg
) & 0x0f;
674 type
= regs
[pos
].type
.vbi_type
;
676 pos
= tvp5150_read(sd
, reg
+ 1) & 0x0f;
678 type
|= regs
[pos
].type
.vbi_type
;
683 static int tvp5150_set_std(struct v4l2_subdev
*sd
, v4l2_std_id std
)
685 struct tvp5150
*decoder
= to_tvp5150(sd
);
690 /* First tests should be against specific std */
692 if (std
== V4L2_STD_ALL
) {
693 fmt
= 0; /* Autodetect mode */
694 } else if (std
& V4L2_STD_NTSC_443
) {
696 } else if (std
& V4L2_STD_PAL_M
) {
698 } else if (std
& (V4L2_STD_PAL_N
| V4L2_STD_PAL_Nc
)) {
701 /* Then, test against generic ones */
702 if (std
& V4L2_STD_NTSC
)
704 else if (std
& V4L2_STD_PAL
)
706 else if (std
& V4L2_STD_SECAM
)
710 v4l2_dbg(1, debug
, sd
, "Set video std register to %d.\n", fmt
);
711 tvp5150_write(sd
, TVP5150_VIDEO_STD
, fmt
);
715 static int tvp5150_s_std(struct v4l2_subdev
*sd
, v4l2_std_id std
)
717 struct tvp5150
*decoder
= to_tvp5150(sd
);
719 if (decoder
->norm
== std
)
722 return tvp5150_set_std(sd
, std
);
725 static int tvp5150_reset(struct v4l2_subdev
*sd
, u32 val
)
727 struct tvp5150
*decoder
= to_tvp5150(sd
);
728 u8 msb_id
, lsb_id
, msb_rom
, lsb_rom
;
730 msb_id
= tvp5150_read(sd
, TVP5150_MSB_DEV_ID
);
731 lsb_id
= tvp5150_read(sd
, TVP5150_LSB_DEV_ID
);
732 msb_rom
= tvp5150_read(sd
, TVP5150_ROM_MAJOR_VER
);
733 lsb_rom
= tvp5150_read(sd
, TVP5150_ROM_MINOR_VER
);
735 if (msb_rom
== 4 && lsb_rom
== 0) { /* Is TVP5150AM1 */
736 v4l2_info(sd
, "tvp%02x%02xam1 detected.\n", msb_id
, lsb_id
);
738 /* ITU-T BT.656.4 timing */
739 tvp5150_write(sd
, TVP5150_REV_SELECT
, 0);
741 if (msb_rom
== 3 || lsb_rom
== 0x21) { /* Is TVP5150A */
742 v4l2_info(sd
, "tvp%02x%02xa detected.\n", msb_id
, lsb_id
);
744 v4l2_info(sd
, "*** unknown tvp%02x%02x chip detected.\n",
746 v4l2_info(sd
, "*** Rom ver is %d.%d\n", msb_rom
, lsb_rom
);
750 /* Initializes TVP5150 to its default values */
751 tvp5150_write_inittab(sd
, tvp5150_init_default
);
753 /* Initializes VDP registers */
754 tvp5150_vdp_init(sd
, vbi_ram_default
);
756 /* Selects decoder input */
759 /* Initializes TVP5150 to stream enabled values */
760 tvp5150_write_inittab(sd
, tvp5150_init_enable
);
762 /* Initialize image preferences */
763 tvp5150_write(sd
, TVP5150_BRIGHT_CTL
, decoder
->bright
);
764 tvp5150_write(sd
, TVP5150_CONTRAST_CTL
, decoder
->contrast
);
765 tvp5150_write(sd
, TVP5150_SATURATION_CTL
, decoder
->contrast
);
766 tvp5150_write(sd
, TVP5150_HUE_CTL
, decoder
->hue
);
768 tvp5150_set_std(sd
, decoder
->norm
);
772 static int tvp5150_g_ctrl(struct v4l2_subdev
*sd
, struct v4l2_control
*ctrl
)
774 v4l2_dbg(1, debug
, sd
, "g_ctrl called\n");
777 case V4L2_CID_BRIGHTNESS
:
778 ctrl
->value
= tvp5150_read(sd
, TVP5150_BRIGHT_CTL
);
780 case V4L2_CID_CONTRAST
:
781 ctrl
->value
= tvp5150_read(sd
, TVP5150_CONTRAST_CTL
);
783 case V4L2_CID_SATURATION
:
784 ctrl
->value
= tvp5150_read(sd
, TVP5150_SATURATION_CTL
);
787 ctrl
->value
= tvp5150_read(sd
, TVP5150_HUE_CTL
);
793 static int tvp5150_s_ctrl(struct v4l2_subdev
*sd
, struct v4l2_control
*ctrl
)
796 n
= ARRAY_SIZE(tvp5150_qctrl
);
798 for (i
= 0; i
< n
; i
++) {
799 if (ctrl
->id
!= tvp5150_qctrl
[i
].id
)
801 if (ctrl
->value
< tvp5150_qctrl
[i
].minimum
||
802 ctrl
->value
> tvp5150_qctrl
[i
].maximum
)
804 v4l2_dbg(1, debug
, sd
, "s_ctrl: id=%d, value=%d\n",
805 ctrl
->id
, ctrl
->value
);
810 case V4L2_CID_BRIGHTNESS
:
811 tvp5150_write(sd
, TVP5150_BRIGHT_CTL
, ctrl
->value
);
813 case V4L2_CID_CONTRAST
:
814 tvp5150_write(sd
, TVP5150_CONTRAST_CTL
, ctrl
->value
);
816 case V4L2_CID_SATURATION
:
817 tvp5150_write(sd
, TVP5150_SATURATION_CTL
, ctrl
->value
);
820 tvp5150_write(sd
, TVP5150_HUE_CTL
, ctrl
->value
);
826 /****************************************************************************
828 ****************************************************************************/
830 static int tvp5150_s_routing(struct v4l2_subdev
*sd
,
831 u32 input
, u32 output
, u32 config
)
833 struct tvp5150
*decoder
= to_tvp5150(sd
);
835 decoder
->input
= input
;
836 decoder
->output
= output
;
841 static int tvp5150_s_raw_fmt(struct v4l2_subdev
*sd
, struct v4l2_vbi_format
*fmt
)
843 /* this is for capturing 36 raw vbi lines
844 if there's a way to cut off the beginning 2 vbi lines
845 with the tvp5150 then the vbi line count could be lowered
846 to 17 lines/field again, although I couldn't find a register
847 which could do that cropping */
848 if (fmt
->sample_format
== V4L2_PIX_FMT_GREY
)
849 tvp5150_write(sd
, TVP5150_LUMA_PROC_CTL_1
, 0x70);
850 if (fmt
->count
[0] == 18 && fmt
->count
[1] == 18) {
851 tvp5150_write(sd
, TVP5150_VERT_BLANKING_START
, 0x00);
852 tvp5150_write(sd
, TVP5150_VERT_BLANKING_STOP
, 0x01);
857 static int tvp5150_s_sliced_fmt(struct v4l2_subdev
*sd
, struct v4l2_sliced_vbi_format
*svbi
)
861 if (svbi
->service_set
!= 0) {
862 for (i
= 0; i
<= 23; i
++) {
863 svbi
->service_lines
[1][i
] = 0;
864 svbi
->service_lines
[0][i
] =
865 tvp5150_set_vbi(sd
, vbi_ram_default
,
866 svbi
->service_lines
[0][i
], 0xf0, i
, 3);
869 tvp5150_write(sd
, TVP5150_FIFO_OUT_CTRL
, 1);
872 tvp5150_write(sd
, TVP5150_FIFO_OUT_CTRL
, 0);
874 /* Disable Full Field */
875 tvp5150_write(sd
, TVP5150_FULL_FIELD_ENA
, 0);
877 /* Disable Line modes */
878 for (i
= TVP5150_LINE_MODE_INI
; i
<= TVP5150_LINE_MODE_END
; i
++)
879 tvp5150_write(sd
, i
, 0xff);
884 static int tvp5150_g_sliced_fmt(struct v4l2_subdev
*sd
, struct v4l2_sliced_vbi_format
*svbi
)
888 memset(svbi
, 0, sizeof(*svbi
));
890 for (i
= 0; i
<= 23; i
++) {
891 svbi
->service_lines
[0][i
] =
892 tvp5150_get_vbi(sd
, vbi_ram_default
, i
);
893 mask
|= svbi
->service_lines
[0][i
];
895 svbi
->service_set
= mask
;
899 static int tvp5150_g_chip_ident(struct v4l2_subdev
*sd
,
900 struct v4l2_dbg_chip_ident
*chip
)
903 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
905 rev
= tvp5150_read(sd
, TVP5150_ROM_MAJOR_VER
) << 8 |
906 tvp5150_read(sd
, TVP5150_ROM_MINOR_VER
);
908 return v4l2_chip_ident_i2c_client(client
, chip
, V4L2_IDENT_TVP5150
,
913 #ifdef CONFIG_VIDEO_ADV_DEBUG
914 static int tvp5150_g_register(struct v4l2_subdev
*sd
, struct v4l2_dbg_register
*reg
)
916 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
918 if (!v4l2_chip_match_i2c_client(client
, ®
->match
))
920 if (!capable(CAP_SYS_ADMIN
))
922 reg
->val
= tvp5150_read(sd
, reg
->reg
& 0xff);
927 static int tvp5150_s_register(struct v4l2_subdev
*sd
, struct v4l2_dbg_register
*reg
)
929 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
931 if (!v4l2_chip_match_i2c_client(client
, ®
->match
))
933 if (!capable(CAP_SYS_ADMIN
))
935 tvp5150_write(sd
, reg
->reg
& 0xff, reg
->val
& 0xff);
940 static int tvp5150_g_tuner(struct v4l2_subdev
*sd
, struct v4l2_tuner
*vt
)
942 int status
= tvp5150_read(sd
, 0x88);
944 vt
->signal
= ((status
& 0x04) && (status
& 0x02)) ? 0xffff : 0x0;
948 static int tvp5150_queryctrl(struct v4l2_subdev
*sd
, struct v4l2_queryctrl
*qc
)
952 v4l2_dbg(1, debug
, sd
, "queryctrl called\n");
954 for (i
= 0; i
< ARRAY_SIZE(tvp5150_qctrl
); i
++)
955 if (qc
->id
&& qc
->id
== tvp5150_qctrl
[i
].id
) {
956 memcpy(qc
, &(tvp5150_qctrl
[i
]),
964 /* ----------------------------------------------------------------------- */
966 static const struct v4l2_subdev_core_ops tvp5150_core_ops
= {
967 .log_status
= tvp5150_log_status
,
968 .g_ctrl
= tvp5150_g_ctrl
,
969 .s_ctrl
= tvp5150_s_ctrl
,
970 .queryctrl
= tvp5150_queryctrl
,
971 .s_std
= tvp5150_s_std
,
972 .reset
= tvp5150_reset
,
973 .g_chip_ident
= tvp5150_g_chip_ident
,
974 #ifdef CONFIG_VIDEO_ADV_DEBUG
975 .g_register
= tvp5150_g_register
,
976 .s_register
= tvp5150_s_register
,
980 static const struct v4l2_subdev_tuner_ops tvp5150_tuner_ops
= {
981 .g_tuner
= tvp5150_g_tuner
,
984 static const struct v4l2_subdev_video_ops tvp5150_video_ops
= {
985 .s_routing
= tvp5150_s_routing
,
988 static const struct v4l2_subdev_vbi_ops tvp5150_vbi_ops
= {
989 .g_sliced_vbi_cap
= tvp5150_g_sliced_vbi_cap
,
990 .g_sliced_fmt
= tvp5150_g_sliced_fmt
,
991 .s_sliced_fmt
= tvp5150_s_sliced_fmt
,
992 .s_raw_fmt
= tvp5150_s_raw_fmt
,
995 static const struct v4l2_subdev_ops tvp5150_ops
= {
996 .core
= &tvp5150_core_ops
,
997 .tuner
= &tvp5150_tuner_ops
,
998 .video
= &tvp5150_video_ops
,
999 .vbi
= &tvp5150_vbi_ops
,
1003 /****************************************************************************
1005 ****************************************************************************/
1007 static int tvp5150_probe(struct i2c_client
*c
,
1008 const struct i2c_device_id
*id
)
1010 struct tvp5150
*core
;
1011 struct v4l2_subdev
*sd
;
1013 /* Check if the adapter supports the needed features */
1014 if (!i2c_check_functionality(c
->adapter
,
1015 I2C_FUNC_SMBUS_READ_BYTE
| I2C_FUNC_SMBUS_WRITE_BYTE_DATA
))
1018 core
= kzalloc(sizeof(struct tvp5150
), GFP_KERNEL
);
1023 v4l2_i2c_subdev_init(sd
, c
, &tvp5150_ops
);
1024 v4l_info(c
, "chip found @ 0x%02x (%s)\n",
1025 c
->addr
<< 1, c
->adapter
->name
);
1027 core
->norm
= V4L2_STD_ALL
; /* Default is autodetect */
1028 core
->input
= TVP5150_COMPOSITE1
;
1031 core
->contrast
= 128;
1036 tvp5150_log_status(sd
);
1040 static int tvp5150_remove(struct i2c_client
*c
)
1042 struct v4l2_subdev
*sd
= i2c_get_clientdata(c
);
1044 v4l2_dbg(1, debug
, sd
,
1045 "tvp5150.c: removing tvp5150 adapter on address 0x%x\n",
1048 v4l2_device_unregister_subdev(sd
);
1049 kfree(to_tvp5150(sd
));
1053 /* ----------------------------------------------------------------------- */
1055 static const struct i2c_device_id tvp5150_id
[] = {
1059 MODULE_DEVICE_TABLE(i2c
, tvp5150_id
);
1061 static struct v4l2_i2c_driver_data v4l2_i2c_data
= {
1063 .probe
= tvp5150_probe
,
1064 .remove
= tvp5150_remove
,
1065 .id_table
= tvp5150_id
,