avcodec/vc1: fix calculation of the last line of a slice
[ffmpeg.git] / libavcodec / ivi_dsp.c
1 /*
2  * DSP functions for Indeo Video Interactive codecs (Indeo4 and Indeo5)
3  *
4  * Copyright (c) 2009-2011 Maxim Poliakovski
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 /**
24  * @file
25  * DSP functions (inverse transforms, motion compensation, wavelet recompositions)
26  * for Indeo Video Interactive codecs.
27  */
28
29 #include "avcodec.h"
30 #include "ivi.h"
31 #include "ivi_dsp.h"
32
33 void ff_ivi_recompose53(const IVIPlaneDesc *plane, uint8_t *dst,
34                         const ptrdiff_t dst_pitch)
35 {
36     int             x, y, indx;
37     int32_t         p0, p1, p2, p3, tmp0, tmp1, tmp2;
38     int32_t         b0_1, b0_2, b1_1, b1_2, b1_3, b2_1, b2_2, b2_3, b2_4, b2_5, b2_6;
39     int32_t         b3_1, b3_2, b3_3, b3_4, b3_5, b3_6, b3_7, b3_8, b3_9;
40     ptrdiff_t       pitch, back_pitch;
41     const short     *b0_ptr, *b1_ptr, *b2_ptr, *b3_ptr;
42     const int       num_bands = 4;
43
44     /* all bands should have the same pitch */
45     pitch = plane->bands[0].pitch;
46
47     /* pixels at the position "y-1" will be set to pixels at the "y" for the 1st iteration */
48     back_pitch = 0;
49
50     /* get pointers to the wavelet bands */
51     b0_ptr = plane->bands[0].buf;
52     b1_ptr = plane->bands[1].buf;
53     b2_ptr = plane->bands[2].buf;
54     b3_ptr = plane->bands[3].buf;
55
56     for (y = 0; y < plane->height; y += 2) {
57
58         if (y+2 >= plane->height)
59             pitch= 0;
60         /* load storage variables with values */
61         if (num_bands > 0) {
62             b0_1 = b0_ptr[0];
63             b0_2 = b0_ptr[pitch];
64         }
65
66         if (num_bands > 1) {
67             b1_1 = b1_ptr[back_pitch];
68             b1_2 = b1_ptr[0];
69             b1_3 = b1_1 - b1_2*6 + b1_ptr[pitch];
70         }
71
72         if (num_bands > 2) {
73             b2_2 = b2_ptr[0];     // b2[x,  y  ]
74             b2_3 = b2_2;          // b2[x+1,y  ] = b2[x,y]
75             b2_5 = b2_ptr[pitch]; // b2[x  ,y+1]
76             b2_6 = b2_5;          // b2[x+1,y+1] = b2[x,y+1]
77         }
78
79         if (num_bands > 3) {
80             b3_2 = b3_ptr[back_pitch]; // b3[x  ,y-1]
81             b3_3 = b3_2;               // b3[x+1,y-1] = b3[x  ,y-1]
82             b3_5 = b3_ptr[0];          // b3[x  ,y  ]
83             b3_6 = b3_5;               // b3[x+1,y  ] = b3[x  ,y  ]
84             b3_8 = b3_2 - b3_5*6 + b3_ptr[pitch];
85             b3_9 = b3_8;
86         }
87
88         for (x = 0, indx = 0; x < plane->width; x+=2, indx++) {
89             if (x+2 >= plane->width) {
90                 b0_ptr --;
91                 b1_ptr --;
92                 b2_ptr --;
93                 b3_ptr --;
94             }
95
96             /* some values calculated in the previous iterations can */
97             /* be reused in the next ones, so do appropriate copying */
98             b2_1 = b2_2; // b2[x-1,y  ] = b2[x,  y  ]
99             b2_2 = b2_3; // b2[x  ,y  ] = b2[x+1,y  ]
100             b2_4 = b2_5; // b2[x-1,y+1] = b2[x  ,y+1]
101             b2_5 = b2_6; // b2[x  ,y+1] = b2[x+1,y+1]
102             b3_1 = b3_2; // b3[x-1,y-1] = b3[x  ,y-1]
103             b3_2 = b3_3; // b3[x  ,y-1] = b3[x+1,y-1]
104             b3_4 = b3_5; // b3[x-1,y  ] = b3[x  ,y  ]
105             b3_5 = b3_6; // b3[x  ,y  ] = b3[x+1,y  ]
106             b3_7 = b3_8; // vert_HPF(x-1)
107             b3_8 = b3_9; // vert_HPF(x  )
108
109             p0 = p1 = p2 = p3 = 0;
110
111             /* process the LL-band by applying LPF both vertically and horizontally */
112             if (num_bands > 0) {
113                 tmp0 = b0_1;
114                 tmp2 = b0_2;
115                 b0_1 = b0_ptr[indx+1];
116                 b0_2 = b0_ptr[pitch+indx+1];
117                 tmp1 = tmp0 + b0_1;
118
119                 p0 =  tmp0 * 16;
120                 p1 =  tmp1 * 8;
121                 p2 = (tmp0 + tmp2) * 8;
122                 p3 = (tmp1 + tmp2 + b0_2) * 4;
123             }
124
125             /* process the HL-band by applying HPF vertically and LPF horizontally */
126             if (num_bands > 1) {
127                 tmp0 = b1_2;
128                 tmp1 = b1_1;
129                 b1_2 = b1_ptr[indx+1];
130                 b1_1 = b1_ptr[back_pitch+indx+1];
131
132                 tmp2 = tmp1 - tmp0*6 + b1_3;
133                 b1_3 = b1_1 - b1_2*6 + b1_ptr[pitch+indx+1];
134
135                 p0 += (tmp0 + tmp1) * 8;
136                 p1 += (tmp0 + tmp1 + b1_1 + b1_2) * 4;
137                 p2 +=  tmp2 * 4;
138                 p3 += (tmp2 + b1_3) * 2;
139             }
140
141             /* process the LH-band by applying LPF vertically and HPF horizontally */
142             if (num_bands > 2) {
143                 b2_3 = b2_ptr[indx+1];
144                 b2_6 = b2_ptr[pitch+indx+1];
145
146                 tmp0 = b2_1 + b2_2;
147                 tmp1 = b2_1 - b2_2*6 + b2_3;
148
149                 p0 += tmp0 * 8;
150                 p1 += tmp1 * 4;
151                 p2 += (tmp0 + b2_4 + b2_5) * 4;
152                 p3 += (tmp1 + b2_4 - b2_5*6 + b2_6) * 2;
153             }
154
155             /* process the HH-band by applying HPF both vertically and horizontally */
156             if (num_bands > 3) {
157                 b3_6 = b3_ptr[indx+1];            // b3[x+1,y  ]
158                 b3_3 = b3_ptr[back_pitch+indx+1]; // b3[x+1,y-1]
159
160                 tmp0 = b3_1 + b3_4;
161                 tmp1 = b3_2 + b3_5;
162                 tmp2 = b3_3 + b3_6;
163
164                 b3_9 = b3_3 - b3_6*6 + b3_ptr[pitch+indx+1];
165
166                 p0 += (tmp0 + tmp1) * 4;
167                 p1 += (tmp0 - tmp1*6 + tmp2) * 2;
168                 p2 += (b3_7 + b3_8) * 2;
169                 p3 +=  b3_7 - b3_8*6 + b3_9;
170             }
171
172             /* output four pixels */
173             dst[x]             = av_clip_uint8((p0 >> 6) + 128);
174             dst[x+1]           = av_clip_uint8((p1 >> 6) + 128);
175             dst[dst_pitch+x]   = av_clip_uint8((p2 >> 6) + 128);
176             dst[dst_pitch+x+1] = av_clip_uint8((p3 >> 6) + 128);
177         }// for x
178
179         dst += dst_pitch << 1;
180
181         back_pitch = -pitch;
182
183         b0_ptr += pitch + 1;
184         b1_ptr += pitch + 1;
185         b2_ptr += pitch + 1;
186         b3_ptr += pitch + 1;
187     }
188 }
189
190 void ff_ivi_recompose_haar(const IVIPlaneDesc *plane, uint8_t *dst,
191                            const ptrdiff_t dst_pitch)
192 {
193     int             x, y, indx, b0, b1, b2, b3, p0, p1, p2, p3;
194     const short     *b0_ptr, *b1_ptr, *b2_ptr, *b3_ptr;
195     ptrdiff_t       pitch;
196
197     /* all bands should have the same pitch */
198     pitch = plane->bands[0].pitch;
199
200     /* get pointers to the wavelet bands */
201     b0_ptr = plane->bands[0].buf;
202     b1_ptr = plane->bands[1].buf;
203     b2_ptr = plane->bands[2].buf;
204     b3_ptr = plane->bands[3].buf;
205
206     for (y = 0; y < plane->height; y += 2) {
207         for (x = 0, indx = 0; x < plane->width; x += 2, indx++) {
208             /* load coefficients */
209             b0 = b0_ptr[indx]; //should be: b0 = (num_bands > 0) ? b0_ptr[indx] : 0;
210             b1 = b1_ptr[indx]; //should be: b1 = (num_bands > 1) ? b1_ptr[indx] : 0;
211             b2 = b2_ptr[indx]; //should be: b2 = (num_bands > 2) ? b2_ptr[indx] : 0;
212             b3 = b3_ptr[indx]; //should be: b3 = (num_bands > 3) ? b3_ptr[indx] : 0;
213
214             /* haar wavelet recomposition */
215             p0 = (b0 + b1 + b2 + b3 + 2) >> 2;
216             p1 = (b0 + b1 - b2 - b3 + 2) >> 2;
217             p2 = (b0 - b1 + b2 - b3 + 2) >> 2;
218             p3 = (b0 - b1 - b2 + b3 + 2) >> 2;
219
220             /* bias, convert and output four pixels */
221             dst[x]                 = av_clip_uint8(p0 + 128);
222             dst[x + 1]             = av_clip_uint8(p1 + 128);
223             dst[dst_pitch + x]     = av_clip_uint8(p2 + 128);
224             dst[dst_pitch + x + 1] = av_clip_uint8(p3 + 128);
225         }// for x
226
227         dst += dst_pitch << 1;
228
229         b0_ptr += pitch;
230         b1_ptr += pitch;
231         b2_ptr += pitch;
232         b3_ptr += pitch;
233     }// for y
234 }
235
236 /** butterfly operation for the inverse Haar transform */
237 #define IVI_HAAR_BFLY(s1, s2, o1, o2, t) \
238     t  = ((s1) - (s2)) >> 1;\
239     o1 = ((s1) + (s2)) >> 1;\
240     o2 = (t);\
241
242 /** inverse 8-point Haar transform */
243 #define INV_HAAR8(s1, s5, s3, s7, s2, s4, s6, s8,\
244                   d1, d2, d3, d4, d5, d6, d7, d8,\
245                   t0, t1, t2, t3, t4, t5, t6, t7, t8) {\
246     t1 = (s1) * 2; t5 = (s5) * 2;\
247     IVI_HAAR_BFLY(t1, t5, t1, t5, t0); IVI_HAAR_BFLY(t1, s3, t1, t3, t0);\
248     IVI_HAAR_BFLY(t5, s7, t5, t7, t0); IVI_HAAR_BFLY(t1, s2, t1, t2, t0);\
249     IVI_HAAR_BFLY(t3, s4, t3, t4, t0); IVI_HAAR_BFLY(t5, s6, t5, t6, t0);\
250     IVI_HAAR_BFLY(t7, s8, t7, t8, t0);\
251     d1 = COMPENSATE(t1);\
252     d2 = COMPENSATE(t2);\
253     d3 = COMPENSATE(t3);\
254     d4 = COMPENSATE(t4);\
255     d5 = COMPENSATE(t5);\
256     d6 = COMPENSATE(t6);\
257     d7 = COMPENSATE(t7);\
258     d8 = COMPENSATE(t8); }
259
260 /** inverse 4-point Haar transform */
261 #define INV_HAAR4(s1, s3, s5, s7, d1, d2, d3, d4, t0, t1, t2, t3, t4) {\
262     IVI_HAAR_BFLY(s1, s3, t0, t1, t4);\
263     IVI_HAAR_BFLY(t0, s5, t2, t3, t4);\
264     d1 = COMPENSATE(t2);\
265     d2 = COMPENSATE(t3);\
266     IVI_HAAR_BFLY(t1, s7, t2, t3, t4);\
267     d3 = COMPENSATE(t2);\
268     d4 = COMPENSATE(t3); }
269
270 void ff_ivi_inverse_haar_8x8(const int32_t *in, int16_t *out, ptrdiff_t pitch,
271                              const uint8_t *flags)
272 {
273     int     i, shift, sp1, sp2, sp3, sp4;
274     const int32_t *src;
275     int32_t *dst;
276     int     tmp[64];
277     int     t0, t1, t2, t3, t4, t5, t6, t7, t8;
278
279     /* apply the InvHaar8 to all columns */
280 #define COMPENSATE(x) (x)
281     src = in;
282     dst = tmp;
283     for (i = 0; i < 8; i++) {
284         if (flags[i]) {
285             /* pre-scaling */
286             shift = !(i & 4);
287             sp1 = src[ 0] * (1 << shift);
288             sp2 = src[ 8] * (1 << shift);
289             sp3 = src[16] * (1 << shift);
290             sp4 = src[24] * (1 << shift);
291             INV_HAAR8(    sp1,     sp2,     sp3,     sp4,
292                       src[32], src[40], src[48], src[56],
293                       dst[ 0], dst[ 8], dst[16], dst[24],
294                       dst[32], dst[40], dst[48], dst[56],
295                       t0, t1, t2, t3, t4, t5, t6, t7, t8);
296         } else
297             dst[ 0] = dst[ 8] = dst[16] = dst[24] =
298             dst[32] = dst[40] = dst[48] = dst[56] = 0;
299
300         src++;
301         dst++;
302     }
303 #undef  COMPENSATE
304
305     /* apply the InvHaar8 to all rows */
306 #define COMPENSATE(x) (x)
307     src = tmp;
308     for (i = 0; i < 8; i++) {
309         if (   !src[0] && !src[1] && !src[2] && !src[3]
310             && !src[4] && !src[5] && !src[6] && !src[7]) {
311             memset(out, 0, 8 * sizeof(out[0]));
312         } else {
313             INV_HAAR8(src[0], src[1], src[2], src[3],
314                       src[4], src[5], src[6], src[7],
315                       out[0], out[1], out[2], out[3],
316                       out[4], out[5], out[6], out[7],
317                       t0, t1, t2, t3, t4, t5, t6, t7, t8);
318         }
319         src += 8;
320         out += pitch;
321     }
322 #undef  COMPENSATE
323 }
324
325 void ff_ivi_row_haar8(const int32_t *in, int16_t *out, ptrdiff_t pitch,
326                       const uint8_t *flags)
327 {
328     int     i;
329     int     t0, t1, t2, t3, t4, t5, t6, t7, t8;
330
331     /* apply the InvHaar8 to all rows */
332 #define COMPENSATE(x) (x)
333     for (i = 0; i < 8; i++) {
334         if (   !in[0] && !in[1] && !in[2] && !in[3]
335             && !in[4] && !in[5] && !in[6] && !in[7]) {
336             memset(out, 0, 8 * sizeof(out[0]));
337         } else {
338             INV_HAAR8(in[0],  in[1],  in[2],  in[3],
339                       in[4],  in[5],  in[6],  in[7],
340                       out[0], out[1], out[2], out[3],
341                       out[4], out[5], out[6], out[7],
342                       t0, t1, t2, t3, t4, t5, t6, t7, t8);
343         }
344         in  += 8;
345         out += pitch;
346     }
347 #undef  COMPENSATE
348 }
349
350 void ff_ivi_col_haar8(const int32_t *in, int16_t *out, ptrdiff_t pitch,
351                       const uint8_t *flags)
352 {
353     int     i;
354     int     t0, t1, t2, t3, t4, t5, t6, t7, t8;
355
356     /* apply the InvHaar8 to all columns */
357 #define COMPENSATE(x) (x)
358     for (i = 0; i < 8; i++) {
359         if (flags[i]) {
360             INV_HAAR8(in[ 0], in[ 8], in[16], in[24],
361                       in[32], in[40], in[48], in[56],
362                       out[0 * pitch], out[1 * pitch],
363                       out[2 * pitch], out[3 * pitch],
364                       out[4 * pitch], out[5 * pitch],
365                       out[6 * pitch], out[7 * pitch],
366                       t0, t1, t2, t3, t4, t5, t6, t7, t8);
367         } else
368             out[0 * pitch] = out[1 * pitch] =
369             out[2 * pitch] = out[3 * pitch] =
370             out[4 * pitch] = out[5 * pitch] =
371             out[6 * pitch] = out[7 * pitch] = 0;
372
373         in++;
374         out++;
375     }
376 #undef  COMPENSATE
377 }
378
379 void ff_ivi_inverse_haar_4x4(const int32_t *in, int16_t *out, ptrdiff_t pitch,
380                              const uint8_t *flags)
381 {
382     int     i, shift, sp1, sp2;
383     const int32_t *src;
384     int32_t *dst;
385     int     tmp[16];
386     int     t0, t1, t2, t3, t4;
387
388     /* apply the InvHaar4 to all columns */
389 #define COMPENSATE(x) (x)
390     src = in;
391     dst = tmp;
392     for (i = 0; i < 4; i++) {
393         if (flags[i]) {
394             /* pre-scaling */
395             shift = !(i & 2);
396             sp1 = src[0] * (1 << shift);
397             sp2 = src[4] * (1 << shift);
398             INV_HAAR4(   sp1,    sp2, src[8], src[12],
399                       dst[0], dst[4], dst[8], dst[12],
400                       t0, t1, t2, t3, t4);
401         } else
402             dst[0] = dst[4] = dst[8] = dst[12] = 0;
403
404         src++;
405         dst++;
406     }
407 #undef  COMPENSATE
408
409     /* apply the InvHaar8 to all rows */
410 #define COMPENSATE(x) (x)
411     src = tmp;
412     for (i = 0; i < 4; i++) {
413         if (!src[0] && !src[1] && !src[2] && !src[3]) {
414             memset(out, 0, 4 * sizeof(out[0]));
415         } else {
416             INV_HAAR4(src[0], src[1], src[2], src[3],
417                       out[0], out[1], out[2], out[3],
418                       t0, t1, t2, t3, t4);
419         }
420         src += 4;
421         out += pitch;
422     }
423 #undef  COMPENSATE
424 }
425
426 void ff_ivi_row_haar4(const int32_t *in, int16_t *out, ptrdiff_t pitch,
427                       const uint8_t *flags)
428 {
429     int     i;
430     int     t0, t1, t2, t3, t4;
431
432     /* apply the InvHaar4 to all rows */
433 #define COMPENSATE(x) (x)
434     for (i = 0; i < 4; i++) {
435         if (!in[0] && !in[1] && !in[2] && !in[3]) {
436             memset(out, 0, 4 * sizeof(out[0]));
437         } else {
438             INV_HAAR4(in[0], in[1], in[2], in[3],
439                       out[0], out[1], out[2], out[3],
440                       t0, t1, t2, t3, t4);
441         }
442         in  += 4;
443         out += pitch;
444     }
445 #undef  COMPENSATE
446 }
447
448 void ff_ivi_col_haar4(const int32_t *in, int16_t *out, ptrdiff_t pitch,
449                       const uint8_t *flags)
450 {
451     int     i;
452     int     t0, t1, t2, t3, t4;
453
454     /* apply the InvHaar8 to all columns */
455 #define COMPENSATE(x) (x)
456     for (i = 0; i < 4; i++) {
457         if (flags[i]) {
458             INV_HAAR4(in[0], in[4], in[8], in[12],
459                       out[0 * pitch], out[1 * pitch],
460                       out[2 * pitch], out[3 * pitch],
461                       t0, t1, t2, t3, t4);
462         } else
463             out[0 * pitch] = out[1 * pitch] =
464             out[2 * pitch] = out[3 * pitch] = 0;
465
466         in++;
467         out++;
468     }
469 #undef  COMPENSATE
470 }
471
472 void ff_ivi_dc_haar_2d(const int32_t *in, int16_t *out, ptrdiff_t pitch,
473                        int blk_size)
474 {
475     int     x, y;
476     int16_t dc_coeff;
477
478     dc_coeff = (*in + 0) >> 3;
479
480     for (y = 0; y < blk_size; out += pitch, y++) {
481         for (x = 0; x < blk_size; x++)
482             out[x] = dc_coeff;
483     }
484 }
485
486 /** butterfly operation for the inverse slant transform */
487 #define IVI_SLANT_BFLY(s1, s2, o1, o2, t) \
488     t  = (s1) - (s2);\
489     o1 = (s1) + (s2);\
490     o2 = (t);\
491
492 /** This is a reflection a,b = 1/2, 5/4 for the inverse slant transform */
493 #define IVI_IREFLECT(s1, s2, o1, o2, t) \
494     t  = (((s1) + (s2)*2 + 2) >> 2) + (s1);\
495     o2 = (((s1)*2 - (s2) + 2) >> 2) - (s2);\
496     o1 = (t);\
497
498 /** This is a reflection a,b = 1/2, 7/8 for the inverse slant transform */
499 #define IVI_SLANT_PART4(s1, s2, o1, o2, t) \
500     t  = (s2) + (((s1)*4  - (s2) + 4) >> 3);\
501     o2 = (s1) + ((-(s1) - (s2)*4 + 4) >> 3);\
502     o1 = (t);\
503
504 /** inverse slant8 transform */
505 #define IVI_INV_SLANT8(s1, s4, s8, s5, s2, s6, s3, s7,\
506                        d1, d2, d3, d4, d5, d6, d7, d8,\
507                        t0, t1, t2, t3, t4, t5, t6, t7, t8) {\
508     IVI_SLANT_PART4(s4, s5, t4, t5, t0);\
509 \
510     IVI_SLANT_BFLY(s1, t5, t1, t5, t0); IVI_SLANT_BFLY(s2, s6, t2, t6, t0);\
511     IVI_SLANT_BFLY(s7, s3, t7, t3, t0); IVI_SLANT_BFLY(t4, s8, t4, t8, t0);\
512 \
513     IVI_SLANT_BFLY(t1, t2, t1, t2, t0); IVI_IREFLECT  (t4, t3, t4, t3, t0);\
514     IVI_SLANT_BFLY(t5, t6, t5, t6, t0); IVI_IREFLECT  (t8, t7, t8, t7, t0);\
515     IVI_SLANT_BFLY(t1, t4, t1, t4, t0); IVI_SLANT_BFLY(t2, t3, t2, t3, t0);\
516     IVI_SLANT_BFLY(t5, t8, t5, t8, t0); IVI_SLANT_BFLY(t6, t7, t6, t7, t0);\
517     d1 = COMPENSATE(t1);\
518     d2 = COMPENSATE(t2);\
519     d3 = COMPENSATE(t3);\
520     d4 = COMPENSATE(t4);\
521     d5 = COMPENSATE(t5);\
522     d6 = COMPENSATE(t6);\
523     d7 = COMPENSATE(t7);\
524     d8 = COMPENSATE(t8);}
525
526 /** inverse slant4 transform */
527 #define IVI_INV_SLANT4(s1, s4, s2, s3, d1, d2, d3, d4, t0, t1, t2, t3, t4) {\
528     IVI_SLANT_BFLY(s1, s2, t1, t2, t0); IVI_IREFLECT  (s4, s3, t4, t3, t0);\
529 \
530     IVI_SLANT_BFLY(t1, t4, t1, t4, t0); IVI_SLANT_BFLY(t2, t3, t2, t3, t0);\
531     d1 = COMPENSATE(t1);\
532     d2 = COMPENSATE(t2);\
533     d3 = COMPENSATE(t3);\
534     d4 = COMPENSATE(t4);}
535
536 void ff_ivi_inverse_slant_8x8(const int32_t *in, int16_t *out, ptrdiff_t pitch, const uint8_t *flags)
537 {
538     int     i;
539     const int32_t *src;
540     int32_t *dst;
541     int     tmp[64];
542     int     t0, t1, t2, t3, t4, t5, t6, t7, t8;
543
544 #define COMPENSATE(x) (x)
545     src = in;
546     dst = tmp;
547     for (i = 0; i < 8; i++) {
548         if (flags[i]) {
549             IVI_INV_SLANT8(src[0], src[8], src[16], src[24], src[32], src[40], src[48], src[56],
550                            dst[0], dst[8], dst[16], dst[24], dst[32], dst[40], dst[48], dst[56],
551                            t0, t1, t2, t3, t4, t5, t6, t7, t8);
552         } else
553             dst[0] = dst[8] = dst[16] = dst[24] = dst[32] = dst[40] = dst[48] = dst[56] = 0;
554
555         src++;
556         dst++;
557     }
558 #undef COMPENSATE
559
560 #define COMPENSATE(x) (((x) + 1)>>1)
561     src = tmp;
562     for (i = 0; i < 8; i++) {
563         if (!src[0] && !src[1] && !src[2] && !src[3] && !src[4] && !src[5] && !src[6] && !src[7]) {
564             memset(out, 0, 8*sizeof(out[0]));
565         } else {
566             IVI_INV_SLANT8(src[0], src[1], src[2], src[3], src[4], src[5], src[6], src[7],
567                            out[0], out[1], out[2], out[3], out[4], out[5], out[6], out[7],
568                            t0, t1, t2, t3, t4, t5, t6, t7, t8);
569         }
570         src += 8;
571         out += pitch;
572     }
573 #undef COMPENSATE
574 }
575
576 void ff_ivi_inverse_slant_4x4(const int32_t *in, int16_t *out, ptrdiff_t pitch, const uint8_t *flags)
577 {
578     int     i;
579     const int32_t *src;
580     int32_t *dst;
581     int     tmp[16];
582     int     t0, t1, t2, t3, t4;
583
584 #define COMPENSATE(x) (x)
585     src = in;
586     dst = tmp;
587     for (i = 0; i < 4; i++) {
588         if (flags[i]) {
589             IVI_INV_SLANT4(src[0], src[4], src[8], src[12],
590                            dst[0], dst[4], dst[8], dst[12],
591                            t0, t1, t2, t3, t4);
592         } else
593             dst[0] = dst[4] = dst[8] = dst[12] = 0;
594
595         src++;
596         dst++;
597     }
598 #undef COMPENSATE
599
600 #define COMPENSATE(x) (((x) + 1)>>1)
601     src = tmp;
602     for (i = 0; i < 4; i++) {
603         if (!src[0] && !src[1] && !src[2] && !src[3]) {
604             out[0] = out[1] = out[2] = out[3] = 0;
605         } else {
606             IVI_INV_SLANT4(src[0], src[1], src[2], src[3],
607                            out[0], out[1], out[2], out[3],
608                            t0, t1, t2, t3, t4);
609         }
610         src += 4;
611         out += pitch;
612     }
613 #undef COMPENSATE
614 }
615
616 void ff_ivi_dc_slant_2d(const int32_t *in, int16_t *out, ptrdiff_t pitch, int blk_size)
617 {
618     int     x, y;
619     int16_t dc_coeff;
620
621     dc_coeff = (*in + 1) >> 1;
622
623     for (y = 0; y < blk_size; out += pitch, y++) {
624         for (x = 0; x < blk_size; x++)
625             out[x] = dc_coeff;
626     }
627 }
628
629 void ff_ivi_row_slant8(const int32_t *in, int16_t *out, ptrdiff_t pitch, const uint8_t *flags)
630 {
631     int     i;
632     int     t0, t1, t2, t3, t4, t5, t6, t7, t8;
633
634 #define COMPENSATE(x) (((x) + 1)>>1)
635     for (i = 0; i < 8; i++) {
636         if (!in[0] && !in[1] && !in[2] && !in[3] && !in[4] && !in[5] && !in[6] && !in[7]) {
637             memset(out, 0, 8*sizeof(out[0]));
638         } else {
639             IVI_INV_SLANT8( in[0],  in[1],  in[2],  in[3],  in[4],  in[5],  in[6],  in[7],
640                            out[0], out[1], out[2], out[3], out[4], out[5], out[6], out[7],
641                            t0, t1, t2, t3, t4, t5, t6, t7, t8);
642         }
643         in += 8;
644         out += pitch;
645     }
646 #undef COMPENSATE
647 }
648
649 void ff_ivi_dc_row_slant(const int32_t *in, int16_t *out, ptrdiff_t pitch, int blk_size)
650 {
651     int     x, y;
652     int16_t dc_coeff;
653
654     dc_coeff = (*in + 1) >> 1;
655
656     for (x = 0; x < blk_size; x++)
657         out[x] = dc_coeff;
658
659     out += pitch;
660
661     for (y = 1; y < blk_size; out += pitch, y++) {
662         for (x = 0; x < blk_size; x++)
663             out[x] = 0;
664     }
665 }
666
667 void ff_ivi_col_slant8(const int32_t *in, int16_t *out, ptrdiff_t pitch, const uint8_t *flags)
668 {
669     int     i, row2, row4, row8;
670     int     t0, t1, t2, t3, t4, t5, t6, t7, t8;
671
672     row2 = pitch << 1;
673     row4 = pitch << 2;
674     row8 = pitch << 3;
675
676 #define COMPENSATE(x) (((x) + 1)>>1)
677     for (i = 0; i < 8; i++) {
678         if (flags[i]) {
679             IVI_INV_SLANT8(in[0], in[8], in[16], in[24], in[32], in[40], in[48], in[56],
680                            out[0], out[pitch], out[row2], out[row2 + pitch], out[row4],
681                            out[row4 + pitch],  out[row4 + row2], out[row8 - pitch],
682                            t0, t1, t2, t3, t4, t5, t6, t7, t8);
683         } else {
684             out[0] = out[pitch] = out[row2] = out[row2 + pitch] = out[row4] =
685             out[row4 + pitch] =  out[row4 + row2] = out[row8 - pitch] = 0;
686         }
687
688         in++;
689         out++;
690     }
691 #undef COMPENSATE
692 }
693
694 void ff_ivi_dc_col_slant(const int32_t *in, int16_t *out, ptrdiff_t pitch, int blk_size)
695 {
696     int     x, y;
697     int16_t dc_coeff;
698
699     dc_coeff = (*in + 1) >> 1;
700
701     for (y = 0; y < blk_size; out += pitch, y++) {
702         out[0] = dc_coeff;
703         for (x = 1; x < blk_size; x++)
704             out[x] = 0;
705     }
706 }
707
708 void ff_ivi_row_slant4(const int32_t *in, int16_t *out, ptrdiff_t pitch, const uint8_t *flags)
709 {
710     int     i;
711     int     t0, t1, t2, t3, t4;
712
713 #define COMPENSATE(x) (((x) + 1)>>1)
714     for (i = 0; i < 4; i++) {
715         if (!in[0] && !in[1] && !in[2] && !in[3]) {
716             memset(out, 0, 4*sizeof(out[0]));
717         } else {
718             IVI_INV_SLANT4( in[0],  in[1],  in[2],  in[3],
719                            out[0], out[1], out[2], out[3],
720                            t0, t1, t2, t3, t4);
721         }
722         in  += 4;
723         out += pitch;
724     }
725 #undef COMPENSATE
726 }
727
728 void ff_ivi_col_slant4(const int32_t *in, int16_t *out, ptrdiff_t pitch, const uint8_t *flags)
729 {
730     int     i, row2;
731     int     t0, t1, t2, t3, t4;
732
733     row2 = pitch << 1;
734
735 #define COMPENSATE(x) (((x) + 1)>>1)
736     for (i = 0; i < 4; i++) {
737         if (flags[i]) {
738             IVI_INV_SLANT4(in[0], in[4], in[8], in[12],
739                            out[0], out[pitch], out[row2], out[row2 + pitch],
740                            t0, t1, t2, t3, t4);
741         } else {
742             out[0] = out[pitch] = out[row2] = out[row2 + pitch] = 0;
743         }
744
745         in++;
746         out++;
747     }
748 #undef COMPENSATE
749 }
750
751 void ff_ivi_put_pixels_8x8(const int32_t *in, int16_t *out, ptrdiff_t pitch,
752                            const uint8_t *flags)
753 {
754     int     x, y;
755
756     for (y = 0; y < 8; out += pitch, in += 8, y++)
757         for (x = 0; x < 8; x++)
758             out[x] = in[x];
759 }
760
761 void ff_ivi_put_dc_pixel_8x8(const int32_t *in, int16_t *out, ptrdiff_t pitch,
762                              int blk_size)
763 {
764     int     y;
765
766     out[0] = in[0];
767     memset(out + 1, 0, 7*sizeof(out[0]));
768     out += pitch;
769
770     for (y = 1; y < 8; out += pitch, y++)
771         memset(out, 0, 8*sizeof(out[0]));
772 }
773
774 #define IVI_MC_TEMPLATE(size, suffix, OP) \
775 static void ivi_mc_ ## size ##x## size ## suffix(int16_t *buf, \
776                                                  ptrdiff_t dpitch, \
777                                                  const int16_t *ref_buf, \
778                                                  ptrdiff_t pitch, int mc_type) \
779 { \
780     int     i, j; \
781     const int16_t *wptr; \
782 \
783     switch (mc_type) { \
784     case 0: /* fullpel (no interpolation) */ \
785         for (i = 0; i < size; i++, buf += dpitch, ref_buf += pitch) { \
786             for (j = 0; j < size; j++) {\
787                 OP(buf[j], ref_buf[j]); \
788             } \
789         } \
790         break; \
791     case 1: /* horizontal halfpel interpolation */ \
792         for (i = 0; i < size; i++, buf += dpitch, ref_buf += pitch) \
793             for (j = 0; j < size; j++) \
794                 OP(buf[j], (ref_buf[j] + ref_buf[j+1]) >> 1); \
795         break; \
796     case 2: /* vertical halfpel interpolation */ \
797         wptr = ref_buf + pitch; \
798         for (i = 0; i < size; i++, buf += dpitch, wptr += pitch, ref_buf += pitch) \
799             for (j = 0; j < size; j++) \
800                 OP(buf[j], (ref_buf[j] + wptr[j]) >> 1); \
801         break; \
802     case 3: /* vertical and horizontal halfpel interpolation */ \
803         wptr = ref_buf + pitch; \
804         for (i = 0; i < size; i++, buf += dpitch, wptr += pitch, ref_buf += pitch) \
805             for (j = 0; j < size; j++) \
806                 OP(buf[j], (ref_buf[j] + ref_buf[j+1] + wptr[j] + wptr[j+1]) >> 2); \
807         break; \
808     } \
809 } \
810 \
811 void ff_ivi_mc_ ## size ##x## size ## suffix(int16_t *buf, const int16_t *ref_buf, \
812                                              ptrdiff_t pitch, int mc_type) \
813 { \
814     ivi_mc_ ## size ##x## size ## suffix(buf, pitch, ref_buf, pitch, mc_type); \
815 } \
816
817 #define IVI_MC_AVG_TEMPLATE(size, suffix, OP) \
818 void ff_ivi_mc_avg_ ## size ##x## size ## suffix(int16_t *buf, \
819                                                  const int16_t *ref_buf, \
820                                                  const int16_t *ref_buf2, \
821                                                  ptrdiff_t pitch, \
822                                                  int mc_type, int mc_type2) \
823 { \
824     int16_t tmp[size * size]; \
825     int i, j; \
826 \
827     ivi_mc_ ## size ##x## size ## _no_delta(tmp, size, ref_buf, pitch, mc_type); \
828     ivi_mc_ ## size ##x## size ## _delta(tmp, size, ref_buf2, pitch, mc_type2); \
829     for (i = 0; i < size; i++, buf += pitch) { \
830         for (j = 0; j < size; j++) {\
831             OP(buf[j], tmp[i * size + j] >> 1); \
832         } \
833     } \
834 } \
835
836 #define OP_PUT(a, b)  (a) = (b)
837 #define OP_ADD(a, b)  (a) += (b)
838
839 IVI_MC_TEMPLATE(8, _no_delta, OP_PUT)
840 IVI_MC_TEMPLATE(8, _delta,    OP_ADD)
841 IVI_MC_TEMPLATE(4, _no_delta, OP_PUT)
842 IVI_MC_TEMPLATE(4, _delta,    OP_ADD)
843 IVI_MC_AVG_TEMPLATE(8, _no_delta, OP_PUT)
844 IVI_MC_AVG_TEMPLATE(8, _delta,    OP_ADD)
845 IVI_MC_AVG_TEMPLATE(4, _no_delta, OP_PUT)
846 IVI_MC_AVG_TEMPLATE(4, _delta,    OP_ADD)