1515bc800d03c260aa85d6247b32e4c0579a3283
[ffmpeg.git] / libavcodec / h264_mb.c
1 /*
2  * H.26L/H.264/AVC/JVT/14496-10/... decoder
3  * Copyright (c) 2003 Michael Niedermayer <michaelni@gmx.at>
4  *
5  * This file is part of Libav.
6  *
7  * Libav is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU Lesser General Public
9  * License as published by the Free Software Foundation; either
10  * version 2.1 of the License, or (at your option) any later version.
11  *
12  * Libav is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15  * Lesser General Public License for more details.
16  *
17  * You should have received a copy of the GNU Lesser General Public
18  * License along with Libav; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20  */
21
22 /**
23  * @file
24  * H.264 / AVC / MPEG4 part10 macroblock decoding
25  */
26
27 #include <stdint.h>
28
29 #include "config.h"
30
31 #include "libavutil/common.h"
32 #include "libavutil/intreadwrite.h"
33 #include "avcodec.h"
34 #include "h264.h"
35 #include "qpeldsp.h"
36 #include "svq3.h"
37 #include "thread.h"
38
39 static inline int get_lowest_part_list_y(H264Context *h, H264Picture *pic, int n,
40                                          int height, int y_offset, int list)
41 {
42     int raw_my             = h->mv_cache[list][scan8[n]][1];
43     int filter_height_up   = (raw_my & 3) ? 2 : 0;
44     int filter_height_down = (raw_my & 3) ? 3 : 0;
45     int full_my            = (raw_my >> 2) + y_offset;
46     int top                = full_my - filter_height_up;
47     int bottom             = full_my + filter_height_down + height;
48
49     return FFMAX(abs(top), bottom);
50 }
51
52 static inline void get_lowest_part_y(H264Context *h, int refs[2][48], int n,
53                                      int height, int y_offset, int list0,
54                                      int list1, int *nrefs)
55 {
56     int my;
57
58     y_offset += 16 * (h->mb_y >> MB_FIELD(h));
59
60     if (list0) {
61         int ref_n = h->ref_cache[0][scan8[n]];
62         H264Picture *ref = &h->ref_list[0][ref_n];
63
64         // Error resilience puts the current picture in the ref list.
65         // Don't try to wait on these as it will cause a deadlock.
66         // Fields can wait on each other, though.
67         if (ref->tf.progress->data != h->cur_pic.tf.progress->data ||
68             (ref->reference & 3) != h->picture_structure) {
69             my = get_lowest_part_list_y(h, ref, n, height, y_offset, 0);
70             if (refs[0][ref_n] < 0)
71                 nrefs[0] += 1;
72             refs[0][ref_n] = FFMAX(refs[0][ref_n], my);
73         }
74     }
75
76     if (list1) {
77         int ref_n    = h->ref_cache[1][scan8[n]];
78         H264Picture *ref = &h->ref_list[1][ref_n];
79
80         if (ref->tf.progress->data != h->cur_pic.tf.progress->data ||
81             (ref->reference & 3) != h->picture_structure) {
82             my = get_lowest_part_list_y(h, ref, n, height, y_offset, 1);
83             if (refs[1][ref_n] < 0)
84                 nrefs[1] += 1;
85             refs[1][ref_n] = FFMAX(refs[1][ref_n], my);
86         }
87     }
88 }
89
90 /**
91  * Wait until all reference frames are available for MC operations.
92  *
93  * @param h the H264 context
94  */
95 static void await_references(H264Context *h)
96 {
97     const int mb_xy   = h->mb_xy;
98     const int mb_type = h->cur_pic.mb_type[mb_xy];
99     int refs[2][48];
100     int nrefs[2] = { 0 };
101     int ref, list;
102
103     memset(refs, -1, sizeof(refs));
104
105     if (IS_16X16(mb_type)) {
106         get_lowest_part_y(h, refs, 0, 16, 0,
107                           IS_DIR(mb_type, 0, 0), IS_DIR(mb_type, 0, 1), nrefs);
108     } else if (IS_16X8(mb_type)) {
109         get_lowest_part_y(h, refs, 0, 8, 0,
110                           IS_DIR(mb_type, 0, 0), IS_DIR(mb_type, 0, 1), nrefs);
111         get_lowest_part_y(h, refs, 8, 8, 8,
112                           IS_DIR(mb_type, 1, 0), IS_DIR(mb_type, 1, 1), nrefs);
113     } else if (IS_8X16(mb_type)) {
114         get_lowest_part_y(h, refs, 0, 16, 0,
115                           IS_DIR(mb_type, 0, 0), IS_DIR(mb_type, 0, 1), nrefs);
116         get_lowest_part_y(h, refs, 4, 16, 0,
117                           IS_DIR(mb_type, 1, 0), IS_DIR(mb_type, 1, 1), nrefs);
118     } else {
119         int i;
120
121         assert(IS_8X8(mb_type));
122
123         for (i = 0; i < 4; i++) {
124             const int sub_mb_type = h->sub_mb_type[i];
125             const int n           = 4 * i;
126             int y_offset          = (i & 2) << 2;
127
128             if (IS_SUB_8X8(sub_mb_type)) {
129                 get_lowest_part_y(h, refs, n, 8, y_offset,
130                                   IS_DIR(sub_mb_type, 0, 0),
131                                   IS_DIR(sub_mb_type, 0, 1),
132                                   nrefs);
133             } else if (IS_SUB_8X4(sub_mb_type)) {
134                 get_lowest_part_y(h, refs, n, 4, y_offset,
135                                   IS_DIR(sub_mb_type, 0, 0),
136                                   IS_DIR(sub_mb_type, 0, 1),
137                                   nrefs);
138                 get_lowest_part_y(h, refs, n + 2, 4, y_offset + 4,
139                                   IS_DIR(sub_mb_type, 0, 0),
140                                   IS_DIR(sub_mb_type, 0, 1),
141                                   nrefs);
142             } else if (IS_SUB_4X8(sub_mb_type)) {
143                 get_lowest_part_y(h, refs, n, 8, y_offset,
144                                   IS_DIR(sub_mb_type, 0, 0),
145                                   IS_DIR(sub_mb_type, 0, 1),
146                                   nrefs);
147                 get_lowest_part_y(h, refs, n + 1, 8, y_offset,
148                                   IS_DIR(sub_mb_type, 0, 0),
149                                   IS_DIR(sub_mb_type, 0, 1),
150                                   nrefs);
151             } else {
152                 int j;
153                 assert(IS_SUB_4X4(sub_mb_type));
154                 for (j = 0; j < 4; j++) {
155                     int sub_y_offset = y_offset + 2 * (j & 2);
156                     get_lowest_part_y(h, refs, n + j, 4, sub_y_offset,
157                                       IS_DIR(sub_mb_type, 0, 0),
158                                       IS_DIR(sub_mb_type, 0, 1),
159                                       nrefs);
160                 }
161             }
162         }
163     }
164
165     for (list = h->list_count - 1; list >= 0; list--)
166         for (ref = 0; ref < 48 && nrefs[list]; ref++) {
167             int row = refs[list][ref];
168             if (row >= 0) {
169                 H264Picture *ref_pic  = &h->ref_list[list][ref];
170                 int ref_field         = ref_pic->reference - 1;
171                 int ref_field_picture = ref_pic->field_picture;
172                 int pic_height        = 16 * h->mb_height >> ref_field_picture;
173
174                 row <<= MB_MBAFF(h);
175                 nrefs[list]--;
176
177                 if (!FIELD_PICTURE(h) && ref_field_picture) { // frame referencing two fields
178                     ff_thread_await_progress(&ref_pic->tf,
179                                              FFMIN((row >> 1) - !(row & 1),
180                                                    pic_height - 1),
181                                              1);
182                     ff_thread_await_progress(&ref_pic->tf,
183                                              FFMIN((row >> 1), pic_height - 1),
184                                              0);
185                 } else if (FIELD_PICTURE(h) && !ref_field_picture) { // field referencing one field of a frame
186                     ff_thread_await_progress(&ref_pic->tf,
187                                              FFMIN(row * 2 + ref_field,
188                                                    pic_height - 1),
189                                              0);
190                 } else if (FIELD_PICTURE(h)) {
191                     ff_thread_await_progress(&ref_pic->tf,
192                                              FFMIN(row, pic_height - 1),
193                                              ref_field);
194                 } else {
195                     ff_thread_await_progress(&ref_pic->tf,
196                                              FFMIN(row, pic_height - 1),
197                                              0);
198                 }
199             }
200         }
201 }
202
203 static av_always_inline void mc_dir_part(H264Context *h, H264Picture *pic,
204                                          int n, int square, int height,
205                                          int delta, int list,
206                                          uint8_t *dest_y, uint8_t *dest_cb,
207                                          uint8_t *dest_cr,
208                                          int src_x_offset, int src_y_offset,
209                                          qpel_mc_func *qpix_op,
210                                          h264_chroma_mc_func chroma_op,
211                                          int pixel_shift, int chroma_idc)
212 {
213     const int mx      = h->mv_cache[list][scan8[n]][0] + src_x_offset * 8;
214     int my            = h->mv_cache[list][scan8[n]][1] + src_y_offset * 8;
215     const int luma_xy = (mx & 3) + ((my & 3) << 2);
216     ptrdiff_t offset  = ((mx >> 2) << pixel_shift) + (my >> 2) * h->mb_linesize;
217     uint8_t *src_y    = pic->f.data[0] + offset;
218     uint8_t *src_cb, *src_cr;
219     int extra_width  = 0;
220     int extra_height = 0;
221     int emu = 0;
222     const int full_mx    = mx >> 2;
223     const int full_my    = my >> 2;
224     const int pic_width  = 16 * h->mb_width;
225     const int pic_height = 16 * h->mb_height >> MB_FIELD(h);
226     int ysh;
227
228     if (mx & 7)
229         extra_width -= 3;
230     if (my & 7)
231         extra_height -= 3;
232
233     if (full_mx                <          0 - extra_width  ||
234         full_my                <          0 - extra_height ||
235         full_mx + 16 /*FIXME*/ > pic_width  + extra_width  ||
236         full_my + 16 /*FIXME*/ > pic_height + extra_height) {
237         h->vdsp.emulated_edge_mc(h->edge_emu_buffer,
238                                  src_y - (2 << pixel_shift) - 2 * h->mb_linesize,
239                                  h->mb_linesize, h->mb_linesize,
240                                  16 + 5, 16 + 5 /*FIXME*/, full_mx - 2,
241                                  full_my - 2, pic_width, pic_height);
242         src_y = h->edge_emu_buffer + (2 << pixel_shift) + 2 * h->mb_linesize;
243         emu   = 1;
244     }
245
246     qpix_op[luma_xy](dest_y, src_y, h->mb_linesize); // FIXME try variable height perhaps?
247     if (!square)
248         qpix_op[luma_xy](dest_y + delta, src_y + delta, h->mb_linesize);
249
250     if (CONFIG_GRAY && h->flags & CODEC_FLAG_GRAY)
251         return;
252
253     if (chroma_idc == 3 /* yuv444 */) {
254         src_cb = pic->f.data[1] + offset;
255         if (emu) {
256             h->vdsp.emulated_edge_mc(h->edge_emu_buffer,
257                                      src_cb - (2 << pixel_shift) - 2 * h->mb_linesize,
258                                      h->mb_linesize, h->mb_linesize,
259                                      16 + 5, 16 + 5 /*FIXME*/,
260                                      full_mx - 2, full_my - 2,
261                                      pic_width, pic_height);
262             src_cb = h->edge_emu_buffer + (2 << pixel_shift) + 2 * h->mb_linesize;
263         }
264         qpix_op[luma_xy](dest_cb, src_cb, h->mb_linesize); // FIXME try variable height perhaps?
265         if (!square)
266             qpix_op[luma_xy](dest_cb + delta, src_cb + delta, h->mb_linesize);
267
268         src_cr = pic->f.data[2] + offset;
269         if (emu) {
270             h->vdsp.emulated_edge_mc(h->edge_emu_buffer,
271                                      src_cr - (2 << pixel_shift) - 2 * h->mb_linesize,
272                                      h->mb_linesize, h->mb_linesize,
273                                      16 + 5, 16 + 5 /*FIXME*/,
274                                      full_mx - 2, full_my - 2,
275                                      pic_width, pic_height);
276             src_cr = h->edge_emu_buffer + (2 << pixel_shift) + 2 * h->mb_linesize;
277         }
278         qpix_op[luma_xy](dest_cr, src_cr, h->mb_linesize); // FIXME try variable height perhaps?
279         if (!square)
280             qpix_op[luma_xy](dest_cr + delta, src_cr + delta, h->mb_linesize);
281         return;
282     }
283
284     ysh = 3 - (chroma_idc == 2 /* yuv422 */);
285     if (chroma_idc == 1 /* yuv420 */ && MB_FIELD(h)) {
286         // chroma offset when predicting from a field of opposite parity
287         my  += 2 * ((h->mb_y & 1) - (pic->reference - 1));
288         emu |= (my >> 3) < 0 || (my >> 3) + 8 >= (pic_height >> 1);
289     }
290
291     src_cb = pic->f.data[1] + ((mx >> 3) << pixel_shift) +
292              (my >> ysh) * h->mb_uvlinesize;
293     src_cr = pic->f.data[2] + ((mx >> 3) << pixel_shift) +
294              (my >> ysh) * h->mb_uvlinesize;
295
296     if (emu) {
297         h->vdsp.emulated_edge_mc(h->edge_emu_buffer, src_cb,
298                                  h->mb_uvlinesize, h->mb_uvlinesize,
299                                  9, 8 * chroma_idc + 1, (mx >> 3), (my >> ysh),
300                                  pic_width >> 1, pic_height >> (chroma_idc == 1 /* yuv420 */));
301         src_cb = h->edge_emu_buffer;
302     }
303     chroma_op(dest_cb, src_cb, h->mb_uvlinesize,
304               height >> (chroma_idc == 1 /* yuv420 */),
305               mx & 7, (my << (chroma_idc == 2 /* yuv422 */)) & 7);
306
307     if (emu) {
308         h->vdsp.emulated_edge_mc(h->edge_emu_buffer, src_cr,
309                                  h->mb_uvlinesize, h->mb_uvlinesize,
310                                  9, 8 * chroma_idc + 1, (mx >> 3), (my >> ysh),
311                                  pic_width >> 1, pic_height >> (chroma_idc == 1 /* yuv420 */));
312         src_cr = h->edge_emu_buffer;
313     }
314     chroma_op(dest_cr, src_cr, h->mb_uvlinesize, height >> (chroma_idc == 1 /* yuv420 */),
315               mx & 7, (my << (chroma_idc == 2 /* yuv422 */)) & 7);
316 }
317
318 static av_always_inline void mc_part_std(H264Context *h, int n, int square,
319                                          int height, int delta,
320                                          uint8_t *dest_y, uint8_t *dest_cb,
321                                          uint8_t *dest_cr,
322                                          int x_offset, int y_offset,
323                                          qpel_mc_func *qpix_put,
324                                          h264_chroma_mc_func chroma_put,
325                                          qpel_mc_func *qpix_avg,
326                                          h264_chroma_mc_func chroma_avg,
327                                          int list0, int list1,
328                                          int pixel_shift, int chroma_idc)
329 {
330     qpel_mc_func *qpix_op         = qpix_put;
331     h264_chroma_mc_func chroma_op = chroma_put;
332
333     dest_y += (2 * x_offset << pixel_shift) + 2 * y_offset * h->mb_linesize;
334     if (chroma_idc == 3 /* yuv444 */) {
335         dest_cb += (2 * x_offset << pixel_shift) + 2 * y_offset * h->mb_linesize;
336         dest_cr += (2 * x_offset << pixel_shift) + 2 * y_offset * h->mb_linesize;
337     } else if (chroma_idc == 2 /* yuv422 */) {
338         dest_cb += (x_offset << pixel_shift) + 2 * y_offset * h->mb_uvlinesize;
339         dest_cr += (x_offset << pixel_shift) + 2 * y_offset * h->mb_uvlinesize;
340     } else { /* yuv420 */
341         dest_cb += (x_offset << pixel_shift) + y_offset * h->mb_uvlinesize;
342         dest_cr += (x_offset << pixel_shift) + y_offset * h->mb_uvlinesize;
343     }
344     x_offset += 8 * h->mb_x;
345     y_offset += 8 * (h->mb_y >> MB_FIELD(h));
346
347     if (list0) {
348         H264Picture *ref = &h->ref_list[0][h->ref_cache[0][scan8[n]]];
349         mc_dir_part(h, ref, n, square, height, delta, 0,
350                     dest_y, dest_cb, dest_cr, x_offset, y_offset,
351                     qpix_op, chroma_op, pixel_shift, chroma_idc);
352
353         qpix_op   = qpix_avg;
354         chroma_op = chroma_avg;
355     }
356
357     if (list1) {
358         H264Picture *ref = &h->ref_list[1][h->ref_cache[1][scan8[n]]];
359         mc_dir_part(h, ref, n, square, height, delta, 1,
360                     dest_y, dest_cb, dest_cr, x_offset, y_offset,
361                     qpix_op, chroma_op, pixel_shift, chroma_idc);
362     }
363 }
364
365 static av_always_inline void mc_part_weighted(H264Context *h, H264SliceContext *sl,
366                                               int n, int square,
367                                               int height, int delta,
368                                               uint8_t *dest_y, uint8_t *dest_cb,
369                                               uint8_t *dest_cr,
370                                               int x_offset, int y_offset,
371                                               qpel_mc_func *qpix_put,
372                                               h264_chroma_mc_func chroma_put,
373                                               h264_weight_func luma_weight_op,
374                                               h264_weight_func chroma_weight_op,
375                                               h264_biweight_func luma_weight_avg,
376                                               h264_biweight_func chroma_weight_avg,
377                                               int list0, int list1,
378                                               int pixel_shift, int chroma_idc)
379 {
380     int chroma_height;
381
382     dest_y += (2 * x_offset << pixel_shift) + 2 * y_offset * h->mb_linesize;
383     if (chroma_idc == 3 /* yuv444 */) {
384         chroma_height     = height;
385         chroma_weight_avg = luma_weight_avg;
386         chroma_weight_op  = luma_weight_op;
387         dest_cb += (2 * x_offset << pixel_shift) + 2 * y_offset * h->mb_linesize;
388         dest_cr += (2 * x_offset << pixel_shift) + 2 * y_offset * h->mb_linesize;
389     } else if (chroma_idc == 2 /* yuv422 */) {
390         chroma_height = height;
391         dest_cb      += (x_offset << pixel_shift) + 2 * y_offset * h->mb_uvlinesize;
392         dest_cr      += (x_offset << pixel_shift) + 2 * y_offset * h->mb_uvlinesize;
393     } else { /* yuv420 */
394         chroma_height = height >> 1;
395         dest_cb      += (x_offset << pixel_shift) + y_offset * h->mb_uvlinesize;
396         dest_cr      += (x_offset << pixel_shift) + y_offset * h->mb_uvlinesize;
397     }
398     x_offset += 8 * h->mb_x;
399     y_offset += 8 * (h->mb_y >> MB_FIELD(h));
400
401     if (list0 && list1) {
402         /* don't optimize for luma-only case, since B-frames usually
403          * use implicit weights => chroma too. */
404         uint8_t *tmp_cb = h->bipred_scratchpad;
405         uint8_t *tmp_cr = h->bipred_scratchpad + (16 << pixel_shift);
406         uint8_t *tmp_y  = h->bipred_scratchpad + 16 * h->mb_uvlinesize;
407         int refn0       = h->ref_cache[0][scan8[n]];
408         int refn1       = h->ref_cache[1][scan8[n]];
409
410         mc_dir_part(h, &h->ref_list[0][refn0], n, square, height, delta, 0,
411                     dest_y, dest_cb, dest_cr,
412                     x_offset, y_offset, qpix_put, chroma_put,
413                     pixel_shift, chroma_idc);
414         mc_dir_part(h, &h->ref_list[1][refn1], n, square, height, delta, 1,
415                     tmp_y, tmp_cb, tmp_cr,
416                     x_offset, y_offset, qpix_put, chroma_put,
417                     pixel_shift, chroma_idc);
418
419         if (sl->use_weight == 2) {
420             int weight0 = sl->implicit_weight[refn0][refn1][h->mb_y & 1];
421             int weight1 = 64 - weight0;
422             luma_weight_avg(dest_y, tmp_y, h->mb_linesize,
423                             height, 5, weight0, weight1, 0);
424             chroma_weight_avg(dest_cb, tmp_cb, h->mb_uvlinesize,
425                               chroma_height, 5, weight0, weight1, 0);
426             chroma_weight_avg(dest_cr, tmp_cr, h->mb_uvlinesize,
427                               chroma_height, 5, weight0, weight1, 0);
428         } else {
429             luma_weight_avg(dest_y, tmp_y, h->mb_linesize, height,
430                             sl->luma_log2_weight_denom,
431                             sl->luma_weight[refn0][0][0],
432                             sl->luma_weight[refn1][1][0],
433                             sl->luma_weight[refn0][0][1] +
434                             sl->luma_weight[refn1][1][1]);
435             chroma_weight_avg(dest_cb, tmp_cb, h->mb_uvlinesize, chroma_height,
436                               sl->chroma_log2_weight_denom,
437                               sl->chroma_weight[refn0][0][0][0],
438                               sl->chroma_weight[refn1][1][0][0],
439                               sl->chroma_weight[refn0][0][0][1] +
440                               sl->chroma_weight[refn1][1][0][1]);
441             chroma_weight_avg(dest_cr, tmp_cr, h->mb_uvlinesize, chroma_height,
442                               sl->chroma_log2_weight_denom,
443                               sl->chroma_weight[refn0][0][1][0],
444                               sl->chroma_weight[refn1][1][1][0],
445                               sl->chroma_weight[refn0][0][1][1] +
446                               sl->chroma_weight[refn1][1][1][1]);
447         }
448     } else {
449         int list     = list1 ? 1 : 0;
450         int refn     = h->ref_cache[list][scan8[n]];
451         H264Picture *ref = &h->ref_list[list][refn];
452         mc_dir_part(h, ref, n, square, height, delta, list,
453                     dest_y, dest_cb, dest_cr, x_offset, y_offset,
454                     qpix_put, chroma_put, pixel_shift, chroma_idc);
455
456         luma_weight_op(dest_y, h->mb_linesize, height,
457                        sl->luma_log2_weight_denom,
458                        sl->luma_weight[refn][list][0],
459                        sl->luma_weight[refn][list][1]);
460         if (sl->use_weight_chroma) {
461             chroma_weight_op(dest_cb, h->mb_uvlinesize, chroma_height,
462                              sl->chroma_log2_weight_denom,
463                              sl->chroma_weight[refn][list][0][0],
464                              sl->chroma_weight[refn][list][0][1]);
465             chroma_weight_op(dest_cr, h->mb_uvlinesize, chroma_height,
466                              sl->chroma_log2_weight_denom,
467                              sl->chroma_weight[refn][list][1][0],
468                              sl->chroma_weight[refn][list][1][1]);
469         }
470     }
471 }
472
473 static av_always_inline void prefetch_motion(H264Context *h, int list,
474                                              int pixel_shift, int chroma_idc)
475 {
476     /* fetch pixels for estimated mv 4 macroblocks ahead
477      * optimized for 64byte cache lines */
478     const int refn = h->ref_cache[list][scan8[0]];
479     if (refn >= 0) {
480         const int mx  = (h->mv_cache[list][scan8[0]][0] >> 2) + 16 * h->mb_x + 8;
481         const int my  = (h->mv_cache[list][scan8[0]][1] >> 2) + 16 * h->mb_y;
482         uint8_t **src = h->ref_list[list][refn].f.data;
483         int off       = (mx << pixel_shift) +
484                         (my + (h->mb_x & 3) * 4) * h->mb_linesize +
485                         (64 << pixel_shift);
486         h->vdsp.prefetch(src[0] + off, h->linesize, 4);
487         if (chroma_idc == 3 /* yuv444 */) {
488             h->vdsp.prefetch(src[1] + off, h->linesize, 4);
489             h->vdsp.prefetch(src[2] + off, h->linesize, 4);
490         } else {
491             off = ((mx >> 1) << pixel_shift) +
492                   ((my >> 1) + (h->mb_x & 7)) * h->uvlinesize +
493                   (64 << pixel_shift);
494             h->vdsp.prefetch(src[1] + off, src[2] - src[1], 2);
495         }
496     }
497 }
498
499 static av_always_inline void xchg_mb_border(H264Context *h, H264SliceContext *sl,
500                                             uint8_t *src_y,
501                                             uint8_t *src_cb, uint8_t *src_cr,
502                                             int linesize, int uvlinesize,
503                                             int xchg, int chroma444,
504                                             int simple, int pixel_shift)
505 {
506     int deblock_topleft;
507     int deblock_top;
508     int top_idx = 1;
509     uint8_t *top_border_m1;
510     uint8_t *top_border;
511
512     if (!simple && FRAME_MBAFF(h)) {
513         if (h->mb_y & 1) {
514             if (!MB_MBAFF(h))
515                 return;
516         } else {
517             top_idx = MB_MBAFF(h) ? 0 : 1;
518         }
519     }
520
521     if (h->deblocking_filter == 2) {
522         deblock_topleft = h->slice_table[h->mb_xy - 1 - h->mb_stride] == h->slice_num;
523         deblock_top     = sl->top_type;
524     } else {
525         deblock_topleft = (h->mb_x > 0);
526         deblock_top     = (h->mb_y > !!MB_FIELD(h));
527     }
528
529     src_y  -= linesize   + 1 + pixel_shift;
530     src_cb -= uvlinesize + 1 + pixel_shift;
531     src_cr -= uvlinesize + 1 + pixel_shift;
532
533     top_border_m1 = h->top_borders[top_idx][h->mb_x - 1];
534     top_border    = h->top_borders[top_idx][h->mb_x];
535
536 #define XCHG(a, b, xchg)                        \
537     if (pixel_shift) {                          \
538         if (xchg) {                             \
539             AV_SWAP64(b + 0, a + 0);            \
540             AV_SWAP64(b + 8, a + 8);            \
541         } else {                                \
542             AV_COPY128(b, a);                   \
543         }                                       \
544     } else if (xchg)                            \
545         AV_SWAP64(b, a);                        \
546     else                                        \
547         AV_COPY64(b, a);
548
549     if (deblock_top) {
550         if (deblock_topleft) {
551             XCHG(top_border_m1 + (8 << pixel_shift),
552                  src_y - (7 << pixel_shift), 1);
553         }
554         XCHG(top_border + (0 << pixel_shift), src_y + (1 << pixel_shift), xchg);
555         XCHG(top_border + (8 << pixel_shift), src_y + (9 << pixel_shift), 1);
556         if (h->mb_x + 1 < h->mb_width) {
557             XCHG(h->top_borders[top_idx][h->mb_x + 1],
558                  src_y + (17 << pixel_shift), 1);
559         }
560     }
561     if (simple || !CONFIG_GRAY || !(h->flags & CODEC_FLAG_GRAY)) {
562         if (chroma444) {
563             if (deblock_top) {
564                 if (deblock_topleft) {
565                     XCHG(top_border_m1 + (24 << pixel_shift), src_cb - (7 << pixel_shift), 1);
566                     XCHG(top_border_m1 + (40 << pixel_shift), src_cr - (7 << pixel_shift), 1);
567                 }
568                 XCHG(top_border + (16 << pixel_shift), src_cb + (1 << pixel_shift), xchg);
569                 XCHG(top_border + (24 << pixel_shift), src_cb + (9 << pixel_shift), 1);
570                 XCHG(top_border + (32 << pixel_shift), src_cr + (1 << pixel_shift), xchg);
571                 XCHG(top_border + (40 << pixel_shift), src_cr + (9 << pixel_shift), 1);
572                 if (h->mb_x + 1 < h->mb_width) {
573                     XCHG(h->top_borders[top_idx][h->mb_x + 1] + (16 << pixel_shift), src_cb + (17 << pixel_shift), 1);
574                     XCHG(h->top_borders[top_idx][h->mb_x + 1] + (32 << pixel_shift), src_cr + (17 << pixel_shift), 1);
575                 }
576             }
577         } else {
578             if (deblock_top) {
579                 if (deblock_topleft) {
580                     XCHG(top_border_m1 + (16 << pixel_shift), src_cb - (7 << pixel_shift), 1);
581                     XCHG(top_border_m1 + (24 << pixel_shift), src_cr - (7 << pixel_shift), 1);
582                 }
583                 XCHG(top_border + (16 << pixel_shift), src_cb + 1 + pixel_shift, 1);
584                 XCHG(top_border + (24 << pixel_shift), src_cr + 1 + pixel_shift, 1);
585             }
586         }
587     }
588 }
589
590 static av_always_inline int dctcoef_get(int16_t *mb, int high_bit_depth,
591                                         int index)
592 {
593     if (high_bit_depth) {
594         return AV_RN32A(((int32_t *)mb) + index);
595     } else
596         return AV_RN16A(mb + index);
597 }
598
599 static av_always_inline void dctcoef_set(int16_t *mb, int high_bit_depth,
600                                          int index, int value)
601 {
602     if (high_bit_depth) {
603         AV_WN32A(((int32_t *)mb) + index, value);
604     } else
605         AV_WN16A(mb + index, value);
606 }
607
608 static av_always_inline void hl_decode_mb_predict_luma(H264Context *h,
609                                                        H264SliceContext *sl,
610                                                        int mb_type, int is_h264,
611                                                        int simple,
612                                                        int transform_bypass,
613                                                        int pixel_shift,
614                                                        int *block_offset,
615                                                        int linesize,
616                                                        uint8_t *dest_y, int p)
617 {
618     void (*idct_add)(uint8_t *dst, int16_t *block, int stride);
619     void (*idct_dc_add)(uint8_t *dst, int16_t *block, int stride);
620     int i;
621     int qscale = p == 0 ? sl->qscale : sl->chroma_qp[p - 1];
622     block_offset += 16 * p;
623     if (IS_INTRA4x4(mb_type)) {
624         if (IS_8x8DCT(mb_type)) {
625             if (transform_bypass) {
626                 idct_dc_add =
627                 idct_add    = h->h264dsp.h264_add_pixels8_clear;
628             } else {
629                 idct_dc_add = h->h264dsp.h264_idct8_dc_add;
630                 idct_add    = h->h264dsp.h264_idct8_add;
631             }
632             for (i = 0; i < 16; i += 4) {
633                 uint8_t *const ptr = dest_y + block_offset[i];
634                 const int dir      = h->intra4x4_pred_mode_cache[scan8[i]];
635                 if (transform_bypass && h->sps.profile_idc == 244 && dir <= 1) {
636                     h->hpc.pred8x8l_add[dir](ptr, h->mb + (i * 16 + p * 256 << pixel_shift), linesize);
637                 } else {
638                     const int nnz = h->non_zero_count_cache[scan8[i + p * 16]];
639                     h->hpc.pred8x8l[dir](ptr, (h->topleft_samples_available << i) & 0x8000,
640                                          (h->topright_samples_available << i) & 0x4000, linesize);
641                     if (nnz) {
642                         if (nnz == 1 && dctcoef_get(h->mb, pixel_shift, i * 16 + p * 256))
643                             idct_dc_add(ptr, h->mb + (i * 16 + p * 256 << pixel_shift), linesize);
644                         else
645                             idct_add(ptr, h->mb + (i * 16 + p * 256 << pixel_shift), linesize);
646                     }
647                 }
648             }
649         } else {
650             if (transform_bypass) {
651                 idct_dc_add  =
652                 idct_add     = h->h264dsp.h264_add_pixels4_clear;
653             } else {
654                 idct_dc_add = h->h264dsp.h264_idct_dc_add;
655                 idct_add    = h->h264dsp.h264_idct_add;
656             }
657             for (i = 0; i < 16; i++) {
658                 uint8_t *const ptr = dest_y + block_offset[i];
659                 const int dir      = h->intra4x4_pred_mode_cache[scan8[i]];
660
661                 if (transform_bypass && h->sps.profile_idc == 244 && dir <= 1) {
662                     h->hpc.pred4x4_add[dir](ptr, h->mb + (i * 16 + p * 256 << pixel_shift), linesize);
663                 } else {
664                     uint8_t *topright;
665                     int nnz, tr;
666                     uint64_t tr_high;
667                     if (dir == DIAG_DOWN_LEFT_PRED || dir == VERT_LEFT_PRED) {
668                         const int topright_avail = (h->topright_samples_available << i) & 0x8000;
669                         assert(h->mb_y || linesize <= block_offset[i]);
670                         if (!topright_avail) {
671                             if (pixel_shift) {
672                                 tr_high  = ((uint16_t *)ptr)[3 - linesize / 2] * 0x0001000100010001ULL;
673                                 topright = (uint8_t *)&tr_high;
674                             } else {
675                                 tr       = ptr[3 - linesize] * 0x01010101u;
676                                 topright = (uint8_t *)&tr;
677                             }
678                         } else
679                             topright = ptr + (4 << pixel_shift) - linesize;
680                     } else
681                         topright = NULL;
682
683                     h->hpc.pred4x4[dir](ptr, topright, linesize);
684                     nnz = h->non_zero_count_cache[scan8[i + p * 16]];
685                     if (nnz) {
686                         if (is_h264) {
687                             if (nnz == 1 && dctcoef_get(h->mb, pixel_shift, i * 16 + p * 256))
688                                 idct_dc_add(ptr, h->mb + (i * 16 + p * 256 << pixel_shift), linesize);
689                             else
690                                 idct_add(ptr, h->mb + (i * 16 + p * 256 << pixel_shift), linesize);
691                         } else if (CONFIG_SVQ3_DECODER)
692                             ff_svq3_add_idct_c(ptr, h->mb + i * 16 + p * 256, linesize, qscale, 0);
693                     }
694                 }
695             }
696         }
697     } else {
698         h->hpc.pred16x16[sl->intra16x16_pred_mode](dest_y, linesize);
699         if (is_h264) {
700             if (h->non_zero_count_cache[scan8[LUMA_DC_BLOCK_INDEX + p]]) {
701                 if (!transform_bypass)
702                     h->h264dsp.h264_luma_dc_dequant_idct(h->mb + (p * 256 << pixel_shift),
703                                                          h->mb_luma_dc[p],
704                                                          h->dequant4_coeff[p][qscale][0]);
705                 else {
706                     static const uint8_t dc_mapping[16] = {
707                          0 * 16,  1 * 16,  4 * 16,  5 * 16,
708                          2 * 16,  3 * 16,  6 * 16,  7 * 16,
709                          8 * 16,  9 * 16, 12 * 16, 13 * 16,
710                         10 * 16, 11 * 16, 14 * 16, 15 * 16
711                     };
712                     for (i = 0; i < 16; i++)
713                         dctcoef_set(h->mb + (p * 256 << pixel_shift),
714                                     pixel_shift, dc_mapping[i],
715                                     dctcoef_get(h->mb_luma_dc[p],
716                                                 pixel_shift, i));
717                 }
718             }
719         } else if (CONFIG_SVQ3_DECODER)
720             ff_svq3_luma_dc_dequant_idct_c(h->mb + p * 256,
721                                            h->mb_luma_dc[p], qscale);
722     }
723 }
724
725 static av_always_inline void hl_decode_mb_idct_luma(H264Context *h, H264SliceContext *sl,
726                                                     int mb_type,
727                                                     int is_h264, int simple,
728                                                     int transform_bypass,
729                                                     int pixel_shift,
730                                                     int *block_offset,
731                                                     int linesize,
732                                                     uint8_t *dest_y, int p)
733 {
734     void (*idct_add)(uint8_t *dst, int16_t *block, int stride);
735     int i;
736     block_offset += 16 * p;
737     if (!IS_INTRA4x4(mb_type)) {
738         if (is_h264) {
739             if (IS_INTRA16x16(mb_type)) {
740                 if (transform_bypass) {
741                     if (h->sps.profile_idc == 244 &&
742                         (sl->intra16x16_pred_mode == VERT_PRED8x8 ||
743                          sl->intra16x16_pred_mode == HOR_PRED8x8)) {
744                         h->hpc.pred16x16_add[sl->intra16x16_pred_mode](dest_y, block_offset,
745                                                                       h->mb + (p * 256 << pixel_shift),
746                                                                       linesize);
747                     } else {
748                         for (i = 0; i < 16; i++)
749                             if (h->non_zero_count_cache[scan8[i + p * 16]] ||
750                                 dctcoef_get(h->mb, pixel_shift, i * 16 + p * 256))
751                                 h->h264dsp.h264_add_pixels4_clear(dest_y + block_offset[i],
752                                                                   h->mb + (i * 16 + p * 256 << pixel_shift),
753                                                                   linesize);
754                     }
755                 } else {
756                     h->h264dsp.h264_idct_add16intra(dest_y, block_offset,
757                                                     h->mb + (p * 256 << pixel_shift),
758                                                     linesize,
759                                                     h->non_zero_count_cache + p * 5 * 8);
760                 }
761             } else if (h->cbp & 15) {
762                 if (transform_bypass) {
763                     const int di = IS_8x8DCT(mb_type) ? 4 : 1;
764                     idct_add = IS_8x8DCT(mb_type) ? h->h264dsp.h264_add_pixels8_clear
765                                                   : h->h264dsp.h264_add_pixels4_clear;
766                     for (i = 0; i < 16; i += di)
767                         if (h->non_zero_count_cache[scan8[i + p * 16]])
768                             idct_add(dest_y + block_offset[i],
769                                      h->mb + (i * 16 + p * 256 << pixel_shift),
770                                      linesize);
771                 } else {
772                     if (IS_8x8DCT(mb_type))
773                         h->h264dsp.h264_idct8_add4(dest_y, block_offset,
774                                                    h->mb + (p * 256 << pixel_shift),
775                                                    linesize,
776                                                    h->non_zero_count_cache + p * 5 * 8);
777                     else
778                         h->h264dsp.h264_idct_add16(dest_y, block_offset,
779                                                    h->mb + (p * 256 << pixel_shift),
780                                                    linesize,
781                                                    h->non_zero_count_cache + p * 5 * 8);
782                 }
783             }
784         } else if (CONFIG_SVQ3_DECODER) {
785             for (i = 0; i < 16; i++)
786                 if (h->non_zero_count_cache[scan8[i + p * 16]] || h->mb[i * 16 + p * 256]) {
787                     // FIXME benchmark weird rule, & below
788                     uint8_t *const ptr = dest_y + block_offset[i];
789                     ff_svq3_add_idct_c(ptr, h->mb + i * 16 + p * 256, linesize,
790                                        sl->qscale, IS_INTRA(mb_type) ? 1 : 0);
791                 }
792         }
793     }
794 }
795
796 #define BITS   8
797 #define SIMPLE 1
798 #include "h264_mb_template.c"
799
800 #undef  BITS
801 #define BITS   16
802 #include "h264_mb_template.c"
803
804 #undef  SIMPLE
805 #define SIMPLE 0
806 #include "h264_mb_template.c"
807
808 void ff_h264_hl_decode_mb(H264Context *h, H264SliceContext *sl)
809 {
810     const int mb_xy   = h->mb_xy;
811     const int mb_type = h->cur_pic.mb_type[mb_xy];
812     int is_complex    = CONFIG_SMALL || h->is_complex ||
813                         IS_INTRA_PCM(mb_type) || sl->qscale == 0;
814
815     if (CHROMA444(h)) {
816         if (is_complex || h->pixel_shift)
817             hl_decode_mb_444_complex(h, sl);
818         else
819             hl_decode_mb_444_simple_8(h, sl);
820     } else if (is_complex) {
821         hl_decode_mb_complex(h, sl);
822     } else if (h->pixel_shift) {
823         hl_decode_mb_simple_16(h, sl);
824     } else
825         hl_decode_mb_simple_8(h, sl);
826 }