Mercurial > mplayer.hg
view stream/tvi_vbi.c @ 23927:91ccac9cc015
Add test for GNUisms
It currently tests for case ... ranges only, but other tests (like GNU
extensions to libc) can be added later
| author | ivo |
|---|---|
| date | Mon, 30 Jul 2007 18:08:26 +0000 |
| parents | 39b21ffcee44 |
| children | c6becdb359d7 |
line wrap: on
line source
/* * Teletext support * Copyright (C) 2007 Vladimir Voroshilov <voroshil@gmail.com> * * This file is part of MPlayer. * * MPlayer is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * MPlayer is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with MPlayer; if not, write to the Free Software * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA * * * Based on Attila Otvos' teletext patch, Michael Niedermayer's * proof-of-concept teletext capture utility and some parts * (decode_raw_line_runin,pll_add,pll_reset) of MythTV project. * * * Some implementation details: * How to port teletext to another tvi_* driver (see tvi_v4l2.c for example): * * 1. Implement TVI_CONTROL_VBI_INIT (initialize driver-related vbi subsystem, * start grabbing thread) * input data: vbi device name. * (driver should also call TV_VBI_CONTROL_START for common vbi subsystem initialization * with pointer to initialized tt_stream_properties structure. * After ioctl call variable will contain pointer to initialized priv_vbi_t structure. * * 2. After receiving next chunk of raw vbi data call TV_VBI_CONTROL_DECODE_PAGE * ioctl with pointer to data buffer * 3. pass all other VBI related ioctl cmds to teletext_control routine * * Page displaying process consist of following stages: * * ---grabbing stage--- * 0. stream/tvi_*.c: vbi_grabber(...) * getting vbi data from video device * ---decoding stage--- * 1. stream/tvi_vbi.c: decode_raw_line_runin(...) or decode_raw_line_sine(...) * decode raw vbi data into sliced 45(?) bytes long packets * 2. stream/tvi_vbi.c: decode_pkt0(...), decode_pkt_page(...) * packets processing (header analyzing, storing complete page in cache, * only raw member of tt_char is filled at this stage) * 3. stream/tvi_vbi.c: decode_page(...) * page decoding. filling unicode,gfx,ctl,etc members of tt_char structure * with appropriate values according to teletext control chars, converting * text to utf8. * ---rendering stage--- * 4. stream/tvi_vbi.c: prepare_visible_page(...) * processing page. adding number of just received by background process * teletext page, adding current time,etc. * 5. libvo/sub.c: vo_update_text_teletext(...) * rendering displayable osd with text and graphics * * TODO: * v4lv1,bktr support * spu rendering * is better quality on poor signal possible ? * link support * font autoscale * greyscale osd * slave command for dumping pages * fix bcd<->dec as suggested my Michael * * BUGS: * wrong colors in debug dump * blinking when visible page was just updated */ #include "config.h" #include <stdlib.h> #include <string.h> #include <unistd.h> #include <errno.h> #include <math.h> #include <stdio.h> #include <pthread.h> #include "tv.h" #include "mp_msg.h" #include "help_mp.h" #include "libmpcodecs/img_format.h" #include "libavutil/common.h" #include "input/input.h" //#define DEBUG_DUMP 1 /// page magazine entry structure typedef struct mag_s{ tt_page* pt; int order; int lang; } mag_t; typedef struct { int on; ///< teletext on/off int pagenum; ///< seek page number int subpagenum; ///< seek subpage int curr_pagenum; ///< current page number int pagenumdec; ///< set page num with dec teletext_format tformat; ///< see teletext_format enum teletext_zoom zoom; ///< see teletext_zoom enum mag_t* mag; ///< pages magazine (has 8 entities) /// Currently displayed page (with additional info, e.g current time) tt_char display_page[VBI_ROWS*VBI_COLUMNS]; /// number of raw bytes between two subsequent encoded bits int bpb; /// clock run-in sequence will be searched in buffer in [soc:eoc] bytes range int soc; int eoc; /// minimum number of raw vbi bytes wich can be decoded into 8 data bits int bp8bl; /// maximum number of raw vbi bytes wich can be decoded into 8 data bits int bp8bh; int pll_adj; int pll_dir; int pll_cnt; int pll_err; int pll_lerr; int pll_fixed; /// vbi stream properties (buffer size,bytes per line, etc) tt_stream_props* ptsp; pthread_mutex_t buffer_mutex; tt_page** ptt_cache; unsigned char* ptt_cache_first_subpage; } priv_vbi_t; static unsigned char fixParity[256]; static tt_char tt_space={0x20,7,0,0,0,0,0x20}; static tt_char tt_error={'?',1,0,0,0,0,'?'}; // Red '?' on black background static double si[12]; static double co[12]; #define VBI_FORMAT(priv) (*(priv->ptsp)) #define FIXP_SH 16 #define ONE_FIXP (1<<FIXP_SH) #define FIXP2INT(a) ((a)>>FIXP_SH) #define ANY2FIXP(a) ((int)((a)*ONE_FIXP)) static const unsigned char corrHamm48[256]={ 0x01, 0xff, 0x01, 0x01, 0xff, 0x00, 0x01, 0xff, 0xff, 0x02, 0x01, 0xff, 0x0a, 0xff, 0xff, 0x07, 0xff, 0x00, 0x01, 0xff, 0x00, 0x00, 0xff, 0x00, 0x06, 0xff, 0xff, 0x0b, 0xff, 0x00, 0x03, 0xff, 0xff, 0x0c, 0x01, 0xff, 0x04, 0xff, 0xff, 0x07, 0x06, 0xff, 0xff, 0x07, 0xff, 0x07, 0x07, 0x07, 0x06, 0xff, 0xff, 0x05, 0xff, 0x00, 0x0d, 0xff, 0x06, 0x06, 0x06, 0xff, 0x06, 0xff, 0xff, 0x07, 0xff, 0x02, 0x01, 0xff, 0x04, 0xff, 0xff, 0x09, 0x02, 0x02, 0xff, 0x02, 0xff, 0x02, 0x03, 0xff, 0x08, 0xff, 0xff, 0x05, 0xff, 0x00, 0x03, 0xff, 0xff, 0x02, 0x03, 0xff, 0x03, 0xff, 0x03, 0x03, 0x04, 0xff, 0xff, 0x05, 0x04, 0x04, 0x04, 0xff, 0xff, 0x02, 0x0f, 0xff, 0x04, 0xff, 0xff, 0x07, 0xff, 0x05, 0x05, 0x05, 0x04, 0xff, 0xff, 0x05, 0x06, 0xff, 0xff, 0x05, 0xff, 0x0e, 0x03, 0xff, 0xff, 0x0c, 0x01, 0xff, 0x0a, 0xff, 0xff, 0x09, 0x0a, 0xff, 0xff, 0x0b, 0x0a, 0x0a, 0x0a, 0xff, 0x08, 0xff, 0xff, 0x0b, 0xff, 0x00, 0x0d, 0xff, 0xff, 0x0b, 0x0b, 0x0b, 0x0a, 0xff, 0xff, 0x0b, 0x0c, 0x0c, 0xff, 0x0c, 0xff, 0x0c, 0x0d, 0xff, 0xff, 0x0c, 0x0f, 0xff, 0x0a, 0xff, 0xff, 0x07, 0xff, 0x0c, 0x0d, 0xff, 0x0d, 0xff, 0x0d, 0x0d, 0x06, 0xff, 0xff, 0x0b, 0xff, 0x0e, 0x0d, 0xff, 0x08, 0xff, 0xff, 0x09, 0xff, 0x09, 0x09, 0x09, 0xff, 0x02, 0x0f, 0xff, 0x0a, 0xff, 0xff, 0x09, 0x08, 0x08, 0x08, 0xff, 0x08, 0xff, 0xff, 0x09, 0x08, 0xff, 0xff, 0x0b, 0xff, 0x0e, 0x03, 0xff, 0xff, 0x0c, 0x0f, 0xff, 0x04, 0xff, 0xff, 0x09, 0x0f, 0xff, 0x0f, 0x0f, 0xff, 0x0e, 0x0f, 0xff, 0x08, 0xff, 0xff, 0x05, 0xff, 0x0e, 0x0d, 0xff, 0xff, 0x0e, 0x0f, 0xff, 0x0e, 0x0e, 0xff, 0x0e }; enum { LAT_UNI=0, RUS_UNI, LANGS }; // conversion table for chars 0x20-0x7F (UTF8) // TODO: add another languages static unsigned int lang_chars[LANGS][0x60]={ { //Latin 0x20,0x21,0x22,0x23,0x24,0x25,0x26,0x27, 0x28,0x29,0x2a,0x2b,0x2c,0x2d,0x2e,0x2f, 0x30,0x31,0x32,0x33,0x34,0x35,0x36,0x37, 0x38,0x39,0x3a,0x3b,0x3c,0x3d,0x3e,0x3f, 0x40,0x41,0x42,0x43,0x44,0x45,0x46,0x47, 0x48,0x49,0x4a,0x4b,0x4c,0x4d,0x4e,0x4f, 0x50,0x51,0x52,0x53,0x54,0x55,0x56,0x57, 0x58,0x59,0x5a,0x5b,0x5c,0x5d,0x5e,0x5f, 0x60,0x61,0x62,0x63,0x64,0x65,0x66,0x67, 0x68,0x69,0x6a,0x6b,0x6c,0x6d,0x6e,0x6f, 0x70,0x71,0x72,0x73,0x74,0x75,0x76,0x77, 0x78,0x79,0x7a,0x7b,0x7c,0x7d,0x7e,0x7f }, { //Russian 0x20,0x21,0x22,0x23,0x24,0x25,0x044b,0x27, 0x28,0x29,0x2a,0x2b,0x2c,0x2d,0x2e,0x2f, 0x30,0x31,0x32,0x33,0x34,0x35,0x36,0x37, 0x38,0x39,0x3a,0x3b,0x3c,0x3d,0x3e,0x3f, 0x042e,0x0410,0x0411,0x0426,0x0414,0x0415,0x0424,0x0413, 0x0425,0x0418,0x0419,0x041a,0x041b,0x041c,0x041d,0x041e, 0x041f,0x042f,0x0420,0x0421,0x0422,0x0423,0x0416,0x0412, 0x042c,0x042a,0x0417,0x0428,0x042d,0x0429,0x0427,0x042b, 0x044e,0x0430,0x0431,0x0446,0x0434,0x0435,0x0444,0x0433, 0x0445,0x0438,0x0439,0x043a,0x043b,0x043c,0x043d,0x043e, 0x043f,0x044f,0x0440,0x0441,0x0442,0x0443,0x0436,0x0432, 0x044c,0x044a,0x0437,0x0448,0x044d,0x0449,0x0447,0x044b } }; static int lang2id (int lang){ switch(lang){ case 0: return LAT_UNI; case 3: /* Stub. My teletext provider (1TV, Russia) sets this this language code for russian teletext pages TODO: make this configurable */ return RUS_UNI; default: return LAT_UNI; } } /** * \brief convert chars from curent teletext codepage into MPlayer charset * \param p raw teletext char to decode * \param lang teletext internal language code (see lang2id) * \return UTF8 char * * \remarks * routine will analyze raw member of given tt_char structure and * fill unicode member of the same struct with appropriate utf8 code. */ static unsigned int conv2uni(unsigned int p,int lang) { if(p<0x80 && p>=0x20){ return lang_chars[lang][p-0x20]; }else return 0x20; } static void init_vbi_consts(priv_vbi_t* priv){ int i,j; double ang; for(i=0; i<256; i++){ j=i&0x7F; j^= j+j; j^= j<<2; j^= j<<4; fixParity[i]= i ^ (j&0x80) ^ 0x80; } for(i=0,ang=0; i<12; i++,ang+=M_PI/priv->bpb){ si[i]= sin(ang); co[i]= cos(ang); } priv->bpb=(priv->ptsp->sampling_rate/6937500.0)*ONE_FIXP+0.5; //FIXME: STUBS!!!! priv->soc=0; priv->eoc=92; //END STUBS!!! priv->bp8bl=0.97*8*priv->bpb/ONE_FIXP; // -3% tolerance priv->bp8bh=1.03*8*priv->bpb/ONE_FIXP; // +3% tolerance } /** * \brief calculate increased/decreased by given value page number * \param curr current page number in hexadecimal for * \param direction decimal value (can be negative) to add to value * of curr parameter * \return new page number in hexadecimal form * * VBI page numbers are represented in special hexadecimal form, e.g. * page with number 123 (as seen by user) internally has number 0x123. * and equation 0x123+8 should be equal to 0x131 instead of regular 0x12b. * * * Page numbers 0xYYY (where Y is not belongs to (0..9). * Page number belongs to [0x000,0x799] or [0x100:0x899] (first 0 can be * treated as '8') */ static int steppage(int p, int direction, int skip_hidden) { if(skip_hidden) p=(p&15)+((p>>4)&15)*10+(p>>8)*100; p+=direction; if(skip_hidden){ p=(p+800)%800; p=(p%10)+((p/10)%10)*16+(p/100)*256; } return p&0x7ff; } /* ------------------------------------------------------------------ Cache stuff ------------------------------------------------------------------ */ /** * \brief add/update entry in cache * \param priv private data structure * \param pg page to store in cache * \param line line to update (value below 0 means update entire page) */ static void put_to_cache(priv_vbi_t* priv,tt_page* pg,int line){ tt_page* pgc; //page in cache int i,count; if(line<0){ i=0; count=VBI_ROWS*VBI_COLUMNS; }else if(line<VBI_ROWS){ i=line*VBI_COLUMNS; count=(line+1)*VBI_COLUMNS; }else return; pthread_mutex_lock(&(priv->buffer_mutex)); if(!priv->ptt_cache[pg->pagenum]){ priv->ptt_cache[pg->pagenum]=calloc(1,sizeof(tt_page)); pgc=priv->ptt_cache[pg->pagenum]; }else{ pgc=priv->ptt_cache[pg->pagenum]; while(pgc->next_subpage && pgc->subpagenum!=pg->subpagenum) pgc=pgc->next_subpage; if(pgc->subpagenum!=pg->subpagenum){ pgc->next_subpage=calloc(1,sizeof(tt_page)); pgc=pgc->next_subpage; } } pgc->pagenum=pg->pagenum; pgc->subpagenum=pg->subpagenum; pgc->lang=pg->lang; pgc->flags=pg->flags; //instead of copying entire page into cache, copy only undamaged //symbols into cache for(;i<count;i++){ if(!(pg->raw[i]&0x80)) pgc->raw[i]=pg->raw[i]; else mp_msg(MSGT_TV,MSGL_DBG3,"char error. pg:%x, c[%d]=0x%x\n", pg->pagenum,i,pg->raw[i]); } pgc->active=1; pthread_mutex_unlock(&(priv->buffer_mutex)); } /** * \brief get any subpage number of given page * \param priv private data structure * \param pagenum page number to search subpages in * * \return subpage number of first found subpage which belongs to * given page number * * \note page itself is subpage too (and usually has subpage number 0) */ static inline int get_subpagenum_from_cache(priv_vbi_t* priv, int pagenum){ if (!priv->ptt_cache[pagenum]) return -1; else return priv->ptt_cache[pagenum]->subpagenum; } /** * \brief get page from cache by it page and subpage number * \param priv private data structure * \param pagenum page number * \param subpagenum subpage number * * \return pointer to tt_page structure if requested page is found * and NULL otherwise */ static inline tt_page* get_from_cache(priv_vbi_t* priv, int pagenum,int subpagenum){ tt_page* tp=priv->ptt_cache[pagenum]; while(tp && tp->subpagenum!=subpagenum) tp=tp->next_subpage; return tp; } /** * \brief clears cache * \param priv private data structure * * Deletes all tt_page structures from cache and frees allocated memory. * Only zero-filled array of pointers remains in memory */ static void clear_cache(priv_vbi_t* priv){ int i; tt_page* tp; for(i=0;i<VBI_MAX_PAGES;i++){ while(priv->ptt_cache[i]){ tp=priv->ptt_cache[i]; priv->ptt_cache[i]=tp->next_subpage; free(tp); } } } /** * \brief cache initialization * \param priv private data structure * * \note Has to be called before any cache operations! */ static void init_cache(priv_vbi_t* priv){ priv->ptt_cache=calloc(VBI_MAX_PAGES,sizeof(tt_page*)); } /** * \brief destroys cache * \param priv private data structure * * Frees all memory allocated for cache (including array of pointers). * It is safe to call this routine multiple times */ static void destroy_cache(priv_vbi_t* priv){ if(priv->ptt_cache){ clear_cache(priv); free(priv->ptt_cache); priv->ptt_cache=NULL; } } /* ------------------------------------------------------------------ Decoder stuff ------------------------------------------------------------------ */ /** * \brief converts raw teletext page into useful format (1st rendering stage) * \param pg page to decode * * Routine fills tt_char structure of each teletext_page character with proper * info about foreground and background colors, character * type (graphics/control/text). */ static void decode_page(tt_char* p,int lang,unsigned char* raw) { int c,gfx=0,lat=0; int i=0; int fg_color=0; int bg_color=0; int row,col; int separated=0; for(row=0;row<VBI_ROWS;row++) { lat=(lang==0); gfx=0; fg_color=7; bg_color=0; separated=0; for(col=0;col<VBI_COLUMNS;col++){ i=row*VBI_COLUMNS+col; c=raw[i]; p[i].raw=c; if(c&0x80){ //damaged char p[i]=tt_error; continue; } p[i].gfx=gfx?(separated?2:1):0; p[i].lng=lat?0:lang; p[i].ctl=(c&0x60)==0?1:0; p[i].fg=fg_color; p[i].bg=bg_color; if ((c&0x60)==0){ //control chars if(c>=0x08 && c<=0x0f){ }else if (c<=0x17){ //colors fg_color=c&0x0f; gfx=c>>4; }else if (c<=0x18){ }else if (c<=0x1a){ //Contiguous/Separated gfx separated=!(c&1); }else if (c<=0x1b){ lat=!lat; }else if (c<=0x1d){ bg_color=(c&1)?fg_color:0; p[i].bg=bg_color; } p[i].ctl=1; p[i].unicode=p[i].gfx?0:' '; continue; } if(gfx){ p[i].unicode=c-0x20; if (p[i].unicode>0x3f) p[i].unicode-=0x20; }else p[i].unicode=conv2uni(c,lang2id(p[i].lng)); p[i].fg=fg_color; p[i].bg=bg_color; } } } /** * \brief prepares current page for displaying * \param priv_vbi private data structure * * Routine adds some useful info (time and page number of page, grabbed by * background thread to top line of current page). Displays "No teletext" * string if no vbi data available. */ #define PRINT_HEX(dp,i,h) dp[i].unicode=((h)&0xf)>9?'A'+((h)&0xf)-10:'0'+((h)&0xf) static void prepare_visible_page(priv_vbi_t* priv){ tt_page *pg,*curr_pg; unsigned char *p; int i; pthread_mutex_lock(&(priv->buffer_mutex)); mp_msg(MSGT_TV,MSGL_DBG3,"tvi_vbi: prepare_visible_page pg:0x%x, sub:0x%x\n", priv->pagenum,priv->subpagenum); if(priv->subpagenum==-1) //no page yet priv->subpagenum=get_subpagenum_from_cache(priv,priv->pagenum); pg=get_from_cache(priv,priv->pagenum,priv->subpagenum); mp_dbg(MSGT_TV,MSGL_DBG3,"tvi_vbi: prepare_vibible_page2 pg:0x%x, sub:0x%x\n", priv->pagenum,priv->subpagenum); curr_pg=get_from_cache(priv,priv->curr_pagenum, get_subpagenum_from_cache(priv,priv->curr_pagenum)); if (!pg && !curr_pg){ p=MSGTR_TV_NoTeletext; for(i=0;i<VBI_COLUMNS && *p;i++){ GET_UTF8(priv->display_page[i].unicode,*p++,break;); } for(;i<VBI_ROWS*VBI_COLUMNS;i++) priv->display_page[i]=tt_space; pthread_mutex_unlock(&(priv->buffer_mutex)); return; } if (!pg || !pg->active){ for(i=0;i<VBI_ROWS*VBI_COLUMNS;i++){ priv->display_page[i]=tt_space; } }else{ decode_page(priv->display_page,pg->lang,pg->raw); mp_msg(MSGT_TV,MSGL_DBG3,"page #%x was decoded!\n",pg->pagenum); } PRINT_HEX(priv->display_page,0,(priv->curr_pagenum&0x700)?priv->curr_pagenum>>8:8); PRINT_HEX(priv->display_page,1,priv->curr_pagenum>>4); PRINT_HEX(priv->display_page,2,priv->curr_pagenum); priv->display_page[3].unicode=' '; priv->display_page[4].unicode=' '; switch(priv->pagenumdec>>12){ case 1: priv->display_page[5].unicode='_'; priv->display_page[6].unicode='_'; PRINT_HEX(priv->display_page,7,priv->pagenumdec); break; case 2: priv->display_page[5].unicode='_'; PRINT_HEX(priv->display_page,6,priv->pagenumdec>>4); PRINT_HEX(priv->display_page,7,priv->pagenumdec); break; default: PRINT_HEX(priv->display_page,5,(priv->pagenum&0x700)?priv->pagenum>>8:8); PRINT_HEX(priv->display_page,6,priv->pagenum>>4); PRINT_HEX(priv->display_page,7,priv->pagenum); } if(priv->subpagenum!=-1){ priv->display_page[8].unicode='.'; PRINT_HEX(priv->display_page,9,priv->subpagenum>>4); PRINT_HEX(priv->display_page,10,priv->subpagenum); }else{ priv->display_page[8].unicode=' '; priv->display_page[9].unicode=' '; priv->display_page[10].unicode=' '; } priv->display_page[11].unicode=' '; for(i=VBI_TIME_LINEPOS;i<VBI_COLUMNS;i++){ priv->display_page[i].unicode=curr_pg->raw[i]; } pthread_mutex_unlock(&(priv->buffer_mutex)); } /* ------------------------------------------------------------------ Renderer stuff ------------------------------------------------------------------ */ #ifdef DEBUG_DUMP /** * \brief renders teletext page into given file * \param pt page to render * \param f opened file descriptor * \param pagenum which page to render * \param colored use colors not implementede yet) * * Text will be UTF8 encoded */ static void render2text(tt_page* pt,FILE* f,int colored){ int i,j; unsigned int u; unsigned char buf[8]; unsigned char tmp; int pos; tt_char dp[VBI_ROWS*VBI_COLUMNS]; int color=0; int bkg=0; int c1,b1; if(!pt) return; fprintf(f,"+========================================+\n"); fprintf(f,"| lang:%d pagenum:0x%x subpagenum:%d flags:0x%x|\n", pt->lang, pt->pagenum, pt->subpagenum, 0); fprintf(f,"+----------------------------------------+\n"); decode_page(dp,pt->lang,pt->raw); for(i=0;i<VBI_ROWS;i++){ fprintf(f,"|"); if(colored) fprintf(f,"\033[40m"); for(j=0;j<VBI_COLUMNS;j++) { u=dp[i*VBI_COLUMNS+j].unicode; switch(dp[i*VBI_COLUMNS+j].fg){ case 0 ... 7: c1=30+dp[i*VBI_COLUMNS+j].fg; break; default: c1=38; break; } switch(dp[i*VBI_COLUMNS+j].bg){ case 0 ... 7: b1=40+dp[i*VBI_COLUMNS+j].bg; break; default: b1=40; } if (b1!=bkg && colored){ fprintf(f,"\033[%dm",b1); bkg=b1; } if(c1!=color && colored){ fprintf(f,"\033[%dm",c1); color=c1; } if(dp[i*VBI_COLUMNS+j].gfx){ fprintf(f,"*"); }else{ pos=0; PUT_UTF8(u,tmp,if(pos<7) buf[pos++]=tmp;); buf[pos]='\0'; fprintf(f,"%s",buf); } } if (colored) fprintf(f,"\033[0m"); color=-1;bkg=-1; fprintf(f,"|\n"); } #if 1 //for debug fprintf(f,"+====================raw=================+\n"); for(i=0;i<VBI_ROWS;i++){ for(j=0;j<VBI_COLUMNS;j++) fprintf(f,"%02x ",dp[i*VBI_COLUMNS+j].raw); fprintf(f,"\n"); } fprintf(f,"+====================lng=================+\n"); for(i=0;i<VBI_ROWS;i++){ for(j=0;j<VBI_COLUMNS;j++) fprintf(f,"%02x ",dp[i*VBI_COLUMNS+j].lng); fprintf(f,"\n"); } #endif fprintf(f,"+========================================+\n"); } /** * \brief dump page into pgXXX.txt file in vurrent directory * \param pt page to dump * * \note XXX in filename is page number * \note use only for debug purposes */ static void dump_page(tt_page* pt) { FILE*f; char name[100]; snprintf(name,99,"pg%x.txt",pt->pagenum); f=fopen(name,"wb"); render2text(pt,f,1); fclose(f); } #endif //DEBUG_DUMP /** * \brief checks whether page is ready and copies it into cache array if so * \param priv private data structure * \param magAddr page's magazine address (0-7) * * Routine also calls decode_page to perform 1st stage of rendering */ static void store_in_cache(priv_vbi_t* priv, int magAddr, int line){ mp_msg(MSGT_TV,MSGL_DBG2,"store_in_cache(%d): pagenum:%x\n", priv->mag[magAddr].order, priv->mag[magAddr].pt->pagenum); put_to_cache(priv,priv->mag[magAddr].pt,line); priv->curr_pagenum=priv->mag[magAddr].pt->pagenum; #ifdef DEBUG_DUMP dump_page(get_from_cache(priv, priv->mag[magAddr].pt->pagenum, priv->mag[magAddr].pt->subpagenum)); #endif } /* ------------------------------------------------------------------ Grabber stuff ------------------------------------------------------------------ */ #define PLL_SAMPLES 4 #define PLL_ERROR 4 #define PLL_ADJUST 4 /** * \brief adjust current phase for better signal decoding * \param n count of bytes processed (?) * \param err count of error bytes (?) * * \remarks code was got from MythTV project */ static void pll_add(priv_vbi_t* priv,int n,int err){ if(priv->pll_fixed) return; if(err>PLL_ERROR*2/3) err=PLL_ERROR*2/3; priv->pll_err+=err; priv->pll_cnt+=n; if(priv->pll_cnt<PLL_SAMPLES) return; if(priv->pll_err>PLL_ERROR) { if(priv->pll_err>priv->pll_lerr) priv->pll_dir= -priv->pll_dir; priv->pll_lerr=priv->pll_err; priv->pll_adj+=priv->pll_dir; if (priv->pll_adj<-PLL_ADJUST || priv->pll_adj>PLL_ADJUST) { priv->pll_adj=0; priv->pll_dir=-1; priv->pll_lerr=0; } mp_msg(MSGT_TV,MSGL_DBG3,"vbi: pll_adj=%2d\n",priv->pll_adj); } priv->pll_cnt=0; priv->pll_err=0; } /** * \brief reset error correction * \param priv private data structure * \param fine_tune shift value for adjusting * * \remarks code was got from MythTV project */ static void pll_reset(priv_vbi_t* priv,int fine_tune){ priv->pll_fixed=fine_tune >= -PLL_ADJUST && fine_tune <= PLL_ADJUST; priv->pll_err=0; priv->pll_lerr=0; priv->pll_cnt=0; priv->pll_dir=-1; priv->pll_adj=0; if(priv->pll_fixed) priv->pll_adj=fine_tune; if(priv->pll_fixed) mp_msg(MSGT_TV,MSGL_DBG3,"pll_reset (fixed@%2d)\n",priv->pll_adj); else mp_msg(MSGT_TV,MSGL_DBG3,"pll_reset (auto)\n"); } /** * \brief decode packet 0 (teletext page header) * \param priv private data structure * \param data raw teletext data (with not applied hamm correction yet) * \param magAddr teletext page's magazine address * * \remarks * data buffer was shifted by 6 and now contains: * 0..1 page number * 2..5 sub-code * 6..7 control codes * 8..39 display data * * only first 8 bytes protected by Hamm 8/4 code */ static int decode_pkt0(priv_vbi_t* priv,unsigned char* data,int magAddr) { int d[8]; int i,err; if (magAddr<0 || magAddr>7) return 0; for(i=0;i<8;i++){ d[i]= corrHamm48[ data[i] ]; if(d[i]&0x80){ pll_add(priv,2,4); if(priv->mag[magAddr].pt) free(priv->mag[magAddr].pt); priv->mag[magAddr].pt=NULL; priv->mag[magAddr].order=0; return 0; } } if (!priv->mag[magAddr].pt) priv->mag[magAddr].pt= malloc(sizeof(tt_page)); priv->mag[magAddr].lang= d[7] & 0x7; priv->mag[magAddr].pt->lang=priv->mag[magAddr].lang; priv->mag[magAddr].pt->subpagenum=(d[2]|(d[3]<<4)|(d[4]<<8)|(d[5]<<12))&0x3f7f; priv->mag[magAddr].pt->pagenum=(magAddr<<8) | d[0] | (d[1]<<4); priv->mag[magAddr].pt->flags=( d[6] | (d[7]<<4)); memset(priv->mag[magAddr].pt->raw, 0x00, VBI_COLUMNS*VBI_ROWS); priv->mag[magAddr].order=0; for(i=0;i<8;i++){ priv->mag[magAddr].pt->raw[i]=0x20; } err=0; for(i=8; i<VBI_COLUMNS; i++){ data[i]= fixParity[data[i]]; priv->mag[magAddr].pt->raw[i]=data[i]; if(data[i]&0x80) //Error err++; pll_add(priv,1,err); } store_in_cache(priv,magAddr,0); return 1; } /** * \brief decode packets 1..24 (teletext page header) * \param priv private data structure * \param data raw teletext data * \param magAddr teletext page's magazine address * \param rowAddr teletext page's row number * * \remarks * data buffer was shifted by 6 and now contains 40 bytes of display data: * this type of packet is not proptected by Hamm 8/4 code */ static void decode_pkt_page(priv_vbi_t* priv,unsigned char*data,int magAddr,int rowAddr){ int i,err; if (!priv->mag[magAddr].pt) return; priv->mag[magAddr].order=rowAddr; err=0; for(i=0; i<VBI_COLUMNS; i++){ data[i]= fixParity[ data[i] ]; priv->mag[magAddr].pt->raw[i+rowAddr*VBI_COLUMNS]=data[i]; if( data[i]&0x80) //HammError err++; } pll_add(priv,1,err); store_in_cache(priv,magAddr,rowAddr); } /** * \brief decodes raw vbi data (signal amplitudes) into sequence of bytes * \param priv private data structure * \param buf raw vbi data (one line of frame) * \param data output buffer for decoded bytes (at least 45 bytes long) * * Used XawTV's algorithm. Signal phase is calculated with help of starting clock * run-in sequence (min/max values and bit distance values are calculated) */ static int decode_raw_line_runin(priv_vbi_t* priv,unsigned char* buf,unsigned char* data){ const int magic= 0x27; // reversed 1110010 int dt[256],hi[6],lo[6]; int i,x,r; int decoded; int sync; unsigned char min,max; int thr=0; //threshold //stubs int soc=0; int eoc=92; for(i=soc;i<eoc;i++) dt[i]=buf[i+priv->bpb/ONE_FIXP]-buf[i]; // amplifies the edges best. /* set barrier */ for (i=eoc; i<eoc+16; i+=2) dt[i]=100, dt[i+1]=-100; /* find 6 rising and falling edges */ for (i=soc, x=0; x<6; ++x) { while (dt[i]<32) i++; hi[x]=i; while (dt[i]>-32) i++; lo[x]=i; } if (i>=eoc) { return 0; // not enough periods found } i=hi[5]-hi[1]; // length of 4 periods (8 bits) if (i<priv->bp8bl || i>priv->bp8bh) { mp_msg(MSGT_TV,MSGL_DBG3,"vbi: wrong freq %d (%d,%d)\n", i,priv->bp8bl,priv->bp8bh); return 0; // bad frequency } /* AGC and sync-reference */ min=255, max=0, sync=0; for (i=hi[4]; i<hi[5]; ++i) if (buf[i]>max) max=buf[i], sync=i; for (i=lo[4]; i<lo[5]; ++i) if (buf[i]<min) min=buf[i]; thr=(min+max)/2; buf+=sync; // searching for '11' for(i=priv->pll_adj*priv->bpb/10;i<16*priv->bpb;i+=priv->bpb) if(buf[FIXP2INT(i)]>thr && buf[FIXP2INT(i+priv->bpb)]>thr) break; r=0; for(decoded=1; decoded<= (VBI_COLUMNS+3)<<3;decoded++){ r>>=1; if(buf[FIXP2INT(i)]>thr) r|=0x80; if(!(decoded & 0x07)){ data[(decoded>>3) - 1]=r; r=0; } i+=priv->bpb; } if(data[0]!=magic) return 0; //magic not found //stub for(i=0;i<43;i++){ data[i]=data[i+1]; } mp_msg(MSGT_TV,MSGL_DBG3,"thr:%d sync:%d ",thr,sync); return 1; } /** * \brief decodes raw vbi data (signal amplitudes) into sequence of bytes * \param priv private data structure * \param buf raw vbi data (one line of frame) * \param data output buffer for decoded bytes (at least 45 bytes long) * * Used Michael Niedermayer's algorithm. * Signal phase is calculated using correlation between given samples data and * pure sine */ static int decode_raw_line_sine(priv_vbi_t* priv,unsigned char* buf,unsigned char* data){ int i,x,r,amp,xFixp; int avg=0; double sin_sum=0, cos_sum=0; for(x=0; x< FIXP2INT(10*priv->bpb); x++) avg+=buf[x]; avg/=FIXP2INT(10*priv->bpb); for(x=0; x<12; x++){ amp= buf[x<<1]; sin_sum+= si[x]*(amp-avg); cos_sum+= co[x]*(amp-avg); } //this is always zero. Why ? xFixp= atan(sin_sum/cos_sum)*priv->bpb/M_PI; //Without this line the result is full of errors //and routine is unable to find magic sequence buf+=FIXP2INT(10*priv->bpb); r=0; for(x=FIXP2INT(xFixp);x<70;x=FIXP2INT(xFixp)){ r=(r<<1) & 0xFFFF; if(buf[x]>avg) r|=1; xFixp+=priv->bpb; if(r==0xAAE4) break; } //this is not teletext if (r!=0xaae4) return 0; //Decode remaining 45-2(clock run-in)-1(framing code)=42 bytes for(i=1; i<=(42<<3); i++){ r>>=1; x=FIXP2INT(xFixp); if(buf[x]> avg) r|=0x80; if(!(i & 0x07)){ data[(i>>3)-1]=r; r=0; } xFixp+=priv->bpb; } return 1; } /** * \brief decodes all vbi lines from one video frame * \param priv private data structure * \param buf buffer with raw vbi data in it * * \note buffer size have to be at least priv->ptsp->bufsize bytes */ static void vbi_decode(priv_vbi_t* priv,unsigned char*buf){ int magAddr; int pkt; unsigned char data[64]; unsigned char* linep; int d0,d1; int i=0; mp_msg(MSGT_TV,MSGL_DBG3,"vbi: vbi_decode\n"); for(linep=buf; linep<buf+priv->ptsp->bufsize; linep+=priv->ptsp->samples_per_line,i++){ #if 0 /* This routine is alternative implementation of raw VBI data decoding. Unfortunately, it detects only about 20% of incoming data, but Michael says that this algorithm is better, and he wants to fix it. */ if(decode_raw_line_sine(priv,linep,data)<=0){ #endif if(decode_raw_line_runin(priv,linep,data)<=0){ continue; //this is not valid teletext line } d0= corrHamm48[ data[0] ]; d1= corrHamm48[ data[1] ]; if(d0&0x80 || d1&0x80){ pll_add(priv,2,4); mp_msg(MSGT_TV,MSGL_V,"vbi_decode(%d):HammErr after decode_raw_line\n",i); continue; //hamError } magAddr=d0 & 0x7; pkt=(d0>>3)|(d1<<1); mp_msg(MSGT_TV,MSGL_DBG3,"vbi_decode(%d):%x %x (mag:%x, pkt:%d)\n", i,d0,d1,magAddr,pkt); if(!pkt){ decode_pkt0(priv,data+2,magAddr); //skip MRGA }else if(pkt>0 && pkt<VBI_ROWS){ if(!priv->mag[magAddr].pt) continue; decode_pkt_page(priv,data+2,magAddr,pkt);//skip MRGA } else { mp_msg(MSGT_TV,MSGL_DBG3,"unsupported packet:%d\n",pkt); } } } /* --------------------------------------------------------------------------------- Public routines --------------------------------------------------------------------------------- */ /** * \brief toggles teletext page displaying format * \param priv_vbi private data structure * \param flag new format * \return * TVI_CONTROL_TRUE is success, * TVI_CONTROL_FALSE otherwise * * flag: * 0 - opaque * 1 - transparent * 2 - opaque with black foreground color (only in bw mode) * 3 - transparent with black foreground color (only in bw mode) */ static int teletext_set_format(priv_vbi_t * priv, teletext_format flag) { flag&=3; mp_msg(MSGT_TV,MSGL_DBG3,"teletext_set_format_is called. mode:%d\n",flag); pthread_mutex_lock(&(priv->buffer_mutex)); priv->tformat=flag; priv->pagenumdec=0; pthread_mutex_unlock(&(priv->buffer_mutex)); return TVI_CONTROL_TRUE; } /** * \brief append just entered digit to editing page number * \param priv_vbi private data structure * \param dec decimal digit to append * * dec: * '0'..'9' append digit * '-' remove last digit (backspace emulation) * * This routine allows user to jump to arbitrary page. * It implements simple page number editing algorithm. * * Subsystem can be on one of two modes: normal and page number edit mode. * Zero value of priv->pagenumdec means normal mode * Non-zero value means page number edit mode and equals to packed * decimal number of already entered part of page number. * * How this works. * Let's assume that current mode is normal (pagenumdec is zero), teletext page * 100 are displayed as usual. topmost left corner of page contains page number. * Then vbi_add_dec is sequentially called (through slave * command of course) with 1,4,-,2,3 * values of dec parameter. * * +-----+------------+------------------+ * | dec | pagenumdec | displayed number | * +-----+------------+------------------+ * | | 0x000 | 100 | * +-----+------------+------------------+ * | 1 | 0x001 | __1 | * +-----+------------+------------------+ * | 4 | 0x014 | _14 | * +-----+------------+------------------+ * | - | 0x001 | __1 | * +-----+------------+------------------+ * | 2 | 0x012 | _12 | * +-----+------------+------------------+ * | 3 | 0x123 | 123 | * +-----+------------+------------------+ * | | 0x000 | 123 | * +-----+------------+------------------+ * * pagenumdec will automatically receive zero value after third digit of page * number is entered and current page will be switched to another one with * entered page number. */ static void vbi_add_dec(priv_vbi_t * priv, char *dec) { int count, shift; if (!dec) return; if (!priv->on) return; if ((*dec<'0' || *dec>'9') && *dec!='-') return; if (!priv->pagenumdec) //first digit cannot be '0','9' or '-' if(*dec=='-' || *dec=='0' || *dec=='9') return; pthread_mutex_lock(&(priv->buffer_mutex)); count=(priv->pagenumdec>>12)&0xf; if (*dec=='-') { count--; if (count) priv->pagenumdec=((priv->pagenumdec>>4)&0xfff)|(count<<12); else priv->pagenumdec=0; } else { shift = count * 4; count++; priv->pagenumdec= (((priv->pagenumdec)<<4|(*dec-'0'))&0xfff)|(count<<12); if (count==3) { priv->pagenum=priv->pagenumdec&0x7ff; priv->subpagenum=get_subpagenum_from_cache(priv,priv->pagenum); priv->pagenumdec=0; } } pthread_mutex_unlock(&(priv->buffer_mutex)); } /** * \brief Teletext control routine * \param priv_vbi private data structure * \param cmd command * \param arg command parameter (has to be not null) */ int teletext_control(void* p, int cmd, void *arg) { int fine_tune=99; priv_vbi_t* priv=(priv_vbi_t*)p; if (!priv && cmd!=TV_VBI_CONTROL_START) return TVI_CONTROL_FALSE; if (!arg && cmd!=TV_VBI_CONTROL_STOP) return TVI_CONTROL_FALSE; switch (cmd) { case TV_VBI_CONTROL_RESET: { tv_param_t* tv_param=arg; pthread_mutex_lock(&(priv->buffer_mutex)); priv->pagenumdec=0; clear_cache(priv); priv->pagenum=steppage(0,tv_param->tpage&0x7ff,1); priv->tformat=tv_param->tformat; priv->subpagenum=0; pll_reset(priv,fine_tune); pthread_mutex_unlock(&(priv->buffer_mutex)); return TVI_CONTROL_TRUE; } case TV_VBI_CONTROL_START: { int i; tt_stream_props* ptsp=*(tt_stream_props**)arg; if(!ptsp) return TVI_CONTROL_FALSE; priv=calloc(1,sizeof(priv_vbi_t)); priv->ptsp=malloc(sizeof(tt_stream_props)); memcpy(priv->ptsp,ptsp,sizeof(tt_stream_props)); *(priv_vbi_t**)arg=priv; priv->subpagenum=0; pthread_mutex_init(&priv->buffer_mutex, NULL); priv->pagenumdec=0; for(i=0;i<VBI_ROWS*VBI_COLUMNS;i++) priv->display_page[i]=tt_space; priv->mag=calloc(8,sizeof(mag_t)); init_cache(priv); init_vbi_consts(priv); pll_reset(priv,fine_tune); return TVI_CONTROL_TRUE; } case TV_VBI_CONTROL_STOP: { if(priv->mag) free(priv->mag); if(priv->ptsp) free(priv->ptsp); destroy_cache(priv); free(priv); return TVI_CONTROL_TRUE; } case TV_VBI_CONTROL_SET_MODE: priv->on=(*(int*)arg%2); return TVI_CONTROL_TRUE; case TV_VBI_CONTROL_GET_MODE: *(int*)arg=priv->on; return TVI_CONTROL_TRUE; case TV_VBI_CONTROL_SET_FORMAT: return teletext_set_format(priv, *(int *) arg); case TV_VBI_CONTROL_GET_FORMAT: pthread_mutex_lock(&(priv->buffer_mutex)); *(int*)arg=priv->tformat; pthread_mutex_unlock(&(priv->buffer_mutex)); return TVI_CONTROL_TRUE; case TV_VBI_CONTROL_GET_HALF_PAGE: if(!priv->on) return TVI_CONTROL_FALSE; *(int *)arg=priv->zoom; return TVI_CONTROL_TRUE; case TV_VBI_CONTROL_SET_HALF_PAGE: { int val=*(int*)arg; val%=3; if(val<0) val+=3; pthread_mutex_lock(&(priv->buffer_mutex)); priv->zoom=val; pthread_mutex_unlock(&(priv->buffer_mutex)); return TVI_CONTROL_TRUE; } case TV_VBI_CONTROL_SET_PAGE: { int val=*(int *) arg; if(val<100 || val>0x899) return TVI_CONTROL_FALSE; pthread_mutex_lock(&(priv->buffer_mutex)); priv->pagenum=val&0x7ff; priv->subpagenum=get_subpagenum_from_cache(priv,priv->pagenum); priv->pagenumdec=0; pthread_mutex_unlock(&(priv->buffer_mutex)); return TVI_CONTROL_TRUE; } case TV_VBI_CONTROL_STEP_PAGE: { int direction=*(int *) arg; pthread_mutex_lock(&(priv->buffer_mutex)); priv->pagenum=steppage(priv->pagenum, direction,1); priv->subpagenum=get_subpagenum_from_cache(priv,priv->pagenum); priv->pagenumdec=0; pthread_mutex_unlock(&(priv->buffer_mutex)); return TVI_CONTROL_TRUE; } case TV_VBI_CONTROL_GET_PAGE: *(int*)arg=((priv->pagenum+0x700)&0x7ff)+0x100; return TVI_CONTROL_TRUE; case TV_VBI_CONTROL_SET_SUBPAGE: pthread_mutex_lock(&(priv->buffer_mutex)); priv->pagenumdec=0; priv->subpagenum=*(int*)arg; if(priv->subpagenum<0) priv->subpagenum=0; if(priv->subpagenum>=VBI_MAX_SUBPAGES) priv->subpagenum=VBI_MAX_SUBPAGES-1; pthread_mutex_unlock(&(priv->buffer_mutex)); return TVI_CONTROL_TRUE; case TV_VBI_CONTROL_GET_SUBPAGE: *(int*)arg=priv->subpagenum; return TVI_CONTROL_TRUE; case TV_VBI_CONTROL_ADD_DEC: vbi_add_dec(priv, *(char **) arg); return TVI_CONTROL_TRUE; case TV_VBI_CONTROL_DECODE_PAGE: vbi_decode(priv,*(unsigned char**)arg); return TVI_CONTROL_TRUE; case TV_VBI_CONTROL_GET_VBIPAGE: if(!priv->on) return TVI_CONTROL_FALSE; prepare_visible_page(priv); *(void **)arg=priv->display_page; return TVI_CONTROL_TRUE; } return TVI_CONTROL_UNKNOWN; }