23899
|
1 /*
|
|
2 * Teletext support
|
|
3 * Copyright (C) 2007 Vladimir Voroshilov <voroshil@gmail.com>
|
|
4 *
|
|
5 * This file is part of MPlayer.
|
|
6 *
|
|
7 * MPlayer is free software; you can redistribute it and/or modify
|
|
8 * it under the terms of the GNU General Public License as published by
|
|
9 * the Free Software Foundation; either version 2 of the License, or
|
|
10 * (at your option) any later version.
|
|
11 *
|
|
12 * MPlayer is distributed in the hope that it will be useful,
|
|
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
15 * GNU General Public License for more details.
|
|
16 *
|
|
17 * You should have received a copy of the GNU General Public License
|
|
18 * along with MPlayer; if not, write to the Free Software
|
|
19 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
|
20 *
|
|
21 *
|
|
22 * Based on Attila Otvos' teletext patch, Michael Niedermayer's
|
|
23 * proof-of-concept teletext capture utility and some parts
|
|
24 * (decode_raw_line_runin,pll_add,pll_reset) of MythTV project.
|
|
25 *
|
|
26 *
|
|
27 * Some implementation details:
|
|
28 * How to port teletext to another tvi_* driver (see tvi_v4l2.c for example):
|
|
29 *
|
|
30 * 1. Implement TVI_CONTROL_VBI_INIT (initialize driver-related vbi subsystem,
|
|
31 * start grabbing thread)
|
|
32 * input data: vbi device name.
|
|
33 * (driver should also call TV_VBI_CONTROL_START for common vbi subsystem initialization
|
|
34 * with pointer to initialized tt_stream_properties structure.
|
|
35 * After ioctl call variable will contain pointer to initialized priv_vbi_t structure.
|
|
36 *
|
|
37 * 2. After receiving next chunk of raw vbi data call TV_VBI_CONTROL_DECODE_PAGE
|
|
38 * ioctl with pointer to data buffer
|
|
39 * 3. pass all other VBI related ioctl cmds to teletext_control routine
|
|
40 *
|
|
41 * Page displaying process consist of following stages:
|
|
42 *
|
|
43 * ---grabbing stage---
|
|
44 * 0. stream/tvi_*.c: vbi_grabber(...)
|
|
45 * getting vbi data from video device
|
|
46 * ---decoding stage---
|
|
47 * 1. stream/tvi_vbi.c: decode_raw_line_runin(...) or decode_raw_line_sine(...)
|
|
48 * decode raw vbi data into sliced 45(?) bytes long packets
|
|
49 * 2. stream/tvi_vbi.c: decode_pkt0(...), decode_pkt_page(...)
|
|
50 * packets processing (header analyzing, storing complete page in cache,
|
|
51 * only raw member of tt_char is filled at this stage)
|
|
52 * 3. stream/tvi_vbi.c: decode_page(...)
|
|
53 * page decoding. filling unicode,gfx,ctl,etc members of tt_char structure
|
|
54 * with appropriate values according to teletext control chars, converting
|
|
55 * text to utf8.
|
|
56 * ---rendering stage---
|
|
57 * 4. stream/tvi_vbi.c: prepare_visible_page(...)
|
|
58 * processing page. adding number of just received by background process
|
|
59 * teletext page, adding current time,etc.
|
|
60 * 5. libvo/sub.c: vo_update_text_teletext(...)
|
|
61 * rendering displayable osd with text and graphics
|
|
62 *
|
|
63 * TODO:
|
|
64 * v4lv1,bktr support
|
|
65 * spu rendering
|
|
66 * is better quality on poor signal possible ?
|
|
67 * link support
|
|
68 * font autoscale
|
|
69 * greyscale osd
|
|
70 * slave command for dumping pages
|
|
71 * fix bcd<->dec as suggested my Michael
|
|
72 *
|
|
73 * BUGS:
|
|
74 * wrong colors in debug dump
|
|
75 * blinking when visible page was just updated
|
|
76 */
|
|
77
|
|
78 #include "config.h"
|
|
79
|
|
80 #include <stdlib.h>
|
|
81 #include <string.h>
|
|
82 #include <unistd.h>
|
|
83 #include <errno.h>
|
|
84 #include <math.h>
|
|
85 #include <stdio.h>
|
|
86
|
|
87 #include <pthread.h>
|
|
88
|
|
89 #include "tv.h"
|
|
90 #include "mp_msg.h"
|
|
91 #include "help_mp.h"
|
|
92 #include "libmpcodecs/img_format.h"
|
|
93 #include "libavutil/common.h"
|
|
94 #include "input/input.h"
|
|
95
|
|
96 //#define DEBUG_DUMP 1
|
|
97
|
|
98 /// page magazine entry structure
|
|
99 typedef struct mag_s{
|
|
100 tt_page* pt;
|
|
101 int order;
|
|
102 int lang;
|
|
103 } mag_t;
|
|
104
|
|
105 typedef struct {
|
|
106 int on; ///< teletext on/off
|
|
107 int pagenum; ///< seek page number
|
|
108 int subpagenum; ///< seek subpage
|
|
109 int curr_pagenum; ///< current page number
|
|
110 int pagenumdec; ///< set page num with dec
|
|
111
|
|
112 teletext_format tformat; ///< see teletext_format enum
|
|
113 teletext_zoom zoom; ///< see teletext_zoom enum
|
|
114 mag_t* mag; ///< pages magazine (has 8 entities)
|
|
115 /// Currently displayed page (with additional info, e.g current time)
|
|
116 tt_char display_page[VBI_ROWS*VBI_COLUMNS];
|
|
117 /// number of raw bytes between two subsequent encoded bits
|
|
118 int bpb;
|
|
119 /// clock run-in sequence will be searched in buffer in [soc:eoc] bytes range
|
|
120 int soc;
|
|
121 int eoc;
|
|
122 /// minimum number of raw vbi bytes wich can be decoded into 8 data bits
|
|
123 int bp8bl;
|
|
124 /// maximum number of raw vbi bytes wich can be decoded into 8 data bits
|
|
125 int bp8bh;
|
|
126
|
|
127 int pll_adj;
|
|
128 int pll_dir;
|
|
129 int pll_cnt;
|
|
130 int pll_err;
|
|
131 int pll_lerr;
|
|
132 int pll_fixed;
|
|
133 /// vbi stream properties (buffer size,bytes per line, etc)
|
|
134 tt_stream_props* ptsp;
|
|
135 pthread_mutex_t buffer_mutex;
|
|
136
|
|
137 tt_page** ptt_cache;
|
|
138 unsigned char* ptt_cache_first_subpage;
|
|
139 } priv_vbi_t;
|
|
140
|
|
141 static unsigned char fixParity[256];
|
|
142
|
|
143 static tt_char tt_space={0x20,7,0,0,0,0,0x20};
|
|
144 static tt_char tt_error={'?',1,0,0,0,0,'?'}; // Red '?' on black background
|
|
145 static double si[12];
|
|
146 static double co[12];
|
|
147
|
|
148 #define VBI_FORMAT(priv) (*(priv->ptsp))
|
|
149
|
|
150 #define FIXP_SH 16
|
|
151 #define ONE_FIXP (1<<FIXP_SH)
|
|
152 #define FIXP2INT(a) ((a)>>FIXP_SH)
|
|
153 #define ANY2FIXP(a) ((int)((a)*ONE_FIXP))
|
|
154
|
|
155 static const unsigned char corrHamm48[256]={
|
|
156 0x01, 0xff, 0x01, 0x01, 0xff, 0x00, 0x01, 0xff,
|
|
157 0xff, 0x02, 0x01, 0xff, 0x0a, 0xff, 0xff, 0x07,
|
|
158 0xff, 0x00, 0x01, 0xff, 0x00, 0x00, 0xff, 0x00,
|
|
159 0x06, 0xff, 0xff, 0x0b, 0xff, 0x00, 0x03, 0xff,
|
|
160 0xff, 0x0c, 0x01, 0xff, 0x04, 0xff, 0xff, 0x07,
|
|
161 0x06, 0xff, 0xff, 0x07, 0xff, 0x07, 0x07, 0x07,
|
|
162 0x06, 0xff, 0xff, 0x05, 0xff, 0x00, 0x0d, 0xff,
|
|
163 0x06, 0x06, 0x06, 0xff, 0x06, 0xff, 0xff, 0x07,
|
|
164 0xff, 0x02, 0x01, 0xff, 0x04, 0xff, 0xff, 0x09,
|
|
165 0x02, 0x02, 0xff, 0x02, 0xff, 0x02, 0x03, 0xff,
|
|
166 0x08, 0xff, 0xff, 0x05, 0xff, 0x00, 0x03, 0xff,
|
|
167 0xff, 0x02, 0x03, 0xff, 0x03, 0xff, 0x03, 0x03,
|
|
168 0x04, 0xff, 0xff, 0x05, 0x04, 0x04, 0x04, 0xff,
|
|
169 0xff, 0x02, 0x0f, 0xff, 0x04, 0xff, 0xff, 0x07,
|
|
170 0xff, 0x05, 0x05, 0x05, 0x04, 0xff, 0xff, 0x05,
|
|
171 0x06, 0xff, 0xff, 0x05, 0xff, 0x0e, 0x03, 0xff,
|
|
172 0xff, 0x0c, 0x01, 0xff, 0x0a, 0xff, 0xff, 0x09,
|
|
173 0x0a, 0xff, 0xff, 0x0b, 0x0a, 0x0a, 0x0a, 0xff,
|
|
174 0x08, 0xff, 0xff, 0x0b, 0xff, 0x00, 0x0d, 0xff,
|
|
175 0xff, 0x0b, 0x0b, 0x0b, 0x0a, 0xff, 0xff, 0x0b,
|
|
176 0x0c, 0x0c, 0xff, 0x0c, 0xff, 0x0c, 0x0d, 0xff,
|
|
177 0xff, 0x0c, 0x0f, 0xff, 0x0a, 0xff, 0xff, 0x07,
|
|
178 0xff, 0x0c, 0x0d, 0xff, 0x0d, 0xff, 0x0d, 0x0d,
|
|
179 0x06, 0xff, 0xff, 0x0b, 0xff, 0x0e, 0x0d, 0xff,
|
|
180 0x08, 0xff, 0xff, 0x09, 0xff, 0x09, 0x09, 0x09,
|
|
181 0xff, 0x02, 0x0f, 0xff, 0x0a, 0xff, 0xff, 0x09,
|
|
182 0x08, 0x08, 0x08, 0xff, 0x08, 0xff, 0xff, 0x09,
|
|
183 0x08, 0xff, 0xff, 0x0b, 0xff, 0x0e, 0x03, 0xff,
|
|
184 0xff, 0x0c, 0x0f, 0xff, 0x04, 0xff, 0xff, 0x09,
|
|
185 0x0f, 0xff, 0x0f, 0x0f, 0xff, 0x0e, 0x0f, 0xff,
|
|
186 0x08, 0xff, 0xff, 0x05, 0xff, 0x0e, 0x0d, 0xff,
|
|
187 0xff, 0x0e, 0x0f, 0xff, 0x0e, 0x0e, 0xff, 0x0e };
|
|
188
|
|
189
|
|
190 enum {
|
|
191 LAT_UNI=0,
|
|
192 RUS_UNI,
|
|
193 LANGS
|
|
194 };
|
|
195
|
|
196 // conversion table for chars 0x20-0x7F (UTF8)
|
|
197 // TODO: add another languages
|
|
198 static unsigned int lang_chars[LANGS][0x60]={
|
|
199 {
|
|
200 //Latin
|
|
201 0x20,0x21,0x22,0x23,0x24,0x25,0x26,0x27,
|
|
202 0x28,0x29,0x2a,0x2b,0x2c,0x2d,0x2e,0x2f,
|
|
203 0x30,0x31,0x32,0x33,0x34,0x35,0x36,0x37,
|
|
204 0x38,0x39,0x3a,0x3b,0x3c,0x3d,0x3e,0x3f,
|
|
205 0x40,0x41,0x42,0x43,0x44,0x45,0x46,0x47,
|
|
206 0x48,0x49,0x4a,0x4b,0x4c,0x4d,0x4e,0x4f,
|
|
207 0x50,0x51,0x52,0x53,0x54,0x55,0x56,0x57,
|
|
208 0x58,0x59,0x5a,0x5b,0x5c,0x5d,0x5e,0x5f,
|
|
209 0x60,0x61,0x62,0x63,0x64,0x65,0x66,0x67,
|
|
210 0x68,0x69,0x6a,0x6b,0x6c,0x6d,0x6e,0x6f,
|
|
211 0x70,0x71,0x72,0x73,0x74,0x75,0x76,0x77,
|
|
212 0x78,0x79,0x7a,0x7b,0x7c,0x7d,0x7e,0x7f
|
|
213 },
|
|
214 {
|
|
215 //Russian
|
|
216 0x20,0x21,0x22,0x23,0x24,0x25,0x044b,0x27,
|
|
217 0x28,0x29,0x2a,0x2b,0x2c,0x2d,0x2e,0x2f,
|
|
218 0x30,0x31,0x32,0x33,0x34,0x35,0x36,0x37,
|
|
219 0x38,0x39,0x3a,0x3b,0x3c,0x3d,0x3e,0x3f,
|
|
220 0x042e,0x0410,0x0411,0x0426,0x0414,0x0415,0x0424,0x0413,
|
|
221 0x0425,0x0418,0x0419,0x041a,0x041b,0x041c,0x041d,0x041e,
|
|
222 0x041f,0x042f,0x0420,0x0421,0x0422,0x0423,0x0416,0x0412,
|
|
223 0x042c,0x042a,0x0417,0x0428,0x042d,0x0429,0x0427,0x042b,
|
|
224 0x044e,0x0430,0x0431,0x0446,0x0434,0x0435,0x0444,0x0433,
|
|
225 0x0445,0x0438,0x0439,0x043a,0x043b,0x043c,0x043d,0x043e,
|
|
226 0x043f,0x044f,0x0440,0x0441,0x0442,0x0443,0x0436,0x0432,
|
|
227 0x044c,0x044a,0x0437,0x0448,0x044d,0x0449,0x0447,0x044b
|
|
228 }
|
|
229 };
|
|
230
|
|
231 static int lang2id (int lang){
|
|
232 switch(lang){
|
|
233 case 0:
|
|
234 return LAT_UNI;
|
|
235 case 3: /* Stub. My teletext provider (1TV, Russia) sets this this language
|
|
236 code for russian teletext pages
|
|
237 TODO: make this configurable
|
|
238 */
|
|
239 return RUS_UNI;
|
|
240 default:
|
|
241 return LAT_UNI;
|
|
242 }
|
|
243 }
|
|
244
|
|
245 /**
|
|
246 * \brief convert chars from curent teletext codepage into MPlayer charset
|
|
247 * \param p raw teletext char to decode
|
|
248 * \param lang teletext internal language code (see lang2id)
|
|
249 * \return UTF8 char
|
|
250 *
|
|
251 * \remarks
|
|
252 * routine will analyze raw member of given tt_char structure and
|
|
253 * fill unicode member of the same struct with appropriate utf8 code.
|
|
254 */
|
|
255 static unsigned int conv2uni(unsigned int p,int lang)
|
|
256 {
|
|
257 if(p<0x80 && p>=0x20){
|
|
258 return lang_chars[lang][p-0x20];
|
|
259 }else
|
|
260 return 0x20;
|
|
261 }
|
|
262
|
|
263 static void init_vbi_consts(priv_vbi_t* priv){
|
|
264 int i,j;
|
|
265 double ang;
|
|
266 for(i=0; i<256; i++){
|
|
267 j=i&0x7F;
|
|
268 j^= j+j;
|
|
269 j^= j<<2;
|
|
270 j^= j<<4;
|
|
271 fixParity[i]= i ^ (j&0x80) ^ 0x80;
|
|
272 }
|
|
273
|
|
274 for(i=0,ang=0; i<12; i++,ang+=M_PI/priv->bpb){
|
|
275 si[i]= sin(ang);
|
|
276 co[i]= cos(ang);
|
|
277 }
|
|
278
|
|
279 priv->bpb=(priv->ptsp->sampling_rate/6937500.0)*ONE_FIXP+0.5;
|
|
280 //FIXME: STUBS!!!!
|
|
281 priv->soc=0;
|
|
282 priv->eoc=92;
|
|
283 //END STUBS!!!
|
|
284 priv->bp8bl=0.97*8*priv->bpb/ONE_FIXP; // -3% tolerance
|
|
285 priv->bp8bh=1.03*8*priv->bpb/ONE_FIXP; // +3% tolerance
|
|
286 }
|
|
287 /**
|
|
288 * \brief calculate increased/decreased by given value page number
|
|
289 * \param curr current page number in hexadecimal for
|
|
290 * \param direction decimal value (can be negative) to add to value
|
|
291 * of curr parameter
|
|
292 * \return new page number in hexadecimal form
|
|
293 *
|
|
294 * VBI page numbers are represented in special hexadecimal form, e.g.
|
|
295 * page with number 123 (as seen by user) internally has number 0x123.
|
|
296 * and equation 0x123+8 should be equal to 0x131 instead of regular 0x12b.
|
|
297 *
|
|
298 *
|
|
299 * Page numbers 0xYYY (where Y is not belongs to (0..9).
|
|
300 * Page number belongs to [0x000,0x799] or [0x100:0x899] (first 0 can be
|
|
301 * treated as '8')
|
|
302 */
|
|
303 static int steppage(int p, int direction, int skip_hidden)
|
|
304 {
|
|
305 if(skip_hidden)
|
|
306 p=(p&15)+((p>>4)&15)*10+(p>>8)*100;
|
|
307 p+=direction;
|
|
308 if(skip_hidden){
|
|
309 p=(p+800)%800;
|
|
310 p=(p%10)+((p/10)%10)*16+(p/100)*256;
|
|
311 }
|
|
312
|
|
313 return p&0x7ff;
|
|
314 }
|
|
315
|
|
316 /*
|
|
317 ------------------------------------------------------------------
|
|
318 Cache stuff
|
|
319 ------------------------------------------------------------------
|
|
320 */
|
|
321
|
|
322 /**
|
|
323 * \brief add/update entry in cache
|
|
324 * \param priv private data structure
|
|
325 * \param pg page to store in cache
|
|
326 * \param line line to update (value below 0 means update entire page)
|
|
327 */
|
|
328 static void put_to_cache(priv_vbi_t* priv,tt_page* pg,int line){
|
|
329 tt_page* pgc; //page in cache
|
|
330 int i,count;
|
|
331
|
|
332 if(line<0){
|
|
333 i=0;
|
|
334 count=VBI_ROWS*VBI_COLUMNS;
|
|
335 }else if(line<VBI_ROWS){
|
|
336 i=line*VBI_COLUMNS;
|
|
337 count=(line+1)*VBI_COLUMNS;
|
|
338 }else
|
|
339 return;
|
|
340
|
|
341 pthread_mutex_lock(&(priv->buffer_mutex));
|
|
342
|
|
343 if(!priv->ptt_cache[pg->pagenum]){
|
|
344 priv->ptt_cache[pg->pagenum]=calloc(1,sizeof(tt_page));
|
|
345 pgc=priv->ptt_cache[pg->pagenum];
|
|
346 }else{
|
|
347 pgc=priv->ptt_cache[pg->pagenum];
|
|
348 while(pgc->next_subpage && pgc->subpagenum!=pg->subpagenum)
|
|
349 pgc=pgc->next_subpage;
|
|
350
|
|
351 if(pgc->subpagenum!=pg->subpagenum){
|
|
352 pgc->next_subpage=calloc(1,sizeof(tt_page));
|
|
353 pgc=pgc->next_subpage;
|
|
354 }
|
|
355 }
|
|
356 pgc->pagenum=pg->pagenum;
|
|
357 pgc->subpagenum=pg->subpagenum;
|
|
358 pgc->lang=pg->lang;
|
|
359 pgc->flags=pg->flags;
|
|
360 //instead of copying entire page into cache, copy only undamaged
|
|
361 //symbols into cache
|
|
362 for(;i<count;i++){
|
|
363 if(!(pg->raw[i]&0x80))
|
|
364 pgc->raw[i]=pg->raw[i];
|
|
365 else
|
|
366 mp_msg(MSGT_TV,MSGL_DBG3,"char error. pg:%x, c[%d]=0x%x\n",
|
|
367 pg->pagenum,i,pg->raw[i]);
|
|
368 }
|
|
369 pgc->active=1;
|
|
370 pthread_mutex_unlock(&(priv->buffer_mutex));
|
|
371 }
|
|
372
|
|
373 /**
|
|
374 * \brief get any subpage number of given page
|
|
375 * \param priv private data structure
|
|
376 * \param pagenum page number to search subpages in
|
|
377 *
|
|
378 * \return subpage number of first found subpage which belongs to
|
|
379 * given page number
|
|
380 *
|
|
381 * \note page itself is subpage too (and usually has subpage number 0)
|
|
382 */
|
|
383 static inline int get_subpagenum_from_cache(priv_vbi_t* priv, int pagenum){
|
|
384 if (!priv->ptt_cache[pagenum])
|
|
385 return -1;
|
|
386 else
|
|
387 return priv->ptt_cache[pagenum]->subpagenum;
|
|
388 }
|
|
389
|
|
390 /**
|
|
391 * \brief get page from cache by it page and subpage number
|
|
392 * \param priv private data structure
|
|
393 * \param pagenum page number
|
|
394 * \param subpagenum subpage number
|
|
395 *
|
|
396 * \return pointer to tt_page structure if requested page is found
|
|
397 * and NULL otherwise
|
|
398 */
|
|
399 static inline tt_page* get_from_cache(priv_vbi_t* priv, int pagenum,int subpagenum){
|
|
400 tt_page* tp=priv->ptt_cache[pagenum];
|
|
401
|
|
402 while(tp && tp->subpagenum!=subpagenum)
|
|
403 tp=tp->next_subpage;
|
|
404 return tp;
|
|
405 }
|
|
406
|
|
407 /**
|
|
408 * \brief clears cache
|
|
409 * \param priv private data structure
|
|
410 *
|
|
411 * Deletes all tt_page structures from cache and frees allocated memory.
|
|
412 * Only zero-filled array of pointers remains in memory
|
|
413 */
|
|
414 static void clear_cache(priv_vbi_t* priv){
|
|
415 int i;
|
|
416 tt_page* tp;
|
|
417 for(i=0;i<VBI_MAX_PAGES;i++){
|
|
418 while(priv->ptt_cache[i]){
|
|
419 tp=priv->ptt_cache[i];
|
|
420 priv->ptt_cache[i]=tp->next_subpage;
|
|
421 free(tp);
|
|
422 }
|
|
423 }
|
|
424 }
|
|
425
|
|
426 /**
|
|
427 * \brief cache initialization
|
|
428 * \param priv private data structure
|
|
429 *
|
|
430 * \note Has to be called before any cache operations!
|
|
431 */
|
|
432 static void init_cache(priv_vbi_t* priv){
|
|
433 priv->ptt_cache=calloc(VBI_MAX_PAGES,sizeof(tt_page*));
|
|
434 }
|
|
435
|
|
436 /**
|
|
437 * \brief destroys cache
|
|
438 * \param priv private data structure
|
|
439 *
|
|
440 * Frees all memory allocated for cache (including array of pointers).
|
|
441 * It is safe to call this routine multiple times
|
|
442 */
|
|
443 static void destroy_cache(priv_vbi_t* priv){
|
|
444 if(priv->ptt_cache){
|
|
445 clear_cache(priv);
|
|
446 free(priv->ptt_cache);
|
|
447 priv->ptt_cache=NULL;
|
|
448 }
|
|
449 }
|
|
450
|
|
451 /*
|
|
452 ------------------------------------------------------------------
|
|
453 Decoder stuff
|
|
454 ------------------------------------------------------------------
|
|
455 */
|
|
456 /**
|
|
457 * \brief converts raw teletext page into useful format (1st rendering stage)
|
|
458 * \param pg page to decode
|
|
459 *
|
|
460 * Routine fills tt_char structure of each teletext_page character with proper
|
|
461 * info about foreground and background colors, character
|
|
462 * type (graphics/control/text).
|
|
463 */
|
|
464 static void decode_page(tt_char* p,int lang,unsigned char* raw)
|
|
465 {
|
|
466 int c,gfx=0,lat=0;
|
|
467 int i=0;
|
|
468 int fg_color=0;
|
|
469 int bg_color=0;
|
|
470 int row,col;
|
|
471 int separated=0;
|
|
472
|
|
473 for(row=0;row<VBI_ROWS;row++) {
|
|
474 lat=(lang==0);
|
|
475 gfx=0;
|
|
476 fg_color=7;
|
|
477 bg_color=0;
|
|
478 separated=0;
|
|
479 for(col=0;col<VBI_COLUMNS;col++){
|
|
480 i=row*VBI_COLUMNS+col;
|
|
481 c=raw[i];
|
|
482 p[i].raw=c;
|
|
483 if(c&0x80){ //damaged char
|
|
484 p[i]=tt_error;
|
|
485 continue;
|
|
486 }
|
|
487 p[i].gfx=gfx?(separated?2:1):0;
|
|
488 p[i].lng=lat?0:lang;
|
|
489 p[i].ctl=(c&0x60)==0?1:0;
|
|
490 p[i].fg=fg_color;
|
|
491 p[i].bg=bg_color;
|
|
492
|
|
493 if ((c&0x60)==0){ //control chars
|
|
494 if(c>=0x08 && c<=0x0f){
|
|
495 }else if (c<=0x17){ //colors
|
|
496 fg_color=c&0x0f;
|
|
497 gfx=c>>4;
|
|
498 }else if (c<=0x18){
|
|
499 }else if (c<=0x1a){ //Contiguous/Separated gfx
|
|
500 separated=!(c&1);
|
|
501 }else if (c<=0x1b){
|
|
502 lat=!lat;
|
|
503 }else if (c<=0x1d){
|
|
504 bg_color=(c&1)?fg_color:0;
|
|
505 p[i].bg=bg_color;
|
|
506 }
|
|
507 p[i].ctl=1;
|
|
508 p[i].unicode=p[i].gfx?0:' ';
|
|
509 continue;
|
|
510 }
|
|
511
|
|
512 if(gfx){
|
|
513 p[i].unicode=c-0x20;
|
|
514 if (p[i].unicode>0x3f) p[i].unicode-=0x20;
|
|
515 }else
|
|
516 p[i].unicode=conv2uni(c,lang2id(p[i].lng));
|
|
517
|
|
518 p[i].fg=fg_color;
|
|
519 p[i].bg=bg_color;
|
|
520 }
|
|
521 }
|
|
522 }
|
|
523
|
|
524 /**
|
|
525 * \brief prepares current page for displaying
|
|
526 * \param priv_vbi private data structure
|
|
527 *
|
|
528 * Routine adds some useful info (time and page number of page, grabbed by
|
|
529 * background thread to top line of current page). Displays "No teletext"
|
|
530 * string if no vbi data available.
|
|
531 */
|
23908
|
532 #define PRINT_HEX(dp,i,h) dp[i].unicode=((h)&0xf)>9?'A'+((h)&0xf)-10:'0'+((h)&0xf)
|
23899
|
533 static void prepare_visible_page(priv_vbi_t* priv){
|
|
534 tt_page *pg,*curr_pg;
|
|
535 unsigned char *p;
|
|
536 int i;
|
|
537
|
|
538 pthread_mutex_lock(&(priv->buffer_mutex));
|
|
539 mp_msg(MSGT_TV,MSGL_DBG3,"tvi_vbi: prepare_visible_page pg:0x%x, sub:0x%x\n",
|
|
540 priv->pagenum,priv->subpagenum);
|
|
541 if(priv->subpagenum==-1) //no page yet
|
|
542 priv->subpagenum=get_subpagenum_from_cache(priv,priv->pagenum);
|
|
543
|
|
544 pg=get_from_cache(priv,priv->pagenum,priv->subpagenum);
|
|
545 mp_dbg(MSGT_TV,MSGL_DBG3,"tvi_vbi: prepare_vibible_page2 pg:0x%x, sub:0x%x\n",
|
|
546 priv->pagenum,priv->subpagenum);
|
|
547
|
|
548 curr_pg=get_from_cache(priv,priv->curr_pagenum,
|
|
549 get_subpagenum_from_cache(priv,priv->curr_pagenum));
|
|
550 if (!pg && !curr_pg){
|
|
551 p=MSGTR_TV_NoTeletext;
|
|
552 for(i=0;i<VBI_COLUMNS && *p;i++){
|
|
553 GET_UTF8(priv->display_page[i].unicode,*p++,break;);
|
|
554 }
|
|
555 for(;i<VBI_ROWS*VBI_COLUMNS;i++)
|
|
556 priv->display_page[i]=tt_space;
|
|
557 pthread_mutex_unlock(&(priv->buffer_mutex));
|
|
558 return;
|
|
559 }
|
|
560
|
|
561 if (!pg || !pg->active){
|
|
562 for(i=0;i<VBI_ROWS*VBI_COLUMNS;i++){
|
|
563 priv->display_page[i]=tt_space;
|
|
564 }
|
|
565 }else{
|
|
566 decode_page(priv->display_page,pg->lang,pg->raw);
|
|
567 mp_msg(MSGT_TV,MSGL_DBG3,"page #%x was decoded!\n",pg->pagenum);
|
|
568 }
|
|
569
|
|
570 PRINT_HEX(priv->display_page,0,(priv->curr_pagenum&0x700)?priv->curr_pagenum>>8:8);
|
|
571 PRINT_HEX(priv->display_page,1,priv->curr_pagenum>>4);
|
|
572 PRINT_HEX(priv->display_page,2,priv->curr_pagenum);
|
|
573 priv->display_page[3].unicode=' ';
|
|
574 priv->display_page[4].unicode=' ';
|
|
575 switch(priv->pagenumdec>>12){
|
|
576 case 1:
|
|
577 priv->display_page[5].unicode='_';
|
|
578 priv->display_page[6].unicode='_';
|
|
579 PRINT_HEX(priv->display_page,7,priv->pagenumdec);
|
|
580 break;
|
|
581 case 2:
|
|
582 priv->display_page[5].unicode='_';
|
|
583 PRINT_HEX(priv->display_page,6,priv->pagenumdec>>4);
|
|
584 PRINT_HEX(priv->display_page,7,priv->pagenumdec);
|
|
585 break;
|
|
586 default:
|
|
587 PRINT_HEX(priv->display_page,5,(priv->pagenum&0x700)?priv->pagenum>>8:8);
|
|
588 PRINT_HEX(priv->display_page,6,priv->pagenum>>4);
|
|
589 PRINT_HEX(priv->display_page,7,priv->pagenum);
|
|
590 }
|
|
591 if(priv->subpagenum!=-1){
|
|
592 priv->display_page[8].unicode='.';
|
|
593 PRINT_HEX(priv->display_page,9,priv->subpagenum>>4);
|
|
594 PRINT_HEX(priv->display_page,10,priv->subpagenum);
|
|
595 }else{
|
|
596 priv->display_page[8].unicode=' ';
|
|
597 priv->display_page[9].unicode=' ';
|
|
598 priv->display_page[10].unicode=' ';
|
|
599 }
|
|
600 priv->display_page[11].unicode=' ';
|
|
601 for(i=VBI_TIME_LINEPOS;i<VBI_COLUMNS;i++){
|
|
602 priv->display_page[i].unicode=curr_pg->raw[i];
|
|
603 }
|
|
604 pthread_mutex_unlock(&(priv->buffer_mutex));
|
|
605 }
|
|
606 /*
|
|
607 ------------------------------------------------------------------
|
|
608 Renderer stuff
|
|
609 ------------------------------------------------------------------
|
|
610 */
|
|
611 #ifdef DEBUG_DUMP
|
|
612 /**
|
|
613 * \brief renders teletext page into given file
|
|
614 * \param pt page to render
|
|
615 * \param f opened file descriptor
|
|
616 * \param pagenum which page to render
|
|
617 * \param colored use colors not implementede yet)
|
|
618 *
|
|
619 * Text will be UTF8 encoded
|
|
620 */
|
|
621 static void render2text(tt_page* pt,FILE* f,int colored){
|
|
622 int i,j;
|
|
623 unsigned int u;
|
|
624 unsigned char buf[8];
|
|
625 unsigned char tmp;
|
|
626 int pos;
|
|
627 tt_char dp[VBI_ROWS*VBI_COLUMNS];
|
|
628 int color=0;
|
|
629 int bkg=0;
|
|
630 int c1,b1;
|
|
631 if(!pt)
|
|
632 return;
|
|
633 fprintf(f,"+========================================+\n");
|
|
634 fprintf(f,"| lang:%d pagenum:0x%x subpagenum:%d flags:0x%x|\n",
|
|
635 pt->lang,
|
|
636 pt->pagenum,
|
|
637 pt->subpagenum,
|
|
638 0);
|
|
639 fprintf(f,"+----------------------------------------+\n");
|
|
640
|
|
641 decode_page(dp,pt->lang,pt->raw);
|
|
642 for(i=0;i<VBI_ROWS;i++){
|
|
643 fprintf(f,"|");
|
|
644 if(colored) fprintf(f,"\033[40m");
|
|
645 for(j=0;j<VBI_COLUMNS;j++)
|
|
646 {
|
|
647 u=dp[i*VBI_COLUMNS+j].unicode;
|
23928
|
648 if(dp[i*VBI_COLUMNS+j].fg <= 7)
|
23899
|
649 c1=30+dp[i*VBI_COLUMNS+j].fg;
|
23928
|
650 else
|
23899
|
651 c1=38;
|
23928
|
652 if(dp[i*VBI_COLUMNS+j].bg <= 7)
|
23899
|
653 b1=40+dp[i*VBI_COLUMNS+j].bg;
|
23928
|
654 else
|
23899
|
655 b1=40;
|
|
656 if (b1!=bkg && colored){
|
|
657 fprintf(f,"\033[%dm",b1);
|
|
658 bkg=b1;
|
|
659 }
|
|
660 if(c1!=color && colored){
|
|
661 fprintf(f,"\033[%dm",c1);
|
|
662 color=c1;
|
|
663 }
|
|
664 if(dp[i*VBI_COLUMNS+j].gfx){
|
|
665 fprintf(f,"*");
|
|
666 }else{
|
|
667 pos=0;
|
|
668 PUT_UTF8(u,tmp,if(pos<7) buf[pos++]=tmp;);
|
|
669 buf[pos]='\0';
|
|
670 fprintf(f,"%s",buf);
|
|
671 }
|
|
672 }
|
|
673
|
|
674 if (colored) fprintf(f,"\033[0m");
|
|
675 color=-1;bkg=-1;
|
|
676 fprintf(f,"|\n");
|
|
677 }
|
|
678 #if 1
|
|
679 //for debug
|
|
680 fprintf(f,"+====================raw=================+\n");
|
|
681 for(i=0;i<VBI_ROWS;i++){
|
|
682 for(j=0;j<VBI_COLUMNS;j++)
|
|
683 fprintf(f,"%02x ",dp[i*VBI_COLUMNS+j].raw);
|
|
684 fprintf(f,"\n");
|
|
685 }
|
|
686 fprintf(f,"+====================lng=================+\n");
|
|
687 for(i=0;i<VBI_ROWS;i++){
|
|
688 for(j=0;j<VBI_COLUMNS;j++)
|
|
689 fprintf(f,"%02x ",dp[i*VBI_COLUMNS+j].lng);
|
|
690 fprintf(f,"\n");
|
|
691 }
|
|
692 #endif
|
|
693 fprintf(f,"+========================================+\n");
|
|
694 }
|
|
695
|
|
696 /**
|
|
697 * \brief dump page into pgXXX.txt file in vurrent directory
|
|
698 * \param pt page to dump
|
|
699 *
|
|
700 * \note XXX in filename is page number
|
|
701 * \note use only for debug purposes
|
|
702 */
|
|
703 static void dump_page(tt_page* pt)
|
|
704 {
|
|
705 FILE*f;
|
|
706 char name[100];
|
|
707 snprintf(name,99,"pg%x.txt",pt->pagenum);
|
|
708 f=fopen(name,"wb");
|
|
709 render2text(pt,f,1);
|
|
710 fclose(f);
|
|
711 }
|
|
712 #endif //DEBUG_DUMP
|
|
713
|
|
714
|
|
715 /**
|
|
716 * \brief checks whether page is ready and copies it into cache array if so
|
|
717 * \param priv private data structure
|
|
718 * \param magAddr page's magazine address (0-7)
|
|
719 *
|
|
720 * Routine also calls decode_page to perform 1st stage of rendering
|
|
721 */
|
|
722 static void store_in_cache(priv_vbi_t* priv, int magAddr, int line){
|
|
723 mp_msg(MSGT_TV,MSGL_DBG2,"store_in_cache(%d): pagenum:%x\n",
|
|
724 priv->mag[magAddr].order,
|
|
725 priv->mag[magAddr].pt->pagenum);
|
|
726
|
|
727 put_to_cache(priv,priv->mag[magAddr].pt,line);
|
|
728 priv->curr_pagenum=priv->mag[magAddr].pt->pagenum;
|
|
729
|
|
730 #ifdef DEBUG_DUMP
|
|
731 dump_page(get_from_cache(priv,
|
|
732 priv->mag[magAddr].pt->pagenum,
|
|
733 priv->mag[magAddr].pt->subpagenum));
|
|
734 #endif
|
|
735 }
|
|
736
|
|
737
|
|
738 /*
|
|
739 ------------------------------------------------------------------
|
|
740 Grabber stuff
|
|
741 ------------------------------------------------------------------
|
|
742 */
|
|
743 #define PLL_SAMPLES 4
|
|
744 #define PLL_ERROR 4
|
|
745 #define PLL_ADJUST 4
|
|
746
|
|
747 /**
|
|
748 * \brief adjust current phase for better signal decoding
|
|
749 * \param n count of bytes processed (?)
|
|
750 * \param err count of error bytes (?)
|
|
751 *
|
|
752 * \remarks code was got from MythTV project
|
|
753 */
|
|
754 static void pll_add(priv_vbi_t* priv,int n,int err){
|
|
755 if(priv->pll_fixed)
|
|
756 return;
|
|
757 if(err>PLL_ERROR*2/3)
|
|
758 err=PLL_ERROR*2/3;
|
|
759 priv->pll_err+=err;
|
|
760 priv->pll_cnt+=n;
|
|
761 if(priv->pll_cnt<PLL_SAMPLES)
|
|
762 return;
|
|
763 if(priv->pll_err>PLL_ERROR)
|
|
764 {
|
|
765 if(priv->pll_err>priv->pll_lerr)
|
|
766 priv->pll_dir= -priv->pll_dir;
|
|
767 priv->pll_lerr=priv->pll_err;
|
|
768 priv->pll_adj+=priv->pll_dir;
|
|
769 if (priv->pll_adj<-PLL_ADJUST || priv->pll_adj>PLL_ADJUST)
|
|
770 {
|
|
771 priv->pll_adj=0;
|
|
772 priv->pll_dir=-1;
|
|
773 priv->pll_lerr=0;
|
|
774 }
|
|
775 mp_msg(MSGT_TV,MSGL_DBG3,"vbi: pll_adj=%2d\n",priv->pll_adj);
|
|
776 }
|
|
777 priv->pll_cnt=0;
|
|
778 priv->pll_err=0;
|
|
779 }
|
|
780
|
|
781 /**
|
|
782 * \brief reset error correction
|
|
783 * \param priv private data structure
|
|
784 * \param fine_tune shift value for adjusting
|
|
785 *
|
|
786 * \remarks code was got from MythTV project
|
|
787 */
|
|
788 static void pll_reset(priv_vbi_t* priv,int fine_tune){
|
|
789 priv->pll_fixed=fine_tune >= -PLL_ADJUST && fine_tune <= PLL_ADJUST;
|
|
790
|
|
791 priv->pll_err=0;
|
|
792 priv->pll_lerr=0;
|
|
793 priv->pll_cnt=0;
|
|
794 priv->pll_dir=-1;
|
|
795 priv->pll_adj=0;
|
|
796 if(priv->pll_fixed)
|
|
797 priv->pll_adj=fine_tune;
|
|
798 if(priv->pll_fixed)
|
|
799 mp_msg(MSGT_TV,MSGL_DBG3,"pll_reset (fixed@%2d)\n",priv->pll_adj);
|
|
800 else
|
|
801 mp_msg(MSGT_TV,MSGL_DBG3,"pll_reset (auto)\n");
|
|
802
|
|
803 }
|
|
804 /**
|
|
805 * \brief decode packet 0 (teletext page header)
|
|
806 * \param priv private data structure
|
|
807 * \param data raw teletext data (with not applied hamm correction yet)
|
|
808 * \param magAddr teletext page's magazine address
|
|
809 *
|
|
810 * \remarks
|
|
811 * data buffer was shifted by 6 and now contains:
|
|
812 * 0..1 page number
|
|
813 * 2..5 sub-code
|
|
814 * 6..7 control codes
|
|
815 * 8..39 display data
|
|
816 *
|
|
817 * only first 8 bytes protected by Hamm 8/4 code
|
|
818 */
|
|
819 static int decode_pkt0(priv_vbi_t* priv,unsigned char* data,int magAddr)
|
|
820 {
|
|
821 int d[8];
|
|
822 int i,err;
|
|
823
|
|
824 if (magAddr<0 || magAddr>7)
|
|
825 return 0;
|
|
826 for(i=0;i<8;i++){
|
|
827 d[i]= corrHamm48[ data[i] ];
|
|
828 if(d[i]&0x80){
|
|
829 pll_add(priv,2,4);
|
|
830
|
|
831 if(priv->mag[magAddr].pt)
|
|
832 free(priv->mag[magAddr].pt);
|
|
833 priv->mag[magAddr].pt=NULL;
|
|
834 priv->mag[magAddr].order=0;
|
|
835 return 0;
|
|
836 }
|
|
837 }
|
|
838 if (!priv->mag[magAddr].pt)
|
|
839 priv->mag[magAddr].pt= malloc(sizeof(tt_page));
|
|
840
|
|
841 priv->mag[magAddr].lang= d[7] & 0x7;
|
|
842 priv->mag[magAddr].pt->lang=priv->mag[magAddr].lang;
|
|
843 priv->mag[magAddr].pt->subpagenum=(d[2]|(d[3]<<4)|(d[4]<<8)|(d[5]<<12))&0x3f7f;
|
|
844 priv->mag[magAddr].pt->pagenum=(magAddr<<8) | d[0] | (d[1]<<4);
|
|
845 priv->mag[magAddr].pt->flags=( d[6] | (d[7]<<4));
|
|
846
|
|
847 memset(priv->mag[magAddr].pt->raw, 0x00, VBI_COLUMNS*VBI_ROWS);
|
|
848 priv->mag[magAddr].order=0;
|
|
849
|
|
850 for(i=0;i<8;i++){
|
|
851 priv->mag[magAddr].pt->raw[i]=0x20;
|
|
852 }
|
|
853 err=0;
|
|
854 for(i=8; i<VBI_COLUMNS; i++){
|
|
855 data[i]= fixParity[data[i]];
|
|
856 priv->mag[magAddr].pt->raw[i]=data[i];
|
|
857 if(data[i]&0x80) //Error
|
|
858 err++;
|
|
859 pll_add(priv,1,err);
|
|
860 }
|
|
861
|
|
862 store_in_cache(priv,magAddr,0);
|
|
863
|
|
864 return 1;
|
|
865 }
|
|
866
|
|
867 /**
|
|
868 * \brief decode packets 1..24 (teletext page header)
|
|
869 * \param priv private data structure
|
|
870 * \param data raw teletext data
|
|
871 * \param magAddr teletext page's magazine address
|
|
872 * \param rowAddr teletext page's row number
|
|
873 *
|
|
874 * \remarks
|
|
875 * data buffer was shifted by 6 and now contains 40 bytes of display data:
|
|
876 * this type of packet is not proptected by Hamm 8/4 code
|
|
877 */
|
|
878 static void decode_pkt_page(priv_vbi_t* priv,unsigned char*data,int magAddr,int rowAddr){
|
|
879 int i,err;
|
|
880 if (!priv->mag[magAddr].pt)
|
|
881 return;
|
|
882
|
|
883 priv->mag[magAddr].order=rowAddr;
|
|
884
|
|
885 err=0;
|
|
886 for(i=0; i<VBI_COLUMNS; i++){
|
|
887 data[i]= fixParity[ data[i] ];
|
|
888 priv->mag[magAddr].pt->raw[i+rowAddr*VBI_COLUMNS]=data[i];
|
|
889 if( data[i]&0x80) //HammError
|
|
890 err++;
|
|
891 }
|
|
892 pll_add(priv,1,err);
|
|
893
|
|
894 store_in_cache(priv,magAddr,rowAddr);
|
|
895 }
|
|
896
|
|
897 /**
|
|
898 * \brief decodes raw vbi data (signal amplitudes) into sequence of bytes
|
|
899 * \param priv private data structure
|
|
900 * \param buf raw vbi data (one line of frame)
|
|
901 * \param data output buffer for decoded bytes (at least 45 bytes long)
|
|
902 *
|
|
903 * Used XawTV's algorithm. Signal phase is calculated with help of starting clock
|
|
904 * run-in sequence (min/max values and bit distance values are calculated)
|
|
905 */
|
|
906 static int decode_raw_line_runin(priv_vbi_t* priv,unsigned char* buf,unsigned char* data){
|
|
907 const int magic= 0x27; // reversed 1110010
|
|
908 int dt[256],hi[6],lo[6];
|
|
909 int i,x,r;
|
|
910 int decoded;
|
|
911 int sync;
|
|
912 unsigned char min,max;
|
|
913 int thr=0; //threshold
|
|
914
|
|
915 //stubs
|
|
916 int soc=0;
|
|
917 int eoc=92;
|
|
918
|
|
919 for(i=soc;i<eoc;i++)
|
|
920 dt[i]=buf[i+priv->bpb/ONE_FIXP]-buf[i]; // amplifies the edges best.
|
|
921 /* set barrier */
|
|
922 for (i=eoc; i<eoc+16; i+=2)
|
|
923 dt[i]=100, dt[i+1]=-100;
|
|
924
|
|
925 /* find 6 rising and falling edges */
|
|
926 for (i=soc, x=0; x<6; ++x)
|
|
927 {
|
|
928 while (dt[i]<32)
|
|
929 i++;
|
|
930 hi[x]=i;
|
|
931 while (dt[i]>-32)
|
|
932 i++;
|
|
933 lo[x]=i;
|
|
934 }
|
|
935 if (i>=eoc)
|
|
936 {
|
|
937 return 0; // not enough periods found
|
|
938 }
|
|
939 i=hi[5]-hi[1]; // length of 4 periods (8 bits)
|
|
940 if (i<priv->bp8bl || i>priv->bp8bh)
|
|
941 {
|
|
942 mp_msg(MSGT_TV,MSGL_DBG3,"vbi: wrong freq %d (%d,%d)\n",
|
|
943 i,priv->bp8bl,priv->bp8bh);
|
|
944 return 0; // bad frequency
|
|
945 }
|
|
946 /* AGC and sync-reference */
|
|
947 min=255, max=0, sync=0;
|
|
948 for (i=hi[4]; i<hi[5]; ++i)
|
|
949 if (buf[i]>max)
|
|
950 max=buf[i], sync=i;
|
|
951 for (i=lo[4]; i<lo[5]; ++i)
|
|
952 if (buf[i]<min)
|
|
953 min=buf[i];
|
|
954 thr=(min+max)/2;
|
|
955
|
|
956 buf+=sync;
|
|
957 // searching for '11'
|
|
958 for(i=priv->pll_adj*priv->bpb/10;i<16*priv->bpb;i+=priv->bpb)
|
|
959 if(buf[FIXP2INT(i)]>thr && buf[FIXP2INT(i+priv->bpb)]>thr)
|
|
960 break;
|
|
961 r=0;
|
|
962 for(decoded=1; decoded<= (VBI_COLUMNS+3)<<3;decoded++){
|
|
963 r>>=1;
|
|
964 if(buf[FIXP2INT(i)]>thr) r|=0x80;
|
|
965 if(!(decoded & 0x07)){
|
|
966 data[(decoded>>3) - 1]=r;
|
|
967 r=0;
|
|
968 }
|
|
969 i+=priv->bpb;
|
|
970 }
|
|
971 if(data[0]!=magic)
|
|
972 return 0; //magic not found
|
|
973
|
|
974 //stub
|
|
975 for(i=0;i<43;i++){
|
|
976 data[i]=data[i+1];
|
|
977 }
|
|
978 mp_msg(MSGT_TV,MSGL_DBG3,"thr:%d sync:%d ",thr,sync);
|
|
979
|
|
980 return 1;
|
|
981 }
|
|
982
|
|
983 /**
|
|
984 * \brief decodes raw vbi data (signal amplitudes) into sequence of bytes
|
|
985 * \param priv private data structure
|
|
986 * \param buf raw vbi data (one line of frame)
|
|
987 * \param data output buffer for decoded bytes (at least 45 bytes long)
|
|
988 *
|
|
989 * Used Michael Niedermayer's algorithm.
|
|
990 * Signal phase is calculated using correlation between given samples data and
|
|
991 * pure sine
|
|
992 */
|
|
993 static int decode_raw_line_sine(priv_vbi_t* priv,unsigned char* buf,unsigned char* data){
|
|
994 int i,x,r,amp,xFixp;
|
|
995 int avg=0;
|
|
996 double sin_sum=0, cos_sum=0;
|
|
997
|
|
998 for(x=0; x< FIXP2INT(10*priv->bpb); x++)
|
|
999 avg+=buf[x];
|
|
1000
|
|
1001 avg/=FIXP2INT(10*priv->bpb);
|
|
1002
|
|
1003 for(x=0; x<12; x++){
|
|
1004 amp= buf[x<<1];
|
|
1005 sin_sum+= si[x]*(amp-avg);
|
|
1006 cos_sum+= co[x]*(amp-avg);
|
|
1007 }
|
|
1008 //this is always zero. Why ?
|
|
1009 xFixp= atan(sin_sum/cos_sum)*priv->bpb/M_PI;
|
|
1010
|
|
1011 //Without this line the result is full of errors
|
|
1012 //and routine is unable to find magic sequence
|
|
1013 buf+=FIXP2INT(10*priv->bpb);
|
|
1014
|
|
1015 r=0;
|
|
1016 for(x=FIXP2INT(xFixp);x<70;x=FIXP2INT(xFixp)){
|
|
1017 r=(r<<1) & 0xFFFF;
|
|
1018 if(buf[x]>avg) r|=1;
|
|
1019 xFixp+=priv->bpb;
|
|
1020 if(r==0xAAE4) break;
|
|
1021 }
|
|
1022
|
|
1023 //this is not teletext
|
|
1024 if (r!=0xaae4) return 0;
|
|
1025
|
|
1026 //Decode remaining 45-2(clock run-in)-1(framing code)=42 bytes
|
|
1027 for(i=1; i<=(42<<3); i++){
|
|
1028 r>>=1;
|
|
1029 x=FIXP2INT(xFixp);
|
|
1030 if(buf[x]> avg)
|
|
1031 r|=0x80;
|
|
1032
|
|
1033 if(!(i & 0x07)){
|
|
1034 data[(i>>3)-1]=r;
|
|
1035 r=0;
|
|
1036 }
|
|
1037 xFixp+=priv->bpb;
|
|
1038 }
|
|
1039
|
|
1040 return 1;
|
|
1041 }
|
|
1042
|
|
1043 /**
|
|
1044 * \brief decodes all vbi lines from one video frame
|
|
1045 * \param priv private data structure
|
|
1046 * \param buf buffer with raw vbi data in it
|
|
1047 *
|
|
1048 * \note buffer size have to be at least priv->ptsp->bufsize bytes
|
|
1049 */
|
|
1050 static void vbi_decode(priv_vbi_t* priv,unsigned char*buf){
|
|
1051 int magAddr;
|
|
1052 int pkt;
|
|
1053 unsigned char data[64];
|
|
1054 unsigned char* linep;
|
|
1055 int d0,d1;
|
|
1056 int i=0;
|
|
1057 mp_msg(MSGT_TV,MSGL_DBG3,"vbi: vbi_decode\n");
|
|
1058 for(linep=buf; linep<buf+priv->ptsp->bufsize; linep+=priv->ptsp->samples_per_line,i++){
|
|
1059 #if 0
|
|
1060 /*
|
|
1061 This routine is alternative implementation of raw VBI data decoding.
|
|
1062 Unfortunately, it detects only about 20% of incoming data,
|
|
1063 but Michael says that this algorithm is better, and he wants to fix it.
|
|
1064 */
|
|
1065 if(decode_raw_line_sine(priv,linep,data)<=0){
|
|
1066 #endif
|
|
1067 if(decode_raw_line_runin(priv,linep,data)<=0){
|
|
1068 continue; //this is not valid teletext line
|
|
1069 }
|
|
1070 d0= corrHamm48[ data[0] ];
|
|
1071 d1= corrHamm48[ data[1] ];
|
|
1072
|
|
1073 if(d0&0x80 || d1&0x80){
|
|
1074 pll_add(priv,2,4);
|
|
1075 mp_msg(MSGT_TV,MSGL_V,"vbi_decode(%d):HammErr after decode_raw_line\n",i);
|
|
1076
|
|
1077 continue; //hamError
|
|
1078 }
|
|
1079 magAddr=d0 & 0x7;
|
|
1080 pkt=(d0>>3)|(d1<<1);
|
|
1081 mp_msg(MSGT_TV,MSGL_DBG3,"vbi_decode(%d):%x %x (mag:%x, pkt:%d)\n",
|
|
1082 i,d0,d1,magAddr,pkt);
|
|
1083 if(!pkt){
|
|
1084 decode_pkt0(priv,data+2,magAddr); //skip MRGA
|
|
1085 }else if(pkt>0 && pkt<VBI_ROWS){
|
|
1086 if(!priv->mag[magAddr].pt) continue;
|
|
1087 decode_pkt_page(priv,data+2,magAddr,pkt);//skip MRGA
|
|
1088 } else {
|
|
1089 mp_msg(MSGT_TV,MSGL_DBG3,"unsupported packet:%d\n",pkt);
|
|
1090 }
|
|
1091 }
|
|
1092
|
|
1093 }
|
|
1094
|
|
1095 /*
|
|
1096 ---------------------------------------------------------------------------------
|
|
1097 Public routines
|
|
1098 ---------------------------------------------------------------------------------
|
|
1099 */
|
|
1100
|
|
1101 /**
|
|
1102 * \brief toggles teletext page displaying format
|
|
1103 * \param priv_vbi private data structure
|
|
1104 * \param flag new format
|
|
1105 * \return
|
|
1106 * TVI_CONTROL_TRUE is success,
|
|
1107 * TVI_CONTROL_FALSE otherwise
|
|
1108 *
|
|
1109 * flag:
|
|
1110 * 0 - opaque
|
|
1111 * 1 - transparent
|
|
1112 * 2 - opaque with black foreground color (only in bw mode)
|
|
1113 * 3 - transparent with black foreground color (only in bw mode)
|
|
1114 */
|
|
1115 static int teletext_set_format(priv_vbi_t * priv, teletext_format flag)
|
|
1116 {
|
|
1117 flag&=3;
|
|
1118
|
|
1119 mp_msg(MSGT_TV,MSGL_DBG3,"teletext_set_format_is called. mode:%d\n",flag);
|
|
1120 pthread_mutex_lock(&(priv->buffer_mutex));
|
|
1121
|
|
1122 priv->tformat=flag;
|
|
1123
|
|
1124 priv->pagenumdec=0;
|
|
1125
|
|
1126 pthread_mutex_unlock(&(priv->buffer_mutex));
|
|
1127 return TVI_CONTROL_TRUE;
|
|
1128 }
|
|
1129
|
|
1130 /**
|
|
1131 * \brief append just entered digit to editing page number
|
|
1132 * \param priv_vbi private data structure
|
|
1133 * \param dec decimal digit to append
|
|
1134 *
|
|
1135 * dec:
|
|
1136 * '0'..'9' append digit
|
|
1137 * '-' remove last digit (backspace emulation)
|
|
1138 *
|
|
1139 * This routine allows user to jump to arbitrary page.
|
|
1140 * It implements simple page number editing algorithm.
|
|
1141 *
|
|
1142 * Subsystem can be on one of two modes: normal and page number edit mode.
|
|
1143 * Zero value of priv->pagenumdec means normal mode
|
|
1144 * Non-zero value means page number edit mode and equals to packed
|
|
1145 * decimal number of already entered part of page number.
|
|
1146 *
|
|
1147 * How this works.
|
|
1148 * Let's assume that current mode is normal (pagenumdec is zero), teletext page
|
|
1149 * 100 are displayed as usual. topmost left corner of page contains page number.
|
|
1150 * Then vbi_add_dec is sequentially called (through slave
|
|
1151 * command of course) with 1,4,-,2,3 * values of dec parameter.
|
|
1152 *
|
|
1153 * +-----+------------+------------------+
|
|
1154 * | dec | pagenumdec | displayed number |
|
|
1155 * +-----+------------+------------------+
|
|
1156 * | | 0x000 | 100 |
|
|
1157 * +-----+------------+------------------+
|
|
1158 * | 1 | 0x001 | __1 |
|
|
1159 * +-----+------------+------------------+
|
|
1160 * | 4 | 0x014 | _14 |
|
|
1161 * +-----+------------+------------------+
|
|
1162 * | - | 0x001 | __1 |
|
|
1163 * +-----+------------+------------------+
|
|
1164 * | 2 | 0x012 | _12 |
|
|
1165 * +-----+------------+------------------+
|
|
1166 * | 3 | 0x123 | 123 |
|
|
1167 * +-----+------------+------------------+
|
|
1168 * | | 0x000 | 123 |
|
|
1169 * +-----+------------+------------------+
|
|
1170 *
|
|
1171 * pagenumdec will automatically receive zero value after third digit of page
|
|
1172 * number is entered and current page will be switched to another one with
|
|
1173 * entered page number.
|
|
1174 */
|
|
1175 static void vbi_add_dec(priv_vbi_t * priv, char *dec)
|
|
1176 {
|
|
1177 int count, shift;
|
|
1178 if (!dec)
|
|
1179 return;
|
|
1180 if (!priv->on)
|
|
1181 return;
|
|
1182 if ((*dec<'0' || *dec>'9') && *dec!='-')
|
|
1183 return;
|
|
1184 if (!priv->pagenumdec) //first digit cannot be '0','9' or '-'
|
|
1185 if(*dec=='-' || *dec=='0' || *dec=='9')
|
|
1186 return;
|
|
1187 pthread_mutex_lock(&(priv->buffer_mutex));
|
|
1188 count=(priv->pagenumdec>>12)&0xf;
|
|
1189 if (*dec=='-') {
|
|
1190 count--;
|
|
1191 if (count)
|
|
1192 priv->pagenumdec=((priv->pagenumdec>>4)&0xfff)|(count<<12);
|
|
1193 else
|
|
1194 priv->pagenumdec=0;
|
|
1195 } else {
|
|
1196 shift = count * 4;
|
|
1197 count++;
|
|
1198 priv->pagenumdec=
|
|
1199 (((priv->pagenumdec)<<4|(*dec-'0'))&0xfff)|(count<<12);
|
|
1200 if (count==3) {
|
|
1201 priv->pagenum=priv->pagenumdec&0x7ff;
|
|
1202 priv->subpagenum=get_subpagenum_from_cache(priv,priv->pagenum);
|
|
1203 priv->pagenumdec=0;
|
|
1204 }
|
|
1205 }
|
|
1206 pthread_mutex_unlock(&(priv->buffer_mutex));
|
|
1207 }
|
|
1208
|
|
1209
|
|
1210 /**
|
|
1211 * \brief Teletext control routine
|
|
1212 * \param priv_vbi private data structure
|
|
1213 * \param cmd command
|
|
1214 * \param arg command parameter (has to be not null)
|
|
1215 */
|
|
1216 int teletext_control(void* p, int cmd, void *arg)
|
|
1217 {
|
|
1218 int fine_tune=99;
|
|
1219 priv_vbi_t* priv=(priv_vbi_t*)p;
|
|
1220
|
|
1221 if (!priv && cmd!=TV_VBI_CONTROL_START)
|
|
1222 return TVI_CONTROL_FALSE;
|
|
1223 if (!arg && cmd!=TV_VBI_CONTROL_STOP)
|
|
1224 return TVI_CONTROL_FALSE;
|
|
1225
|
|
1226 switch (cmd) {
|
|
1227 case TV_VBI_CONTROL_RESET:
|
|
1228 {
|
|
1229 tv_param_t* tv_param=arg;
|
|
1230 pthread_mutex_lock(&(priv->buffer_mutex));
|
|
1231 priv->pagenumdec=0;
|
|
1232 clear_cache(priv);
|
|
1233 priv->pagenum=steppage(0,tv_param->tpage&0x7ff,1);
|
|
1234 priv->tformat=tv_param->tformat;
|
|
1235 priv->subpagenum=0;
|
|
1236 pll_reset(priv,fine_tune);
|
|
1237 pthread_mutex_unlock(&(priv->buffer_mutex));
|
|
1238 return TVI_CONTROL_TRUE;
|
|
1239 }
|
|
1240 case TV_VBI_CONTROL_START:
|
|
1241 {
|
|
1242 int i;
|
|
1243 tt_stream_props* ptsp=*(tt_stream_props**)arg;
|
|
1244
|
|
1245 if(!ptsp)
|
|
1246 return TVI_CONTROL_FALSE;
|
|
1247
|
|
1248 priv=calloc(1,sizeof(priv_vbi_t));
|
|
1249
|
|
1250 priv->ptsp=malloc(sizeof(tt_stream_props));
|
|
1251 memcpy(priv->ptsp,ptsp,sizeof(tt_stream_props));
|
|
1252 *(priv_vbi_t**)arg=priv;
|
|
1253
|
|
1254 priv->subpagenum=0;
|
|
1255 pthread_mutex_init(&priv->buffer_mutex, NULL);
|
|
1256 priv->pagenumdec=0;
|
|
1257 for(i=0;i<VBI_ROWS*VBI_COLUMNS;i++)
|
|
1258 priv->display_page[i]=tt_space;
|
|
1259
|
|
1260 priv->mag=calloc(8,sizeof(mag_t));
|
|
1261 init_cache(priv);
|
|
1262 init_vbi_consts(priv);
|
|
1263 pll_reset(priv,fine_tune);
|
|
1264 return TVI_CONTROL_TRUE;
|
|
1265 }
|
|
1266 case TV_VBI_CONTROL_STOP:
|
|
1267 {
|
|
1268 if(priv->mag)
|
|
1269 free(priv->mag);
|
|
1270 if(priv->ptsp)
|
|
1271 free(priv->ptsp);
|
|
1272 destroy_cache(priv);
|
|
1273 free(priv);
|
|
1274 return TVI_CONTROL_TRUE;
|
|
1275 }
|
|
1276 case TV_VBI_CONTROL_SET_MODE:
|
|
1277 priv->on=(*(int*)arg%2);
|
|
1278 return TVI_CONTROL_TRUE;
|
|
1279 case TV_VBI_CONTROL_GET_MODE:
|
|
1280 *(int*)arg=priv->on;
|
|
1281 return TVI_CONTROL_TRUE;
|
|
1282 case TV_VBI_CONTROL_SET_FORMAT:
|
|
1283 return teletext_set_format(priv, *(int *) arg);
|
|
1284 case TV_VBI_CONTROL_GET_FORMAT:
|
|
1285 pthread_mutex_lock(&(priv->buffer_mutex));
|
|
1286 *(int*)arg=priv->tformat;
|
|
1287 pthread_mutex_unlock(&(priv->buffer_mutex));
|
|
1288 return TVI_CONTROL_TRUE;
|
|
1289 case TV_VBI_CONTROL_GET_HALF_PAGE:
|
|
1290 if(!priv->on)
|
|
1291 return TVI_CONTROL_FALSE;
|
|
1292 *(int *)arg=priv->zoom;
|
|
1293 return TVI_CONTROL_TRUE;
|
|
1294 case TV_VBI_CONTROL_SET_HALF_PAGE:
|
|
1295 {
|
|
1296 int val=*(int*)arg;
|
|
1297 val%=3;
|
|
1298 if(val<0)
|
|
1299 val+=3;
|
|
1300 pthread_mutex_lock(&(priv->buffer_mutex));
|
|
1301 priv->zoom=val;
|
|
1302 pthread_mutex_unlock(&(priv->buffer_mutex));
|
|
1303 return TVI_CONTROL_TRUE;
|
|
1304 }
|
|
1305 case TV_VBI_CONTROL_SET_PAGE:
|
|
1306 {
|
|
1307 int val=*(int *) arg;
|
|
1308 if(val<100 || val>0x899)
|
|
1309 return TVI_CONTROL_FALSE;
|
|
1310 pthread_mutex_lock(&(priv->buffer_mutex));
|
|
1311 priv->pagenum=val&0x7ff;
|
|
1312 priv->subpagenum=get_subpagenum_from_cache(priv,priv->pagenum);
|
|
1313 priv->pagenumdec=0;
|
|
1314 pthread_mutex_unlock(&(priv->buffer_mutex));
|
|
1315 return TVI_CONTROL_TRUE;
|
|
1316 }
|
|
1317 case TV_VBI_CONTROL_STEP_PAGE:
|
|
1318 {
|
|
1319 int direction=*(int *) arg;
|
|
1320 pthread_mutex_lock(&(priv->buffer_mutex));
|
|
1321 priv->pagenum=steppage(priv->pagenum, direction,1);
|
|
1322 priv->subpagenum=get_subpagenum_from_cache(priv,priv->pagenum);
|
|
1323 priv->pagenumdec=0;
|
|
1324 pthread_mutex_unlock(&(priv->buffer_mutex));
|
|
1325 return TVI_CONTROL_TRUE;
|
|
1326 }
|
|
1327 case TV_VBI_CONTROL_GET_PAGE:
|
|
1328 *(int*)arg=((priv->pagenum+0x700)&0x7ff)+0x100;
|
|
1329 return TVI_CONTROL_TRUE;
|
|
1330 case TV_VBI_CONTROL_SET_SUBPAGE:
|
|
1331 pthread_mutex_lock(&(priv->buffer_mutex));
|
|
1332 priv->pagenumdec=0;
|
|
1333 priv->subpagenum=*(int*)arg;
|
|
1334 if(priv->subpagenum<0)
|
|
1335 priv->subpagenum=0;
|
|
1336 if(priv->subpagenum>=VBI_MAX_SUBPAGES)
|
|
1337 priv->subpagenum=VBI_MAX_SUBPAGES-1;
|
|
1338 pthread_mutex_unlock(&(priv->buffer_mutex));
|
|
1339 return TVI_CONTROL_TRUE;
|
|
1340 case TV_VBI_CONTROL_GET_SUBPAGE:
|
|
1341 *(int*)arg=priv->subpagenum;
|
|
1342 return TVI_CONTROL_TRUE;
|
|
1343 case TV_VBI_CONTROL_ADD_DEC:
|
|
1344 vbi_add_dec(priv, *(char **) arg);
|
|
1345 return TVI_CONTROL_TRUE;
|
|
1346 case TV_VBI_CONTROL_DECODE_PAGE:
|
|
1347 vbi_decode(priv,*(unsigned char**)arg);
|
|
1348 return TVI_CONTROL_TRUE;
|
|
1349 case TV_VBI_CONTROL_GET_VBIPAGE:
|
|
1350 if(!priv->on)
|
|
1351 return TVI_CONTROL_FALSE;
|
|
1352 prepare_visible_page(priv);
|
|
1353 *(void **)arg=priv->display_page;
|
|
1354 return TVI_CONTROL_TRUE;
|
|
1355 }
|
|
1356 return TVI_CONTROL_UNKNOWN;
|
|
1357 }
|