bs.h
上传用户:hjq518
上传日期:2021-12-09
资源大小:5084k
文件大小:9k
源码类别:

Audio

开发平台:

Visual C++

  1. /*****************************************************************************
  2.  * bs.h :
  3.  *****************************************************************************
  4.  * Copyright (C) 2003 Laurent Aimar
  5.  * $Id: bs.h,v 1.1 2004/06/03 19:27:06 fenrir Exp $
  6.  *
  7.  * Authors: Laurent Aimar <fenrir@via.ecp.fr>
  8.  *
  9.  * This program is free software; you can redistribute it and/or modify
  10.  * it under the terms of the GNU General Public License as published by
  11.  * the Free Software Foundation; either version 2 of the License, or
  12.  * (at your option) any later version.
  13.  *
  14.  * This program is distributed in the hope that it will be useful,
  15.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17.  * GNU General Public License for more details.
  18.  *
  19.  * You should have received a copy of the GNU General Public License
  20.  * along with this program; if not, write to the Free Software
  21.  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111, USA.
  22.  *****************************************************************************/
  23. #ifdef _BS_H
  24. #warning FIXME Multiple inclusion of bs.h
  25. #else
  26. #define _BS_H
  27. typedef struct bs_s
  28. {
  29.     uint8_t *p_start;
  30.     uint8_t *p;
  31.     uint8_t *p_end;
  32.     int     i_left;    /* i_count number of available bits */
  33.     int     i_bits_encoded; /* RD only */
  34. } bs_t;
  35. static inline void bs_init( bs_t *s, void *p_data, int i_data )
  36. {
  37.     s->p_start = p_data;
  38.     s->p       = p_data;
  39.     s->p_end   = s->p + i_data;
  40.     s->i_left  = 8;
  41. }
  42. static inline int bs_pos( bs_t *s )
  43. {
  44.     return( 8 * ( s->p - s->p_start ) + 8 - s->i_left );
  45. }
  46. static inline int bs_eof( bs_t *s )
  47. {
  48.     return( s->p >= s->p_end ? 1: 0 );
  49. }
  50. static inline uint32_t bs_read( bs_t *s, int i_count )
  51. {
  52.      static uint32_t i_mask[33] ={0x00,
  53.                                   0x01,      0x03,      0x07,      0x0f,
  54.                                   0x1f,      0x3f,      0x7f,      0xff,
  55.                                   0x1ff,     0x3ff,     0x7ff,     0xfff,
  56.                                   0x1fff,    0x3fff,    0x7fff,    0xffff,
  57.                                   0x1ffff,   0x3ffff,   0x7ffff,   0xfffff,
  58.                                   0x1fffff,  0x3fffff,  0x7fffff,  0xffffff,
  59.                                   0x1ffffff, 0x3ffffff, 0x7ffffff, 0xfffffff,
  60.                                   0x1fffffff,0x3fffffff,0x7fffffff,0xffffffff};
  61.     int      i_shr;
  62.     uint32_t i_result = 0;
  63.     while( i_count > 0 )
  64.     {
  65.         if( s->p >= s->p_end )
  66.         {
  67.             break;
  68.         }
  69.         if( ( i_shr = s->i_left - i_count ) >= 0 )
  70.         {
  71.             /* more in the buffer than requested */
  72.             i_result |= ( *s->p >> i_shr )&i_mask[i_count];
  73.             s->i_left -= i_count;
  74.             if( s->i_left == 0 )
  75.             {
  76.                 s->p++;
  77.                 s->i_left = 8;
  78.             }
  79.             return( i_result );
  80.         }
  81.         else
  82.         {
  83.             /* less in the buffer than requested */
  84.            i_result |= (*s->p&i_mask[s->i_left]) << -i_shr;
  85.            i_count  -= s->i_left;
  86.            s->p++;
  87.            s->i_left = 8;
  88.         }
  89.     }
  90.     return( i_result );
  91. }
  92. static inline uint32_t bs_read1( bs_t *s )
  93. {
  94.     if( s->p < s->p_end )
  95.     {
  96.         unsigned int i_result;
  97.         s->i_left--;
  98.         i_result = ( *s->p >> s->i_left )&0x01;
  99.         if( s->i_left == 0 )
  100.         {
  101.             s->p++;
  102.             s->i_left = 8;
  103.         }
  104.         return i_result;
  105.     }
  106.     return 0;
  107. }
  108. static inline uint32_t bs_show( bs_t *s, int i_count )
  109. {
  110.     if( s->p < s->p_end && i_count > 0 )
  111.     {
  112.         uint32_t i_cache = ((s->p[0] << 24)+(s->p[1] << 16)+(s->p[2] << 8)+s->p[3]) << (8-s->i_left);
  113.         return( i_cache >> ( 32 - i_count) );
  114.     }
  115.     return 0;
  116. }
  117. /* TODO optimize */
  118. static inline void bs_skip( bs_t *s, int i_count )
  119. {
  120.     s->i_left -= i_count;
  121.     while( s->i_left <= 0 )
  122.     {
  123.         s->p++;
  124.         s->i_left += 8;
  125.     }
  126. }
  127. static inline int bs_read_ue( bs_t *s )
  128. {
  129.     int i = 0;
  130.     while( bs_read1( s ) == 0 && s->p < s->p_end && i < 32 )
  131.     {
  132.         i++;
  133.     }
  134.     return( ( 1 << i) - 1 + bs_read( s, i ) );
  135. }
  136. static inline int bs_read_se( bs_t *s )
  137. {
  138.     int val = bs_read_ue( s );
  139.     return val&0x01 ? (val+1)/2 : -(val/2);
  140. }
  141. static inline int bs_read_te( bs_t *s, int x )
  142. {
  143.     if( x == 1 )
  144.     {
  145.         return 1 - bs_read1( s );
  146.     }
  147.     else if( x > 1 )
  148.     {
  149.         return bs_read_ue( s );
  150.     }
  151.     return 0;
  152. }
  153. static inline void bs_write( bs_t *s, int i_count, uint32_t i_bits )
  154. {
  155.     if( s->p >= s->p_end - 4 )
  156.         return;
  157.     while( i_count > 0 )
  158.     {
  159.         if( i_count < 32 )
  160.             i_bits &= (1<<i_count)-1;
  161.         if( i_count < s->i_left )
  162.         {
  163.             *s->p = (*s->p << i_count) | i_bits;
  164.             s->i_left -= i_count;
  165.             break;
  166.         }
  167.         else
  168.         {
  169.             *s->p = (*s->p << s->i_left) | (i_bits >> (i_count - s->i_left));
  170.             i_count -= s->i_left;
  171.             s->p++;
  172.             s->i_left = 8;
  173.         }
  174.     }
  175. }
  176. static inline void bs_write1( bs_t *s, uint32_t i_bit )
  177. {
  178.     if( s->p < s->p_end )
  179.     {
  180.         *s->p <<= 1;
  181.         *s->p |= i_bit;
  182.         s->i_left--;
  183.         if( s->i_left == 0 )
  184.         {
  185.             s->p++;
  186.             s->i_left = 8;
  187.         }
  188.     }
  189. }
  190. static inline void bs_align_0( bs_t *s )
  191. {
  192.     if( s->i_left != 8 )
  193.     {
  194.         *s->p <<= s->i_left;
  195.         s->i_left = 8;
  196.         s->p++;
  197.     }
  198. }
  199. static inline void bs_align_1( bs_t *s )
  200. {
  201.     if( s->i_left != 8 )
  202.     {
  203.         *s->p <<= s->i_left;
  204.         *s->p |= (1 << s->i_left) - 1;
  205.         s->i_left = 8;
  206.         s->p++;
  207.     }
  208. }
  209. static inline void bs_align( bs_t *s )
  210. {
  211.     bs_align_0( s );
  212. }
  213. /* golomb functions */
  214. static inline void bs_write_ue( bs_t *s, unsigned int val )
  215. {
  216.     int i_size = 0;
  217.     static const int i_size0_255[256] =
  218.     {
  219.         1,1,2,2,3,3,3,3,4,4,4,4,4,4,4,4,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,5,
  220.         6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,6,
  221.         7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,
  222.         7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,7,
  223.         8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,
  224.         8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,
  225.         8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,
  226.         8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8,8
  227.     };
  228.     if( val == 0 )
  229.     {
  230.         bs_write1( s, 1 );
  231.     }
  232.     else
  233.     {
  234.         unsigned int tmp = ++val;
  235.         if( tmp >= 0x00010000 )
  236.         {
  237.             i_size += 16;
  238.             tmp >>= 16;
  239.         }
  240.         if( tmp >= 0x100 )
  241.         {
  242.             i_size += 8;
  243.             tmp >>= 8;
  244.         }
  245.         i_size += i_size0_255[tmp];
  246.         bs_write( s, 2 * i_size - 1, val );
  247.     }
  248. }
  249. static inline void bs_write_se( bs_t *s, int val )
  250. {
  251.     bs_write_ue( s, val <= 0 ? -val * 2 : val * 2 - 1);
  252. }
  253. static inline void bs_write_te( bs_t *s, int x, int val )
  254. {
  255.     if( x == 1 )
  256.     {
  257.         bs_write1( s, 1&~val );
  258.     }
  259.     else if( x > 1 )
  260.     {
  261.         bs_write_ue( s, val );
  262.     }
  263. }
  264. static inline void bs_rbsp_trailing( bs_t *s )
  265. {
  266.     bs_write1( s, 1 );
  267.     if( s->i_left != 8 )
  268.     {
  269.         bs_write( s, s->i_left, 0x00 );
  270.     }
  271. }
  272. static inline int bs_size_ue( unsigned int val )
  273. {
  274.     static const int i_size0_254[255] =
  275.     {
  276.         1, 3, 3, 5, 5, 5, 5, 7, 7, 7, 7, 7, 7, 7, 7,
  277.         9, 9, 9, 9, 9, 9, 9, 9, 9, 9, 9, 9, 9, 9, 9, 9,
  278.         11,11,11,11,11,11,11,11,11,11,11,11,11,11,11,11,11,11,11,11,11,11,11,
  279.         11,11,11,11,11,11,11,11,11,13,13,13,13,13,13,13,13,13,13,13,13,13,13,
  280.         13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,
  281.         13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,13,
  282.         13,13,13,13,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,
  283.         15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,
  284.         15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,
  285.         15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,
  286.         15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,
  287.         15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15,15
  288.     };
  289.     if( val < 255 )
  290.     {
  291.         return i_size0_254[val];
  292.     }
  293.     else
  294.     {
  295.         int i_size = 0;
  296.         val++;
  297.         if( val >= 0x10000 )
  298.         {
  299.             i_size += 32;
  300.             val = (val >> 16) - 1;
  301.         }
  302.         if( val >= 0x100 )
  303.         {
  304.             i_size += 16;
  305.             val = (val >> 8) - 1;
  306.         }
  307.         return i_size0_254[val] + i_size;
  308.     }
  309. }
  310. static inline int bs_size_se( int val )
  311. {
  312.     return bs_size_ue( val <= 0 ? -val * 2 : val * 2 - 1);
  313. }
  314. static inline int bs_size_te( int x, int val )
  315. {
  316.     if( x == 1 )
  317.     {
  318.         return 1;
  319.     }
  320.     else if( x > 1 )
  321.     {
  322.         return bs_size_ue( val );
  323.     }
  324.     return 0;
  325. }
  326. #endif