Subversion Repositories Kolibri OS

Rev

Go to most recent revision | Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
4349 Serge 1
/*
2
 * RV40 decoder motion compensation functions
3
 * Copyright (c) 2008 Konstantin Shishkov
4
 *
5
 * This file is part of FFmpeg.
6
 *
7
 * FFmpeg 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
 * FFmpeg 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 FFmpeg; 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
 * RV40 decoder motion compensation functions
25
 */
26
 
27
#include "avcodec.h"
28
#include "h264qpel.h"
29
#include "rv34dsp.h"
30
#include "libavutil/avassert.h"
31
#include "libavutil/common.h"
32
 
33
#define RV40_LOWPASS(OPNAME, OP) \
34
static av_unused void OPNAME ## rv40_qpel8_h_lowpass(uint8_t *dst, uint8_t *src, int dstStride, int srcStride,\
35
                                                     const int h, const int C1, const int C2, const int SHIFT){\
36
    const uint8_t *cm = ff_cropTbl + MAX_NEG_CROP;\
37
    int i;\
38
    for(i = 0; i < h; i++)\
39
    {\
40
        OP(dst[0], (src[-2] + src[ 3] - 5*(src[-1]+src[2]) + src[0]*C1 + src[1]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
41
        OP(dst[1], (src[-1] + src[ 4] - 5*(src[ 0]+src[3]) + src[1]*C1 + src[2]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
42
        OP(dst[2], (src[ 0] + src[ 5] - 5*(src[ 1]+src[4]) + src[2]*C1 + src[3]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
43
        OP(dst[3], (src[ 1] + src[ 6] - 5*(src[ 2]+src[5]) + src[3]*C1 + src[4]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
44
        OP(dst[4], (src[ 2] + src[ 7] - 5*(src[ 3]+src[6]) + src[4]*C1 + src[5]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
45
        OP(dst[5], (src[ 3] + src[ 8] - 5*(src[ 4]+src[7]) + src[5]*C1 + src[6]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
46
        OP(dst[6], (src[ 4] + src[ 9] - 5*(src[ 5]+src[8]) + src[6]*C1 + src[7]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
47
        OP(dst[7], (src[ 5] + src[10] - 5*(src[ 6]+src[9]) + src[7]*C1 + src[8]*C2 + (1<<(SHIFT-1))) >> SHIFT);\
48
        dst += dstStride;\
49
        src += srcStride;\
50
    }\
51
}\
52
\
53
static void OPNAME ## rv40_qpel8_v_lowpass(uint8_t *dst, uint8_t *src, int dstStride, int srcStride,\
54
                                           const int w, const int C1, const int C2, const int SHIFT){\
55
    const uint8_t *cm = ff_cropTbl + MAX_NEG_CROP;\
56
    int i;\
57
    for(i = 0; i < w; i++)\
58
    {\
59
        const int srcB  = src[-2*srcStride];\
60
        const int srcA  = src[-1*srcStride];\
61
        const int src0  = src[0 *srcStride];\
62
        const int src1  = src[1 *srcStride];\
63
        const int src2  = src[2 *srcStride];\
64
        const int src3  = src[3 *srcStride];\
65
        const int src4  = src[4 *srcStride];\
66
        const int src5  = src[5 *srcStride];\
67
        const int src6  = src[6 *srcStride];\
68
        const int src7  = src[7 *srcStride];\
69
        const int src8  = src[8 *srcStride];\
70
        const int src9  = src[9 *srcStride];\
71
        const int src10 = src[10*srcStride];\
72
        OP(dst[0*dstStride], (srcB + src3  - 5*(srcA+src2) + src0*C1 + src1*C2 + (1<<(SHIFT-1))) >> SHIFT);\
73
        OP(dst[1*dstStride], (srcA + src4  - 5*(src0+src3) + src1*C1 + src2*C2 + (1<<(SHIFT-1))) >> SHIFT);\
74
        OP(dst[2*dstStride], (src0 + src5  - 5*(src1+src4) + src2*C1 + src3*C2 + (1<<(SHIFT-1))) >> SHIFT);\
75
        OP(dst[3*dstStride], (src1 + src6  - 5*(src2+src5) + src3*C1 + src4*C2 + (1<<(SHIFT-1))) >> SHIFT);\
76
        OP(dst[4*dstStride], (src2 + src7  - 5*(src3+src6) + src4*C1 + src5*C2 + (1<<(SHIFT-1))) >> SHIFT);\
77
        OP(dst[5*dstStride], (src3 + src8  - 5*(src4+src7) + src5*C1 + src6*C2 + (1<<(SHIFT-1))) >> SHIFT);\
78
        OP(dst[6*dstStride], (src4 + src9  - 5*(src5+src8) + src6*C1 + src7*C2 + (1<<(SHIFT-1))) >> SHIFT);\
79
        OP(dst[7*dstStride], (src5 + src10 - 5*(src6+src9) + src7*C1 + src8*C2 + (1<<(SHIFT-1))) >> SHIFT);\
80
        dst++;\
81
        src++;\
82
    }\
83
}\
84
\
85
static void OPNAME ## rv40_qpel16_v_lowpass(uint8_t *dst, uint8_t *src, int dstStride, int srcStride,\
86
                                            const int w, const int C1, const int C2, const int SHIFT){\
87
    OPNAME ## rv40_qpel8_v_lowpass(dst  , src  , dstStride, srcStride, 8, C1, C2, SHIFT);\
88
    OPNAME ## rv40_qpel8_v_lowpass(dst+8, src+8, dstStride, srcStride, 8, C1, C2, SHIFT);\
89
    src += 8*srcStride;\
90
    dst += 8*dstStride;\
91
    OPNAME ## rv40_qpel8_v_lowpass(dst  , src  , dstStride, srcStride, w-8, C1, C2, SHIFT);\
92
    OPNAME ## rv40_qpel8_v_lowpass(dst+8, src+8, dstStride, srcStride, w-8, C1, C2, SHIFT);\
93
}\
94
\
95
static void OPNAME ## rv40_qpel16_h_lowpass(uint8_t *dst, uint8_t *src, int dstStride, int srcStride,\
96
                                            const int h, const int C1, const int C2, const int SHIFT){\
97
    OPNAME ## rv40_qpel8_h_lowpass(dst  , src  , dstStride, srcStride, 8, C1, C2, SHIFT);\
98
    OPNAME ## rv40_qpel8_h_lowpass(dst+8, src+8, dstStride, srcStride, 8, C1, C2, SHIFT);\
99
    src += 8*srcStride;\
100
    dst += 8*dstStride;\
101
    OPNAME ## rv40_qpel8_h_lowpass(dst  , src  , dstStride, srcStride, h-8, C1, C2, SHIFT);\
102
    OPNAME ## rv40_qpel8_h_lowpass(dst+8, src+8, dstStride, srcStride, h-8, C1, C2, SHIFT);\
103
}\
104
\
105
 
106
#define RV40_MC(OPNAME, SIZE) \
107
static void OPNAME ## rv40_qpel ## SIZE ## _mc10_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
108
{\
109
    OPNAME ## rv40_qpel ## SIZE ## _h_lowpass(dst, src, stride, stride, SIZE, 52, 20, 6);\
110
}\
111
\
112
static void OPNAME ## rv40_qpel ## SIZE ## _mc30_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
113
{\
114
    OPNAME ## rv40_qpel ## SIZE ## _h_lowpass(dst, src, stride, stride, SIZE, 20, 52, 6);\
115
}\
116
\
117
static void OPNAME ## rv40_qpel ## SIZE ## _mc01_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
118
{\
119
    OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, src, stride, stride, SIZE, 52, 20, 6);\
120
}\
121
\
122
static void OPNAME ## rv40_qpel ## SIZE ## _mc11_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
123
{\
124
    uint8_t full[SIZE*(SIZE+5)];\
125
    uint8_t * const full_mid = full + SIZE*2;\
126
    put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 52, 20, 6);\
127
    OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 52, 20, 6);\
128
}\
129
\
130
static void OPNAME ## rv40_qpel ## SIZE ## _mc21_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
131
{\
132
    uint8_t full[SIZE*(SIZE+5)];\
133
    uint8_t * const full_mid = full + SIZE*2;\
134
    put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 20, 20, 5);\
135
    OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 52, 20, 6);\
136
}\
137
\
138
static void OPNAME ## rv40_qpel ## SIZE ## _mc31_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
139
{\
140
    uint8_t full[SIZE*(SIZE+5)];\
141
    uint8_t * const full_mid = full + SIZE*2;\
142
    put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 20, 52, 6);\
143
    OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 52, 20, 6);\
144
}\
145
\
146
static void OPNAME ## rv40_qpel ## SIZE ## _mc12_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
147
{\
148
    uint8_t full[SIZE*(SIZE+5)];\
149
    uint8_t * const full_mid = full + SIZE*2;\
150
    put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 52, 20, 6);\
151
    OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 20, 20, 5);\
152
}\
153
\
154
static void OPNAME ## rv40_qpel ## SIZE ## _mc22_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
155
{\
156
    uint8_t full[SIZE*(SIZE+5)];\
157
    uint8_t * const full_mid = full + SIZE*2;\
158
    put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 20, 20, 5);\
159
    OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 20, 20, 5);\
160
}\
161
\
162
static void OPNAME ## rv40_qpel ## SIZE ## _mc32_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
163
{\
164
    uint8_t full[SIZE*(SIZE+5)];\
165
    uint8_t * const full_mid = full + SIZE*2;\
166
    put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 20, 52, 6);\
