2b2421ed16a5033c60a4d0104c74b33af29e524e
[ffmpeg.git] / libavcodec / hevcdsp_template.c
1 /*
2  * HEVC video decoder
3  *
4  * Copyright (C) 2012 - 2013 Guillaume Martres
5  *
6  * This file is part of FFmpeg.
7  *
8  * FFmpeg is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU Lesser General Public
10  * License as published by the Free Software Foundation; either
11  * version 2.1 of the License, or (at your option) any later version.
12  *
13  * FFmpeg is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16  * Lesser General Public License for more details.
17  *
18  * You should have received a copy of the GNU Lesser General Public
19  * License along with FFmpeg; if not, write to the Free Software
20  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
21  */
22
23 #include "get_bits.h"
24 #include "hevc.h"
25
26 #include "bit_depth_template.c"
27 #include "hevcdsp.h"
28
29
30 static void FUNC(put_pcm)(uint8_t *_dst, ptrdiff_t stride, int size,
31                           GetBitContext *gb, int pcm_bit_depth)
32 {
33     int x, y;
34     pixel *dst = (pixel *)_dst;
35
36     stride /= sizeof(pixel);
37
38     for (y = 0; y < size; y++) {
39         for (x = 0; x < size; x++)
40             dst[x] = get_bits(gb, pcm_bit_depth) << (BIT_DEPTH - pcm_bit_depth);
41         dst += stride;
42     }
43 }
44
45 static void FUNC(transquant_bypass4x4)(uint8_t *_dst, int16_t *coeffs,
46                                        ptrdiff_t stride)
47 {
48     int x, y;
49     pixel *dst = (pixel *)_dst;
50
51     stride /= sizeof(pixel);
52
53     for (y = 0; y < 4; y++) {
54         for (x = 0; x < 4; x++) {
55             dst[x] += *coeffs;
56             coeffs++;
57         }
58         dst += stride;
59     }
60 }
61
62 static void FUNC(transquant_bypass8x8)(uint8_t *_dst, int16_t *coeffs,
63                                        ptrdiff_t stride)
64 {
65     int x, y;
66     pixel *dst = (pixel *)_dst;
67
68     stride /= sizeof(pixel);
69
70     for (y = 0; y < 8; y++) {
71         for (x = 0; x < 8; x++) {
72             dst[x] += *coeffs;
73             coeffs++;
74         }
75         dst += stride;
76     }
77 }
78
79 static void FUNC(transquant_bypass16x16)(uint8_t *_dst, int16_t *coeffs,
80                                          ptrdiff_t stride)
81 {
82     int x, y;
83     pixel *dst = (pixel *)_dst;
84
85     stride /= sizeof(pixel);
86
87     for (y = 0; y < 16; y++) {
88         for (x = 0; x < 16; x++) {
89             dst[x] += *coeffs;
90             coeffs++;
91         }
92         dst += stride;
93     }
94 }
95
96 static void FUNC(transquant_bypass32x32)(uint8_t *_dst, int16_t *coeffs,
97                                          ptrdiff_t stride)
98 {
99     int x, y;
100     pixel *dst = (pixel *)_dst;
101
102     stride /= sizeof(pixel);
103
104     for (y = 0; y < 32; y++) {
105         for (x = 0; x < 32; x++) {
106             dst[x] += *coeffs;
107             coeffs++;
108         }
109         dst += stride;
110     }
111 }
112
113 static void FUNC(transform_skip)(uint8_t *_dst, int16_t *coeffs,
114                                  ptrdiff_t stride)
115 {
116     pixel *dst = (pixel *)_dst;
117     int shift  = 13 - BIT_DEPTH;
118 #if BIT_DEPTH <= 13
119     int offset = 1 << (shift - 1);
120 #else
121     int offset = 0;
122 #endif
123     int x, y;
124
125     stride /= sizeof(pixel);
126
127     for (y = 0; y < 4 * 4; y += 4) {
128         for (x = 0; x < 4; x++)
129             dst[x] = av_clip_pixel(dst[x] + ((coeffs[y + x] + offset) >> shift));
130         dst += stride;
131     }
132 }
133
134 #define SET(dst, x)   (dst) = (x)
135 #define SCALE(dst, x) (dst) = av_clip_int16(((x) + add) >> shift)
136 #define ADD_AND_SCALE(dst, x)                                           \
137     (dst) = av_clip_pixel((dst) + av_clip_int16(((x) + add) >> shift))
138
139 #define TR_4x4_LUMA(dst, src, step, assign)                             \
140     do {                                                                \
141         int c0 = src[0 * step] + src[2 * step];                         \
142         int c1 = src[2 * step] + src[3 * step];                         \
143         int c2 = src[0 * step] - src[3 * step];                         \
144         int c3 = 74 * src[1 * step];                                    \
145                                                                         \
146         assign(dst[2 * step], 74 * (src[0 * step] -                     \
147                                     src[2 * step] +                     \
148                                     src[3 * step]));                    \
149         assign(dst[0 * step], 29 * c0 + 55 * c1 + c3);                  \
150         assign(dst[1 * step], 55 * c2 - 29 * c1 + c3);                  \
151         assign(dst[3 * step], 55 * c0 + 29 * c2 - c3);                  \
152     } while (0)
153
154 static void FUNC(transform_4x4_luma_add)(uint8_t *_dst, int16_t *coeffs,
155                                          ptrdiff_t stride)
156 {
157     int i;
158     pixel *dst   = (pixel *)_dst;
159     int shift    = 7;
160     int add      = 1 << (shift - 1);
161     int16_t *src = coeffs;
162
163     stride /= sizeof(pixel);
164
165     for (i = 0; i < 4; i++) {
166         TR_4x4_LUMA(src, src, 4, SCALE);
167         src++;
168     }
169
170     shift = 20 - BIT_DEPTH;
171     add   = 1 << (shift - 1);
172     for (i = 0; i < 4; i++) {
173         TR_4x4_LUMA(dst, coeffs, 1, ADD_AND_SCALE);
174         coeffs += 4;
175         dst    += stride;
176     }
177 }
178
179 #undef TR_4x4_LUMA
180
181 #define TR_4(dst, src, dstep, sstep, assign)                            \
182     do {                                                                \
183         const int e0 = transform[8 * 0][0] * src[0 * sstep] +           \
184                        transform[8 * 2][0] * src[2 * sstep];            \
185         const int e1 = transform[8 * 0][1] * src[0 * sstep] +           \
186                        transform[8 * 2][1] * src[2 * sstep];            \
187         const int o0 = transform[8 * 1][0] * src[1 * sstep] +           \
188                        transform[8 * 3][0] * src[3 * sstep];            \
189         const int o1 = transform[8 * 1][1] * src[1 * sstep] +           \
190                        transform[8 * 3][1] * src[3 * sstep];            \
191                                                                         \
192         assign(dst[0 * dstep], e0 + o0);                                \
193         assign(dst[1 * dstep], e1 + o1);                                \
194         assign(dst[2 * dstep], e1 - o1);                                \
195         assign(dst[3 * dstep], e0 - o0);                                \
196     } while (0)
197 #define TR_4_1(dst, src) TR_4(dst, src, 4, 4, SCALE)
198 #define TR_4_2(dst, src) TR_4(dst, src, 1, 1, ADD_AND_SCALE)
199
200 static void FUNC(transform_4x4_add)(uint8_t *_dst, int16_t *coeffs,
201                                     ptrdiff_t stride)
202 {
203     int i;
204     pixel *dst   = (pixel *)_dst;
205     int shift    = 7;
206     int add      = 1 << (shift - 1);
207     int16_t *src = coeffs;
208
209     stride /= sizeof(pixel);
210
211     for (i = 0; i < 4; i++) {
212         TR_4_1(src, src);
213         src++;
214     }
215
216     shift = 20 - BIT_DEPTH;
217     add   = 1 << (shift - 1);
218     for (i = 0; i < 4; i++) {
219         TR_4_2(dst, coeffs);
220         coeffs += 4;
221         dst    += stride;
222     }
223 }
224
225 #define TR_8(dst, src, dstep, sstep, assign)                      \
226     do {                                                          \
227         int i, j;                                                 \
228         int e_8[4];                                               \
229         int o_8[4] = { 0 };                                       \
230         for (i = 0; i < 4; i++)                                   \
231             for (j = 1; j < 8; j += 2)                            \
232                 o_8[i] += transform[4 * j][i] * src[j * sstep];   \
233         TR_4(e_8, src, 1, 2 * sstep, SET);                        \
234                                                                   \
235         for (i = 0; i < 4; i++) {                                 \
236             assign(dst[i * dstep], e_8[i] + o_8[i]);              \
237             assign(dst[(7 - i) * dstep], e_8[i] - o_8[i]);        \
238         }                                                         \
239     } while (0)
240
241 #define TR_16(dst, src, dstep, sstep, assign)                     \
242     do {                                                          \
243         int i, j;                                                 \
244         int e_16[8];                                              \
245         int o_16[8] = { 0 };                                      \
246         for (i = 0; i < 8; i++)                                   \
247             for (j = 1; j < 16; j += 2)                           \
248                 o_16[i] += transform[2 * j][i] * src[j * sstep];  \
249         TR_8(e_16, src, 1, 2 * sstep, SET);                       \
250                                                                   \
251         for (i = 0; i < 8; i++) {                                 \
252             assign(dst[i * dstep], e_16[i] + o_16[i]);            \
253             assign(dst[(15 - i) * dstep], e_16[i] - o_16[i]);     \
254         }                                                         \
255     } while (0)
256
257 #define TR_32(dst, src, dstep, sstep, assign)                     \
258     do {                                                          \
259         int i, j;                                                 \
260         int e_32[16];                                             \
261         int o_32[16] = { 0 };                                     \
262         for (i = 0; i < 16; i++)                                  \
263             for (j = 1; j < 32; j += 2)                           \
264                 o_32[i] += transform[j][i] * src[j * sstep];      \
265         TR_16(e_32, src, 1, 2 * sstep, SET);                      \
266                                                                   \
267         for (i = 0; i < 16; i++) {                                \
268             assign(dst[i * dstep], e_32[i] + o_32[i]);            \
269             assign(dst[(31 - i) * dstep], e_32[i] - o_32[i]);     \
270         }                                                         \
271     } while (0)
272
273 #define TR_8_1(dst, src) TR_8(dst, src, 8, 8, SCALE)
274 #define TR_16_1(dst, src) TR_16(dst, src, 16, 16, SCALE)
275 #define TR_32_1(dst, src) TR_32(dst, src, 32, 32, SCALE)
276
277 #define TR_8_2(dst, src) TR_8(dst, src, 1, 1, ADD_AND_SCALE)
278 #define TR_16_2(dst, src) TR_16(dst, src, 1, 1, ADD_AND_SCALE)
279 #define TR_32_2(dst, src) TR_32(dst, src, 1, 1, ADD_AND_SCALE)
280
281 static void FUNC(transform_8x8_add)(uint8_t *_dst, int16_t *coeffs, ptrdiff_t stride)
282 {
283     int i;
284     pixel *dst   = (pixel *)_dst;
285     int shift    = 7;
286     int add      = 1 << (shift - 1);
287     int16_t *src = coeffs;
288
289     stride /= sizeof(pixel);
290
291     for (i = 0; i < 8; i++) {
292         TR_8_1(src, src);
293         src++;
294     }
295
296     shift = 20 - BIT_DEPTH;
297     add   = 1 << (shift - 1);
298     for (i = 0; i < 8; i++) {
299         TR_8_2(dst, coeffs);
300         coeffs += 8;
301         dst    += stride;
302     }
303 }
304
305 static void FUNC(transform_16x16_add)(uint8_t *_dst, int16_t *coeffs,
306                                       ptrdiff_t stride)
307 {
308     int i;
309     pixel *dst   = (pixel *)_dst;
310     int shift    = 7;
311     int add      = 1 << (shift - 1);
312     int16_t *src = coeffs;
313
314     stride /= sizeof(pixel);
315
316     for (i = 0; i < 16; i++) {
317         TR_16_1(src, src);
318         src++;
319     }
320
321     shift = 20 - BIT_DEPTH;
322     add   = 1 << (shift - 1);
323     for (i = 0; i < 16; i++) {
324         TR_16_2(dst, coeffs);
325         coeffs += 16;
326         dst    += stride;
327     }
328 }
329
330 static void FUNC(transform_32x32_add)(uint8_t *_dst, int16_t *coeffs,
331                                       ptrdiff_t stride)
332 {
333 #define IT32x32_even(i,w) ( src[ 0*w] * transform[ 0][i] ) + ( src[16*w] * transform[16][i] )
334 #define IT32x32_odd(i,w)  ( src[ 8*w] * transform[ 8][i] ) + ( src[24*w] * transform[24][i] )
335 #define IT16x16(i,w)      ( src[ 4*w] * transform[ 4][i] ) + ( src[12*w] * transform[12][i] ) + ( src[20*w] * transform[20][i] ) + ( src[28*w] * transform[28][i] )
336 #define IT8x8(i,w)        ( src[ 2*w] * transform[ 2][i] ) + ( src[ 6*w] * transform[ 6][i] ) + ( src[10*w] * transform[10][i] ) + ( src[14*w] * transform[14][i] ) + \
337                           ( src[18*w] * transform[18][i] ) + ( src[22*w] * transform[22][i] ) + ( src[26*w] * transform[26][i] ) + ( src[30*w] * transform[30][i] )
338 #define IT4x4(i,w)        ( src[ 1*w] * transform[ 1][i] ) + ( src[ 3*w] * transform[ 3][i] ) + ( src[ 5*w] * transform[ 5][i] ) + ( src[ 7*w] * transform[ 7][i] ) + \
339                           ( src[ 9*w] * transform[ 9][i] ) + ( src[11*w] * transform[11][i] ) + ( src[13*w] * transform[13][i] ) + ( src[15*w] * transform[15][i] ) + \
340                           ( src[17*w] * transform[17][i] ) + ( src[19*w] * transform[19][i] ) + ( src[21*w] * transform[21][i] ) + ( src[23*w] * transform[23][i] ) + \
341                           ( src[25*w] * transform[25][i] ) + ( src[27*w] * transform[27][i] ) + ( src[29*w] * transform[29][i] ) + ( src[31*w] * transform[31][i] )
342     int i;
343     pixel *dst   = (pixel *)_dst;
344     int shift    = 7;
345     int add      = 1 << (shift - 1);
346     int16_t *src = coeffs;
347
348     stride /= sizeof(pixel);
349
350     for (i = 0; i < 32; i++) {
351         TR_32_1(src, src);
352         src++;
353     }
354     src   = coeffs;
355     shift = 20 - BIT_DEPTH;
356     add   = 1 << (shift - 1);
357     for (i = 0; i < 32; i++) {
358         TR_32_2(dst, coeffs);
359         coeffs += 32;
360         dst    += stride;
361     }
362 #undef IT32x32_even
363 #undef IT32x32_odd
364 #undef IT16x16
365 #undef IT8x8
366 #undef IT4x4
367 }
368
369 static void FUNC(sao_band_filter)(uint8_t *_dst, uint8_t *_src,
370                                   ptrdiff_t stride, SAOParams *sao,
371                                   int *borders, int width, int height,
372                                   int c_idx, int class)
373 {
374     pixel *dst = (pixel *)_dst;
375     pixel *src = (pixel *)_src;
376     int offset_table[32] = { 0 };
377     int k, y, x;
378     int chroma = !!c_idx;
379     int shift  = BIT_DEPTH - 5;
380     int *sao_offset_val = sao->offset_val[c_idx];
381     int sao_left_class  = sao->band_position[c_idx];
382     int init_y = 0, init_x = 0;
383
384     stride /= sizeof(pixel);
385
386     switch (class) {
387     case 0:
388         if (!borders[2])
389             width -= (8 >> chroma) + 2;
390         if (!borders[3])
391             height -= (4 >> chroma) + 2;
392         break;
393     case 1:
394         init_y = -(4 >> chroma) - 2;
395         if (!borders[2])
396             width -= (8 >> chroma) + 2;
397         height = (4 >> chroma) + 2;
398         break;
399     case 2:
400         init_x = -(8 >> chroma) - 2;
401         width  =  (8 >> chroma) + 2;
402         if (!borders[3])
403             height -= (4 >> chroma) + 2;
404         break;
405     case 3:
406         init_y = -(4 >> chroma) - 2;
407         init_x = -(8 >> chroma) - 2;
408         width  =  (8 >> chroma) + 2;
409         height =  (4 >> chroma) + 2;
410         break;
411     }
412
413     dst = dst + (init_y * stride + init_x);
414     src = src + (init_y * stride + init_x);
415     for (k = 0; k < 4; k++)
416         offset_table[(k + sao_left_class) & 31] = sao_offset_val[k + 1];
417     for (y = 0; y < height; y++) {
418         for (x = 0; x < width; x++)
419             dst[x] = av_clip_pixel(src[x] + offset_table[av_clip_pixel(src[x] >> shift)]);
420         dst += stride;
421         src += stride;
422     }
423 }
424
425 static void FUNC(sao_band_filter_0)(uint8_t *dst, uint8_t *src,
426                                     ptrdiff_t stride, SAOParams *sao,
427                                     int *borders, int width, int height,
428                                     int c_idx)
429 {
430     FUNC(sao_band_filter)(dst, src, stride, sao, borders,
431                           width, height, c_idx, 0);
432 }
433
434 static void FUNC(sao_band_filter_1)(uint8_t *dst, uint8_t *src,
435                                     ptrdiff_t stride, SAOParams *sao,
436                                     int *borders, int width, int height,
437                                     int c_idx)
438 {
439     FUNC(sao_band_filter)(dst, src, stride, sao, borders,
440                           width, height, c_idx, 1);
441 }
442
443 static void FUNC(sao_band_filter_2)(uint8_t *dst, uint8_t *src,
444                                     ptrdiff_t stride, SAOParams *sao,
445                                     int *borders, int width, int height,
446                                     int c_idx)
447 {
448     FUNC(sao_band_filter)(dst, src, stride, sao, borders,
449                           width, height, c_idx, 2);
450 }
451
452 static void FUNC(sao_band_filter_3)(uint8_t *_dst, uint8_t *_src,
453                                     ptrdiff_t stride, SAOParams *sao,
454                                     int *borders, int width, int height,
455                                     int c_idx)
456 {
457     FUNC(sao_band_filter)(_dst, _src, stride, sao, borders,
458                           width, height, c_idx, 3);
459 }
460
461 static void FUNC(sao_edge_filter_0)(uint8_t *_dst, uint8_t *_src,
462                                     ptrdiff_t stride, SAOParams *sao,
463                                     int *borders, int _width, int _height,
464                                     int c_idx,
465                                     uint8_t vert_edge, uint8_t horiz_edge, uint8_t diag_edge)
466 {
467     int x, y;
468     pixel *dst = (pixel *)_dst;
469     pixel *src = (pixel *)_src;
470     int chroma = !!c_idx;
471     int *sao_offset_val = sao->offset_val[c_idx];
472     int sao_eo_class    = sao->eo_class[c_idx];
473
474     static const int8_t pos[4][2][2] = {
475         { { -1,  0 }, {  1, 0 } }, // horizontal
476         { {  0, -1 }, {  0, 1 } }, // vertical
477         { { -1, -1 }, {  1, 1 } }, // 45 degree
478         { {  1, -1 }, { -1, 1 } }, // 135 degree
479     };
480     static const uint8_t edge_idx[] = { 1, 2, 0, 3, 4 };
481
482     int init_x = 0, init_y = 0, width = _width, height = _height;
483
484     stride /= sizeof(pixel);
485 #define CMP(a, b) ((a) > (b) ? 1 : ((a) == (b) ? 0 : -1))
486
487     if (!borders[2])
488         width -= (8 >> chroma) + 2;
489     if (!borders[3])
490         height -= (4 >> chroma) + 2;
491
492     dst = dst + (init_y * stride + init_x);
493     src = src + (init_y * stride + init_x);
494     init_y = init_x = 0;
495     if (sao_eo_class != SAO_EO_VERT) {
496         if (borders[0]) {
497             int offset_val = sao_offset_val[0];
498             int y_stride   = 0;
499             for (y = 0; y < height; y++) {
500                 dst[y_stride] = av_clip_pixel(src[y_stride] + offset_val);
501                 y_stride     += stride;
502             }
503             init_x = 1;
504         }
505         if (borders[2]) {
506             int offset_val = sao_offset_val[0];
507             int x_stride   = width - 1;
508             for (x = 0; x < height; x++) {
509                 dst[x_stride] = av_clip_pixel(src[x_stride] + offset_val);
510                 x_stride     += stride;
511             }
512             width--;
513         }
514     }
515     if (sao_eo_class != SAO_EO_HORIZ) {
516         if (borders[1]) {
517             int offset_val = sao_offset_val[0];
518             for (x = init_x; x < width; x++)
519                 dst[x] = av_clip_pixel(src[x] + offset_val);
520             init_y = 1;
521         }
522         if (borders[3]) {
523             int offset_val = sao_offset_val[0];
524             int y_stride   = stride * (height - 1);
525             for (x = init_x; x < width; x++)
526                 dst[x + y_stride] = av_clip_pixel(src[x + y_stride] + offset_val);
527             height--;
528         }
529     }
530     {
531         int y_stride = init_y * stride;
532         int pos_0_0  = pos[sao_eo_class][0][0];
533         int pos_0_1  = pos[sao_eo_class][0][1];
534         int pos_1_0  = pos[sao_eo_class][1][0];
535         int pos_1_1  = pos[sao_eo_class][1][1];
536
537         int y_stride_0_1 = (init_y + pos_0_1) * stride;
538         int y_stride_1_1 = (init_y + pos_1_1) * stride;
539         for (y = init_y; y < height; y++) {
540             for (x = init_x; x < width; x++) {
541                 int diff0         = CMP(src[x + y_stride], src[x + pos_0_0 + y_stride_0_1]);
542                 int diff1         = CMP(src[x + y_stride], src[x + pos_1_0 + y_stride_1_1]);
543                 int offset_val    = edge_idx[2 + diff0 + diff1];
544                 dst[x + y_stride] = av_clip_pixel(src[x + y_stride] + sao_offset_val[offset_val]);
545             }
546             y_stride     += stride;
547             y_stride_0_1 += stride;
548             y_stride_1_1 += stride;
549         }
550     }
551
552     {
553         // Restore pixels that can't be modified
554         int save_upper_left = !diag_edge && sao_eo_class == SAO_EO_135D && !borders[0] && !borders[1];
555         if (vert_edge && sao_eo_class != SAO_EO_VERT)
556             for (y = init_y+save_upper_left; y< height; y++)
557                 dst[y*stride] = src[y*stride];
558         if(horiz_edge && sao_eo_class != SAO_EO_HORIZ)
559             for(x = init_x+save_upper_left; x<width; x++)
560                 dst[x] = src[x];
561         if(diag_edge && sao_eo_class == SAO_EO_135D)
562             dst[0] = src[0];
563     }
564
565 #undef CMP
566 }
567
568 static void FUNC(sao_edge_filter_1)(uint8_t *_dst, uint8_t *_src,
569                                     ptrdiff_t stride, SAOParams *sao,
570                                     int *borders, int _width, int _height,
571                                     int c_idx, uint8_t vert_edge,
572                                     uint8_t horiz_edge, uint8_t diag_edge)
573 {
574     int x, y;
575     pixel *dst = (pixel *)_dst;
576     pixel *src = (pixel *)_src;
577     int chroma = !!c_idx;
578     int *sao_offset_val = sao->offset_val[c_idx];
579     int sao_eo_class    = sao->eo_class[c_idx];
580
581     static const int8_t pos[4][2][2] = {
582         { { -1, 0  }, { 1,  0 } }, // horizontal
583         { { 0,  -1 }, { 0,  1 } }, // vertical
584         { { -1, -1 }, { 1,  1 } }, // 45 degree
585         { { 1,  -1 }, { -1, 1 } }, // 135 degree
586     };
587     static const uint8_t edge_idx[] = { 1, 2, 0, 3, 4 };
588
589     int init_x = 0, init_y = 0, width = _width, height = _height;
590
591 #define CMP(a, b) ((a) > (b) ? 1 : ((a) == (b) ? 0 : -1))
592     stride /= sizeof(pixel);
593
594     init_y = -(4 >> chroma) - 2;
595     if (!borders[2])
596         width -= (8 >> chroma) + 2;
597     height = (4 >> chroma) + 2;
598
599     dst = dst + (init_y * stride + init_x);
600     src = src + (init_y * stride + init_x);
601     init_y = init_x = 0;
602     if (sao_eo_class != SAO_EO_VERT) {
603         if (borders[0]) {
604             int offset_val = sao_offset_val[0];
605             int y_stride   = 0;
606             for (y = 0; y < height; y++) {
607                 dst[y_stride] = av_clip_pixel(src[y_stride] + offset_val);
608                 y_stride     += stride;
609             }
610             init_x = 1;
611         }
612         if (borders[2]) {
613             int offset_val = sao_offset_val[0];
614             int x_stride   = width - 1;
615             for (x = 0; x < height; x++) {
616                 dst[x_stride] = av_clip_pixel(src[x_stride] + offset_val);
617                 x_stride     += stride;
618             }
619             width--;
620         }
621     }
622     {
623         int y_stride = init_y * stride;
624         int pos_0_0  = pos[sao_eo_class][0][0];
625         int pos_0_1  = pos[sao_eo_class][0][1];
626         int pos_1_0  = pos[sao_eo_class][1][0];
627         int pos_1_1  = pos[sao_eo_class][1][1];
628
629         int y_stride_0_1 = (init_y + pos_0_1) * stride;
630         int y_stride_1_1 = (init_y + pos_1_1) * stride;
631         for (y = init_y; y < height; y++) {
632             for (x = init_x; x < width; x++) {
633                 int diff0         = CMP(src[x + y_stride], src[x + pos_0_0 + y_stride_0_1]);
634                 int diff1         = CMP(src[x + y_stride], src[x + pos_1_0 + y_stride_1_1]);
635                 int offset_val    = edge_idx[2 + diff0 + diff1];
636                 dst[x + y_stride] = av_clip_pixel(src[x + y_stride] + sao_offset_val[offset_val]);
637             }
638             y_stride     += stride;
639             y_stride_0_1 += stride;
640             y_stride_1_1 += stride;
641         }
642     }
643
644     {
645         // Restore pixels that can't be modified
646         int save_lower_left = !diag_edge && sao_eo_class == SAO_EO_45D && !borders[0];
647         if(vert_edge && sao_eo_class != SAO_EO_VERT)
648             for(y = init_y; y< height-save_lower_left; y++)
649                 dst[y*stride] = src[y*stride];
650         if(horiz_edge && sao_eo_class != SAO_EO_HORIZ)
651             for(x = init_x+save_lower_left; x<width; x++)
652                 dst[(height-1)*stride+x] = src[(height-1)*stride+x];
653         if(diag_edge && sao_eo_class == SAO_EO_45D)
654             dst[stride*(height-1)] = src[stride*(height-1)];
655     }
656
657 #undef CMP
658 }
659
660 static void FUNC(sao_edge_filter_2)(uint8_t *_dst, uint8_t *_src,
661                                     ptrdiff_t stride, SAOParams *sao,
662                                     int *borders, int _width, int _height,
663                                     int c_idx, uint8_t vert_edge,
664                                     uint8_t horiz_edge, uint8_t diag_edge)
665 {
666     int x, y;
667     pixel *dst = (pixel *)_dst;
668     pixel *src = (pixel *)_src;
669     int chroma = !!c_idx;
670     int *sao_offset_val = sao->offset_val[c_idx];
671     int sao_eo_class    = sao->eo_class[c_idx];
672
673     static const int8_t pos[4][2][2] = {
674         { { -1,  0 }, {  1, 0 } }, // horizontal
675         { {  0, -1 }, {  0, 1 } }, // vertical
676         { { -1, -1 }, {  1, 1 } }, // 45 degree
677         { {  1, -1 }, { -1, 1 } }, // 135 degree
678     };
679     static const uint8_t edge_idx[] = { 1, 2, 0, 3, 4 };
680
681     int init_x = 0, init_y = 0, width = _width, height = _height;
682
683 #define CMP(a, b) ((a) > (b) ? 1 : ((a) == (b) ? 0 : -1))
684     stride /= sizeof(pixel);
685
686     init_x = -(8 >> chroma) - 2;
687     width  =  (8 >> chroma) + 2;
688     if (!borders[3])
689         height -= (4 >> chroma) + 2;
690
691     dst = dst + (init_y * stride + init_x);
692     src = src + (init_y * stride + init_x);
693     init_y = init_x = 0;
694     if (sao_eo_class != SAO_EO_HORIZ) {
695         if (borders[1]) {
696             int offset_val = sao_offset_val[0];
697             for (x = init_x; x < width; x++)
698                 dst[x] = av_clip_pixel(src[x] + offset_val);
699             init_y = 1;
700         }
701         if (borders[3]) {
702             int offset_val = sao_offset_val[0];
703             int y_stride   = stride * (height - 1);
704             for (x = init_x; x < width; x++)
705                 dst[x + y_stride] = av_clip_pixel(src[x + y_stride] + offset_val);
706             height--;
707         }
708     }
709     {
710         int y_stride = init_y * stride;
711         int pos_0_0  = pos[sao_eo_class][0][0];
712         int pos_0_1  = pos[sao_eo_class][0][1];
713         int pos_1_0  = pos[sao_eo_class][1][0];
714         int pos_1_1  = pos[sao_eo_class][1][1];
715
716         int y_stride_0_1 = (init_y + pos_0_1) * stride;
717         int y_stride_1_1 = (init_y + pos_1_1) * stride;
718         for (y = init_y; y < height; y++) {
719             for (x = init_x; x < width; x++) {
720                 int diff0         = CMP(src[x + y_stride], src[x + pos_0_0 + y_stride_0_1]);
721                 int diff1         = CMP(src[x + y_stride], src[x + pos_1_0 + y_stride_1_1]);
722                 int offset_val    = edge_idx[2 + diff0 + diff1];
723                 dst[x + y_stride] = av_clip_pixel(src[x + y_stride] + sao_offset_val[offset_val]);
724             }
725             y_stride     += stride;
726             y_stride_0_1 += stride;
727             y_stride_1_1 += stride;
728         }
729     }
730
731     {
732         // Restore pixels that can't be modified
733         int save_upper_right = !diag_edge && sao_eo_class == SAO_EO_45D && !borders[1];
734         if(vert_edge && sao_eo_class != SAO_EO_VERT)
735             for(y = init_y+save_upper_right; y< height; y++)
736                 dst[y*stride+width-1] = src[y*stride+width-1];
737         if(horiz_edge && sao_eo_class != SAO_EO_HORIZ)
738             for(x = init_x; x<width-save_upper_right; x++)
739                 dst[x] = src[x];
740         if(diag_edge && sao_eo_class == SAO_EO_45D)
741             dst[width-1] = src[width-1];
742     }
743 #undef CMP
744 }
745
746 static void FUNC(sao_edge_filter_3)(uint8_t *_dst, uint8_t *_src,
747                                     ptrdiff_t stride, SAOParams *sao,
748                                     int *borders, int _width, int _height,
749                                     int c_idx, uint8_t vert_edge,
750                                     uint8_t horiz_edge, uint8_t diag_edge)
751 {
752     int x, y;
753     pixel *dst = (pixel *)_dst;
754     pixel *src = (pixel *)_src;
755     int chroma = !!c_idx;
756     int *sao_offset_val = sao->offset_val[c_idx];
757     int sao_eo_class    = sao->eo_class[c_idx];
758
759     static const int8_t pos[4][2][2] = {
760         { { -1,  0 }, {  1, 0 } }, // horizontal
761         { {  0, -1 }, {  0, 1 } }, // vertical
762         { { -1, -1 }, {  1, 1 } }, // 45 degree
763         { {  1, -1 }, { -1, 1 } }, // 135 degree
764     };
765     static const uint8_t edge_idx[] = { 1, 2, 0, 3, 4 };
766
767     int init_x = 0, init_y = 0, width = _width, height = _height;
768
769 #define CMP(a, b) ((a) > (b) ? 1 : ((a) == (b) ? 0 : -1))
770     stride /= sizeof(pixel);
771
772     init_y = -(4 >> chroma) - 2;
773     init_x = -(8 >> chroma) - 2;
774     width  =  (8 >> chroma) + 2;
775     height =  (4 >> chroma) + 2;
776
777
778     dst    = dst + (init_y * stride + init_x);
779     src    = src + (init_y * stride + init_x);
780     init_y = init_x = 0;
781
782     {
783         int y_stride = init_y * stride;
784         int pos_0_0  = pos[sao_eo_class][0][0];
785         int pos_0_1  = pos[sao_eo_class][0][1];
786         int pos_1_0  = pos[sao_eo_class][1][0];
787         int pos_1_1  = pos[sao_eo_class][1][1];
788
789         int y_stride_0_1 = (init_y + pos_0_1) * stride;
790         int y_stride_1_1 = (init_y + pos_1_1) * stride;
791
792         for (y = init_y; y < height; y++) {
793             for (x = init_x; x < width; x++) {
794                 int diff0         = CMP(src[x + y_stride], src[x + pos_0_0 + y_stride_0_1]);
795                 int diff1         = CMP(src[x + y_stride], src[x + pos_1_0 + y_stride_1_1]);
796                 int offset_val    = edge_idx[2 + diff0 + diff1];
797                 dst[x + y_stride] = av_clip_pixel(src[x + y_stride] + sao_offset_val[offset_val]);
798             }
799             y_stride     += stride;
800             y_stride_0_1 += stride;
801             y_stride_1_1 += stride;
802         }
803     }
804
805     {
806         // Restore pixels that can't be modified
807         int save_lower_right = !diag_edge && sao_eo_class == SAO_EO_135D;
808         if(vert_edge && sao_eo_class != SAO_EO_VERT)
809             for(y = init_y; y< height-save_lower_right; y++)
810                 dst[y*stride+width-1] = src[y*stride+width-1];
811         if(horiz_edge && sao_eo_class != SAO_EO_HORIZ)
812             for(x = init_x; x<width-save_lower_right; x++)
813                 dst[(height-1)*stride+x] = src[(height-1)*stride+x];
814         if(diag_edge && sao_eo_class == SAO_EO_135D)
815             dst[stride*(height-1)+width-1] = src[stride*(height-1)+width-1];
816     }
817 #undef CMP
818 }
819
820 #undef SET
821 #undef SCALE
822 #undef ADD_AND_SCALE
823 #undef TR_4
824 #undef TR_4_1
825 #undef TR_4_2
826 #undef TR_8
827 #undef TR_8_1
828 #undef TR_8_2
829 #undef TR_16
830 #undef TR_16_1
831 #undef TR_16_2
832 #undef TR_32
833 #undef TR_32_1
834 #undef TR_32_2
835
836 static void FUNC(put_hevc_qpel_pixels)(int16_t *dst, ptrdiff_t dststride,
837                                        uint8_t *_src, ptrdiff_t _srcstride,
838                                        int width, int height, int16_t* mcbuffer)
839 {
840     int x, y;
841     pixel *src          = (pixel *)_src;
842     ptrdiff_t srcstride = _srcstride / sizeof(pixel);
843
844     for (y = 0; y < height; y++) {
845         for (x = 0; x < width; x++)
846             dst[x] = src[x] << (14 - BIT_DEPTH);
847         src += srcstride;
848         dst += dststride;
849     }
850 }
851
852 #define QPEL_FILTER_1(src, stride)      \
853     (1 * -src[x - 3 * stride] +         \
854      4 *  src[x - 2 * stride] -         \
855     10 *  src[x -     stride] +         \
856     58 *  src[x]              +         \
857     17 *  src[x +     stride] -         \
858      5 *  src[x + 2 * stride] +         \
859      1 *  src[x + 3 * stride])
860
861 #define QPEL_FILTER_2(src, stride)      \
862     (1  * -src[x - 3 * stride] +        \
863      4  *  src[x - 2 * stride] -        \
864     11  *  src[x -     stride] +        \
865     40  *  src[x]              +        \
866     40  *  src[x +     stride] -        \
867     11  *  src[x + 2 * stride] +        \
868      4  *  src[x + 3 * stride] -        \
869      1  *  src[x + 4 * stride])
870
871 #define QPEL_FILTER_3(src, stride)      \
872     (1  * src[x - 2 * stride] -         \
873      5  * src[x -     stride] +         \
874     17  * src[x]              +         \
875     58  * src[x + stride]     -         \
876     10  * src[x + 2 * stride] +         \
877      4  * src[x + 3 * stride] -         \
878      1  * src[x + 4 * stride])
879
880
881 #define PUT_HEVC_QPEL_H(H)                                                     \
882 static void FUNC(put_hevc_qpel_h ## H)(int16_t *dst,  ptrdiff_t dststride,     \
883                                        uint8_t *_src, ptrdiff_t _srcstride,    \
884                                        int width, int height,                  \
885                                        int16_t* mcbuffer)                      \
886 {                                                                              \
887     int x, y;                                                                  \
888     pixel *src = (pixel*)_src;                                                 \
889     ptrdiff_t srcstride = _srcstride / sizeof(pixel);                          \
890                                                                                \
891     for (y = 0; y < height; y++) {                                             \
892         for (x = 0; x < width; x++)                                            \
893             dst[x] = QPEL_FILTER_ ## H(src, 1) >> (BIT_DEPTH - 8);             \
894         src += srcstride;                                                      \
895         dst += dststride;                                                      \
896     }                                                                          \
897 }
898
899 #define PUT_HEVC_QPEL_V(V)                                                     \
900 static void FUNC(put_hevc_qpel_v ## V)(int16_t *dst,  ptrdiff_t dststride,     \
901                                        uint8_t *_src, ptrdiff_t _srcstride,    \
902                                        int width, int height,                  \
903                                        int16_t* mcbuffer)                      \
904 {                                                                              \
905     int x, y;                                                                  \
906     pixel *src = (pixel*)_src;                                                 \
907     ptrdiff_t srcstride = _srcstride / sizeof(pixel);                          \
908                                                                                \
909     for (y = 0; y < height; y++)  {                                            \
910         for (x = 0; x < width; x++)                                            \
911             dst[x] = QPEL_FILTER_ ## V(src, srcstride) >> (BIT_DEPTH - 8);     \
912         src += srcstride;                                                      \
913         dst += dststride;                                                      \
914     }                                                                          \
915 }
916
917 #define PUT_HEVC_QPEL_HV(H, V)                                                 \
918 static void FUNC(put_hevc_qpel_h ## H ## v ## V)(int16_t *dst,                 \
919                                                  ptrdiff_t dststride,          \
920                                                  uint8_t *_src,                \
921                                                  ptrdiff_t _srcstride,         \
922                                                  int width, int height,        \
923                                                  int16_t* mcbuffer)            \
924 {                                                                              \
925     int x, y;                                                                  \
926     pixel *src = (pixel*)_src;                                                 \
927     ptrdiff_t srcstride = _srcstride / sizeof(pixel);                          \
928                                                                                \
929     int16_t tmp_array[(MAX_PB_SIZE + 7) * MAX_PB_SIZE];                        \
930     int16_t *tmp = tmp_array;                                                  \
931                                                                                \
932     src -= ff_hevc_qpel_extra_before[V] * srcstride;                           \
933                                                                                \
934     for (y = 0; y < height + ff_hevc_qpel_extra[V]; y++) {                     \
935         for (x = 0; x < width; x++)                                            \
936             tmp[x] = QPEL_FILTER_ ## H(src, 1) >> (BIT_DEPTH - 8);             \
937         src += srcstride;                                                      \
938         tmp += MAX_PB_SIZE;                                                    \
939     }                                                                          \
940                                                                                \
941     tmp = tmp_array + ff_hevc_qpel_extra_before[V] * MAX_PB_SIZE;              \
942                                                                                \
943     for (y = 0; y < height; y++) {                                             \
944         for (x = 0; x < width; x++)                                            \
945             dst[x] = QPEL_FILTER_ ## V(tmp, MAX_PB_SIZE) >> 6;                 \
946         tmp += MAX_PB_SIZE;                                                    \
947         dst += dststride;                                                      \
948     }                                                                          \
949 }
950
951 PUT_HEVC_QPEL_H(1)
952 PUT_HEVC_QPEL_H(2)
953 PUT_HEVC_QPEL_H(3)
954 PUT_HEVC_QPEL_V(1)
955 PUT_HEVC_QPEL_V(2)
956 PUT_HEVC_QPEL_V(3)
957 PUT_HEVC_QPEL_HV(1, 1)
958 PUT_HEVC_QPEL_HV(1, 2)
959 PUT_HEVC_QPEL_HV(1, 3)
960 PUT_HEVC_QPEL_HV(2, 1)
961 PUT_HEVC_QPEL_HV(2, 2)
962 PUT_HEVC_QPEL_HV(2, 3)
963 PUT_HEVC_QPEL_HV(3, 1)
964 PUT_HEVC_QPEL_HV(3, 2)
965 PUT_HEVC_QPEL_HV(3, 3)
966
967 static void FUNC(put_hevc_epel_pixels)(int16_t *dst, ptrdiff_t dststride,
968                                        uint8_t *_src, ptrdiff_t _srcstride,
969                                        int width, int height, int mx, int my,
970                                        int16_t* mcbuffer)
971 {
972     int x, y;
973     pixel *src          = (pixel *)_src;
974     ptrdiff_t srcstride = _srcstride / sizeof(pixel);
975
976     for (y = 0; y < height; y++) {
977         for (x = 0; x < width; x++)
978             dst[x] = src[x] << (14 - BIT_DEPTH);
979         src += srcstride;
980         dst += dststride;
981     }
982 }
983
984 #define EPEL_FILTER(src, stride)                \
985     (filter_0 * src[x - stride] +               \
986      filter_1 * src[x]          +               \
987      filter_2 * src[x + stride] +               \
988      filter_3 * src[x + 2 * stride])
989
990 static void FUNC(put_hevc_epel_h)(int16_t *dst, ptrdiff_t dststride,
991                                   uint8_t *_src, ptrdiff_t _srcstride,
992                                   int width, int height, int mx, int my,
993                                   int16_t* mcbuffer)
994 {
995     int x, y;
996     pixel *src = (pixel *)_src;
997     ptrdiff_t srcstride  = _srcstride / sizeof(pixel);
998     const int8_t *filter = ff_hevc_epel_filters[mx - 1];
999     int8_t filter_0 = filter[0];
1000     int8_t filter_1 = filter[1];
1001     int8_t filter_2 = filter[2];
1002     int8_t filter_3 = filter[3];
1003     for (y = 0; y < height; y++) {
1004         for (x = 0; x < width; x++)
1005             dst[x] = EPEL_FILTER(src, 1) >> (BIT_DEPTH - 8);
1006         src += srcstride;
1007         dst += dststride;
1008     }
1009 }
1010
1011 static void FUNC(put_hevc_epel_v)(int16_t *dst, ptrdiff_t dststride,
1012                                   uint8_t *_src, ptrdiff_t _srcstride,
1013                                   int width, int height, int mx, int my,
1014                                   int16_t* mcbuffer)
1015 {
1016     int x, y;
1017     pixel *src = (pixel *)_src;
1018     ptrdiff_t srcstride = _srcstride / sizeof(pixel);
1019     const int8_t *filter = ff_hevc_epel_filters[my - 1];
1020     int8_t filter_0 = filter[0];
1021     int8_t filter_1 = filter[1];
1022     int8_t filter_2 = filter[2];
1023     int8_t filter_3 = filter[3];
1024
1025     for (y = 0; y < height; y++) {
1026         for (x = 0; x < width; x++)
1027             dst[x] = EPEL_FILTER(src, srcstride) >> (BIT_DEPTH - 8);
1028         src += srcstride;
1029         dst += dststride;
1030     }
1031 }
1032
1033 static void FUNC(put_hevc_epel_hv)(int16_t *dst, ptrdiff_t dststride,
1034                                    uint8_t *_src, ptrdiff_t _srcstride,
1035                                    int width, int height, int mx, int my,
1036                                    int16_t* mcbuffer)
1037 {
1038     int x, y;
1039     pixel *src = (pixel *)_src;
1040     ptrdiff_t srcstride = _srcstride / sizeof(pixel);
1041     const int8_t *filter_h = ff_hevc_epel_filters[mx - 1];
1042     const int8_t *filter_v = ff_hevc_epel_filters[my - 1];
1043     int8_t filter_0 = filter_h[0];
1044     int8_t filter_1 = filter_h[1];
1045     int8_t filter_2 = filter_h[2];
1046     int8_t filter_3 = filter_h[3];
1047     int16_t tmp_array[(MAX_PB_SIZE + 3) * MAX_PB_SIZE];
1048     int16_t *tmp = tmp_array;
1049
1050     src -= EPEL_EXTRA_BEFORE * srcstride;
1051
1052     for (y = 0; y < height + EPEL_EXTRA; y++) {
1053         for (x = 0; x < width; x++)
1054             tmp[x] = EPEL_FILTER(src, 1) >> (BIT_DEPTH - 8);
1055         src += srcstride;
1056         tmp += MAX_PB_SIZE;
1057     }
1058
1059     tmp      = tmp_array + EPEL_EXTRA_BEFORE * MAX_PB_SIZE;
1060     filter_0 = filter_v[0];
1061     filter_1 = filter_v[1];
1062     filter_2 = filter_v[2];
1063     filter_3 = filter_v[3];
1064     for (y = 0; y < height; y++) {
1065         for (x = 0; x < width; x++)
1066             dst[x] = EPEL_FILTER(tmp, MAX_PB_SIZE) >> 6;
1067         tmp += MAX_PB_SIZE;
1068         dst += dststride;
1069     }
1070 }
1071
1072 static void FUNC(put_unweighted_pred)(uint8_t *_dst, ptrdiff_t _dststride,
1073                                       int16_t *src, ptrdiff_t srcstride,
1074                                       int width, int height)
1075 {
1076     int x, y;
1077     pixel *dst          = (pixel *)_dst;
1078     ptrdiff_t dststride = _dststride / sizeof(pixel);
1079
1080     int shift = 14 - BIT_DEPTH;
1081 #if BIT_DEPTH < 14
1082     int offset = 1 << (shift - 1);
1083 #else
1084     int offset = 0;
1085 #endif
1086     for (y = 0; y < height; y++) {
1087         for (x = 0; x < width; x++)
1088             dst[x] = av_clip_pixel((src[x] + offset) >> shift);
1089         dst += dststride;
1090         src += srcstride;
1091     }
1092 }
1093
1094 static void FUNC(put_weighted_pred_avg)(uint8_t *_dst, ptrdiff_t _dststride,
1095                                         int16_t *src1, int16_t *src2,
1096                                         ptrdiff_t srcstride,
1097                                         int width, int height)
1098 {
1099     int x, y;
1100     pixel *dst          = (pixel *)_dst;
1101     ptrdiff_t dststride = _dststride / sizeof(pixel);
1102
1103     int shift = 14 + 1 - BIT_DEPTH;
1104 #if BIT_DEPTH < 14
1105     int offset = 1 << (shift - 1);
1106 #else
1107     int offset = 0;
1108 #endif
1109
1110     for (y = 0; y < height; y++) {
1111         for (x = 0; x < width; x++)
1112             dst[x] = av_clip_pixel((src1[x] + src2[x] + offset) >> shift);
1113         dst  += dststride;
1114         src1 += srcstride;
1115         src2 += srcstride;
1116     }
1117 }
1118
1119 static void FUNC(weighted_pred)(uint8_t denom, int16_t wlxFlag, int16_t olxFlag,
1120                                 uint8_t *_dst, ptrdiff_t _dststride,
1121                                 int16_t *src, ptrdiff_t srcstride,
1122                                 int width, int height)
1123 {
1124     int shift;
1125     int log2Wd;
1126     int wx;
1127     int ox;
1128     int x, y;
1129     int offset;
1130     pixel *dst          = (pixel *)_dst;
1131     ptrdiff_t dststride = _dststride / sizeof(pixel);
1132
1133     shift  = 14 - BIT_DEPTH;
1134     log2Wd = denom + shift;
1135     offset = 1 << (log2Wd - 1);
1136     wx     = wlxFlag;
1137     ox     = olxFlag * (1 << (BIT_DEPTH - 8));
1138
1139     for (y = 0; y < height; y++) {
1140         for (x = 0; x < width; x++) {
1141             if (log2Wd >= 1) {
1142                 dst[x] = av_clip_pixel(((src[x] * wx + offset) >> log2Wd) + ox);
1143             } else {
1144                 dst[x] = av_clip_pixel(src[x] * wx + ox);
1145             }
1146         }
1147         dst += dststride;
1148         src += srcstride;
1149     }
1150 }
1151
1152 static void FUNC(weighted_pred_avg)(uint8_t denom,
1153                                     int16_t wl0Flag, int16_t wl1Flag,
1154                                     int16_t ol0Flag, int16_t ol1Flag,
1155                                     uint8_t *_dst, ptrdiff_t _dststride,
1156                                     int16_t *src1, int16_t *src2,
1157                                     ptrdiff_t srcstride,
1158                                     int width, int height)
1159 {
1160     int shift;
1161     int log2Wd;
1162     int w0;
1163     int w1;
1164     int o0;
1165     int o1;
1166     int x, y;
1167     pixel *dst = (pixel *)_dst;
1168     ptrdiff_t dststride = _dststride / sizeof(pixel);
1169
1170     shift  = 14 - BIT_DEPTH;
1171     log2Wd = denom + shift;
1172     w0     = wl0Flag;
1173     w1     = wl1Flag;
1174     o0     = ol0Flag * (1 << (BIT_DEPTH - 8));
1175     o1     = ol1Flag * (1 << (BIT_DEPTH - 8));
1176
1177     for (y = 0; y < height; y++) {
1178         for (x = 0; x < width; x++)
1179             dst[x] = av_clip_pixel((src1[x] * w0 + src2[x] * w1 +
1180                                     ((o0 + o1 + 1) << log2Wd)) >> (log2Wd + 1));
1181         dst  += dststride;
1182         src1 += srcstride;
1183         src2 += srcstride;
1184     }
1185 }
1186
1187 // line zero
1188 #define P3 pix[-4 * xstride]
1189 #define P2 pix[-3 * xstride]
1190 #define P1 pix[-2 * xstride]
1191 #define P0 pix[-1 * xstride]
1192 #define Q0 pix[0]
1193 #define Q1 pix[1 * xstride]
1194 #define Q2 pix[2 * xstride]
1195 #define Q3 pix[3 * xstride]
1196
1197 // line three. used only for deblocking decision
1198 #define TP3 pix[-4 * xstride + 3 * ystride]
1199 #define TP2 pix[-3 * xstride + 3 * ystride]
1200 #define TP1 pix[-2 * xstride + 3 * ystride]
1201 #define TP0 pix[-1 * xstride + 3 * ystride]
1202 #define TQ0 pix[3 * ystride]
1203 #define TQ1 pix[1  * xstride + 3 * ystride]
1204 #define TQ2 pix[2  * xstride + 3 * ystride]
1205 #define TQ3 pix[3  * xstride + 3 * ystride]
1206
1207 static void FUNC(hevc_loop_filter_luma)(uint8_t *_pix,
1208                                         ptrdiff_t _xstride, ptrdiff_t _ystride,
1209                                         int *_beta, int *_tc,
1210                                         uint8_t *_no_p, uint8_t *_no_q)
1211 {
1212     int d, j;
1213     pixel *pix        = (pixel *)_pix;
1214     ptrdiff_t xstride = _xstride / sizeof(pixel);
1215     ptrdiff_t ystride = _ystride / sizeof(pixel);
1216
1217     for (j = 0; j < 2; j++) {
1218         const int dp0  = abs(P2  - 2 * P1  + P0);
1219         const int dq0  = abs(Q2  - 2 * Q1  + Q0);
1220         const int dp3  = abs(TP2 - 2 * TP1 + TP0);
1221         const int dq3  = abs(TQ2 - 2 * TQ1 + TQ0);
1222         const int d0   = dp0 + dq0;
1223         const int d3   = dp3 + dq3;
1224         const int beta = _beta[j] << (BIT_DEPTH - 8);
1225         const int tc   = _tc[j]   << (BIT_DEPTH - 8);
1226         const int no_p = _no_p[j];
1227         const int no_q = _no_q[j];
1228
1229         if (d0 + d3 >= beta /*|| tc <= 0*/) {
1230             pix += 4 * ystride;
1231             continue;
1232         } else {
1233             const int beta_3 = beta >> 3;
1234             const int beta_2 = beta >> 2;
1235             const int tc25   = ((tc * 5 + 1) >> 1);
1236
1237             if (abs(P3  -  P0) + abs(Q3  -  Q0) < beta_3 && abs(P0  -  Q0) < tc25 &&
1238                 abs(TP3 - TP0) + abs(TQ3 - TQ0) < beta_3 && abs(TP0 - TQ0) < tc25 &&
1239                                       (d0 << 1) < beta_2 &&      (d3 << 1) < beta_2) {
1240                 // strong filtering
1241                 const int tc2 = tc << 1;
1242                 for (d = 0; d < 4; d++) {
1243                     const int p3 = P3;
1244                     const int p2 = P2;
1245                     const int p1 = P1;
1246                     const int p0 = P0;
1247                     const int q0 = Q0;
1248                     const int q1 = Q1;
1249                     const int q2 = Q2;
1250                     const int q3 = Q3;
1251                     if (!no_p) {
1252                         P0 = p0 + av_clip(((p2 + 2 * p1 + 2 * p0 + 2 * q0 + q1 + 4) >> 3) - p0, -tc2, tc2);
1253                         P1 = p1 + av_clip(((p2 + p1 + p0 + q0 + 2) >> 2) - p1, -tc2, tc2);
1254                         P2 = p2 + av_clip(((2 * p3 + 3 * p2 + p1 + p0 + q0 + 4) >> 3) - p2, -tc2, tc2);
1255                     }
1256                     if (!no_q) {
1257                         Q0 = q0 + av_clip(((p1 + 2 * p0 + 2 * q0 + 2 * q1 + q2 + 4) >> 3) - q0, -tc2, tc2);
1258                         Q1 = q1 + av_clip(((p0 + q0 + q1 + q2 + 2) >> 2) - q1, -tc2, tc2);
1259                         Q2 = q2 + av_clip(((2 * q3 + 3 * q2 + q1 + q0 + p0 + 4) >> 3) - q2, -tc2, tc2);
1260                     }
1261                     pix += ystride;
1262                 }
1263             } else { // normal filtering
1264                 int nd_p = 1;
1265                 int nd_q = 1;
1266                 const int tc_2 = tc >> 1;
1267                 if (dp0 + dp3 < ((beta + (beta >> 1)) >> 3))
1268                     nd_p = 2;
1269                 if (dq0 + dq3 < ((beta + (beta >> 1)) >> 3))
1270                     nd_q = 2;
1271
1272                 for (d = 0; d < 4; d++) {
1273                     const int p2 = P2;
1274                     const int p1 = P1;
1275                     const int p0 = P0;
1276                     const int q0 = Q0;
1277                     const int q1 = Q1;
1278                     const int q2 = Q2;
1279                     int delta0   = (9 * (q0 - p0) - 3 * (q1 - p1) + 8) >> 4;
1280                     if (abs(delta0) < 10 * tc) {
1281                         delta0 = av_clip(delta0, -tc, tc);
1282                         if (!no_p)
1283                             P0 = av_clip_pixel(p0 + delta0);
1284                         if (!no_q)
1285                             Q0 = av_clip_pixel(q0 - delta0);
1286                         if (!no_p && nd_p > 1) {
1287                             const int deltap1 = av_clip((((p2 + p0 + 1) >> 1) - p1 + delta0) >> 1, -tc_2, tc_2);
1288                             P1 = av_clip_pixel(p1 + deltap1);
1289                         }
1290                         if (!no_q && nd_q > 1) {
1291                             const int deltaq1 = av_clip((((q2 + q0 + 1) >> 1) - q1 - delta0) >> 1, -tc_2, tc_2);
1292                             Q1 = av_clip_pixel(q1 + deltaq1);
1293                         }
1294                     }
1295                     pix += ystride;
1296                 }
1297             }
1298         }
1299     }
1300 }
1301
1302 static void FUNC(hevc_loop_filter_chroma)(uint8_t *_pix, ptrdiff_t _xstride,
1303                                           ptrdiff_t _ystride, int *_tc,
1304                                           uint8_t *_no_p, uint8_t *_no_q)
1305 {
1306     int d, j;
1307     int no_p, no_q;
1308     pixel *pix        = (pixel *)_pix;
1309     ptrdiff_t xstride = _xstride / sizeof(pixel);
1310     ptrdiff_t ystride = _ystride / sizeof(pixel);
1311
1312     for (j = 0; j < 2; j++) {
1313         const int tc = _tc[j] << (BIT_DEPTH - 8);
1314         if (tc <= 0) {
1315             pix += 4 * ystride;
1316             continue;
1317         }
1318         no_p = _no_p[j];
1319         no_q = _no_q[j];
1320
1321         for (d = 0; d < 4; d++) {
1322             int delta0;
1323             const int p1 = P1;
1324             const int p0 = P0;
1325             const int q0 = Q0;
1326             const int q1 = Q1;
1327             delta0 = av_clip((((q0 - p0) << 2) + p1 - q1 + 4) >> 3, -tc, tc);
1328             if (!no_p)
1329                 P0 = av_clip_pixel(p0 + delta0);
1330             if (!no_q)
1331                 Q0 = av_clip_pixel(q0 - delta0);
1332             pix += ystride;
1333         }
1334     }
1335 }
1336
1337 static void FUNC(hevc_h_loop_filter_chroma)(uint8_t *pix, ptrdiff_t stride,
1338                                             int *tc, uint8_t *no_p,
1339                                             uint8_t *no_q)
1340 {
1341     FUNC(hevc_loop_filter_chroma)(pix, stride, sizeof(pixel), tc, no_p, no_q);
1342 }
1343
1344 static void FUNC(hevc_v_loop_filter_chroma)(uint8_t *pix, ptrdiff_t stride,
1345                                             int *tc, uint8_t *no_p,
1346                                             uint8_t *no_q)
1347 {
1348     FUNC(hevc_loop_filter_chroma)(pix, sizeof(pixel), stride, tc, no_p, no_q);
1349 }
1350
1351 static void FUNC(hevc_h_loop_filter_luma)(uint8_t *pix, ptrdiff_t stride,
1352                                           int *beta, int *tc, uint8_t *no_p,
1353                                           uint8_t *no_q)
1354 {
1355     FUNC(hevc_loop_filter_luma)(pix, stride, sizeof(pixel),
1356                                 beta, tc, no_p, no_q);
1357 }
1358
1359 static void FUNC(hevc_v_loop_filter_luma)(uint8_t *pix, ptrdiff_t stride,
1360                                           int *beta, int *tc, uint8_t *no_p,
1361                                           uint8_t *no_q)
1362 {
1363     FUNC(hevc_loop_filter_luma)(pix, sizeof(pixel), stride,
1364                                 beta, tc, no_p, no_q);
1365 }
1366
1367 #undef P3
1368 #undef P2
1369 #undef P1
1370 #undef P0
1371 #undef Q0
1372 #undef Q1
1373 #undef Q2
1374 #undef Q3
1375
1376 #undef TP3
1377 #undef TP2
1378 #undef TP1
1379 #undef TP0
1380 #undef TQ0
1381 #undef TQ1
1382 #undef TQ2
1383 #undef TQ3