Video-Capture-V4l/VBI/VBI.xs

#include "EXTERN.h"
#include "perl.h"
#include "XSUB.h"

#include <sys/types.h>
#include <unistd.h>
#include <sys/mman.h>

#include "../gppport.h"

/* loosely based on the program vbidecode.cc by Ralph Metzler */

typedef unsigned int UI;
typedef unsigned char u8;
typedef U16 u16;

/* calculates odd parity, medium-efficient */
static int
parodd(U32 data)
{
  u8 p4[16] = { 0,1,1,0, 1,0,0,1, 1,0,0,1, 0,1,1,0 };
  int parity = 1;

  do {
    parity ^= p4[data & 15];
    data >>= 4;
  } while (data);

  return parity;
}

static u8 invtab[256] = {
  0x00, 0x80, 0x40, 0xc0, 0x20, 0xa0, 0x60, 0xe0, 
  0x10, 0x90, 0x50, 0xd0, 0x30, 0xb0, 0x70, 0xf0, 
  0x08, 0x88, 0x48, 0xc8, 0x28, 0xa8, 0x68, 0xe8, 
  0x18, 0x98, 0x58, 0xd8, 0x38, 0xb8, 0x78, 0xf8, 
  0x04, 0x84, 0x44, 0xc4, 0x24, 0xa4, 0x64, 0xe4, 
  0x14, 0x94, 0x54, 0xd4, 0x34, 0xb4, 0x74, 0xf4, 
  0x0c, 0x8c, 0x4c, 0xcc, 0x2c, 0xac, 0x6c, 0xec, 
  0x1c, 0x9c, 0x5c, 0xdc, 0x3c, 0xbc, 0x7c, 0xfc, 
  0x02, 0x82, 0x42, 0xc2, 0x22, 0xa2, 0x62, 0xe2, 
  0x12, 0x92, 0x52, 0xd2, 0x32, 0xb2, 0x72, 0xf2, 
  0x0a, 0x8a, 0x4a, 0xca, 0x2a, 0xaa, 0x6a, 0xea, 
  0x1a, 0x9a, 0x5a, 0xda, 0x3a, 0xba, 0x7a, 0xfa, 
  0x06, 0x86, 0x46, 0xc6, 0x26, 0xa6, 0x66, 0xe6, 
  0x16, 0x96, 0x56, 0xd6, 0x36, 0xb6, 0x76, 0xf6, 
  0x0e, 0x8e, 0x4e, 0xce, 0x2e, 0xae, 0x6e, 0xee, 
  0x1e, 0x9e, 0x5e, 0xde, 0x3e, 0xbe, 0x7e, 0xfe, 
  0x01, 0x81, 0x41, 0xc1, 0x21, 0xa1, 0x61, 0xe1, 
  0x11, 0x91, 0x51, 0xd1, 0x31, 0xb1, 0x71, 0xf1, 
  0x09, 0x89, 0x49, 0xc9, 0x29, 0xa9, 0x69, 0xe9, 
  0x19, 0x99, 0x59, 0xd9, 0x39, 0xb9, 0x79, 0xf9, 
  0x05, 0x85, 0x45, 0xc5, 0x25, 0xa5, 0x65, 0xe5, 
  0x15, 0x95, 0x55, 0xd5, 0x35, 0xb5, 0x75, 0xf5, 
  0x0d, 0x8d, 0x4d, 0xcd, 0x2d, 0xad, 0x6d, 0xed, 
  0x1d, 0x9d, 0x5d, 0xdd, 0x3d, 0xbd, 0x7d, 0xfd, 
  0x03, 0x83, 0x43, 0xc3, 0x23, 0xa3, 0x63, 0xe3, 
  0x13, 0x93, 0x53, 0xd3, 0x33, 0xb3, 0x73, 0xf3, 
  0x0b, 0x8b, 0x4b, 0xcb, 0x2b, 0xab, 0x6b, 0xeb, 
  0x1b, 0x9b, 0x5b, 0xdb, 0x3b, 0xbb, 0x7b, 0xfb, 
  0x07, 0x87, 0x47, 0xc7, 0x27, 0xa7, 0x67, 0xe7, 
  0x17, 0x97, 0x57, 0xd7, 0x37, 0xb7, 0x77, 0xf7, 
  0x0f, 0x8f, 0x4f, 0xcf, 0x2f, 0xaf, 0x6f, 0xef, 
  0x1f, 0x9f, 0x5f, 0xdf, 0x3f, 0xbf, 0x7f, 0xff, 
};

static u8 unhamtab[256] = {
  0x01, 0xff, 0x81, 0x01, 0xff, 0x00, 0x01, 0xff, 
  0xff, 0x02, 0x01, 0xff, 0x0a, 0xff, 0xff, 0x07, 
  0xff, 0x00, 0x01, 0xff, 0x00, 0x80, 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, 0x87, 
  0x06, 0xff, 0xff, 0x05, 0xff, 0x00, 0x0d, 0xff, 
  0x86, 0x06, 0x06, 0xff, 0x06, 0xff, 0xff, 0x07, 
  0xff, 0x02, 0x01, 0xff, 0x04, 0xff, 0xff, 0x09, 
  0x02, 0x82, 0xff, 0x02, 0xff, 0x02, 0x03, 0xff, 
  0x08, 0xff, 0xff, 0x05, 0xff, 0x00, 0x03, 0xff, 
  0xff, 0x02, 0x03, 0xff, 0x03, 0xff, 0x83, 0x03, 
  0x04, 0xff, 0xff, 0x05, 0x84, 0x04, 0x04, 0xff, 
  0xff, 0x02, 0x0f, 0xff, 0x04, 0xff, 0xff, 0x07, 
  0xff, 0x05, 0x05, 0x85, 0x04, 0xff, 0xff, 0x05, 
  0x06, 0xff, 0xff, 0x05, 0xff, 0x0e, 0x03, 0xff, 
  0xff, 0x0c, 0x01, 0xff, 0x0a, 0xff, 0xff, 0x09, 
  0x0a, 0xff, 0xff, 0x0b, 0x8a, 0x0a, 0x0a, 0xff, 
  0x08, 0xff, 0xff, 0x0b, 0xff, 0x00, 0x0d, 0xff, 
  0xff, 0x0b, 0x0b, 0x8b, 0x0a, 0xff, 0xff, 0x0b, 
  0x0c, 0x8c, 0xff, 0x0c, 0xff, 0x0c, 0x0d, 0xff, 
  0xff, 0x0c, 0x0f, 0xff, 0x0a, 0xff, 0xff, 0x07, 
  0xff, 0x0c, 0x0d, 0xff, 0x0d, 0xff, 0x8d, 0x0d, 
  0x06, 0xff, 0xff, 0x0b, 0xff, 0x0e, 0x0d, 0xff, 
  0x08, 0xff, 0xff, 0x09, 0xff, 0x09, 0x09, 0x89, 
  0xff, 0x02, 0x0f, 0xff, 0x0a, 0xff, 0xff, 0x09, 
  0x88, 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, 0x8f, 0x0f, 0xff, 0x0e, 0x0f, 0xff, 
  0x08, 0xff, 0xff, 0x05, 0xff, 0x0e, 0x0d, 0xff, 
  0xff, 0x0e, 0x0f, 0xff, 0x0e, 0x8e, 0xff, 0x0e, 
};