167
    OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 20, 20, 5);\
168
}\
169
\
170
static void OPNAME ## rv40_qpel ## SIZE ## _mc03_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
171
{\
172
    OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, src, stride, stride, SIZE, 20, 52, 6);\
173
}\
174
\
175
static void OPNAME ## rv40_qpel ## SIZE ## _mc13_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
176
{\
177
    uint8_t full[SIZE*(SIZE+5)];\
178
    uint8_t * const full_mid = full + SIZE*2;\
179
    put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 52, 20, 6);\
180
    OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 20, 52, 6);\
181
}\
182
\
183
static void OPNAME ## rv40_qpel ## SIZE ## _mc23_c(uint8_t *dst, uint8_t *src, ptrdiff_t stride)\
184
{\
185
    uint8_t full[SIZE*(SIZE+5)];\
186
    uint8_t * const full_mid = full + SIZE*2;\
187
    put_rv40_qpel ## SIZE ## _h_lowpass(full, src - 2*stride, SIZE, stride, SIZE+5, 20, 20, 5);\
188
    OPNAME ## rv40_qpel ## SIZE ## _v_lowpass(dst, full_mid, stride, SIZE, SIZE, 20, 52, 6);\
189
}\
190
\
191
 
192
#define op_avg(a, b)  a = (((a)+cm[b]+1)>>1)
193
#define op_put(a, b)  a = cm[b]
194
 
