1 /* cx25840 VBI functions
3 * This program is free software; you can redistribute it and/or
4 * modify it under the terms of the GNU General Public License
5 * as published by the Free Software Foundation; either version 2
6 * of the License, or (at your option) any later version.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
13 * You should have received a copy of the GNU General Public License
14 * along with this program; if not, write to the Free Software
15 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
19 #include <linux/videodev2.h>
20 #include <linux/i2c.h>
21 #include <media/v4l2-common.h>
22 #include <media/cx25840.h>
24 #include "cx25840-core.h"
26 static int odd_parity(u8 c
)
35 static int decode_vps(u8
* dst
, u8
* p
)
37 static const u8 biphase_tbl
[] = {
38 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
39 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
40 0xd2, 0x5a, 0x52, 0xd2, 0x96, 0x1e, 0x16, 0x96,
41 0x92, 0x1a, 0x12, 0x92, 0xd2, 0x5a, 0x52, 0xd2,
42 0xd0, 0x58, 0x50, 0xd0, 0x94, 0x1c, 0x14, 0x94,
43 0x90, 0x18, 0x10, 0x90, 0xd0, 0x58, 0x50, 0xd0,
44 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
45 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
46 0xe1, 0x69, 0x61, 0xe1, 0xa5, 0x2d, 0x25, 0xa5,
47 0xa1, 0x29, 0x21, 0xa1, 0xe1, 0x69, 0x61, 0xe1,
48 0xc3, 0x4b, 0x43, 0xc3, 0x87, 0x0f, 0x07, 0x87,
49 0x83, 0x0b, 0x03, 0x83, 0xc3, 0x4b, 0x43, 0xc3,
50 0xc1, 0x49, 0x41, 0xc1, 0x85, 0x0d, 0x05, 0x85,
51 0x81, 0x09, 0x01, 0x81, 0xc1, 0x49, 0x41, 0xc1,
52 0xe1, 0x69, 0x61, 0xe1, 0xa5, 0x2d, 0x25, 0xa5,
53 0xa1, 0x29, 0x21, 0xa1, 0xe1, 0x69, 0x61, 0xe1,
54 0xe0, 0x68, 0x60, 0xe0, 0xa4, 0x2c, 0x24, 0xa4,
55 0xa0, 0x28, 0x20, 0xa0, 0xe0, 0x68, 0x60, 0xe0,
56 0xc2, 0x4a, 0x42, 0xc2, 0x86, 0x0e, 0x06, 0x86,
57 0x82, 0x0a, 0x02, 0x82, 0xc2, 0x4a, 0x42, 0xc2,
58 0xc0, 0x48, 0x40, 0xc0, 0x84, 0x0c, 0x04, 0x84,
59 0x80, 0x08, 0x00, 0x80, 0xc0, 0x48, 0x40, 0xc0,
60 0xe0, 0x68, 0x60, 0xe0, 0xa4, 0x2c, 0x24, 0xa4,
61 0xa0, 0x28, 0x20, 0xa0, 0xe0, 0x68, 0x60, 0xe0,
62 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
63 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
64 0xd2, 0x5a, 0x52, 0xd2, 0x96, 0x1e, 0x16, 0x96,
65 0x92, 0x1a, 0x12, 0x92, 0xd2, 0x5a, 0x52, 0xd2,
66 0xd0, 0x58, 0x50, 0xd0, 0x94, 0x1c, 0x14, 0x94,
67 0x90, 0x18, 0x10, 0x90, 0xd0, 0x58, 0x50, 0xd0,
68 0xf0, 0x78, 0x70, 0xf0, 0xb4, 0x3c, 0x34, 0xb4,
69 0xb0, 0x38, 0x30, 0xb0, 0xf0, 0x78, 0x70, 0xf0,
75 for (i
= 0; i
< 2 * 13; i
+= 2) {
76 err
|= biphase_tbl
[p
[i
]] | biphase_tbl
[p
[i
+ 1]];
77 c
= (biphase_tbl
[p
[i
+ 1]] & 0xf) |
78 ((biphase_tbl
[p
[i
]] & 0xf) << 4);
85 void cx25840_vbi_setup(struct i2c_client
*client
)
87 struct cx25840_state
*state
= i2c_get_clientdata(client
);
88 v4l2_std_id std
= cx25840_get_v4lstd(client
);
89 int hblank
,hactive
,burst
,vblank
,vactive
,sc
,vblank656
,src_decimation
;
90 int luma_lpf
,uv_lpf
, comb
;
91 u32 pll_int
,pll_frac
,pll_post
;
93 /* datasheet startup, step 8d */
94 if (std
& ~V4L2_STD_NTSC
) {
95 cx25840_write(client
, 0x49f, 0x11);
97 cx25840_write(client
, 0x49f, 0x14);
100 if (std
& V4L2_STD_625_50
) {
107 src_decimation
=0x21f;
110 if (std
& V4L2_STD_SECAM
) {
126 src_decimation
=0x21f;
127 if (std
== V4L2_STD_PAL_M
) {
143 /* DEBUG: Displays configured PLL frequency */
144 pll_int
=cx25840_read(client
, 0x108);
145 pll_frac
=cx25840_read4(client
, 0x10c)&0x1ffffff;
146 pll_post
=cx25840_read(client
, 0x109);
147 v4l_dbg(1, cx25840_debug
, client
,
148 "PLL regs = int: %u, frac: %u, post: %u\n",
149 pll_int
,pll_frac
,pll_post
);
153 int pll
= (28636363L*((((u64
)pll_int
)<<25L)+pll_frac
)) >>25L;
156 v4l_dbg(1, cx25840_debug
, client
, "PLL = %d.%06d MHz\n",
157 pll
/1000000, pll
%1000000);
158 v4l_dbg(1, cx25840_debug
, client
, "PLL/8 = %d.%06d MHz\n",
159 pll
/8000000, (pll
/8)%1000000);
161 fin
=((u64
)src_decimation
*pll
)>>12;
162 v4l_dbg(1, cx25840_debug
, client
, "ADC Sampling freq = "
164 fin
/1000000,fin
%1000000);
166 fsc
= (((u64
)sc
)*pll
) >> 24L;
167 v4l_dbg(1, cx25840_debug
, client
, "Chroma sub-carrier freq = "
169 fsc
/1000000,fsc
%1000000);
171 v4l_dbg(1, cx25840_debug
, client
, "hblank %i, hactive %i, "
172 "vblank %i , vactive %i, vblank656 %i, src_dec %i,"
173 "burst 0x%02x, luma_lpf %i, uv_lpf %i, comb 0x%02x,"
175 hblank
, hactive
, vblank
, vactive
, vblank656
,
176 src_decimation
, burst
, luma_lpf
, uv_lpf
, comb
, sc
);
179 /* Sets horizontal blanking delay and active lines */
180 cx25840_write(client
, 0x470, hblank
);
181 cx25840_write(client
, 0x471, 0xff&(((hblank
>>8)&0x3)|(hactive
<<4)));
182 cx25840_write(client
, 0x472, hactive
>>4);
184 /* Sets burst gate delay */
185 cx25840_write(client
, 0x473, burst
);
187 /* Sets vertical blanking delay and active duration */
188 cx25840_write(client
, 0x474, vblank
);
189 cx25840_write(client
, 0x475, 0xff&(((vblank
>>8)&0x3)|(vactive
<<4)));
190 cx25840_write(client
, 0x476, vactive
>>4);
191 cx25840_write(client
, 0x477, vblank656
);
193 /* Sets src decimation rate */
194 cx25840_write(client
, 0x478, 0xff&src_decimation
);
195 cx25840_write(client
, 0x479, 0xff&(src_decimation
>>8));
197 /* Sets Luma and UV Low pass filters */
198 cx25840_write(client
, 0x47a, luma_lpf
<<6|((uv_lpf
<<4)&0x30));
200 /* Enables comb filters */
201 cx25840_write(client
, 0x47b, comb
);
204 cx25840_write(client
, 0x47c, sc
);
205 cx25840_write(client
, 0x47d, 0xff&sc
>>8);
206 cx25840_write(client
, 0x47e, 0xff&sc
>>16);
208 /* Sets VBI parameters */
209 if (std
& V4L2_STD_625_50
) {
210 cx25840_write(client
, 0x47f, 0x01);
211 state
->vbi_line_offset
= 5;
213 cx25840_write(client
, 0x47f, 0x00);
214 state
->vbi_line_offset
= 8;
218 int cx25840_vbi(struct i2c_client
*client
, unsigned int cmd
, void *arg
)
220 struct cx25840_state
*state
= i2c_get_clientdata(client
);
221 struct v4l2_format
*fmt
;
222 struct v4l2_sliced_vbi_format
*svbi
;
227 static u16 lcr2vbi
[] = {
228 0, V4L2_SLICED_TELETEXT_B
, 0, /* 1 */
229 0, V4L2_SLICED_WSS_625
, 0, /* 4 */
230 V4L2_SLICED_CAPTION_525
, /* 6 */
231 0, 0, V4L2_SLICED_VPS
, 0, 0, /* 9 */
237 if (fmt
->type
!= V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
)
239 svbi
= &fmt
->fmt
.sliced
;
240 memset(svbi
, 0, sizeof(*svbi
));
241 /* we're done if raw VBI is active */
242 if ((cx25840_read(client
, 0x404) & 0x10) == 0)
245 for (i
= 7; i
<= 23; i
++) {
246 u8 v
= cx25840_read(client
, 0x424 + i
- 7);
248 svbi
->service_lines
[0][i
] = lcr2vbi
[v
>> 4];
249 svbi
->service_lines
[1][i
] = lcr2vbi
[v
& 0xf];
251 svbi
->service_lines
[0][i
] | svbi
->service_lines
[1][i
];
258 int is_pal
= !(cx25840_get_v4lstd(client
) & V4L2_STD_525_60
);
259 int vbi_offset
= is_pal
? 1 : 0;
264 if (fmt
->type
!= V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
)
266 svbi
= &fmt
->fmt
.sliced
;
267 if (svbi
->service_set
== 0) {
269 memset(svbi
, 0, sizeof(*svbi
));
272 cx25840_vbi_setup(client
);
275 cx25840_write(client
, 0x47f, vbi_offset
);
276 cx25840_write(client
, 0x404, 0x2e);
280 for (x
= 0; x
<= 23; x
++)
284 cx25840_vbi_setup(client
);
287 cx25840_write(client
, 0x404, 0x32); /* Ancillary data */
288 cx25840_write(client
, 0x406, 0x13);
289 cx25840_write(client
, 0x47f, vbi_offset
);
292 for (i
= 0; i
<= 6; i
++)
293 svbi
->service_lines
[0][i
] =
294 svbi
->service_lines
[1][i
] = 0;
296 for (i
= 0; i
<= 9; i
++)
297 svbi
->service_lines
[0][i
] =
298 svbi
->service_lines
[1][i
] = 0;
300 for (i
= 22; i
<= 23; i
++)
301 svbi
->service_lines
[0][i
] =
302 svbi
->service_lines
[1][i
] = 0;
305 for (i
= 7; i
<= 23; i
++) {
306 for (x
= 0; x
<= 1; x
++) {
307 switch (svbi
->service_lines
[1-x
][i
]) {
308 case V4L2_SLICED_TELETEXT_B
:
309 lcr
[i
] |= 1 << (4 * x
);
311 case V4L2_SLICED_WSS_625
:
312 lcr
[i
] |= 4 << (4 * x
);
314 case V4L2_SLICED_CAPTION_525
:
315 lcr
[i
] |= 6 << (4 * x
);
317 case V4L2_SLICED_VPS
:
318 lcr
[i
] |= 9 << (4 * x
);
325 for (x
= 1, i
= 0x424; i
<= 0x434; i
++, x
++) {
326 cx25840_write(client
, i
, lcr
[6 + x
]);
330 for (x
= 1, i
= 0x424; i
<= 0x430; i
++, x
++) {
331 cx25840_write(client
, i
, lcr
[9 + x
]);
333 for (i
= 0x431; i
<= 0x434; i
++) {
334 cx25840_write(client
, i
, 0);
338 cx25840_write(client
, 0x43c, 0x16);
341 cx25840_write(client
, 0x474, 0x2a);
343 cx25840_write(client
, 0x474, 0x22);
348 case VIDIOC_INT_DECODE_VBI_LINE
:
350 struct v4l2_decode_vbi_line
*vbi
= arg
;
352 int id1
, id2
, l
, err
= 0;
354 if (p
[0] || p
[1] != 0xff || p
[2] != 0xff ||
355 (p
[3] != 0x55 && p
[3] != 0x91)) {
356 vbi
->line
= vbi
->type
= 0;
364 l
+= state
->vbi_line_offset
;
369 id2
= V4L2_SLICED_TELETEXT_B
;
372 id2
= V4L2_SLICED_WSS_625
;
375 id2
= V4L2_SLICED_CAPTION_525
;
376 err
= !odd_parity(p
[0]) || !odd_parity(p
[1]);
379 id2
= V4L2_SLICED_VPS
;
380 if (decode_vps(p
, p
) != 0) {
390 vbi
->type
= err
? 0 : id2
;
391 vbi
->line
= err
? 0 : l
;
392 vbi
->is_second_field
= err
? 0 : (id1
== 0x55);