#define VBI_BPL         2048

#define FREQ_PAL        35.468950
#define FREQ_NTSC       28.636363
#define FREQ            FREQ_PAL

#define FREQ_VT_PAL     6.9375
#define FREQ_VT_NTSC    5.72725
#define FREQ_VT         FREQ_VT_PAL /* Replace by FREQ_VT_NTSC and pray that it works */
/*#define FREQ_VT 6.165*/ /* teletext-like signal on france, 0xe7 instead of 0x27 */
#define FREQ_CRYPT      4.5     /* found on premiere */
#define FREQ_VPS        2.5     /* probably only pal */
#define FREQ_VDAT       2.0     /* videodat */
#define FREQ_VC         0.77    /* videocrypt, just ignore */

#define VBI_VT          0x0001
#define VBI_VPS         0x0002
#define VBI_VDAT        0x0004
#define VBI_VC          0x0008
#define VBI_OTHER       0x0010
#define VBI_EMPTY       0x8000

typedef long FP;

#define FP_BITS         16
#define FP_0_5          D2FP(0.5)

#define D2FP(d)         ((FP)((d) * (1<<FP_BITS) + 0.5))
#define I2FP(i)         ((FP)(i) << FP_BITS)
#define FP2I(fp)        (((fp) + FP_0_5) >> FP_BITS)

#define VT_COLS         40
#define VT_LINES        36

typedef struct {
  UI types;             /* required types */

  int offset;           /* signal offset */
  int did_agc : 1;      /* did we already do agc this frame? */

  int y;                /* the line number */
  u8 *line;             /* the current line */
  FP step;              /* the bit step */
  FP pos;               /* position */
} decoder;

static void
decoder_init (decoder *dec, UI types)
{
  dec->types = types;
  dec->did_agc = 0;
}

static void
decoder_scan_start (decoder *dec, UI a, UI b)
{
  u8 *p = dec->line + a;
  UI med = 128 - dec->offset;
  do
    {
      if (*p >= med)
        break;
    }
  while (++p < dec->line + b);

  /* find maximum */
  while (p[1] > p[0])
    p++;

  dec->pos = I2FP (p - dec->line);
}
    

static u8
get_byte (decoder *dec)
{
  u8 byte;
  int bit = 8;

  /* if the next bit is a one bit, try to re-center the decoder on it */
  if ((dec->offset + dec->line[FP2I(dec->pos)]) & 0x80)
    {
      /*if (dec->line[FP2I(dec->pos)] < dec->line[FP2I(dec->pos)+1])
        dec->pos += I2FP(1);*/ /* why is this casuing checksum errors? */
      /*if (dec->line[FP2I(dec->pos)] < dec->line[FP2I(dec->pos)-1])
        dec->pos -= I2FP(1);*/
    }

  byte=0;
  do
    {
      byte >>= 1;
      byte |= ((dec->offset + dec->line[FP2I(dec->pos)]) & 0x80);
      dec->pos += dec->step;
    }
  while (--bit);

  return byte;
}

/* get shift-encoded byte */
static u8
get_byte_SE (decoder *dec)
{
  u8 byte;
  int bit = 8;

  do
    {
      byte >>= 1;
      byte |= (dec->line[FP2I(dec->pos)]
             > dec->line[FP2I(dec->pos + dec->step/2)]) << 7;
      dec->pos += dec->step;
    }
  while (--bit);

  /* if the next bit is a one bit, try to re-center the decoder on it */
  if (dec->line[FP2I(dec->pos)] > 128-dec->offset)
    {
      if (dec->line[FP2I(dec->pos)] > dec->line[FP2I(dec->pos)+1])
        dec->pos += I2FP(1);
      if (dec->line[FP2I(dec->pos)] < dec->line[FP2I(dec->pos)-1])
        dec->pos -= I2FP(1);
    }

  return byte;
}

static u8
unham4(u8 a)
{
  return unhamtab[a] & 15;
}

static u8
unham8(u8 a, u8 b)
{
  u8 c1 = unhamtab[a];
  u8 c2 = unhamtab[b];

  if ( (c1|c2) & 0x40)
    /* 2 bit error */;

  return (c1 & 15)
       | (c2 << 4);
}

static u16 unham16(u8 a, u8 b, u8 c)
{
   U32 d = (((c << 8) | b) << 8) | c;
   int A = parodd (d & 0x555555);
   int B = parodd (d & 0x666666);
   int C = parodd (d & 0x787878);
   int D = parodd (d & 0x007f80);
   int E = parodd (d & 0x7f8000);
   int F = parodd (d & 0xffffff);
   int bit;

   d = (((d >> 16) & 0x7f) << 11)
     | (((d >>  8) & 0x7f) <<  4)
     | (((d >>  4) & 0x07) <<  1)
     | (((d >>  2) & 0x01)      );

   if (A&B&C&D&E)
     return d;
   if (F)
     return -1; /* double bit error */

   /* correct the single bit error */
   return d ^ (1 << (31 - 16*E + 8*D + 4*C + 2*B + A));
}