195
RV40_LOWPASS(put_       , op_put)
196
RV40_LOWPASS(avg_       , op_avg)
197
 
198
#undef op_avg
199
#undef op_put
200
 
201
RV40_MC(put_, 8)
202
RV40_MC(put_, 16)
203
RV40_MC(avg_, 8)
204
RV40_MC(avg_, 16)
205
 
206
static const int rv40_bias[4][4] = {
207
    {  0, 16, 32, 16 },
208
    { 32, 28, 32, 28 },
209
    {  0, 32, 16, 32 },
210
    { 32, 28, 32, 28 }
211
};
212
 
213
#define RV40_CHROMA_MC(OPNAME, OP)\
214
static void OPNAME ## rv40_chroma_mc4_c(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y){\
215
    const int A = (8-x) * (8-y);\
216
    const int B = (  x) * (8-y);\
217
    const int C = (8-x) * (  y);\
218
    const int D = (  x) * (  y);\
219
    int i;\
220
    int bias = rv40_bias[y>>1][x>>1];\
221
    \
222
    av_assert2(x<8 && y<8 && x>=0 && y>=0);\
223
\
224
    if(D){\
225
        for(i = 0; i < h; i++){\
226
            OP(dst[0], (A*src[0] + B*src[1] + C*src[stride+0] + D*src[stride+1] + bias));\
227
            OP(dst[1], (A*src[1] + B*src[2] + C*src[stride+1] + D*src[stride+2] + bias));\
228
            OP(dst[2], (A*src[2] + B*src[3] + C*src[stride+2] + D*src[stride+3] + bias));\
229
            OP(dst[3], (A*src[3] + B*src[4] + C*src[stride+3] + D*src[stride+4] + bias));\
230
            dst += stride;\
231
            src += stride;\
232
        }\
233
    }else{\
234
        const int E = B + C;\
235
        const int step = C ? stride : 1;\
236
        for(i = 0; i < h; i++){\
237
            OP(dst[0], (A*src[0] + E*src[step+0] + bias));\
238
            OP(dst[1], (A*src[1] + E*src[step+1] + bias));\
239
            OP(dst[2], (A*src[2] + E*src[step+2] + bias));\
240
            OP(dst[3], (A*src[3] + E*src[step+3] + bias));\
241
            dst += stride;\
242
            src += stride;\
243
        }\
244
    }\
