1 /*****************************************************************************
2 * h264.c: h264/avc video packetizer
3 *****************************************************************************
4 * Copyright (C) 2001, 2002, 2006 the VideoLAN team
7 * Authors: Laurent Aimar <fenrir@via.ecp.fr>
8 * Eric Petit <titer@videolan.org>
9 * Gildas Bazin <gbazin@videolan.org>
10 * Derk-Jan Hartman <hartman at videolan dot org>
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2 of the License, or
15 * (at your option) any later version.
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
25 *****************************************************************************/
27 /*****************************************************************************
29 *****************************************************************************/
30 #include <stdlib.h> /* malloc(), free() */
34 #include <vlc_codec.h>
35 #include <vlc_block.h>
37 #include "vlc_block_helper.h"
40 /*****************************************************************************
42 *****************************************************************************/
43 static int Open ( vlc_object_t * );
44 static void Close( vlc_object_t * );
47 set_category( CAT_SOUT );
48 set_subcategory( SUBCAT_SOUT_PACKETIZER );
49 set_description( _("H.264 video packetizer") );
50 set_capability( "packetizer", 50 );
51 set_callbacks( Open, Close );
55 /****************************************************************************
57 ****************************************************************************/
58 static block_t *Packetize( decoder_t *, block_t ** );
59 static block_t *PacketizeAVC1( decoder_t *, block_t ** );
63 block_bytestream_t bytestream;
77 int i_avcC_length_size;
81 /* Useful values of the Sequence Parameter Set */
82 int i_log2_max_frame_num;
85 /* Useful values of the Slice Header */
106 NAL_SLICE_IDR = 5, /* ref_idc != 0 */
107 NAL_SEI = 6, /* ref_idc == 0 */
111 /* ref_idc == 0 for 6,9,10,11,12 */
116 NAL_PRIORITY_DISPOSABLE = 0,
117 NAL_PRIORITY_LOW = 1,
118 NAL_PRIORITY_HIGH = 2,
119 NAL_PRIORITY_HIGHEST = 3,
122 static block_t *ParseNALBlock( decoder_t *, block_t * );
124 static block_t *nal_get_annexeb( decoder_t *, uint8_t *p, int );
126 /*****************************************************************************
127 * Open: probe the packetizer and return score
128 * When opening after demux, the packetizer is only loaded AFTER the decoder
129 * That means that what you set in fmt_out is ignored by the decoder in this special case
130 *****************************************************************************/
131 static int Open( vlc_object_t *p_this )
133 decoder_t *p_dec = (decoder_t*)p_this;
134 decoder_sys_t *p_sys;
136 if( p_dec->fmt_in.i_codec != VLC_FOURCC( 'h', '2', '6', '4') &&
137 p_dec->fmt_in.i_codec != VLC_FOURCC( 'H', '2', '6', '4') &&
138 p_dec->fmt_in.i_codec != VLC_FOURCC( 'V', 'S', 'S', 'H') &&
139 p_dec->fmt_in.i_codec != VLC_FOURCC( 'v', 's', 's', 'h') &&
140 p_dec->fmt_in.i_codec != VLC_FOURCC( 'D', 'A', 'V', 'C') &&
141 ( p_dec->fmt_in.i_codec != VLC_FOURCC( 'a', 'v', 'c', '1') ||
142 p_dec->fmt_in.i_extra < 7 ) )
147 /* Allocate the memory needed to store the decoder's structure */
148 if( ( p_dec->p_sys = p_sys = malloc( sizeof(decoder_sys_t) ) ) == NULL )
150 msg_Err( p_dec, "out of memory" );
153 p_sys->i_state = STATE_NOSYNC;
155 p_sys->startcode[0] = 0;
156 p_sys->startcode[1] = 0;
157 p_sys->startcode[2] = 0;
158 p_sys->startcode[3] = 1;
159 p_sys->bytestream = block_BytestreamInit( p_dec );
160 p_sys->b_slice = VLC_FALSE;
161 p_sys->p_frame = NULL;
162 p_sys->b_sps = VLC_FALSE;
163 p_sys->b_pps = VLC_FALSE;
166 p_sys->b_header= VLC_FALSE;
168 p_sys->i_nal_type = -1;
169 p_sys->i_nal_ref_idc = -1;
170 p_sys->i_idr_pic_id = -1;
171 p_sys->i_frame_num = -1;
172 p_sys->i_frame_type = 0;
174 /* Setup properties */
175 es_format_Copy( &p_dec->fmt_out, &p_dec->fmt_in );
176 p_dec->fmt_out.i_codec = VLC_FOURCC( 'h', '2', '6', '4' );
178 if( p_dec->fmt_in.i_codec == VLC_FOURCC( 'a', 'v', 'c', '1' ) )
180 /* This type of stream is produced by mp4 and matroska
181 * when we want to store it in another streamformat, you need to convert
182 * The fmt_in.p_extra should ALWAYS contain the avcC
183 * The fmt_out.p_extra should contain all the SPS and PPS with 4 byte startcodes */
184 uint8_t *p = &((uint8_t*)p_dec->fmt_in.p_extra)[4];
189 p_sys->i_avcC_length_size = 1 + ((*p++)&0x03);
193 for( i = 0; i < i_sps; i++ )
195 int i_length = GetWBE( p );
196 block_t *p_sps = nal_get_annexeb( p_dec, p + 2, i_length );
198 p_sys->p_sps = block_Duplicate( p_sps );
199 p_sps->i_pts = p_sps->i_dts = mdate();
200 ParseNALBlock( p_dec, p_sps );
205 for( i = 0; i < i_pps; i++ )
207 int i_length = GetWBE( p );
208 block_t *p_pps = nal_get_annexeb( p_dec, p + 2, i_length );
210 p_sys->p_pps = block_Duplicate( p_pps );
211 p_pps->i_pts = p_pps->i_dts = mdate();
212 ParseNALBlock( p_dec, p_pps );
215 msg_Dbg( p_dec, "avcC length size=%d, sps=%d, pps=%d",
216 p_sys->i_avcC_length_size, i_sps, i_pps );
218 /* FIXME: FFMPEG isn't happy at all if you leave this */
219 if( p_dec->fmt_out.i_extra ) free( p_dec->fmt_out.p_extra );
220 p_dec->fmt_out.i_extra = 0; p_dec->fmt_out.p_extra = NULL;
222 /* Set the new extradata */
223 p_dec->fmt_out.i_extra = p_sys->p_pps->i_buffer + p_sys->p_sps->i_buffer;
224 p_dec->fmt_out.p_extra = (uint8_t*)malloc( p_dec->fmt_out.i_extra );
225 memcpy( p_dec->fmt_out.p_extra, p_sys->p_sps->p_buffer, p_sys->p_sps->i_buffer);
226 memcpy( p_dec->fmt_out.p_extra+p_sys->p_sps->i_buffer, p_sys->p_pps->p_buffer, p_sys->p_pps->i_buffer);
227 p_sys->b_header = VLC_TRUE;
230 p_dec->pf_packetize = PacketizeAVC1;
234 /* This type of stream contains data with 3 of 4 byte startcodes
235 * The fmt_in.p_extra MAY contain SPS/PPS with 4 byte startcodes
236 * The fmt_out.p_extra should be the same */
239 p_dec->pf_packetize = Packetize;
242 if( p_dec->fmt_in.i_extra > 0 )
244 block_t *p_init = block_New( p_dec, p_dec->fmt_in.i_extra );
247 memcpy( p_init->p_buffer, p_dec->fmt_in.p_extra,
248 p_dec->fmt_in.i_extra );
250 while( ( p_pic = Packetize( p_dec, &p_init ) ) )
252 /* Should not occur because we should only receive SPS/PPS */
253 block_Release( p_pic );
261 /*****************************************************************************
262 * Close: clean up the packetizer
263 *****************************************************************************/
264 static void Close( vlc_object_t *p_this )
266 decoder_t *p_dec = (decoder_t*)p_this;
267 decoder_sys_t *p_sys = p_dec->p_sys;
269 if( p_sys->p_frame ) block_ChainRelease( p_sys->p_frame );
270 if( p_sys->p_sps ) block_Release( p_sys->p_sps );
271 if( p_sys->p_pps ) block_Release( p_sys->p_pps );
272 block_BytestreamRelease( &p_sys->bytestream );
276 /****************************************************************************
277 * Packetize: the whole thing
278 * Search for the startcodes 3 or more bytes
279 * Feed ParseNALBlock ALWAYS with 4 byte startcode prepended NALs
280 ****************************************************************************/
281 static block_t *Packetize( decoder_t *p_dec, block_t **pp_block )
283 decoder_sys_t *p_sys = p_dec->p_sys;
286 if( !pp_block || !*pp_block ) return NULL;
288 block_BytestreamPush( &p_sys->bytestream, *pp_block );
292 switch( p_sys->i_state )
295 /* Skip until 3 byte startcode 0 0 1 */
296 if( block_FindStartcodeFromOffset( &p_sys->bytestream,
297 &p_sys->i_offset, p_sys->startcode+1, 3 ) == VLC_SUCCESS)
299 p_sys->i_state = STATE_NEXT_SYNC;
302 if( p_sys->i_offset )
305 block_SkipBytes( &p_sys->bytestream, p_sys->i_offset );
307 block_BytestreamFlush( &p_sys->bytestream );
310 if( p_sys->i_state != STATE_NEXT_SYNC )
316 p_sys->i_offset = 1; /* To find next startcode */
318 case STATE_NEXT_SYNC:
319 /* Find the next 3 byte startcode 0 0 1*/
320 if( block_FindStartcodeFromOffset( &p_sys->bytestream,
321 &p_sys->i_offset, p_sys->startcode+1, 3 ) != VLC_SUCCESS)
327 /* Get the new fragment and set the pts/dts */
328 p_pic = block_New( p_dec, p_sys->i_offset +1 );
329 p_pic->i_pts = p_sys->bytestream.p_block->i_pts;
330 p_pic->i_dts = p_sys->bytestream.p_block->i_dts;
331 /* Force 4 byte startcode 0 0 0 1 */
332 p_pic->p_buffer[0] = 0;
334 block_GetBytes( &p_sys->bytestream, &p_pic->p_buffer[1],
337 /* Remove trailing 0 bytes */
338 while( p_pic->i_buffer && (!p_pic->p_buffer[p_pic->i_buffer-1] ) ) p_pic->i_buffer--;
342 if( !( p_pic = ParseNALBlock( p_dec, p_pic ) ) )
344 p_sys->i_state = STATE_NOSYNC;
348 msg_Dbg( p_dec, "pts="I64Fd" dts="I64Fd,
349 p_pic->i_pts, p_pic->i_dts );
352 /* So p_block doesn't get re-added several times */
353 *pp_block = block_BytestreamPop( &p_sys->bytestream );
355 p_sys->i_state = STATE_NOSYNC;
362 /****************************************************************************
363 * PacketizeAVC1: Takes VCL blocks of data and creates annexe B type NAL stream
364 * Will always use 4 byte 0 0 0 1 startcodes
365 * Will prepend a SPS and PPS before each keyframe
366 ****************************************************************************/
367 static block_t *PacketizeAVC1( decoder_t *p_dec, block_t **pp_block )
369 decoder_sys_t *p_sys = p_dec->p_sys;
371 block_t *p_ret = NULL;
374 if( !pp_block || !*pp_block ) return NULL;
379 for( p = p_block->p_buffer; p < &p_block->p_buffer[p_block->i_buffer]; )
385 for( i = 0; i < p_sys->i_avcC_length_size; i++ )
387 i_size = (i_size << 8) | (*p++);
392 block_t *p_part = nal_get_annexeb( p_dec, p, i_size );
394 p_part->i_dts = p_block->i_dts;
395 p_part->i_pts = p_block->i_pts;
398 if( ( p_pic = ParseNALBlock( p_dec, p_part ) ) )
400 block_ChainAppend( &p_ret, p_pic );
405 block_Release( p_block );
410 static block_t *nal_get_annexeb( decoder_t *p_dec, uint8_t *p, int i_size )
414 p_nal = block_New( p_dec, 4 + i_size );
417 p_nal->p_buffer[0] = 0x00;
418 p_nal->p_buffer[1] = 0x00;
419 p_nal->p_buffer[2] = 0x00;
420 p_nal->p_buffer[3] = 0x01;
423 memcpy( &p_nal->p_buffer[4], p, i_size );
428 static void nal_get_decoded( uint8_t **pp_ret, int *pi_ret,
429 uint8_t *src, int i_src )
431 uint8_t *end = &src[i_src];
432 uint8_t *dst = malloc( i_src );
438 if( src < end - 3 && src[0] == 0x00 && src[1] == 0x00 &&
450 *pi_ret = dst - *pp_ret;
453 static inline int bs_read_ue( bs_t *s )
457 while( bs_read1( s ) == 0 && s->p < s->p_end && i < 32 )
461 return( ( 1 << i) - 1 + bs_read( s, i ) );
464 static inline int bs_read_se( bs_t *s )
466 int val = bs_read_ue( s );
468 return val&0x01 ? (val+1)/2 : -(val/2);
472 /*****************************************************************************
473 * ParseNALBlock: parses annexB type NALs
474 * All p_frag blocks are required to start with 0 0 0 1 4-byte startcode
475 *****************************************************************************/
476 static block_t *ParseNALBlock( decoder_t *p_dec, block_t *p_frag )
478 decoder_sys_t *p_sys = p_dec->p_sys;
479 block_t *p_pic = NULL;
481 const int i_nal_ref_idc = (p_frag->p_buffer[4] >> 5)&0x03;
482 const int i_nal_type = p_frag->p_buffer[4]&0x1f;
486 if( !p_sys->b_header && p_sys->i_frame_type != BLOCK_FLAG_TYPE_I) \
489 p_pic = block_ChainGather( p_sys->p_frame ); \
490 p_pic->i_length = 0; /* FIXME */ \
491 p_pic->i_flags |= p_sys->i_frame_type; \
493 p_sys->i_frame_type = 0; \
494 p_sys->p_frame = NULL; \
495 p_sys->b_slice = VLC_FALSE; \
497 if( ( p_pic->i_flags & BLOCK_FLAG_TYPE_I ) && \
498 p_sys->p_sps && p_sys->p_pps ) \
500 block_t *p_sps = block_Duplicate( p_sys->p_sps ); \
501 block_t *p_pps = block_Duplicate( p_sys->p_pps ); \
502 p_sps->i_dts = p_pps->i_dts = p_pic->i_dts; \
503 p_sps->i_pts = p_pps->i_pts = p_pic->i_pts; \
504 block_ChainAppend( &p_sps, p_pps ); \
505 block_ChainAppend( &p_sps, p_pic ); \
507 p_sys->b_header = VLC_TRUE; \
512 if( p_sys->b_slice && !p_sys->b_sps )
514 block_ChainRelease( p_sys->p_frame );
515 msg_Warn( p_dec, "waiting for SPS" );
518 p_sys->p_frame = NULL;
519 p_sys->b_slice = VLC_FALSE;
523 i_nal_type >= NAL_SLICE && i_nal_type <= NAL_SLICE_IDR )
525 p_sys->b_slice = VLC_TRUE;
526 /* Fragment will be discarded later on */
528 else if( i_nal_type >= NAL_SLICE && i_nal_type <= NAL_SLICE_IDR )
531 int i_dec, i_first_mb, i_slice_type, i_frame_num;
532 vlc_bool_t b_pic = VLC_FALSE;
535 /* do not convert the whole frame */
536 nal_get_decoded( &dec, &i_dec, &p_frag->p_buffer[5],
537 __MIN( p_frag->i_buffer - 5, 60 ) );
538 bs_init( &s, dec, i_dec );
540 /* first_mb_in_slice */
541 i_first_mb = bs_read_ue( &s );
544 switch( (i_slice_type = bs_read_ue( &s )) )
547 p_sys->i_frame_type = BLOCK_FLAG_TYPE_P;
550 p_sys->i_frame_type = BLOCK_FLAG_TYPE_B;
553 p_sys->i_frame_type = BLOCK_FLAG_TYPE_I;
555 case 3: case 8: /* SP */
556 p_sys->i_frame_type = BLOCK_FLAG_TYPE_P;
559 p_sys->i_frame_type = BLOCK_FLAG_TYPE_I;
563 /* pic_parameter_set_id */
566 i_frame_num = bs_read( &s, p_sys->i_log2_max_frame_num + 4 );
568 /* Detection of the first VCL NAL unit of a primary coded picture
570 if( i_frame_num != p_sys->i_frame_num ||
571 ( (i_nal_ref_idc != p_sys->i_nal_ref_idc) &&
572 (!i_nal_ref_idc || !p_sys->i_nal_ref_idc) ) )
576 p_sys->i_frame_num = i_frame_num;
577 p_sys->i_nal_ref_idc = i_nal_ref_idc;
579 if( !p_sys->b_frame_mbs_only )
582 if( bs_read( &s, 1 ) )
584 /* bottom_field_flag */
589 if( i_nal_type == NAL_SLICE_IDR )
592 int i_idr_pic_id = bs_read_ue( &s );
593 if( p_sys->i_nal_type != i_nal_type ) b_pic = VLC_TRUE;
594 if( p_sys->i_idr_pic_id != i_idr_pic_id ) b_pic = VLC_TRUE;
595 p_sys->i_idr_pic_id = i_idr_pic_id;
597 p_sys->i_nal_type = i_nal_type;
599 if( b_pic && p_sys->b_slice ) OUTPUT;
601 p_sys->b_slice = VLC_TRUE;
605 else if( i_nal_type == NAL_SPS )
612 if( !p_sys->b_sps ) msg_Dbg( p_dec, "found NAL_SPS" );
614 p_sys->b_sps = VLC_TRUE;
616 nal_get_decoded( &dec, &i_dec, &p_frag->p_buffer[5],
617 p_frag->i_buffer - 5 );
619 bs_init( &s, dec, i_dec );
620 /* Skip profile(8), constraint_set012, reserver(5), level(8) */
621 bs_skip( &s, 8 + 1+1+1 + 5 + 8 );
624 /* Skip i_log2_max_frame_num */
625 p_sys->i_log2_max_frame_num = bs_read_ue( &s );
627 i_tmp = bs_read_ue( &s );
630 /* skip i_log2_max_poc_lsb */
633 else if( i_tmp == 1 )
636 /* skip b_delta_pic_order_always_zero */
638 /* skip i_offset_for_non_ref_pic */
640 /* skip i_offset_for_top_to_bottom_field */
642 /* read i_num_ref_frames_in_poc_cycle */
643 i_cycle = bs_read_ue( &s );
644 if( i_cycle > 256 ) i_cycle = 256;
647 /* skip i_offset_for_ref_frame */
651 /* i_num_ref_frames */
653 /* b_gaps_in_frame_num_value_allowed */
657 p_dec->fmt_out.video.i_width = 16 * ( bs_read_ue( &s ) + 1 );
658 p_dec->fmt_out.video.i_height = 16 * ( bs_read_ue( &s ) + 1 );
660 /* b_frame_mbs_only */
661 p_sys->b_frame_mbs_only = bs_read( &s, 1 );
662 if( p_sys->b_frame_mbs_only == 0 )
666 /* b_direct8x8_inference */
670 i_tmp = bs_read( &s, 1 );
684 i_tmp = bs_read( &s, 1 );
687 /* read the aspect ratio part if any FIXME check it */
688 i_tmp = bs_read( &s, 1 );
691 static const struct { int w, h; } sar[14] =
693 { 0, 0 }, { 1, 1 }, { 12, 11 }, { 10, 11 },
694 { 16, 11 }, { 40, 33 }, { 24, 11 }, { 20, 11 },
695 { 32, 11 }, { 80, 33 }, { 18, 11 }, { 15, 11 },
696 { 64, 33 }, { 160,99 },
698 int i_sar = bs_read( &s, 8 );
708 w = bs_read( &s, 16 );
709 h = bs_read( &s, 16 );
712 p_dec->fmt_out.video.i_aspect = VOUT_ASPECT_FACTOR * w /
713 h * p_dec->fmt_out.video.i_width /
714 p_dec->fmt_out.video.i_height;
716 p_dec->fmt_out.video.i_aspect = VOUT_ASPECT_FACTOR;
722 if( p_sys->b_slice ) OUTPUT;
724 /* We have a new SPS */
725 if( p_sys->p_sps ) block_Release( p_sys->p_sps );
726 p_sys->p_sps = p_frag;
728 /* Do not append the SPS because we will insert it on keyframes */
731 else if( i_nal_type == NAL_PPS )
734 bs_init( &s, &p_frag->p_buffer[5], p_frag->i_buffer - 5 );
736 if( !p_sys->b_pps ) msg_Dbg( p_dec, "found NAL_PPS" );
737 p_sys->b_pps = VLC_TRUE;
741 if( p_sys->b_slice ) OUTPUT;
743 /* We have a new PPS */
744 if( p_sys->p_pps ) block_Release( p_sys->p_pps );
745 p_sys->p_pps = p_frag;
747 /* Do not append the PPS because we will insert it on keyframes */
750 else if( i_nal_type == NAL_AU_DELIMITER ||
751 i_nal_type == NAL_SEI ||
752 ( i_nal_type >= 13 && i_nal_type <= 18 ) )
754 if( p_sys->b_slice ) OUTPUT;
759 /* Append the block */
760 block_ChainAppend( &p_sys->p_frame, p_frag );