#define rev(byte) (invtab [(u8)(byte)])

static SV *
decode_vps (u8 *data)
{
  AV *av  = newAV ();

  char name = rev (data[3]);

  av_push (av, newSViv (VBI_VPS));
  av_push (av, newSVpvn (&name, 1));
  av_push (av, newSViv (data[4] & 3)); /* "unknown", "stereo  ", "mono   ", "dual   " */
  /* ch, day, mon, hour, min */
  av_push (av, newSViv (data[ 4] <<12 & 0xf000
                      | data[10]      & 0x00c0
                      | data[12] <<10 & 0x0c00
                      | data[13] << 2 & 0x0300
                      | data[13]      & 0x003f));
  av_push (av, newSViv (rev (data[10]) >> 1 & 31));
  av_push (av, newSViv (rev (data[10]) << 3 & 8 | rev (data[11]) >> 5));
  av_push (av, newSViv (rev (data[11]) & 31));
  av_push (av, newSViv (rev (data[12]) >> 2));
  av_push (av, newSViv (rev (data[14])));

  return newRV_noinc ((SV*)av);
}

static SV *
decode_vt (u8 *data)
{
   AV *av  = newAV ();
   u8 mpag = unham8 (data[3], data[4]);
   u8 mag = mpag & 7;
   u8 pack = (mpag & 0xf8) >> 3;

   av_push (av, newSViv (VBI_VT));
   av_push (av, newSViv (mag));
   av_push (av, newSViv (pack));
   
   switch (pack)
     {
       /* ets300-706 */
       case 0:
         av_push (av, newSVpvn (data+5, 40));
         av_push (av, newSViv  (unham8 (data[5], data[6]) | (mag << 8)));
         av_push (av, newSViv  (unham8 (data[7], data[8])
                                | (unham8 (data[9], data[10]) << 8)
                                | (unham8 (data[11], data[12]) << 16)));
         break;
       case  1: case  2: case  3: case  4: case  5: case  6: case  7: case  8: case  9: case 10:
       case 11: case 12: case 13: case 14: case 15: case 16: case 17: case 18: case 19: case 20:
       case 21: case 22: case 23: case 24: case 25:
         av_push (av, newSVpvn (data+5, 40));
         break;
       case 26: case 27: case 28: case 29: /* enhancement packets */
         av_push (av, newSViv (unham4 (data[5])));
         av_push (av, newSViv (unham16 (data[ 6], data[ 7], data[ 8])));
         av_push (av, newSViv (unham16 (data[ 9], data[10], data[11])));
         av_push (av, newSViv (unham16 (data[12], data[13], data[14])));
         av_push (av, newSViv (unham16 (data[15], data[16], data[17])));
         av_push (av, newSViv (unham16 (data[18], data[19], data[20])));
         av_push (av, newSViv (unham16 (data[21], data[22], data[23])));
         av_push (av, newSViv (unham16 (data[24], data[25], data[26])));
         av_push (av, newSViv (unham16 (data[27], data[28], data[29])));
         av_push (av, newSViv (unham16 (data[30], data[31], data[32])));
         av_push (av, newSViv (unham16 (data[33], data[34], data[35])));
         av_push (av, newSViv (unham16 (data[36], data[37], data[38])));
         av_push (av, newSViv (unham16 (data[39], data[40], data[41])));
         av_push (av, newSViv (unham16 (data[42], data[43], data[44])));
         break;
       /* ets300-706 & ets300-231 */
       case 30:
         {
           UI dc = unham4 (data[5]);
           av_push (av, newSViv (dc));
           if ((dc >> 1) == 0)
             {
               av_push (av, newSViv (unham8 (data[6], data[7]) | (mag << 8)));
               av_push (av, newSViv (unham8 (data[8], data[9])
                                     | unham8 (data[10], data[11]) << 8));
               av_push (av, newSViv (rev (data[12]) << 8 | rev (data[13])));
             }
           else if ((dc >> 1) == 8)
             {
               /* pdc */
             }
         }
         break;
       case 31:
         {
           UI ft = unham4 (data[5]);
           UI al = unham4 (data[6]);
           UI i, addr = 0;

           /* ets300-708, IDL */
           /* http://sunsite.cnlab-switch.ch/ftp/mirror/internet-drafts/draft-ietf-ipvbi-tv-signal-00.txt */

           for(i=0; i<al&7; i++)
             addr = addr << 4 | unham4 (data[i+7]);

           av_push (av, newSViv (ft));
           av_push (av, newSViv (addr));
           break;
         }
       default:
         av_push (av, newSVpvn (data+5, 40));
     }
   return newRV_noinc ((SV*)av);
}

static SV *
decoder_decode_other (decoder *dec)
{
   AV *av  = newAV ();
   FP pos = dec->pos;
   u8 data[6];

   av_push (av, newSViv (VBI_OTHER));

   dec->step = D2FP (FREQ / FREQ_CRYPT); /* found on premiere */
   data [0] = get_byte (dec);
   data [1] = get_byte (dec);
   data [2] = get_byte (dec);
   if (data[0] == 0x55 && data[1] == 0xd0 && data[2] == 0x18)
     {
       /* premiere */
       av_push (av, newSViv (1));
     }
   else
     av_push (av, newSViv (0));

   return newRV_noinc ((SV*)av);
}

static SV *
decode_empty ()
{
   AV *av  = newAV ();
   av_push (av, newSViv (VBI_EMPTY));
   return newRV_noinc ((SV*)av);
}