245
}\
246
\
247
static void OPNAME ## rv40_chroma_mc8_c(uint8_t *dst/*align 8*/, uint8_t *src/*align 1*/, int stride, int h, int x, int y){\
248
    const int A = (8-x) * (8-y);\
249
    const int B = (  x) * (8-y);\
250
    const int C = (8-x) * (  y);\
251
    const int D = (  x) * (  y);\
252
    int i;\
253
    int bias = rv40_bias[y>>1][x>>1];\
254
    \
255
    av_assert2(x<8 && y<8 && x>=0 && y>=0);\
256
\
257
    if(D){\
258
        for(i = 0; i < h; i++){\
259
            OP(dst[0], (A*src[0] + B*src[1] + C*src[stride+0] + D*src[stride+1] + bias));\
260
            OP(dst[1], (A*src[1] + B*src[2] + C*src[stride+1] + D*src[stride+2] + bias));\
261
            OP(dst[2], (A*src[2] + B*src[3] + C*src[stride+2] + D*src[stride+3] + bias));\
262
            OP(dst[3], (A*src[3] + B*src[4] + C*src[stride+3] + D*src[stride+4] + bias));\
263
            OP(dst[4], (A*src[4] + B*src[5] + C*src[stride+4] + D*src[stride+5] + bias));\
264
            OP(dst[5], (A*src[5] + B*src[6] + C*src[stride+5] + D*src[stride+6] + bias));\
265
            OP(dst[6], (A*src[6] + B*src[7] + C*src[stride+6] + D*src[stride+7] + bias));\
266
            OP(dst[7], (A*src[7] + B*src[8] + C*src[stride+7] + D*src[stride+8] + bias));\
267
            dst += stride;\
268
            src += stride;\
269
        }\
270
    }else{\
271
        const int E = B + C;\
272
        const int step = C ? stride : 1;\
273
        for(i = 0; i < h; i++){\
274
            OP(dst[0], (A*src[0] + E*src[step+0] + bias));\
275
            OP(dst[1], (A*src[1] + E*src[step+1] + bias));\
276
            OP(dst[2], (A*src[2] + E*src[step+2] + bias));\
277
            OP(dst[3], (A*src[3] + E*src[step+3] + bias));\
278
            OP(dst[4], (A*src[4] + E*src[step+4] + bias));\
279
            OP(dst[5], (A*src[5] + E*src[step+5] + bias));\
280
            OP(dst[6], (A*src[6] + E*src[step+6] + bias));\
281
            OP(dst[7], (A*src[7] + E*src[step+7] + bias));\
282
            dst += stride;\
283
            src += stride;\
284
        }\
285
    }\
286
}
287
 
288
#define op_avg(a, b) a = (((a)+((b)>>6)+1)>>1)
289
#define op_put(a, b) a = ((b)>>6)
290
 
291
RV40_CHROMA_MC(put_, op_put)
292
RV40_CHROMA_MC(avg_, op_avg)
293
 
294
#define RV40_WEIGHT_FUNC(size) \
295
static void rv40_weight_func_rnd_ ## size (uint8_t *dst, uint8_t *src1, uint8_t *src2, int w1, int w2, ptrdiff_t stride)\
296
{\
297
    int i, j;\
298
\
299
    for (j = 0; j < size; j++) {\
300
        for (i = 0; i < size; i++)\
301
            dst[i] = (((w2 * src1[i]) >> 9) + ((w1 * src2[i]) >> 9) + 0x10) >> 5;\
302
        src1 += stride;\
303
        src2 += stride;\
304
        dst  += stride;\
305
    }\
306
}\
307
static void rv40_weight_func_nornd_ ## size (uint8_t *dst, uint8_t *src1, uint8_t *src2, int w1, int w2, ptrdiff_t stride)\
308
{\
309
    int i, j;\
310
\
311
    for (j = 0; j < size; j++) {\
312
        for (i = 0; i < size; i++)\
313
            dst[i] = (w2 * src1[i] + w1 * src2[i] + 0x10) >> 5;\
314
        src1 += stride;\
315
        src2 += stride;\
316
        dst  += stride;\
317
    }\
318
}
319
 
320
RV40_WEIGHT_FUNC(16)
321
RV40_WEIGHT_FUNC(8)
322
 
323
/**
324
 * dither values for deblocking filter - left/top values
325
 */
