H264_encoding: Don't update the slice qp for CBR mode when finding packed slice_heade...
[platform/upstream/libva-intel-driver.git] / 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 #include <math.h>
34
35 #include "intel_batchbuffer.h"
36 #include "i965_defines.h"
37 #include "i965_structs.h"
38 #include "i965_drv_video.h"
39 #include "i965_encoder.h"
40 #include "i965_encoder_utils.h"
41 #include "gen6_mfc.h"
42 #include "gen6_vme.h"
43 #include "intel_media.h"
44
45 #define SURFACE_STATE_PADDED_SIZE               MAX(SURFACE_STATE_PADDED_SIZE_GEN6, SURFACE_STATE_PADDED_SIZE_GEN7)
46 #define SURFACE_STATE_OFFSET(index)             (SURFACE_STATE_PADDED_SIZE * index)
47 #define BINDING_TABLE_OFFSET(index)             (SURFACE_STATE_OFFSET(MAX_MEDIA_SURFACES_GEN6) + sizeof(unsigned int) * index)
48
49 static const uint32_t gen6_mfc_batchbuffer_avc_intra[][4] = {
50 #include "shaders/utils/mfc_batchbuffer_avc_intra.g6b"
51 };
52
53 static const uint32_t gen6_mfc_batchbuffer_avc_inter[][4] = {
54 #include "shaders/utils/mfc_batchbuffer_avc_inter.g6b"
55 };
56
57 static struct i965_kernel gen6_mfc_kernels[] = {
58     {
59         "MFC AVC INTRA BATCHBUFFER ",
60         MFC_BATCHBUFFER_AVC_INTRA,
61         gen6_mfc_batchbuffer_avc_intra,
62         sizeof(gen6_mfc_batchbuffer_avc_intra),
63         NULL
64     },
65
66     {
67         "MFC AVC INTER BATCHBUFFER ",
68         MFC_BATCHBUFFER_AVC_INTER,
69         gen6_mfc_batchbuffer_avc_inter,
70         sizeof(gen6_mfc_batchbuffer_avc_inter),
71         NULL
72     },
73 };
74
75 static void
76 gen6_mfc_pipe_mode_select(VADriverContextP ctx,
77                           int standard_select,
78                           struct intel_encoder_context *encoder_context)
79 {
80     struct intel_batchbuffer *batch = encoder_context->base.batch;
81     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
82
83     assert(standard_select == MFX_FORMAT_AVC);
84
85     BEGIN_BCS_BATCH(batch, 4);
86
87     OUT_BCS_BATCH(batch, MFX_PIPE_MODE_SELECT | (4 - 2));
88     OUT_BCS_BATCH(batch,
89                   (1 << 10) | /* disable Stream-Out , advanced QP/bitrate control need enable it*/
90                   ((!!mfc_context->post_deblocking_output.bo) << 9)  | /* Post Deblocking Output */
91                   ((!!mfc_context->pre_deblocking_output.bo) << 8)  | /* Pre Deblocking Output */
92                   (0 << 7)  | /* disable TLB prefectch */
93                   (0 << 5)  | /* not in stitch mode */
94                   (1 << 4)  | /* encoding mode */
95                   (2 << 0));  /* Standard Select: AVC */
96     OUT_BCS_BATCH(batch,
97                   (0 << 20) | /* round flag in PB slice */
98                   (0 << 19) | /* round flag in Intra8x8 */
99                   (0 << 7)  | /* expand NOA bus flag */
100                   (1 << 6)  | /* must be 1 */
101                   (0 << 5)  | /* disable clock gating for NOA */
102                   (0 << 4)  | /* terminate if AVC motion and POC table error occurs */
103                   (0 << 3)  | /* terminate if AVC mbdata error occurs */
104                   (0 << 2)  | /* terminate if AVC CABAC/CAVLC decode error occurs */
105                   (0 << 1)  | /* AVC long field motion vector */
106                   (0 << 0));  /* always calculate AVC ILDB boundary strength */
107     OUT_BCS_BATCH(batch, 0);
108
109     ADVANCE_BCS_BATCH(batch);
110 }
111
112 static void
113 gen6_mfc_surface_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
114 {
115     struct intel_batchbuffer *batch = encoder_context->base.batch;
116     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
117
118     BEGIN_BCS_BATCH(batch, 6);
119
120     OUT_BCS_BATCH(batch, MFX_SURFACE_STATE | (6 - 2));
121     OUT_BCS_BATCH(batch, 0);
122     OUT_BCS_BATCH(batch,
123                   ((mfc_context->surface_state.height - 1) << 19) |
124                   ((mfc_context->surface_state.width - 1) << 6));
125     OUT_BCS_BATCH(batch,
126                   (MFX_SURFACE_PLANAR_420_8 << 28) | /* 420 planar YUV surface */
127                   (1 << 27) | /* must be 1 for interleave U/V, hardware requirement */
128                   (0 << 22) | /* surface object control state, FIXME??? */
129                   ((mfc_context->surface_state.w_pitch - 1) << 3) | /* pitch */
130                   (0 << 2)  | /* must be 0 for interleave U/V */
131                   (1 << 1)  | /* must be y-tiled */
132                   (I965_TILEWALK_YMAJOR << 0));                         /* tile walk, TILEWALK_YMAJOR */
133     OUT_BCS_BATCH(batch,
134                   (0 << 16) |                                                           /* must be 0 for interleave U/V */
135                   (mfc_context->surface_state.h_pitch));                /* y offset for U(cb) */
136     OUT_BCS_BATCH(batch, 0);
137     ADVANCE_BCS_BATCH(batch);
138 }
139
140 void
141 gen6_mfc_pipe_buf_addr_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
142 {
143     struct intel_batchbuffer *batch = encoder_context->base.batch;
144     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
145     int i;
146
147     BEGIN_BCS_BATCH(batch, 24);
148
149     OUT_BCS_BATCH(batch, MFX_PIPE_BUF_ADDR_STATE | (24 - 2));
150
151     if (mfc_context->pre_deblocking_output.bo)
152         OUT_BCS_RELOC(batch, mfc_context->pre_deblocking_output.bo,
153                       I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
154                       0);
155     else
156         OUT_BCS_BATCH(batch, 0);                                                                                        /* pre output addr   */
157
158     if (mfc_context->post_deblocking_output.bo)
159         OUT_BCS_RELOC(batch, mfc_context->post_deblocking_output.bo,
160                       I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
161                       0);                                                                                       /* post output addr  */ 
162     else
163         OUT_BCS_BATCH(batch, 0);
164
165     OUT_BCS_RELOC(batch, mfc_context->uncompressed_picture_source.bo,
166                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
167                   0);                                                                                   /* uncompressed data */
168     OUT_BCS_RELOC(batch, mfc_context->macroblock_status_buffer.bo,
169                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
170                   0);                                                                                   /* StreamOut data*/
171     OUT_BCS_RELOC(batch, mfc_context->intra_row_store_scratch_buffer.bo,
172                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
173                   0);   
174     OUT_BCS_RELOC(batch, mfc_context->deblocking_filter_row_store_scratch_buffer.bo,
175                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
176                   0);
177     /* 7..22 Reference pictures*/
178     for (i = 0; i < ARRAY_ELEMS(mfc_context->reference_surfaces); i++) {
179         if ( mfc_context->reference_surfaces[i].bo != NULL) {
180             OUT_BCS_RELOC(batch, mfc_context->reference_surfaces[i].bo,
181                           I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
182                           0);                   
183         } else {
184             OUT_BCS_BATCH(batch, 0);
185         }
186     }
187     OUT_BCS_RELOC(batch, mfc_context->macroblock_status_buffer.bo,
188                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
189                   0);                                                                                   /* Macroblock status buffer*/
190
191     ADVANCE_BCS_BATCH(batch);
192 }
193
194 static void
195 gen6_mfc_ind_obj_base_addr_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
196 {
197     struct intel_batchbuffer *batch = encoder_context->base.batch;
198     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
199     struct gen6_vme_context *vme_context = encoder_context->vme_context;
200
201     BEGIN_BCS_BATCH(batch, 11);
202
203     OUT_BCS_BATCH(batch, MFX_IND_OBJ_BASE_ADDR_STATE | (11 - 2));
204     OUT_BCS_BATCH(batch, 0);
205     OUT_BCS_BATCH(batch, 0);
206     /* MFX Indirect MV Object Base Address */
207     OUT_BCS_RELOC(batch, vme_context->vme_output.bo, I915_GEM_DOMAIN_INSTRUCTION, 0, 0);
208     OUT_BCS_BATCH(batch, 0);    
209     OUT_BCS_BATCH(batch, 0);
210     OUT_BCS_BATCH(batch, 0);
211     OUT_BCS_BATCH(batch, 0);
212     OUT_BCS_BATCH(batch, 0);
213     /*MFC Indirect PAK-BSE Object Base Address for Encoder*/    
214     OUT_BCS_RELOC(batch,
215                   mfc_context->mfc_indirect_pak_bse_object.bo,
216                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
217                   0);
218     OUT_BCS_RELOC(batch,
219                   mfc_context->mfc_indirect_pak_bse_object.bo,
220                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
221                   mfc_context->mfc_indirect_pak_bse_object.end_offset);
222
223     ADVANCE_BCS_BATCH(batch);
224 }
225
226 void
227 gen6_mfc_bsp_buf_base_addr_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
228 {
229     struct intel_batchbuffer *batch = encoder_context->base.batch;
230     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
231
232     BEGIN_BCS_BATCH(batch, 4);
233
234     OUT_BCS_BATCH(batch, MFX_BSP_BUF_BASE_ADDR_STATE | (4 - 2));
235     OUT_BCS_RELOC(batch, mfc_context->bsd_mpc_row_store_scratch_buffer.bo,
236                   I915_GEM_DOMAIN_INSTRUCTION, I915_GEM_DOMAIN_INSTRUCTION,
237                   0);
238     OUT_BCS_BATCH(batch, 0);
239     OUT_BCS_BATCH(batch, 0);
240
241     ADVANCE_BCS_BATCH(batch);
242 }
243
244 static void
245 gen6_mfc_avc_img_state(VADriverContextP ctx,struct encode_state *encode_state,
246                        struct intel_encoder_context *encoder_context)
247 {
248     struct intel_batchbuffer *batch = encoder_context->base.batch;
249     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
250     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
251     VAEncPictureParameterBufferH264 *pPicParameter = (VAEncPictureParameterBufferH264 *)encode_state->pic_param_ext->buffer;
252     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
253     int height_in_mbs = (mfc_context->surface_state.height + 15) / 16;
254
255     BEGIN_BCS_BATCH(batch, 13);
256     OUT_BCS_BATCH(batch, MFX_AVC_IMG_STATE | (13 - 2));
257     OUT_BCS_BATCH(batch, 
258                   ((width_in_mbs * height_in_mbs) & 0xFFFF));
259     OUT_BCS_BATCH(batch, 
260                   (height_in_mbs << 16) | 
261                   (width_in_mbs << 0));
262     OUT_BCS_BATCH(batch, 
263                   (0 << 24) |     /*Second Chroma QP Offset*/
264                   (0 << 16) |     /*Chroma QP Offset*/
265                   (0 << 14) |   /*Max-bit conformance Intra flag*/
266                   (0 << 13) |   /*Max Macroblock size conformance Inter flag*/
267                   (1 << 12) |   /*Should always be written as "1" */
268                   (0 << 10) |   /*QM Preset FLag */
269                   (0 << 8)  |   /*Image Structure*/
270                   (0 << 0) );   /*Current Decoed Image Frame Store ID, reserved in Encode mode*/
271     OUT_BCS_BATCH(batch,
272                   (400 << 16) |   /*Mininum Frame size*/        
273                   (0 << 15) |   /*Disable reading of Macroblock Status Buffer*/
274                   (0 << 14) |   /*Load BitStream Pointer only once, 1 slic 1 frame*/
275                   (0 << 13) |   /*CABAC 0 word insertion test enable*/
276                   (1 << 12) |   /*MVUnpackedEnable,compliant to DXVA*/
277                   (1 << 10) |   /*Chroma Format IDC, 4:2:0*/
278                   (pPicParameter->pic_fields.bits.entropy_coding_mode_flag << 7)  |   /*0:CAVLC encoding mode,1:CABAC*/
279                   (0 << 6)  |   /*Only valid for VLD decoding mode*/
280                   (0 << 5)  |   /*Constrained Intra Predition Flag, from PPS*/
281                   (pSequenceParameter->seq_fields.bits.direct_8x8_inference_flag << 4)  |   /*Direct 8x8 inference flag*/
282                   (pPicParameter->pic_fields.bits.transform_8x8_mode_flag << 3)  |   /*8x8 or 4x4 IDCT Transform Mode Flag*/
283                   (1 << 2)  |   /*Frame MB only flag*/
284                   (0 << 1)  |   /*MBAFF mode is in active*/
285                   (0 << 0) );   /*Field picture flag*/
286     OUT_BCS_BATCH(batch, 
287                   (1<<16)   |   /*Frame Size Rate Control Flag*/  
288                   (1<<12)   |   
289                   (1<<9)    |   /*MB level Rate Control Enabling Flag*/
290                   (1 << 3)  |   /*FrameBitRateMinReportMask*/
291                   (1 << 2)  |   /*FrameBitRateMaxReportMask*/
292                   (1 << 1)  |   /*InterMBMaxSizeReportMask*/
293                   (1 << 0) );   /*IntraMBMaxSizeReportMask*/
294     OUT_BCS_BATCH(batch,                        /*Inter and Intra Conformance Max size limit*/
295                   (0x0600 << 16) |              /*InterMbMaxSz 192 Byte*/
296                   (0x0800) );                   /*IntraMbMaxSz 256 Byte*/
297     OUT_BCS_BATCH(batch, 0x00000000);   /*Reserved : MBZReserved*/
298     OUT_BCS_BATCH(batch, 0x01020304);   /*Slice QP Delta for bitrate control*/                  
299     OUT_BCS_BATCH(batch, 0xFEFDFCFB);           
300     OUT_BCS_BATCH(batch, 0x80601004);   /*MAX = 128KB, MIN = 64KB*/
301     OUT_BCS_BATCH(batch, 0x00800001);   
302     OUT_BCS_BATCH(batch, 0);
303
304     ADVANCE_BCS_BATCH(batch);
305 }
306
307 static void
308 gen6_mfc_avc_directmode_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
309 {
310     struct intel_batchbuffer *batch = encoder_context->base.batch;
311     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
312
313     int i;
314
315     BEGIN_BCS_BATCH(batch, 69);
316
317     OUT_BCS_BATCH(batch, MFX_AVC_DIRECTMODE_STATE | (69 - 2));
318
319     /* Reference frames and Current frames */
320     for(i = 0; i < NUM_MFC_DMV_BUFFERS; i++) {
321         if ( mfc_context->direct_mv_buffers[i].bo != NULL) { 
322             OUT_BCS_RELOC(batch, mfc_context->direct_mv_buffers[i].bo,
323                           I915_GEM_DOMAIN_INSTRUCTION, 0,
324                           0);
325         } else {
326             OUT_BCS_BATCH(batch, 0);
327         }
328     }
329
330     /* POL list */
331     for(i = 0; i < 32; i++) {
332         OUT_BCS_BATCH(batch, i/2);
333     }
334     OUT_BCS_BATCH(batch, 0);
335     OUT_BCS_BATCH(batch, 0);
336
337     ADVANCE_BCS_BATCH(batch);
338 }
339
340 static void
341 gen6_mfc_avc_slice_state(VADriverContextP ctx,
342                          VAEncPictureParameterBufferH264 *pic_param,
343                          VAEncSliceParameterBufferH264 *slice_param,
344                          struct encode_state *encode_state,
345                          struct intel_encoder_context *encoder_context,
346                          int rate_control_enable,
347                          int qp,
348                          struct intel_batchbuffer *batch)
349 {
350     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
351     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
352     int height_in_mbs = (mfc_context->surface_state.height + 15) / 16;
353     int beginmb = slice_param->macroblock_address;
354     int endmb = beginmb + slice_param->num_macroblocks;
355     int beginx = beginmb % width_in_mbs;
356     int beginy = beginmb / width_in_mbs;
357     int nextx =  endmb % width_in_mbs;
358     int nexty = endmb / width_in_mbs;
359     int slice_type = intel_avc_enc_slice_type_fixup(slice_param->slice_type);
360     int last_slice = (endmb == (width_in_mbs * height_in_mbs));
361     int maxQpN, maxQpP;
362     unsigned char correct[6], grow, shrink;
363     int i;
364     int weighted_pred_idc = 0;
365     unsigned int luma_log2_weight_denom = slice_param->luma_log2_weight_denom;
366     unsigned int chroma_log2_weight_denom = slice_param->chroma_log2_weight_denom;
367     int num_ref_l0 = 0, num_ref_l1 = 0;
368
369     if (batch == NULL)
370         batch = encoder_context->base.batch;
371
372     if (slice_type == SLICE_TYPE_I) {
373         luma_log2_weight_denom = 0;
374         chroma_log2_weight_denom = 0;
375     } else if (slice_type == SLICE_TYPE_P) {
376         weighted_pred_idc = pic_param->pic_fields.bits.weighted_pred_flag;
377         num_ref_l0 = pic_param->num_ref_idx_l0_active_minus1 + 1;
378
379         if (slice_param->num_ref_idx_active_override_flag)
380             num_ref_l0 = slice_param->num_ref_idx_l0_active_minus1 + 1;
381     } else if (slice_type == SLICE_TYPE_B) {
382         weighted_pred_idc = pic_param->pic_fields.bits.weighted_bipred_idc;
383         num_ref_l0 = pic_param->num_ref_idx_l0_active_minus1 + 1;
384         num_ref_l1 = pic_param->num_ref_idx_l1_active_minus1 + 1;
385
386         if (slice_param->num_ref_idx_active_override_flag) {
387             num_ref_l0 = slice_param->num_ref_idx_l0_active_minus1 + 1;
388             num_ref_l1 = slice_param->num_ref_idx_l1_active_minus1 + 1;
389         }
390
391         if (weighted_pred_idc == 2) {
392             /* 8.4.3 - Derivation process for prediction weights (8-279) */
393             luma_log2_weight_denom = 5;
394             chroma_log2_weight_denom = 5;
395         }
396     }
397
398     maxQpN = mfc_context->bit_rate_control_context[slice_type].MaxQpNegModifier;
399     maxQpP = mfc_context->bit_rate_control_context[slice_type].MaxQpPosModifier;
400
401     for (i = 0; i < 6; i++)
402         correct[i] = mfc_context->bit_rate_control_context[slice_type].Correct[i];
403
404     grow = mfc_context->bit_rate_control_context[slice_type].GrowInit + 
405         (mfc_context->bit_rate_control_context[slice_type].GrowResistance << 4);
406     shrink = mfc_context->bit_rate_control_context[slice_type].ShrinkInit + 
407         (mfc_context->bit_rate_control_context[slice_type].ShrinkResistance << 4);
408
409     BEGIN_BCS_BATCH(batch, 11);;
410
411     OUT_BCS_BATCH(batch, MFX_AVC_SLICE_STATE | (11 - 2) );
412     OUT_BCS_BATCH(batch, slice_type);                   /*Slice Type: I:P:B Slice*/
413
414     OUT_BCS_BATCH(batch,
415                   (num_ref_l0 << 16) |
416                   (num_ref_l1 << 24) |
417                   (chroma_log2_weight_denom << 8) |
418                   (luma_log2_weight_denom << 0));
419
420     OUT_BCS_BATCH(batch, 
421                   (weighted_pred_idc << 30) |
422                   (slice_param->direct_spatial_mv_pred_flag<<29) |             /*Direct Prediction Type*/
423                   (slice_param->disable_deblocking_filter_idc << 27) |
424                   (slice_param->cabac_init_idc << 24) |
425                   (qp<<16) |                    /*Slice Quantization Parameter*/
426                   ((slice_param->slice_beta_offset_div2 & 0xf) << 8) |
427                   ((slice_param->slice_alpha_c0_offset_div2 & 0xf) << 0));
428     OUT_BCS_BATCH(batch,
429                   (beginy << 24) |                      /*First MB X&Y , the begin postion of current slice*/
430                   (beginx << 16) |
431                   slice_param->macroblock_address );
432     OUT_BCS_BATCH(batch, (nexty << 16) | nextx);                       /*Next slice first MB X&Y*/
433     OUT_BCS_BATCH(batch, 
434                   (0/*rate_control_enable*/ << 31) |            /*in CBR mode RateControlCounterEnable = enable*/
435                   (1 << 30) |           /*ResetRateControlCounter*/
436                   (0 << 28) |           /*RC Triggle Mode = Always Rate Control*/
437                   (4 << 24) |     /*RC Stable Tolerance, middle level*/
438                   (0/*rate_control_enable*/ << 23) |     /*RC Panic Enable*/                 
439                   (0 << 22) |     /*QP mode, don't modfiy CBP*/
440                   (0 << 21) |     /*MB Type Direct Conversion Enabled*/ 
441                   (0 << 20) |     /*MB Type Skip Conversion Enabled*/ 
442                   (last_slice << 19) |     /*IsLastSlice*/
443                   (0 << 18) |   /*BitstreamOutputFlag Compressed BitStream Output Disable Flag 0:enable 1:disable*/
444                   (1 << 17) |       /*HeaderPresentFlag*/       
445                   (1 << 16) |       /*SliceData PresentFlag*/
446                   (1 << 15) |       /*TailPresentFlag*/
447                   (1 << 13) |       /*RBSP NAL TYPE*/   
448                   (0 << 12) );    /*CabacZeroWordInsertionEnable*/
449     OUT_BCS_BATCH(batch, mfc_context->mfc_indirect_pak_bse_object.offset);
450     OUT_BCS_BATCH(batch,
451                   (maxQpN << 24) |     /*Target QP - 24 is lowest QP*/ 
452                   (maxQpP << 16) |     /*Target QP + 20 is highest QP*/
453                   (shrink << 8)  |
454                   (grow << 0));   
455     OUT_BCS_BATCH(batch,
456                   (correct[5] << 20) |
457                   (correct[4] << 16) |
458                   (correct[3] << 12) |
459                   (correct[2] << 8) |
460                   (correct[1] << 4) |
461                   (correct[0] << 0));
462     OUT_BCS_BATCH(batch, 0);
463
464     ADVANCE_BCS_BATCH(batch);
465 }
466
467 static void gen6_mfc_avc_qm_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
468 {
469     struct intel_batchbuffer *batch = encoder_context->base.batch;
470     int i;
471
472     BEGIN_BCS_BATCH(batch, 58);
473
474     OUT_BCS_BATCH(batch, MFX_AVC_QM_STATE | 56);
475     OUT_BCS_BATCH(batch, 0xFF ) ; 
476     for( i = 0; i < 56; i++) {
477         OUT_BCS_BATCH(batch, 0x10101010); 
478     }   
479
480     ADVANCE_BCS_BATCH(batch);
481 }
482
483 static void gen6_mfc_avc_fqm_state(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
484 {
485     struct intel_batchbuffer *batch = encoder_context->base.batch;
486     int i;
487
488     BEGIN_BCS_BATCH(batch, 113);
489     OUT_BCS_BATCH(batch, MFC_AVC_FQM_STATE | (113 - 2));
490
491     for(i = 0; i < 112;i++) {
492         OUT_BCS_BATCH(batch, 0x10001000);
493     }   
494
495     ADVANCE_BCS_BATCH(batch);   
496 }
497
498 static void
499 gen6_mfc_avc_insert_object(VADriverContextP ctx, struct intel_encoder_context *encoder_context,
500                            unsigned int *insert_data, int lenght_in_dws, int data_bits_in_last_dw,
501                            int skip_emul_byte_count, int is_last_header, int is_end_of_slice, int emulation_flag,
502                            struct intel_batchbuffer *batch)
503 {
504     if (batch == NULL)
505         batch = encoder_context->base.batch;
506
507     BEGIN_BCS_BATCH(batch, lenght_in_dws + 2);
508
509     OUT_BCS_BATCH(batch, MFC_AVC_INSERT_OBJECT | (lenght_in_dws + 2 - 2));
510
511     OUT_BCS_BATCH(batch,
512                   (0 << 16) |   /* always start at offset 0 */
513                   (data_bits_in_last_dw << 8) |
514                   (skip_emul_byte_count << 4) |
515                   (!!emulation_flag << 3) |
516                   ((!!is_last_header) << 2) |
517                   ((!!is_end_of_slice) << 1) |
518                   (0 << 0));    /* FIXME: ??? */
519
520     intel_batchbuffer_data(batch, insert_data, lenght_in_dws * 4);
521     ADVANCE_BCS_BATCH(batch);
522 }
523
524 void 
525 gen6_mfc_init(VADriverContextP ctx, 
526               struct encode_state *encode_state,
527               struct intel_encoder_context *encoder_context)
528 {
529     struct i965_driver_data *i965 = i965_driver_data(ctx);
530     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
531     dri_bo *bo;
532     int i;
533     int width_in_mbs = 0;
534     int height_in_mbs = 0;
535     int slice_batchbuffer_size;
536
537     if (encoder_context->codec == CODEC_H264) {
538         VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
539         width_in_mbs = pSequenceParameter->picture_width_in_mbs;
540         height_in_mbs = pSequenceParameter->picture_height_in_mbs;
541     } else {
542         VAEncSequenceParameterBufferMPEG2 *pSequenceParameter = (VAEncSequenceParameterBufferMPEG2 *)encode_state->seq_param_ext->buffer;
543
544         assert(encoder_context->codec == CODEC_MPEG2);
545
546         width_in_mbs = ALIGN(pSequenceParameter->picture_width, 16) / 16;
547         height_in_mbs = ALIGN(pSequenceParameter->picture_height, 16) / 16;
548     }
549
550     slice_batchbuffer_size = 64 * width_in_mbs * height_in_mbs + 4096 +
551                 (SLICE_HEADER + SLICE_TAIL) * encode_state->num_slice_params_ext;
552
553     /*Encode common setup for MFC*/
554     dri_bo_unreference(mfc_context->post_deblocking_output.bo);
555     mfc_context->post_deblocking_output.bo = NULL;
556
557     dri_bo_unreference(mfc_context->pre_deblocking_output.bo);
558     mfc_context->pre_deblocking_output.bo = NULL;
559
560     dri_bo_unreference(mfc_context->uncompressed_picture_source.bo);
561     mfc_context->uncompressed_picture_source.bo = NULL;
562
563     dri_bo_unreference(mfc_context->mfc_indirect_pak_bse_object.bo); 
564     mfc_context->mfc_indirect_pak_bse_object.bo = NULL;
565
566     for (i = 0; i < NUM_MFC_DMV_BUFFERS; i++){
567         if ( mfc_context->direct_mv_buffers[i].bo != NULL);
568         dri_bo_unreference(mfc_context->direct_mv_buffers[i].bo);
569         mfc_context->direct_mv_buffers[i].bo = NULL;
570     }
571
572     for (i = 0; i < MAX_MFC_REFERENCE_SURFACES; i++){
573         if (mfc_context->reference_surfaces[i].bo != NULL)
574             dri_bo_unreference(mfc_context->reference_surfaces[i].bo);
575         mfc_context->reference_surfaces[i].bo = NULL;  
576     }
577
578     dri_bo_unreference(mfc_context->intra_row_store_scratch_buffer.bo);
579     bo = dri_bo_alloc(i965->intel.bufmgr,
580                       "Buffer",
581                       width_in_mbs * 64,
582                       64);
583     assert(bo);
584     mfc_context->intra_row_store_scratch_buffer.bo = bo;
585
586     dri_bo_unreference(mfc_context->macroblock_status_buffer.bo);
587     bo = dri_bo_alloc(i965->intel.bufmgr,
588                       "Buffer",
589                       width_in_mbs * height_in_mbs * 16,
590                       64);
591     assert(bo);
592     mfc_context->macroblock_status_buffer.bo = bo;
593
594     dri_bo_unreference(mfc_context->deblocking_filter_row_store_scratch_buffer.bo);
595     bo = dri_bo_alloc(i965->intel.bufmgr,
596                       "Buffer",
597                       4 * width_in_mbs * 64,  /* 4 * width_in_mbs * 64 */
598                       64);
599     assert(bo);
600     mfc_context->deblocking_filter_row_store_scratch_buffer.bo = bo;
601
602     dri_bo_unreference(mfc_context->bsd_mpc_row_store_scratch_buffer.bo);
603     bo = dri_bo_alloc(i965->intel.bufmgr,
604                       "Buffer",
605                       128 * width_in_mbs, /* 2 * widht_in_mbs * 64 */
606                       0x1000);
607     assert(bo);
608     mfc_context->bsd_mpc_row_store_scratch_buffer.bo = bo;
609
610     dri_bo_unreference(mfc_context->mfc_batchbuffer_surface.bo);
611     mfc_context->mfc_batchbuffer_surface.bo = NULL;
612
613     dri_bo_unreference(mfc_context->aux_batchbuffer_surface.bo);
614     mfc_context->aux_batchbuffer_surface.bo = NULL;
615
616     if (mfc_context->aux_batchbuffer)
617         intel_batchbuffer_free(mfc_context->aux_batchbuffer);
618
619     mfc_context->aux_batchbuffer = intel_batchbuffer_new(&i965->intel, I915_EXEC_BSD,
620                                                          slice_batchbuffer_size);
621     mfc_context->aux_batchbuffer_surface.bo = mfc_context->aux_batchbuffer->buffer;
622     dri_bo_reference(mfc_context->aux_batchbuffer_surface.bo);
623     mfc_context->aux_batchbuffer_surface.pitch = 16;
624     mfc_context->aux_batchbuffer_surface.num_blocks = mfc_context->aux_batchbuffer->size / 16;
625     mfc_context->aux_batchbuffer_surface.size_block = 16;
626
627     i965_gpe_context_init(ctx, &mfc_context->gpe_context);
628 }
629
630 static void gen6_mfc_avc_pipeline_picture_programing( VADriverContextP ctx,
631                                                       struct encode_state *encode_state,
632                                                       struct intel_encoder_context *encoder_context)
633 {
634     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
635
636     mfc_context->pipe_mode_select(ctx, MFX_FORMAT_AVC, encoder_context);
637     mfc_context->set_surface_state(ctx, encoder_context);
638     mfc_context->ind_obj_base_addr_state(ctx, encoder_context);
639     gen6_mfc_pipe_buf_addr_state(ctx, encoder_context);
640     gen6_mfc_bsp_buf_base_addr_state(ctx, encoder_context);
641     mfc_context->avc_img_state(ctx, encode_state, encoder_context);
642     mfc_context->avc_qm_state(ctx, encoder_context);
643     mfc_context->avc_fqm_state(ctx, encoder_context);
644     gen6_mfc_avc_directmode_state(ctx, encoder_context); 
645     intel_mfc_avc_ref_idx_state(ctx, encode_state, encoder_context);
646 }
647
648
649 VAStatus
650 gen6_mfc_run(VADriverContextP ctx, 
651              struct encode_state *encode_state,
652              struct intel_encoder_context *encoder_context)
653 {
654     struct intel_batchbuffer *batch = encoder_context->base.batch;
655
656     intel_batchbuffer_flush(batch);             //run the pipeline
657
658     return VA_STATUS_SUCCESS;
659 }
660
661 VAStatus
662 gen6_mfc_stop(VADriverContextP ctx, 
663               struct encode_state *encode_state,
664               struct intel_encoder_context *encoder_context,
665               int *encoded_bits_size)
666 {
667     VAStatus vaStatus = VA_STATUS_ERROR_UNKNOWN;
668     VAEncPictureParameterBufferH264 *pPicParameter = (VAEncPictureParameterBufferH264 *)encode_state->pic_param_ext->buffer;
669     VACodedBufferSegment *coded_buffer_segment;
670     
671     vaStatus = i965_MapBuffer(ctx, pPicParameter->coded_buf, (void **)&coded_buffer_segment);
672     assert(vaStatus == VA_STATUS_SUCCESS);
673     *encoded_bits_size = coded_buffer_segment->size * 8;
674     i965_UnmapBuffer(ctx, pPicParameter->coded_buf);
675
676     return VA_STATUS_SUCCESS;
677 }
678
679 #if __SOFTWARE__
680
681 static int
682 gen6_mfc_avc_pak_object_intra(VADriverContextP ctx, int x, int y, int end_mb, int qp,unsigned int *msg,
683                               struct intel_encoder_context *encoder_context,
684                               unsigned char target_mb_size, unsigned char max_mb_size,
685                               struct intel_batchbuffer *batch)
686 {
687     int len_in_dwords = 11;
688
689     if (batch == NULL)
690         batch = encoder_context->base.batch;
691
692     BEGIN_BCS_BATCH(batch, len_in_dwords);
693
694     OUT_BCS_BATCH(batch, MFC_AVC_PAK_OBJECT | (len_in_dwords - 2));
695     OUT_BCS_BATCH(batch, 0);
696     OUT_BCS_BATCH(batch, 0);
697     OUT_BCS_BATCH(batch, 
698                   (0 << 24) |           /* PackedMvNum, Debug*/
699                   (0 << 20) |           /* No motion vector */
700                   (1 << 19) |           /* CbpDcY */
701                   (1 << 18) |           /* CbpDcU */
702                   (1 << 17) |           /* CbpDcV */
703                   (msg[0] & 0xFFFF) );
704
705     OUT_BCS_BATCH(batch, (0xFFFF << 16) | (y << 8) | x);                /* Code Block Pattern for Y*/
706     OUT_BCS_BATCH(batch, 0x000F000F);                                                   /* Code Block Pattern */                
707     OUT_BCS_BATCH(batch, (0 << 27) | (end_mb << 26) | qp);      /* Last MB */
708
709     /*Stuff for Intra MB*/
710     OUT_BCS_BATCH(batch, msg[1]);                       /* We using Intra16x16 no 4x4 predmode*/        
711     OUT_BCS_BATCH(batch, msg[2]);       
712     OUT_BCS_BATCH(batch, msg[3]&0xFC);          
713     
714     /*MaxSizeInWord and TargetSzieInWord*/
715     OUT_BCS_BATCH(batch, (max_mb_size << 24) |
716                   (target_mb_size << 16) );
717
718     ADVANCE_BCS_BATCH(batch);
719
720     return len_in_dwords;
721 }
722
723 static int
724 gen6_mfc_avc_pak_object_inter(VADriverContextP ctx, int x, int y, int end_mb, int qp,
725                               unsigned int *msg, unsigned int offset,
726                               struct intel_encoder_context *encoder_context,
727                               unsigned char target_mb_size,unsigned char max_mb_size, int slice_type,
728                               struct intel_batchbuffer *batch)
729 {
730     struct gen6_vme_context *vme_context = encoder_context->vme_context;
731     int len_in_dwords = 11;
732
733     if (batch == NULL)
734         batch = encoder_context->base.batch;
735
736     BEGIN_BCS_BATCH(batch, len_in_dwords);
737
738     OUT_BCS_BATCH(batch, MFC_AVC_PAK_OBJECT | (len_in_dwords - 2));
739
740     OUT_BCS_BATCH(batch, msg[2]);         /* 32 MV*/
741     OUT_BCS_BATCH(batch, offset);
742
743     OUT_BCS_BATCH(batch, msg[0]);
744
745     OUT_BCS_BATCH(batch, (0xFFFF<<16) | (y << 8) | x);        /* Code Block Pattern for Y*/
746     OUT_BCS_BATCH(batch, 0x000F000F);                         /* Code Block Pattern */  
747 #if 0 
748     if ( slice_type == SLICE_TYPE_B) {
749         OUT_BCS_BATCH(batch, (0xF<<28) | (end_mb << 26) | qp);  /* Last MB */
750     } else {
751         OUT_BCS_BATCH(batch, (end_mb << 26) | qp);      /* Last MB */
752     }
753 #else
754     OUT_BCS_BATCH(batch, (end_mb << 26) | qp);  /* Last MB */
755 #endif
756
757
758     /*Stuff for Inter MB*/
759     OUT_BCS_BATCH(batch, msg[1]);        
760     OUT_BCS_BATCH(batch, vme_context->ref_index_in_mb[0]);
761     OUT_BCS_BATCH(batch, vme_context->ref_index_in_mb[1]);
762
763     /*MaxSizeInWord and TargetSzieInWord*/
764     OUT_BCS_BATCH(batch, (max_mb_size << 24) |
765                   (target_mb_size << 16) );
766
767     ADVANCE_BCS_BATCH(batch);
768
769     return len_in_dwords;
770 }
771
772 static void 
773 gen6_mfc_avc_pipeline_slice_programing(VADriverContextP ctx,
774                                        struct encode_state *encode_state,
775                                        struct intel_encoder_context *encoder_context,
776                                        int slice_index,
777                                        struct intel_batchbuffer *slice_batch)
778 {
779     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
780     struct gen6_vme_context *vme_context = encoder_context->vme_context;
781     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
782     VAEncPictureParameterBufferH264 *pPicParameter = (VAEncPictureParameterBufferH264 *)encode_state->pic_param_ext->buffer;
783     VAEncSliceParameterBufferH264 *pSliceParameter = (VAEncSliceParameterBufferH264 *)encode_state->slice_params_ext[slice_index]->buffer; 
784     unsigned int *msg = NULL, offset = 0;
785     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
786     int height_in_mbs = (mfc_context->surface_state.height + 15) / 16;
787     int last_slice = (pSliceParameter->macroblock_address + pSliceParameter->num_macroblocks) == (width_in_mbs * height_in_mbs);
788     int i,x,y;
789     int qp = pPicParameter->pic_init_qp + pSliceParameter->slice_qp_delta;
790     unsigned int rate_control_mode = encoder_context->rate_control_mode;
791     unsigned int tail_data[] = { 0x0, 0x0 };
792     int slice_type = intel_avc_enc_slice_type_fixup(pSliceParameter->slice_type);
793     int is_intra = slice_type == SLICE_TYPE_I;
794
795     if (rate_control_mode == VA_RC_CBR) {
796         qp = mfc_context->bit_rate_control_context[slice_type].QpPrimeY;
797         if (encode_state->slice_header_index[slice_index] == 0)
798             pSliceParameter->slice_qp_delta = qp - pPicParameter->pic_init_qp;
799     }
800
801     /* only support for 8-bit pixel bit-depth */
802     assert(pSequenceParameter->bit_depth_luma_minus8 == 0);
803     assert(pSequenceParameter->bit_depth_chroma_minus8 == 0);
804     assert(pPicParameter->pic_init_qp >= 0 && pPicParameter->pic_init_qp < 52);
805     assert(qp >= 0 && qp < 52);
806
807     gen6_mfc_avc_slice_state(ctx, 
808                              pPicParameter,
809                              pSliceParameter,
810                              encode_state, encoder_context,
811                              (rate_control_mode == VA_RC_CBR), qp, slice_batch);
812
813     if ( slice_index == 0) 
814         intel_mfc_avc_pipeline_header_programing(ctx, encode_state, encoder_context, slice_batch);
815
816     intel_avc_slice_insert_packed_data(ctx, encode_state, encoder_context, slice_index, slice_batch);
817
818     dri_bo_map(vme_context->vme_output.bo , 1);
819     msg = (unsigned int *)vme_context->vme_output.bo->virtual;
820
821     if (is_intra) {
822         msg += pSliceParameter->macroblock_address * INTRA_VME_OUTPUT_IN_DWS;
823     } else {
824         msg += pSliceParameter->macroblock_address * INTER_VME_OUTPUT_IN_DWS;
825         msg += 32; /* the first 32 DWs are MVs */
826         offset = pSliceParameter->macroblock_address * INTER_VME_OUTPUT_IN_BYTES;
827     }
828    
829     for (i = pSliceParameter->macroblock_address; 
830          i < pSliceParameter->macroblock_address + pSliceParameter->num_macroblocks; i++) {
831         int last_mb = (i == (pSliceParameter->macroblock_address + pSliceParameter->num_macroblocks - 1) );
832         x = i % width_in_mbs;
833         y = i / width_in_mbs;
834
835         if (is_intra) {
836             assert(msg);
837             gen6_mfc_avc_pak_object_intra(ctx, x, y, last_mb, qp, msg, encoder_context, 0, 0, slice_batch);
838             msg += INTRA_VME_OUTPUT_IN_DWS;
839         } else {
840             if (msg[0] & INTRA_MB_FLAG_MASK) {
841                 gen6_mfc_avc_pak_object_intra(ctx, x, y, last_mb, qp, msg, encoder_context, 0, 0, slice_batch);
842             } else {
843                 gen6_mfc_avc_pak_object_inter(ctx, x, y, last_mb, qp, msg, offset, encoder_context, 0, 0, slice_type, slice_batch);
844             }
845
846             msg += INTER_VME_OUTPUT_IN_DWS;
847             offset += INTER_VME_OUTPUT_IN_BYTES;
848         }
849     }
850    
851     dri_bo_unmap(vme_context->vme_output.bo);
852
853     if ( last_slice ) {    
854         mfc_context->insert_object(ctx, encoder_context,
855                                    tail_data, 2, 8,
856                                    2, 1, 1, 0, slice_batch);
857     } else {
858         mfc_context->insert_object(ctx, encoder_context,
859                                    tail_data, 1, 8,
860                                    1, 1, 1, 0, slice_batch);
861     }
862
863
864 }
865
866 static dri_bo *
867 gen6_mfc_avc_software_batchbuffer(VADriverContextP ctx,
868                                   struct encode_state *encode_state,
869                                   struct intel_encoder_context *encoder_context)
870 {
871     struct i965_driver_data *i965 = i965_driver_data(ctx);
872     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
873     struct intel_batchbuffer *batch;;
874     dri_bo *batch_bo;
875     int i;
876
877     batch = mfc_context->aux_batchbuffer;
878     batch_bo = batch->buffer;
879
880     for (i = 0; i < encode_state->num_slice_params_ext; i++) {
881         gen6_mfc_avc_pipeline_slice_programing(ctx, encode_state, encoder_context, i, batch);
882     }
883
884     intel_batchbuffer_align(batch, 8);
885     
886     BEGIN_BCS_BATCH(batch, 2);
887     OUT_BCS_BATCH(batch, 0);
888     OUT_BCS_BATCH(batch, MI_BATCH_BUFFER_END);
889     ADVANCE_BCS_BATCH(batch);
890
891     dri_bo_reference(batch_bo);
892
893     intel_batchbuffer_free(batch);
894     mfc_context->aux_batchbuffer = NULL;
895
896     return batch_bo;
897 }
898
899 #else
900
901 static void
902 gen6_mfc_batchbuffer_surfaces_input(VADriverContextP ctx,
903                                     struct encode_state *encode_state,
904                                     struct intel_encoder_context *encoder_context)
905
906 {
907     struct gen6_vme_context *vme_context = encoder_context->vme_context;
908     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
909
910     assert(vme_context->vme_output.bo);
911     mfc_context->buffer_suface_setup(ctx,
912                                      &mfc_context->gpe_context,
913                                      &vme_context->vme_output,
914                                      BINDING_TABLE_OFFSET(BIND_IDX_VME_OUTPUT),
915                                      SURFACE_STATE_OFFSET(BIND_IDX_VME_OUTPUT));
916     assert(mfc_context->aux_batchbuffer_surface.bo);
917     mfc_context->buffer_suface_setup(ctx,
918                                      &mfc_context->gpe_context,
919                                      &mfc_context->aux_batchbuffer_surface,
920                                      BINDING_TABLE_OFFSET(BIND_IDX_MFC_SLICE_HEADER),
921                                      SURFACE_STATE_OFFSET(BIND_IDX_MFC_SLICE_HEADER));
922 }
923
924 static void
925 gen6_mfc_batchbuffer_surfaces_output(VADriverContextP ctx,
926                                      struct encode_state *encode_state,
927                                      struct intel_encoder_context *encoder_context)
928
929 {
930     struct i965_driver_data *i965 = i965_driver_data(ctx);
931     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
932     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
933     int width_in_mbs = pSequenceParameter->picture_width_in_mbs;
934     int height_in_mbs = pSequenceParameter->picture_height_in_mbs;
935     mfc_context->mfc_batchbuffer_surface.num_blocks = width_in_mbs * height_in_mbs + encode_state->num_slice_params_ext * 8 + 1;
936     mfc_context->mfc_batchbuffer_surface.size_block = 16 * CMD_LEN_IN_OWORD; /* 3 OWORDs */
937     mfc_context->mfc_batchbuffer_surface.pitch = 16;
938     mfc_context->mfc_batchbuffer_surface.bo = dri_bo_alloc(i965->intel.bufmgr, 
939                                                            "MFC batchbuffer",
940                                                            mfc_context->mfc_batchbuffer_surface.num_blocks * mfc_context->mfc_batchbuffer_surface.size_block,
941                                                            0x1000);
942     mfc_context->buffer_suface_setup(ctx,
943                                      &mfc_context->gpe_context,
944                                      &mfc_context->mfc_batchbuffer_surface,
945                                      BINDING_TABLE_OFFSET(BIND_IDX_MFC_BATCHBUFFER),
946                                      SURFACE_STATE_OFFSET(BIND_IDX_MFC_BATCHBUFFER));
947 }
948
949 static void
950 gen6_mfc_batchbuffer_surfaces_setup(VADriverContextP ctx, 
951                                     struct encode_state *encode_state,
952                                     struct intel_encoder_context *encoder_context)
953 {
954     gen6_mfc_batchbuffer_surfaces_input(ctx, encode_state, encoder_context);
955     gen6_mfc_batchbuffer_surfaces_output(ctx, encode_state, encoder_context);
956 }
957
958 static void
959 gen6_mfc_batchbuffer_idrt_setup(VADriverContextP ctx, 
960                                 struct encode_state *encode_state,
961                                 struct intel_encoder_context *encoder_context)
962 {
963     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
964     struct gen6_interface_descriptor_data *desc;   
965     int i;
966     dri_bo *bo;
967
968     bo = mfc_context->gpe_context.idrt.bo;
969     dri_bo_map(bo, 1);
970     assert(bo->virtual);
971     desc = bo->virtual;
972
973     for (i = 0; i < mfc_context->gpe_context.num_kernels; i++) {
974         struct i965_kernel *kernel;
975
976         kernel = &mfc_context->gpe_context.kernels[i];
977         assert(sizeof(*desc) == 32);
978
979         /*Setup the descritor table*/
980         memset(desc, 0, sizeof(*desc));
981         desc->desc0.kernel_start_pointer = (kernel->bo->offset >> 6);
982         desc->desc2.sampler_count = 0;
983         desc->desc2.sampler_state_pointer = 0;
984         desc->desc3.binding_table_entry_count = 2;
985         desc->desc3.binding_table_pointer = (BINDING_TABLE_OFFSET(0) >> 5);
986         desc->desc4.constant_urb_entry_read_offset = 0;
987         desc->desc4.constant_urb_entry_read_length = 4;
988                 
989         /*kernel start*/
990         dri_bo_emit_reloc(bo,   
991                           I915_GEM_DOMAIN_INSTRUCTION, 0,
992                           0,
993                           i * sizeof(*desc) + offsetof(struct gen6_interface_descriptor_data, desc0),
994                           kernel->bo);
995         desc++;
996     }
997
998     dri_bo_unmap(bo);
999 }
1000
1001 static void
1002 gen6_mfc_batchbuffer_constant_setup(VADriverContextP ctx, 
1003                                     struct encode_state *encode_state,
1004                                     struct intel_encoder_context *encoder_context)
1005 {
1006     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1007     
1008     (void)mfc_context;
1009 }
1010
1011 static void
1012 gen6_mfc_batchbuffer_emit_object_command(struct intel_batchbuffer *batch,
1013                                          int index,
1014                                          int head_offset,
1015                                          int batchbuffer_offset,
1016                                          int head_size,
1017                                          int tail_size,
1018                                          int number_mb_cmds,
1019                                          int first_object,
1020                                          int last_object,
1021                                          int last_slice,
1022                                          int mb_x,
1023                                          int mb_y,
1024                                          int width_in_mbs,
1025                                          int qp,
1026                                          unsigned int ref_index[2])
1027 {
1028     BEGIN_BATCH(batch, 14);
1029     
1030     OUT_BATCH(batch, CMD_MEDIA_OBJECT | (14 - 2));
1031     OUT_BATCH(batch, index);
1032     OUT_BATCH(batch, 0);
1033     OUT_BATCH(batch, 0);
1034     OUT_BATCH(batch, 0);
1035     OUT_BATCH(batch, 0);
1036    
1037     /*inline data */
1038     OUT_BATCH(batch, head_offset);
1039     OUT_BATCH(batch, batchbuffer_offset);
1040     OUT_BATCH(batch, 
1041               head_size << 16 |
1042               tail_size);
1043     OUT_BATCH(batch,
1044               number_mb_cmds << 16 |
1045               first_object << 2 |
1046               last_object << 1 |
1047               last_slice);
1048     OUT_BATCH(batch,
1049               mb_y << 8 |
1050               mb_x);
1051     OUT_BATCH(batch,
1052               qp << 16 |
1053               width_in_mbs);
1054     OUT_BATCH(batch, ref_index[0]);
1055     OUT_BATCH(batch, ref_index[1]);
1056
1057     ADVANCE_BATCH(batch);
1058 }
1059
1060 static void
1061 gen6_mfc_avc_batchbuffer_slice_command(VADriverContextP ctx,
1062                                        struct intel_encoder_context *encoder_context,
1063                                        VAEncSliceParameterBufferH264 *slice_param,
1064                                        int head_offset,
1065                                        unsigned short head_size,
1066                                        unsigned short tail_size,
1067                                        int batchbuffer_offset,
1068                                        int qp,
1069                                        int last_slice)
1070 {
1071     struct intel_batchbuffer *batch = encoder_context->base.batch;
1072     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1073     struct gen6_vme_context *vme_context = encoder_context->vme_context;
1074     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
1075     int total_mbs = slice_param->num_macroblocks;
1076     int number_mb_cmds = 128;
1077     int starting_mb = 0;
1078     int last_object = 0;
1079     int first_object = 1;
1080     int i;
1081     int mb_x, mb_y;
1082     int index = (slice_param->slice_type == SLICE_TYPE_I) ? MFC_BATCHBUFFER_AVC_INTRA : MFC_BATCHBUFFER_AVC_INTER;
1083
1084     for (i = 0; i < total_mbs / number_mb_cmds; i++) {
1085         last_object = (total_mbs - starting_mb) == number_mb_cmds;
1086         mb_x = (slice_param->macroblock_address + starting_mb) % width_in_mbs;
1087         mb_y = (slice_param->macroblock_address + starting_mb) / width_in_mbs;
1088         assert(mb_x <= 255 && mb_y <= 255);
1089
1090         starting_mb += number_mb_cmds;
1091
1092         gen6_mfc_batchbuffer_emit_object_command(batch,
1093                                                  index,
1094                                                  head_offset,
1095                                                  batchbuffer_offset,
1096                                                  head_size,
1097                                                  tail_size,
1098                                                  number_mb_cmds,
1099                                                  first_object,
1100                                                  last_object,
1101                                                  last_slice,
1102                                                  mb_x,
1103                                                  mb_y,
1104                                                  width_in_mbs,
1105                                                  qp,
1106                                                  vme_context->ref_index_in_mb);
1107
1108         if (first_object) {
1109             head_offset += head_size;
1110             batchbuffer_offset += head_size;
1111         }
1112
1113         if (last_object) {
1114             head_offset += tail_size;
1115             batchbuffer_offset += tail_size;
1116         }
1117
1118         batchbuffer_offset += number_mb_cmds * CMD_LEN_IN_OWORD;
1119
1120         first_object = 0;
1121     }
1122
1123     if (!last_object) {
1124         last_object = 1;
1125         number_mb_cmds = total_mbs % number_mb_cmds;
1126         mb_x = (slice_param->macroblock_address + starting_mb) % width_in_mbs;
1127         mb_y = (slice_param->macroblock_address + starting_mb) / width_in_mbs;
1128         assert(mb_x <= 255 && mb_y <= 255);
1129         starting_mb += number_mb_cmds;
1130
1131         gen6_mfc_batchbuffer_emit_object_command(batch,
1132                                                  index,
1133                                                  head_offset,
1134                                                  batchbuffer_offset,
1135                                                  head_size,
1136                                                  tail_size,
1137                                                  number_mb_cmds,
1138                                                  first_object,
1139                                                  last_object,
1140                                                  last_slice,
1141                                                  mb_x,
1142                                                  mb_y,
1143                                                  width_in_mbs,
1144                                                  qp,
1145                                                  vme_context->ref_index_in_mb);
1146     }
1147 }
1148                           
1149 /*
1150  * return size in Owords (16bytes)
1151  */         
1152 static int
1153 gen6_mfc_avc_batchbuffer_slice(VADriverContextP ctx,
1154                                struct encode_state *encode_state,
1155                                struct intel_encoder_context *encoder_context,
1156                                int slice_index,
1157                                int batchbuffer_offset)
1158 {
1159     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1160     struct intel_batchbuffer *slice_batch = mfc_context->aux_batchbuffer;
1161     VAEncSequenceParameterBufferH264 *pSequenceParameter = (VAEncSequenceParameterBufferH264 *)encode_state->seq_param_ext->buffer;
1162     VAEncPictureParameterBufferH264 *pPicParameter = (VAEncPictureParameterBufferH264 *)encode_state->pic_param_ext->buffer;
1163     VAEncSliceParameterBufferH264 *pSliceParameter = (VAEncSliceParameterBufferH264 *)encode_state->slice_params_ext[slice_index]->buffer; 
1164     int width_in_mbs = (mfc_context->surface_state.width + 15) / 16;
1165     int height_in_mbs = (mfc_context->surface_state.height + 15) / 16;
1166     int last_slice = (pSliceParameter->macroblock_address + pSliceParameter->num_macroblocks) == (width_in_mbs * height_in_mbs);
1167     int qp = pPicParameter->pic_init_qp + pSliceParameter->slice_qp_delta;
1168     unsigned int rate_control_mode = encoder_context->rate_control_mode;
1169     unsigned int tail_data[] = { 0x0, 0x0 };
1170     long head_offset;
1171     int old_used = intel_batchbuffer_used_size(slice_batch), used;
1172     unsigned short head_size, tail_size;
1173     int slice_type = intel_avc_enc_slice_type_fixup(pSliceParameter->slice_type);
1174
1175     if (rate_control_mode == VA_RC_CBR) {
1176         qp = mfc_context->bit_rate_control_context[slice_type].QpPrimeY;
1177         if (encode_state->slice_header_index[slice_index] == 0)
1178             pSliceParameter->slice_qp_delta = qp - pPicParameter->pic_init_qp;
1179     }
1180
1181     /* only support for 8-bit pixel bit-depth */
1182     assert(pSequenceParameter->bit_depth_luma_minus8 == 0);
1183     assert(pSequenceParameter->bit_depth_chroma_minus8 == 0);
1184     assert(pPicParameter->pic_init_qp >= 0 && pPicParameter->pic_init_qp < 52);
1185     assert(qp >= 0 && qp < 52);
1186
1187     head_offset = old_used / 16;
1188     gen6_mfc_avc_slice_state(ctx,
1189                              pPicParameter,
1190                              pSliceParameter,
1191                              encode_state,
1192                              encoder_context,
1193                              (rate_control_mode == VA_RC_CBR),
1194                              qp,
1195                              slice_batch);
1196
1197     if (slice_index == 0)
1198         intel_mfc_avc_pipeline_header_programing(ctx, encode_state, encoder_context, slice_batch);
1199
1200     intel_avc_slice_insert_packed_data(ctx, encode_state, encoder_context, slice_index, slice_batch);
1201
1202     intel_batchbuffer_align(slice_batch, 16); /* aligned by an Oword */
1203     used = intel_batchbuffer_used_size(slice_batch);
1204     head_size = (used - old_used) / 16;
1205     old_used = used;
1206
1207     /* tail */
1208     if (last_slice) {    
1209         mfc_context->insert_object(ctx,
1210                                    encoder_context,
1211                                    tail_data,
1212                                    2,
1213                                    8,
1214                                    2,
1215                                    1,
1216                                    1,
1217                                    0,
1218                                    slice_batch);
1219     } else {
1220         mfc_context->insert_object(ctx,
1221                                    encoder_context,
1222                                    tail_data,
1223                                    1,
1224                                    8,
1225                                    1,
1226                                    1,
1227                                    1,
1228                                    0,
1229                                    slice_batch);
1230     }
1231
1232     intel_batchbuffer_align(slice_batch, 16); /* aligned by an Oword */
1233     used = intel_batchbuffer_used_size(slice_batch);
1234     tail_size = (used - old_used) / 16;
1235
1236    
1237     gen6_mfc_avc_batchbuffer_slice_command(ctx,
1238                                            encoder_context,
1239                                            pSliceParameter,
1240                                            head_offset,
1241                                            head_size,
1242                                            tail_size,
1243                                            batchbuffer_offset,
1244                                            qp,
1245                                            last_slice);
1246
1247     return head_size + tail_size + pSliceParameter->num_macroblocks * CMD_LEN_IN_OWORD;
1248 }
1249
1250 static void
1251 gen6_mfc_avc_batchbuffer_pipeline(VADriverContextP ctx,
1252                                   struct encode_state *encode_state,
1253                                   struct intel_encoder_context *encoder_context)
1254 {
1255     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1256     struct intel_batchbuffer *batch = encoder_context->base.batch;
1257     int i, size, offset = 0;
1258     intel_batchbuffer_start_atomic(batch, 0x4000); 
1259     gen6_gpe_pipeline_setup(ctx, &mfc_context->gpe_context, batch);
1260
1261     for ( i = 0; i < encode_state->num_slice_params_ext; i++) {
1262         size = gen6_mfc_avc_batchbuffer_slice(ctx, encode_state, encoder_context, i, offset);
1263         offset += size;
1264     }
1265
1266     intel_batchbuffer_end_atomic(batch);
1267     intel_batchbuffer_flush(batch);
1268 }
1269
1270 static void
1271 gen6_mfc_build_avc_batchbuffer(VADriverContextP ctx, 
1272                                struct encode_state *encode_state,
1273                                struct intel_encoder_context *encoder_context)
1274 {
1275     gen6_mfc_batchbuffer_surfaces_setup(ctx, encode_state, encoder_context);
1276     gen6_mfc_batchbuffer_idrt_setup(ctx, encode_state, encoder_context);
1277     gen6_mfc_batchbuffer_constant_setup(ctx, encode_state, encoder_context);
1278     gen6_mfc_avc_batchbuffer_pipeline(ctx, encode_state, encoder_context);
1279 }
1280
1281 static dri_bo *
1282 gen6_mfc_avc_hardware_batchbuffer(VADriverContextP ctx,
1283                                   struct encode_state *encode_state,
1284                                   struct intel_encoder_context *encoder_context)
1285 {
1286     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1287
1288     gen6_mfc_build_avc_batchbuffer(ctx, encode_state, encoder_context);
1289     dri_bo_reference(mfc_context->mfc_batchbuffer_surface.bo);
1290
1291     return mfc_context->mfc_batchbuffer_surface.bo;
1292 }
1293
1294 #endif
1295
1296
1297 static void
1298 gen6_mfc_avc_pipeline_programing(VADriverContextP ctx,
1299                                  struct encode_state *encode_state,
1300                                  struct intel_encoder_context *encoder_context)
1301 {
1302     struct intel_batchbuffer *batch = encoder_context->base.batch;
1303     dri_bo *slice_batch_bo;
1304
1305     if ( intel_mfc_interlace_check(ctx, encode_state, encoder_context) ) {
1306         fprintf(stderr, "Current VA driver don't support interlace mode!\n");
1307         assert(0);
1308         return; 
1309     }
1310
1311 #if __SOFTWARE__
1312     slice_batch_bo = gen6_mfc_avc_software_batchbuffer(ctx, encode_state, encoder_context);
1313 #else
1314     slice_batch_bo = gen6_mfc_avc_hardware_batchbuffer(ctx, encode_state, encoder_context);
1315 #endif
1316
1317     // begin programing
1318     intel_batchbuffer_start_atomic_bcs(batch, 0x4000); 
1319     intel_batchbuffer_emit_mi_flush(batch);
1320     
1321     // picture level programing
1322     gen6_mfc_avc_pipeline_picture_programing(ctx, encode_state, encoder_context);
1323
1324     BEGIN_BCS_BATCH(batch, 2);
1325     OUT_BCS_BATCH(batch, MI_BATCH_BUFFER_START | (1 << 8));
1326     OUT_BCS_RELOC(batch,
1327                   slice_batch_bo,
1328                   I915_GEM_DOMAIN_COMMAND, 0, 
1329                   0);
1330     ADVANCE_BCS_BATCH(batch);
1331
1332     // end programing
1333     intel_batchbuffer_end_atomic(batch);
1334
1335     dri_bo_unreference(slice_batch_bo);
1336 }
1337
1338 VAStatus
1339 gen6_mfc_avc_encode_picture(VADriverContextP ctx, 
1340                             struct encode_state *encode_state,
1341                             struct intel_encoder_context *encoder_context)
1342 {
1343     struct gen6_mfc_context *mfc_context = encoder_context->mfc_context;
1344     unsigned int rate_control_mode = encoder_context->rate_control_mode;
1345     int current_frame_bits_size;
1346     int sts;
1347  
1348     for (;;) {
1349         gen6_mfc_init(ctx, encode_state, encoder_context);
1350         intel_mfc_avc_prepare(ctx, encode_state, encoder_context);
1351         /*Programing bcs pipeline*/
1352         gen6_mfc_avc_pipeline_programing(ctx, encode_state, encoder_context);   //filling the pipeline
1353         gen6_mfc_run(ctx, encode_state, encoder_context);
1354         if (rate_control_mode == VA_RC_CBR /*|| rate_control_mode == VA_RC_VBR*/) {
1355             gen6_mfc_stop(ctx, encode_state, encoder_context, &current_frame_bits_size);
1356             sts = intel_mfc_brc_postpack(encode_state, mfc_context, current_frame_bits_size);
1357             if (sts == BRC_NO_HRD_VIOLATION) {
1358                 intel_mfc_hrd_context_update(encode_state, mfc_context);
1359                 break;
1360             }
1361             else if (sts == BRC_OVERFLOW_WITH_MIN_QP || sts == BRC_UNDERFLOW_WITH_MAX_QP) {
1362                 if (!mfc_context->hrd.violation_noted) {
1363                     fprintf(stderr, "Unrepairable %s!\n", (sts == BRC_OVERFLOW_WITH_MIN_QP)? "overflow": "underflow");
1364                     mfc_context->hrd.violation_noted = 1;
1365                 }
1366                 return VA_STATUS_SUCCESS;
1367             }
1368         } else {
1369             break;
1370         }
1371     }
1372
1373     return VA_STATUS_SUCCESS;
1374 }
1375
1376 VAStatus
1377 gen6_mfc_pipeline(VADriverContextP ctx,
1378                   VAProfile profile,
1379                   struct encode_state *encode_state,
1380                   struct intel_encoder_context *encoder_context)
1381 {
1382     VAStatus vaStatus;
1383
1384     switch (profile) {
1385     case VAProfileH264ConstrainedBaseline:
1386     case VAProfileH264Main:
1387     case VAProfileH264High:
1388         vaStatus = gen6_mfc_avc_encode_picture(ctx, encode_state, encoder_context);
1389         break;
1390
1391         /* FIXME: add for other profile */
1392     default:
1393         vaStatus = VA_STATUS_ERROR_UNSUPPORTED_PROFILE;
1394         break;
1395     }
1396
1397     return vaStatus;
1398 }
1399
1400 void
1401 gen6_mfc_context_destroy(void *context)
1402 {
1403     struct gen6_mfc_context *mfc_context = context;
1404     int i;
1405
1406     dri_bo_unreference(mfc_context->post_deblocking_output.bo);
1407     mfc_context->post_deblocking_output.bo = NULL;
1408
1409     dri_bo_unreference(mfc_context->pre_deblocking_output.bo);
1410     mfc_context->pre_deblocking_output.bo = NULL;
1411
1412     dri_bo_unreference(mfc_context->uncompressed_picture_source.bo);
1413     mfc_context->uncompressed_picture_source.bo = NULL;
1414
1415     dri_bo_unreference(mfc_context->mfc_indirect_pak_bse_object.bo); 
1416     mfc_context->mfc_indirect_pak_bse_object.bo = NULL;
1417
1418     for (i = 0; i < NUM_MFC_DMV_BUFFERS; i++){
1419         dri_bo_unreference(mfc_context->direct_mv_buffers[i].bo);
1420         mfc_context->direct_mv_buffers[i].bo = NULL;
1421     }
1422
1423     dri_bo_unreference(mfc_context->intra_row_store_scratch_buffer.bo);
1424     mfc_context->intra_row_store_scratch_buffer.bo = NULL;
1425
1426     dri_bo_unreference(mfc_context->macroblock_status_buffer.bo);
1427     mfc_context->macroblock_status_buffer.bo = NULL;
1428
1429     dri_bo_unreference(mfc_context->deblocking_filter_row_store_scratch_buffer.bo);
1430     mfc_context->deblocking_filter_row_store_scratch_buffer.bo = NULL;
1431
1432     dri_bo_unreference(mfc_context->bsd_mpc_row_store_scratch_buffer.bo);
1433     mfc_context->bsd_mpc_row_store_scratch_buffer.bo = NULL;
1434
1435
1436     for (i = 0; i < MAX_MFC_REFERENCE_SURFACES; i++){
1437         dri_bo_unreference(mfc_context->reference_surfaces[i].bo);
1438         mfc_context->reference_surfaces[i].bo = NULL;  
1439     }
1440
1441     i965_gpe_context_destroy(&mfc_context->gpe_context);
1442
1443     dri_bo_unreference(mfc_context->mfc_batchbuffer_surface.bo);
1444     mfc_context->mfc_batchbuffer_surface.bo = NULL;
1445
1446     dri_bo_unreference(mfc_context->aux_batchbuffer_surface.bo);
1447     mfc_context->aux_batchbuffer_surface.bo = NULL;
1448
1449     if (mfc_context->aux_batchbuffer)
1450         intel_batchbuffer_free(mfc_context->aux_batchbuffer);
1451
1452     mfc_context->aux_batchbuffer = NULL;
1453
1454     free(mfc_context);
1455 }
1456
1457 Bool gen6_mfc_context_init(VADriverContextP ctx, struct intel_encoder_context *encoder_context)
1458 {
1459     struct gen6_mfc_context *mfc_context = calloc(1, sizeof(struct gen6_mfc_context));
1460
1461     if (!mfc_context)
1462         return False;
1463
1464     mfc_context->gpe_context.surface_state_binding_table.length = (SURFACE_STATE_PADDED_SIZE + sizeof(unsigned int)) * MAX_MEDIA_SURFACES_GEN6;
1465
1466     mfc_context->gpe_context.idrt.max_entries = MAX_GPE_KERNELS;
1467     mfc_context->gpe_context.idrt.entry_size = sizeof(struct gen6_interface_descriptor_data);
1468
1469     mfc_context->gpe_context.curbe.length = 32 * 4;
1470
1471     mfc_context->gpe_context.vfe_state.max_num_threads = 60 - 1;
1472     mfc_context->gpe_context.vfe_state.num_urb_entries = 16;
1473     mfc_context->gpe_context.vfe_state.gpgpu_mode = 0;
1474     mfc_context->gpe_context.vfe_state.urb_entry_size = 59 - 1;
1475     mfc_context->gpe_context.vfe_state.curbe_allocation_size = 37 - 1;
1476
1477     i965_gpe_load_kernels(ctx,
1478                           &mfc_context->gpe_context,
1479                           gen6_mfc_kernels,
1480                           NUM_MFC_KERNEL);
1481
1482     mfc_context->pipe_mode_select = gen6_mfc_pipe_mode_select;
1483     mfc_context->set_surface_state = gen6_mfc_surface_state;
1484     mfc_context->ind_obj_base_addr_state = gen6_mfc_ind_obj_base_addr_state;
1485     mfc_context->avc_img_state = gen6_mfc_avc_img_state;
1486     mfc_context->avc_qm_state = gen6_mfc_avc_qm_state;
1487     mfc_context->avc_fqm_state = gen6_mfc_avc_fqm_state;
1488     mfc_context->insert_object = gen6_mfc_avc_insert_object;
1489     mfc_context->buffer_suface_setup = i965_gpe_buffer_suface_setup;
1490
1491     encoder_context->mfc_context = mfc_context;
1492     encoder_context->mfc_context_destroy = gen6_mfc_context_destroy;
1493     encoder_context->mfc_pipeline = gen6_mfc_pipeline;
1494     encoder_context->mfc_brc_prepare = intel_mfc_brc_prepare;
1495
1496     return True;
1497 }