static SV *
decoder_decode (decoder *dec, UI y, u8 *line)
{
  UI type;
  u8 data[45];                  /* 45 bytes per line are max. */
  UI i;
  int did_agc;

  type = VBI_VT | VBI_EMPTY | VBI_OTHER | VBI_VC;       /* can be everywhere */
  if (y == 16 - 7) type |= VBI_VPS;
  if (y >  17 - 7) type |= VBI_VDAT;

  type &= dec->types;

  /* don't do anything unless we need to */
  if (type)
    {
      dec->line = line;
      dec->y = y;
      dec->pos = 0;

      did_agc = dec->did_agc;

      /* maybe do agc? */
      if (!dec->did_agc || y == 20-7)
        {
          u8 *n = line + 120;
          u8 max = 0, min = 255;
          do
            {
              if (*n > max) max = *n;
              if (*n < min) min = *n;
            }
          while (++n < line + 300);

          if (max > min + 30)
            {
              dec->offset = 128 - (((int)max + (int)min) >> 1);
              dec->did_agc = 1;
            }
        }

      if (dec->did_agc)
        {
          if (type & VBI_VT)
            {
              dec->step = D2FP (FREQ / FREQ_VT);
              decoder_scan_start (dec, 50, 350);

              data[0] = get_byte (dec);
              if ((data[0] & 0xfe) == 0x54)
                {
                  data[1] = get_byte (dec);
                  switch (data[1])
                    {
                    case 0x27:
                      dec->pos -= dec->step * 2;
                    case 0x4e:
                      dec->pos -= dec->step * 2;
                    case 0x9d:
                      dec->pos -= dec->step * 2;
                    case 0x75:
                      dec->pos -= dec->step * 2;
                    case 0xd5:
                      dec->pos -= dec->step * 2;
                      data[1] = 0x55;
                    case 0x55:
                      break;
                    default:
                      ; /* no teletext page */
                    }

                  if (data[1] == 0x55)
                    {
                      data[2] = get_byte (dec);
                      if (data[2] == 0x27 || data[2] == 0xe7)
                        {
                          for (i = 3; i < 45; i++)
                            data[i] = get_byte (dec);
                          return decode_vt (data);
                        }
                    }
                }
            }

          if (type & VBI_VPS)
            {
              decoder_scan_start (dec, 150, 260);
              dec->step = D2FP (FREQ / FREQ_VPS);       /* shift encoding, two "pixels"/bit (skip the 2nd) */
              data[0] = get_byte_SE (dec);
              if (data[0] == 0xff)
                {
                  data[1] = get_byte_SE (dec);
                  if (data[1] == 0x5d || data[1] == 0x5f)
                    {
                      for (i = 2; i < 16; i++)
                        data[i] = get_byte_SE (dec);
                      return decode_vps (data);
                    }
                }
            }

#if 0
          if (type & VBI_VDAT)
            {
              dec->step = D2FP (FREQ / FREQ_VDAT);
              decoder_scan_start (dec, 150, 200);
            }

          if (type & VBI_VC)
            {
              dec->step = D2FP (FREQ / FREQ_VC);
              decoder_scan_start (dec, 150, 200);
            }
#endif

          /* watch out for empty lines, test signals etc.. */
          if (type & VBI_OTHER)
            {
              dec->did_agc = did_agc; /* other signals do not affect agc, yet */

              dec->step = D2FP (FREQ);
              decoder_scan_start (dec, 100, 500);
              if (dec->pos < I2FP (450))
                return decoder_decode_other (dec);
            }
        }

      dec->did_agc = did_agc;

      if (type & VBI_EMPTY)
        return decode_empty ();
    }

  return 0;
}

/* vtx decoding routines taken from videotext-0.6.971023,
 * Copyright (c) 1994-96 Martin Buck */

#define VTX_COLMASK 0x07
#define VTX_BGMASK  (0x07 << 3)
#define VTX_G1      (1 << 6)
#define VTX_GRSEP   (1 << 8)
#define VTX_HIDDEN  (1 << 9)
#define VTX_BOX     (1 << 10)
#define VTX_FLASH   (1 << 11)
#define VTX_DOUBLE1 (1 << 12)
#define VTX_DOUBLE2 (1 << 13)
#define VTX_INVERT  (1 << 14)
#define VTX_DOUBLE  (VTX_DOUBLE1 | VTX_DOUBLE2)

static const u8 g0_to_iso_table[256] =
  "                                "
  " !\"#$%&'()*+,-./0123456789:;<=>?"
  "@ABCDEFGHIJKLMNOPQRSTUVWXYZAOU^#"
  "-abcdefghijklmnopqrstuvwxyzaous#"
  "                                "
  "                                "
  "                                "
  "                                ";