326
static const uint8_t rv40_dither_l[16] = {
327
    0x40, 0x50, 0x20, 0x60, 0x30, 0x50, 0x40, 0x30,
328
    0x50, 0x40, 0x50, 0x30, 0x60, 0x20, 0x50, 0x40
329
};
330
 
331
/**
332
 * dither values for deblocking filter - right/bottom values
333
 */
334
static const uint8_t rv40_dither_r[16] = {
335
    0x40, 0x30, 0x60, 0x20, 0x50, 0x30, 0x30, 0x40,
336
    0x40, 0x40, 0x50, 0x30, 0x20, 0x60, 0x30, 0x40
337
};
338
 
339
#define CLIP_SYMM(a, b) av_clip(a, -(b), b)
340
/**
341
 * weaker deblocking very similar to the one described in 4.4.2 of JVT-A003r1
342
 */
343
static av_always_inline void rv40_weak_loop_filter(uint8_t *src,
344
                                                   const int step,
345
                                                   const ptrdiff_t stride,
346
                                                   const int filter_p1,
347
                                                   const int filter_q1,
348
                                                   const int alpha,
349
                                                   const int beta,
350
                                                   const int lim_p0q0,
351
                                                   const int lim_q1,
352
                                                   const int lim_p1)
353
{
354
    const uint8_t *cm = ff_cropTbl + MAX_NEG_CROP;
355
    int i, t, u, diff;
356
 
357
    for (i = 0; i < 4; i++, src += stride) {
358
        int diff_p1p0 = src[-2*step] - src[-1*step];
359
        int diff_q1q0 = src[ 1*step] - src[ 0*step];
360
        int diff_p1p2 = src[-2*step] - src[-3*step];
361
        int diff_q1q2 = src[ 1*step] - src[ 2*step];
362
 
363
        t = src[0*step] - src[-1*step];
364
        if (!t)
365
            continue;
366
 
367
        u = (alpha * FFABS(t)) >> 7;
368
        if (u > 3 - (filter_p1 && filter_q1))
369
            continue;
370
 
371
        t <<= 2;
372
        if (filter_p1 && filter_q1)
373
            t += src[-2*step] - src[1*step];
374
 
375
        diff = CLIP_SYMM((t + 4) >> 3, lim_p0q0);
376
        src[-1*step] = cm[src[-1*step] + diff];
377
        src[ 0*step] = cm[src[ 0*step] - diff];
378
 
379
        if (filter_p1 && FFABS(diff_p1p2) <= beta) {
380
            t = (diff_p1p0 + diff_p1p2 - diff) >> 1;
381
            src[-2*step] = cm[src[-2*step] - CLIP_SYMM(t, lim_p1)];
382
        }
383
 
384
        if (filter_q1 && FFABS(diff_q1q2) <= beta) {
385
            t = (diff_q1q0 + diff_q1q2 + diff) >> 1;
386
            src[ 1*step] = cm[src[ 1*step] - CLIP_SYMM(t, lim_q1)];
387
        }
388
    }
389
}
390
 
391
static void rv40_h_weak_loop_filter(uint8_t *src, const ptrdiff_t stride,
392
                                    const int filter_p1, const int filter_q1,
393
                                    const int alpha, const int beta,
394
                                    const int lim_p0q0, const int lim_q1,
395
                                    const int lim_p1)
396
{
397
    rv40_weak_loop_filter(src, stride, 1, filter_p1, filter_q1,
398
                          alpha, beta, lim_p0q0, lim_q1, lim_p1);
399
}
400
 
401
static void rv40_v_weak_loop_filter(uint8_t *src, const ptrdiff_t stride,
402
                                    const int filter_p1, const int filter_q1,
403
                                    const int alpha, const int beta,
404
                                    const int lim_p0q0, const int lim_q1,
405
                                    const int lim_p1)
406
{
407
    rv40_weak_loop_filter(src, 1, stride, filter_p1, filter_q1,
408
                          alpha, beta, lim_p0q0, lim_q1, lim_p1);
409
}
410
 
411
static av_always_inline void rv40_strong_loop_filter(uint8_t *src,
412
                                                     const int step,
413
                                                     const ptrdiff_t stride,
414
                                                     const int alpha,
415
                                                     const int lims,
416
                                                     const int dmode,
417
                                                     const int chroma)
