gst/vaapiencode/gstvaapih264encoder.c

   1
   2 #include "gstvaapih264encoder.h"
   3
   4 #include <string.h>
   5 #include <stdlib.h>
   6 #include <va/va.h>
   7 #include "va/va_x11.h"
   8 #include <X11/Xlib.h>
   9 #include <glib.h>
  10
  11 #include "gst/gstclock.h"
  12 #include "gst/gstvalue.h"
  13
  14 #include "gst/vaapi/gstvaapiobject.h"
  15 #include "gst/vaapi/gstvaapiobject_priv.h"
  16 #include "gst/vaapi/gstvaapicontext.h"
  17 #include "gst/vaapi/gstvaapisurface.h"
  18 #include "gst/vaapi/gstvaapivideobuffer.h"
  19 #include "gst/vaapi/gstvaapidisplay_priv.h"
  20
  21 /* enable old lib va*/
  22 //#define _SIMPLE_LIB_VA_
  23
  24 GST_DEBUG_CATEGORY_STATIC (gst_vaapi_h264_encoder_debug);
  25 #define GST_CAT_DEFAULT gst_vaapi_h264_encoder_debug
  26
  27 #define SHARE_CODED_BUF         0
  28
  29 #define DEFAULT_SURFACE_NUMBER  3
  30 #define DEFAULT_CODEDBUF_NUM    5
  31 #define DEFAULT_SID_INPUT       0 // suface_ids[0]
  32
  33 #define REF_RECON_SURFACE_NUM   2
  34
  35 #define ENTROPY_MODE_CAVLC      0
  36 #define ENTROPY_MODE_CABAC      1
  37
  38 #define BR_CBR          0
  39 #define BR_VBR          1
  40 #define BR_CQP          2
  41
  42 #define NAL_REF_IDC_NONE        0
  43 #define NAL_REF_IDC_LOW         1
  44 #define NAL_REF_IDC_MEDIUM      2
  45 #define NAL_REF_IDC_HIGH        3
  46
  47
  48 typedef enum {
  49   NAL_UNKNOWN     = 0,
  50   NAL_NON_IDR     = 1,
  51   NAL_IDR         = 5,    /* ref_idc != 0 */
  52   NAL_SEI         = 6,    /* ref_idc == 0 */
  53   NAL_SPS         = 7,
  54   NAL_PPS         = 8,
  55   NAL_AUD         = 9,
  56   NAL_FILLER      = 12,
  57 }H264_NAL_TYPE;
  58
  59
  60 typedef enum {
  61   SLICE_TYPE_P  = 0,
  62   SLICE_TYPE_B  = 1,
  63   SLICE_TYPE_I  = 2
  64 } H264_SLICE_TYPE;
  65
  66 struct _GstH264EncodeBuffer {
  67   GstBuffer           buffer;
  68   VABufferID         *coded_id;
  69   GstH264EncoderPrivate *encoder;
  70 };
  71
  72 struct _GstH264EncoderPrivate {
  73   GstH264Encoder   *public;
  74   guint32           format;   /*NV12, I420,*/
  75   gboolean          es_flag;  /*elementary flag*/
  76
  77   /* private data*/
  78   GQueue           *video_buffer_caches; /*not used for baseline*/
  79
  80   GstVaapiSurface  *ref_surface1;  /* reference buffer*/
  81   GstVaapiSurface  *ref_surface2;  /* for B frames */
  82   GstVaapiSurface  *recon_surface; /* reconstruct buffer*/
  83
  84   VABufferID        seq_parameter;
  85   VABufferID        pic_parameter;
  86   VABufferID        slice_parameter;
  87   VABufferID        packed_sps_par_buf;
  88   VABufferID        packed_sps_data_buf;
  89   VABufferID        packed_pps_par_buf;
  90   VABufferID        packed_pps_data_buf;
  91 #ifdef _SIMPLE_LIB_VA_
  92   VAEncSliceParameterBuffer     *slice_param_buffers;
  93 #else
  94   VAEncSliceParameterBufferH264 *slice_param_buffers;
  95 #endif
  96   guint32           default_slice_height;
  97   guint32           slice_mod_mb_num;
  98   guint32           default_cts_offset;
  99
 100   GstBuffer        *sps_data;
 101   GstBuffer        *pps_data;
 102
 103   GQueue           *queued_buffers;  /* GstVaapiVideoBuffers with surface*/
 104
 105   guint32           gop_count;
 106   guint32           cur_display_num;
 107   guint32           cur_decode_num;
 108   H264_SLICE_TYPE   cur_slice_type;
 109   guint64           last_decode_time;
 110 };
 111
 112 G_DEFINE_TYPE(GstH264Encoder, gst_h264_encoder, GST_TYPE_VAAPI_BASE_ENCODER);
 113
 114
 115 // 4096-1
 116 #define H264_BITSTREAM_ALLOC_ALIGN_MASK 0x0FFF
 117
 118 #define BIT_STREAM_BUFFER(stream)    ((stream)->buffer)
 119 #define BIT_STREAM_BIT_SIZE(stream)  ((stream)->bit_size)
 120
 121 struct _H264Bitstream {
 122   guint8   *buffer;
 123   guint32   bit_size;
 124   guint32   max_bit_capability;
 125 };
 126
 127 typedef struct _H264Bitstream H264Bitstream;
 128
 129 static const guint8 h264_bit_mask[9] = {0x00, 0x01, 0x03, 0x07, 0x0F, 0x1F, 0x3F, 0x7F, 0xFF};
 130
 131 static EncoderStatus gst_h264_encoder_flush(GstVaapiEncoder* encoder, GstVaapiDisplay *display,
 132                                     GstVaapiContext *context, GList **coded_pics);
 133
 134 /*other functions*/
 135 static EncoderStatus gst_h264_encoder_get_avcC_codec_data(
 136                                     GstVaapiEncoder* encoder, GstBuffer **buffer);
 137 static EncoderStatus gst_h264_encoder_get_nal_codec_data(GstVaapiEncoder* encoder, GstBuffer **buffer);
 138
 139 static gboolean      gst_h264_validate_parameters(GstVaapiBaseEncoder *encoder);
 140 static void          gst_h264_encoder_finalize(GObject *object);
 141 static void          gst_h264_encoder_init_public_values(GstH264Encoder* encoder);
 142
 143 static gboolean      gst_h264_encoder_alloc_slices(GstVaapiBaseEncoder *encoder,
 144                                     GstVaapiDisplay *display, GstVaapiContext *context);
 145 static gboolean      gst_h264_encoder_release_resource(GstVaapiBaseEncoder* encoder,
 146                                     GstVaapiDisplay *display, GstVaapiContext *context);
 147 static EncoderStatus gst_h264_encoder_prepare_next_buffer(GstVaapiBaseEncoder* encoder,
 148                                     GstVaapiVideoBuffer *display_buf,  gboolean need_flush,
 149                                     GstVaapiVideoBuffer **out_buf);
 150 static void          gst_h264_encoder_frame_failed(GstVaapiBaseEncoder *encoder,
 151                                     GstVaapiVideoBuffer* buffer);
 152 static EncoderStatus gst_h264_encoder_rendering(GstVaapiBaseEncoder *encoder, GstVaapiDisplay *display,
 153                                     GstVaapiContext *context, GstVaapiSurface *surface,
 154                                     guint frame_index, VABufferID coded_buf, gboolean *is_key);
 155 static void          gst_h264_notify_frame(GstVaapiBaseEncoder *encoder, guint8 *buf, guint32 size);
 156 //static EncoderStatus h264_encoder_read_sps_pps(
 157 //                                    GstH264EncoderPrivate *h264_prv, const guint8 *buf, guint32 size);
 158 static GstBuffer    *gst_h264_encoder_copy_coded_buffer(GstVaapiBaseEncoder *encoder,
 159                                     guint8 *frame, guint32 frame_size, VABufferID *coded_buf);
 160
 161 /* h264 bitstream functions */
 162 static void     h264_bitstream_init(H264Bitstream *bitstream, guint32 bit_capability);
 163 static gboolean h264_bitstream_write_uint(H264Bitstream *bitstream, guint32 value, guint32 bit_size);
 164 static gboolean h264_bitstream_align(H264Bitstream *bitstream, guint32 value);
 165 static gboolean h264_bitstream_write_ue(H264Bitstream *bitstream, guint32 value);
 166 static gboolean h264_bitstream_write_se(H264Bitstream *bitstream, gint32 value);
 167 static gboolean h264_bitstream_write_trailing_bits(H264Bitstream *bitstream);
 168
 169 static gboolean h264_bitstream_write_byte_array(H264Bitstream *bitstream, const guint8 *buf, guint32 byte_size);
 170 static void     h264_bitstream_destroy(H264Bitstream *bitstream, gboolean free_flag);
 171 static gboolean h264_bitstream_auto_grow(H264Bitstream *bitstream, guint32 extra_bit_size);
 172 static gboolean h264_bitstream_write_sps(H264Bitstream *bitstream, VAEncSequenceParameterBufferH264 *seq);
 173 static gboolean h264_bitstream_write_pps(H264Bitstream *bitstream, VAEncPictureParameterBufferH264 *pic);
 174 static gboolean h264_bitstream_write_nal_header(H264Bitstream *bitstream,
 175                                     guint nal_ref_idc, guint nal_unit_type);
 176
 177 static const guint8 *h264_next_nal(const guint8 *buffer, guint32 len, guint32 *nal_size);
 178 static gboolean h264_read_sps_attributes(const guint8 *sps_data, guint32 sps_size,
 179                                     guint32 *profile_idc, guint32 *profile_comp, guint32 *level_idc);
 180
 181 static void
 182 gst_h264_encoder_class_init(GstH264EncoderClass *klass)
 183 {
 184   GObjectClass * const object_class = G_OBJECT_CLASS(klass);
 185   GstVaapiEncoderClass * const encoder_class = GST_VAAPI_ENCODER_CLASS(klass);
 186   GstVaapiBaseEncoderClass * const base_class = GST_VAAPI_BASE_ENCODER_CLASS(klass);
 187
 188   g_type_class_add_private(klass, sizeof(GstH264EncoderPrivate));
 189
 190   GST_DEBUG_CATEGORY_INIT (gst_vaapi_h264_encoder_debug, "gst_va_h264_encoder", 0,
 191       "gst_va_h264_encoder element");
 192
 193   object_class->finalize = gst_h264_encoder_finalize;
 194
 195   base_class->validate_attributes = gst_h264_validate_parameters;
 196   base_class->pre_alloc_resource  = gst_h264_encoder_alloc_slices;
 197   base_class->release_resource    = gst_h264_encoder_release_resource;
 198   base_class->prepare_next_input_buffer = gst_h264_encoder_prepare_next_buffer;
 199   base_class->render_frame = gst_h264_encoder_rendering;
 200   base_class->notify_frame = gst_h264_notify_frame;
 201   base_class->copy_coded_frame = gst_h264_encoder_copy_coded_buffer;
 202   base_class->encode_frame_failed = gst_h264_encoder_frame_failed;
 203
 204   encoder_class->flush = gst_h264_encoder_flush;
 205
 206   encoder_class->get_codec_data = gst_h264_encoder_get_avcC_codec_data;
 207   /* encoder_class->get_codec_data = gst_h264_encoder_get_nal_codec_data; */
 208
 209   /*
 210   object_class->set_property = gst_h264_encoder_set_property;
 211   object_class->get_property = gst_h264_encoder_get_property;
 212   */
 213 }
 214
 215
 216 static void
 217 gst_h264_encode_buffer_class_init (gpointer g_class, gpointer class_data)
 218 {
 219   GstMiniObjectClass *mini_object_class = GST_MINI_OBJECT_CLASS(g_class);
 220
 221   h264_encode_buffer_parent_class = g_type_class_peek_parent(g_class);
 222   ENCODER_ASSERT(h264_encode_buffer_parent_class);
 223
 224   mini_object_class->finalize = (GstMiniObjectFinalizeFunction)
 225       gst_h264_encode_buffer_finalize;
 226 }
 227
 228
 229 static GType
 230 gst_h264_encode_buffer_get_type (void)
 231 {
 232   static GType s_h264_encode_buffer_type = 0;
 233   if (G_UNLIKELY (s_h264_encode_buffer_type == 0)) {
 234     static const GTypeInfo s_h264_encode_buffer_info = {
 235       sizeof(GstBufferClass),
 236       NULL,
 237       NULL,
 238       gst_h264_encode_buffer_class_init,
 239       NULL,
 240       NULL,
 241       sizeof(GstH264EncodeBuffer),
 242       0,
 243       NULL,
 244       NULL
 245     };
 246     s_h264_encode_buffer_type = g_type_register_static (GST_TYPE_BUFFER,
 247         "GstH264EncodeBuffer", &s_h264_encode_buffer_info, 0);
 248   }
 249   return s_h264_encode_buffer_type;
 250 }
 251
 252 static void
 253 gst_h264_encode_buffer_finalize (GstH264EncodeBuffer *h264_buffer)
 254 {
 255   GstH264EncoderPrivate *h264_prv = NULL;
 256   VABufferID* coded_id = NULL;
 257   GstVaapiDisplay *display = NULL;
 258
 259   gboolean is_locked = FALSE;
 260
 261   h264_prv = h264_buffer->encoder;
 262   coded_id = h264_buffer->coded_id;
 263   display = ENCODER_DISPLAY(h264_prv->public);
 264
 265   ENCODER_ASSERT(display);
 266   VADisplay va_dpy = gst_vaapi_display_get_display(display);
 267
 268   ENCODER_ASSERT(h264_prv);
 269   ENCODER_ASSERT(coded_id && VA_INVALID_ID!= *coded_id);
 270
 271   /*if (--(*h264_buffer->ref_coded_id) == 0) */
 272   {
 273     /*g_free(h264_buffer->ref_coded_id);*/
 274     ENCODER_ACQUIRE_DISPLAY_LOCK(display);
 275     vaUnmapBuffer(va_dpy, *coded_id);
 276     ENCODER_RELEASE_DISPLAY_LOCK(display);
 277     push_available_coded_buffer(h264_prv, coded_id);
 278   }
 279
 280   if (GST_MINI_OBJECT_CLASS(h264_encode_buffer_parent_class)->finalize) {
 281     GST_MINI_OBJECT_CLASS(h264_encode_buffer_parent_class)->finalize(GST_MINI_OBJECT(h264_buffer));
 282   }
 283 }
 284
 285 static GstH264EncodeBuffer *
 286 gst_h264_encode_buffer_new(GstH264EncoderPrivate *h264_prv,
 287                            VABufferID *coded_id)
 288 {
 289   GstH264EncodeBuffer *buf = (GstH264EncodeBuffer*)gst_mini_object_new(GST_TYPE_H264_ENCODE_BUFFER);
 290   buf->coded_id = coded_id;
 291   buf->encoder = h264_prv;
 292   return buf;
 293 }
 294
 295
 296 static GstVaapiSurface *
 297 h264_get_video_surface(GstH264EncoderPrivate *h264_prv, GstVaapiVideoBuffer *video_buffer)
 298 {
 299   //ref_surface
 300   GstVaapiSurface *ret = gst_vaapi_video_buffer_get_surface(video_buffer);
 301
 302   ENCODER_CHECK_STATUS(ret, NULL, "video buffer doesn't have a surface");
 303 #if 0
 304   g_queue_push_tail(h264_prv->video_buffer_caches,video_buffer);
 305   gst_buffer_ref(GST_BUFFER(video_buffer));
 306 #endif
 307   return ret;
 308
 309   end:
 310   return NULL;
 311 }
 312
 313 static void
 314 h264_release_video_surface(GstH264EncoderPrivate *h264_prv, VASurfaceID surface)
 315 {
 316 #if 0
 317   ENCODER_ASSERT(h264_prv->video_buffer_caches);
 318   g_queue_find_custom(h264_prv->video_buffer_caches,xx, compare_func);
 319   for (h264_prv->video_buffer_caches) {
 320   }
 321 #endif
 322 }
 323
 324 static VAProfile
 325 h264_get_va_profile(guint32 profile)
 326 {
 327   switch (profile) {
 328     case H264_PROFILE_BASELINE:
 329       return VAProfileH264Baseline;
 330
 331     case H264_PROFILE_MAIN:
 332       return VAProfileH264Main;
 333
 334     case H264_PROFILE_HIGH:
 335       return VAProfileH264High;
 336
 337     default:
 338       break;
 339   }
 340   return (-1);
 341 }
 342
 343 static void
 344 gst_h264_encoder_init(GstH264Encoder *encoder)
 345 {
 346   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(encoder);
 347   ENCODER_ASSERT(h264_prv);
 348   h264_prv->public = encoder;
 349
 350   /* init public attributes */
 351   gst_h264_encoder_init_public_values(encoder);
 352   gst_vaapi_base_encoder_set_frame_notify(GST_VAAPI_BASE_ENCODER(encoder), TRUE);
 353
 354   /* init private values*/
 355   h264_prv->format = GST_MAKE_FOURCC('N','V','1','2');
 356   h264_prv->es_flag = TRUE;
 357   //h264_prv->es_flag = FALSE;
 358
 359   h264_prv->ref_surface1 = NULL;
 360   h264_prv->ref_surface2 = NULL;
 361   h264_prv->recon_surface = NULL;
 362
 363   h264_prv->seq_parameter = VA_INVALID_ID;
 364   h264_prv->pic_parameter = VA_INVALID_ID;
 365   h264_prv->slice_parameter = VA_INVALID_ID;
 366   h264_prv->packed_sps_par_buf = VA_INVALID_ID;
 367   h264_prv->packed_sps_data_buf = VA_INVALID_ID;
 368   h264_prv->packed_pps_par_buf = VA_INVALID_ID;
 369   h264_prv->packed_pps_data_buf = VA_INVALID_ID;
 370   h264_prv->slice_param_buffers = NULL;
 371   h264_prv->default_slice_height = 0;
 372   h264_prv->slice_mod_mb_num = 0;
 373
 374   h264_prv->sps_data = NULL;
 375   h264_prv->pps_data = NULL;
 376
 377   h264_prv->queued_buffers = g_queue_new();
 378   h264_prv->gop_count = 0;
 379   h264_prv->cur_display_num = 0;
 380   h264_prv->cur_decode_num = 0;
 381   h264_prv->cur_slice_type = SLICE_TYPE_I;
 382   h264_prv->last_decode_time = 0LL;
 383   h264_prv->default_cts_offset = 0;
 384 }
 385
 386 static void
 387 gst_h264_encoder_finalize(GObject *object)
 388 {
 389   /*free private buffers*/
 390   GstVaapiEncoder *encoder = GST_VAAPI_ENCODER(object);
 391   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(object);
 392
 393   if (gst_vaapi_encoder_get_state(encoder) != VAAPI_ENC_NULL) {
 394     gst_vaapi_encoder_uninitialize(encoder);
 395   }
 396
 397   if (h264_prv->sps_data) {
 398     gst_buffer_unref(h264_prv->sps_data);
 399     h264_prv->sps_data = NULL;
 400   }
 401   if (h264_prv->pps_data) {
 402     gst_buffer_unref(h264_prv->pps_data);
 403     h264_prv->pps_data = NULL;
 404   }
 405   if (h264_prv->slice_param_buffers) {
 406     g_free(h264_prv->slice_param_buffers);
 407     h264_prv->slice_param_buffers = NULL;
 408   }
 409
 410   if (h264_prv->queued_buffers) {
 411     ENCODER_ASSERT(g_queue_is_empty(h264_prv->queued_buffers));
 412     g_queue_free(h264_prv->queued_buffers);
 413     h264_prv->queued_buffers = NULL;
 414   }
 415
 416   G_OBJECT_CLASS(gst_h264_encoder_parent_class)->finalize(object);
 417 }
 418
 419
 420 GstH264Encoder *
 421 gst_h264_encoder_new(void)
 422 {
 423   return GST_H264_ENCODER(g_object_new(GST_TYPE_H264_ENCODER, NULL));
 424 }
 425
 426 static void
 427 gst_h264_encoder_init_public_values(GstH264Encoder* encoder)
 428 {
 429   encoder->profile = 0;
 430   encoder->level = 0;
 431   encoder->bitrate = 0;
 432   encoder->intra_period = 0;
 433   encoder->init_qp = -1;
 434   encoder->min_qp = -1;
 435   encoder->slice_num = 0;
 436   encoder->b_frame_num = 0;
 437 }
 438
 439 void
 440 gst_h264_encoder_set_es_flag(GstH264Encoder* encoder, gboolean es)
 441 {
 442   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(encoder);
 443   h264_prv->es_flag = es;
 444 }
 445
 446
 447 gboolean
 448 gst_h264_validate_parameters(GstVaapiBaseEncoder *base_encoder)
 449 {
 450   GstH264Encoder *encoder = GST_H264_ENCODER(base_encoder);
 451   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(encoder);
 452   if (!ENCODER_WIDTH(encoder) || !ENCODER_HEIGHT(encoder) || !ENCODER_FPS(encoder)) {
 453     return FALSE;
 454   }
 455   if (!encoder->profile) {
 456     encoder->profile = H264_DEFAULT_PROFILE;
 457   }
 458   gst_vaapi_base_encoder_set_va_profile(base_encoder, h264_get_va_profile(encoder->profile));
 459   if (!encoder->level) {
 460     if (encoder->profile <= H264_PROFILE_BASELINE)
 461       encoder->level = H264_LEVEL_30;
 462     else
 463       encoder->level = H264_LEVEL_41;
 464   }
 465   if (!encoder->intra_period) {
 466     encoder->intra_period = H264_DEFAULT_INTRA_PERIOD;
 467   }
 468   if (-1 == encoder->init_qp) {
 469     encoder->init_qp = H264_DEFAULT_INIT_QP;
 470   }
 471   if (-1 == encoder->min_qp) {
 472     encoder->min_qp = H264_DEFAULT_MIN_QP;
 473   }
 474
 475   if (encoder->min_qp > encoder->init_qp) {
 476     encoder->min_qp = encoder->init_qp;
 477   }
 478
 479   /* default compress ratio 1: (4*8*1.5) */
 480   if (!encoder->bitrate) {
 481     encoder->bitrate = 0; //ENCODER_WIDTH(encoder)*ENCODER_HEIGHT(encoder)*ENCODER_FPS(encoder)/4;
 482   }
 483
 484   if (!encoder->slice_num) {
 485     encoder->slice_num = H264_DEFAULT_SLICE_NUM;
 486   }
 487
 488   /* need  calculate slice-num and each slice-height
 489         suppose:  ((encoder->height+15)/16) = 13, slice_num = 8
 490         then: slice_1_height = 2
 491                  slice_2_height = 2
 492                  slice_3_height = 2
 493                  slice_4_height = 2
 494                  slice_5_height = 2
 495                  slice_6_height = 1
 496                  slice_7_height = 1
 497                  slice_8_height = 1
 498    */
 499   h264_prv->default_slice_height = (ENCODER_HEIGHT(encoder)+15)/16/encoder->slice_num;
 500   if (0 == h264_prv->default_slice_height) { /* special value */
 501     h264_prv->default_slice_height = 1;
 502     h264_prv->slice_mod_mb_num = 0;
 503     encoder->slice_num = (ENCODER_HEIGHT(encoder)+15)/16;
 504   } else {
 505     h264_prv->slice_mod_mb_num = ((ENCODER_HEIGHT(encoder)+15)/16)%encoder->slice_num;
 506   }
 507
 508   if (encoder->b_frame_num) {
 509     h264_prv->default_cts_offset = GST_SECOND/ENCODER_FPS(encoder);
 510   } else {
 511     h264_prv->default_cts_offset = 0;
 512   }
 513   return TRUE;
 514 }
 515
 516
 517 static gboolean
 518 h264_encoder_release_parameters(GstH264Encoder *h264_encoder, GstVaapiDisplay *display, GstVaapiContext *context)
 519 {
 520   VAStatus va_status = VA_STATUS_SUCCESS;
 521   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
 522
 523   gboolean is_locked = FALSE;
 524
 525   ENCODER_ASSERT(display);
 526   ENCODER_ASSERT(context);
 527   VAAPI_UNUSED_ARG(va_status);
 528   VADisplay va_dpy = gst_vaapi_display_get_display(display);
 529
 530   ENCODER_ACQUIRE_DISPLAY_LOCK(display);
 531   if (VA_INVALID_ID != h264_prv->seq_parameter) {
 532     va_status = vaDestroyBuffer(va_dpy, h264_prv->seq_parameter);
 533     h264_prv->seq_parameter = VA_INVALID_ID;
 534   }
 535   if (VA_INVALID_ID != h264_prv->pic_parameter) {
 536     va_status = vaDestroyBuffer(va_dpy, h264_prv->pic_parameter);
 537     h264_prv->pic_parameter = VA_INVALID_ID;
 538   }
 539   if (VA_INVALID_ID != h264_prv->slice_parameter) {
 540     va_status = vaDestroyBuffer(va_dpy, h264_prv->slice_parameter);
 541     h264_prv->slice_parameter = VA_INVALID_ID;
 542   }
 543
 544   if (VA_INVALID_ID != h264_prv->packed_sps_par_buf) {
 545     va_status = vaDestroyBuffer(va_dpy, h264_prv->packed_sps_par_buf);
 546     h264_prv->packed_sps_par_buf = VA_INVALID_ID;
 547   }
 548   if (VA_INVALID_ID != h264_prv->packed_sps_data_buf) {
 549     va_status = vaDestroyBuffer(va_dpy, h264_prv->packed_sps_data_buf);
 550     h264_prv->packed_sps_data_buf = VA_INVALID_ID;
 551   }
 552   if (VA_INVALID_ID != h264_prv->packed_pps_par_buf) {
 553     va_status = vaDestroyBuffer(va_dpy, h264_prv->packed_pps_par_buf);
 554     h264_prv->packed_pps_par_buf = VA_INVALID_ID;
 555   }
 556   if (VA_INVALID_ID != h264_prv->packed_pps_data_buf) {
 557     va_status = vaDestroyBuffer(va_dpy, h264_prv->packed_pps_data_buf);
 558     h264_prv->packed_pps_data_buf = VA_INVALID_ID;
 559   }
 560
 561   ENCODER_RELEASE_DISPLAY_LOCK(display);
 562
 563   if (h264_prv->slice_param_buffers) {
 564     g_free(h264_prv->slice_param_buffers);
 565     h264_prv->slice_param_buffers = NULL;
 566   }
 567
 568   if (h264_prv->sps_data) {
 569     gst_buffer_unref(h264_prv->sps_data);
 570     h264_prv->sps_data = NULL;
 571   }
 572   if (h264_prv->pps_data) {
 573     gst_buffer_unref(h264_prv->pps_data);
 574     h264_prv->pps_data = NULL;
 575   }
 576
 577   return TRUE;
 578 }
 579
 580 static void
 581 h264_release_queued_buffers(GstH264EncoderPrivate *h264_prv)
 582 {
 583     while (!g_queue_is_empty(h264_prv->queued_buffers)) {
 584     GstBuffer* tmp = g_queue_pop_head(h264_prv->queued_buffers);
 585     if (tmp)
 586       gst_buffer_unref(tmp);
 587   }
 588 }
 589
 590
 591 static gboolean
 592 gst_h264_encoder_release_resource(GstVaapiBaseEncoder* encoder, GstVaapiDisplay *display, GstVaapiContext *context)
 593 {
 594   GstH264Encoder* h264_encoder = GST_H264_ENCODER(encoder);
 595   gboolean ret = TRUE;
 596   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
 597
 598   /* release buffers first */
 599   h264_encoder_release_parameters(h264_encoder, display, context);
 600   h264_release_queued_buffers(h264_prv);
 601   h264_prv->cur_display_num = 0;
 602   h264_prv->cur_decode_num = 0;
 603   h264_prv->cur_slice_type = SLICE_TYPE_I;
 604   h264_prv->gop_count = 0;
 605   h264_prv->last_decode_time = 0LL;
 606   h264_prv->default_cts_offset = 0;
 607
 608   /*remove ref_surface1*/
 609   if (h264_prv->ref_surface1) {
 610     if (context) {
 611       gst_vaapi_context_put_surface(context, h264_prv->ref_surface1);
 612     } else {
 613       g_object_unref(h264_prv->ref_surface1);
 614     }
 615     h264_prv->ref_surface1 = NULL;
 616   }
 617
 618   if (h264_prv->ref_surface2) {
 619     if (context) {
 620       gst_vaapi_context_put_surface(context, h264_prv->ref_surface2);
 621     } else {
 622       g_object_unref(h264_prv->ref_surface2);
 623     }
 624     h264_prv->ref_surface2 = NULL;
 625   }
 626
 627   /*remove recon_surface*/
 628   if (h264_prv->recon_surface) {
 629     if (context) {
 630       gst_vaapi_context_put_surface(context, h264_prv->recon_surface);
 631     } else {
 632       g_object_unref(h264_prv->recon_surface);
 633     }
 634     h264_prv->recon_surface = NULL;
 635   }
 636
 637   return ret;
 638 }
 639
 640 static gboolean
 641 gst_h264_encoder_alloc_slices(GstVaapiBaseEncoder *encoder, GstVaapiDisplay *display, GstVaapiContext *context)
 642 {
 643   gboolean ret = TRUE;
 644   GstH264Encoder *h264_encoder = GST_H264_ENCODER(encoder);
 645   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(encoder);
 646
 647   h264_prv->slice_param_buffers =
 648 #ifdef _SIMPLE_LIB_VA_
 649   (VAEncSliceParameterBuffer*)
 650 #else
 651   (VAEncSliceParameterBufferH264*)
 652 #endif
 653           g_malloc0_n(h264_encoder->slice_num,
 654               sizeof(h264_prv->slice_param_buffers[0]));
 655
 656   return ret;
 657 }
 658
 659 static void
 660 gst_h264_encoder_frame_failed(GstVaapiBaseEncoder *encoder, GstVaapiVideoBuffer* buffer)
 661 {
 662   GstH264Encoder *h264_encoder = GST_H264_ENCODER(encoder);
 663   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
 664
 665   h264_release_queued_buffers(h264_prv);
 666   h264_prv->cur_display_num = 0;
 667   h264_prv->cur_decode_num = 0;
 668   h264_prv->cur_slice_type = SLICE_TYPE_I;
 669   h264_prv->gop_count = 0;
 670   h264_prv->last_decode_time = 0LL;
 671 }
 672
 673 static EncoderStatus
 674 gst_h264_encoder_prepare_next_buffer(GstVaapiBaseEncoder* encoder,
 675                               GstVaapiVideoBuffer *display_buf, gboolean need_flush,
 676                               GstVaapiVideoBuffer **out_buf)
 677 {
 678   EncoderStatus ret = ENCODER_NO_ERROR;
 679   GstH264Encoder *h264_encoder = GST_H264_ENCODER(encoder);
 680   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
 681   GstVaapiVideoBuffer  *return_buf = NULL;
 682   GstVaapiVideoBuffer  *tmp_next_buf = NULL;
 683   guint64 pts = 0;
 684   guint32 cts = 0;
 685
 686   if (NULL == display_buf && g_queue_is_empty(h264_prv->queued_buffers)) {
 687     ret = ENCODER_BUFFER_EMPTY;
 688     if (h264_prv->gop_count >= h264_encoder->intra_period || need_flush)
 689       h264_prv->gop_count = 0;
 690     goto end;
 691   }
 692
 693   if (display_buf) {
 694     ++h264_prv->gop_count;
 695     gst_buffer_ref(GST_BUFFER_CAST(display_buf));
 696     h264_prv->last_decode_time = GST_BUFFER_TIMESTAMP(display_buf);
 697   }
 698
 699   /* first frame */
 700   if (h264_prv->gop_count == 1) {
 701     ENCODER_ASSERT(display_buf);
 702     h264_prv->cur_display_num = 0;
 703     h264_prv->cur_decode_num = 0;
 704     h264_prv->cur_slice_type = SLICE_TYPE_I;
 705     return_buf = display_buf;
 706     goto end;
 707   }
 708
 709   if (display_buf) {
 710     if (h264_encoder->b_frame_num &&
 711         h264_prv->gop_count < h264_encoder->intra_period &&
 712         g_queue_get_length(h264_prv->queued_buffers) < h264_encoder->b_frame_num
 713         )
 714     {
 715       g_queue_push_tail(h264_prv->queued_buffers, display_buf);
 716       ret = ENCODER_BUFFER_WAITING;
 717       goto end;
 718     }
 719     h264_prv->cur_slice_type = SLICE_TYPE_P;
 720     h264_prv->cur_display_num = h264_prv->gop_count-1;
 721     ++h264_prv->cur_decode_num;
 722     return_buf = display_buf;
 723   } else {
 724     if (need_flush) {
 725       return_buf = (GstVaapiVideoBuffer*)g_queue_pop_tail(h264_prv->queued_buffers);
 726       h264_prv->cur_slice_type = SLICE_TYPE_P;
 727       h264_prv->cur_display_num = h264_prv->gop_count - 1;
 728       ++h264_prv->cur_decode_num;
 729     } else {
 730       return_buf = (GstVaapiVideoBuffer*)g_queue_pop_head(h264_prv->queued_buffers);
 731       h264_prv->cur_slice_type = SLICE_TYPE_B;
 732       h264_prv->cur_display_num = h264_prv->gop_count - 2 - g_queue_get_length(h264_prv->queued_buffers);
 733     }
 734   }
 735
 736 end:
 737   *out_buf = return_buf;
 738   /* calculate cts/pts/dts */
 739   if (return_buf) {
 740     pts = GST_BUFFER_TIMESTAMP(return_buf);
 741     tmp_next_buf = (GstVaapiVideoBuffer*)g_queue_peek_head(h264_prv->queued_buffers);
 742     if (tmp_next_buf) {
 743       GST_BUFFER_TIMESTAMP(return_buf) = GST_BUFFER_TIMESTAMP(tmp_next_buf);
 744     } else if (SLICE_TYPE_B == h264_prv->cur_slice_type) {
 745       GST_BUFFER_TIMESTAMP(return_buf) = h264_prv->last_decode_time;
 746     }
 747     cts = (pts + h264_prv->default_cts_offset - GST_BUFFER_TIMESTAMP(return_buf));
 748     ENCODER_ASSERT(cts < 0x80000000);
 749     if (cts > 0x80000000) {
 750       cts = 0;
 751     }
 752     GST_BUFFER_OFFSET_END(return_buf) = cts;
 753   }
 754   return ret;
 755 }
 756
 757
 758 #ifdef _SIMPLE_LIB_VA_
 759 static EncoderStatus
 760 gst_h264_encoder_rendering(GstVaapiBaseEncoder *encoder, GstVaapiDisplay *display,
 761                              GstVaapiContext *context, GstVaapiSurface *surface,
 762                              guint frame_index, VABufferID coded_buf, gboolean *is_key)
 763 {
 764   EncoderStatus ret = ENCODER_NO_ERROR;
 765   VAStatus va_status = VA_STATUS_SUCCESS;
 766   GstH264Encoder *h264_encoder = GST_H264_ENCODER(encoder);
 767   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
 768   VAEncPictureParameterBufferH264 pic_h264;
 769   VAEncSliceParameterBuffer *slice_h264 = NULL;
 770
 771   gboolean is_locked = FALSE;
 772
 773   ENCODER_ASSERT(display && context);
 774   VADisplay va_dpy = gst_vaapi_display_get_display(display);
 775   VAContextID context_id = GST_VAAPI_OBJECT_ID(context);
 776
 777   *is_key = (h264_prv->cur_slice_type == SLICE_TYPE_I);
 778
 779   /* lock display */
 780   ENCODER_ACQUIRE_DISPLAY_LOCK(display);
 781   /*handle first surface_index*/
 782   /*only need first frame*/
 783   if (VA_INVALID_ID == h264_prv->seq_parameter) { /*first time*/
 784     VAEncSequenceParameterBufferH264 seq_h264 = { 0 };
 785     seq_h264.level_idc = h264_encoder->level; /* 3.0 */
 786     seq_h264.max_num_ref_frames = 1; /*Only I, P frames*/
 787     seq_h264.picture_width_in_mbs = (ENCODER_WIDTH(h264_encoder)+15)/16;
 788     seq_h264.picture_height_in_mbs = (ENCODER_HEIGHT(h264_encoder)+15)/16;
 789
 790     seq_h264.bits_per_second = h264_encoder->bitrate;
 791     seq_h264.frame_rate = ENCODER_FPS(h264_encoder);
 792     seq_h264.initial_qp = h264_encoder->init_qp; /*qp_value; 15, 24, 26?*/
 793     seq_h264.min_qp = h264_encoder->min_qp;     /*1, 6, 10*/
 794     seq_h264.basic_unit_size = 0;
 795     seq_h264.intra_period = h264_encoder->intra_period;
 796     seq_h264.intra_idr_period = h264_encoder->intra_period;
 797
 798     va_status = vaCreateBuffer(va_dpy, context_id,
 799                                VAEncSequenceParameterBufferType,
 800                                sizeof(seq_h264), 1, &seq_h264, &h264_prv->seq_parameter);
 801     ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS == va_status, ENCODER_ENC_RES_ERR, "alloc seq-buffer failed.\n");
 802     va_status = vaRenderPicture(va_dpy, context_id, &h264_prv->seq_parameter, 1);
 803     ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS == va_status, ENCODER_PICTURE_ERR, "vaRenderPicture seq-parameters failed.\n");
 804   }
 805
 806   /* set pic_parameters*/
 807   if (!h264_prv->ref_surface1) {
 808     h264_prv->ref_surface1 = gst_vaapi_context_get_surface(context);
 809     ENCODER_CHECK_STATUS(h264_prv->ref_surface1, ENCODER_SURFACE_ERR, "reference surface, h264_pop_free_surface failed.\n");
 810   }
 811   if (!h264_prv->recon_surface) {
 812     h264_prv->recon_surface = gst_vaapi_context_get_surface(context);
 813     ENCODER_CHECK_STATUS(h264_prv->recon_surface, ENCODER_SURFACE_ERR, "reconstructed surface, h264_pop_free_surface failed.\n");
 814   }
 815
 816   pic_h264.reference_picture = GST_VAAPI_OBJECT_ID(h264_prv->ref_surface1);
 817   pic_h264.reconstructed_picture = GST_VAAPI_OBJECT_ID(h264_prv->recon_surface);
 818   pic_h264.coded_buf = coded_buf;
 819   pic_h264.picture_width = ENCODER_WIDTH(h264_encoder);
 820   pic_h264.picture_height = ENCODER_HEIGHT(h264_encoder);
 821   pic_h264.last_picture = 0; // last pic or not
 822
 823   if (VA_INVALID_ID != h264_prv->pic_parameter) { /* share the same pic_parameter*/
 824     vaDestroyBuffer(va_dpy, h264_prv->pic_parameter);
 825     h264_prv->pic_parameter = VA_INVALID_ID;
 826   }
 827   va_status = vaCreateBuffer(va_dpy, context_id, VAEncPictureParameterBufferType,
 828                                sizeof(pic_h264), 1, &pic_h264, &h264_prv->pic_parameter);
 829
 830   ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS ==va_status, ENCODER_PICTURE_ERR, "creating pic-param buffer failed.\n");
 831
 832   va_status = vaRenderPicture(va_dpy, context_id, &h264_prv->pic_parameter, 1);
 833   ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS ==va_status, ENCODER_PICTURE_ERR, "rendering pic-param buffer failed.\n");
 834
 835   /* set slice parameters, support multiple slices */
 836   int i = 0;
 837   guint32 last_row_num = 0;
 838   guint32 slice_mod_num = h264_prv->slice_mod_mb_num;
 839
 840   memset(h264_prv->slice_param_buffers, 0, h264_encoder->slice_num*sizeof(h264_prv->slice_param_buffers[0]));
 841   for (i = 0; i < h264_encoder->slice_num; ++i) {
 842     slice_h264 = &h264_prv->slice_param_buffers[i];
 843     slice_h264->start_row_number = last_row_num;               /* unit MB*/
 844     slice_h264->slice_height = h264_prv->default_slice_height; /* unit MB */
 845     if (slice_mod_num) {
 846       ++slice_h264->slice_height;
 847       --slice_mod_num;
 848     }
 849     last_row_num += slice_h264->slice_height;
 850     slice_h264->slice_flags.bits.is_intra = *is_key;
 851     slice_h264->slice_flags.bits.disable_deblocking_filter_idc = 0;
 852
 853   }
 854   ENCODER_ASSERT(last_row_num == (ENCODER_HEIGHT(h264_encoder)+15)/16);
 855
 856   if (VA_INVALID_ID != h264_prv->slice_parameter) {
 857     vaDestroyBuffer(va_dpy, h264_prv->slice_parameter);
 858     h264_prv->slice_parameter = VA_INVALID_ID;
 859   }
 860   va_status = vaCreateBuffer(va_dpy,
 861                              context_id,
 862                              VAEncSliceParameterBufferType,
 863                              sizeof(h264_prv->slice_param_buffers[0]),
 864                              h264_encoder->slice_num,
 865                              h264_prv->slice_param_buffers,
 866                              &h264_prv->slice_parameter);
 867   ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS ==va_status, ENCODER_PICTURE_ERR, "creating slice-parameters buffer failed.\n");
 868
 869   va_status = vaRenderPicture(va_dpy, context_id, &h264_prv->slice_parameter, 1);
 870   ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS ==va_status, ENCODER_PICTURE_ERR, "rendering slice-parameters buffer failed.\n");
 871
 872   /*after finished, set ref_surface1_index, recon_surface_index */
 873   GstVaapiSurface *swap = h264_prv->ref_surface1;
 874   h264_prv->ref_surface1 = h264_prv->recon_surface;
 875   h264_prv->recon_surface = swap;
 876
 877   end:
 878   ENCODER_RELEASE_DISPLAY_LOCK(display);
 879   return ret;
 880 }
 881
 882 #else  /* extended libva, new parameter structures*/
 883
 884 static void h264_swap_surface(GstVaapiSurface **s1, GstVaapiSurface **s2)
 885 {
 886   GstVaapiSurface *tmp;
 887
 888   g_return_if_fail(s1 && s2);
 889   tmp = *s1;
 890   *s1 = *s2;
 891   *s2 = tmp;
 892 }
 893
 894 static gboolean
 895 h264_recreate_seq_param(GstH264Encoder *h264_encoder,
 896                         VADisplay va_dpy, VAContextID context_id)
 897 {
 898   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
 899   VAEncSequenceParameterBufferH264 seq_h264 = { 0 };
 900   guint width_in_mbs, height_in_mbs;
 901   gboolean ret = TRUE;
 902   VAStatus va_status = VA_STATUS_SUCCESS;
 903
 904   /* only once */
 905   if (VA_INVALID_ID != h264_prv->seq_parameter)
 906     return TRUE;
 907
 908   width_in_mbs = (ENCODER_WIDTH(h264_encoder)+15)/16;
 909   height_in_mbs = (ENCODER_HEIGHT(h264_encoder)+15)/16;
 910
 911   seq_h264.seq_parameter_set_id = 0;
 912   seq_h264.profile_idc = h264_encoder->profile;
 913   seq_h264.level_idc = h264_encoder->level; /* 3.0 */
 914   seq_h264.intra_period = h264_encoder->intra_period;
 915   seq_h264.ip_period = 0;           // ?
 916   seq_h264.max_num_ref_frames = (h264_encoder->b_frame_num < 2 ? 3 : h264_encoder->b_frame_num+1);  // ?, why 4
 917   seq_h264.picture_width_in_mbs = width_in_mbs;
 918   seq_h264.picture_height_in_mbs = height_in_mbs;
 919   seq_h264.frame_mbs_only_flag = 1;
 920   seq_h264.target_usage = 1;        // ?
 921
 922   if (h264_encoder->init_qp == -1)
 923       seq_h264.rate_control_method = BR_CBR;
 924   else if (h264_encoder->init_qp == -2)
 925       seq_h264.rate_control_method = BR_VBR;
 926   else {
 927       assert(h264_encoder->init_qp >= 0 && h264_encoder->init_qp <= 51);
 928       seq_h264.rate_control_method = BR_CQP;
 929   }
 930
 931   if (h264_encoder->bitrate> 0)
 932       seq_h264.bits_per_second = h264_encoder->bitrate; /* use kbps as input */
 933   else
 934       seq_h264.bits_per_second = 0;
 935
 936   if (seq_h264.rate_control_method == BR_VBR) {
 937     seq_h264.max_bits_per_second = seq_h264.bits_per_second*1.5;
 938     seq_h264.min_bits_per_second = seq_h264.bits_per_second*0.3;
 939   }
 940   seq_h264.initial_hrd_buffer_fullness = 0;   // ??
 941   seq_h264.hrd_buffer_size = 0;
 942   seq_h264.num_units_in_tick = 100;
 943   seq_h264.time_scale = ENCODER_FPS(h264_encoder)*2*seq_h264.num_units_in_tick;
 944
 945   if (height_in_mbs*16 - ENCODER_HEIGHT(h264_encoder)) {
 946     seq_h264.frame_cropping_flag = 1;
 947     seq_h264.frame_crop_left_offset = 0;
 948     seq_h264.frame_crop_right_offset = 0;
 949     seq_h264.frame_crop_top_offset = 0;
 950     seq_h264.frame_crop_bottom_offset =
 951            (height_in_mbs * 16 - ENCODER_HEIGHT(h264_encoder))/(2 * (!seq_h264.frame_mbs_only_flag + 1));
 952   }
 953   seq_h264.pic_order_cnt_type = 0;   // pic order cnt
 954   seq_h264.direct_8x8_inference_flag = 0;
 955   seq_h264.log2_max_frame_num_minus4 = 4; // log2(seq_h264.intra_period)-3 : 0
 956   seq_h264.log2_max_pic_order_cnt_lsb_minus4 = seq_h264.log2_max_frame_num_minus4+2;
 957   seq_h264.vui_flag = 0; // 0? or 1?
 958
 959   va_status = vaCreateBuffer(va_dpy, context_id,
 960                              VAEncSequenceParameterBufferType,
 961                              sizeof(seq_h264), 1,
 962                              &seq_h264, &h264_prv->seq_parameter);
 963   ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS == va_status,
 964                      FALSE, "alloc seq-buffer failed.\n");
 965
 966   /*pack sps header buffer/data */
 967   if (NULL == h264_prv->sps_data) {
 968     VAEncPackedHeaderParameterBuffer packed_header_param_buffer = { 0 };
 969     guint32 length_in_bits, offset_in_bytes;
 970     guint8 *packed_seq_buffer = NULL;
 971     H264Bitstream bitstream;
 972     h264_bitstream_init(&bitstream, 128*8);
 973     h264_bitstream_write_uint(&bitstream, 0x00000001, 32); /* start code*/
 974     h264_bitstream_write_nal_header(&bitstream, NAL_REF_IDC_HIGH, NAL_SPS);
 975     h264_bitstream_write_sps(&bitstream, &seq_h264);
 976     ENCODER_ASSERT(BIT_STREAM_BIT_SIZE(&bitstream)%8 == 0);
 977     length_in_bits = BIT_STREAM_BIT_SIZE(&bitstream);
 978     packed_seq_buffer = BIT_STREAM_BUFFER(&bitstream);
 979     //h264_prv->sps_data = gst_buffer_new_and_alloc((length_in_bits+7)/8);
 980     //GST_BUFFER_SIZE(h264_prv->sps_data) = (length_in_bits+7)/8-4;
 981     //memcpy(GST_BUFFER_DATA(h264_prv->sps_data), packed_seq_buffer+4, (length_in_bits+7)/8-4);
 982
 983     offset_in_bytes = 0;
 984     packed_header_param_buffer.type = VAEncPackedHeaderSPS;
 985     packed_header_param_buffer.insert_emulation_bytes = 1;
 986     packed_header_param_buffer.skip_emulation_check_count = 5;
 987     packed_header_param_buffer.num_headers = 1;
 988     packed_header_param_buffer.length_in_bits = &length_in_bits;
 989     packed_header_param_buffer.offset_in_bytes = &offset_in_bytes;
 990     va_status = vaCreateBuffer(va_dpy,
 991                                context_id,
 992                                VAEncPackedHeaderParameterBufferType,
 993                                sizeof(packed_header_param_buffer), 1,
 994                                &packed_header_param_buffer,
 995                                &h264_prv->packed_sps_par_buf);
 996     ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS == va_status,
 997                          FALSE,
 998                          "EncPackedSeqHeaderParameterBuffer failed");
 999     va_status = vaCreateBuffer(va_dpy,
1000                                context_id,
1001                                VAEncPackedHeaderDataBufferType,
1002                                (length_in_bits + 7) / 8, 1,
1003                                packed_seq_buffer,
1004                                &h264_prv->packed_sps_data_buf);
1005     h264_bitstream_destroy(&bitstream, TRUE);
1006     ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS == va_status,
1007                          FALSE,
1008                          "EncPackedSeqHeaderDataBuffer failed");
1009   }
1010 end:
1011
1012   return ret;
1013 }
1014
1015 static gboolean
1016 h264_recreate_pic_param(GstH264Encoder *h264_encoder,
1017                         VADisplay va_dpy, VAContextID context_id,
1018                         VABufferID coded_buf)
1019 {
1020   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
1021   VAEncPictureParameterBufferH264 pic_h264;
1022   gboolean ret = TRUE;
1023   VAStatus va_status = VA_STATUS_SUCCESS;
1024
1025   VAAPI_UNUSED_ARG(va_status);
1026   memset(&pic_h264, 0, sizeof(pic_h264));
1027   pic_h264.CurrPic.picture_id = GST_VAAPI_OBJECT_ID(h264_prv->recon_surface);
1028   pic_h264.CurrPic.TopFieldOrderCnt = h264_prv->cur_display_num * 2;   // ??? /**/
1029   pic_h264.ReferenceFrames[0].picture_id = GST_VAAPI_OBJECT_ID(h264_prv->ref_surface1);
1030   pic_h264.ReferenceFrames[1].picture_id = GST_VAAPI_OBJECT_ID(h264_prv->ref_surface2);
1031   pic_h264.ReferenceFrames[2].picture_id = VA_INVALID_ID;
1032   pic_h264.CodedBuf = coded_buf;
1033
1034   pic_h264.seq_parameter_set_id = 0;
1035   pic_h264.pic_parameter_set_id = 0;
1036   pic_h264.last_picture = 0;
1037   pic_h264.frame_num = (h264_prv->cur_slice_type == SLICE_TYPE_B ?
1038                        (h264_prv->cur_decode_num + 1) : h264_prv->cur_decode_num);
1039   pic_h264.coding_type = 0;
1040   pic_h264.pic_init_qp = (h264_encoder->init_qp >= 0 ? h264_encoder->init_qp : 26);
1041   pic_h264.num_ref_idx_l0_active_minus1 = 0;
1042   pic_h264.num_ref_idx_l1_active_minus1 = 0;
1043   pic_h264.pic_fields.bits.idr_pic_flag = (h264_prv->cur_slice_type == SLICE_TYPE_I);
1044   pic_h264.pic_fields.bits.reference_pic_flag = (h264_prv->cur_slice_type != SLICE_TYPE_B);
1045   pic_h264.pic_fields.bits.entropy_coding_mode_flag = ENTROPY_MODE_CABAC;
1046   pic_h264.pic_fields.bits.weighted_pred_flag = 0;
1047   pic_h264.pic_fields.bits.weighted_bipred_idc = 0;
1048   pic_h264.pic_fields.bits.transform_8x8_mode_flag = 1;
1049   pic_h264.pic_fields.bits.deblocking_filter_control_present_flag = 1;
1050
1051   if (VA_INVALID_ID != h264_prv->pic_parameter) { /* share the same pic_parameter*/
1052     vaDestroyBuffer(va_dpy, h264_prv->pic_parameter);
1053     h264_prv->pic_parameter = VA_INVALID_ID;
1054   }
1055   va_status = vaCreateBuffer(va_dpy, context_id, VAEncPictureParameterBufferType,
1056                                sizeof(pic_h264), 1, &pic_h264, &h264_prv->pic_parameter);
1057
1058   ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS ==va_status, FALSE, "creating pic-param buffer failed.\n");
1059
1060   //if (NULL == h264_prv->pps_data) {
1061   if (VA_INVALID_ID == h264_prv->packed_pps_data_buf) {
1062     VAEncPackedHeaderParameterBuffer packed_header_param_buffer = { 0 };
1063     guint32 length_in_bits, offset_in_bytes;
1064     guint8 *packed_pic_buffer = NULL;
1065     H264Bitstream bitstream;
1066     h264_bitstream_init(&bitstream, 128*8);
1067     h264_bitstream_write_uint(&bitstream, 0x00000001, 32); /* start code*/
1068     h264_bitstream_write_nal_header(&bitstream, NAL_REF_IDC_HIGH, NAL_PPS);
1069     h264_bitstream_write_pps(&bitstream, &pic_h264);
1070     ENCODER_ASSERT(BIT_STREAM_BIT_SIZE(&bitstream)%8 == 0);
1071     length_in_bits = BIT_STREAM_BIT_SIZE(&bitstream);
1072     packed_pic_buffer = BIT_STREAM_BUFFER(&bitstream);
1073     //h264_prv->pps_data = gst_buffer_new_and_alloc((length_in_bits+7)/8);
1074     //GST_BUFFER_SIZE(h264_prv->pps_data) = (length_in_bits+7)/8-4;
1075     //memcpy(GST_BUFFER_DATA(h264_prv->pps_data), packed_pic_buffer+4, (length_in_bits+7)/8-4);
1076
1077     offset_in_bytes = 0;
1078     packed_header_param_buffer.type = VAEncPackedHeaderPPS;
1079     packed_header_param_buffer.insert_emulation_bytes = 1;
1080     packed_header_param_buffer.skip_emulation_check_count = 5;
1081     packed_header_param_buffer.num_headers = 1;
1082     packed_header_param_buffer.length_in_bits = &length_in_bits;
1083     packed_header_param_buffer.offset_in_bytes = &offset_in_bytes;
1084
1085     va_status = vaCreateBuffer(va_dpy,
1086                                context_id,
1087                                VAEncPackedHeaderParameterBufferType,
1088                                sizeof(packed_header_param_buffer), 1,
1089                                &packed_header_param_buffer,
1090                                &h264_prv->packed_pps_par_buf);
1091     ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS == va_status,
1092                          FALSE,
1093                          "EncPackedPicHeaderParameterBuffer failed");
1094
1095     va_status = vaCreateBuffer(va_dpy,
1096                                context_id,
1097                                VAEncPackedHeaderDataBufferType,
1098                                (length_in_bits + 7) / 8, 1,
1099                                packed_pic_buffer,
1100                                &h264_prv->packed_pps_data_buf);
1101     h264_bitstream_destroy(&bitstream, TRUE);
1102     ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS == va_status,
1103                          FALSE,
1104                          "EncPackedPicHeaderDataBuffer failed");
1105   }
1106
1107 end:
1108   return ret;
1109 }
1110
1111
1112 static gboolean
1113 h264_recreate_slice_param(GstH264Encoder *h264_encoder,
1114                         VADisplay va_dpy, VAContextID context_id)
1115 {
1116   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
1117   VAEncSliceParameterBufferH264 *slice_h264 = NULL;
1118   guint width_in_mbs;
1119   gboolean ret = TRUE;
1120   VAStatus va_status = VA_STATUS_SUCCESS;
1121
1122   width_in_mbs = (ENCODER_WIDTH(h264_encoder)+15)/16;
1123
1124   int i = 0;
1125   guint32 last_row_num = 0;
1126   guint32 slice_mod_num = h264_prv->slice_mod_mb_num;
1127
1128   memset(h264_prv->slice_param_buffers, 0, h264_encoder->slice_num*sizeof(h264_prv->slice_param_buffers[0]));
1129   for (i = 0; i < h264_encoder->slice_num; ++i) {
1130     slice_h264 = &h264_prv->slice_param_buffers[i];
1131
1132     slice_h264->starting_macroblock_address = last_row_num*width_in_mbs;
1133     slice_h264->number_of_mbs = width_in_mbs*h264_prv->default_slice_height;
1134     last_row_num += h264_prv->default_slice_height;
1135     if (slice_mod_num) {
1136       slice_h264->number_of_mbs += width_in_mbs;
1137       ++last_row_num;
1138       --slice_mod_num;
1139     }
1140     slice_h264->pic_parameter_set_id = 0;
1141     slice_h264->slice_type = h264_prv->cur_slice_type;
1142     slice_h264->direct_spatial_mv_pred_flag = 0;
1143     slice_h264->num_ref_idx_l0_active_minus1 = 0;
1144     slice_h264->num_ref_idx_l1_active_minus1 = 0;
1145     slice_h264->cabac_init_idc = 0;
1146     slice_h264->slice_qp_delta = 0;
1147     slice_h264->disable_deblocking_filter_idc = 0;
1148     slice_h264->slice_alpha_c0_offset_div2 = 2;
1149     slice_h264->slice_beta_offset_div2 = 2;
1150     slice_h264->idr_pic_id = 0;
1151
1152     slice_h264->ref_pic_list_modification_flag_l0 = 0;
1153     slice_h264->ref_pic_list_modification_flag_l1 = 0;
1154
1155   }
1156   ENCODER_ASSERT(last_row_num == (ENCODER_HEIGHT(h264_encoder)+15)/16);
1157
1158   if (VA_INVALID_ID != h264_prv->slice_parameter) {
1159     vaDestroyBuffer(va_dpy, h264_prv->slice_parameter);
1160     h264_prv->slice_parameter = VA_INVALID_ID;
1161   }
1162   va_status = vaCreateBuffer(va_dpy,
1163                              context_id,
1164                              VAEncSliceParameterBufferType,
1165                              sizeof(h264_prv->slice_param_buffers[0]),
1166                              h264_encoder->slice_num,
1167                              h264_prv->slice_param_buffers,
1168                              &h264_prv->slice_parameter);
1169   ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS ==va_status, FALSE, "creating slice-parameters buffer failed.\n");
1170
1171 end:
1172   return ret;
1173 }
1174
1175 static EncoderStatus
1176 gst_h264_encoder_rendering(GstVaapiBaseEncoder *encoder, GstVaapiDisplay *display,
1177                              GstVaapiContext *context, GstVaapiSurface *surface,
1178                              guint frame_index, VABufferID coded_buf, gboolean *is_key)
1179 {
1180   EncoderStatus ret = ENCODER_NO_ERROR;
1181   VAStatus va_status = VA_STATUS_SUCCESS;
1182   GstH264Encoder *h264_encoder = GST_H264_ENCODER(encoder);
1183   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
1184   VABufferID va_buffers[64];
1185   guint32    va_buffers_count = 0;
1186   gboolean is_params_ok = TRUE;
1187
1188   gboolean is_locked = FALSE;
1189
1190   ENCODER_ASSERT(display && context);
1191   VADisplay va_dpy = gst_vaapi_display_get_display(display);
1192   VAContextID context_id = GST_VAAPI_OBJECT_ID(context);
1193
1194   *is_key = (h264_prv->cur_slice_type == SLICE_TYPE_I);
1195
1196   if (!h264_prv->ref_surface1) {
1197     h264_prv->ref_surface1 = gst_vaapi_context_get_surface(context);
1198     ENCODER_CHECK_STATUS(h264_prv->ref_surface1, ENCODER_SURFACE_ERR, "reference surface, h264_pop_free_surface failed.\n");
1199   }
1200   if (!h264_prv->ref_surface2) {
1201     h264_prv->ref_surface2 = gst_vaapi_context_get_surface(context);
1202     ENCODER_CHECK_STATUS(h264_prv->ref_surface2, ENCODER_SURFACE_ERR, "reference surface, h264_pop_free_surface failed.\n");
1203   }
1204   if (!h264_prv->recon_surface) {
1205     h264_prv->recon_surface = gst_vaapi_context_get_surface(context);
1206     ENCODER_CHECK_STATUS(h264_prv->recon_surface, ENCODER_SURFACE_ERR, "reconstructed surface, h264_pop_free_surface failed.\n");
1207   }
1208
1209   if (SLICE_TYPE_P == h264_prv->cur_slice_type) {
1210     h264_swap_surface(&h264_prv->ref_surface1, &h264_prv->ref_surface2);
1211   }
1212
1213   /* set sequence parameters, need set every time */
1214   is_params_ok = h264_recreate_seq_param(h264_encoder, va_dpy, context_id);
1215   ENCODER_CHECK_STATUS(is_params_ok, ENCODER_PARAMETER_ERR,
1216                        "h264_recreate_seq_param failed");
1217   /* set pic_parameters*/
1218   is_params_ok = h264_recreate_pic_param(h264_encoder, va_dpy, context_id, coded_buf);
1219   ENCODER_CHECK_STATUS(is_params_ok, ENCODER_PARAMETER_ERR,
1220                        "h264_recreate_pic_param failed");
1221   /* set slice parameters, support multiple slices */
1222   is_params_ok = h264_recreate_slice_param(h264_encoder, va_dpy, context_id);
1223   ENCODER_CHECK_STATUS(is_params_ok, ENCODER_PARAMETER_ERR,
1224                        "h264_recreate_slice_param failed");
1225
1226   /* lock display */
1227   ENCODER_ACQUIRE_DISPLAY_LOCK(display);
1228
1229   /*render all buffers*/
1230   if (VA_INVALID_ID != h264_prv->seq_parameter) {
1231     va_buffers[va_buffers_count++] = h264_prv->seq_parameter;
1232   }
1233   if (VA_INVALID_ID != h264_prv->pic_parameter) {
1234     va_buffers[va_buffers_count++] = h264_prv->pic_parameter;
1235   }
1236   if (VA_INVALID_ID != h264_prv->slice_parameter) {
1237     va_buffers[va_buffers_count++] = h264_prv->slice_parameter;
1238   }
1239   if (SLICE_TYPE_I == h264_prv->cur_slice_type) {
1240     if (VA_INVALID_ID != h264_prv->packed_sps_par_buf) {
1241       va_buffers[va_buffers_count++] = h264_prv->packed_sps_par_buf;
1242     }
1243     if (VA_INVALID_ID != h264_prv->packed_sps_data_buf) {
1244       va_buffers[va_buffers_count++] = h264_prv->packed_sps_data_buf;
1245     }
1246     if (VA_INVALID_ID != h264_prv->packed_pps_par_buf) {
1247       va_buffers[va_buffers_count++] = h264_prv->packed_pps_par_buf;
1248     }
1249     if (VA_INVALID_ID != h264_prv->packed_pps_data_buf) {
1250       va_buffers[va_buffers_count++] = h264_prv->packed_pps_data_buf;
1251     }
1252   }
1253
1254   va_status = vaRenderPicture(va_dpy, context_id, va_buffers, va_buffers_count);
1255   ENCODER_CHECK_STATUS(VA_STATUS_SUCCESS == va_status, ENCODER_PICTURE_ERR,
1256                        "vaRenderH264Picture failed.\n");
1257
1258   /*after finished,  swap  recon and surface2*/
1259   if (SLICE_TYPE_P == h264_prv->cur_slice_type ||
1260       SLICE_TYPE_I == h264_prv->cur_slice_type) {
1261     h264_swap_surface(&h264_prv->recon_surface, &h264_prv->ref_surface2);
1262   }
1263
1264   end:
1265   ENCODER_RELEASE_DISPLAY_LOCK(display);
1266   return ret;
1267 }
1268
1269 #endif
1270
1271 static GstBuffer *
1272 gst_h264_encoder_copy_coded_buffer(GstVaapiBaseEncoder *encoder,
1273                                         guint8 *frame,
1274                                         guint32 frame_size,
1275                                         VABufferID *coded_buf)
1276 {
1277   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(encoder);
1278   GstBuffer *ret_buffer;
1279   guint32   nal_size;
1280   const guint8   *nal_start;
1281   guint8  *frame_end;
1282
1283   ret_buffer = gst_buffer_new();
1284   ENCODER_ASSERT(ret_buffer);
1285   H264Bitstream bitstream;
1286   h264_bitstream_init(&bitstream, (frame_size+32)*8);
1287   h264_bitstream_align(&bitstream, 0);
1288   ENCODER_ASSERT(bitstream.bit_size == 0);
1289
1290   if (!h264_prv->es_flag) { /*nal format*/
1291     h264_bitstream_write_byte_array(&bitstream, frame, frame_size);
1292     ENCODER_ASSERT(bitstream.bit_size == frame_size*8);
1293   } else { /* elementary format */
1294     frame_end = frame + frame_size;
1295     nal_start = frame;
1296     nal_size = 0;
1297     while((nal_start = h264_next_nal(nal_start, frame_end-nal_start, &nal_size)) != NULL) {
1298       ENCODER_ASSERT(nal_size);
1299       if (!nal_size) {
1300         nal_start += nal_size;
1301         continue;
1302       }
1303       h264_bitstream_write_uint(&bitstream, nal_size, 32);
1304       h264_bitstream_write_byte_array(&bitstream, nal_start, nal_size);
1305       nal_start += nal_size;
1306     }
1307   }
1308   h264_bitstream_align(&bitstream, 0);
1309
1310   GST_BUFFER_MALLOCDATA(ret_buffer) =
1311         GST_BUFFER_DATA(ret_buffer) = BIT_STREAM_BUFFER(&bitstream);
1312   GST_BUFFER_SIZE(ret_buffer) = BIT_STREAM_BIT_SIZE(&bitstream)/8;
1313   h264_bitstream_destroy(&bitstream, FALSE);
1314
1315   return ret_buffer;
1316 }
1317
1318 static EncoderStatus
1319 h264_encoder_read_sps_pps(GstH264EncoderPrivate *h264_prv, const guint8 *buf, guint32 size)
1320 {
1321   const guint8 *end = buf + size;
1322   const guint8 *nal_start = buf;
1323   guint32 nal_size = 0;
1324   guint8 nal_type;
1325   GstBuffer *sps = NULL, *pps = NULL;
1326
1327   while((!sps || !pps) && (nal_start = h264_next_nal(nal_start, end-nal_start, &nal_size)) != NULL) {
1328     if (!nal_size) {
1329       nal_start += nal_size;
1330       continue;
1331     }
1332
1333     nal_type = (*nal_start)&0x1F;
1334     switch (nal_type) {
1335       case NAL_SPS: {
1336         sps = gst_buffer_new_and_alloc(nal_size);
1337         memcpy(GST_BUFFER_DATA(sps), nal_start, nal_size);
1338         gst_buffer_replace(&h264_prv->sps_data, sps);
1339         gst_buffer_unref(sps); /*don't set to NULL*/
1340         break;
1341       }
1342
1343       case NAL_PPS: {
1344         pps = gst_buffer_new_and_alloc(nal_size);
1345         memcpy(GST_BUFFER_DATA(pps), nal_start, nal_size);
1346         gst_buffer_replace(&h264_prv->pps_data, pps);
1347         gst_buffer_unref(pps);
1348         break;
1349       }
1350
1351       default:
1352         break;
1353     }
1354     nal_start += nal_size;
1355
1356   }
1357   if (!sps || !pps) {
1358     return ENCODER_DATA_NOT_READY;
1359   }
1360   return ENCODER_NO_ERROR;
1361 }
1362
1363 static void
1364 gst_h264_notify_frame(GstVaapiBaseEncoder *encoder, guint8 *buf, guint32 size)
1365 {
1366   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(encoder);
1367   if (!h264_prv->sps_data || !h264_prv->pps_data) {
1368     h264_encoder_read_sps_pps(h264_prv, buf, size);
1369   }
1370   if (h264_prv->sps_data && h264_prv->pps_data) {
1371     gst_vaapi_base_encoder_set_frame_notify(GST_VAAPI_BASE_ENCODER(encoder), FALSE);
1372   }
1373 }
1374
1375
1376 static gboolean
1377 h264_read_sps_attributes(const guint8 *sps_data, guint32 sps_size,
1378                                 guint32 *profile_idc, guint32 *profile_comp, guint32 *level_idc)
1379 {
1380   ENCODER_ASSERT(profile_idc && profile_comp && level_idc);
1381   ENCODER_ASSERT(sps_size >= 4);
1382   if (sps_size < 4) {
1383     return FALSE;
1384   }
1385   /*skip sps_data[0], nal_type*/
1386   *profile_idc = sps_data[1];
1387   *profile_comp = sps_data[2];
1388   *level_idc = sps_data[3];
1389   return TRUE;
1390 }
1391
1392
1393 static EncoderStatus
1394 gst_h264_encoder_flush(GstVaapiEncoder* encoder, GstVaapiDisplay *display,
1395                        GstVaapiContext *context, GList **coded_pics)
1396 {
1397   GstH264Encoder* h264_encoder = GST_H264_ENCODER(encoder);
1398   EncoderStatus ret = ENCODER_NO_ERROR;
1399   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
1400
1401   //h264_prv->frame_count = 0;
1402   h264_prv->cur_display_num = 0;
1403   h264_prv->cur_decode_num = 0;
1404   h264_prv->cur_slice_type = SLICE_TYPE_I;
1405   h264_prv->gop_count = g_queue_get_length(h264_prv->queued_buffers);
1406   //gst_vaapi_base_encoder_set_frame_notify((GST_VAAPI_BASE_ENCODER)encoder, TRUE);
1407
1408   //end:
1409   return ret;
1410 }
1411
1412 /*test*/
1413 static int draw_picture(int width, int height,
1414                          unsigned char *Y_start,
1415                          unsigned char *U_start,
1416                          unsigned char *V_start,
1417                          int UV_interleave, int box_width, int row_shift);
1418
1419 int main_test(int argc, char* argv[])
1420 {
1421   EncoderStatus ret = ENCODER_NO_ERROR;
1422   GstVaapiEncoder *encoder = NULL;
1423
1424   GList *coded_pics = NULL;
1425   GstBuffer **raw_buffer = NULL;
1426   const guint32 raw_buffer_num = 20;
1427
1428   GstBuffer *tmp_buffer;
1429
1430   guint32 i = 0, k = 0;
1431
1432   gst_init (&argc, &argv);
1433
1434   g_type_init();
1435   if (!g_thread_supported ())
1436     g_thread_init (NULL);
1437
1438   GstH264Encoder *h264_encoder = gst_h264_encoder_new();
1439   encoder = GST_VAAPI_ENCODER(h264_encoder);
1440   ENCODER_ASSERT(encoder);
1441
1442   h264_encoder->profile = 64;
1443   h264_encoder->level = 30;
1444   encoder->width = 1280;
1445   encoder->height = 720;
1446   encoder->frame_rate = 10;
1447   h264_encoder->bitrate = 512*1000;
1448   h264_encoder->intra_period = 30;
1449   ret = gst_vaapi_encoder_initialize(encoder);
1450   ENCODER_ASSERT(ret == ENCODER_NO_ERROR);
1451   ret = gst_vaapi_encoder_open(encoder, NULL);
1452   ENCODER_ASSERT(ret == ENCODER_NO_ERROR);
1453
1454   guint32 buffer_size = encoder->width * encoder->width *3 /2;
1455   guint32 y_width = encoder->width, y_size = encoder->width * encoder->height;
1456   guint32 u_width = encoder->width/2, u_size = (encoder->width/2) * (encoder->height/2);
1457   guint32 v_width = encoder->width/2;
1458   guint8 *y_src, *u_src, *v_src;
1459
1460   /*set buffers*/
1461   int box_width=8;
1462   int row_shift=0;
1463
1464   VAAPI_UNUSED_ARG(v_width);
1465   VAAPI_UNUSED_ARG(u_width);
1466   VAAPI_UNUSED_ARG(y_width);
1467   raw_buffer = (GstBuffer**)g_malloc0(raw_buffer_num*sizeof(GstBuffer*));
1468   for (i = 0; i < raw_buffer_num; i++) {
1469     raw_buffer[i] = gst_buffer_new_and_alloc(buffer_size);
1470     y_src = GST_BUFFER_DATA(raw_buffer[i]);
1471     u_src = y_src + y_size;
1472     v_src = u_src + u_size;
1473
1474     draw_picture(encoder->width, encoder->height, y_src, u_src, v_src, 0, box_width, row_shift);
1475     row_shift++;
1476     if (row_shift==(2*box_width)) row_shift= 0;
1477   }
1478
1479   FILE *fp = fopen("tmp.h264", "wb");
1480   ENCODER_ASSERT(fp);
1481
1482   k = 0;
1483
1484   for (i = 0; i < 50; i++) {
1485     coded_pics = NULL;
1486     ret = gst_vaapi_encoder_encode(encoder, raw_buffer[k], &coded_pics);
1487     ENCODER_ASSERT(ENCODER_NO_ERROR == ret);
1488     ++k;
1489     if (k >= raw_buffer_num) k = 0;
1490
1491     while (coded_pics) {
1492       tmp_buffer = coded_pics->data;
1493       coded_pics = g_list_remove(coded_pics, tmp_buffer);
1494       fwrite(GST_BUFFER_DATA(tmp_buffer), GST_BUFFER_SIZE(tmp_buffer), 1, fp);
1495       printf("F:%d, S:%d, %s\n", i, GST_BUFFER_SIZE(tmp_buffer), vaapi_encoder_dump_bytes(GST_BUFFER_DATA(tmp_buffer)+4, 8));
1496       gst_buffer_unref(tmp_buffer);
1497     }
1498   }
1499   fclose(fp);
1500
1501   ret = gst_vaapi_encoder_close(encoder);
1502   ENCODER_ASSERT(ENCODER_NO_ERROR == ret);
1503
1504   for (i = 0; i < raw_buffer_num; i++) {
1505     gst_buffer_unref(raw_buffer[i]);
1506   }
1507   g_free(raw_buffer);
1508   gst_vaapi_encoder_unref(encoder);
1509
1510   return 0;
1511 }
1512
1513 EncoderStatus
1514 gst_h264_encoder_get_avcC_codec_data(GstVaapiEncoder *encoder, GstBuffer **buffer)
1515 {
1516   GstH264Encoder *h264_encoder = GST_H264_ENCODER(encoder);
1517   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
1518   GstBuffer *avc_codec;
1519   const guint32 configuration_version = 0x01;
1520   const guint32 length_size_minus_one = 0x03;
1521   guint32 profile, profile_comp, level_idc;
1522
1523   ENCODER_ASSERT(buffer);
1524   if (!h264_prv->sps_data || !h264_prv->pps_data) {
1525     return ENCODER_DATA_NOT_READY;
1526   }
1527
1528   if (FALSE == h264_read_sps_attributes(GST_BUFFER_DATA(h264_prv->sps_data),
1529                                    GST_BUFFER_SIZE(h264_prv->sps_data),
1530                                    &profile, &profile_comp, &level_idc))
1531   {
1532     ENCODER_ASSERT(0);
1533     return ENCODER_DATA_ERR;
1534   }
1535
1536   H264Bitstream bitstream;
1537   h264_bitstream_init(&bitstream,
1538                      (GST_BUFFER_SIZE(h264_prv->sps_data)+GST_BUFFER_SIZE(h264_prv->pps_data) + 32)*8);
1539
1540   /*codec_data*/
1541   h264_bitstream_write_uint(&bitstream, configuration_version, 8);
1542   h264_bitstream_write_uint(&bitstream, profile, 8);
1543   h264_bitstream_write_uint(&bitstream, profile_comp, 8);
1544   h264_bitstream_write_uint(&bitstream, level_idc, 8);
1545   h264_bitstream_write_uint(&bitstream, h264_bit_mask[6], 6); /*111111*/
1546   h264_bitstream_write_uint(&bitstream, length_size_minus_one, 2);
1547   h264_bitstream_write_uint(&bitstream, h264_bit_mask[3], 3); /*111*/
1548
1549   /*write sps*/
1550   h264_bitstream_write_uint(&bitstream, 1, 5);   /* sps count = 1*/
1551   ENCODER_ASSERT( BIT_STREAM_BIT_SIZE(&bitstream)%8 == 0);
1552   h264_bitstream_write_uint(&bitstream, GST_BUFFER_SIZE(h264_prv->sps_data), 16);
1553   h264_bitstream_write_byte_array(&bitstream, GST_BUFFER_DATA(h264_prv->sps_data),
1554                                               GST_BUFFER_SIZE(h264_prv->sps_data));
1555
1556   /*write pps*/
1557   h264_bitstream_write_uint(&bitstream, 1, 8); /*pps count = 1*/
1558   h264_bitstream_write_uint(&bitstream, GST_BUFFER_SIZE(h264_prv->pps_data), 16);
1559   h264_bitstream_write_byte_array(&bitstream, GST_BUFFER_DATA(h264_prv->pps_data),
1560                                               GST_BUFFER_SIZE(h264_prv->pps_data));
1561
1562   avc_codec = gst_buffer_new();
1563   GST_BUFFER_MALLOCDATA(avc_codec) =
1564          GST_BUFFER_DATA(avc_codec) =
1565          BIT_STREAM_BUFFER(&bitstream);
1566   GST_BUFFER_SIZE(avc_codec) = BIT_STREAM_BIT_SIZE(&bitstream)/8;
1567   h264_bitstream_destroy(&bitstream, FALSE);
1568   *buffer = avc_codec;
1569
1570   return ENCODER_NO_ERROR;
1571 }
1572
1573 EncoderStatus
1574 gst_h264_encoder_get_nal_codec_data(GstVaapiEncoder *encoder, GstBuffer **buffer)
1575 {
1576   GstH264Encoder *h264_encoder = GST_H264_ENCODER(encoder);
1577   GstH264EncoderPrivate *h264_prv = GST_H264_ENCODER_GET_PRIVATE(h264_encoder);
1578   GstBuffer *nal_sps_pps;
1579
1580   ENCODER_ASSERT(buffer);
1581   if (!h264_prv->sps_data || !h264_prv->pps_data) {
1582     return ENCODER_DATA_NOT_READY;
1583   }
1584
1585   H264Bitstream bitstream;
1586   h264_bitstream_init(&bitstream,
1587                      (GST_BUFFER_SIZE(h264_prv->sps_data)+GST_BUFFER_SIZE(h264_prv->pps_data) + 8)*8);
1588
1589   /*0x000001 start code*/
1590   h264_bitstream_write_uint(&bitstream, 0x000001, 24);
1591   h264_bitstream_write_byte_array(&bitstream, GST_BUFFER_DATA(h264_prv->sps_data),
1592                                               GST_BUFFER_SIZE(h264_prv->sps_data));
1593   h264_bitstream_write_uint(&bitstream, 0x000001, 24);
1594   h264_bitstream_write_byte_array(&bitstream, GST_BUFFER_DATA(h264_prv->pps_data),
1595                                               GST_BUFFER_SIZE(h264_prv->pps_data));
1596
1597   nal_sps_pps = gst_buffer_new();
1598   GST_BUFFER_MALLOCDATA(nal_sps_pps) =
1599          GST_BUFFER_DATA(nal_sps_pps) =
1600          BIT_STREAM_BUFFER(&bitstream);
1601   GST_BUFFER_SIZE(nal_sps_pps) = BIT_STREAM_BIT_SIZE(&bitstream)/8;
1602   h264_bitstream_destroy(&bitstream, FALSE);
1603   *buffer = nal_sps_pps;
1604   return ENCODER_NO_ERROR;
1605 }
1606
1607 static void
1608 h264_bitstream_init(H264Bitstream *bitstream, guint32 bit_capability)
1609 {
1610   bitstream->bit_size = 0;
1611   bitstream->buffer = NULL;
1612   bitstream->max_bit_capability = 0;
1613   if (bit_capability) {
1614     h264_bitstream_auto_grow(bitstream, bit_capability);
1615   }
1616 }
1617
1618 static gboolean
1619 h264_bitstream_write_uint(H264Bitstream *bitstream, guint32 value, guint32 bit_size)
1620 {
1621   gboolean ret = TRUE;
1622   guint32 byte_pos, bit_offset;
1623   guint8  *cur_byte;
1624   guint32 fill_bits;
1625
1626   if(!bit_size) {
1627     return TRUE;
1628   }
1629
1630   VAAPI_UNUSED_ARG(ret);
1631   ENCODER_CHECK_STATUS(TRUE == h264_bitstream_auto_grow(bitstream, bit_size), FALSE, "h264_bitstream_auto_grow failed.\n");
1632   byte_pos = (bitstream->bit_size>>3);
1633   bit_offset = (bitstream->bit_size&0x07);
1634   cur_byte = bitstream->buffer + byte_pos;
1635   ENCODER_ASSERT(bit_offset < 8 && bitstream->bit_size <= bitstream->max_bit_capability);
1636
1637   while (bit_size) {
1638     fill_bits = ((8-bit_offset) < bit_size ? (8-bit_offset) : bit_size);
1639     bit_size -= fill_bits;
1640     bitstream->bit_size += fill_bits;
1641
1642     *cur_byte |= ((value>>bit_size) & h264_bit_mask[fill_bits])<<(8-bit_offset-fill_bits);
1643     ++cur_byte;
1644     bit_offset = 0;
1645   }
1646   ENCODER_ASSERT(cur_byte <= bitstream->buffer + bitstream->max_bit_capability/8);
1647
1648   end:
1649   return ret;
1650 }
1651
1652 static gboolean h264_bitstream_align(H264Bitstream *bitstream, guint32 value)
1653 {
1654   guint32 bit_offset, bit_left;
1655
1656   bit_offset = (bitstream->bit_size&0x07);
1657   if (!bit_offset) {
1658     return TRUE;
1659   }
1660   bit_left = 8 - bit_offset;
1661   if (value) value = h264_bit_mask[bit_left];
1662   return h264_bitstream_write_uint(bitstream, value, bit_left);
1663 }
1664
1665
1666 static gboolean
1667 h264_bitstream_write_byte_array(H264Bitstream *bitstream, const guint8 *buf, guint32 byte_size)
1668 {
1669   gboolean ret = TRUE;
1670   if (!byte_size) {
1671     return 0;
1672   }
1673
1674   VAAPI_UNUSED_ARG(ret);
1675   ENCODER_CHECK_STATUS(TRUE == h264_bitstream_auto_grow(bitstream, byte_size<<3), FALSE, "h264_bitstream_auto_grow failed.\n");
1676   if (0 == (bitstream->bit_size&0x07)) {
1677     memcpy(&bitstream->buffer[bitstream->bit_size>>3], buf, byte_size);
1678     bitstream->bit_size += (byte_size<<3);
1679   } else {
1680     ENCODER_ASSERT(0);
1681     while(byte_size) {
1682       h264_bitstream_write_uint(bitstream, *buf, 8);
1683       --byte_size;
1684       ++buf;
1685     }
1686   }
1687
1688 end:
1689   return ret;
1690 }
1691
1692 static gboolean
1693 h264_bitstream_write_ue(H264Bitstream *bitstream, guint32 value)
1694 {
1695   gboolean ret = TRUE;
1696   guint32  size_in_bits = 0;
1697   guint32  tmp_value = ++value;
1698   while (tmp_value) {
1699     ++size_in_bits;
1700     tmp_value >>= 1;
1701   }
1702   ENCODER_CHECK_STATUS(h264_bitstream_write_uint(bitstream, 0, size_in_bits-1), FALSE, "h264_bitstream_write_ue failed.\n");
1703   ENCODER_CHECK_STATUS(h264_bitstream_write_uint(bitstream, value, size_in_bits), FALSE, "h264_bitstream_write_ue failed.\n");
1704
1705 end:
1706   return ret;
1707 }
1708
1709 static gboolean
1710 h264_bitstream_write_se(H264Bitstream *bitstream, gint32 value)
1711 {
1712   gboolean ret = TRUE;
1713   guint32 new_val;
1714
1715   if (value <= 0) {
1716     new_val = -(value<<1);
1717   } else {
1718     new_val = (value<<1) - 1;
1719   }
1720
1721   ENCODER_CHECK_STATUS(h264_bitstream_write_ue(bitstream, new_val), FALSE, "h264_bitstream_write_se failed.\n");
1722
1723 end:
1724   return ret;
1725 }
1726
1727 static gboolean
1728 h264_bitstream_write_trailing_bits(H264Bitstream *bitstream)
1729 {
1730     h264_bitstream_write_uint(bitstream, 1, 1);
1731     h264_bitstream_align(bitstream, 0);
1732     return TRUE;
1733 }
1734
1735 static void
1736 h264_bitstream_destroy(H264Bitstream *bitstream, gboolean free_flag)
1737 {
1738   if (bitstream->buffer && free_flag) {
1739     free (bitstream->buffer);
1740   }
1741   bitstream->buffer = NULL;
1742   bitstream->bit_size = 0;
1743   bitstream->max_bit_capability = 0;
1744 }
1745
1746 static gboolean
1747 h264_bitstream_auto_grow(H264Bitstream *bitstream, guint32 extra_bit_size)
1748 {
1749   guint32 new_bit_size = extra_bit_size + bitstream->bit_size;
1750   guint32 clear_pos;
1751
1752   ENCODER_ASSERT(bitstream->bit_size <= bitstream->max_bit_capability);
1753   if (new_bit_size <= bitstream->max_bit_capability) {
1754     return TRUE;
1755   }
1756
1757   new_bit_size = ((new_bit_size + H264_BITSTREAM_ALLOC_ALIGN_MASK)
1758                 &(~H264_BITSTREAM_ALLOC_ALIGN_MASK));
1759   ENCODER_ASSERT(new_bit_size%(H264_BITSTREAM_ALLOC_ALIGN_MASK+1) == 0);
1760   clear_pos = ((bitstream->bit_size+7)>>3);
1761   bitstream->buffer = realloc(bitstream->buffer, new_bit_size>>3);
1762   memset(bitstream->buffer+clear_pos, 0, (new_bit_size>>3)-clear_pos);
1763   bitstream->max_bit_capability = new_bit_size;
1764   return TRUE;
1765 }
1766
1767 static gboolean
1768 h264_bitstream_write_nal_header(H264Bitstream *bitstream,
1769                                  guint nal_ref_idc, guint nal_unit_type)
1770 {
1771   h264_bitstream_write_uint(bitstream, 0, 1);
1772   h264_bitstream_write_uint(bitstream, nal_ref_idc, 2);
1773   h264_bitstream_write_uint(bitstream, nal_unit_type, 5);
1774   return TRUE;
1775 }
1776
1777 static gboolean
1778 h264_bitstream_write_sps(H264Bitstream *bitstream,
1779                      VAEncSequenceParameterBufferH264 *seq)
1780 {
1781   guint32 constraint_set0_flag, constraint_set1_flag, constraint_set2_flag, constraint_set3_flag;
1782   guint32 gaps_in_frame_num_value_allowed_flag = 0; // ??
1783
1784   guint32 b_qpprime_y_zero_transform_bypass = (seq->rate_control_method == BR_CQP);
1785   guint32 residual_color_transform_flag = 0;
1786   guint32 pic_height_in_map_units = (seq->frame_mbs_only_flag ?
1787                                     seq->picture_height_in_mbs :
1788                                     seq->picture_height_in_mbs/2);
1789   guint32 mb_adaptive_frame_field = !seq->frame_mbs_only_flag;
1790   guint32 i = 0;
1791
1792   constraint_set0_flag = seq->profile_idc == H264_PROFILE_BASELINE;
1793   constraint_set1_flag = seq->profile_idc <= H264_PROFILE_MAIN;
1794   constraint_set2_flag = 0;
1795   constraint_set3_flag = 0;
1796
1797   h264_bitstream_write_uint(bitstream, seq->profile_idc, 8);         /* profile_idc */
1798   h264_bitstream_write_uint(bitstream, constraint_set0_flag, 1);     /* constraint_set0_flag */
1799   h264_bitstream_write_uint(bitstream, constraint_set1_flag, 1);     /* constraint_set1_flag */
1800   h264_bitstream_write_uint(bitstream, constraint_set2_flag, 1);     /* constraint_set2_flag */
1801   h264_bitstream_write_uint(bitstream, constraint_set3_flag, 1);     /* constraint_set3_flag */
1802   h264_bitstream_write_uint(bitstream, 0, 4);                        /* reserved_zero_4bits */
1803   h264_bitstream_write_uint(bitstream, seq->level_idc, 8);   /* level_idc */
1804   h264_bitstream_write_ue(bitstream, seq->seq_parameter_set_id);     /* seq_parameter_set_id */
1805
1806   if (seq->profile_idc >= H264_PROFILE_HIGH) {
1807     /* for high profile */
1808     ENCODER_ASSERT(0);
1809     h264_bitstream_write_ue(bitstream, seq->seq_fields.bits.chroma_format_idc); /* chroma_format_idc  = 1, 4:2:0*/
1810     if (3 == seq->seq_fields.bits.chroma_format_idc) {
1811       h264_bitstream_write_uint(bitstream, residual_color_transform_flag, 1);
1812     }
1813     h264_bitstream_write_ue(bitstream, seq->bit_depth_luma_minus8); /* bit_depth_luma_minus8 */
1814     h264_bitstream_write_ue(bitstream, seq->bit_depth_chroma_minus8); /* bit_depth_chroma_minus8 */
1815     h264_bitstream_write_uint(bitstream, b_qpprime_y_zero_transform_bypass, 1); /* b_qpprime_y_zero_transform_bypass */
1816     ENCODER_ASSERT(seq->seq_fields.bits.seq_scaling_matrix_present_flag == 0);
1817     h264_bitstream_write_uint(bitstream, seq->seq_fields.bits.seq_scaling_matrix_present_flag, 1); /*seq_scaling_matrix_present_flag  */
1818
1819     if (seq->seq_fields.bits.seq_scaling_matrix_present_flag) {
1820       for (i = 0; i < (seq->seq_fields.bits.chroma_format_idc != 3 ? 8 : 12); i++) {
1821         h264_bitstream_write_uint(bitstream, seq->seq_fields.bits.seq_scaling_list_present_flag, 1);
1822         if (seq->seq_fields.bits.seq_scaling_list_present_flag) {
1823           ENCODER_ASSERT(0);
1824           /* FIXME, need write scaling list if seq_scaling_matrix_present_flag ==1*/
1825         }
1826       }
1827     }
1828   }
1829
1830   h264_bitstream_write_ue(bitstream, seq->log2_max_frame_num_minus4);    /* log2_max_frame_num_minus4 */
1831   h264_bitstream_write_ue(bitstream, seq->pic_order_cnt_type);           /* pic_order_cnt_type */
1832
1833   if (seq->pic_order_cnt_type == 0)
1834     h264_bitstream_write_ue(bitstream, seq->log2_max_pic_order_cnt_lsb_minus4);/* log2_max_pic_order_cnt_lsb_minus4 */
1835   else if (seq->pic_order_cnt_type == 1) {
1836     ENCODER_ASSERT(0);
1837     h264_bitstream_write_uint(bitstream, seq->seq_fields.bits.delta_pic_order_always_zero_flag, 1);
1838     h264_bitstream_write_se(bitstream, seq->offset_for_non_ref_pic);
1839     h264_bitstream_write_se(bitstream, seq->offset_for_top_to_bottom_field);
1840     h264_bitstream_write_ue(bitstream, seq->num_ref_frames_in_pic_order_cnt_cycle);
1841     for ( i = 0; i < seq->num_ref_frames_in_pic_order_cnt_cycle; i++) {
1842       h264_bitstream_write_se(bitstream, seq->offset_for_ref_frame[i]);
1843     }
1844   }
1845
1846   h264_bitstream_write_ue(bitstream, seq->max_num_ref_frames);                   /* num_ref_frames */
1847   h264_bitstream_write_uint(bitstream, gaps_in_frame_num_value_allowed_flag, 1); /* gaps_in_frame_num_value_allowed_flag */
1848
1849   h264_bitstream_write_ue(bitstream, seq->picture_width_in_mbs - 1);  /* pic_width_in_mbs_minus1 */
1850   h264_bitstream_write_ue(bitstream, pic_height_in_map_units - 1);    /* pic_height_in_map_units_minus1 */
1851   h264_bitstream_write_uint(bitstream, seq->frame_mbs_only_flag, 1);  /* frame_mbs_only_flag */
1852
1853   if (!seq->frame_mbs_only_flag) { //ONLY mbs
1854       ENCODER_ASSERT(0);
1855       h264_bitstream_write_uint(bitstream, mb_adaptive_frame_field, 1);
1856   }
1857
1858   h264_bitstream_write_uint(bitstream, 0, 1);                           /* direct_8x8_inference_flag */
1859   h264_bitstream_write_uint(bitstream, seq->frame_cropping_flag, 1);    /* frame_cropping_flag */
1860
1861   if (seq->frame_cropping_flag) {
1862       h264_bitstream_write_ue(bitstream, seq->frame_crop_left_offset);  /* frame_crop_left_offset */
1863       h264_bitstream_write_ue(bitstream, seq->frame_crop_right_offset); /* frame_crop_right_offset */
1864       h264_bitstream_write_ue(bitstream, seq->frame_crop_top_offset);   /* frame_crop_top_offset */
1865       h264_bitstream_write_ue(bitstream, seq->frame_crop_bottom_offset); /* frame_crop_bottom_offset */
1866   }
1867   ENCODER_ASSERT(seq->vui_flag == 0);
1868   h264_bitstream_write_uint(bitstream, seq->vui_flag, 1);               /* vui_parameters_present_flag */
1869   if (seq->vui_flag) {
1870     /*FIXME, to write vui parameters*/
1871   }
1872   h264_bitstream_write_trailing_bits(bitstream);                        /* rbsp_trailing_bits */
1873   return TRUE;
1874 }
1875
1876
1877 static gboolean
1878 h264_bitstream_write_pps(H264Bitstream *bitstream,
1879                         VAEncPictureParameterBufferH264 *pic)
1880 {
1881   guint32 num_slice_groups_minus1 = 0;
1882   guint32 pic_init_qs_minus26 = 0;
1883   guint32 redundant_pic_cnt_present_flag = 0;
1884
1885   h264_bitstream_write_ue(bitstream, pic->pic_parameter_set_id); /* pic_parameter_set_id */
1886   h264_bitstream_write_ue(bitstream, pic->seq_parameter_set_id); /* seq_parameter_set_id */
1887   h264_bitstream_write_uint(bitstream, pic->pic_fields.bits.entropy_coding_mode_flag, 1); /* entropy_coding_mode_flag */
1888   h264_bitstream_write_uint(bitstream, pic->pic_fields.bits.pic_order_present_flag, 1); /* pic_order_present_flag */
1889   h264_bitstream_write_ue(bitstream, num_slice_groups_minus1); /*slice_groups-1*/
1890
1891   if (num_slice_groups_minus1 > 0) {
1892     /*FIXME*/
1893     ENCODER_ASSERT(0);
1894   }
1895   h264_bitstream_write_ue(bitstream, pic->num_ref_idx_l0_active_minus1);
1896   h264_bitstream_write_ue(bitstream, pic->num_ref_idx_l1_active_minus1);
1897   h264_bitstream_write_uint(bitstream, pic->pic_fields.bits.weighted_pred_flag, 1);
1898   h264_bitstream_write_uint(bitstream, pic->pic_fields.bits.weighted_bipred_idc, 2);
1899   h264_bitstream_write_se(bitstream, pic->pic_init_qp-26);  /* pic_init_qp_minus26 */
1900   h264_bitstream_write_se(bitstream, pic_init_qs_minus26);  /* pic_init_qs_minus26 */
1901   h264_bitstream_write_se(bitstream, pic->chroma_qp_index_offset); /*chroma_qp_index_offset*/
1902
1903   h264_bitstream_write_uint(bitstream, pic->pic_fields.bits.deblocking_filter_control_present_flag, 1);
1904   h264_bitstream_write_uint(bitstream, pic->pic_fields.bits.constrained_intra_pred_flag, 1);
1905   h264_bitstream_write_uint(bitstream, redundant_pic_cnt_present_flag, 1);
1906
1907   /*more_rbsp_data*/
1908   h264_bitstream_write_uint(bitstream, pic->pic_fields.bits.transform_8x8_mode_flag, 1);
1909   h264_bitstream_write_uint(bitstream, pic->pic_fields.bits.pic_scaling_matrix_present_flag, 1);
1910   if (pic->pic_fields.bits.pic_scaling_matrix_present_flag) {
1911     ENCODER_ASSERT(0);
1912     /* FIXME */
1913     /*
1914     for (i = 0; i <
1915       (6+(-( (chroma_format_idc ! = 3) ? 2 : 6) * -pic->pic_fields.bits.transform_8x8_mode_flag));
1916       i++) {
1917       h264_bitstream_write_uint(bitstream, pic->pic_fields.bits.pic_scaling_list_present_flag, 1);
1918     }
1919     */
1920   }
1921
1922   h264_bitstream_write_se(bitstream, pic->second_chroma_qp_index_offset);
1923   h264_bitstream_write_trailing_bits(bitstream);
1924   return TRUE;
1925 }
1926
1927
1928 static const guint8 *
1929 h264_next_nal(const guint8 *buffer, guint32 len, guint32 *nal_size)
1930 {
1931     const guint8 *cur = buffer;
1932     const guint8 *end = buffer + len;
1933     const guint8 *nal_start = NULL;
1934     guint32 flag = 0xFFFFFFFF;
1935     guint32 nal_start_len = 0;
1936
1937     ENCODER_ASSERT(len >= 0 && buffer && nal_size);
1938     if (len < 3) {
1939         *nal_size = len;
1940         nal_start = (len ? buffer : NULL);
1941         return nal_start;
1942     }
1943
1944     /*locate head postion*/
1945     if (!buffer[0] && !buffer[1]) {
1946         if (buffer[2] == 1) { // 0x000001
1947             nal_start_len = 3;
1948         } else if (!buffer[2] && len >=4 && buffer[3] == 1) { //0x00000001
1949             nal_start_len = 4;
1950         }
1951     }
1952     nal_start = buffer + nal_start_len;
1953     cur = nal_start;
1954
1955     /*find next nal start position*/
1956     while (cur < end) {
1957         flag = ((flag<<8) | ((*cur++)&0xFF));
1958         if (flag == 0x00000001) {
1959             *nal_size = cur - 4 - nal_start;
1960             break;
1961         } else if ((flag&0x00FFFFFF) == 0x00000001) {
1962             *nal_size = cur - 3 - nal_start;
1963             break;
1964         }
1965     }
1966     if (cur >= end) {
1967       *nal_size = end - nal_start;
1968       if (nal_start >= end) {
1969         nal_start = NULL;
1970       }
1971     }
1972     return nal_start;
1973 }
1974
1975 static int draw_picture(int width, int height,
1976                          unsigned char *Y_start,
1977                          unsigned char *U_start,
1978                          unsigned char *V_start,
1979                          int UV_interleave, int box_width, int row_shift)
1980 {
1981     int row;
1982     int field = 0;
1983     int Y_pitch = width;
1984     int U_pitch = width/2;
1985     int V_pitch = width/2;
1986
1987     /* copy Y plane */
1988     for (row=0;row<height;row++) {
1989         unsigned char *Y_row = Y_start + row * Y_pitch;
1990         int jj, xpos, ypos;
1991
1992         ypos = (row / box_width) & 0x1;
1993
1994         /* fill garbage data into the other field */
1995         if (((field == 1) && (row &1))
1996             || ((field == 2) && ((row &1)==0))) {
1997             memset(Y_row, 0xff, width);
1998             continue;
1999         }
2000
2001         for (jj=0; jj<width; jj++) {
2002             xpos = ((row_shift + jj) / box_width) & 0x1;
2003
2004             if ((xpos == 0) && (ypos == 0))
2005                 Y_row[jj] = 0xeb;
2006             if ((xpos == 1) && (ypos == 1))
2007                 Y_row[jj] = 0xeb;
2008
2009             if ((xpos == 1) && (ypos == 0))
2010                 Y_row[jj] = 0x10;
2011             if ((xpos == 0) && (ypos == 1))
2012                 Y_row[jj] = 0x10;
2013         }
2014     }
2015
2016     /* copy UV data */
2017     for( row =0; row < height/2; row++) {
2018         unsigned short value = 0x80;
2019
2020         /* fill garbage data into the other field */
2021         if (((field == 1) && (row &1))
2022             || ((field == 2) && ((row &1)==0))) {
2023             value = 0xff;
2024         }
2025
2026         if (UV_interleave) {
2027             unsigned short *UV_row = (unsigned short *)(U_start + row * U_pitch);
2028
2029             memset(UV_row, value, width);
2030         } else {
2031             unsigned char *U_row = U_start + row * U_pitch;
2032             unsigned char *V_row = V_start + row * V_pitch;
2033
2034             memset (U_row,value,width/2);
2035             memset (V_row,value,width/2);
2036         }
2037     }
2038     return 0;
2039 }
2040
2041
2042