/* one-to-one copy */
static int
decode_vtpage (u8 *src, UI lines, u8 *chr, u16 *attr)
{
  UI line, col, pos, graphics, grhold, doubleht, nextattr = 0;
  u16 *lastattr, default_attrib = 7, next_attrib;
  u8 c, *lastchr, default_chr = ' ';
  UI lang;
  
  lang = 4;
  pos = 0;
  doubleht = 0;

  for (line = 0; line < lines; line++) {
    lastchr = &default_chr;
    lastattr = &default_attrib;
    graphics = grhold = 0;
    if (doubleht && pos > 40) {
      for (col = 0; col <= 39; col++) {
        if (attr[pos - 40] & VTX_DOUBLE1) {
          chr[pos] = chr[pos - 40];
          chr[pos - 40] = ' ';
          attr[pos] = (attr[pos - 40] & ~VTX_DOUBLE1) | VTX_DOUBLE2;
        } else {
          chr[pos] = ' ';
          attr[pos] = attr[pos - 40];
        }
        pos++;
      }
      doubleht = 0;
    } else {
      for (col = 0; col <= 39; col++) {
        c = src[pos];
        if (parodd(c)) {
          chr[pos] = 254;                                       /* Parity error */
          attr[pos] = 7;
          /* return 0 */ /*?*/
        } else if ((c & 0x7f) >= 32) {                  /* Normal character */
          c &= 0x7f;
          if (!graphics || (c >= 64 && c <= 95)) {
            chr[pos] = g0_to_iso_table [c];
            attr[pos] = *lastattr;
          } else {
            chr[pos] = c + (c >= 96 ? 64 : 96);
            attr[pos] = *lastattr | VTX_G1;
          }
        } else {
          c &= 0x7f;
          chr[pos] = ((grhold && graphics ) ? *lastchr : ' ');
          if (c <= 7) {                                 /* Set alphanumerics-color */
            attr[pos] = *lastattr;
            next_attrib = (*lastattr & ~(VTX_COLMASK | VTX_HIDDEN)) + c;
            nextattr = 1;
            graphics = 0;
          } else if (c == 8 || c == 9) {                        /* Flash on/off */
            attr[pos] = (*lastattr & ~VTX_FLASH) + VTX_FLASH * (c == 8);
          } else if (c == 10 || c == 11) {                      /* End/start box */
            attr[pos] = (*lastattr & ~VTX_BOX) + VTX_BOX * (c == 11);
          } else if (c == 12 || c == 13) {                      /* Normal/double height */
            attr[pos] = (*lastattr & ~VTX_DOUBLE1) + VTX_DOUBLE1 * (c == 13);
            if (c == 13)
              doubleht = 1;
          } else if (c == 14 || c == 15 || c == 27) {   /* SO, SI, ESC (ignored) */
            attr[pos] = *lastattr;
          } else if (c >= 16 && c <= 23) {                      /* Set graphics-color */
            attr[pos] = *lastattr;
            next_attrib = (*lastattr & ~(VTX_COLMASK | VTX_HIDDEN)) + c - 16;
            nextattr = 1;
            graphics = 1;
          } else if (c == 24) {                         /* Conceal display */
            attr[pos] = *lastattr | VTX_HIDDEN;
          } else if (c == 25 || c == 26) {                      /* Contiguous/separated graphics */
            attr[pos] = (*lastattr & ~VTX_GRSEP) + VTX_GRSEP * (c == 26);
          } else if (c == 28) {                         /* Black background */
            attr[pos] = *lastattr & ~VTX_BGMASK;
          } else if (c == 29) {                         /* Set background */
            attr[pos] = (*lastattr & ~VTX_BGMASK) + ((*lastattr & VTX_COLMASK) << 3);
          } else if (c == 30 || c == 31) {                      /* Hold/release graphics */
            attr[pos] = *lastattr;
            grhold = (c == 30);
            if (grhold && graphics)
              chr[pos] = *lastchr;
          } else {
            return 0;
          }
        }
        lastchr = chr + pos;
        if (nextattr) {
          lastattr = &next_attrib;
          nextattr = 0;
        } else {
          lastattr = attr + pos;
        }
        pos++;
      }
    }
  }
  return 1;
}

static SV *
decode_ansi (u8 *chr, u16 *atr)
{
  UI x;
  SV *sv = newSVpvn ("", 0);
  u16 o;

  for (x=0; x < VT_COLS; x++)
    {
      u16 a = *atr++;
      if (x == 0 || (a & 0x07) != (o & 0x07))
        sv_catpvf (sv, "\x1b[3%dm", a & 7);
      if (x == 0 || (a & 0x38) != (o & 0x38))
        sv_catpvf (sv, "\x1b[4%dm", (o & 0x38)>>3);
      if (x == 0 || (a & VTX_FLASH) != (o & VTX_FLASH))
        sv_catpvf (sv, "\x1b[%sm", a & VTX_FLASH ? "7" : "");

      sv_catpvf (sv, "%c", a & VTX_G1 ? 'x' : *chr);

      chr++;
      o = a;
    }

  sv_catpv (sv, "\x1b[37;40;0m");
  
  return sv;
}

#define valid_packet(sv) (SvPOK(packet) && SvCUR(packet) == 40)
#define consume_byte(store)                             \
        if (bp >= 39)                                   \
          {                                             \
            SV **sv = av_fetch(stream, pi, 0); pi++;    \
            if (!sv)                                    \
              goto eostream;                            \
            packet = *sv;                               \
            if (!valid_packet (pascket))                        \
              goto skip;                                \
            p = SvPV_nolen (packet);                    \
            bp = 0;                                     \
          }                                             \
        (store) = p[++bp]

static void
decode_stream (AV *stream)
{
  dSP;

  while (av_len (stream) >= 0)
    {
      UI pi = 1;
      SV *packet = *av_fetch(stream, 0, 1);

      if (valid_packet (packet))
        {
          u8 *p = SvPV_nolen(packet);
          u8 bp = p[0] == 0xff ? p[1] : unham4 (p[0])*3+1;

          if (bp <= 12*3+1 && p[bp] == 0xa1)
            {
              u8 buf[4];

              consume_byte (buf[0]); consume_byte (buf[1]);
              consume_byte (buf[2]); consume_byte (buf[3]);

              {
                u16 sh = unham8 (buf[0], buf[1]) | unham8 (buf[2], buf[3]) << 8;
                u8  bt = sh & 0x1f;
                u16 bl = sh >> 5;
                SV *block = sv_2mortal (newSVpvn (&bt, 1));

                while (bl--)
                  {
                    consume_byte (buf[0]);
                    sv_catpvn (block, buf, 1);
                  }

                EXTEND (SP, 1);
                PUSHs (block);

                /* optimize, do only when still in first packet! */
                do {
                  if (bp >= 39)
                    break;

                  bp++;
                  if (p[bp] == 0xa1)
                    {
                      p[0] = 0xff;
                      p[1] = bp;
                      pi--;
                      break;
                    }
                } while (p[bp] = 0x5e);
              }
            }
        }

skip:
      while (pi--)
        SvREFCNT_dec(av_shift(stream));
    }
eostream:

  PUTBACK;
}

static u8 *
unham_block (u8 *src, UI len, u8 *dst, UI dlen)
{
  u16 sh = *src | (len-1)<<5;
  u8 sum = ( sh        & 15)
         + ((sh >>  4) & 15)
         + ((sh >>  8) & 15)
         + ((sh >> 12) & 15);
  
  if (len < 5)
    return 0;
  
  sum += unham8 (src[1], src[2]);
  src += 3; len -= 3;

  dlen--;

  if (len < dlen)
    return 0;

  while (dlen)
    {
      *dst = unham8 (src[0], src[1]);
      sum += (*dst >> 4) + (*dst & 15);
#if 0
      printf ("%02x ", *dst);
#endif
      dst++; src += 2; dlen--;
    }
#if 0
  printf ("\n");
  printf ("sh = %04x, len = %02x, sum = %02x\n", sh, len, sum);
#endif
  if (sum)
    return 0;

  return src;
}

