src/gen6_mfc.c

   1 /*
   2  * Copyright © 2010-2011 Intel Corporation
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the
   6  * "Software"), to deal in the Software without restriction, including
   7  * without limitation the rights to use, copy, modify, merge, publish,
   8  * distribute, sub license, and/or sell copies of the Software, and to
   9  * permit persons to whom the Software is furnished to do so, subject to
  10  * the following conditions:
  11  *
  12  * The above copyright notice and this permission notice (including the
  13  * next paragraph) shall be included in all copies or substantial portions
  14  * of the Software.
  15  *
  16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
  17  * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  18  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
  19  * IN NO EVENT SHALL PRECISION INSIGHT AND/OR ITS SUPPLIERS BE LIABLE FOR
  20  * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
  21  * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
  22  * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  23  *
  24  * Authors:
  25  *    Zhou Chang <chang.zhou@intel.com>
  26  *
  27  */
  28
  29 #include <stdio.h>
  30 #include <stdlib.h>
  31 #include <string.h>
  32 #include <assert.h>
  33
  34 #include "intel_batchbuffer.h"
  35 #include "i965_defines.h"
  36 #include "i965_structs.h"
  37 #include "i965_drv_video.h"
  38 #include "i965_encoder.h"
  39 #include "i965_encoder_utils.h"
  40 #include "gen6_mfc.h"
  41 #include "gen6_vme.h"
  42
  43 #define CMD_LEN_IN_OWORD        4
  44
  45 static const uint32_t gen6_mfc_batchbuffer_avc_intra[][4] = {
  46 #include "shaders/utils/mfc_batchbuffer_avc_intra.g6b"
  47 };
  48
  49 static const uint32_t gen6_mfc_batchbuffer_avc_inter[][4] = {
  50 #include "shaders/utils/mfc_batchbuffer_avc_inter.g6b"
  51 };
  52
  53 static struct i965_kernel gen6_mfc_kernels[] = {
  54     {
  55         "MFC AVC INTRA BATCHBUFFER ",
  56         MFC_BATCHBUFFER_AVC_INTRA,
  57         gen6_mfc_batchbuffer_avc_intra,
  58         sizeof(gen6_mfc_batchbuffer_avc_intra),
  59         NULL
  60     },
  61
  62     {
  63         "MFC AVC INTER BATCHBUFFER ",
  64         MFC_BATCHBUFFER_AVC_INTER,
  65         gen6_mfc_batchbuffer_avc_inter,
  66         sizeof(gen6_mfc_batchbuffer_avc_inter),
  67         NULL
  68     },
  69 };
  70
  71 static void
  72 gen6_mfc_pipe_mode_select(VADriverContextP ctx,
  73                           int standard_select,
  74                           struct intel_encoder_context *encoder_context)
  75 {
  76     struct intel_batchbuffer *batch = encoder_context->base.batch;
  77
  78     assert(standard_select == MFX_FORMAT_AVC);
  79
  80     BEGIN_BCS_BATCH(batch, 4);
  81
  82     OUT_BCS_BATCH(batch, MFX_PIPE_MODE_SELECT | (4 - 2));
  83     OUT_BCS_BATCH(batch,
  84                   (1 << 10) | /* disable Stream-Out , advanced QP/bitrate control need enable it*/
  85                   (1 << 9)  | /* Post Deblocking Output */
  86                   (0 << 8)  | /* Pre Deblocking Output */
  87                   (0 << 7)  | /* disable TLB prefectch */
  88                   (0 << 5)  | /* not in stitch mode */
  89                   (1 << 4)  | /* encoding mode */
  90                   (2 << 0));  /* Standard Select: AVC */
  91     OUT_BCS_BATCH(batch,
  92                   (0 << 20) | /* round flag in PB slice */
  93                   (0 << 19) | /* round flag in Intra8x8 */
  94                   (0 << 7)  | /* expand NOA bus flag */
  95                   (1 << 6)  | /* must be 1 */
  96                   (0 << 5)  | /* disable clock gating for NOA */
  97                   (0 << 4)  | /* terminate if AVC motion and POC table error occurs */
  98                   (0 << 3)  | /* terminate if AVC mbdata error occurs */
  99                   (0 << 2)  | /* terminate if AVC CABAC/CAVLC decode error occurs */
 100                   (0 << 1)  | /* AVC long field motion vector */
 101                   (0 << 0));  /* always calculate AVC ILDB boundary strength */
 102     OUT_BCS_BATCH(batch, 0);
 103
 104     ADVANCE_BCS_BATCH(batch);
 105 }
 106
 107 static void
 108 gen6_mfc_surface_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
 109 {
 110     struct intel_batchbuffer *batch = encoder_context->base.batch;
 111     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 112
 113     BEGIN_BCS_BATCH(batch, 6);
 114
 115     OUT_BCS_BATCH(batch, MFX_SURFACE_STATE | (6 - 2));
 116     OUT_BCS_BATCH(batch, 0);
 117     OUT_BCS_BATCH(batch,
 118                   ((mfc_context->surface_state.height - 1) << 19) |
 119                   ((mfc_context->surface_state.width - 1) << 6));
 120     OUT_BCS_BATCH(batch,
 121                   (MFX_SURFACE_PLANAR_420_8 << 28) | /* 420 planar YUV surface */
 122                   (1 << 27) | /* must be 1 for interleave U/V, hardware requirement */
 123                   (0 << 22) | /* surface object control state, FIXME??? */
 124                   ((mfc_context->surface_state.w_pitch - 1) << 3) | /* pitch */
 125                   (0 << 2)  | /* must be 0 for interleave U/V */
 126                   (1 << 1)  | /* must be y-tiled */
 127                   (I965_TILEWALK_YMAJOR << 0));                         /* tile walk, TILEWALK_YMAJOR */
 128     OUT_BCS_BATCH(batch,
 129                   (0 << 16) |                                                           /* must be 0 for interleave U/V */
 130                   (mfc_context->surface_state.h_pitch));                /* y offset for U(cb) */
 131     OUT_BCS_BATCH(batch, 0);
 132     ADVANCE_BCS_BATCH(batch);
 133 }
 134
 135 static void
 136 gen6_mfc_pipe_buf_addr_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
 137 {
 138     struct intel_batchbuffer *batch = encoder_context->base.batch;
 139     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 140     int i;
 141
 142     BEGIN_BCS_BATCH(batch, 24);
 143
 144     OUT_BCS_BATCH(batch, MFX_PIPE_BUF_ADDR_STATE | (24 - 2));
 145
 146     OUT_BCS_BATCH(batch, 0);                                                                                    /* pre output addr   */
 147
 148     OUT_BCS_RELOC(batch, mfc_context->post_deblocking_output.bo,
 149                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
 150                   0);                                                                                   /* post output addr  */
 151
 152     OUT_BCS_RELOC(batch, mfc_context->uncompressed_picture_source.bo,
 153                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
 154                   0);                                                                                   /* uncompressed data */
 155     OUT_BCS_RELOC(batch, mfc_context->macroblock_status_buffer.bo,
 156                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
 157                   0);                                                                                   /* StreamOut data*/
 158     OUT_BCS_RELOC(batch, mfc_context->intra_row_store_scratch_buffer.bo,
 159                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
 160                   0);
 161     OUT_BCS_RELOC(batch, mfc_context->deblocking_filter_row_store_scratch_buffer.bo,
 162                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
 163                   0);
 164     /* 7..22 Reference pictures*/
 165     for (i = 0; i < ARRAY_ELEMS(mfc_context->reference_surfaces); i++) {
 166         if ( mfc_context->reference_surfaces[i].bo != NULL) {
 167             OUT_BCS_RELOC(batch, mfc_context->reference_surfaces[i].bo,
 168                           I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
 169                           0);
 170         } else {
 171             OUT_BCS_BATCH(batch, 0);
 172         }
 173     }
 174     OUT_BCS_RELOC(batch, mfc_context->macroblock_status_buffer.bo,
 175                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
 176                   0);                                                                                   /* Macroblock status buffer*/
 177
 178     ADVANCE_BCS_BATCH(batch);
 179 }
 180
 181 static void
 182 gen6_mfc_ind_obj_base_addr_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
 183 {
 184     struct intel_batchbuffer *batch = encoder_context->base.batch;
 185     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 186     struct gen6_vme_context *vme_context = encoder_context->vme_context;
 187
 188     BEGIN_BCS_BATCH(batch, 11);
 189
 190     OUT_BCS_BATCH(batch, MFX_IND_OBJ_BASE_ADDR_STATE | (11 - 2));
 191     OUT_BCS_BATCH(batch, 0);
 192     OUT_BCS_BATCH(batch, 0);
 193     /* MFX Indirect MV Object Base Address */
 194     OUT_BCS_RELOC(batch, vme_context->vme_output.bo, I915_GEM_DOMAIN_INSTRUCTION, 0, 0);
 195     OUT_BCS_BATCH(batch, 0);
 196     OUT_BCS_BATCH(batch, 0);
 197     OUT_BCS_BATCH(batch, 0);
 198     OUT_BCS_BATCH(batch, 0);
 199     OUT_BCS_BATCH(batch, 0);
 200     /*MFC Indirect PAK-BSE Object Base Address for Encoder*/
 201     OUT_BCS_RELOC(batch,
 202                   mfc_context->mfc_indirect_pak_bse_object.bo,
 203                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
 204                   0);
 205     OUT_BCS_RELOC(batch,
 206                   mfc_context->mfc_indirect_pak_bse_object.bo,
 207                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
 208                   mfc_context->mfc_indirect_pak_bse_object.end_offset);
 209
 210     ADVANCE_BCS_BATCH(batch);
 211 }
 212
 213 static void
 214 gen6_mfc_bsp_buf_base_addr_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
 215 {
 216     struct intel_batchbuffer *batch = encoder_context->base.batch;
 217     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 218
 219     BEGIN_BCS_BATCH(batch, 4);
 220
 221     OUT_BCS_BATCH(batch, MFX_BSP_BUF_BASE_ADDR_STATE | (4 - 2));
 222     OUT_BCS_RELOC(batch, mfc_context->bsd_mpc_row_store_scratch_buffer.bo,
 223                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
 224                   0);
 225     OUT_BCS_BATCH(batch, 0);
 226     OUT_BCS_BATCH(batch, 0);
 227
 228     ADVANCE_BCS_BATCH(batch);
 229 }
 230
 231 static void
 232 gen6_mfc_avc_img_state(VADriverContextP ctx,struct encode_state *encode_state,
 233                        struct intel_encoder_context *encoder_context)
 234 {
 235     struct intel_batchbuffer *batch = encoder_context->base.batch;
 236     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 237     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
 238     VAEncPictureParameterBufferH264 *pPicParameter = (VAEncPictureParameterBufferH264 *)encode_state->pic_param_ext->buffer;
 239     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
 240     int height_in_mbs = (mfc_context->surface_state.height + 15) / 16;
 241
 242     BEGIN_BCS_BATCH(batch, 13);
 243     OUT_BCS_BATCH(batch, MFX_AVC_IMG_STATE | (13 - 2));
 244     OUT_BCS_BATCH(batch,
 245                   ((width_in_mbs * height_in_mbs) & 0xFFFF));
 246     OUT_BCS_BATCH(batch,
 247                   (height_in_mbs << 16) |
 248                   (width_in_mbs << 0));
 249     OUT_BCS_BATCH(batch,
 250                   (0 << 24) |     /*Second Chroma QP Offset*/
 251                   (0 << 16) |     /*Chroma QP Offset*/
 252                   (0 << 14) |   /*Max-bit conformance Intra flag*/
 253                   (0 << 13) |   /*Max Macroblock size conformance Inter flag*/
 254                   (1 << 12) |   /*Should always be written as "1" */
 255                   (0 << 10) |   /*QM Preset FLag */
 256                   (0 << 8)  |   /*Image Structure*/
 257                   (0 << 0) );   /*Current Decoed Image Frame Store ID, reserved in Encode mode*/
 258     OUT_BCS_BATCH(batch,
 259                   (400 << 16) |   /*Mininum Frame size*/
 260                   (0 << 15) |   /*Disable reading of Macroblock Status Buffer*/
 261                   (0 << 14) |   /*Load BitStream Pointer only once, 1 slic 1 frame*/
 262                   (0 << 13) |   /*CABAC 0 word insertion test enable*/
 263                   (1 << 12) |   /*MVUnpackedEnable,compliant to DXVA*/
 264                   (1 << 10) |   /*Chroma Format IDC, 4:2:0*/
 265                   (pPicParameter->pic_fields.bits.entropy_coding_mode_flag << 7)  |   /*0:CAVLC encoding mode,1:CABAC*/
 266                   (0 << 6)  |   /*Only valid for VLD decoding mode*/
 267                   (0 << 5)  |   /*Constrained Intra Predition Flag, from PPS*/
 268                   (pSequenceParameter->direct_8x8_inference_flag << 4)  |   /*Direct 8x8 inference flag*/
 269                   (pPicParameter->pic_fields.bits.transform_8x8_mode_flag << 3)  |   /*8x8 or 4x4 IDCT Transform Mode Flag*/
 270                   (1 << 2)  |   /*Frame MB only flag*/
 271                   (0 << 1)  |   /*MBAFF mode is in active*/
 272                   (0 << 0) );   /*Field picture flag*/
 273     OUT_BCS_BATCH(batch,
 274                   (1<<16)   |   /*Frame Size Rate Control Flag*/
 275                   (1<<12)   |
 276                   (1<<9)    |   /*MB level Rate Control Enabling Flag*/
 277                   (1 << 3)  |   /*FrameBitRateMinReportMask*/
 278                   (1 << 2)  |   /*FrameBitRateMaxReportMask*/
 279                   (1 << 1)  |   /*InterMBMaxSizeReportMask*/
 280                   (1 << 0) );   /*IntraMBMaxSizeReportMask*/
 281     OUT_BCS_BATCH(batch,                        /*Inter and Intra Conformance Max size limit*/
 282                   (0x0600 << 16) |              /*InterMbMaxSz 192 Byte*/
 283                   (0x0800) );                   /*IntraMbMaxSz 256 Byte*/
 284     OUT_BCS_BATCH(batch, 0x00000000);   /*Reserved : MBZReserved*/
 285     OUT_BCS_BATCH(batch, 0x01020304);   /*Slice QP Delta for bitrate control*/
 286     OUT_BCS_BATCH(batch, 0xFEFDFCFB);
 287     OUT_BCS_BATCH(batch, 0x80601004);   /*MAX = 128KB, MIN = 64KB*/
 288     OUT_BCS_BATCH(batch, 0x00800001);
 289     OUT_BCS_BATCH(batch, 0);
 290
 291     ADVANCE_BCS_BATCH(batch);
 292 }
 293
 294 static void
 295 gen6_mfc_avc_directmode_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
 296 {
 297     struct intel_batchbuffer *batch = encoder_context->base.batch;
 298     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 299
 300     int i;
 301
 302     BEGIN_BCS_BATCH(batch, 69);
 303
 304     OUT_BCS_BATCH(batch, MFX_AVC_DIRECTMODE_STATE | (69 - 2));
 305
 306     /* Reference frames and Current frames */
 307     for(i = 0; i < NUM_MFC_DMV_BUFFERS; i++) {
 308         if ( mfc_context->direct_mv_buffers[i].bo != NULL) {
 309             OUT_BCS_RELOC(batch, mfc_context->direct_mv_buffers[i].bo,
 310                           I915_GEM_DOMAIN_INSTRUCTION, 0,
 311                           0);
 312         } else {
 313             OUT_BCS_BATCH(batch, 0);
 314         }
 315     }
 316
 317     /* POL list */
 318     for(i = 0; i < 32; i++) {
 319         OUT_BCS_BATCH(batch, i/2);
 320     }
 321     OUT_BCS_BATCH(batch, 0);
 322     OUT_BCS_BATCH(batch, 0);
 323
 324     ADVANCE_BCS_BATCH(batch);
 325 }
 326
 327 static void
 328 gen6_mfc_avc_slice_state(VADriverContextP ctx,
 329                          VAEncSliceParameterBufferH264 *slice_param,
 330                          struct encode_state *encode_state,
 331                          struct intel_encoder_context *encoder_context,
 332                          int rate_control_enable,
 333                          int qp,
 334                          struct intel_batchbuffer *batch)
 335 {
 336     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 337     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
 338     int height_in_mbs = (mfc_context->surface_state.height + 15) / 16;
 339     int beginmb = slice_param->starting_macroblock_address;
 340     int endmb = beginmb + slice_param->number_of_mbs;
 341     int beginx = beginmb % width_in_mbs;
 342     int beginy = beginmb / width_in_mbs;
 343     int nextx =  endmb % width_in_mbs;
 344     int nexty = endmb / width_in_mbs;
 345     int slice_type = slice_param->slice_type;
 346     int last_slice = (endmb == (width_in_mbs * height_in_mbs));
 347     int bit_rate_control_target, maxQpN, maxQpP;
 348     unsigned char correct[6], grow, shrink;
 349     int i;
 350
 351     if (batch == NULL)
 352         batch = encoder_context->base.batch;
 353
 354     if (slice_type == SLICE_TYPE_I)
 355         bit_rate_control_target = 0;
 356     else
 357         bit_rate_control_target = 1;
 358
 359     maxQpN = mfc_context->bit_rate_control_context[bit_rate_control_target].MaxQpNegModifier;
 360     maxQpP = mfc_context->bit_rate_control_context[bit_rate_control_target].MaxQpPosModifier;
 361
 362     for (i = 0; i < 6; i++)
 363         correct[i] = mfc_context->bit_rate_control_context[bit_rate_control_target].Correct[i];
 364
 365     grow = mfc_context->bit_rate_control_context[bit_rate_control_target].GrowInit +
 366         (mfc_context->bit_rate_control_context[bit_rate_control_target].GrowResistance << 4);
 367     shrink = mfc_context->bit_rate_control_context[bit_rate_control_target].ShrinkInit +
 368         (mfc_context->bit_rate_control_context[bit_rate_control_target].ShrinkResistance << 4);
 369
 370     BEGIN_BCS_BATCH(batch, 11);;
 371
 372     OUT_BCS_BATCH(batch, MFX_AVC_SLICE_STATE | (11 - 2) );
 373     OUT_BCS_BATCH(batch, slice_type);                   /*Slice Type: I:P:B Slice*/
 374
 375     if (slice_type == SLICE_TYPE_I) {
 376         OUT_BCS_BATCH(batch, 0);                        /*no reference frames and pred_weight_table*/
 377     } else {
 378         OUT_BCS_BATCH(batch, 0x00010000);       /*1 reference frame*/
 379     }
 380
 381     OUT_BCS_BATCH(batch,
 382                   (slice_param->direct_spatial_mv_pred_flag << 29) |             /*Direct Prediction Type*/
 383                   (0 << 24) |                /*Enable deblocking operation*/
 384                   (qp << 16) |                  /*Slice Quantization Parameter*/
 385                   (0x0202 << 0));
 386     OUT_BCS_BATCH(batch, (beginy << 24) |                       /*First MB X&Y , the begin postion of current slice*/
 387                   (beginx << 16) |
 388                   slice_param->starting_macroblock_address );
 389     OUT_BCS_BATCH(batch, (nexty << 16) | nextx);                       /*Next slice first MB X&Y*/
 390     OUT_BCS_BATCH(batch,
 391                   (rate_control_enable << 31) |         /*in CBR mode RateControlCounterEnable = enable*/
 392                   (1 << 30) |           /*ResetRateControlCounter*/
 393                   (0 << 28) |           /*RC Triggle Mode = Always Rate Control*/
 394                   (4 << 24) |     /*RC Stable Tolerance, middle level*/
 395                   (rate_control_enable << 23) |     /*RC Panic Enable*/
 396                   (0 << 22) |     /*QP mode, don't modfiy CBP*/
 397                   (0 << 21) |     /*MB Type Direct Conversion Enabled*/
 398                   (0 << 20) |     /*MB Type Skip Conversion Enabled*/
 399                   (last_slice << 19) |     /*IsLastSlice*/
 400                   (0 << 18) |   /*BitstreamOutputFlag Compressed BitStream Output Disable Flag 0:enable 1:disable*/
 401                   (1 << 17) |       /*HeaderPresentFlag*/
 402                   (1 << 16) |       /*SliceData PresentFlag*/
 403                   (1 << 15) |       /*TailPresentFlag*/
 404                   (1 << 13) |       /*RBSP NAL TYPE*/
 405                   (0 << 12) );    /*CabacZeroWordInsertionEnable*/
 406     OUT_BCS_BATCH(batch, mfc_context->mfc_indirect_pak_bse_object.offset);
 407     OUT_BCS_BATCH(batch,
 408                   (maxQpN << 24) |     /*Target QP - 24 is lowest QP*/
 409                   (maxQpP << 16) |     /*Target QP + 20 is highest QP*/
 410                   (shrink << 8)  |
 411                   (grow << 0));
 412     OUT_BCS_BATCH(batch,
 413                   (correct[5] << 20) |
 414                   (correct[4] << 16) |
 415                   (correct[3] << 12) |
 416                   (correct[2] << 8) |
 417                   (correct[1] << 4) |
 418                   (correct[0] << 0));
 419     OUT_BCS_BATCH(batch, 0);
 420
 421     ADVANCE_BCS_BATCH(batch);
 422 }
 423
 424 static void gen6_mfc_avc_qm_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
 425 {
 426     struct intel_batchbuffer *batch = encoder_context->base.batch;
 427     int i;
 428
 429     BEGIN_BCS_BATCH(batch, 58);
 430
 431     OUT_BCS_BATCH(batch, MFX_AVC_QM_STATE | 56);
 432     OUT_BCS_BATCH(batch, 0xFF ) ;
 433     for( i = 0; i < 56; i++) {
 434         OUT_BCS_BATCH(batch, 0x10101010);
 435     }
 436
 437     ADVANCE_BCS_BATCH(batch);
 438 }
 439
 440 static void gen6_mfc_avc_fqm_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
 441 {
 442     struct intel_batchbuffer *batch = encoder_context->base.batch;
 443     int i;
 444
 445     BEGIN_BCS_BATCH(batch, 113);
 446     OUT_BCS_BATCH(batch, MFC_AVC_FQM_STATE | (113 - 2));
 447
 448     for(i = 0; i < 112;i++) {
 449         OUT_BCS_BATCH(batch, 0x10001000);
 450     }
 451
 452     ADVANCE_BCS_BATCH(batch);
 453 }
 454
 455 static void
 456 gen6_mfc_avc_ref_idx_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
 457 {
 458     struct intel_batchbuffer *batch = encoder_context->base.batch;
 459     int i;
 460
 461     BEGIN_BCS_BATCH(batch, 10);
 462     OUT_BCS_BATCH(batch, MFX_AVC_REF_IDX_STATE | 8);
 463     OUT_BCS_BATCH(batch, 0);                  //Select L0
 464     OUT_BCS_BATCH(batch, 0x80808020);         //Only 1 reference
 465     for(i = 0; i < 7; i++) {
 466         OUT_BCS_BATCH(batch, 0x80808080);
 467     }
 468     ADVANCE_BCS_BATCH(batch);
 469
 470     BEGIN_BCS_BATCH(batch, 10);
 471     OUT_BCS_BATCH(batch, MFX_AVC_REF_IDX_STATE | 8);
 472     OUT_BCS_BATCH(batch, 1);                  //Select L1
 473     OUT_BCS_BATCH(batch, 0x80808022);         //Only 1 reference
 474     for(i = 0; i < 7; i++) {
 475         OUT_BCS_BATCH(batch, 0x80808080);
 476     }
 477     ADVANCE_BCS_BATCH(batch);
 478 }
 479
 480 static void
 481 gen6_mfc_avc_insert_object(VADriverContextP ctx, struct intel_encoder_context *encoder_context,
 482                            unsigned int *insert_data, int lenght_in_dws, int data_bits_in_last_dw,
 483                            int skip_emul_byte_count, int is_last_header, int is_end_of_slice, int emulation_flag,
 484                            struct intel_batchbuffer *batch)
 485 {
 486     if (batch == NULL)
 487         batch = encoder_context->base.batch;
 488
 489     BEGIN_BCS_BATCH(batch, lenght_in_dws + 2);
 490
 491     OUT_BCS_BATCH(batch, MFC_AVC_INSERT_OBJECT | (lenght_in_dws + 2 - 2));
 492
 493     OUT_BCS_BATCH(batch,
 494                   (0 << 16) |   /* always start at offset 0 */
 495                   (data_bits_in_last_dw << 8) |
 496                   (skip_emul_byte_count << 4) |
 497                   (!!emulation_flag << 3) |
 498                   ((!!is_last_header) << 2) |
 499                   ((!!is_end_of_slice) << 1) |
 500                   (0 << 0));    /* FIXME: ??? */
 501
 502     intel_batchbuffer_data(batch, insert_data, lenght_in_dws * 4);
 503     ADVANCE_BCS_BATCH(batch);
 504 }
 505
 506 static void gen6_mfc_init(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
 507 {
 508     struct i965_driver_data *i965 = i965_driver_data(ctx);
 509     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 510     dri_bo *bo;
 511     int i;
 512
 513     /*Encode common setup for MFC*/
 514     dri_bo_unreference(mfc_context->post_deblocking_output.bo);
 515     mfc_context->post_deblocking_output.bo = NULL;
 516
 517     dri_bo_unreference(mfc_context->pre_deblocking_output.bo);
 518     mfc_context->pre_deblocking_output.bo = NULL;
 519
 520     dri_bo_unreference(mfc_context->uncompressed_picture_source.bo);
 521     mfc_context->uncompressed_picture_source.bo = NULL;
 522
 523     dri_bo_unreference(mfc_context->mfc_indirect_pak_bse_object.bo);
 524     mfc_context->mfc_indirect_pak_bse_object.bo = NULL;
 525
 526     for (i = 0; i < NUM_MFC_DMV_BUFFERS; i++){
 527         if ( mfc_context->direct_mv_buffers[i].bo != NULL);
 528         dri_bo_unreference(mfc_context->direct_mv_buffers[i].bo);
 529         mfc_context->direct_mv_buffers[i].bo = NULL;
 530     }
 531
 532     for (i = 0; i < MAX_MFC_REFERENCE_SURFACES; i++){
 533         if (mfc_context->reference_surfaces[i].bo != NULL)
 534             dri_bo_unreference(mfc_context->reference_surfaces[i].bo);
 535         mfc_context->reference_surfaces[i].bo = NULL;
 536     }
 537
 538     dri_bo_unreference(mfc_context->intra_row_store_scratch_buffer.bo);
 539     bo = dri_bo_alloc(i965->intel.bufmgr,
 540                       "Buffer",
 541                       128 * 64,
 542                       64);
 543     assert(bo);
 544     mfc_context->intra_row_store_scratch_buffer.bo = bo;
 545
 546     dri_bo_unreference(mfc_context->macroblock_status_buffer.bo);
 547     bo = dri_bo_alloc(i965->intel.bufmgr,
 548                       "Buffer",
 549                       128*128*16,
 550                       64);
 551     assert(bo);
 552     mfc_context->macroblock_status_buffer.bo = bo;
 553
 554     dri_bo_unreference(mfc_context->deblocking_filter_row_store_scratch_buffer.bo);
 555     bo = dri_bo_alloc(i965->intel.bufmgr,
 556                       "Buffer",
 557                       49152,  /* 6 * 128 * 64 */
 558                       64);
 559     assert(bo);
 560     mfc_context->deblocking_filter_row_store_scratch_buffer.bo = bo;
 561
 562     dri_bo_unreference(mfc_context->bsd_mpc_row_store_scratch_buffer.bo);
 563     bo = dri_bo_alloc(i965->intel.bufmgr,
 564                       "Buffer",
 565                       12288, /* 1.5 * 128 * 64 */
 566                       0x1000);
 567     assert(bo);
 568     mfc_context->bsd_mpc_row_store_scratch_buffer.bo = bo;
 569
 570     dri_bo_unreference(mfc_context->mfc_batchbuffer_surface.bo);
 571     mfc_context->mfc_batchbuffer_surface.bo = NULL;
 572
 573     dri_bo_unreference(mfc_context->aux_batchbuffer_surface.bo);
 574     mfc_context->aux_batchbuffer_surface.bo = NULL;
 575
 576     if (mfc_context->aux_batchbuffer)
 577         intel_batchbuffer_free(mfc_context->aux_batchbuffer);
 578
 579     mfc_context->aux_batchbuffer = intel_batchbuffer_new(&i965->intel, I915_EXEC_BSD);
 580     mfc_context->aux_batchbuffer_surface.bo = mfc_context->aux_batchbuffer->buffer;
 581     dri_bo_reference(mfc_context->aux_batchbuffer_surface.bo);
 582     mfc_context->aux_batchbuffer_surface.pitch = 16;
 583     mfc_context->aux_batchbuffer_surface.num_blocks = mfc_context->aux_batchbuffer->size / 16;
 584     mfc_context->aux_batchbuffer_surface.size_block = 16;
 585
 586     i965_gpe_context_init(ctx, &mfc_context->gpe_context);
 587 }
 588
 589 static void gen6_mfc_avc_pipeline_header_programing(VADriverContextP ctx,
 590                                                     struct encode_state *encode_state,
 591                                                     struct intel_encoder_context *encoder_context,
 592                                                     struct intel_batchbuffer *slice_batch)
 593 {
 594     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 595     static int count = 0;
 596     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
 597     int rate_control_mode = pSequenceParameter->rate_control_method;
 598
 599     if (encode_state->packed_header_data[VAEncPackedHeaderSPS]) {
 600         VAEncPackedHeaderParameterBuffer *param = NULL;
 601         unsigned int *header_data = (unsigned int *)encode_state->packed_header_data[VAEncPackedHeaderSPS]->buffer;
 602         unsigned int length_in_bits;
 603
 604         assert(encode_state->packed_header_param[VAEncPackedHeaderSPS]);
 605         param = (VAEncPackedHeaderParameterBuffer *)encode_state->packed_header_param[VAEncPackedHeaderSPS]->buffer;
 606         length_in_bits = param->length_in_bits[0];
 607
 608         mfc_context->insert_object(ctx,
 609                                    encoder_context,
 610                                    header_data,
 611                                    ALIGN(length_in_bits, 32) >> 5,
 612                                    length_in_bits & 0x1f,
 613                                    param->skip_emulation_check_count,
 614                                    0,
 615                                    0,
 616                                    param->insert_emulation_bytes,
 617                                    slice_batch);
 618     }
 619
 620     if (encode_state->packed_header_data[VAEncPackedHeaderPPS]) {
 621         VAEncPackedHeaderParameterBuffer *param = NULL;
 622         unsigned int *header_data = (unsigned int *)encode_state->packed_header_data[VAEncPackedHeaderPPS]->buffer;
 623         unsigned int length_in_bits;
 624
 625         assert(encode_state->packed_header_param[VAEncPackedHeaderPPS]);
 626         param = (VAEncPackedHeaderParameterBuffer *)encode_state->packed_header_param[VAEncPackedHeaderPPS]->buffer;
 627         length_in_bits = param->length_in_bits[0];
 628
 629         mfc_context->insert_object(ctx,
 630                                    encoder_context,
 631                                    header_data,
 632                                    ALIGN(length_in_bits, 32) >> 5,
 633                                    length_in_bits & 0x1f,
 634                                    param->skip_emulation_check_count,
 635                                    0,
 636                                    0,
 637                                    param->insert_emulation_bytes,
 638                                    slice_batch);
 639     }
 640
 641     if ( (rate_control_mode == 0) && encode_state->packed_header_data[VAEncPackedHeaderSPS]) {       // this is frist AU
 642         struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 643
 644         unsigned char *sei_data = NULL;
 645         int length_in_bits = build_avc_sei_buffering_period(mfc_context->vui_hrd.i_initial_cpb_removal_delay_length,
 646                                                             mfc_context->vui_hrd.i_initial_cpb_removal_delay, 0, &sei_data);
 647         mfc_context->insert_object(ctx,
 648                                    encoder_context,
 649                                    (unsigned int *)sei_data,
 650                                    ALIGN(length_in_bits, 32) >> 5,
 651                                    length_in_bits & 0x1f,
 652                                    4,
 653                                    0,
 654                                    0,
 655                                    1,
 656                                    slice_batch);
 657         free(sei_data);
 658     }
 659
 660     // SEI pic_timing header
 661     if ( rate_control_mode == 0) {
 662         struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 663         unsigned char *sei_data = NULL;
 664         int length_in_bits = build_avc_sei_pic_timing( mfc_context->vui_hrd.i_cpb_removal_delay_length,
 665                                                        mfc_context->vui_hrd.i_cpb_removal_delay * mfc_context->vui_hrd.i_frame_number,
 666                                                        mfc_context->vui_hrd.i_dpb_output_delay_length,
 667                                                        0, &sei_data);
 668         mfc_context->insert_object(ctx,
 669                                    encoder_context,
 670                                    (unsigned int *)sei_data,
 671                                    ALIGN(length_in_bits, 32) >> 5,
 672                                    length_in_bits & 0x1f,
 673                                    4,
 674                                    0,
 675                                    0,
 676                                    1,
 677                                    slice_batch);
 678         free(sei_data);
 679     }
 680
 681     count++;
 682 }
 683
 684 static void gen6_mfc_avc_pipeline_picture_programing( VADriverContextP ctx,
 685                                       struct encode_state *encode_state,
 686                                       struct intel_encoder_context *encoder_context)
 687 {
 688     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 689
 690     mfc_context->pipe_mode_select(ctx, MFX_FORMAT_AVC, encoder_context);
 691     mfc_context->set_surface_state(ctx, encoder_context);
 692     mfc_context->ind_obj_base_addr_state(ctx, encoder_context);
 693     gen6_mfc_pipe_buf_addr_state(ctx, encoder_context);
 694     gen6_mfc_bsp_buf_base_addr_state(ctx, encoder_context);
 695     mfc_context->avc_img_state(ctx, encode_state, encoder_context);
 696     mfc_context->avc_qm_state(ctx, encoder_context);
 697     mfc_context->avc_fqm_state(ctx, encoder_context);
 698     gen6_mfc_avc_directmode_state(ctx, encoder_context);
 699     gen6_mfc_avc_ref_idx_state(ctx, encoder_context);
 700 }
 701
 702 static void
 703 gen6_mfc_free_avc_surface(void **data)
 704 {
 705     struct gen6_mfc_avc_surface_aux *avc_surface = *data;
 706
 707     if (!avc_surface)
 708         return;
 709
 710     dri_bo_unreference(avc_surface->dmv_top);
 711     avc_surface->dmv_top = NULL;
 712     dri_bo_unreference(avc_surface->dmv_bottom);
 713     avc_surface->dmv_bottom = NULL;
 714
 715     free(avc_surface);
 716     *data = NULL;
 717 }
 718
 719 static void
 720 gen6_mfc_bit_rate_control_context_init(struct encode_state *encode_state,
 721                                        struct gen6_mfc_context *mfc_context)
 722 {
 723     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
 724
 725     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
 726     int height_in_mbs = (mfc_context->surface_state.height + 15) / 16;
 727     float fps =  pSequenceParameter->time_scale * 0.5 / pSequenceParameter->num_units_in_tick ;
 728     int inter_mb_size = pSequenceParameter->bits_per_second * 1.0 / (fps+4.0) / width_in_mbs / height_in_mbs;
 729     int intra_mb_size = inter_mb_size * 5.0;
 730     int i;
 731
 732     mfc_context->bit_rate_control_context[0].target_mb_size = intra_mb_size;
 733     mfc_context->bit_rate_control_context[0].target_frame_size = intra_mb_size * width_in_mbs * height_in_mbs;
 734     mfc_context->bit_rate_control_context[1].target_mb_size = inter_mb_size;
 735     mfc_context->bit_rate_control_context[1].target_frame_size = inter_mb_size * width_in_mbs * height_in_mbs;
 736
 737     for(i = 0 ; i < 2; i++) {
 738         mfc_context->bit_rate_control_context[i].QpPrimeY = 26;
 739         mfc_context->bit_rate_control_context[i].MaxQpNegModifier = 6;
 740         mfc_context->bit_rate_control_context[i].MaxQpPosModifier = 6;
 741         mfc_context->bit_rate_control_context[i].GrowInit = 6;
 742         mfc_context->bit_rate_control_context[i].GrowResistance = 4;
 743         mfc_context->bit_rate_control_context[i].ShrinkInit = 6;
 744         mfc_context->bit_rate_control_context[i].ShrinkResistance = 4;
 745
 746         mfc_context->bit_rate_control_context[i].Correct[0] = 8;
 747         mfc_context->bit_rate_control_context[i].Correct[1] = 4;
 748         mfc_context->bit_rate_control_context[i].Correct[2] = 2;
 749         mfc_context->bit_rate_control_context[i].Correct[3] = 2;
 750         mfc_context->bit_rate_control_context[i].Correct[4] = 4;
 751         mfc_context->bit_rate_control_context[i].Correct[5] = 8;
 752     }
 753
 754     mfc_context->bit_rate_control_context[0].TargetSizeInWord = (intra_mb_size + 16)/ 16;
 755     mfc_context->bit_rate_control_context[1].TargetSizeInWord = (inter_mb_size + 16)/ 16;
 756
 757     mfc_context->bit_rate_control_context[0].MaxSizeInWord = mfc_context->bit_rate_control_context[0].TargetSizeInWord * 1.5;
 758     mfc_context->bit_rate_control_context[1].MaxSizeInWord = mfc_context->bit_rate_control_context[1].TargetSizeInWord * 1.5;
 759 }
 760
 761 static int gen6_mfc_bit_rate_control_context_update(struct encode_state *encode_state,
 762                                                     struct gen6_mfc_context *mfc_context,
 763                                                     int current_frame_size)
 764 {
 765     VAEncSliceParameterBufferH264 *pSliceParameter = (VAEncSliceParameterBufferH264 *)encode_state->slice_params_ext[0]->buffer;
 766     int control_index = 1 - (pSliceParameter->slice_type == SLICE_TYPE_I);
 767     int oldQp = mfc_context->bit_rate_control_context[control_index].QpPrimeY;
 768
 769     /*
 770       printf("conrol_index = %d, start_qp = %d, result = %d, target = %d\n", control_index,
 771       mfc_context->bit_rate_control_context[control_index].QpPrimeY, current_frame_size,
 772       mfc_context->bit_rate_control_context[control_index].target_frame_size );
 773     */
 774
 775     if ( current_frame_size > mfc_context->bit_rate_control_context[control_index].target_frame_size * 4.0 ) {
 776         mfc_context->bit_rate_control_context[control_index].QpPrimeY += 4;
 777     } else if ( current_frame_size > mfc_context->bit_rate_control_context[control_index].target_frame_size * 2.0 ) {
 778         mfc_context->bit_rate_control_context[control_index].QpPrimeY += 3;
 779     } else if ( current_frame_size > mfc_context->bit_rate_control_context[control_index].target_frame_size * 1.50 ) {
 780         mfc_context->bit_rate_control_context[control_index].QpPrimeY += 2;
 781     } else if ( current_frame_size > mfc_context->bit_rate_control_context[control_index].target_frame_size * 1.20 ) {
 782         mfc_context->bit_rate_control_context[control_index].QpPrimeY ++;
 783     } else if (current_frame_size < mfc_context->bit_rate_control_context[control_index].target_frame_size * 0.30 )  {
 784         mfc_context->bit_rate_control_context[control_index].QpPrimeY -= 3;
 785     } else if (current_frame_size < mfc_context->bit_rate_control_context[control_index].target_frame_size * 0.50 )  {
 786         mfc_context->bit_rate_control_context[control_index].QpPrimeY -= 2;
 787     } else if (current_frame_size < mfc_context->bit_rate_control_context[control_index].target_frame_size * 0.80 )  {
 788         mfc_context->bit_rate_control_context[control_index].QpPrimeY --;
 789     }
 790
 791     if ( mfc_context->bit_rate_control_context[control_index].QpPrimeY > 51)
 792         mfc_context->bit_rate_control_context[control_index].QpPrimeY = 51;
 793     if ( mfc_context->bit_rate_control_context[control_index].QpPrimeY < 1)
 794         mfc_context->bit_rate_control_context[control_index].QpPrimeY = 1;
 795
 796     if ( mfc_context->bit_rate_control_context[control_index].QpPrimeY != oldQp)
 797         return 0;
 798
 799     return 1;
 800 }
 801
 802 static void
 803 gen6_mfc_hrd_context_init(struct encode_state *encode_state,
 804                           struct gen6_mfc_context *mfc_context)
 805 {
 806     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
 807     int rate_control_mode = pSequenceParameter->rate_control_method;
 808     int target_bit_rate = pSequenceParameter->bits_per_second;
 809
 810     // current we only support CBR mode.
 811     if ( rate_control_mode == 0) {
 812         mfc_context->vui_hrd.i_bit_rate_value = target_bit_rate >> 10;
 813         mfc_context->vui_hrd.i_cpb_size_value = (target_bit_rate * 8) >> 10;
 814         mfc_context->vui_hrd.i_initial_cpb_removal_delay = mfc_context->vui_hrd.i_cpb_size_value * 0.5 * 1024 / target_bit_rate * 90000;
 815         mfc_context->vui_hrd.i_cpb_removal_delay = 2;
 816         mfc_context->vui_hrd.i_frame_number = 0;
 817
 818         mfc_context->vui_hrd.i_initial_cpb_removal_delay_length = 24;
 819         mfc_context->vui_hrd.i_cpb_removal_delay_length = 24;
 820         mfc_context->vui_hrd.i_dpb_output_delay_length = 24;
 821     }
 822
 823 }
 824
 825 static void
 826 gen6_mfc_hrd_context_update(struct encode_state *encode_state,
 827                           struct gen6_mfc_context *mfc_context)
 828 {
 829     mfc_context->vui_hrd.i_frame_number++;
 830 }
 831
 832 static VAStatus gen6_mfc_avc_prepare(VADriverContextP ctx,
 833                                      struct encode_state *encode_state,
 834                                      struct intel_encoder_context *encoder_context)
 835 {
 836     struct i965_driver_data *i965 = i965_driver_data(ctx);
 837     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 838     struct object_surface *obj_surface;
 839     struct object_buffer *obj_buffer;
 840     struct gen6_mfc_avc_surface_aux* gen6_avc_surface;
 841     dri_bo *bo;
 842     VAEncPictureParameterBufferH264 *pPicParameter = (VAEncPictureParameterBufferH264 *)encode_state->pic_param_ext->buffer;
 843     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
 844     int rate_control_mode = pSequenceParameter->rate_control_method;
 845     VAStatus vaStatus = VA_STATUS_SUCCESS;
 846     int i;
 847
 848     /*Setup all the input&output object*/
 849
 850     /* Setup current frame and current direct mv buffer*/
 851     obj_surface = SURFACE(pPicParameter->CurrPic.picture_id);
 852     assert(obj_surface);
 853     i965_check_alloc_surface_bo(ctx, obj_surface, 1, VA_FOURCC('N','V','1','2'), SUBSAMPLE_YUV420);
 854
 855     if ( obj_surface->private_data == NULL) {
 856         gen6_avc_surface = calloc(sizeof(struct gen6_mfc_avc_surface_aux), 1);
 857         gen6_avc_surface->dmv_top =
 858             dri_bo_alloc(i965->intel.bufmgr,
 859                          "Buffer",
 860                          68*8192,
 861                          64);
 862         gen6_avc_surface->dmv_bottom =
 863             dri_bo_alloc(i965->intel.bufmgr,
 864                          "Buffer",
 865                          68*8192,
 866                          64);
 867         assert(gen6_avc_surface->dmv_top);
 868         assert(gen6_avc_surface->dmv_bottom);
 869         obj_surface->private_data = (void *)gen6_avc_surface;
 870         obj_surface->free_private_data = (void *)gen6_mfc_free_avc_surface;
 871     }
 872     gen6_avc_surface = (struct gen6_mfc_avc_surface_aux*) obj_surface->private_data;
 873     mfc_context->direct_mv_buffers[NUM_MFC_DMV_BUFFERS - 2].bo = gen6_avc_surface->dmv_top;
 874     mfc_context->direct_mv_buffers[NUM_MFC_DMV_BUFFERS - 1].bo = gen6_avc_surface->dmv_bottom;
 875     dri_bo_reference(gen6_avc_surface->dmv_top);
 876     dri_bo_reference(gen6_avc_surface->dmv_bottom);
 877
 878     mfc_context->post_deblocking_output.bo = obj_surface->bo;
 879     dri_bo_reference(mfc_context->post_deblocking_output.bo);
 880
 881     mfc_context->surface_state.width = obj_surface->orig_width;
 882     mfc_context->surface_state.height = obj_surface->orig_height;
 883     mfc_context->surface_state.w_pitch = obj_surface->width;
 884     mfc_context->surface_state.h_pitch = obj_surface->height;
 885
 886     /* Setup reference frames and direct mv buffers*/
 887     for(i = 0; i < MAX_MFC_REFERENCE_SURFACES; i++) {
 888         if ( pPicParameter->ReferenceFrames[i].picture_id != VA_INVALID_ID ) {
 889             obj_surface = SURFACE(pPicParameter->ReferenceFrames[i].picture_id);
 890             assert(obj_surface);
 891             if (obj_surface->bo != NULL) {
 892                 mfc_context->reference_surfaces[i].bo = obj_surface->bo;
 893                 dri_bo_reference(obj_surface->bo);
 894             }
 895             /* Check DMV buffer */
 896             if ( obj_surface->private_data == NULL) {
 897
 898                 gen6_avc_surface = calloc(sizeof(struct gen6_mfc_avc_surface_aux), 1);
 899                 gen6_avc_surface->dmv_top =
 900                     dri_bo_alloc(i965->intel.bufmgr,
 901                                  "Buffer",
 902                                  68*8192,
 903                                  64);
 904                 gen6_avc_surface->dmv_bottom =
 905                     dri_bo_alloc(i965->intel.bufmgr,
 906                                  "Buffer",
 907                                  68*8192,
 908                                  64);
 909                 assert(gen6_avc_surface->dmv_top);
 910                 assert(gen6_avc_surface->dmv_bottom);
 911                 obj_surface->private_data = gen6_avc_surface;
 912                 obj_surface->free_private_data = gen6_mfc_free_avc_surface;
 913             }
 914
 915             gen6_avc_surface = (struct gen6_mfc_avc_surface_aux*) obj_surface->private_data;
 916             /* Setup DMV buffer */
 917             mfc_context->direct_mv_buffers[i*2].bo = gen6_avc_surface->dmv_top;
 918             mfc_context->direct_mv_buffers[i*2+1].bo = gen6_avc_surface->dmv_bottom;
 919             dri_bo_reference(gen6_avc_surface->dmv_top);
 920             dri_bo_reference(gen6_avc_surface->dmv_bottom);
 921         } else {
 922             break;
 923         }
 924     }
 925
 926     obj_surface = SURFACE(encoder_context->input_yuv_surface);
 927     assert(obj_surface && obj_surface->bo);
 928     mfc_context->uncompressed_picture_source.bo = obj_surface->bo;
 929     dri_bo_reference(mfc_context->uncompressed_picture_source.bo);
 930
 931     obj_buffer = BUFFER (pPicParameter->CodedBuf); /* FIXME: fix this later */
 932     bo = obj_buffer->buffer_store->bo;
 933     assert(bo);
 934     mfc_context->mfc_indirect_pak_bse_object.bo = bo;
 935     mfc_context->mfc_indirect_pak_bse_object.offset = ALIGN(sizeof(VACodedBufferSegment), 64);
 936     mfc_context->mfc_indirect_pak_bse_object.end_offset = ALIGN (obj_buffer->size_element - 0x1000, 0x1000);
 937     dri_bo_reference(mfc_context->mfc_indirect_pak_bse_object.bo);
 938
 939     /*Programing bit rate control */
 940     if ( mfc_context->bit_rate_control_context[0].MaxSizeInWord == 0 )
 941         gen6_mfc_bit_rate_control_context_init(encode_state, mfc_context);
 942
 943     /*Programing HRD control */
 944     if ( (rate_control_mode == 0) && (mfc_context->vui_hrd.i_cpb_size_value == 0) )
 945         gen6_mfc_hrd_context_init(encode_state, mfc_context);
 946
 947     return vaStatus;
 948 }
 949
 950 static VAStatus gen6_mfc_run(VADriverContextP ctx,
 951                              struct encode_state *encode_state,
 952                              struct intel_encoder_context *encoder_context)
 953 {
 954     struct intel_batchbuffer *batch = encoder_context->base.batch;
 955
 956     intel_batchbuffer_flush(batch);             //run the pipeline
 957
 958     return VA_STATUS_SUCCESS;
 959 }
 960
 961 static VAStatus
 962 gen6_mfc_stop(VADriverContextP ctx,
 963               struct encode_state *encode_state,
 964               struct intel_encoder_context *encoder_context,
 965               int *encoded_bits_size)
 966 {
 967     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
 968     unsigned int *status_mem;
 969     unsigned int buffer_size_bits = 0;
 970     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
 971     int height_in_mbs = (mfc_context->surface_state.height + 15) / 16;
 972     int i;
 973
 974     dri_bo_map(mfc_context->macroblock_status_buffer.bo, 1);
 975     status_mem = (unsigned int *)mfc_context->macroblock_status_buffer.bo->virtual;
 976     //Detecting encoder buffer size and bit rate control result
 977     for(i = 0; i < width_in_mbs * height_in_mbs; i++) {
 978         unsigned short current_mb = status_mem[1] >> 16;
 979         buffer_size_bits += current_mb;
 980         status_mem += 4;
 981     }
 982     dri_bo_unmap(mfc_context->macroblock_status_buffer.bo);
 983
 984     *encoded_bits_size = buffer_size_bits;
 985
 986     return VA_STATUS_SUCCESS;
 987 }
 988
 989 #if __SOFTWARE__
 990
 991 static int
 992 gen6_mfc_avc_pak_object_intra(VADriverContextP ctx, int x, int y, int end_mb, int qp,unsigned int *msg,
 993                               struct intel_encoder_context *encoder_context,
 994                               unsigned char target_mb_size, unsigned char max_mb_size,
 995                               struct intel_batchbuffer *batch)
 996 {
 997     int len_in_dwords = 11;
 998
 999     if (batch == NULL)
1000         batch = encoder_context->base.batch;
1001
1002     BEGIN_BCS_BATCH(batch, len_in_dwords);
1003
1004     OUT_BCS_BATCH(batch, MFC_AVC_PAK_OBJECT | (len_in_dwords - 2));
1005     OUT_BCS_BATCH(batch, 0);
1006     OUT_BCS_BATCH(batch, 0);
1007     OUT_BCS_BATCH(batch,
1008                   (0 << 24) |           /* PackedMvNum, Debug*/
1009                   (0 << 20) |           /* No motion vector */
1010                   (1 << 19) |           /* CbpDcY */
1011                   (1 << 18) |           /* CbpDcU */
1012                   (1 << 17) |           /* CbpDcV */
1013                   (msg[0] & 0xFFFF) );
1014
1015     OUT_BCS_BATCH(batch, (0xFFFF << 16) | (y << 8) | x);                /* Code Block Pattern for Y*/
1016     OUT_BCS_BATCH(batch, 0x000F000F);                                                   /* Code Block Pattern */
1017     OUT_BCS_BATCH(batch, (0 << 27) | (end_mb << 26) | qp);      /* Last MB */
1018
1019     /*Stuff for Intra MB*/
1020     OUT_BCS_BATCH(batch, msg[1]);                       /* We using Intra16x16 no 4x4 predmode*/
1021     OUT_BCS_BATCH(batch, msg[2]);
1022     OUT_BCS_BATCH(batch, msg[3]&0xFC);
1023
1024     /*MaxSizeInWord and TargetSzieInWord*/
1025     OUT_BCS_BATCH(batch, (max_mb_size << 24) |
1026                   (target_mb_size << 16) );
1027
1028     ADVANCE_BCS_BATCH(batch);
1029
1030     return len_in_dwords;
1031 }
1032
1033 static int
1034 gen6_mfc_avc_pak_object_inter(VADriverContextP ctx, int x, int y, int end_mb, int qp, unsigned int offset,
1035                               struct intel_encoder_context *encoder_context,
1036                               unsigned char target_mb_size,unsigned char max_mb_size, int slice_type,
1037                               struct intel_batchbuffer *batch)
1038 {
1039     int len_in_dwords = 11;
1040
1041     if (batch == NULL)
1042         batch = encoder_context->base.batch;
1043
1044     BEGIN_BCS_BATCH(batch, len_in_dwords);
1045
1046     OUT_BCS_BATCH(batch, MFC_AVC_PAK_OBJECT | (len_in_dwords - 2));
1047
1048     OUT_BCS_BATCH(batch, 32);         /* 32 MV*/
1049     OUT_BCS_BATCH(batch, offset);
1050
1051     OUT_BCS_BATCH(batch,
1052                   (1 << 24) |     /* PackedMvNum, Debug*/
1053                   (4 << 20) |     /* 8 MV, SNB don't use it*/
1054                   (1 << 19) |     /* CbpDcY */
1055                   (1 << 18) |     /* CbpDcU */
1056                   (1 << 17) |     /* CbpDcV */
1057                   (0 << 15) |     /* Transform8x8Flag = 0*/
1058                   (0 << 14) |     /* Frame based*/
1059                   (0 << 13) |     /* Inter MB */
1060                   (1 << 8)  |     /* MbType = P_L0_16x16 */
1061                   (0 << 7)  |     /* MBZ for frame */
1062                   (0 << 6)  |     /* MBZ */
1063                   (2 << 4)  |     /* MBZ for inter*/
1064                   (0 << 3)  |     /* MBZ */
1065                   (0 << 2)  |     /* SkipMbFlag */
1066                   (0 << 0));      /* InterMbMode */
1067
1068     OUT_BCS_BATCH(batch, (0xFFFF<<16) | (y << 8) | x);        /* Code Block Pattern for Y*/
1069     OUT_BCS_BATCH(batch, 0x000F000F);                         /* Code Block Pattern */
1070 #if 0
1071     if ( slice_type == SLICE_TYPE_B) {
1072         OUT_BCS_BATCH(batch, (0xF<<28) | (end_mb << 26) | qp);  /* Last MB */
1073     } else {
1074         OUT_BCS_BATCH(batch, (end_mb << 26) | qp);      /* Last MB */
1075     }
1076 #else
1077     OUT_BCS_BATCH(batch, (end_mb << 26) | qp);  /* Last MB */
1078 #endif
1079
1080
1081     /*Stuff for Inter MB*/
1082     OUT_BCS_BATCH(batch, 0x0);
1083     OUT_BCS_BATCH(batch, 0x0);
1084     OUT_BCS_BATCH(batch, 0x0);
1085
1086     /*MaxSizeInWord and TargetSzieInWord*/
1087     OUT_BCS_BATCH(batch, (max_mb_size << 24) |
1088                   (target_mb_size << 16) );
1089
1090     ADVANCE_BCS_BATCH(batch);
1091
1092     return len_in_dwords;
1093 }
1094
1095 static void
1096 gen6_mfc_avc_pipeline_slice_programing(VADriverContextP ctx,
1097                                        struct encode_state *encode_state,
1098                                        struct intel_encoder_context *encoder_context,
1099                                        int slice_index,
1100                                        struct intel_batchbuffer *slice_batch)
1101 {
1102     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1103     struct gen6_vme_context *vme_context = encoder_context->vme_context;
1104     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
1105     VAEncPictureParameterBufferH264 *pPicParameter = (VAEncPictureParameterBufferH264 *)encode_state->pic_param_ext->buffer;
1106     VAEncSliceParameterBufferH264 *pSliceParameter = (VAEncSliceParameterBufferH264 *)encode_state->slice_params_ext[slice_index]->buffer;
1107     VAEncH264DecRefPicMarkingBuffer *pDecRefPicMarking = NULL;
1108     unsigned int *msg = NULL, offset = 0;
1109     int is_intra = pSliceParameter->slice_type == SLICE_TYPE_I;
1110     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
1111     int height_in_mbs = (mfc_context->surface_state.height + 15) / 16;
1112     int last_slice = (pSliceParameter->starting_macroblock_address + pSliceParameter->number_of_mbs) == (width_in_mbs * height_in_mbs);
1113     int i,x,y;
1114     int qp = pPicParameter->pic_init_qp + pSliceParameter->slice_qp_delta;
1115     int rate_control_mode = pSequenceParameter->rate_control_method;
1116     unsigned char *slice_header = NULL;
1117     int slice_header_length_in_bits = 0;
1118     unsigned int tail_data[] = { 0x0, 0x0 };
1119
1120     gen6_mfc_avc_slice_state(ctx, pSliceParameter,
1121                              encode_state, encoder_context,
1122                              (rate_control_mode == 0), qp, slice_batch);
1123
1124     if ( slice_index == 0)
1125         gen6_mfc_avc_pipeline_header_programing(ctx, encode_state, encoder_context, slice_batch);
1126
1127     if (encode_state->dec_ref_pic_marking)
1128         pDecRefPicMarking = (VAEncH264DecRefPicMarkingBuffer *)encode_state->dec_ref_pic_marking->buffer;
1129     slice_header_length_in_bits = build_avc_slice_header(pSequenceParameter, pPicParameter, pSliceParameter, pDecRefPicMarking, &slice_header);
1130
1131     // slice hander
1132     mfc_context->insert_object(ctx, encoder_context,
1133                                (unsigned int *)slice_header, ALIGN(slice_header_length_in_bits, 32) >> 5, slice_header_length_in_bits & 0x1f,
1134                                5,  /* first 5 bytes are start code + nal unit type */
1135                                1, 0, 1, slice_batch);
1136
1137     if ( rate_control_mode == 0) {
1138         qp = mfc_context->bit_rate_control_context[1-is_intra].QpPrimeY;
1139     }
1140
1141     if (is_intra) {
1142         dri_bo_map(vme_context->vme_output.bo , 1);
1143         msg = (unsigned int *)vme_context->vme_output.bo->virtual;
1144         msg += pSliceParameter->starting_macroblock_address * 4;
1145     } else {
1146         offset = pSliceParameter->starting_macroblock_address * 64;
1147     }
1148
1149     for (i = pSliceParameter->starting_macroblock_address;
1150          i < pSliceParameter->starting_macroblock_address + pSliceParameter->number_of_mbs; i++) {
1151         int last_mb = (i == (pSliceParameter->starting_macroblock_address + pSliceParameter->number_of_mbs - 1) );
1152         x = i % width_in_mbs;
1153         y = i / width_in_mbs;
1154
1155         if (is_intra) {
1156             assert(msg);
1157             gen6_mfc_avc_pak_object_intra(ctx, x, y, last_mb, qp, msg, encoder_context, 0, 0, slice_batch);
1158             msg += 4;
1159         } else {
1160             gen6_mfc_avc_pak_object_inter(ctx, x, y, last_mb, qp, offset, encoder_context, 0, 0, pSliceParameter->slice_type, slice_batch);
1161             offset += 64;
1162         }
1163     }
1164
1165     if (is_intra)
1166         dri_bo_unmap(vme_context->vme_output.bo);
1167     if ( last_slice ) {
1168         mfc_context->insert_object(ctx, encoder_context,
1169                                    tail_data, 2, 8,
1170                                    2, 1, 1, 0, slice_batch);
1171     } else {
1172         mfc_context->insert_object(ctx, encoder_context,
1173                                    tail_data, 1, 8,
1174                                    1, 1, 1, 0, slice_batch);
1175     }
1176
1177     free(slice_header);
1178
1179 }
1180
1181 static dri_bo *
1182 gen6_mfc_avc_software_batchbuffer(VADriverContextP ctx,
1183                                   struct encode_state *encode_state,
1184                                   struct intel_encoder_context *encoder_context)
1185 {
1186     struct i965_driver_data *i965 = i965_driver_data(ctx);
1187     struct intel_batchbuffer *batch = intel_batchbuffer_new(&i965->intel, I915_EXEC_BSD);
1188     dri_bo *batch_bo = batch->buffer;
1189     int i;
1190
1191     for (i = 0; i < encode_state->num_slice_params_ext; i++) {
1192         gen6_mfc_avc_pipeline_slice_programing(ctx, encode_state, encoder_context, i, batch);
1193     }
1194
1195     intel_batchbuffer_align(batch, 8);
1196
1197     BEGIN_BCS_BATCH(batch, 2);
1198     OUT_BCS_BATCH(batch, 0);
1199     OUT_BCS_BATCH(batch, MI_BATCH_BUFFER_END);
1200     ADVANCE_BCS_BATCH(batch);
1201
1202     dri_bo_reference(batch_bo);
1203     intel_batchbuffer_free(batch);
1204
1205     return batch_bo;
1206 }
1207
1208 #else
1209
1210 static void
1211 gen6_mfc_batchbuffer_surfaces_input(VADriverContextP ctx,
1212                                     struct encode_state *encode_state,
1213                                     struct intel_encoder_context *encoder_context)
1214
1215 {
1216     struct gen6_vme_context *vme_context = encoder_context->vme_context;
1217     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1218
1219     assert(vme_context->vme_output.bo);
1220     mfc_context->buffer_suface_setup(ctx,
1221                                      &mfc_context->gpe_context,
1222                                      &vme_context->vme_output,
1223                                      BINDING_TABLE_OFFSET(BIND_IDX_VME_OUTPUT),
1224                                      SURFACE_STATE_OFFSET(BIND_IDX_VME_OUTPUT));
1225     assert(mfc_context->aux_batchbuffer_surface.bo);
1226     mfc_context->buffer_suface_setup(ctx,
1227                                      &mfc_context->gpe_context,
1228                                      &mfc_context->aux_batchbuffer_surface,
1229                                      BINDING_TABLE_OFFSET(BIND_IDX_MFC_SLICE_HEADER),
1230                                      SURFACE_STATE_OFFSET(BIND_IDX_MFC_SLICE_HEADER));
1231 }
1232
1233 static void
1234 gen6_mfc_batchbuffer_surfaces_output(VADriverContextP ctx,
1235                                      struct encode_state *encode_state,
1236                                      struct intel_encoder_context *encoder_context)
1237
1238 {
1239     struct i965_driver_data *i965 = i965_driver_data(ctx);
1240     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1241     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
1242     int width_in_mbs = pSequenceParameter->picture_width_in_mbs;
1243     int height_in_mbs = pSequenceParameter->picture_height_in_mbs;
1244     mfc_context->mfc_batchbuffer_surface.num_blocks = width_in_mbs * height_in_mbs + encode_state->num_slice_params_ext * 8 + 1;
1245     mfc_context->mfc_batchbuffer_surface.size_block = 16 * CMD_LEN_IN_OWORD; /* 3 OWORDs */
1246     mfc_context->mfc_batchbuffer_surface.pitch = 16;
1247     mfc_context->mfc_batchbuffer_surface.bo = dri_bo_alloc(i965->intel.bufmgr,
1248                                                            "MFC batchbuffer",
1249                                                            mfc_context->mfc_batchbuffer_surface.num_blocks * mfc_context->mfc_batchbuffer_surface.size_block,
1250                                                            0x1000);
1251     mfc_context->buffer_suface_setup(ctx,
1252                                      &mfc_context->gpe_context,
1253                                      &mfc_context->mfc_batchbuffer_surface,
1254                                      BINDING_TABLE_OFFSET(BIND_IDX_MFC_BATCHBUFFER),
1255                                      SURFACE_STATE_OFFSET(BIND_IDX_MFC_BATCHBUFFER));
1256 }
1257
1258 static void
1259 gen6_mfc_batchbuffer_surfaces_setup(VADriverContextP ctx,
1260                                     struct encode_state *encode_state,
1261                                     struct intel_encoder_context *encoder_context)
1262 {
1263     gen6_mfc_batchbuffer_surfaces_input(ctx, encode_state, encoder_context);
1264     gen6_mfc_batchbuffer_surfaces_output(ctx, encode_state, encoder_context);
1265 }
1266
1267 static void
1268 gen6_mfc_batchbuffer_idrt_setup(VADriverContextP ctx,
1269                                 struct encode_state *encode_state,
1270                                 struct intel_encoder_context *encoder_context)
1271 {
1272     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1273     struct gen6_interface_descriptor_data *desc;
1274     int i;
1275     dri_bo *bo;
1276
1277     bo = mfc_context->gpe_context.idrt.bo;
1278     dri_bo_map(bo, 1);
1279     assert(bo->virtual);
1280     desc = bo->virtual;
1281
1282     for (i = 0; i < mfc_context->gpe_context.num_kernels; i++) {
1283         struct i965_kernel *kernel;
1284
1285         kernel = &mfc_context->gpe_context.kernels[i];
1286         assert(sizeof(*desc) == 32);
1287
1288         /*Setup the descritor table*/
1289         memset(desc, 0, sizeof(*desc));
1290         desc->desc0.kernel_start_pointer = (kernel->bo->offset >> 6);
1291         desc->desc2.sampler_count = 0;
1292         desc->desc2.sampler_state_pointer = 0;
1293         desc->desc3.binding_table_entry_count = 2;
1294         desc->desc3.binding_table_pointer = (BINDING_TABLE_OFFSET(0) >> 5);
1295         desc->desc4.constant_urb_entry_read_offset = 0;
1296         desc->desc4.constant_urb_entry_read_length = 4;
1297
1298         /*kernel start*/
1299         dri_bo_emit_reloc(bo,
1300                           I915_GEM_DOMAIN_INSTRUCTION, 0,
1301                           0,
1302                           i * sizeof(*desc) + offsetof(struct gen6_interface_descriptor_data, desc0),
1303                           kernel->bo);
1304         desc++;
1305     }
1306
1307     dri_bo_unmap(bo);
1308 }
1309
1310 static void
1311 gen6_mfc_batchbuffer_constant_setup(VADriverContextP ctx,
1312                                     struct encode_state *encode_state,
1313                                     struct intel_encoder_context *encoder_context)
1314 {
1315     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1316
1317     (void)mfc_context;
1318 }
1319
1320 static void
1321 gen6_mfc_batchbuffer_emit_object_command(struct intel_batchbuffer *batch,
1322                                          int index,
1323                                          int head_offset,
1324                                          int batchbuffer_offset,
1325                                          int head_size,
1326                                          int tail_size,
1327                                          int number_mb_cmds,
1328                                          int first_object,
1329                                          int last_object,
1330                                          int last_slice,
1331                                          int mb_x,
1332                                          int mb_y,
1333                                          int width_in_mbs,
1334                                          int qp)
1335 {
1336     BEGIN_BATCH(batch, 12);
1337
1338     OUT_BATCH(batch, CMD_MEDIA_OBJECT | (12 - 2));
1339     OUT_BATCH(batch, index);
1340     OUT_BATCH(batch, 0);
1341     OUT_BATCH(batch, 0);
1342     OUT_BATCH(batch, 0);
1343     OUT_BATCH(batch, 0);
1344
1345     /*inline data */
1346     OUT_BATCH(batch, head_offset);
1347     OUT_BATCH(batch, batchbuffer_offset);
1348     OUT_BATCH(batch,
1349               head_size << 16 |
1350               tail_size);
1351     OUT_BATCH(batch,
1352               number_mb_cmds << 16 |
1353               first_object << 2 |
1354               last_object << 1 |
1355               last_slice);
1356     OUT_BATCH(batch,
1357               mb_y << 8 |
1358               mb_x);
1359     OUT_BATCH(batch,
1360               qp << 16 |
1361               width_in_mbs);
1362
1363     ADVANCE_BATCH(batch);
1364 }
1365
1366 static void
1367 gen6_mfc_avc_batchbuffer_slice_command(VADriverContextP ctx,
1368                                        struct intel_encoder_context *encoder_context,
1369                                        VAEncSliceParameterBufferH264 *slice_param,
1370                                        int head_offset,
1371                                        unsigned short head_size,
1372                                        unsigned short tail_size,
1373                                        int batchbuffer_offset,
1374                                        int qp,
1375                                        int last_slice)
1376 {
1377     struct intel_batchbuffer *batch = encoder_context->base.batch;
1378     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1379     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
1380     int total_mbs = slice_param->number_of_mbs;
1381     int number_mb_cmds = 128;
1382     int starting_mb = 0;
1383     int last_object = 0;
1384     int first_object = 1;
1385     int i;
1386     int mb_x, mb_y;
1387     int index = (slice_param->slice_type == SLICE_TYPE_I) ? MFC_BATCHBUFFER_AVC_INTRA : MFC_BATCHBUFFER_AVC_INTER;
1388
1389     for (i = 0; i < total_mbs / number_mb_cmds; i++) {
1390         last_object = (total_mbs - starting_mb) == number_mb_cmds;
1391         mb_x = (slice_param->starting_macroblock_address + starting_mb) % width_in_mbs;
1392         mb_y = (slice_param->starting_macroblock_address + starting_mb) / width_in_mbs;
1393         assert(mb_x <= 255 && mb_y <= 255);
1394
1395         starting_mb += number_mb_cmds;
1396
1397         gen6_mfc_batchbuffer_emit_object_command(batch,
1398                                                  index,
1399                                                  head_offset,
1400                                                  batchbuffer_offset,
1401                                                  head_size,
1402                                                  tail_size,
1403                                                  number_mb_cmds,
1404                                                  first_object,
1405                                                  last_object,
1406                                                  last_slice,
1407                                                  mb_x,
1408                                                  mb_y,
1409                                                  width_in_mbs,
1410                                                  qp);
1411
1412         if (first_object) {
1413             head_offset += head_size;
1414             batchbuffer_offset += head_size;
1415         }
1416
1417         if (last_object) {
1418             head_offset += tail_size;
1419             batchbuffer_offset += tail_size;
1420         }
1421
1422         batchbuffer_offset += number_mb_cmds * CMD_LEN_IN_OWORD;
1423
1424         first_object = 0;
1425     }
1426
1427     if (!last_object) {
1428         last_object = 1;
1429         number_mb_cmds = total_mbs % number_mb_cmds;
1430         mb_x = (slice_param->starting_macroblock_address + starting_mb) % width_in_mbs;
1431         mb_y = (slice_param->starting_macroblock_address + starting_mb) / width_in_mbs;
1432         assert(mb_x <= 255 && mb_y <= 255);
1433         starting_mb += number_mb_cmds;
1434
1435         gen6_mfc_batchbuffer_emit_object_command(batch,
1436                                                  index,
1437                                                  head_offset,
1438                                                  batchbuffer_offset,
1439                                                  head_size,
1440                                                  tail_size,
1441                                                  number_mb_cmds,
1442                                                  first_object,
1443                                                  last_object,
1444                                                  last_slice,
1445                                                  mb_x,
1446                                                  mb_y,
1447                                                  width_in_mbs,
1448                                                  qp);
1449     }
1450 }
1451
1452 /*
1453  * return size in Owords (16bytes)
1454  */
1455 static int
1456 gen6_mfc_avc_batchbuffer_slice(VADriverContextP ctx,
1457                                struct encode_state *encode_state,
1458                                struct intel_encoder_context *encoder_context,
1459                                int slice_index,
1460                                int batchbuffer_offset)
1461 {
1462     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1463     struct intel_batchbuffer *slice_batch = mfc_context->aux_batchbuffer;
1464     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
1465     VAEncPictureParameterBufferH264 *pPicParameter = (VAEncPictureParameterBufferH264 *)encode_state->pic_param_ext->buffer;
1466     VAEncSliceParameterBufferH264 *pSliceParameter = (VAEncSliceParameterBufferH264 *)encode_state->slice_params_ext[slice_index]->buffer;
1467     VAEncH264DecRefPicMarkingBuffer *pDecRefPicMarking = NULL;
1468     int is_intra = pSliceParameter->slice_type == SLICE_TYPE_I;
1469     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
1470     int height_in_mbs = (mfc_context->surface_state.height + 15) / 16;
1471     int last_slice = (pSliceParameter->starting_macroblock_address + pSliceParameter->number_of_mbs) == (width_in_mbs * height_in_mbs);
1472     int qp = pPicParameter->pic_init_qp + pSliceParameter->slice_qp_delta;
1473     int rate_control_mode = pSequenceParameter->rate_control_method;
1474     unsigned char *slice_header = NULL;
1475     int slice_header_length_in_bits = 0;
1476     unsigned int tail_data[] = { 0x0, 0x0 };
1477     long head_offset;
1478     int old_used = intel_batchbuffer_used_size(slice_batch), used;
1479     unsigned short head_size, tail_size;
1480
1481     head_offset = old_used / 16;
1482     gen6_mfc_avc_slice_state(ctx,
1483                              pSliceParameter,
1484                              encode_state,
1485                              encoder_context,
1486                              (rate_control_mode == 0),
1487                              qp,
1488                              slice_batch);
1489
1490     if (slice_index == 0)
1491         gen6_mfc_avc_pipeline_header_programing(ctx, encode_state, encoder_context, slice_batch);
1492
1493     if (encode_state->dec_ref_pic_marking)
1494         pDecRefPicMarking = (VAEncH264DecRefPicMarkingBuffer *)encode_state->dec_ref_pic_marking->buffer;
1495
1496     slice_header_length_in_bits = build_avc_slice_header(pSequenceParameter, pPicParameter, pSliceParameter, pDecRefPicMarking, &slice_header);
1497
1498     // slice hander
1499     mfc_context->insert_object(ctx,
1500                                encoder_context,
1501                                (unsigned int *)slice_header,
1502                                ALIGN(slice_header_length_in_bits, 32) >> 5,
1503                                slice_header_length_in_bits & 0x1f,
1504                                5,  /* first 5 bytes are start code + nal unit type */
1505                                1,
1506                                0,
1507                                1,
1508                                slice_batch);
1509     free(slice_header);
1510
1511     intel_batchbuffer_align(slice_batch, 16); /* aligned by an Oword */
1512     used = intel_batchbuffer_used_size(slice_batch);
1513     head_size = (used - old_used) / 16;
1514     old_used = used;
1515
1516     if (rate_control_mode == 0) {
1517         qp = mfc_context->bit_rate_control_context[1 - is_intra].QpPrimeY;
1518     }
1519
1520     /* tail */
1521     if (last_slice) {
1522         mfc_context->insert_object(ctx,
1523                                    encoder_context,
1524                                    tail_data,
1525                                    2,
1526                                    8,
1527                                    2,
1528                                    1,
1529                                    1,
1530                                    0,
1531                                    slice_batch);
1532     } else {
1533         mfc_context->insert_object(ctx,
1534                                    encoder_context,
1535                                    tail_data,
1536                                    1,
1537                                    8,
1538                                    1,
1539                                    1,
1540                                    1,
1541                                    0,
1542                                    slice_batch);
1543     }
1544
1545     intel_batchbuffer_align(slice_batch, 16); /* aligned by an Oword */
1546     used = intel_batchbuffer_used_size(slice_batch);
1547     tail_size = (used - old_used) / 16;
1548
1549
1550     gen6_mfc_avc_batchbuffer_slice_command(ctx,
1551                                            encoder_context,
1552                                            pSliceParameter,
1553                                            head_offset,
1554                                            head_size,
1555                                            tail_size,
1556                                            batchbuffer_offset,
1557                                            qp,
1558                                            last_slice);
1559
1560     return head_size + tail_size + pSliceParameter->number_of_mbs * CMD_LEN_IN_OWORD;
1561 }
1562
1563 static void
1564 gen6_mfc_avc_batchbuffer_pipeline(VADriverContextP ctx,
1565                                   struct encode_state *encode_state,
1566                                   struct intel_encoder_context *encoder_context)
1567 {
1568     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1569     struct intel_batchbuffer *batch = encoder_context->base.batch;
1570     int i, size, offset = 0;
1571     intel_batchbuffer_start_atomic(batch, 0x4000);
1572     gen6_gpe_pipeline_setup(ctx, &mfc_context->gpe_context, batch);
1573
1574     for ( i = 0; i < encode_state->num_slice_params_ext; i++) {
1575         size = gen6_mfc_avc_batchbuffer_slice(ctx, encode_state, encoder_context, i, offset);
1576         offset += size;
1577     }
1578
1579     intel_batchbuffer_end_atomic(batch);
1580     intel_batchbuffer_flush(batch);
1581 }
1582
1583 static void
1584 gen6_mfc_build_avc_batchbuffer(VADriverContextP ctx,
1585                                struct encode_state *encode_state,
1586                                struct intel_encoder_context *encoder_context)
1587 {
1588     gen6_mfc_batchbuffer_surfaces_setup(ctx, encode_state, encoder_context);
1589     gen6_mfc_batchbuffer_idrt_setup(ctx, encode_state, encoder_context);
1590     gen6_mfc_batchbuffer_constant_setup(ctx, encode_state, encoder_context);
1591     gen6_mfc_avc_batchbuffer_pipeline(ctx, encode_state, encoder_context);
1592 }
1593
1594 static dri_bo *
1595 gen6_mfc_avc_hardware_batchbuffer(VADriverContextP ctx,
1596                                   struct encode_state *encode_state,
1597                                   struct intel_encoder_context *encoder_context)
1598 {
1599     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1600
1601     gen6_mfc_build_avc_batchbuffer(ctx, encode_state, encoder_context);
1602     dri_bo_reference(mfc_context->mfc_batchbuffer_surface.bo);
1603
1604     return mfc_context->mfc_batchbuffer_surface.bo;
1605 }
1606
1607 #endif
1608
1609 static void
1610 gen6_mfc_avc_pipeline_programing(VADriverContextP ctx,
1611                                  struct encode_state *encode_state,
1612                                  struct intel_encoder_context *encoder_context)
1613 {
1614     struct intel_batchbuffer *batch = encoder_context->base.batch;
1615
1616 #if __SOFTWARE__
1617     dri_bo *slice_batch_bo = gen6_mfc_avc_software_batchbuffer(ctx, encode_state, encoder_context);
1618 #else
1619     dri_bo *slice_batch_bo = gen6_mfc_avc_hardware_batchbuffer(ctx, encode_state, encoder_context);
1620 #endif
1621
1622     // begin programing
1623     intel_batchbuffer_start_atomic_bcs(batch, 0x4000);
1624     intel_batchbuffer_emit_mi_flush(batch);
1625
1626     // picture level programing
1627     gen6_mfc_avc_pipeline_picture_programing(ctx, encode_state, encoder_context);
1628
1629     BEGIN_BCS_BATCH(batch, 2);
1630     OUT_BCS_BATCH(batch, MI_BATCH_BUFFER_START | (1 << 8));
1631     OUT_BCS_RELOC(batch,
1632                   slice_batch_bo,
1633                   I915_GEM_DOMAIN_COMMAND, 0,
1634                   0);
1635     ADVANCE_BCS_BATCH(batch);
1636
1637     // end programing
1638     intel_batchbuffer_end_atomic(batch);
1639
1640     dri_bo_unreference(slice_batch_bo);
1641 }
1642
1643 static VAStatus
1644 gen6_mfc_avc_encode_picture(VADriverContextP ctx,
1645                             struct encode_state *encode_state,
1646                             struct intel_encoder_context *encoder_context)
1647 {
1648     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
1649     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1650     int rate_control_mode = pSequenceParameter->rate_control_method;
1651     int MAX_CBR_INTERATE = 4;
1652     int current_frame_bits_size;
1653     int i;
1654
1655     for(i = 0; i < MAX_CBR_INTERATE; i++) {
1656         gen6_mfc_init(ctx, encoder_context);
1657         gen6_mfc_avc_prepare(ctx, encode_state, encoder_context);
1658         /*Programing bcs pipeline*/
1659         gen6_mfc_avc_pipeline_programing(ctx, encode_state, encoder_context);   //filling the pipeline
1660         gen6_mfc_run(ctx, encode_state, encoder_context);
1661         gen6_mfc_stop(ctx, encode_state, encoder_context, &current_frame_bits_size);
1662         if ( rate_control_mode == 0) {
1663             //gen6_mfc_hrd_context_check(encode_state, mfc_context);
1664             if ( gen6_mfc_bit_rate_control_context_update( encode_state, mfc_context, current_frame_bits_size) ) {
1665                 gen6_mfc_hrd_context_update(encode_state, mfc_context);
1666                 break;
1667             }
1668         } else {
1669             break;
1670         }
1671     }
1672
1673     return VA_STATUS_SUCCESS;
1674 }
1675
1676 VAStatus
1677 gen6_mfc_pipeline(VADriverContextP ctx,
1678                   VAProfile profile,
1679                   struct encode_state *encode_state,
1680                   struct intel_encoder_context *encoder_context)
1681 {
1682     VAStatus vaStatus;
1683
1684     switch (profile) {
1685     case VAProfileH264Baseline:
1686         vaStatus = gen6_mfc_avc_encode_picture(ctx, encode_state, encoder_context);
1687         break;
1688
1689         /* FIXME: add for other profile */
1690     default:
1691         vaStatus = VA_STATUS_ERROR_UNSUPPORTED_PROFILE;
1692         break;
1693     }
1694
1695     return vaStatus;
1696 }
1697
1698 void
1699 gen6_mfc_context_destroy(void *context)
1700 {
1701     struct gen6_mfc_context *mfc_context = context;
1702     int i;
1703
1704     dri_bo_unreference(mfc_context->post_deblocking_output.bo);
1705     mfc_context->post_deblocking_output.bo = NULL;
1706
1707     dri_bo_unreference(mfc_context->pre_deblocking_output.bo);
1708     mfc_context->pre_deblocking_output.bo = NULL;
1709
1710     dri_bo_unreference(mfc_context->uncompressed_picture_source.bo);
1711     mfc_context->uncompressed_picture_source.bo = NULL;
1712
1713     dri_bo_unreference(mfc_context->mfc_indirect_pak_bse_object.bo);
1714     mfc_context->mfc_indirect_pak_bse_object.bo = NULL;
1715
1716     for (i = 0; i < NUM_MFC_DMV_BUFFERS; i++){
1717         dri_bo_unreference(mfc_context->direct_mv_buffers[i].bo);
1718         mfc_context->direct_mv_buffers[i].bo = NULL;
1719     }
1720
1721     dri_bo_unreference(mfc_context->intra_row_store_scratch_buffer.bo);
1722     mfc_context->intra_row_store_scratch_buffer.bo = NULL;
1723
1724     dri_bo_unreference(mfc_context->macroblock_status_buffer.bo);
1725     mfc_context->macroblock_status_buffer.bo = NULL;
1726
1727     dri_bo_unreference(mfc_context->deblocking_filter_row_store_scratch_buffer.bo);
1728     mfc_context->deblocking_filter_row_store_scratch_buffer.bo = NULL;
1729
1730     dri_bo_unreference(mfc_context->bsd_mpc_row_store_scratch_buffer.bo);
1731     mfc_context->bsd_mpc_row_store_scratch_buffer.bo = NULL;
1732
1733
1734     for (i = 0; i < MAX_MFC_REFERENCE_SURFACES; i++){
1735         dri_bo_unreference(mfc_context->reference_surfaces[i].bo);
1736         mfc_context->reference_surfaces[i].bo = NULL;
1737     }
1738
1739     i965_gpe_context_destroy(&mfc_context->gpe_context);
1740
1741     dri_bo_unreference(mfc_context->mfc_batchbuffer_surface.bo);
1742     mfc_context->mfc_batchbuffer_surface.bo = NULL;
1743
1744     dri_bo_unreference(mfc_context->aux_batchbuffer_surface.bo);
1745     mfc_context->aux_batchbuffer_surface.bo = NULL;
1746
1747     if (mfc_context->aux_batchbuffer)
1748         intel_batchbuffer_free(mfc_context->aux_batchbuffer);
1749
1750     mfc_context->aux_batchbuffer = NULL;
1751
1752     free(mfc_context);
1753 }
1754
1755 Bool gen6_mfc_context_init(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
1756 {
1757     struct gen6_mfc_context *mfc_context = calloc(1, sizeof(struct gen6_mfc_context));
1758
1759     mfc_context->gpe_context.surface_state_binding_table.length = (SURFACE_STATE_PADDED_SIZE + sizeof(unsigned int)) * MAX_MEDIA_SURFACES_GEN6;
1760
1761     mfc_context->gpe_context.idrt.max_entries = MAX_GPE_KERNELS;
1762     mfc_context->gpe_context.idrt.entry_size = sizeof(struct gen6_interface_descriptor_data);
1763
1764     mfc_context->gpe_context.curbe.length = 32 * 4;
1765
1766     mfc_context->gpe_context.vfe_state.max_num_threads = 60 - 1;
1767     mfc_context->gpe_context.vfe_state.num_urb_entries = 16;
1768     mfc_context->gpe_context.vfe_state.gpgpu_mode = 0;
1769     mfc_context->gpe_context.vfe_state.urb_entry_size = 59 - 1;
1770     mfc_context->gpe_context.vfe_state.curbe_allocation_size = 37 - 1;
1771
1772     i965_gpe_load_kernels(ctx,
1773                           &mfc_context->gpe_context,
1774                           gen6_mfc_kernels,
1775                           NUM_MFC_KERNEL);
1776
1777     mfc_context->pipe_mode_select = gen6_mfc_pipe_mode_select;
1778     mfc_context->set_surface_state = gen6_mfc_surface_state;
1779     mfc_context->ind_obj_base_addr_state = gen6_mfc_ind_obj_base_addr_state;
1780     mfc_context->avc_img_state = gen6_mfc_avc_img_state;
1781     mfc_context->avc_qm_state = gen6_mfc_avc_qm_state;
1782     mfc_context->avc_fqm_state = gen6_mfc_avc_fqm_state;
1783     mfc_context->insert_object = gen6_mfc_avc_insert_object;
1784     mfc_context->buffer_suface_setup = i965_gpe_buffer_suface_setup;
1785
1786     encoder_context->mfc_context = mfc_context;
1787     encoder_context->mfc_context_destroy = gen6_mfc_context_destroy;
1788     encoder_context->mfc_pipeline = gen6_mfc_pipeline;
1789
1790     return True;
1791 }