418
{
419
    int i;
420
 
421
    for(i = 0; i < 4; i++, src += stride){
422
        int sflag, p0, q0, p1, q1;
423
        int t = src[0*step] - src[-1*step];
424
 
425
        if (!t)
426
            continue;
427
 
428
        sflag = (alpha * FFABS(t)) >> 7;
429
        if (sflag > 1)
430
            continue;
431
 
432
        p0 = (25*src[-3*step] + 26*src[-2*step] + 26*src[-1*step] +
433
              26*src[ 0*step] + 25*src[ 1*step] +
434
              rv40_dither_l[dmode + i]) >> 7;
435
 
436
        q0 = (25*src[-2*step] + 26*src[-1*step] + 26*src[ 0*step] +
437
              26*src[ 1*step] + 25*src[ 2*step] +
438
              rv40_dither_r[dmode + i]) >> 7;
439
 
440
        if (sflag) {
441
            p0 = av_clip(p0, src[-1*step] - lims, src[-1*step] + lims);
442
            q0 = av_clip(q0, src[ 0*step] - lims, src[ 0*step] + lims);
443
        }
444
 
445
        p1 = (25*src[-4*step] + 26*src[-3*step] + 26*src[-2*step] + 26*p0 +
446
              25*src[ 0*step] + rv40_dither_l[dmode + i]) >> 7;
447
        q1 = (25*src[-1*step] + 26*q0 + 26*src[ 1*step] + 26*src[ 2*step] +
448
              25*src[ 3*step] + rv40_dither_r[dmode + i]) >> 7;
449
 
450
        if (sflag) {
451
            p1 = av_clip(p1, src[-2*step] - lims, src[-2*step] + lims);
452
            q1 = av_clip(q1, src[ 1*step] - lims, src[ 1*step] + lims);
453
        }
454
 
455
        src[-2*step] = p1;
456
        src[-1*step] = p0;
457
        src[ 0*step] = q0;
458
        src[ 1*step] = q1;
459
 
460
        if(!chroma){
461
            src[-3*step] = (25*src[-1*step] + 26*src[-2*step] +
462
                            51*src[-3*step] + 26*src[-4*step] + 64) >> 7;
463
            src[ 2*step] = (25*src[ 0*step] + 26*src[ 1*step] +
464
                            51*src[ 2*step] + 26*src[ 3*step] + 64) >> 7;
465
        }
466
    }
467
}
468
 
469
static void rv40_h_strong_loop_filter(uint8_t *src, const ptrdiff_t stride,
470
                                      const int alpha, const int lims,
471
                                      const int dmode, const int chroma)
472
{
473
    rv40_strong_loop_filter(src, stride, 1, alpha, lims, dmode, chroma);
474
}
475
 
476
static void rv40_v_strong_loop_filter(uint8_t *src, const ptrdiff_t stride,
477
                                      const int alpha, const int lims,
478
                                      const int dmode, const int chroma)
479
{
480
    rv40_strong_loop_filter(src, 1, stride, alpha, lims, dmode, chroma);
481
}
482
 
483
static av_always_inline int rv40_loop_filter_strength(uint8_t *src,
484
                                                      int step, ptrdiff_t stride,
485
                                                      int beta, int beta2,
486
                                                      int edge,
487
                                                      int *p1, int *q1)
488
{
489
    int sum_p1p0 = 0, sum_q1q0 = 0, sum_p1p2 = 0, sum_q1q2 = 0;
490
    int strong0 = 0, strong1 = 0;
491
    uint8_t *ptr;
492
    int i;
493
 
494
    for (i = 0, ptr = src; i < 4; i++, ptr += stride) {
495
        sum_p1p0 += ptr[-2*step] - ptr[-1*step];
496
        sum_q1q0 += ptr[ 1*step] - ptr[ 0*step];
497
    }
498
 
499
    *p1 = FFABS(sum_p1p0) < (beta << 2);
500
    *q1 = FFABS(sum_q1q0) < (beta << 2);
501
 
502
    if(!*p1 && !*q1)
503
        return 0;
504
 
505
    if (!edge)
506
        return 0;
507
 
508
    for (i = 0, ptr = src; i < 4; i++, ptr += stride) {
509
        sum_p1p2 += ptr[-2*step] - ptr[-3*step];
510
        sum_q1q2 += ptr[ 1*step] - ptr[ 2*step];
511
    }
512
 
513
    strong0 = *p1 && (FFABS(sum_p1p2) < beta2);
514
    strong1 = *q1 && (FFABS(sum_q1q2) < beta2);
515
 
516
    return strong0 && strong1;
517
}
518
 
519
static int rv40_h_loop_filter_strength(uint8_t *src, ptrdiff_t stride,
520
                                       int beta, int beta2, int edge,
521
                                       int *p1, int *q1)