/* must not be a macro, see nvec */
static U32
vec(u8 *d, UI bit, UI len)
{
  U32 word = bit >> 3;

  /*printf ("vec(%d,%d) %d (%d)\n",bit,len,(bit & 7) + len,(bit & 7) + len < 32);*/
  assert ((bit & 7) + len < 32);

  word = (d[word]        )
       | (d[word+1] <<  8)
       | (d[word+2] << 16)
       | (d[word+3] << 24);

  return (word >> (bit & 7)) & (((U32)1 << len) - 1);
}

#define hv_store_sv(name,value) hv_store (hv, #name, strlen(#name), (SV*)(value), 0)
#define hv_store_iv(name,value) hv_store_sv (name, newSViv (value))
#define nvec(bits) vec (c, (ofs += (bits)) - (bits), (bits))

#define decode_escape_sequences(av)             \
  {                                             \
    UI no_escapes = nvec (8);                   \
    av = newAV ();                              \
    while (no_escapes--)                        \
      {                                         \
        AV *esc = newAV ();                     \
        av_push (esc, newSViv (nvec (10)));     \
        av_push (esc, newSViv (nvec (6)));      \
        av_push (esc, newSViv (nvec (8)));      \
        av_push (av, newRV_noinc((SV*)esc));    \
      }                                         \
  }

#define decode_transparent_string(sv, len)      \
  {                                             \
    UI l = len;                                 \
    sv = newSVpvn (s, l);                       \
    s += l;                                     \
    while (l--)                                 \
      SvPV_nolen (sv)[l] &= 0x7f;               \
  }

#define decode_descriptor_loop(av, ll)          \
  av = newAV ();                                \
  while (ll--)                                  \
    {                                           \
      AV *desc = newAV ();                      \
      av_push (desc, newSViv (nvec (6)));       \
      av_push (desc, newSViv (nvec (6)));       \
      av_push (desc, newSViv (nvec (8)));       \
      av_push (av, newRV_noinc((SV*)desc));     \
    }

