Statistics
| Branch: | Revision:

ffmpeg / libavcodec / sh4 / dsputil_align.c @ 8dbe5856

History | View | Annotate | Download (14.6 KB)

1
/*
2
 * aligned/packed access motion
3
 *
4
 * Copyright (c) 2001-2003 BERO <bero@geocities.co.jp>
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
#include "libavcodec/avcodec.h"
25
#include "libavcodec/dsputil.h"
26
#include "dsputil_sh4.h"
27

    
28

    
29
#define         LP(p)           *(uint32_t*)(p)
30
#define         LPC(p)          *(const uint32_t*)(p)
31

    
32

    
33
#define         UNPACK(ph,pl,tt0,tt1) do { \
34
        uint32_t t0,t1; t0=tt0;t1=tt1; \
35
        ph = ( (t0 & ~BYTE_VEC32(0x03))>>2) + ( (t1 & ~BYTE_VEC32(0x03))>>2); \
36
        pl = (t0 & BYTE_VEC32(0x03)) + (t1 & BYTE_VEC32(0x03)); } while(0)
37

    
38
#define         rnd_PACK(ph,pl,nph,npl) ph + nph + (((pl + npl + BYTE_VEC32(0x02))>>2) & BYTE_VEC32(0x03))
39
#define         no_rnd_PACK(ph,pl,nph,npl)      ph + nph + (((pl + npl + BYTE_VEC32(0x01))>>2) & BYTE_VEC32(0x03))
40

    
41
/* little endian */
42
#define         MERGE1(a,b,ofs) (ofs==0)?a:( ((a)>>(8*ofs))|((b)<<(32-8*ofs)) )
43
#define         MERGE2(a,b,ofs) (ofs==3)?b:( ((a)>>(8*(ofs+1)))|((b)<<(32-8*(ofs+1))) )
44
/* big
45
#define         MERGE1(a,b,ofs) (ofs==0)?a:( ((a)<<(8*ofs))|((b)>>(32-8*ofs)) )
46
#define         MERGE2(a,b,ofs) (ofs==3)?b:( ((a)<<(8+8*ofs))|((b)>>(32-8-8*ofs)) )
47
*/
48

    
49

    
50
#define         put(d,s)        d = s
51
#define         avg(d,s)        d = rnd_avg32(s,d)
52

    
53
#define         OP_C4(ofs) \
54
        ref-=ofs; \
55
        do { \
56
                OP(LP(dest),MERGE1(LPC(ref),LPC(ref+4),ofs)); \
57
                ref+=stride; \
58
                dest+=stride; \
59
        } while(--height)
60

    
61
#define        OP_C40() \
62
        do { \
63
                OP(LP(dest),LPC(ref)); \
64
                ref+=stride; \
65
                dest+=stride; \
66
        } while(--height)
