2 * cx18 ADEC VBI functions
4 * Derived from cx25840-vbi.c
6 * Copyright (C) 2007 Hans Verkuil <hverkuil@xs4all.nl>
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * as published by the Free Software Foundation; either version 2
11 * of the License, or (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
25 #include "cx18-driver.h"
27 static int odd_parity(u8 c
)
36 static int decode_vps(u8
*dst
, u8
*p
)
38 static const u8 biphase_tbl
[] = {
39 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
40 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
41 0xd2, 0x5a, 0x52, 0xd2, 0x96, 0x1e, 0x16, 0x96,
42 0x92, 0x1a, 0x12, 0x92, 0xd2, 0x5a, 0x52, 0xd2,
43 0xd0, 0x58, 0x50, 0xd0, 0x94, 0x1c, 0x14, 0x94,
44 0x90, 0x18, 0x10, 0x90, 0xd0, 0x58, 0x50, 0xd0,
45 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
46 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
47 0xe1, 0x69, 0x61, 0xe1, 0xa5, 0x2d, 0x25, 0xa5,
48 0xa1, 0x29, 0x21, 0xa1, 0xe1, 0x69, 0x61, 0xe1,
49 0xc3, 0x4b, 0x43, 0xc3, 0x87, 0x0f, 0x07, 0x87,
50 0x83, 0x0b, 0x03, 0x83, 0xc3, 0x4b, 0x43, 0xc3,
51 0xc1, 0x49, 0x41, 0xc1, 0x85, 0x0d, 0x05, 0x85,
52 0x81, 0x09, 0x01, 0x81, 0xc1, 0x49, 0x41, 0xc1,
53 0xe1, 0x69, 0x61, 0xe1, 0xa5, 0x2d, 0x25, 0xa5,
54 0xa1, 0x29, 0x21, 0xa1, 0xe1, 0x69, 0x61, 0xe1,
55 0xe0, 0x68, 0x60, 0xe0, 0xa4, 0x2c, 0x24, 0xa4,
56 0xa0, 0x28, 0x20, 0xa0, 0xe0, 0x68, 0x60, 0xe0,
57 0xc2, 0x4a, 0x42, 0xc2, 0x86, 0x0e, 0x06, 0x86,
58 0x82, 0x0a, 0x02, 0x82, 0xc2, 0x4a, 0x42, 0xc2,
59 0xc0, 0x48, 0x40, 0xc0, 0x84, 0x0c, 0x04, 0x84,
60 0x80, 0x08, 0x00, 0x80, 0xc0, 0x48, 0x40, 0xc0,
61 0xe0, 0x68, 0x60, 0xe0, 0xa4, 0x2c, 0x24, 0xa4,
62 0xa0, 0x28, 0x20, 0xa0, 0xe0, 0x68, 0x60, 0xe0,
63 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
64 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
65 0xd2, 0x5a, 0x52, 0xd2, 0x96, 0x1e, 0x16, 0x96,
66 0x92, 0x1a, 0x12, 0x92, 0xd2, 0x5a, 0x52, 0xd2,
67 0xd0, 0x58, 0x50, 0xd0, 0x94, 0x1c, 0x14, 0x94,
68 0x90, 0x18, 0x10, 0x90, 0xd0, 0x58, 0x50, 0xd0,
69 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
70 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
76 for (i
= 0; i
< 2 * 13; i
+= 2) {
77 err
|= biphase_tbl
[p
[i
]] | biphase_tbl
[p
[i
+ 1]];
78 c
= (biphase_tbl
[p
[i
+ 1]] & 0xf) |
79 ((biphase_tbl
[p
[i
]] & 0xf) << 4);
86 int cx18_av_vbi(struct cx18
*cx
, unsigned int cmd
, void *arg
)
88 struct cx18_av_state
*state
= &cx
->av_state
;
89 struct v4l2_format
*fmt
;
90 struct v4l2_sliced_vbi_format
*svbi
;
95 static u16 lcr2vbi
[] = {
96 0, V4L2_SLICED_TELETEXT_B
, 0, /* 1 */
97 0, V4L2_SLICED_WSS_625
, 0, /* 4 */
98 V4L2_SLICED_CAPTION_525
, /* 6 */
99 0, 0, V4L2_SLICED_VPS
, 0, 0, /* 9 */
102 int is_pal
= !(state
->std
& V4L2_STD_525_60
);
106 if (fmt
->type
!= V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
)
108 svbi
= &fmt
->fmt
.sliced
;
109 memset(svbi
, 0, sizeof(*svbi
));
110 /* we're done if raw VBI is active */
111 if ((cx18_av_read(cx
, 0x404) & 0x10) == 0)
115 for (i
= 7; i
<= 23; i
++) {
116 u8 v
= cx18_av_read(cx
, 0x424 + i
- 7);
118 svbi
->service_lines
[0][i
] = lcr2vbi
[v
>> 4];
119 svbi
->service_lines
[1][i
] = lcr2vbi
[v
& 0xf];
120 svbi
->service_set
|= svbi
->service_lines
[0][i
] |
121 svbi
->service_lines
[1][i
];
124 for (i
= 10; i
<= 21; i
++) {
125 u8 v
= cx18_av_read(cx
, 0x424 + i
- 10);
127 svbi
->service_lines
[0][i
] = lcr2vbi
[v
>> 4];
128 svbi
->service_lines
[1][i
] = lcr2vbi
[v
& 0xf];
129 svbi
->service_set
|= svbi
->service_lines
[0][i
] |
130 svbi
->service_lines
[1][i
];
138 int is_pal
= !(state
->std
& V4L2_STD_525_60
);
139 int vbi_offset
= is_pal
? 1 : 0;
144 if (fmt
->type
!= V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
&&
145 fmt
->type
!= V4L2_BUF_TYPE_VBI_CAPTURE
)
147 svbi
= &fmt
->fmt
.sliced
;
148 if (fmt
->type
== V4L2_BUF_TYPE_VBI_CAPTURE
) {
150 memset(svbi
, 0, sizeof(*svbi
));
153 cx18_av_std_setup(cx
);
156 cx18_av_write(cx
, 0x47f, vbi_offset
);
157 cx18_av_write(cx
, 0x404, 0x2e);
161 for (x
= 0; x
<= 23; x
++)
165 cx18_av_std_setup(cx
);
168 cx18_av_write(cx
, 0x404, 0x32); /* Ancillary data */
169 cx18_av_write(cx
, 0x406, 0x13);
170 cx18_av_write(cx
, 0x47f, vbi_offset
);
173 for (i
= 0; i
<= 6; i
++)
174 svbi
->service_lines
[0][i
] =
175 svbi
->service_lines
[1][i
] = 0;
177 for (i
= 0; i
<= 9; i
++)
178 svbi
->service_lines
[0][i
] =
179 svbi
->service_lines
[1][i
] = 0;
181 for (i
= 22; i
<= 23; i
++)
182 svbi
->service_lines
[0][i
] =
183 svbi
->service_lines
[1][i
] = 0;
186 for (i
= 7; i
<= 23; i
++) {
187 for (x
= 0; x
<= 1; x
++) {
188 switch (svbi
->service_lines
[1-x
][i
]) {
189 case V4L2_SLICED_TELETEXT_B
:
190 lcr
[i
] |= 1 << (4 * x
);
192 case V4L2_SLICED_WSS_625
:
193 lcr
[i
] |= 4 << (4 * x
);
195 case V4L2_SLICED_CAPTION_525
:
196 lcr
[i
] |= 6 << (4 * x
);
198 case V4L2_SLICED_VPS
:
199 lcr
[i
] |= 9 << (4 * x
);
206 for (x
= 1, i
= 0x424; i
<= 0x434; i
++, x
++)
207 cx18_av_write(cx
, i
, lcr
[6 + x
]);
209 for (x
= 1, i
= 0x424; i
<= 0x430; i
++, x
++)
210 cx18_av_write(cx
, i
, lcr
[9 + x
]);
211 for (i
= 0x431; i
<= 0x434; i
++)
212 cx18_av_write(cx
, i
, 0);
215 cx18_av_write(cx
, 0x43c, 0x16);
216 cx18_av_write(cx
, 0x474, is_pal
? 0x2a : 0x22);
220 case VIDIOC_INT_DECODE_VBI_LINE
:
222 struct v4l2_decode_vbi_line
*vbi
= arg
;
224 int id1
, id2
, l
, err
= 0;
226 if (p
[0] || p
[1] != 0xff || p
[2] != 0xff ||
227 (p
[3] != 0x55 && p
[3] != 0x91)) {
228 vbi
->line
= vbi
->type
= 0;
236 l
+= state
->vbi_line_offset
;
241 id2
= V4L2_SLICED_TELETEXT_B
;
244 id2
= V4L2_SLICED_WSS_625
;
247 id2
= V4L2_SLICED_CAPTION_525
;
248 err
= !odd_parity(p
[0]) || !odd_parity(p
[1]);
251 id2
= V4L2_SLICED_VPS
;
252 if (decode_vps(p
, p
) != 0)
261 vbi
->type
= err
? 0 : id2
;
262 vbi
->line
= err
? 0 : l
;
263 vbi
->is_second_field
= err
? 0 : (id1
== 0x55);