static void
decode_epg (HV *hv, UI appid, u8 *c, u8 *s)
{
  UI ofs = 16;
  UI len;
  AV *av;
  SV *sv;

  hv_store_iv (ca_mode,    nvec(2));
  hv_store_iv (_copyright, nvec(1));

  ofs++; /* reserved */

  switch (appid)
    {
      case 1:
        {
          hv_store_iv (epg_version,     nvec( 6));
          hv_store_iv (epg_version_swo, nvec( 6));
          hv_store_iv (no_navigation,   nvec(16));
          hv_store_iv (no_osd,          nvec(16));
          hv_store_iv (no_message,      nvec(16));
          hv_store_iv (no_navigation_swo,nvec(16));
          hv_store_iv (no_osd_swo,      nvec(16));
          hv_store_iv (no_message_swo,  nvec(16));
          len = nvec(8);
          hv_store_iv (this_network_op, nvec( 8));
          decode_transparent_string (sv, nvec (5));
          hv_store_sv (service_name, sv);
          hv_store_iv (no_updates,      nvec( 1));

          ofs += 2;

          av = newAV ();
          while (len--)
            {
              HV *hv = newHV ();
              int LTO;
              hv_store_iv (cni,                 nvec (16));
              LTO = nvec (7) * 15;
              if (nvec(1))
                LTO = -LTO;
              hv_store_iv (lto, LTO);
              hv_store_iv (no_days,             nvec( 5));
              decode_transparent_string (sv,    nvec( 5));
              hv_store_sv (netwop_name, sv);
              hv_store_iv (default_alphabet,    nvec( 7));
              hv_store_iv (prog_start_no,       nvec(16));
              hv_store_iv (prog_stop_no,        nvec(16));
              hv_store_iv (prog_stop_no_swo,    nvec(16));
              hv_store_iv (network_add_info,    nvec(11));
              
              av_push (av, newRV_noinc ((SV*)hv));
            }
          hv_store_sv (networks, newRV_noinc ((SV*)av));
          break;
        }
      case 2:
        {
          UI background_reuse;

          hv_store_iv (block_no,        nvec(16));
          hv_store_iv (audio_mode,      vec(c, ofs, 12) & 3);
          hv_store_iv (feature_flags,   nvec(12));
          hv_store_iv (netwop_no,       nvec( 8));
          hv_store_iv (start_time,      nvec(16));
          hv_store_iv (start_date,      nvec(16));
          hv_store_iv (stop_time,       nvec(16));
          hv_store_iv (_pil,            nvec(20));
          hv_store_iv (parental_rating, nvec( 4));
          hv_store_iv (editorial_rating,nvec( 3));
          {
            UI no_themes =              nvec( 3);
            UI no_sortcrit =            nvec( 3);
            UI descriptor_looplength =  nvec( 6);
            background_reuse = nvec( 1);

            av = newAV ();
            while (no_themes--)
              av_push (av, newSViv (nvec (8)));
            hv_store_sv (themes, newRV_noinc((SV*)av));

            av = newAV ();
            while (no_sortcrit--)
              av_push (av, newSViv (nvec (8)));
            hv_store_sv (sortcrits, newRV_noinc((SV*)av));

            decode_descriptor_loop (av, descriptor_looplength);
            hv_store_sv (descriptors, newRV_noinc((SV*)av));

            ofs = (ofs+7) & ~7;

            decode_escape_sequences (av);
            hv_store_sv (title_escape_sequences, newRV_noinc((SV*)av));
            decode_transparent_string (sv, nvec (8));
            hv_store_sv (title, sv);
          }

          if (background_reuse)
            hv_store_iv (title_length, nvec (16));
          else
            {
              decode_escape_sequences (av);
              hv_store_sv (shortinfo_escape_sequences, newRV_noinc((SV*)av));
              decode_transparent_string (sv, nvec (8));
              hv_store_sv (shortinfo, sv);

              len = nvec (3);
              ofs += 2;
              switch (len)
                {
                  case 0:
                    decode_escape_sequences (av);
                    hv_store_sv (longinfo_escape_sequences, newRV_noinc((SV*)av));
                    decode_transparent_string (sv, nvec (8));
                    hv_store_sv (longinfo, sv);
                    break;
                  case 1:
                    decode_escape_sequences (av);
                    hv_store_sv (longinfo_escape_sequences, newRV_noinc((SV*)av));
                    decode_transparent_string (sv, nvec (10));
                    hv_store_sv (longinfo, sv);
                    break;
                  default:
                    printf ("UNKNOWN LONGINFO TYPE %d\n", len);
                }
            }

          break;
        }
      case 3:
        {
          UI descriptor_ll;
          hv_store_iv (block_no,        nvec(16));
          hv_store_iv (header_size,     nvec( 2));
          len = nvec(4);
          hv_store_iv (message_size,    nvec( 3));
          ofs++;
          descriptor_ll = nvec(6);
          decode_descriptor_loop (av, descriptor_ll);
          hv_store_sv (descriptors, newRV_noinc((SV*)av));
          ofs = (ofs+7) & ~7;

          decode_escape_sequences (av);
          hv_store_sv (header_escape_sequences, newRV_noinc((SV*)av));

          decode_transparent_string (sv, nvec(8));
          hv_store_sv (header, sv);

          hv_store_iv (message_attribute,nvec(8));

          av = newAV ();
          while (len--)
            {
              AV *av2;
              UI len;
              HV *hv = newHV ();

              hv_store_iv (next_id,   nvec(16));
              hv_store_iv (next_type, nvec( 4));

              len = nvec(4);
              av2 = newAV ();
              while (len--)
                {
                  UI kind = nvec(8);
                  av_push (av2, newSViv (kind));
                  switch (kind)
                    {
                      case 0x02: case 0x10: case 0x11: case 0x18:
                      case 0x20: case 0x21: case 0x22: case 0x23: case 0x24: case 0x25: case 0x26: case 0x27:
                      case 0x30: case 0x31: case 0x32: case 0x33: case 0x34: case 0x35: case 0x36: case 0x37:
                      case 0x40: case 0x41:
                        av_push (av2, newSViv (nvec ( 8)));
                        break;

                      case 0x80: case 0x81:
                        av_push (av2, newSViv (nvec (16)));
                        break;

                      case 0xc0:
                        av_push (av2, newSViv (nvec (12)));
                        av_push (av2, newSViv (nvec (12)));
                        break;

                      case 0xc8: case 0xc9:
                        av_push (av2, newSViv (nvec (24)));
                        break;

                      default:
                        abort ();
                    }
                }
              hv_store_sv (attributes, newRV_noinc((SV*)av2));
              
              decode_escape_sequences (av2);
              hv_store_sv (header_escape_sequences, newRV_noinc((SV*)av2));
              decode_transparent_string (sv, nvec(8));
              hv_store_sv (event, sv);

              av_push (av, newRV_noinc((SV*)hv));
            }
          hv_store_sv (events, newRV_noinc((SV*)av));

          break;
        }
      case 4:
        {
          UI block_no = nvec (16);
          UI descriptor_ll;
          UI msg_len;
          hv_store_iv (block_no,        block_no);
          hv_store_iv (message_attribute,nvec(8));
          hv_store_iv (header_size,     nvec(3));
          hv_store_iv (message_size,    nvec(3));
          descriptor_ll = nvec(6);
          if (!block_no)
            {
              decode_escape_sequences (av);
              hv_store_sv (message_escape_sequences, newRV_noinc((SV*)av));
              msg_len = nvec(10);
              ofs += 6;
            }

          decode_escape_sequences (av);
          hv_store_sv (header_escape_sequences, newRV_noinc((SV*)av));

          decode_transparent_string (sv, nvec(8));
          hv_store_sv (header, sv);

          if (!block_no)
            {
              decode_transparent_string (sv, msg_len);
              hv_store_sv (message, sv);
            }

          decode_descriptor_loop (av, descriptor_ll);
          hv_store_sv (descriptors, newRV_noinc((SV*)av));
          break;
        }
      case 5:
        {
          UI descriptor_ll;
          hv_store_iv (block_no,        nvec(16));
          descriptor_ll = nvec(6);
          decode_descriptor_loop (av, descriptor_ll);
          hv_store_sv (descriptors, newRV_noinc((SV*)av));
          ofs = (ofs+7) & ~7;

          decode_escape_sequences (av);
          hv_store_sv (message_escape_sequences, newRV_noinc((SV*)av));

          decode_transparent_string (sv, nvec(10));
          hv_store_sv (message, sv);

          break;
        }
      default:
        printf ("UNKNOWN EPG DATATYPE ($%02x)\n", appid);
    }
}

static SV *
decode_block(u8 *b, UI len, AV *bi)
{
  dSP;
  u8 ctrl[1024];
  u8 bt = *b;

  if (bt == 0)
    {
      if ((b = unham_block (b, len, ctrl, (len-1)>>1 )))
        {
          UI app_no = ctrl[0];
          UI app;
          av_clear (bi);
          for (app=1; app<=app_no; app++)
            av_store (bi, app, newSViv (vec (ctrl, app*16-8, 16)));
        }
    }
  else if (len >= 5)
    {
      if (bt <= av_len (bi) && SvOK(*av_fetch (bi, bt, 0)))
        {
          u16 appid = SvIV (*av_fetch (bi, bt, 0));
          if (appid == 0) /* EPG */
            {
              if ((b = unham_block (b, len, ctrl, unham8 (b[3], b[4]) | (unham4 (b[5]) << 8) & 1023)))
                {
                  HV *hv = newHV ();
                  /* _now_ we have an epg structure. decode it */

                  appid = vec(ctrl,10,6);
                  EXTEND (SP, 2);
                  PUSHs (sv_2mortal (newSViv (appid)));
                  PUSHs (sv_2mortal (newRV_noinc ((SV*)hv)));

                  decode_epg (hv, appid, ctrl, b);
                }
              else
                printf ("checksum error found block %d, len %d, appid = %d (clen 0)\n", bt, len, appid);
            }
          else
            /* other applications not defined (to my knowledge) */;
        }
      else
        /* no bundle info: can't parse yet */;
    }
  
  PUTBACK;
}

MODULE = Video::Capture::VBI            PACKAGE = Video::Capture::VBI

PROTOTYPES: ENABLE