67

    
68

    
69
#define         OP      put
70

    
71
static void put_pixels4_c(uint8_t *dest,const uint8_t *ref, const int stride,int height)
72
{
73
        switch((int)ref&3){
74
        case 0: OP_C40(); return;
75
        case 1: OP_C4(1); return;
76
        case 2: OP_C4(2); return;
77
        case 3: OP_C4(3); return;
78
        }
79
}
80

    
81
#undef          OP
82
#define         OP      avg
83

    
84
static void avg_pixels4_c(uint8_t *dest,const uint8_t *ref, const int stride,int height)
85
{
86
        switch((int)ref&3){
87
        case 0: OP_C40(); return;
88
        case 1: OP_C4(1); return;
89
        case 2: OP_C4(2); return;
90
        case 3: OP_C4(3); return;
91
        }
92
}
93

    
94
#undef          OP
95

    
96
#define         OP_C(ofs,sz,avg2) \
97
{ \
98
        ref-=ofs; \
99
        do { \
100
                uint32_t        t0,t1; \
101
                t0 = LPC(ref+0); \
102
                t1 = LPC(ref+4); \
103
                OP(LP(dest+0), MERGE1(t0,t1,ofs)); \
104
                t0 = LPC(ref+8); \
105
                OP(LP(dest+4), MERGE1(t1,t0,ofs)); \
106
if (sz==16) { \
107
                t1 = LPC(ref+12); \
108
                OP(LP(dest+8), MERGE1(t0,t1,ofs)); \
109
                t0 = LPC(ref+16); \
110
                OP(LP(dest+12), MERGE1(t1,t0,ofs)); \
111
} \
112
                ref+=stride; \
113
                dest+= stride; \
114
        } while(--height); \
115
}
116

    
117
/* aligned */
118
#define         OP_C0(sz,avg2) \
119
{ \
120
        do { \
121
                OP(LP(dest+0), LPC(ref+0)); \
122
                OP(LP(dest+4), LPC(ref+4)); \
123
if (sz==16) { \
124
                OP(LP(dest+8), LPC(ref+8)); \
125
                OP(LP(dest+12), LPC(ref+12)); \
126
} \
127
                ref+=stride; \
128
                dest+= stride; \
129
        } while(--height); \
130
}
131

    
132
#define         OP_X(ofs,sz,avg2) \
133
{ \
134
        ref-=ofs; \
135
        do { \
136
                uint32_t        t0,t1; \
137
                t0 = LPC(ref+0); \
138
                t1 = LPC(ref+4); \
139
                OP(LP(dest+0), avg2(MERGE1(t0,t1,ofs),MERGE2(t0,t1,ofs))); \
140
                t0 = LPC(ref+8); \
141
                OP(LP(dest+4), avg2(MERGE1(t1,t0,ofs),MERGE2(t1,t0,ofs))); \
142
if (sz==16) { \
143
                t1 = LPC(ref+12); \
144
                OP(LP(dest+8), avg2(MERGE1(t0,t1,ofs),MERGE2(t0,t1,ofs))); \
145
                t0 = LPC(ref+16); \
146
                OP(LP(dest+12), avg2(MERGE1(t1,t0,ofs),MERGE2(t1,t0,ofs))); \
147
} \
148
                ref+=stride; \
149
                dest+= stride; \
150
        } while(--height); \
151
}
152

    
153
/* aligned */
154
#define         OP_Y0(sz,avg2) \
155
{ \
156
        uint32_t t0,t1,t2,t3,t; \
157
\
158
        t0 = LPC(ref+0); \
159
        t1 = LPC(ref+4); \
160
if (sz==16) { \
161
        t2 = LPC(ref+8); \
162
        t3 = LPC(ref+12); \
163
} \
164
        do { \
165
                ref += stride; \
166
\
167
                t = LPC(ref+0); \
168
                OP(LP(dest+0), avg2(t0,t)); t0 = t; \
169
                t = LPC(ref+4); \
170
                OP(LP(dest+4), avg2(t1,t)); t1 = t; \
171
if (sz==16) { \
172
                t = LPC(ref+8); \
173
                OP(LP(dest+8), avg2(t2,t)); t2 = t; \
174
                t = LPC(ref+12); \
175
                OP(LP(dest+12), avg2(t3,t)); t3 = t; \
176
} \
177
                dest+= stride; \
178
        } while(--height); \
179
}
180

    
181
#define         OP_Y(ofs,sz,avg2) \
182
{ \
183
        uint32_t t0,t1,t2,t3,t,w0,w1; \
184
\
185
        ref-=ofs; \
186
        w0 = LPC(ref+0); \
187
        w1 = LPC(ref+4); \
188
        t0 = MERGE1(w0,w1,ofs); \
189
        w0 = LPC(ref+8); \
190
        t1 = MERGE1(w1,w0,ofs); \
191
if (sz==16) { \
192
        w1 = LPC(ref+12); \
193
        t2 = MERGE1(w0,w1,ofs); \
194
        w0 = LPC(ref+16); \
195
        t3 = MERGE1(w1,w0,ofs); \
196
} \
197
        do { \
198
                ref += stride; \
199
\
200
                w0 = LPC(ref+0); \
201
                w1 = LPC(ref+4); \
202
                t = MERGE1(w0,w1,ofs); \
203
                OP(LP(dest+0), avg2(t0,t)); t0 = t; \
204
                w0 = LPC(ref+8); \
205
                t = MERGE1(w1,w0,ofs); \
206
                OP(LP(dest+4), avg2(t1,t)); t1 = t; \
207
if (sz==16) { \
208
                w1 = LPC(ref+12); \
209
                t = MERGE1(w0,w1,ofs); \
210
                OP(LP(dest+8), avg2(t2,t)); t2 = t; \
211
                w0 = LPC(ref+16); \
212
                t = MERGE1(w1,w0,ofs); \
213
                OP(LP(dest+12), avg2(t3,t)); t3 = t; \
214
} \
215
                dest+=stride; \
216
        } while(--height); \
217
}
218

    
219
#define OP_X0(sz,avg2) OP_X(0,sz,avg2)
220
#define OP_XY0(sz,PACK) OP_XY(0,sz,PACK)
221
#define         OP_XY(ofs,sz,PACK) \
222
{ \
223
        uint32_t        t2,t3,w0,w1; \
224
        uint32_t        a0,a1,a2,a3,a4,a5,a6,a7; \
225
\
226
        ref -= ofs; \
227
        w0 = LPC(ref+0); \
228
        w1 = LPC(ref+4); \
229
        UNPACK(a0,a1,MERGE1(w0,w1,ofs),MERGE2(w0,w1,ofs)); \
230
        w0 = LPC(ref+8); \
231
        UNPACK(a2,a3,MERGE1(w1,w0,ofs),MERGE2(w1,w0,ofs)); \
232
if (sz==16) { \
233
        w1 = LPC(ref+12); \
234
        UNPACK(a4,a5,MERGE1(w0,w1,ofs),MERGE2(w0,w1,ofs)); \
235
        w0 = LPC(ref+16); \
236
        UNPACK(a6,a7,MERGE1(w1,w0,ofs),MERGE2(w1,w0,ofs)); \
237
} \
238
        do { \
239
                ref+=stride; \
240
                w0 = LPC(ref+0); \
241
                w1 = LPC(ref+4); \
242
                UNPACK(t2,t3,MERGE1(w0,w1,ofs),MERGE2(w0,w1,ofs)); \
243
                OP(LP(dest+0),PACK(a0,a1,t2,t3)); \
244
                a0 = t2; a1 = t3; \
245
                w0 = LPC(ref+8); \
246
                UNPACK(t2,t3,MERGE1(w1,w0,ofs),MERGE2(w1,w0,ofs)); \
247
                OP(LP(dest+4),PACK(a2,a3,t2,t3)); \
248
                a2 = t2; a3 = t3; \
249
if (sz==16) { \
250
                w1 = LPC(ref+12); \
251
                UNPACK(t2,t3,MERGE1(w0,w1,ofs),MERGE2(w0,w1,ofs)); \
252
                OP(LP(dest+8),PACK(a4,a5,t2,t3)); \
253
                a4 = t2; a5 = t3; \
254
                w0 = LPC(ref+16); \
255
                UNPACK(t2,t3,MERGE1(w1,w0,ofs),MERGE2(w1,w0,ofs)); \
256
                OP(LP(dest+12),PACK(a6,a7,t2,t3)); \
257
                a6 = t2; a7 = t3; \
258
} \
259
                dest+=stride; \
260
        } while(--height); \
261
}
262

    
263
#define         DEFFUNC(op,rnd,xy,sz,OP_N,avgfunc) \
264
static void op##_##rnd##_pixels##sz##_##xy (uint8_t * dest, const uint8_t * ref, \
265
                                const int stride, int height) \