522
{
523
    return rv40_loop_filter_strength(src, stride, 1, beta, beta2, edge, p1, q1);
524
}
525
 
526
static int rv40_v_loop_filter_strength(uint8_t *src, ptrdiff_t stride,
527
                                       int beta, int beta2, int edge,
528
                                       int *p1, int *q1)
529
{
530
    return rv40_loop_filter_strength(src, 1, stride, beta, beta2, edge, p1, q1);
531
}
532
 
533
av_cold void ff_rv40dsp_init(RV34DSPContext *c)
534
{
535
    H264QpelContext qpel;
536
 
537
    ff_rv34dsp_init(c);
538
    ff_h264qpel_init(&qpel, 8);
539
 
540
    c->put_pixels_tab[0][ 0] = qpel.put_h264_qpel_pixels_tab[0][0];
541
    c->put_pixels_tab[0][ 1] = put_rv40_qpel16_mc10_c;
542
    c->put_pixels_tab[0][ 2] = qpel.put_h264_qpel_pixels_tab[0][2];
543
    c->put_pixels_tab[0][ 3] = put_rv40_qpel16_mc30_c;
544
    c->put_pixels_tab[0][ 4] = put_rv40_qpel16_mc01_c;
545
    c->put_pixels_tab[0][ 5] = put_rv40_qpel16_mc11_c;
546
    c->put_pixels_tab[0][ 6] = put_rv40_qpel16_mc21_c;
547
    c->put_pixels_tab[0][ 7] = put_rv40_qpel16_mc31_c;
548
    c->put_pixels_tab[0][ 8] = qpel.put_h264_qpel_pixels_tab[0][8];
549
    c->put_pixels_tab[0][ 9] = put_rv40_qpel16_mc12_c;
550
    c->put_pixels_tab[0][10] = put_rv40_qpel16_mc22_c;
551
    c->put_pixels_tab[0][11] = put_rv40_qpel16_mc32_c;
552
    c->put_pixels_tab[0][12] = put_rv40_qpel16_mc03_c;
553
    c->put_pixels_tab[0][13] = put_rv40_qpel16_mc13_c;
554
    c->put_pixels_tab[0][14] = put_rv40_qpel16_mc23_c;
555
    c->put_pixels_tab[0][15] = ff_put_rv40_qpel16_mc33_c;
556
    c->avg_pixels_tab[0][ 0] = qpel.avg_h264_qpel_pixels_tab[0][0];
557
    c->avg_pixels_tab[0][ 1] = avg_rv40_qpel16_mc10_c;
558
    c->avg_pixels_tab[0][ 2] = qpel.avg_h264_qpel_pixels_tab[0][2];
559
    c->avg_pixels_tab[0][ 3] = avg_rv40_qpel16_mc30_c;
560
    c->avg_pixels_tab[0][ 4] = avg_rv40_qpel16_mc01_c;
561
    c->avg_pixels_tab[0][ 5] = avg_rv40_qpel16_mc11_c;
562
    c->avg_pixels_tab[0][ 6] = avg_rv40_qpel16_mc21_c;
563
    c->avg_pixels_tab[0][ 7] = avg_rv40_qpel16_mc31_c;
564
    c->avg_pixels_tab[0][ 8] = qpel.avg_h264_qpel_pixels_tab[0][8];
565
    c->avg_pixels_tab[0][ 9] = avg_rv40_qpel16_mc12_c;
566
    c->avg_pixels_tab[0][10] = avg_rv40_qpel16_mc22_c;
567
    c->avg_pixels_tab[0][11] = avg_rv40_qpel16_mc32_c;
568
    c->avg_pixels_tab[0][12] = avg_rv40_qpel16_mc03_c;
569
    c->avg_pixels_tab[0][13] = avg_rv40_qpel16_mc13_c;
570
    c->avg_pixels_tab[0][14] = avg_rv40_qpel16_mc23_c;
571
    c->avg_pixels_tab[0][15] = ff_avg_rv40_qpel16_mc33_c;
572
    c->put_pixels_tab[1][ 0] = qpel.put_h264_qpel_pixels_tab[1][0];
573
    c->put_pixels_tab[1][ 1] = put_rv40_qpel8_mc10_c;
574
    c->put_pixels_tab[1][ 2] = qpel.put_h264_qpel_pixels_tab[1][2];
575
    c->put_pixels_tab[1][ 3] = put_rv40_qpel8_mc30_c;
576
    c->put_pixels_tab[1][ 4] = put_rv40_qpel8_mc01_c;
577
    c->put_pixels_tab[1][ 5] = put_rv40_qpel8_mc11_c;
578
    c->put_pixels_tab[1][ 6] = put_rv40_qpel8_mc21_c;
579
    c->put_pixels_tab[1][ 7] = put_rv40_qpel8_mc31_c;
580
    c->put_pixels_tab[1][ 8] = qpel.put_h264_qpel_pixels_tab[1][8];
581
    c->put_pixels_tab[1][ 9] = put_rv40_qpel8_mc12_c;
582
    c->put_pixels_tab[1][10] = put_rv40_qpel8_mc22_c;
583
    c->put_pixels_tab[1][11] = put_rv40_qpel8_mc32_c;
584
    c->put_pixels_tab[1][12] = put_rv40_qpel8_mc03_c;
585
    c->put_pixels_tab[1][13] = put_rv40_qpel8_mc13_c;
586
    c->put_pixels_tab[1][14] = put_rv40_qpel8_mc23_c;
587
    c->put_pixels_tab[1][15] = ff_put_rv40_qpel8_mc33_c;
588
    c->avg_pixels_tab[1][ 0] = qpel.avg_h264_qpel_pixels_tab[1][0];
589
    c->avg_pixels_tab[1][ 1] = avg_rv40_qpel8_mc10_c;
590
    c->avg_pixels_tab[1][ 2] = qpel.avg_h264_qpel_pixels_tab[1][2];
591
    c->avg_pixels_tab[1][ 3] = avg_rv40_qpel8_mc30_c;
592
    c->avg_pixels_tab[1][ 4] = avg_rv40_qpel8_mc01_c;
593
    c->avg_pixels_tab[1][ 5] = avg_rv40_qpel8_mc11_c;
594
    c->avg_pixels_tab[1][ 6] = avg_rv40_qpel8_mc21_c;
595
    c->avg_pixels_tab[1][ 7] = avg_rv40_qpel8_mc31_c;
596
    c->avg_pixels_tab[1][ 8] = qpel.avg_h264_qpel_pixels_tab[1][8];
597
    c->avg_pixels_tab[1][ 9] = avg_rv40_qpel8_mc12_c;
598
    c->avg_pixels_tab[1][10] = avg_rv40_qpel8_mc22_c;
599
    c->avg_pixels_tab[1][11] = avg_rv40_qpel8_mc32_c;
600
    c->avg_pixels_tab[1][12] = avg_rv40_qpel8_mc03_c;
601
    c->avg_pixels_tab[1][13] = avg_rv40_qpel8_mc13_c;
602
    c->avg_pixels_tab[1][14] = avg_rv40_qpel8_mc23_c;
603
    c->avg_pixels_tab[1][15] = ff_avg_rv40_qpel8_mc33_c;
604
 
605
    c->put_chroma_pixels_tab[0] = put_rv40_chroma_mc8_c;
606
    c->put_chroma_pixels_tab[1] = put_rv40_chroma_mc4_c;
607
    c->avg_chroma_pixels_tab[0] = avg_rv40_chroma_mc8_c;
608
    c->avg_chroma_pixels_tab[1] = avg_rv40_chroma_mc4_c;
609
 
610
    c->rv40_weight_pixels_tab[0][0] = rv40_weight_func_rnd_16;
611
    c->rv40_weight_pixels_tab[0][1] = rv40_weight_func_rnd_8;
612
    c->rv40_weight_pixels_tab[1][0] = rv40_weight_func_nornd_16;
613
    c->rv40_weight_pixels_tab[1][1] = rv40_weight_func_nornd_8;
614
 
615
    c->rv40_weak_loop_filter[0]     = rv40_h_weak_loop_filter;
616
    c->rv40_weak_loop_filter[1]     = rv40_v_weak_loop_filter;
617
    c->rv40_strong_loop_filter[0]   = rv40_h_strong_loop_filter;
618
    c->rv40_strong_loop_filter[1]   = rv40_v_strong_loop_filter;
619
    c->rv40_loop_filter_strength[0] = rv40_h_loop_filter_strength;
620
    c->rv40_loop_filter_strength[1] = rv40_v_loop_filter_strength;
621
 
622
    if (ARCH_ARM)
623
        ff_rv40dsp_init_arm(c);
624
    if (ARCH_X86)
625
        ff_rv40dsp_init_x86(c);
626
}