64-bit cabac optimizations
[x262.git] / common / bitstream.c
1 /*****************************************************************************
2  * bitstream.c: bitstream writing
3  *****************************************************************************
4  * Copyright (C) 2003-2013 x264 project
5  *
6  * Authors: Laurent Aimar <fenrir@via.ecp.fr>
7  *          Jason Garrett-Glaser <darkshikari@gmail.com>
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., 51 Franklin Street, Fifth Floor, Boston, MA  02111, USA.
22  *
23  * This program is also available under a commercial proprietary license.
24  * For more information, contact us at licensing@x264.com.
25  *****************************************************************************/
26
27 #include "common.h"
28
29 static uint8_t *x264_nal_escape_c( uint8_t *dst, uint8_t *src, uint8_t *end )
30 {
31     if( src < end ) *dst++ = *src++;
32     if( src < end ) *dst++ = *src++;
33     while( src < end )
34     {
35         if( src[0] <= 0x03 && !dst[-2] && !dst[-1] )
36             *dst++ = 0x03;
37         *dst++ = *src++;
38     }
39     return dst;
40 }
41
42 #if HAVE_MMX
43 uint8_t *x264_nal_escape_mmx2( uint8_t *dst, uint8_t *src, uint8_t *end );
44 uint8_t *x264_nal_escape_sse2( uint8_t *dst, uint8_t *src, uint8_t *end );
45 uint8_t *x264_nal_escape_avx( uint8_t *dst, uint8_t *src, uint8_t *end );
46 #endif
47
48 /****************************************************************************
49  * x264_nal_encode:
50  ****************************************************************************/
51 void x264_nal_encode( x264_t *h, uint8_t *dst, x264_nal_t *nal )
52 {
53     uint8_t *src = nal->p_payload;
54     uint8_t *end = nal->p_payload + nal->i_payload;
55     uint8_t *orig_dst = dst;
56
57     if( h->param.b_annexb )
58     {
59         if( nal->b_long_startcode )
60             *dst++ = 0x00;
61         *dst++ = 0x00;
62         *dst++ = 0x00;
63         *dst++ = 0x01;
64     }
65     else /* save room for size later */
66         dst += 4;
67
68     /* nal header */
69     *dst++ = ( 0x00 << 7 ) | ( nal->i_ref_idc << 5 ) | nal->i_type;
70
71     dst = h->bsf.nal_escape( dst, src, end );
72     int size = (dst - orig_dst) - 4;
73
74     /* Write the size header for mp4/etc */
75     if( !h->param.b_annexb )
76     {
77         /* Size doesn't include the size of the header we're writing now. */
78         orig_dst[0] = size>>24;
79         orig_dst[1] = size>>16;
80         orig_dst[2] = size>> 8;
81         orig_dst[3] = size>> 0;
82     }
83
84     nal->i_payload = size+4;
85     nal->p_payload = orig_dst;
86     x264_emms();
87 }
88
89 void x264_bitstream_init( int cpu, x264_bitstream_function_t *pf )
90 {
91     pf->nal_escape = x264_nal_escape_c;
92 #if HAVE_MMX
93     if( cpu&X264_CPU_MMX2 )
94         pf->nal_escape = x264_nal_escape_mmx2;
95     if( (cpu&X264_CPU_SSE2) && (cpu&X264_CPU_SSE2_IS_FAST) )
96         pf->nal_escape = x264_nal_escape_sse2;
97     if( cpu&X264_CPU_AVX )
98         pf->nal_escape = x264_nal_escape_avx;
99 #endif
100 }