266
{ \
267
        switch((int)ref&3) { \
268
        case 0:OP_N##0(sz,rnd##_##avgfunc); return; \
269
        case 1:OP_N(1,sz,rnd##_##avgfunc); return; \
270
        case 2:OP_N(2,sz,rnd##_##avgfunc); return; \
271
        case 3:OP_N(3,sz,rnd##_##avgfunc); return; \
272
        } \
273
}
274

    
275
#define OP put
276

    
277
DEFFUNC(put,   rnd,o,8,OP_C,avg32)
278
DEFFUNC(put,   rnd,x,8,OP_X,avg32)
279
DEFFUNC(put,no_rnd,x,8,OP_X,avg32)
280
DEFFUNC(put,   rnd,y,8,OP_Y,avg32)
281
DEFFUNC(put,no_rnd,y,8,OP_Y,avg32)
282
DEFFUNC(put,   rnd,xy,8,OP_XY,PACK)
283
DEFFUNC(put,no_rnd,xy,8,OP_XY,PACK)
284
DEFFUNC(put,   rnd,o,16,OP_C,avg32)
285
DEFFUNC(put,   rnd,x,16,OP_X,avg32)
286
DEFFUNC(put,no_rnd,x,16,OP_X,avg32)
287
DEFFUNC(put,   rnd,y,16,OP_Y,avg32)
288
DEFFUNC(put,no_rnd,y,16,OP_Y,avg32)
289
DEFFUNC(put,   rnd,xy,16,OP_XY,PACK)
290
DEFFUNC(put,no_rnd,xy,16,OP_XY,PACK)
291

    
292
#undef OP
293
#define OP avg
294

    
295
DEFFUNC(avg,   rnd,o,8,OP_C,avg32)
296
DEFFUNC(avg,   rnd,x,8,OP_X,avg32)
297
DEFFUNC(avg,no_rnd,x,8,OP_X,avg32)
298
DEFFUNC(avg,   rnd,y,8,OP_Y,avg32)
299
DEFFUNC(avg,no_rnd,y,8,OP_Y,avg32)
300
DEFFUNC(avg,   rnd,xy,8,OP_XY,PACK)
301
DEFFUNC(avg,no_rnd,xy,8,OP_XY,PACK)
302
DEFFUNC(avg,   rnd,o,16,OP_C,avg32)
303
DEFFUNC(avg,   rnd,x,16,OP_X,avg32)
304
DEFFUNC(avg,no_rnd,x,16,OP_X,avg32)
305
DEFFUNC(avg,   rnd,y,16,OP_Y,avg32)
306
DEFFUNC(avg,no_rnd,y,16,OP_Y,avg32)
307
DEFFUNC(avg,   rnd,xy,16,OP_XY,PACK)
308
DEFFUNC(avg,no_rnd,xy,16,OP_XY,PACK)
309

    
310
#undef OP
311

    
312
#define         put_no_rnd_pixels8_o     put_rnd_pixels8_o
313
#define         put_no_rnd_pixels16_o    put_rnd_pixels16_o
314
#define         avg_no_rnd_pixels8_o     avg_rnd_pixels8_o
315
#define         avg_no_rnd_pixels16_o    avg_rnd_pixels16_o
316

    
317
#define         put_pixels8_c            put_rnd_pixels8_o
318
#define         put_pixels16_c           put_rnd_pixels16_o
319
#define         avg_pixels8_c            avg_rnd_pixels8_o
320
#define         avg_pixels16_c           avg_rnd_pixels16_o
321
#define         put_no_rnd_pixels8_c     put_rnd_pixels8_o
322
#define         put_no_rnd_pixels16_c    put_rnd_pixels16_o
323
#define         avg_no_rnd_pixels8_c     avg_rnd_pixels8_o
324
#define         avg_no_rnd_pixels16_c    avg_rnd_pixels16_o
325

    
326
#define         QPEL
327

    
328
#ifdef QPEL
329

    
330
#include "qpel.c"
331

    
332
#endif
333

    
334
void dsputil_init_align(DSPContext* c, AVCodecContext *avctx)
335
{
336
        const int h264_high_depth = avctx->codec_id == CODEC_ID_H264 && avctx->bits_per_raw_sample > 8;
337

    
338
        if (!h264_high_depth) {
339
        c->put_pixels_tab[0][0] = put_rnd_pixels16_o;
340
        c->put_pixels_tab[0][1] = put_rnd_pixels16_x;
341
        c->put_pixels_tab[0][2] = put_rnd_pixels16_y;
342
        c->put_pixels_tab[0][3] = put_rnd_pixels16_xy;
343
        c->put_pixels_tab[1][0] = put_rnd_pixels8_o;
344
        c->put_pixels_tab[1][1] = put_rnd_pixels8_x;
345
        c->put_pixels_tab[1][2] = put_rnd_pixels8_y;
346
        c->put_pixels_tab[1][3] = put_rnd_pixels8_xy;
347

    
348
        c->put_no_rnd_pixels_tab[0][0] = put_no_rnd_pixels16_o;
349
        c->put_no_rnd_pixels_tab[0][1] = put_no_rnd_pixels16_x;
350
        c->put_no_rnd_pixels_tab[0][2] = put_no_rnd_pixels16_y;
351
        c->put_no_rnd_pixels_tab[0][3] = put_no_rnd_pixels16_xy;
352
        c->put_no_rnd_pixels_tab[1][0] = put_no_rnd_pixels8_o;
353
        c->put_no_rnd_pixels_tab[1][1] = put_no_rnd_pixels8_x;
354
        c->put_no_rnd_pixels_tab[1][2] = put_no_rnd_pixels8_y;
355
        c->put_no_rnd_pixels_tab[1][3] = put_no_rnd_pixels8_xy;
356

    
357
        c->avg_pixels_tab[0][0] = avg_rnd_pixels16_o;
358
        c->avg_pixels_tab[0][1] = avg_rnd_pixels16_x;
359
        c->avg_pixels_tab[0][2] = avg_rnd_pixels16_y;
360
        c->avg_pixels_tab[0][3] = avg_rnd_pixels16_xy;
361
        c->avg_pixels_tab[1][0] = avg_rnd_pixels8_o;
362
        c->avg_pixels_tab[1][1] = avg_rnd_pixels8_x;
363
        c->avg_pixels_tab[1][2] = avg_rnd_pixels8_y;
364
        c->avg_pixels_tab[1][3] = avg_rnd_pixels8_xy;
365

    
366
        c->avg_no_rnd_pixels_tab[0][0] = avg_no_rnd_pixels16_o;
367
        c->avg_no_rnd_pixels_tab[0][1] = avg_no_rnd_pixels16_x;
368
        c->avg_no_rnd_pixels_tab[0][2] = avg_no_rnd_pixels16_y;
369
        c->avg_no_rnd_pixels_tab[0][3] = avg_no_rnd_pixels16_xy;
370
        c->avg_no_rnd_pixels_tab[1][0] = avg_no_rnd_pixels8_o;
371
        c->avg_no_rnd_pixels_tab[1][1] = avg_no_rnd_pixels8_x;
372
        c->avg_no_rnd_pixels_tab[1][2] = avg_no_rnd_pixels8_y;
373
        c->avg_no_rnd_pixels_tab[1][3] = avg_no_rnd_pixels8_xy;
374
        }
375

    
376
#ifdef QPEL
377

    
378
#define dspfunc(PFX, IDX, NUM) \
379
    c->PFX ## _pixels_tab[IDX][ 0] = PFX ## NUM ## _mc00_sh4; \
380
    c->PFX ## _pixels_tab[IDX][ 1] = PFX ## NUM ## _mc10_sh4; \
381
    c->PFX ## _pixels_tab[IDX][ 2] = PFX ## NUM ## _mc20_sh4; \
382
    c->PFX ## _pixels_tab[IDX][ 3] = PFX ## NUM ## _mc30_sh4; \
383
    c->PFX ## _pixels_tab[IDX][ 4] = PFX ## NUM ## _mc01_sh4; \
384
    c->PFX ## _pixels_tab[IDX][ 5] = PFX ## NUM ## _mc11_sh4; \
385
    c->PFX ## _pixels_tab[IDX][ 6] = PFX ## NUM ## _mc21_sh4; \
386
    c->PFX ## _pixels_tab[IDX][ 7] = PFX ## NUM ## _mc31_sh4; \
387
    c->PFX ## _pixels_tab[IDX][ 8] = PFX ## NUM ## _mc02_sh4; \
388
    c->PFX ## _pixels_tab[IDX][ 9] = PFX ## NUM ## _mc12_sh4; \
389
    c->PFX ## _pixels_tab[IDX][10] = PFX ## NUM ## _mc22_sh4; \
390
    c->PFX ## _pixels_tab[IDX][11] = PFX ## NUM ## _mc32_sh4; \
391
    c->PFX ## _pixels_tab[IDX][12] = PFX ## NUM ## _mc03_sh4; \
392
    c->PFX ## _pixels_tab[IDX][13] = PFX ## NUM ## _mc13_sh4; \
393
    c->PFX ## _pixels_tab[IDX][14] = PFX ## NUM ## _mc23_sh4; \
394
    c->PFX ## _pixels_tab[IDX][15] = PFX ## NUM ## _mc33_sh4
395

    
396
    dspfunc(put_qpel, 0, 16);
397
    dspfunc(put_no_rnd_qpel, 0, 16);
398

    
399
    dspfunc(avg_qpel, 0, 16);
400
    /* dspfunc(avg_no_rnd_qpel, 0, 16); */
401

    
402
    dspfunc(put_qpel, 1, 8);
403
    dspfunc(put_no_rnd_qpel, 1, 8);
404

    
405
    dspfunc(avg_qpel, 1, 8);
406
    /* dspfunc(avg_no_rnd_qpel, 1, 8); */
407

    
408
    if (!h264_high_depth) {
409
    dspfunc(put_h264_qpel, 0, 16);
410
    dspfunc(put_h264_qpel, 1, 8);
411
    dspfunc(put_h264_qpel, 2, 4);
412
    dspfunc(avg_h264_qpel, 0, 16);
413
    dspfunc(avg_h264_qpel, 1, 8);
414
    dspfunc(avg_h264_qpel, 2, 4);
415
    }
416

    
417
#undef dspfunc
418
    if (!h264_high_depth) {
419
    c->put_h264_chroma_pixels_tab[0]= put_h264_chroma_mc8_sh4;
420
    c->put_h264_chroma_pixels_tab[1]= put_h264_chroma_mc4_sh4;
421
    c->put_h264_chroma_pixels_tab[2]= put_h264_chroma_mc2_sh4;
422
    c->avg_h264_chroma_pixels_tab[0]= avg_h264_chroma_mc8_sh4;
423
    c->avg_h264_chroma_pixels_tab[1]= avg_h264_chroma_mc4_sh4;
424
    c->avg_h264_chroma_pixels_tab[2]= avg_h264_chroma_mc2_sh4;
425
    }
426

    
427
    c->put_mspel_pixels_tab[0]= put_mspel8_mc00_sh4;
428
    c->put_mspel_pixels_tab[1]= put_mspel8_mc10_sh4;
429
    c->put_mspel_pixels_tab[2]= put_mspel8_mc20_sh4;
430
    c->put_mspel_pixels_tab[3]= put_mspel8_mc30_sh4;
431
    c->put_mspel_pixels_tab[4]= put_mspel8_mc02_sh4;
432
    c->put_mspel_pixels_tab[5]= put_mspel8_mc12_sh4;
433
    c->put_mspel_pixels_tab[6]= put_mspel8_mc22_sh4;
434
    c->put_mspel_pixels_tab[7]= put_mspel8_mc32_sh4;
435

    
436
    c->gmc1 = gmc1_c;
437
    c->gmc = gmc_c;
438

    
439
#endif
440
}