int
unham4(data)
        SV *    data
        CODE:
        STRLEN len;
        unsigned char *d = (unsigned char *)SvPV (data, len);

        if (len < 1)
          croak ("unham4: length must be at least 1");

        RETVAL = unham4 (*d);
        OUTPUT:
        RETVAL
        
int
unham8(data)
        SV *    data
        CODE:
        STRLEN len;
        unsigned char *d = (unsigned char *)SvPV (data, len);

        if (len < 2)
          croak ("unham8: length must be at least 2");

        RETVAL = unham8 (d[0], d[1]);
        OUTPUT:
        RETVAL
        
void
decode_field(field, types)
        SV *    field
        unsigned int    types
        PPCODE:
{
        UI lines = SvCUR(field) / VBI_BPL;
        UI line;
        decoder dec;

        decoder_init (&dec, types);

        EXTEND (SP, lines);
        for (line = 0; line < lines; line++)
          {
            SV *sv = decoder_decode (&dec, line, ((u8*)SvPV_nolen(field)) + line * VBI_BPL);
            if (sv)
              PUSHs (sv_2mortal (sv));
          }
}

SV *
decode_vps(char *data)

SV *
decode_vt(char *data)

void
decode_vtpage(data)
        SV *    data
        PPCODE:
{
        u8  chr[VT_COLS*VT_LINES];
        u16 atr[VT_COLS*VT_LINES];
        UI lines;
        
        if (!SvPOK(data))
          XSRETURN_EMPTY;

        lines = SvCUR(data) / VT_COLS;

        if (lines > VT_LINES)
          croak ("videotext cannot have more than %d lines (argument has %d lines)\n", VT_LINES, lines);
        
        Zero(chr, VT_COLS*VT_LINES, u8);
        Zero(atr, VT_COLS*VT_LINES, u16);
        if (decode_vtpage (SvPV_nolen(data), lines, chr, atr))
          {
            AV *av = newAV ();
            UI n;

            for (n = 0; n < VT_COLS*lines; n++)
              av_push (av, newSViv (atr[n]));

            EXTEND (SP, 2);
            PUSHs (sv_2mortal (newSVpvn (chr, VT_COLS*lines)));
            PUSHs (sv_2mortal (newRV_noinc ((SV*)av)));
          }
}

PROTOTYPES: DISABLE

void
decode_ansi(chr, atr)
        SV *    chr
        SV *    atr
        PPCODE:
{
        UI lines = SvCUR(chr) / VT_COLS;
        UI attr_i = 0;
        u8 *_chr = SvPV_nolen (chr);
        u16 _atr[VT_COLS];
        
        EXTEND (SP, lines);

        while (lines--)
          {
            UI attr_j;
            for(attr_j = 0; attr_j < VT_COLS; attr_j++)
              _atr[attr_j] = SvIV (*av_fetch ((AV*)SvRV (atr), attr_i+attr_j, 1));

            PUSHs (sv_2mortal (decode_ansi (_chr, _atr)));

            _chr += VT_COLS;
            attr_i += VT_COLS;
          }
}

unsigned int
bcd2dec(bcd)
        unsigned int bcd
        CODE:
{
        UI digit = 1;
        RETVAL = 0;
        while (bcd)
          {
            if ((bcd & 15) > 9)
              XSRETURN_EMPTY;

            RETVAL += (bcd & 15) * digit;
            digit *= 10;
            bcd >>= 4;
          }
}
        OUTPUT:
        RETVAL

PROTOTYPES: ENABLE

MODULE = Video::Capture::VBI            PACKAGE = Video::Capture::VBI::EPG

void
decode_stream(stream)
        SV *    stream
        PPCODE:
        if (!SvROK(stream) || SvTYPE(SvRV(stream)) != SVt_PVAV)
          croak ("decode_epg stream works on arrayrefs");

        PUTBACK;
        decode_stream ((AV*)SvRV(stream));
        SPAGAIN;

SV *
decode_block(block, bundle)
        SV *    block
        SV *    bundle
        PPCODE:
        if (!SvROK(bundle) || SvTYPE(SvRV(bundle)) != SVt_PVAV)
          croak ("bundle info must be arrayref");

        PUTBACK;
        decode_block (SvPV_nolen(block), SvCUR(block), (AV*)SvRV(bundle));
        SPAGAIN;

BOOT:
{
        HV *stash = gv_stashpvn("Video::Capture::VBI", 19, TRUE);

        newCONSTSUB(stash,"VBI_VT",     newSViv(VBI_VT));
        newCONSTSUB(stash,"VBI_VPS",    newSViv(VBI_VPS));
        newCONSTSUB(stash,"VBI_VDAT",   newSViv(VBI_VDAT));
        newCONSTSUB(stash,"VBI_VC",     newSViv(VBI_VC));
        newCONSTSUB(stash,"VBI_EMPTY",  newSViv(VBI_EMPTY));
        newCONSTSUB(stash,"VBI_OTHER",  newSViv(VBI_OTHER));

        newCONSTSUB(stash,"VTX_COLMASK",newSViv(VTX_COLMASK));
        newCONSTSUB(stash,"VTX_GRSEP",  newSViv(VTX_GRSEP));
        newCONSTSUB(stash,"VTX_HIDDEN", newSViv(VTX_HIDDEN));
        newCONSTSUB(stash,"VTX_BOX",    newSViv(VTX_BOX));
        newCONSTSUB(stash,"VTX_FLASH",  newSViv(VTX_FLASH));
        newCONSTSUB(stash,"VTX_DOUBLE1",newSViv(VTX_DOUBLE1));
        newCONSTSUB(stash,"VTX_DOUBLE2",newSViv(VTX_DOUBLE2));
        newCONSTSUB(stash,"VTX_INVERT", newSViv(VTX_INVERT));
        newCONSTSUB(stash,"VTX_DOUBLE", newSViv(VTX_DOUBLE));
}
        
Revision:	1.6
Committed:	Tue Nov 1 16:10:29 2005 UTC (18 years, 8 months ago) by root
Branch:	MAIN
CVS Tags:	rel-0_9, rel-0_902, HEAD
Changes since 1.5:	+11 -20 lines
Log Message:	* empty log message *