CoCalc -- pixel.c

05. Matplotlib / ffmpeg-3.0 / libx264 / common / ppc / pixel.c
⁵²⁸⁶⁷ views
1
/*****************************************************************************
2
 * pixel.c: ppc pixel metrics
3
 *****************************************************************************
4
 * Copyright (C) 2003-2016 x264 project
5
 *
6
 * Authors: Eric Petit <[email protected]>
7
 *          Guillaume Poirier <[email protected]>
8
 *
9
 * This program is free software; you can redistribute it and/or modify
10
 * it under the terms of the GNU General Public License as published by
11
 * the Free Software Foundation; either version 2 of the License, or
12
 * (at your option) any later version.
13
 *
14
 * This program is distributed in the hope that it will be useful,
15
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17
 * GNU General Public License for more details.
18
 *
19
 * You should have received a copy of the GNU General Public License
20
 * along with this program; if not, write to the Free Software
21
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02111, USA.
22
 *
23
 * This program is also available under a commercial proprietary license.
24
 * For more information, contact us at [email protected].
25
 *****************************************************************************/
26

27
#include "common/common.h"
28
#include "ppccommon.h"
29
#include "../predict.h"
30

31
#if !HIGH_BIT_DEPTH
32
/***********************************************************************
33
 * SAD routines
34
 **********************************************************************/
35

36
#define PIXEL_SAD_ALTIVEC( name, lx, ly, a, b )        \
37
static int name( uint8_t *pix1, intptr_t i_pix1,       \
38
                 uint8_t *pix2, intptr_t i_pix2 )      \
39
{                                                      \
40
    ALIGNED_16( int sum );                             \
41
                                                       \
42
    LOAD_ZERO;                                         \
43
    PREP_LOAD;                                         \
44
    vec_u8_t  pix1v, pix2v;                            \
45
    vec_s32_t sumv = zero_s32v;                        \
46
    for( int y = 0; y < ly; y++ )                      \
47
    {                                                  \
48
        VEC_LOAD_G( pix1, pix1v, lx, vec_u8_t );       \
49
        VEC_LOAD_G( pix2, pix2v, lx, vec_u8_t );       \
50
        sumv = (vec_s32_t) vec_sum4s(                  \
51
                   vec_sub( vec_max( pix1v, pix2v ),   \
52
                            vec_min( pix1v, pix2v ) ), \
53
                   (vec_u32_t) sumv );                 \
54
        pix1 += i_pix1;                                \
55
        pix2 += i_pix2;                                \
56
    }                                                  \
57
    sumv = vec_sum##a( sumv, zero_s32v );              \
58
    sumv = vec_splat( sumv, b );                       \
59
    vec_ste( sumv, 0, &sum );                          \
60
    return sum;                                        \
61
}
62

63
PIXEL_SAD_ALTIVEC( pixel_sad_16x16_altivec, 16, 16, s,  3 )
64
PIXEL_SAD_ALTIVEC( pixel_sad_8x16_altivec,  8,  16, 2s, 1 )
65
PIXEL_SAD_ALTIVEC( pixel_sad_16x8_altivec,  16, 8,  s,  3 )
66
PIXEL_SAD_ALTIVEC( pixel_sad_8x8_altivec,   8,  8,  2s, 1 )
67

68

69

70
/***********************************************************************
71
 * SATD routines
72
 **********************************************************************/
73

74
/***********************************************************************
75
 * VEC_HADAMAR
76
 ***********************************************************************
77
 * b[0] = a[0] + a[1] + a[2] + a[3]
78
 * b[1] = a[0] + a[1] - a[2] - a[3]
79
 * b[2] = a[0] - a[1] - a[2] + a[3]
80
 * b[3] = a[0] - a[1] + a[2] - a[3]
81
 **********************************************************************/
82
#define VEC_HADAMAR(a0,a1,a2,a3,b0,b1,b2,b3) \
83
    b2 = vec_add( a0, a1 ); \
84
    b3 = vec_add( a2, a3 ); \
85
    a0 = vec_sub( a0, a1 ); \
86
    a2 = vec_sub( a2, a3 ); \
87
    b0 = vec_add( b2, b3 ); \
88
    b1 = vec_sub( b2, b3 ); \
89
    b2 = vec_sub( a0, a2 ); \
90
    b3 = vec_add( a0, a2 )
91

92
/***********************************************************************
93
 * VEC_ABS
94
 ***********************************************************************
95
 * a: s16v
96
 *
97
 * a = abs(a)
98
 *
99
 * Call vec_sub()/vec_max() instead of vec_abs() because vec_abs()
100
 * actually also calls vec_splat(0), but we already have a null vector.
101
 **********************************************************************/
102
#define VEC_ABS(a)                            \
103
    a = vec_max( a, vec_sub( zero_s16v, a ) );
104

105
#define VEC_ABSOLUTE(a) (vec_u16_t)vec_max( a, vec_sub( zero_s16v, a ) )
106

107
/***********************************************************************
108
 * VEC_ADD_ABS
109
 ***********************************************************************
110
 * a:    s16v
111
 * b, c: s32v
112
 *
113
 * c[i] = abs(a[2*i]) + abs(a[2*i+1]) + [bi]
114
 **********************************************************************/
115
#define VEC_ADD_ABS(a,b,c) \
116
    VEC_ABS( a );          \
117
    c = vec_sum4s( a, b )
118

119
/***********************************************************************
120
 * SATD 4x4
121
 **********************************************************************/
122
static int pixel_satd_4x4_altivec( uint8_t *pix1, intptr_t i_pix1,
123
                                   uint8_t *pix2, intptr_t i_pix2 )
124
{
125
    ALIGNED_16( int i_satd );
126

127
    PREP_DIFF;
128
    PREP_LOAD_SRC( pix1 );
129
    vec_s16_t diff0v, diff1v, diff2v, diff3v;
130
    vec_s16_t temp0v, temp1v, temp2v, temp3v;
131
    vec_s32_t satdv;
132

133
    vec_u8_t _offset1v_ = vec_lvsl(0, pix2);
134
    vec_u8_t _offset2v_ = vec_lvsl(0, pix2 + i_pix2);
135

136

137
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff0v, offset1v );
138
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff1v, offset2v );
139
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff2v, offset1v );
140
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff3v, offset2v );
141

142
    /* Hadamar H */
143
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
144
                 temp0v, temp1v, temp2v, temp3v );
145

146
    VEC_TRANSPOSE_4( temp0v, temp1v, temp2v, temp3v,
147
                     diff0v, diff1v, diff2v, diff3v );
148
    /* Hadamar V */
149
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
150
                 temp0v, temp1v, temp2v, temp3v );
151

152
    VEC_ADD_ABS( temp0v, zero_s32v, satdv );
153
    VEC_ADD_ABS( temp1v, satdv,     satdv );
154
    VEC_ADD_ABS( temp2v, satdv,     satdv );
155
    VEC_ADD_ABS( temp3v, satdv,     satdv );
156

157
    satdv = vec_sum2s( satdv, zero_s32v );
158
    satdv = vec_splat( satdv, 1 );
159
    vec_ste( satdv, 0, &i_satd );
160

161
    return i_satd >> 1;
162
}
163

164
/***********************************************************************
165
 * SATD 4x8
166
 **********************************************************************/
167
static int pixel_satd_4x8_altivec( uint8_t *pix1, intptr_t i_pix1,
168
                                   uint8_t *pix2, intptr_t i_pix2 )
169
{
170
    ALIGNED_16( int i_satd );
171

172
    PREP_DIFF;
173
    vec_s16_t diff0v, diff1v, diff2v, diff3v;
174
    vec_s16_t temp0v, temp1v, temp2v, temp3v;
175
    vec_s32_t satdv;
176

177
    PREP_LOAD_SRC( pix1 );
178
    vec_u8_t _offset1v_ = vec_lvsl(0, pix2);
179
    vec_u8_t _offset2v_ = vec_lvsl(0, pix2 + i_pix2);
180

181
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff0v, offset1v );
182
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff1v, offset2v );
183
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff2v, offset1v );
184
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff3v, offset2v );
185
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
186
                 temp0v, temp1v, temp2v, temp3v );
187
    VEC_TRANSPOSE_4( temp0v, temp1v, temp2v, temp3v,
188
                     diff0v, diff1v, diff2v, diff3v );
189
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
190
                 temp0v, temp1v, temp2v, temp3v );
191
    VEC_ADD_ABS( temp0v, zero_s32v, satdv );
192
    VEC_ADD_ABS( temp1v, satdv,     satdv );
193
    VEC_ADD_ABS( temp2v, satdv,     satdv );
194
    VEC_ADD_ABS( temp3v, satdv,     satdv );
195

196
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff0v, offset1v );
197
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff1v, offset2v );
198
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff2v, offset1v );
199
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 4, diff3v, offset2v );
200
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
201
                 temp0v, temp1v, temp2v, temp3v );
202
    VEC_TRANSPOSE_4( temp0v, temp1v, temp2v, temp3v,
203
                     diff0v, diff1v, diff2v, diff3v );
204
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
205
                 temp0v, temp1v, temp2v, temp3v );
206
    VEC_ADD_ABS( temp0v, satdv,     satdv );
207
    VEC_ADD_ABS( temp1v, satdv,     satdv );
208
    VEC_ADD_ABS( temp2v, satdv,     satdv );
209
    VEC_ADD_ABS( temp3v, satdv,     satdv );
210

211
    satdv = vec_sum2s( satdv, zero_s32v );
212
    satdv = vec_splat( satdv, 1 );
213
    vec_ste( satdv, 0, &i_satd );
214

215
    return i_satd >> 1;
216
}
217

218
/***********************************************************************
219
 * SATD 8x4
220
 **********************************************************************/
221
static int pixel_satd_8x4_altivec( uint8_t *pix1, intptr_t i_pix1,
222
                                   uint8_t *pix2, intptr_t i_pix2 )
223
{
224
    ALIGNED_16( int i_satd );
225

226
    PREP_DIFF;
227
    vec_s16_t diff0v, diff1v, diff2v, diff3v,
228
              diff4v, diff5v, diff6v, diff7v;
229
    vec_s16_t temp0v, temp1v, temp2v, temp3v,
230
              temp4v, temp5v, temp6v, temp7v;
231
    vec_s32_t satdv;
232

233

234
    PREP_LOAD_SRC( pix1 );
235
    vec_u8_t _offset1v_ = vec_lvsl(0, pix2);
236
    vec_u8_t _offset2v_ = vec_lvsl(0, pix2 + i_pix2);
237

238
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff0v, offset1v );
239
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff1v, offset2v );
240
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff2v, offset1v );
241
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff3v, offset2v );
242

243
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
244
                 temp0v, temp1v, temp2v, temp3v );
245
    /* This causes warnings because temp4v...temp7v haven't be set,
246
       but we don't care */
247
    VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v,
248
                     temp4v, temp5v, temp6v, temp7v,
249
                     diff0v, diff1v, diff2v, diff3v,
250
                     diff4v, diff5v, diff6v, diff7v );
251
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
252
                 temp0v, temp1v, temp2v, temp3v );
253
    VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v,
254
                 temp4v, temp5v, temp6v, temp7v );
255

256
    VEC_ADD_ABS( temp0v, zero_s32v, satdv );
257
    VEC_ADD_ABS( temp1v, satdv,     satdv );
258
    VEC_ADD_ABS( temp2v, satdv,     satdv );
259
    VEC_ADD_ABS( temp3v, satdv,     satdv );
260
    VEC_ADD_ABS( temp4v, satdv,     satdv );
261
    VEC_ADD_ABS( temp5v, satdv,     satdv );
262
    VEC_ADD_ABS( temp6v, satdv,     satdv );
263
    VEC_ADD_ABS( temp7v, satdv,     satdv );
264

265
    satdv = vec_sum2s( satdv, zero_s32v );
266
    satdv = vec_splat( satdv, 1 );
267
    vec_ste( satdv, 0, &i_satd );
268

269
    return i_satd >> 1;
270
}
271

272
/***********************************************************************
273
 * SATD 8x8
274
 **********************************************************************/
275
static int pixel_satd_8x8_altivec( uint8_t *pix1, intptr_t i_pix1,
276
                                   uint8_t *pix2, intptr_t i_pix2 )
277
{
278
    ALIGNED_16( int i_satd );
279

280
    PREP_DIFF;
281
    vec_s16_t diff0v, diff1v, diff2v, diff3v,
282
              diff4v, diff5v, diff6v, diff7v;
283
    vec_s16_t temp0v, temp1v, temp2v, temp3v,
284
              temp4v, temp5v, temp6v, temp7v;
285
    vec_s32_t satdv;
286

287
    vec_u8_t _offset1_1v_ = vec_lvsl(0, pix1);
288
    vec_u8_t _offset1_2v_ = vec_lvsl(0, pix1 + i_pix1);
289
    vec_u8_t _offset2_1v_ = vec_lvsl(0, pix2);
290
    vec_u8_t _offset2_2v_ = vec_lvsl(0, pix2 + i_pix2);
291

292
    VEC_DIFF_H_OFFSET( pix1, i_pix1, pix2, i_pix2, 8, diff0v, offset1_1v, offset2_1v );
293
    VEC_DIFF_H_OFFSET( pix1, i_pix1, pix2, i_pix2, 8, diff1v, offset1_2v, offset2_2v );
294
    VEC_DIFF_H_OFFSET( pix1, i_pix1, pix2, i_pix2, 8, diff2v, offset1_1v, offset2_1v );
295
    VEC_DIFF_H_OFFSET( pix1, i_pix1, pix2, i_pix2, 8, diff3v, offset1_2v, offset2_2v );
296
    VEC_DIFF_H_OFFSET( pix1, i_pix1, pix2, i_pix2, 8, diff4v, offset1_1v, offset2_1v );
297
    VEC_DIFF_H_OFFSET( pix1, i_pix1, pix2, i_pix2, 8, diff5v, offset1_2v, offset2_2v );
298
    VEC_DIFF_H_OFFSET( pix1, i_pix1, pix2, i_pix2, 8, diff6v, offset1_1v, offset2_1v );
299
    VEC_DIFF_H_OFFSET( pix1, i_pix1, pix2, i_pix2, 8, diff7v, offset1_2v, offset2_2v );
300

301
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
302
                 temp0v, temp1v, temp2v, temp3v );
303
    VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v,
304
                 temp4v, temp5v, temp6v, temp7v );
305

306
    VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v,
307
                     temp4v, temp5v, temp6v, temp7v,
308
                     diff0v, diff1v, diff2v, diff3v,
309
                     diff4v, diff5v, diff6v, diff7v );
310

311
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
312
                 temp0v, temp1v, temp2v, temp3v );
313
    VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v,
314
                 temp4v, temp5v, temp6v, temp7v );
315

316
    VEC_ADD_ABS( temp0v, zero_s32v, satdv );
317
    VEC_ADD_ABS( temp1v, satdv,     satdv );
318
    VEC_ADD_ABS( temp2v, satdv,     satdv );
319
    VEC_ADD_ABS( temp3v, satdv,     satdv );
320
    VEC_ADD_ABS( temp4v, satdv,     satdv );
321
    VEC_ADD_ABS( temp5v, satdv,     satdv );
322
    VEC_ADD_ABS( temp6v, satdv,     satdv );
323
    VEC_ADD_ABS( temp7v, satdv,     satdv );
324

325
    satdv = vec_sums( satdv, zero_s32v );
326
    satdv = vec_splat( satdv, 3 );
327
    vec_ste( satdv, 0, &i_satd );
328

329
    return i_satd >> 1;
330
}
331

332
/***********************************************************************
333
 * SATD 8x16
334
 **********************************************************************/
335
static int pixel_satd_8x16_altivec( uint8_t *pix1, intptr_t i_pix1,
336
                                    uint8_t *pix2, intptr_t i_pix2 )
337
{
338
    ALIGNED_16( int i_satd );
339

340
    PREP_DIFF;
341
    vec_s16_t diff0v, diff1v, diff2v, diff3v,
342
              diff4v, diff5v, diff6v, diff7v;
343
    vec_s16_t temp0v, temp1v, temp2v, temp3v,
344
              temp4v, temp5v, temp6v, temp7v;
345
    vec_s32_t satdv;
346

347
    PREP_LOAD_SRC( pix1 );
348
    vec_u8_t _offset1v_ = vec_lvsl(0, pix2);
349
    vec_u8_t _offset2v_ = vec_lvsl(0, pix2 + i_pix2);
350

351
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff0v, offset1v );
352
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff1v, offset2v );
353
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff2v, offset1v );
354
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff3v, offset2v );
355
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff4v, offset1v );
356
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff5v, offset2v );
357
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff6v , offset1v);
358
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff7v, offset2v );
359
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
360
                 temp0v, temp1v, temp2v, temp3v );
361
    VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v,
362
                 temp4v, temp5v, temp6v, temp7v );
363
    VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v,
364
                     temp4v, temp5v, temp6v, temp7v,
365
                     diff0v, diff1v, diff2v, diff3v,
366
                     diff4v, diff5v, diff6v, diff7v );
367
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
368
                 temp0v, temp1v, temp2v, temp3v );
369
    VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v,
370
                 temp4v, temp5v, temp6v, temp7v );
371
    VEC_ADD_ABS( temp0v, zero_s32v, satdv );
372
    VEC_ADD_ABS( temp1v, satdv,     satdv );
373
    VEC_ADD_ABS( temp2v, satdv,     satdv );
374
    VEC_ADD_ABS( temp3v, satdv,     satdv );
375
    VEC_ADD_ABS( temp4v, satdv,     satdv );
376
    VEC_ADD_ABS( temp5v, satdv,     satdv );
377
    VEC_ADD_ABS( temp6v, satdv,     satdv );
378
    VEC_ADD_ABS( temp7v, satdv,     satdv );
379

380
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff0v, offset1v );
381
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff1v, offset2v );
382
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff2v, offset1v );
383
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff3v, offset2v );
384
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff4v, offset1v );
385
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff5v, offset2v );
386
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff6v, offset1v );
387
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff7v, offset2v );
388
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
389
                 temp0v, temp1v, temp2v, temp3v );
390
    VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v,
391
                 temp4v, temp5v, temp6v, temp7v );
392
    VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v,
393
                     temp4v, temp5v, temp6v, temp7v,
394
                     diff0v, diff1v, diff2v, diff3v,
395
                     diff4v, diff5v, diff6v, diff7v );
396
    VEC_HADAMAR( diff0v, diff1v, diff2v, diff3v,
397
                 temp0v, temp1v, temp2v, temp3v );
398
    VEC_HADAMAR( diff4v, diff5v, diff6v, diff7v,
399
                 temp4v, temp5v, temp6v, temp7v );
400
    VEC_ADD_ABS( temp0v, satdv,     satdv );
401
    VEC_ADD_ABS( temp1v, satdv,     satdv );
402
    VEC_ADD_ABS( temp2v, satdv,     satdv );
403
    VEC_ADD_ABS( temp3v, satdv,     satdv );
404
    VEC_ADD_ABS( temp4v, satdv,     satdv );
405
    VEC_ADD_ABS( temp5v, satdv,     satdv );
406
    VEC_ADD_ABS( temp6v, satdv,     satdv );
407
    VEC_ADD_ABS( temp7v, satdv,     satdv );
408

409
    satdv = vec_sums( satdv, zero_s32v );
410
    satdv = vec_splat( satdv, 3 );
411
    vec_ste( satdv, 0, &i_satd );
412

413
    return i_satd >> 1;
414
}
415

416
/***********************************************************************
417
 * SATD 16x8
418
 **********************************************************************/
419
static int pixel_satd_16x8_altivec( uint8_t *pix1, intptr_t i_pix1,
420
                                    uint8_t *pix2, intptr_t i_pix2 )
421
{
422
    ALIGNED_16( int i_satd );
423

424
    LOAD_ZERO;
425
    PREP_LOAD;
426
    PREP_LOAD_SRC( pix2 );
427
    vec_s32_t satdv;
428
    vec_s16_t pix1v, pix2v;
429
    vec_s16_t diffh0v, diffh1v, diffh2v, diffh3v,
430
              diffh4v, diffh5v, diffh6v, diffh7v;
431
    vec_s16_t diffl0v, diffl1v, diffl2v, diffl3v,
432
              diffl4v, diffl5v, diffl6v, diffl7v;
433
    vec_s16_t temp0v, temp1v, temp2v, temp3v,
434
              temp4v, temp5v, temp6v, temp7v;
435

436
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh0v, diffl0v );
437
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh1v, diffl1v );
438
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh2v, diffl2v );
439
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh3v, diffl3v );
440
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh4v, diffl4v );
441
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh5v, diffl5v );
442
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh6v, diffl6v );
443
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh7v, diffl7v );
444

445
    VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v,
446
                 temp0v, temp1v, temp2v, temp3v );
447
    VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v,
448
                 temp4v, temp5v, temp6v, temp7v );
449

450
    VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v,
451
                     temp4v, temp5v, temp6v, temp7v,
452
                     diffh0v, diffh1v, diffh2v, diffh3v,
453
                     diffh4v, diffh5v, diffh6v, diffh7v );
454

455
    VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v,
456
                 temp0v, temp1v, temp2v, temp3v );
457
    VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v,
458
                 temp4v, temp5v, temp6v, temp7v );
459

460
    VEC_ADD_ABS( temp0v, zero_s32v, satdv );
461
    VEC_ADD_ABS( temp1v, satdv,     satdv );
462
    VEC_ADD_ABS( temp2v, satdv,     satdv );
463
    VEC_ADD_ABS( temp3v, satdv,     satdv );
464
    VEC_ADD_ABS( temp4v, satdv,     satdv );
465
    VEC_ADD_ABS( temp5v, satdv,     satdv );
466
    VEC_ADD_ABS( temp6v, satdv,     satdv );
467
    VEC_ADD_ABS( temp7v, satdv,     satdv );
468

469
    VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v,
470
                 temp0v, temp1v, temp2v, temp3v );
471
    VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v,
472
                 temp4v, temp5v, temp6v, temp7v );
473

474
    VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v,
475
                     temp4v, temp5v, temp6v, temp7v,
476
                     diffl0v, diffl1v, diffl2v, diffl3v,
477
                     diffl4v, diffl5v, diffl6v, diffl7v );
478

479
    VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v,
480
                 temp0v, temp1v, temp2v, temp3v );
481
    VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v,
482
                 temp4v, temp5v, temp6v, temp7v );
483

484
    VEC_ADD_ABS( temp0v, satdv,     satdv );
485
    VEC_ADD_ABS( temp1v, satdv,     satdv );
486
    VEC_ADD_ABS( temp2v, satdv,     satdv );
487
    VEC_ADD_ABS( temp3v, satdv,     satdv );
488
    VEC_ADD_ABS( temp4v, satdv,     satdv );
489
    VEC_ADD_ABS( temp5v, satdv,     satdv );
490
    VEC_ADD_ABS( temp6v, satdv,     satdv );
491
    VEC_ADD_ABS( temp7v, satdv,     satdv );
492

493
    satdv = vec_sums( satdv, zero_s32v );
494
    satdv = vec_splat( satdv, 3 );
495
    vec_ste( satdv, 0, &i_satd );
496

497
    return i_satd >> 1;
498
}
499

500
/***********************************************************************
501
 * SATD 16x16
502
 **********************************************************************/
503
static int pixel_satd_16x16_altivec( uint8_t *pix1, intptr_t i_pix1,
504
                                     uint8_t *pix2, intptr_t i_pix2 )
505
{
506
    ALIGNED_16( int i_satd );
507

508
    LOAD_ZERO;
509
    PREP_LOAD;
510
    vec_s32_t satdv;
511
    vec_s16_t pix1v, pix2v;
512
    vec_s16_t diffh0v, diffh1v, diffh2v, diffh3v,
513
              diffh4v, diffh5v, diffh6v, diffh7v;
514
    vec_s16_t diffl0v, diffl1v, diffl2v, diffl3v,
515
              diffl4v, diffl5v, diffl6v, diffl7v;
516
    vec_s16_t temp0v, temp1v, temp2v, temp3v,
517
              temp4v, temp5v, temp6v, temp7v;
518
    PREP_LOAD_SRC( pix2 );
519

520

521
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh0v, diffl0v );
522
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh1v, diffl1v );
523
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh2v, diffl2v );
524
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh3v, diffl3v );
525
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh4v, diffl4v );
526
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh5v, diffl5v );
527
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh6v, diffl6v );
528
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh7v, diffl7v );
529
    VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v,
530
                 temp0v, temp1v, temp2v, temp3v );
531
    VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v,
532
                 temp4v, temp5v, temp6v, temp7v );
533
    VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v,
534
                     temp4v, temp5v, temp6v, temp7v,
535
                     diffh0v, diffh1v, diffh2v, diffh3v,
536
                     diffh4v, diffh5v, diffh6v, diffh7v );
537
    VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v,
538
                 temp0v, temp1v, temp2v, temp3v );
539
    VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v,
540
                 temp4v, temp5v, temp6v, temp7v );
541
    VEC_ADD_ABS( temp0v, zero_s32v, satdv );
542
    VEC_ADD_ABS( temp1v, satdv,     satdv );
543
    VEC_ADD_ABS( temp2v, satdv,     satdv );
544
    VEC_ADD_ABS( temp3v, satdv,     satdv );
545
    VEC_ADD_ABS( temp4v, satdv,     satdv );
546
    VEC_ADD_ABS( temp5v, satdv,     satdv );
547
    VEC_ADD_ABS( temp6v, satdv,     satdv );
548
    VEC_ADD_ABS( temp7v, satdv,     satdv );
549
    VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v,
550
                 temp0v, temp1v, temp2v, temp3v );
551
    VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v,
552
                 temp4v, temp5v, temp6v, temp7v );
553
    VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v,
554
                     temp4v, temp5v, temp6v, temp7v,
555
                     diffl0v, diffl1v, diffl2v, diffl3v,
556
                     diffl4v, diffl5v, diffl6v, diffl7v );
557
    VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v,
558
                 temp0v, temp1v, temp2v, temp3v );
559
    VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v,
560
                 temp4v, temp5v, temp6v, temp7v );
561
    VEC_ADD_ABS( temp0v, satdv,     satdv );
562
    VEC_ADD_ABS( temp1v, satdv,     satdv );
563
    VEC_ADD_ABS( temp2v, satdv,     satdv );
564
    VEC_ADD_ABS( temp3v, satdv,     satdv );
565
    VEC_ADD_ABS( temp4v, satdv,     satdv );
566
    VEC_ADD_ABS( temp5v, satdv,     satdv );
567
    VEC_ADD_ABS( temp6v, satdv,     satdv );
568
    VEC_ADD_ABS( temp7v, satdv,     satdv );
569

570
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh0v, diffl0v );
571
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh1v, diffl1v );
572
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh2v, diffl2v );
573
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh3v, diffl3v );
574
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh4v, diffl4v );
575
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh5v, diffl5v );
576
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh6v, diffl6v );
577
    VEC_DIFF_HL( pix1, i_pix1, pix2, i_pix2, diffh7v, diffl7v );
578
    VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v,
579
                 temp0v, temp1v, temp2v, temp3v );
580
    VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v,
581
                 temp4v, temp5v, temp6v, temp7v );
582
    VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v,
583
                     temp4v, temp5v, temp6v, temp7v,
584
                     diffh0v, diffh1v, diffh2v, diffh3v,
585
                     diffh4v, diffh5v, diffh6v, diffh7v );
586
    VEC_HADAMAR( diffh0v, diffh1v, diffh2v, diffh3v,
587
                 temp0v, temp1v, temp2v, temp3v );
588
    VEC_HADAMAR( diffh4v, diffh5v, diffh6v, diffh7v,
589
                 temp4v, temp5v, temp6v, temp7v );
590
    VEC_ADD_ABS( temp0v, satdv,     satdv );
591
    VEC_ADD_ABS( temp1v, satdv,     satdv );
592
    VEC_ADD_ABS( temp2v, satdv,     satdv );
593
    VEC_ADD_ABS( temp3v, satdv,     satdv );
594
    VEC_ADD_ABS( temp4v, satdv,     satdv );
595
    VEC_ADD_ABS( temp5v, satdv,     satdv );
596
    VEC_ADD_ABS( temp6v, satdv,     satdv );
597
    VEC_ADD_ABS( temp7v, satdv,     satdv );
598
    VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v,
599
                 temp0v, temp1v, temp2v, temp3v );
600
    VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v,
601
                 temp4v, temp5v, temp6v, temp7v );
602
    VEC_TRANSPOSE_8( temp0v, temp1v, temp2v, temp3v,
603
                     temp4v, temp5v, temp6v, temp7v,
604
                     diffl0v, diffl1v, diffl2v, diffl3v,
605
                     diffl4v, diffl5v, diffl6v, diffl7v );
606
    VEC_HADAMAR( diffl0v, diffl1v, diffl2v, diffl3v,
607
                 temp0v, temp1v, temp2v, temp3v );
608
    VEC_HADAMAR( diffl4v, diffl5v, diffl6v, diffl7v,
609
                 temp4v, temp5v, temp6v, temp7v );
610
    VEC_ADD_ABS( temp0v, satdv,     satdv );
611
    VEC_ADD_ABS( temp1v, satdv,     satdv );
612
    VEC_ADD_ABS( temp2v, satdv,     satdv );
613
    VEC_ADD_ABS( temp3v, satdv,     satdv );
614
    VEC_ADD_ABS( temp4v, satdv,     satdv );
615
    VEC_ADD_ABS( temp5v, satdv,     satdv );
616
    VEC_ADD_ABS( temp6v, satdv,     satdv );
617
    VEC_ADD_ABS( temp7v, satdv,     satdv );
618

619
    satdv = vec_sums( satdv, zero_s32v );
620
    satdv = vec_splat( satdv, 3 );
621
    vec_ste( satdv, 0, &i_satd );
622

623
    return i_satd >> 1;
624
}
625

626

627

628
/***********************************************************************
629
* Interleaved SAD routines
630
**********************************************************************/
631

632
static void pixel_sad_x4_16x16_altivec( uint8_t *fenc,
633
                                        uint8_t *pix0, uint8_t *pix1,
634
                                        uint8_t *pix2, uint8_t *pix3,
635
                                        intptr_t i_stride, int scores[4] )
636
{
637
    ALIGNED_16( int sum0 );
638
    ALIGNED_16( int sum1 );
639
    ALIGNED_16( int sum2 );
640
    ALIGNED_16( int sum3 );
641

642
    LOAD_ZERO;
643
    vec_u8_t temp_lv, temp_hv;
644
    vec_u8_t fencv, pix0v, pix1v, pix2v, pix3v;
645
    //vec_u8_t perm0v, perm1v, perm2v, perm3v;
646
    vec_u8_t perm0vA, perm1vA, perm2vA, perm3vA, perm0vB, perm1vB, perm2vB, perm3vB;
647

648
    vec_s32_t sum0v, sum1v, sum2v, sum3v;
649

650
    sum0v = vec_splat_s32(0);
651
    sum1v = vec_splat_s32(0);
652
    sum2v = vec_splat_s32(0);
653
    sum3v = vec_splat_s32(0);
654

655
    perm0vA = vec_lvsl(0, pix0);
656
    perm1vA = vec_lvsl(0, pix1);
657
    perm2vA = vec_lvsl(0, pix2);
658
    perm3vA = vec_lvsl(0, pix3);
659

660
    perm0vB = vec_lvsl(0, pix0 + i_stride);
661
    perm1vB = vec_lvsl(0, pix1 + i_stride);
662
    perm2vB = vec_lvsl(0, pix2 + i_stride);
663
    perm3vB = vec_lvsl(0, pix3 + i_stride);
664

665
    for( int y = 0; y < 8; y++ )
666
    {
667
        temp_lv = vec_ld(0, pix0);
668
        temp_hv = vec_ld(16, pix0);
669
        pix0v = vec_perm(temp_lv, temp_hv, perm0vA);
670
        pix0 += i_stride;
671

672
        temp_lv = vec_ld(0, pix1);
673
        temp_hv = vec_ld(16, pix1);
674
        pix1v = vec_perm(temp_lv, temp_hv, perm1vA);
675
        pix1 += i_stride;
676

677
        fencv = vec_ld(0, fenc);
678
        fenc += FENC_STRIDE;
679

680
        temp_lv = vec_ld(0, pix2);
681
        temp_hv = vec_ld(16, pix2);
682
        pix2v = vec_perm(temp_lv, temp_hv, perm2vA);
683
        pix2 += i_stride;
684

685
        temp_lv = vec_ld(0, pix3);
686
        temp_hv = vec_ld(16, pix3);
687
        pix3v = vec_perm(temp_lv, temp_hv, perm3vA);
688
        pix3 += i_stride;
689

690
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
691
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
692
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
693
        sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v );
694

695
        temp_lv = vec_ld(0, pix0);
696
        temp_hv = vec_ld(16, pix0);
697
        pix0v = vec_perm(temp_lv, temp_hv, perm0vB);
698
        pix0 += i_stride;
699

700
        temp_lv = vec_ld(0, pix1);
701
        temp_hv = vec_ld(16, pix1);
702
        pix1v = vec_perm(temp_lv, temp_hv, perm1vB);
703
        pix1 += i_stride;
704

705
        fencv = vec_ld(0, fenc);
706
        fenc += FENC_STRIDE;
707

708
        temp_lv = vec_ld(0, pix2);
709
        temp_hv = vec_ld(16, pix2);
710
        pix2v = vec_perm(temp_lv, temp_hv, perm2vB);
711
        pix2 += i_stride;
712

713
        temp_lv = vec_ld(0, pix3);
714
        temp_hv = vec_ld(16, pix3);
715
        pix3v = vec_perm(temp_lv, temp_hv, perm3vB);
716
        pix3 += i_stride;
717

718
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
719
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
720
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
721
        sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v );
722
    }
723

724
    sum0v = vec_sums( sum0v, zero_s32v );
725
    sum1v = vec_sums( sum1v, zero_s32v );
726
    sum2v = vec_sums( sum2v, zero_s32v );
727
    sum3v = vec_sums( sum3v, zero_s32v );
728

729
    sum0v = vec_splat( sum0v, 3 );
730
    sum1v = vec_splat( sum1v, 3 );
731
    sum2v = vec_splat( sum2v, 3 );
732
    sum3v = vec_splat( sum3v, 3 );
733

734
    vec_ste( sum0v, 0, &sum0);
735
    vec_ste( sum1v, 0, &sum1);
736
    vec_ste( sum2v, 0, &sum2);
737
    vec_ste( sum3v, 0, &sum3);
738

739
    scores[0] = sum0;
740
    scores[1] = sum1;
741
    scores[2] = sum2;
742
    scores[3] = sum3;
743
}
744

745
static void pixel_sad_x3_16x16_altivec( uint8_t *fenc, uint8_t *pix0,
746
                                        uint8_t *pix1, uint8_t *pix2,
747
                                        intptr_t i_stride, int scores[3] )
748
{
749
    ALIGNED_16( int sum0 );
750
    ALIGNED_16( int sum1 );
751
    ALIGNED_16( int sum2 );
752

753
    LOAD_ZERO;
754
    vec_u8_t temp_lv, temp_hv; // temporary load vectors
755
    vec_u8_t fencv, pix0v, pix1v, pix2v;
756
    vec_u8_t perm0vA, perm1vA, perm2vA, perm0vB, perm1vB, perm2vB;
757

758
    vec_s32_t sum0v, sum1v, sum2v;
759

760
    sum0v = vec_splat_s32(0);
761
    sum1v = vec_splat_s32(0);
762
    sum2v = vec_splat_s32(0);
763

764
    perm0vA = vec_lvsl(0, pix0);
765
    perm1vA = vec_lvsl(0, pix1);
766
    perm2vA = vec_lvsl(0, pix2);
767

768
    perm0vB = vec_lvsl(0, pix0 + i_stride);
769
    perm1vB = vec_lvsl(0, pix1 + i_stride);
770
    perm2vB = vec_lvsl(0, pix2 + i_stride);
771

772
    for( int y = 0; y < 8; y++ )
773
    {
774
        temp_lv = vec_ld(0, pix0);
775
        temp_hv = vec_ld(16, pix0);
776
        pix0v = vec_perm(temp_lv, temp_hv, perm0vA);
777
        pix0 += i_stride;
778

779
        temp_lv = vec_ld(0, pix1);
780
        temp_hv = vec_ld(16, pix1);
781
        pix1v = vec_perm(temp_lv, temp_hv, perm1vA);
782
        pix1 += i_stride;
783

784
        fencv = vec_ld(0, fenc);
785
        fenc += FENC_STRIDE;
786

787
        temp_lv = vec_ld(0, pix2);
788
        temp_hv = vec_ld(16, pix2);
789
        pix2v = vec_perm(temp_lv, temp_hv, perm2vA);
790
        pix2 += i_stride;
791

792
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
793
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
794
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
795

796
        temp_lv = vec_ld(0, pix0);
797
        temp_hv = vec_ld(16, pix0);
798
        pix0v = vec_perm(temp_lv, temp_hv, perm0vB);
799
        pix0 += i_stride;
800

801

802
        temp_lv = vec_ld(0, pix1);
803
        temp_hv = vec_ld(16, pix1);
804
        pix1v = vec_perm(temp_lv, temp_hv, perm1vB);
805
        pix1 += i_stride;
806

807
        fencv = vec_ld(0, fenc);
808
        fenc += FENC_STRIDE;
809

810
        temp_lv = vec_ld(0, pix2);
811
        temp_hv = vec_ld(16, pix2);
812
        pix2v = vec_perm(temp_lv, temp_hv, perm2vB);
813
        pix2 += i_stride;
814

815
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
816
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
817
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
818
    }
819

820
    sum0v = vec_sums( sum0v, zero_s32v );
821
    sum1v = vec_sums( sum1v, zero_s32v );
822
    sum2v = vec_sums( sum2v, zero_s32v );
823

824
    sum0v = vec_splat( sum0v, 3 );
825
    sum1v = vec_splat( sum1v, 3 );
826
    sum2v = vec_splat( sum2v, 3 );
827

828
    vec_ste( sum0v, 0, &sum0);
829
    vec_ste( sum1v, 0, &sum1);
830
    vec_ste( sum2v, 0, &sum2);
831

832
    scores[0] = sum0;
833
    scores[1] = sum1;
834
    scores[2] = sum2;
835
}
836

837
static void pixel_sad_x4_16x8_altivec( uint8_t *fenc, uint8_t *pix0, uint8_t *pix1, uint8_t *pix2,
838
                                       uint8_t *pix3, intptr_t i_stride, int scores[4] )
839
{
840
    ALIGNED_16( int sum0 );
841
    ALIGNED_16( int sum1 );
842
    ALIGNED_16( int sum2 );
843
    ALIGNED_16( int sum3 );
844

845
    LOAD_ZERO;
846
    vec_u8_t temp_lv, temp_hv;
847
    vec_u8_t fencv, pix0v, pix1v, pix2v, pix3v;
848
    vec_u8_t perm0vA, perm1vA, perm2vA, perm3vA, perm0vB, perm1vB, perm2vB, perm3vB;
849

850
    vec_s32_t sum0v, sum1v, sum2v, sum3v;
851

852
    sum0v = vec_splat_s32(0);
853
    sum1v = vec_splat_s32(0);
854
    sum2v = vec_splat_s32(0);
855
    sum3v = vec_splat_s32(0);
856

857
    perm0vA = vec_lvsl(0, pix0);
858
    perm1vA = vec_lvsl(0, pix1);
859
    perm2vA = vec_lvsl(0, pix2);
860
    perm3vA = vec_lvsl(0, pix3);
861

862
    perm0vB = vec_lvsl(0, pix0 + i_stride);
863
    perm1vB = vec_lvsl(0, pix1 + i_stride);
864
    perm2vB = vec_lvsl(0, pix2 + i_stride);
865
    perm3vB = vec_lvsl(0, pix3 + i_stride);
866

867
    for( int y = 0; y < 4; y++ )
868
    {
869
        temp_lv = vec_ld(0, pix0);
870
        temp_hv = vec_ld(16, pix0);
871
        pix0v = vec_perm(temp_lv, temp_hv, perm0vA);
872
        pix0 += i_stride;
873

874
        temp_lv = vec_ld(0, pix1);
875
        temp_hv = vec_ld(16, pix1);
876
        pix1v = vec_perm(temp_lv, temp_hv, perm1vA);
877
        pix1 += i_stride;
878

879
        fencv = vec_ld(0, fenc);
880
        fenc += FENC_STRIDE;
881

882
        temp_lv = vec_ld(0, pix2);
883
        temp_hv = vec_ld(16, pix2);
884
        pix2v = vec_perm(temp_lv, temp_hv, perm2vA);
885
        pix2 += i_stride;
886

887
        temp_lv = vec_ld(0, pix3);
888
        temp_hv = vec_ld(16, pix3);
889
        pix3v = vec_perm(temp_lv, temp_hv, perm3vA);
890
        pix3 += i_stride;
891

892
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
893
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
894
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
895
        sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v );
896

897
        temp_lv = vec_ld(0, pix0);
898
        temp_hv = vec_ld(16, pix0);
899
        pix0v = vec_perm(temp_lv, temp_hv, perm0vB);
900
        pix0 += i_stride;
901

902
        temp_lv = vec_ld(0, pix1);
903
        temp_hv = vec_ld(16, pix1);
904
        pix1v = vec_perm(temp_lv, temp_hv, perm1vB);
905
        pix1 += i_stride;
906

907
        fencv = vec_ld(0, fenc);
908
        fenc += FENC_STRIDE;
909

910
        temp_lv = vec_ld(0, pix2);
911
        temp_hv = vec_ld(16, pix2);
912
        pix2v = vec_perm(temp_lv, temp_hv, perm2vB);
913
        pix2 += i_stride;
914

915
        temp_lv = vec_ld(0, pix3);
916
        temp_hv = vec_ld(16, pix3);
917
        pix3v = vec_perm(temp_lv, temp_hv, perm3vB);
918
        pix3 += i_stride;
919

920
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
921
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
922
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
923
        sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v );
924
    }
925

926
    sum0v = vec_sums( sum0v, zero_s32v );
927
    sum1v = vec_sums( sum1v, zero_s32v );
928
    sum2v = vec_sums( sum2v, zero_s32v );
929
    sum3v = vec_sums( sum3v, zero_s32v );
930

931
    sum0v = vec_splat( sum0v, 3 );
932
    sum1v = vec_splat( sum1v, 3 );
933
    sum2v = vec_splat( sum2v, 3 );
934
    sum3v = vec_splat( sum3v, 3 );
935

936
    vec_ste( sum0v, 0, &sum0);
937
    vec_ste( sum1v, 0, &sum1);
938
    vec_ste( sum2v, 0, &sum2);
939
    vec_ste( sum3v, 0, &sum3);
940

941
    scores[0] = sum0;
942
    scores[1] = sum1;
943
    scores[2] = sum2;
944
    scores[3] = sum3;
945
}
946

947
static void pixel_sad_x3_16x8_altivec( uint8_t *fenc, uint8_t *pix0,
948
                                       uint8_t *pix1, uint8_t *pix2,
949
                                       intptr_t i_stride, int scores[3] )
950
{
951
    ALIGNED_16( int sum0 );
952
    ALIGNED_16( int sum1 );
953
    ALIGNED_16( int sum2 );
954

955
    LOAD_ZERO;
956
    vec_u8_t temp_lv, temp_hv;
957
    vec_u8_t fencv, pix0v, pix1v, pix2v;
958
    vec_u8_t perm0vA, perm1vA, perm2vA, perm0vB, perm1vB, perm2vB;
959

960
    vec_s32_t sum0v, sum1v, sum2v;
961

962
    sum0v = vec_splat_s32(0);
963
    sum1v = vec_splat_s32(0);
964
    sum2v = vec_splat_s32(0);
965

966
    perm0vA = vec_lvsl(0, pix0);
967
    perm1vA = vec_lvsl(0, pix1);
968
    perm2vA = vec_lvsl(0, pix2);
969

970
    perm0vB = vec_lvsl(0, pix0 + i_stride);
971
    perm1vB = vec_lvsl(0, pix1 + i_stride);
972
    perm2vB = vec_lvsl(0, pix2 + i_stride);
973

974
    for( int y = 0; y < 4; y++ )
975
    {
976
        temp_lv = vec_ld(0, pix0);
977
        temp_hv = vec_ld(16, pix0);
978
        pix0v = vec_perm(temp_lv, temp_hv, perm0vA);
979
        pix0 += i_stride;
980

981
        temp_lv = vec_ld(0, pix1);
982
        temp_hv = vec_ld(16, pix1);
983
        pix1v = vec_perm(temp_lv, temp_hv, perm1vA);
984
        pix1 += i_stride;
985

986
        fencv = vec_ld(0, fenc);
987
        fenc += FENC_STRIDE;
988

989
        temp_lv = vec_ld(0, pix2);
990
        temp_hv = vec_ld(16, pix2);
991
        pix2v = vec_perm(temp_lv, temp_hv, perm2vA);
992
        pix2 += i_stride;
993

994
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
995
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
996
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
997

998
        temp_lv = vec_ld(0, pix0);
999
        temp_hv = vec_ld(16, pix0);
1000
        pix0v = vec_perm(temp_lv, temp_hv, perm0vB);
1001
        pix0 += i_stride;
1002

1003
        temp_lv = vec_ld(0, pix1);
1004
        temp_hv = vec_ld(16, pix1);
1005
        pix1v = vec_perm(temp_lv, temp_hv, perm1vB);
1006
        pix1 += i_stride;
1007

1008
        fencv = vec_ld(0, fenc);
1009
        fenc += FENC_STRIDE;
1010

1011
        temp_lv = vec_ld(0, pix2);
1012
        temp_hv = vec_ld(16, pix2);
1013
        pix2v = vec_perm(temp_lv, temp_hv, perm2vB);
1014
        pix2 += i_stride;
1015

1016
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
1017
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
1018
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
1019
    }
1020

1021
    sum0v = vec_sums( sum0v, zero_s32v );
1022
    sum1v = vec_sums( sum1v, zero_s32v );
1023
    sum2v = vec_sums( sum2v, zero_s32v );
1024

1025
    sum0v = vec_splat( sum0v, 3 );
1026
    sum1v = vec_splat( sum1v, 3 );
1027
    sum2v = vec_splat( sum2v, 3 );
1028

1029
    vec_ste( sum0v, 0, &sum0);
1030
    vec_ste( sum1v, 0, &sum1);
1031
    vec_ste( sum2v, 0, &sum2);
1032

1033
    scores[0] = sum0;
1034
    scores[1] = sum1;
1035
    scores[2] = sum2;
1036
}
1037

1038

1039
static void pixel_sad_x4_8x16_altivec( uint8_t *fenc,
1040
                                       uint8_t *pix0, uint8_t *pix1,
1041
                                       uint8_t *pix2, uint8_t *pix3,
1042
                                       intptr_t i_stride, int scores[4] )
1043
{
1044
    ALIGNED_16( int sum0 );
1045
    ALIGNED_16( int sum1 );
1046
    ALIGNED_16( int sum2 );
1047
    ALIGNED_16( int sum3 );
1048

1049
    LOAD_ZERO;
1050
    vec_u8_t temp_lv, temp_hv;
1051
    vec_u8_t fencv, pix0v, pix1v, pix2v, pix3v;
1052
    vec_u8_t perm0vA, perm1vA, perm2vA, perm3vA, perm0vB, perm1vB, perm2vB, perm3vB, permEncv;
1053

1054
    vec_s32_t sum0v, sum1v, sum2v, sum3v;
1055

1056
    sum0v = vec_splat_s32(0);
1057
    sum1v = vec_splat_s32(0);
1058
    sum2v = vec_splat_s32(0);
1059
    sum3v = vec_splat_s32(0);
1060

1061
    permEncv = vec_lvsl(0, fenc);
1062
    perm0vA = vec_lvsl(0, pix0);
1063
    perm1vA = vec_lvsl(0, pix1);
1064
    perm2vA = vec_lvsl(0, pix2);
1065
    perm3vA = vec_lvsl(0, pix3);
1066

1067
    perm0vB = vec_lvsl(0, pix0 + i_stride);
1068
    perm1vB = vec_lvsl(0, pix1 + i_stride);
1069
    perm2vB = vec_lvsl(0, pix2 + i_stride);
1070
    perm3vB = vec_lvsl(0, pix3 + i_stride);
1071

1072
    for( int y = 0; y < 8; y++ )
1073
    {
1074
        temp_lv = vec_ld(0, pix0);
1075
        temp_hv = vec_ld(16, pix0);
1076
        pix0v = vec_perm(temp_lv, temp_hv, perm0vA);
1077
        pix0 += i_stride;
1078

1079
        temp_lv = vec_ld(0, pix1);
1080
        temp_hv = vec_ld(16, pix1);
1081
        pix1v = vec_perm(temp_lv, temp_hv, perm1vA);
1082
        pix1 += i_stride;
1083

1084
        temp_lv = vec_ld(0, fenc);
1085
        fencv = vec_perm(temp_lv, temp_hv, permEncv);
1086
        fenc += FENC_STRIDE;
1087

1088
        temp_lv = vec_ld(0, pix2);
1089
        temp_hv = vec_ld(16, pix2);
1090
        pix2v = vec_perm(temp_lv, temp_hv, perm2vA);
1091
        pix2 += i_stride;
1092

1093
        temp_lv = vec_ld(0, pix3);
1094
        temp_hv = vec_ld(16, pix3);
1095
        pix3v = vec_perm(temp_lv, temp_hv, perm3vA);
1096
        pix3 += i_stride;
1097

1098
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
1099
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
1100
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
1101
        sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v );
1102

1103
        temp_lv = vec_ld(0, pix0);
1104
        temp_hv = vec_ld(16, pix0);
1105
        pix0v = vec_perm(temp_lv, temp_hv, perm0vB);
1106
        pix0 += i_stride;
1107

1108
        temp_lv = vec_ld(0, pix1);
1109
        temp_hv = vec_ld(16, pix1);
1110
        pix1v = vec_perm(temp_lv, temp_hv, perm1vB);
1111
        pix1 += i_stride;
1112

1113
        temp_lv = vec_ld(0, fenc);
1114
        fencv = vec_perm(temp_lv, temp_hv, permEncv);
1115
        fenc += FENC_STRIDE;
1116

1117
        temp_lv = vec_ld(0, pix2);
1118
        temp_hv = vec_ld(16, pix2);
1119
        pix2v = vec_perm(temp_lv, temp_hv, perm2vB);
1120
        pix2 += i_stride;
1121

1122
        temp_lv = vec_ld(0, pix3);
1123
        temp_hv = vec_ld(16, pix3);
1124
        pix3v = vec_perm(temp_lv, temp_hv, perm3vB);
1125
        pix3 += i_stride;
1126

1127
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
1128
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
1129
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
1130
        sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v );
1131
    }
1132

1133
    sum0v = vec_sum2s( sum0v, zero_s32v );
1134
    sum1v = vec_sum2s( sum1v, zero_s32v );
1135
    sum2v = vec_sum2s( sum2v, zero_s32v );
1136
    sum3v = vec_sum2s( sum3v, zero_s32v );
1137

1138
    sum0v = vec_splat( sum0v, 1 );
1139
    sum1v = vec_splat( sum1v, 1 );
1140
    sum2v = vec_splat( sum2v, 1 );
1141
    sum3v = vec_splat( sum3v, 1 );
1142

1143
    vec_ste( sum0v, 0, &sum0);
1144
    vec_ste( sum1v, 0, &sum1);
1145
    vec_ste( sum2v, 0, &sum2);
1146
    vec_ste( sum3v, 0, &sum3);
1147

1148
    scores[0] = sum0;
1149
    scores[1] = sum1;
1150
    scores[2] = sum2;
1151
    scores[3] = sum3;
1152
}
1153

1154
static void pixel_sad_x3_8x16_altivec( uint8_t *fenc, uint8_t *pix0,
1155
                                       uint8_t *pix1, uint8_t *pix2,
1156
                                       intptr_t i_stride, int scores[3] )
1157
{
1158
    ALIGNED_16( int sum0 );
1159
    ALIGNED_16( int sum1 );
1160
    ALIGNED_16( int sum2 );
1161

1162
    LOAD_ZERO;
1163
    vec_u8_t temp_lv, temp_hv;
1164
    vec_u8_t fencv, pix0v, pix1v, pix2v;
1165
    vec_u8_t perm0vA, perm1vA, perm2vA, perm0vB, perm1vB, perm2vB,permEncv;
1166

1167
    vec_s32_t sum0v, sum1v, sum2v;
1168

1169
    sum0v = vec_splat_s32(0);
1170
    sum1v = vec_splat_s32(0);
1171
    sum2v = vec_splat_s32(0);
1172

1173
    permEncv = vec_lvsl(0, fenc);
1174
    perm0vA = vec_lvsl(0, pix0);
1175
    perm1vA = vec_lvsl(0, pix1);
1176
    perm2vA = vec_lvsl(0, pix2);
1177

1178
    perm0vB = vec_lvsl(0, pix0 + i_stride);
1179
    perm1vB = vec_lvsl(0, pix1 + i_stride);
1180
    perm2vB = vec_lvsl(0, pix2 + i_stride);
1181

1182
    for( int y = 0; y < 8; y++ )
1183
    {
1184
        temp_lv = vec_ld(0, pix0);
1185
        temp_hv = vec_ld(16, pix0);
1186
        pix0v = vec_perm(temp_lv, temp_hv, perm0vA);
1187
        pix0 += i_stride;
1188

1189
        temp_lv = vec_ld(0, pix1);
1190
        temp_hv = vec_ld(16, pix1);
1191
        pix1v = vec_perm(temp_lv, temp_hv, perm1vA);
1192
        pix1 += i_stride;
1193

1194
        temp_lv = vec_ld(0, fenc);
1195
        fencv = vec_perm(temp_lv, temp_hv, permEncv);
1196
        fenc += FENC_STRIDE;
1197

1198
        temp_lv = vec_ld(0, pix2);
1199
        temp_hv = vec_ld(16, pix2);
1200
        pix2v = vec_perm(temp_lv, temp_hv, perm2vA);
1201
        pix2 += i_stride;
1202

1203
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
1204
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
1205
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
1206

1207
        temp_lv = vec_ld(0, pix0);
1208
        temp_hv = vec_ld(16, pix0);
1209
        pix0v = vec_perm(temp_lv, temp_hv, perm0vB);
1210
        pix0 += i_stride;
1211

1212
        temp_lv = vec_ld(0, pix1);
1213
        temp_hv = vec_ld(16, pix1);
1214
        pix1v = vec_perm(temp_lv, temp_hv, perm1vB);
1215
        pix1 += i_stride;
1216

1217
        temp_lv = vec_ld(0, fenc);
1218
        fencv = vec_perm(temp_lv, temp_hv, permEncv);
1219
        fenc += FENC_STRIDE;
1220

1221
        temp_lv = vec_ld(0, pix2);
1222
        temp_hv = vec_ld(16, pix2);
1223
        pix2v = vec_perm(temp_lv, temp_hv, perm2vB);
1224
        pix2 += i_stride;
1225

1226
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
1227
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
1228
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
1229
    }
1230

1231
    sum0v = vec_sum2s( sum0v, zero_s32v );
1232
    sum1v = vec_sum2s( sum1v, zero_s32v );
1233
    sum2v = vec_sum2s( sum2v, zero_s32v );
1234

1235
    sum0v = vec_splat( sum0v, 1 );
1236
    sum1v = vec_splat( sum1v, 1 );
1237
    sum2v = vec_splat( sum2v, 1 );
1238

1239
    vec_ste( sum0v, 0, &sum0);
1240
    vec_ste( sum1v, 0, &sum1);
1241
    vec_ste( sum2v, 0, &sum2);
1242

1243
    scores[0] = sum0;
1244
    scores[1] = sum1;
1245
    scores[2] = sum2;
1246
}
1247

1248
static void pixel_sad_x4_8x8_altivec( uint8_t *fenc,
1249
                                      uint8_t *pix0, uint8_t *pix1,
1250
                                      uint8_t *pix2, uint8_t *pix3,
1251
                                      intptr_t i_stride, int scores[4] )
1252
{
1253
    ALIGNED_16( int sum0 );
1254
    ALIGNED_16( int sum1 );
1255
    ALIGNED_16( int sum2 );
1256
    ALIGNED_16( int sum3 );
1257

1258
    LOAD_ZERO;
1259
    vec_u8_t temp_lv, temp_hv;
1260
    vec_u8_t fencv, pix0v, pix1v, pix2v, pix3v;
1261
    vec_u8_t perm0vA, perm1vA, perm2vA, perm3vA, perm0vB, perm1vB, perm2vB, perm3vB, permEncv;
1262

1263
    vec_s32_t sum0v, sum1v, sum2v, sum3v;
1264

1265
    sum0v = vec_splat_s32(0);
1266
    sum1v = vec_splat_s32(0);
1267
    sum2v = vec_splat_s32(0);
1268
    sum3v = vec_splat_s32(0);
1269

1270
    permEncv = vec_lvsl(0, fenc);
1271
    perm0vA = vec_lvsl(0, pix0);
1272
    perm1vA = vec_lvsl(0, pix1);
1273
    perm2vA = vec_lvsl(0, pix2);
1274
    perm3vA = vec_lvsl(0, pix3);
1275

1276
    perm0vB = vec_lvsl(0, pix0 + i_stride);
1277
    perm1vB = vec_lvsl(0, pix1 + i_stride);
1278
    perm2vB = vec_lvsl(0, pix2 + i_stride);
1279
    perm3vB = vec_lvsl(0, pix3 + i_stride);
1280

1281
    for( int y = 0; y < 4; y++ )
1282
    {
1283
        temp_lv = vec_ld(0, pix0);
1284
        temp_hv = vec_ld(16, pix0);
1285
        pix0v = vec_perm(temp_lv, temp_hv, perm0vA);
1286
        pix0 += i_stride;
1287

1288
        temp_lv = vec_ld(0, pix1);
1289
        temp_hv = vec_ld(16, pix1);
1290
        pix1v = vec_perm(temp_lv, temp_hv, perm1vA);
1291
        pix1 += i_stride;
1292

1293
        temp_lv = vec_ld(0, fenc);
1294
        fencv = vec_perm(temp_lv, temp_hv, permEncv);
1295
        fenc += FENC_STRIDE;
1296

1297
        temp_lv = vec_ld(0, pix2);
1298
        temp_hv = vec_ld(16, pix2);
1299
        pix2v = vec_perm(temp_lv, temp_hv, perm2vA);
1300
        pix2 += i_stride;
1301

1302
        temp_lv = vec_ld(0, pix3);
1303
        temp_hv = vec_ld(16, pix3);
1304
        pix3v = vec_perm(temp_lv, temp_hv, perm3vA);
1305
        pix3 += i_stride;
1306

1307
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
1308
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
1309
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
1310
        sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v );
1311

1312
        temp_lv = vec_ld(0, pix0);
1313
        temp_hv = vec_ld(16, pix0);
1314
        pix0v = vec_perm(temp_lv, temp_hv, perm0vB);
1315
        pix0 += i_stride;
1316

1317
        temp_lv = vec_ld(0, pix1);
1318
        temp_hv = vec_ld(16, pix1);
1319
        pix1v = vec_perm(temp_lv, temp_hv, perm1vB);
1320
        pix1 += i_stride;
1321

1322
        temp_lv = vec_ld(0, fenc);
1323
        fencv = vec_perm(temp_lv, temp_hv, permEncv);
1324
        fenc += FENC_STRIDE;
1325

1326
        temp_lv = vec_ld(0, pix2);
1327
        temp_hv = vec_ld(16, pix2);
1328
        pix2v = vec_perm(temp_lv, temp_hv, perm2vB);
1329
        pix2 += i_stride;
1330

1331
        temp_lv = vec_ld(0, pix3);
1332
        temp_hv = vec_ld(16, pix3);
1333
        pix3v = vec_perm(temp_lv, temp_hv, perm3vB);
1334
        pix3 += i_stride;
1335

1336
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
1337
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
1338
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
1339
        sum3v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix3v ), vec_min( fencv, pix3v ) ), (vec_u32_t) sum3v );
1340
    }
1341

1342
    sum0v = vec_sum2s( sum0v, zero_s32v );
1343
    sum1v = vec_sum2s( sum1v, zero_s32v );
1344
    sum2v = vec_sum2s( sum2v, zero_s32v );
1345
    sum3v = vec_sum2s( sum3v, zero_s32v );
1346

1347
    sum0v = vec_splat( sum0v, 1 );
1348
    sum1v = vec_splat( sum1v, 1 );
1349
    sum2v = vec_splat( sum2v, 1 );
1350
    sum3v = vec_splat( sum3v, 1 );
1351

1352
    vec_ste( sum0v, 0, &sum0);
1353
    vec_ste( sum1v, 0, &sum1);
1354
    vec_ste( sum2v, 0, &sum2);
1355
    vec_ste( sum3v, 0, &sum3);
1356

1357
    scores[0] = sum0;
1358
    scores[1] = sum1;
1359
    scores[2] = sum2;
1360
    scores[3] = sum3;
1361
}
1362

1363
static void pixel_sad_x3_8x8_altivec( uint8_t *fenc, uint8_t *pix0,
1364
                                      uint8_t *pix1, uint8_t *pix2,
1365
                                      intptr_t i_stride, int scores[3] )
1366
{
1367
    ALIGNED_16( int sum0 );
1368
    ALIGNED_16( int sum1 );
1369
    ALIGNED_16( int sum2 );
1370

1371
    LOAD_ZERO;
1372
    vec_u8_t temp_lv, temp_hv;
1373
    vec_u8_t fencv, pix0v, pix1v, pix2v;
1374
    vec_u8_t perm0vA, perm1vA, perm2vA, perm0vB, perm1vB, perm2vB,  permEncv;
1375

1376
    vec_s32_t sum0v, sum1v, sum2v;
1377

1378
    sum0v = vec_splat_s32(0);
1379
    sum1v = vec_splat_s32(0);
1380
    sum2v = vec_splat_s32(0);
1381

1382
    permEncv = vec_lvsl(0, fenc);
1383
    perm0vA = vec_lvsl(0, pix0);
1384
    perm1vA = vec_lvsl(0, pix1);
1385
    perm2vA = vec_lvsl(0, pix2);
1386

1387
    perm0vB = vec_lvsl(0, pix0 + i_stride);
1388
    perm1vB = vec_lvsl(0, pix1 + i_stride);
1389
    perm2vB = vec_lvsl(0, pix2 + i_stride);
1390

1391
    for( int y = 0; y < 4; y++ )
1392
    {
1393
        temp_lv = vec_ld(0, pix0);
1394
        temp_hv = vec_ld(16, pix0);
1395
        pix0v = vec_perm(temp_lv, temp_hv, perm0vA);
1396
        pix0 += i_stride;
1397

1398
        temp_lv = vec_ld(0, pix1);
1399
        temp_hv = vec_ld(16, pix1);
1400
        pix1v = vec_perm(temp_lv, temp_hv, perm1vA);
1401
        pix1 += i_stride;
1402

1403
        temp_lv = vec_ld(0, fenc);
1404
        fencv = vec_perm(temp_lv, temp_hv, permEncv);
1405
        fenc += FENC_STRIDE;
1406

1407
        temp_lv = vec_ld(0, pix2);
1408
        temp_hv = vec_ld(16, pix2);
1409
        pix2v = vec_perm(temp_lv, temp_hv, perm2vA);
1410
        pix2 += i_stride;
1411

1412
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
1413
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
1414
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
1415

1416
        temp_lv = vec_ld(0, pix0);
1417
        temp_hv = vec_ld(16, pix0);
1418
        pix0v = vec_perm(temp_lv, temp_hv, perm0vB);
1419
        pix0 += i_stride;
1420

1421
        temp_lv = vec_ld(0, pix1);
1422
        temp_hv = vec_ld(16, pix1);
1423
        pix1v = vec_perm(temp_lv, temp_hv, perm1vB);
1424
        pix1 += i_stride;
1425

1426
        temp_lv = vec_ld(0, fenc);
1427
        fencv = vec_perm(temp_lv, temp_hv, permEncv);
1428
        fenc += FENC_STRIDE;
1429

1430
        temp_lv = vec_ld(0, pix2);
1431
        temp_hv = vec_ld(16, pix2);
1432
        pix2v = vec_perm(temp_lv, temp_hv, perm2vB);
1433
        pix2 += i_stride;
1434

1435
        sum0v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix0v ), vec_min( fencv, pix0v ) ), (vec_u32_t) sum0v );
1436
        sum1v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix1v ), vec_min( fencv, pix1v ) ), (vec_u32_t) sum1v );
1437
        sum2v = (vec_s32_t) vec_sum4s( vec_sub( vec_max( fencv, pix2v ), vec_min( fencv, pix2v ) ), (vec_u32_t) sum2v );
1438
    }
1439

1440
    sum0v = vec_sum2s( sum0v, zero_s32v );
1441
    sum1v = vec_sum2s( sum1v, zero_s32v );
1442
    sum2v = vec_sum2s( sum2v, zero_s32v );
1443

1444
    sum0v = vec_splat( sum0v, 1 );
1445
    sum1v = vec_splat( sum1v, 1 );
1446
    sum2v = vec_splat( sum2v, 1 );
1447

1448
    vec_ste( sum0v, 0, &sum0);
1449
    vec_ste( sum1v, 0, &sum1);
1450
    vec_ste( sum2v, 0, &sum2);
1451

1452
    scores[0] = sum0;
1453
    scores[1] = sum1;
1454
    scores[2] = sum2;
1455
}
1456

1457
/***********************************************************************
1458
* SSD routines
1459
**********************************************************************/
1460

1461
static int pixel_ssd_16x16_altivec ( uint8_t *pix1, intptr_t i_stride_pix1,
1462
                                     uint8_t *pix2, intptr_t i_stride_pix2 )
1463
{
1464
    ALIGNED_16( int sum );
1465

1466
    LOAD_ZERO;
1467
    vec_u8_t  pix1vA, pix2vA, pix1vB, pix2vB;
1468
    vec_u32_t sumv;
1469
    vec_u8_t maxA, minA, diffA, maxB, minB, diffB;
1470
    vec_u8_t temp_lv, temp_hv;
1471
    vec_u8_t permA, permB;
1472

1473
    sumv = vec_splat_u32(0);
1474

1475
    permA = vec_lvsl(0, pix2);
1476
    permB = vec_lvsl(0, pix2 + i_stride_pix2);
1477

1478
    temp_lv = vec_ld(0, pix2);
1479
    temp_hv = vec_ld(16, pix2);
1480
    pix2vA = vec_perm(temp_lv, temp_hv, permA);
1481
    pix1vA = vec_ld(0, pix1);
1482

1483
    for( int y = 0; y < 7; y++ )
1484
    {
1485
        pix1 += i_stride_pix1;
1486
        pix2 += i_stride_pix2;
1487

1488
        maxA = vec_max(pix1vA, pix2vA);
1489
        minA = vec_min(pix1vA, pix2vA);
1490

1491
        temp_lv = vec_ld(0, pix2);
1492
        temp_hv = vec_ld(16, pix2);
1493
        pix2vB = vec_perm(temp_lv, temp_hv, permB);
1494
        pix1vB = vec_ld(0, pix1);
1495

1496
        diffA = vec_sub(maxA, minA);
1497
        sumv = vec_msum(diffA, diffA, sumv);
1498

1499
        pix1 += i_stride_pix1;
1500
        pix2 += i_stride_pix2;
1501

1502
        maxB = vec_max(pix1vB, pix2vB);
1503
        minB = vec_min(pix1vB, pix2vB);
1504

1505
        temp_lv = vec_ld(0, pix2);
1506
        temp_hv = vec_ld(16, pix2);
1507
        pix2vA = vec_perm(temp_lv, temp_hv, permA);
1508
        pix1vA = vec_ld(0, pix1);
1509

1510
        diffB = vec_sub(maxB, minB);
1511
        sumv = vec_msum(diffB, diffB, sumv);
1512
    }
1513

1514
    pix1 += i_stride_pix1;
1515
    pix2 += i_stride_pix2;
1516

1517
    temp_lv = vec_ld(0, pix2);
1518
    temp_hv = vec_ld(16, pix2);
1519
    pix2vB = vec_perm(temp_lv, temp_hv, permB);
1520
    pix1vB = vec_ld(0, pix1);
1521

1522
    maxA = vec_max(pix1vA, pix2vA);
1523
    minA = vec_min(pix1vA, pix2vA);
1524

1525
    maxB = vec_max(pix1vB, pix2vB);
1526
    minB = vec_min(pix1vB, pix2vB);
1527

1528
    diffA = vec_sub(maxA, minA);
1529
    sumv = vec_msum(diffA, diffA, sumv);
1530

1531
    diffB = vec_sub(maxB, minB);
1532
    sumv = vec_msum(diffB, diffB, sumv);
1533

1534
    sumv = (vec_u32_t) vec_sums((vec_s32_t) sumv, zero_s32v);
1535
    sumv = vec_splat(sumv, 3);
1536
    vec_ste((vec_s32_t) sumv, 0, &sum);
1537
    return sum;
1538
}
1539

1540
static int pixel_ssd_8x8_altivec ( uint8_t *pix1, intptr_t i_stride_pix1,
1541
                                   uint8_t *pix2, intptr_t i_stride_pix2 )
1542
{
1543
    ALIGNED_16( int sum );
1544

1545
    LOAD_ZERO;
1546
    vec_u8_t  pix1v, pix2v;
1547
    vec_u32_t sumv;
1548
    vec_u8_t maxv, minv, diffv;
1549
    vec_u8_t temp_lv, temp_hv;
1550
    vec_u8_t perm1v, perm2v;
1551

1552
    const vec_u32_t sel = (vec_u32_t)CV(-1,-1,0,0);
1553

1554
    sumv = vec_splat_u32(0);
1555

1556
    perm1v = vec_lvsl(0, pix1);
1557
    perm2v = vec_lvsl(0, pix2);
1558

1559
    for( int y = 0; y < 8; y++ )
1560
    {
1561
        temp_hv = vec_ld(0, pix1);
1562
        temp_lv = vec_ld(7, pix1);
1563
        pix1v = vec_perm(temp_hv, temp_lv, perm1v);
1564

1565
        temp_hv = vec_ld(0, pix2);
1566
        temp_lv = vec_ld(7, pix2);
1567
        pix2v = vec_perm(temp_hv, temp_lv, perm2v);
1568

1569
        maxv = vec_max(pix1v, pix2v);
1570
        minv = vec_min(pix1v, pix2v);
1571

1572
        diffv = vec_sub(maxv, minv);
1573
        sumv = vec_msum(diffv, diffv, sumv);
1574

1575
        pix1 += i_stride_pix1;
1576
        pix2 += i_stride_pix2;
1577
    }
1578

1579
    sumv = vec_sel( zero_u32v, sumv, sel );
1580

1581
    sumv = (vec_u32_t) vec_sums((vec_s32_t) sumv, zero_s32v);
1582
    sumv = vec_splat(sumv, 3);
1583
    vec_ste((vec_s32_t) sumv, 0, &sum);
1584

1585
    return sum;
1586
}
1587

1588

1589
/****************************************************************************
1590
 * variance
1591
 ****************************************************************************/
1592
static uint64_t x264_pixel_var_16x16_altivec( uint8_t *pix, intptr_t i_stride )
1593
{
1594
    ALIGNED_16(uint32_t sum_tab[4]);
1595
    ALIGNED_16(uint32_t sqr_tab[4]);
1596

1597
    LOAD_ZERO;
1598
    vec_u32_t sqr_v = zero_u32v;
1599
    vec_u32_t sum_v = zero_u32v;
1600

1601
    for( int y = 0; y < 16; y++ )
1602
    {
1603
        vec_u8_t pix0_v = vec_ld(0, pix);
1604
        sum_v = vec_sum4s(pix0_v, sum_v);
1605
        sqr_v = vec_msum(pix0_v, pix0_v, sqr_v);
1606

1607
        pix += i_stride;
1608
    }
1609
    sum_v = (vec_u32_t)vec_sums( (vec_s32_t)sum_v, zero_s32v );
1610
    sqr_v = (vec_u32_t)vec_sums( (vec_s32_t)sqr_v, zero_s32v );
1611
    vec_ste(sum_v, 12, sum_tab);
1612
    vec_ste(sqr_v, 12, sqr_tab);
1613

1614
    uint32_t sum = sum_tab[3];
1615
    uint32_t sqr = sqr_tab[3];
1616
    return sum + ((uint64_t)sqr<<32);
1617
}
1618

1619
static uint64_t x264_pixel_var_8x8_altivec( uint8_t *pix, intptr_t i_stride )
1620
{
1621
    ALIGNED_16(uint32_t sum_tab[4]);
1622
    ALIGNED_16(uint32_t sqr_tab[4]);
1623

1624
    LOAD_ZERO;
1625
    vec_u32_t sqr_v = zero_u32v;
1626
    vec_u32_t sum_v = zero_u32v;
1627

1628
    static const vec_u8_t perm_tab[] =
1629
    {
1630
        CV(0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,  /* pix=mod16, i_stride=mod16 */
1631
           0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17),
1632
        CV(0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,  /* pix=mod8, i_stride=mod16  */
1633
           0x18, 0x19, 0x1A, 0x1B, 0x1C, 0x1D, 0x1E, 0x1F),
1634
    };
1635
    vec_u8_t perm = perm_tab[ ((uintptr_t)pix & 8) >> 3 ];
1636

1637
    for( int y = 0; y < 4; y++ )
1638
    {
1639
        vec_u8_t pix0_v = vec_ld(0, pix);
1640
        vec_u8_t pix1_v = vec_ld(i_stride, pix);
1641
        vec_u8_t pix_v = vec_perm(pix0_v, pix1_v, perm);
1642
        sum_v = vec_sum4s(pix_v, sum_v);
1643
        sqr_v = vec_msum(pix_v, pix_v, sqr_v);
1644

1645
        pix += i_stride<<1;
1646
    }
1647
    sum_v = (vec_u32_t)vec_sums( (vec_s32_t)sum_v, zero_s32v );
1648
    sqr_v = (vec_u32_t)vec_sums( (vec_s32_t)sqr_v, zero_s32v );
1649
    vec_ste(sum_v, 12, sum_tab);
1650
    vec_ste(sqr_v, 12, sqr_tab);
1651

1652
    uint32_t sum = sum_tab[3];
1653
    uint32_t sqr = sqr_tab[3];
1654
    return sum + ((uint64_t)sqr<<32);
1655
}
1656

1657

1658
/**********************************************************************
1659
 * SA8D routines: sum of 8x8 Hadamard transformed differences
1660
 **********************************************************************/
1661
/* SA8D_1D unrolled by 8 in Altivec */
1662
#define SA8D_1D_ALTIVEC( sa8d0v, sa8d1v, sa8d2v, sa8d3v,  \
1663
                         sa8d4v, sa8d5v, sa8d6v, sa8d7v ) \
1664
{                                                         \
1665
    /* int    a0  =        SRC(0) + SRC(4) */             \
1666
    vec_s16_t a0v = vec_add(sa8d0v, sa8d4v);              \
1667
    /* int    a4  =        SRC(0) - SRC(4) */             \
1668
    vec_s16_t a4v = vec_sub(sa8d0v, sa8d4v);              \
1669
    /* int    a1  =        SRC(1) + SRC(5) */             \
1670
    vec_s16_t a1v = vec_add(sa8d1v, sa8d5v);              \
1671
    /* int    a5  =        SRC(1) - SRC(5) */             \
1672
    vec_s16_t a5v = vec_sub(sa8d1v, sa8d5v);              \
1673
    /* int    a2  =        SRC(2) + SRC(6) */             \
1674
    vec_s16_t a2v = vec_add(sa8d2v, sa8d6v);              \
1675
    /* int    a6  =        SRC(2) - SRC(6) */             \
1676
    vec_s16_t a6v = vec_sub(sa8d2v, sa8d6v);              \
1677
    /* int    a3  =        SRC(3) + SRC(7) */             \
1678
    vec_s16_t a3v = vec_add(sa8d3v, sa8d7v);              \
1679
    /* int    a7  =        SRC(3) - SRC(7) */             \
1680
    vec_s16_t a7v = vec_sub(sa8d3v, sa8d7v);              \
1681
                                                          \
1682
    /* int    b0  =         a0 + a2  */                   \
1683
    vec_s16_t b0v = vec_add(a0v, a2v);                    \
1684
    /* int    b2  =         a0 - a2; */                   \
1685
    vec_s16_t  b2v = vec_sub(a0v, a2v);                   \
1686
    /* int    b1  =         a1 + a3; */                   \
1687
    vec_s16_t b1v = vec_add(a1v, a3v);                    \
1688
    /* int    b3  =         a1 - a3; */                   \
1689
    vec_s16_t b3v = vec_sub(a1v, a3v);                    \
1690
    /* int    b4  =         a4 + a6; */                   \
1691
    vec_s16_t b4v = vec_add(a4v, a6v);                    \
1692
    /* int    b6  =         a4 - a6; */                   \
1693
    vec_s16_t b6v = vec_sub(a4v, a6v);                    \
1694
    /* int    b5  =         a5 + a7; */                   \
1695
    vec_s16_t b5v = vec_add(a5v, a7v);                    \
1696
    /* int    b7  =         a5 - a7; */                   \
1697
    vec_s16_t b7v = vec_sub(a5v, a7v);                    \
1698
                                                          \
1699
    /* DST(0,        b0 + b1) */                          \
1700
    sa8d0v = vec_add(b0v, b1v);                           \
1701
    /* DST(1,        b0 - b1) */                          \
1702
    sa8d1v = vec_sub(b0v, b1v);                           \
1703
    /* DST(2,        b2 + b3) */                          \
1704
    sa8d2v = vec_add(b2v, b3v);                           \
1705
    /* DST(3,        b2 - b3) */                          \
1706
    sa8d3v = vec_sub(b2v, b3v);                           \
1707
    /* DST(4,        b4 + b5) */                          \
1708
    sa8d4v = vec_add(b4v, b5v);                           \
1709
    /* DST(5,        b4 - b5) */                          \
1710
    sa8d5v = vec_sub(b4v, b5v);                           \
1711
    /* DST(6,        b6 + b7) */                          \
1712
    sa8d6v = vec_add(b6v, b7v);                           \
1713
    /* DST(7,        b6 - b7) */                          \
1714
    sa8d7v = vec_sub(b6v, b7v);                           \
1715
}
1716

1717
static int pixel_sa8d_8x8_core_altivec( uint8_t *pix1, intptr_t i_pix1,
1718
                                        uint8_t *pix2, intptr_t i_pix2 )
1719
{
1720
    int32_t i_satd=0;
1721

1722
    PREP_DIFF;
1723
    PREP_LOAD_SRC( pix1 );
1724
    PREP_LOAD_SRC( pix2 );
1725

1726
    vec_s16_t diff0v, diff1v, diff2v, diff3v, diff4v, diff5v, diff6v, diff7v;
1727

1728
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff0v, pix2 );
1729
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff1v, pix2 );
1730
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff2v, pix2 );
1731
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff3v, pix2 );
1732

1733
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff4v, pix2 );
1734
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff5v, pix2 );
1735
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff6v, pix2 );
1736
    VEC_DIFF_H( pix1, i_pix1, pix2, i_pix2, 8, diff7v, pix2 );
1737

1738
    vec_s16_t sa8d0v, sa8d1v, sa8d2v, sa8d3v, sa8d4v, sa8d5v, sa8d6v, sa8d7v;
1739

1740
    SA8D_1D_ALTIVEC(diff0v, diff1v, diff2v, diff3v,
1741
                    diff4v, diff5v, diff6v, diff7v);
1742

1743
    VEC_TRANSPOSE_8(diff0v, diff1v, diff2v, diff3v,
1744
                    diff4v, diff5v, diff6v, diff7v,
1745
                    sa8d0v, sa8d1v, sa8d2v, sa8d3v,
1746
                    sa8d4v, sa8d5v, sa8d6v, sa8d7v );
1747

1748
    SA8D_1D_ALTIVEC(sa8d0v, sa8d1v, sa8d2v, sa8d3v,
1749
                    sa8d4v, sa8d5v, sa8d6v, sa8d7v );
1750

1751
    /* accumulation of the absolute value of all elements of the resulting bloc */
1752
    vec_s16_t abs0v = VEC_ABS(sa8d0v);
1753
    vec_s16_t abs1v = VEC_ABS(sa8d1v);
1754
    vec_s16_t sum01v = vec_add(abs0v, abs1v);
1755

1756
    vec_s16_t abs2v = VEC_ABS(sa8d2v);
1757
    vec_s16_t abs3v = VEC_ABS(sa8d3v);
1758
    vec_s16_t sum23v = vec_add(abs2v, abs3v);
1759

1760
    vec_s16_t abs4v = VEC_ABS(sa8d4v);
1761
    vec_s16_t abs5v = VEC_ABS(sa8d5v);
1762
    vec_s16_t sum45v = vec_add(abs4v, abs5v);
1763

1764
    vec_s16_t abs6v = VEC_ABS(sa8d6v);
1765
    vec_s16_t abs7v = VEC_ABS(sa8d7v);
1766
    vec_s16_t sum67v = vec_add(abs6v, abs7v);
1767

1768
    vec_s16_t sum0123v = vec_add(sum01v, sum23v);
1769
    vec_s16_t sum4567v = vec_add(sum45v, sum67v);
1770

1771
    vec_s32_t sumblocv;
1772

1773
    sumblocv = vec_sum4s(sum0123v, (vec_s32_t)zerov );
1774
    sumblocv = vec_sum4s(sum4567v, sumblocv );
1775

1776
    sumblocv = vec_sums(sumblocv, (vec_s32_t)zerov );
1777

1778
    sumblocv = vec_splat(sumblocv, 3);
1779

1780
    vec_ste(sumblocv, 0, &i_satd);
1781

1782
    return i_satd;
1783
}
1784

1785
static int pixel_sa8d_8x8_altivec( uint8_t *pix1, intptr_t i_pix1,
1786
                                   uint8_t *pix2, intptr_t i_pix2 )
1787
{
1788
    int32_t i_satd;
1789
    i_satd = (pixel_sa8d_8x8_core_altivec( pix1, i_pix1, pix2, i_pix2 )+2)>>2;
1790
    return i_satd;
1791
}
1792

1793
static int pixel_sa8d_16x16_altivec( uint8_t *pix1, intptr_t i_pix1,
1794
                                     uint8_t *pix2, intptr_t i_pix2 )
1795
{
1796
    int32_t i_satd;
1797

1798
    i_satd = (pixel_sa8d_8x8_core_altivec( &pix1[0],          i_pix1, &pix2[0],          i_pix2 )
1799
            + pixel_sa8d_8x8_core_altivec( &pix1[8],          i_pix1, &pix2[8],          i_pix2 )
1800
            + pixel_sa8d_8x8_core_altivec( &pix1[8*i_pix1],   i_pix1, &pix2[8*i_pix2],   i_pix2 )
1801
            + pixel_sa8d_8x8_core_altivec( &pix1[8*i_pix1+8], i_pix1, &pix2[8*i_pix2+8], i_pix2 ) +2)>>2;
1802
    return i_satd;
1803
}
1804

1805
#define HADAMARD4_ALTIVEC(d0,d1,d2,d3,s0,s1,s2,s3) {\
1806
    vec_s16_t t0 = vec_add(s0, s1);                 \
1807
    vec_s16_t t1 = vec_sub(s0, s1);                 \
1808
    vec_s16_t t2 = vec_add(s2, s3);                 \
1809
    vec_s16_t t3 = vec_sub(s2, s3);                 \
1810
    d0 = vec_add(t0, t2);                           \
1811
    d2 = vec_sub(t0, t2);                           \
1812
    d1 = vec_add(t1, t3);                           \
1813
    d3 = vec_sub(t1, t3);                           \
1814
}
1815

1816
#define VEC_LOAD_HIGH( p, num )                                    \
1817
    vec_u8_t pix8_##num = vec_ld( stride*num, p );                 \
1818
    vec_s16_t pix16_s##num = (vec_s16_t)vec_perm(pix8_##num, zero_u8v, perm); \
1819
    vec_s16_t pix16_d##num;
1820

1821
static uint64_t pixel_hadamard_ac_altivec( uint8_t *pix, intptr_t stride, const vec_u8_t perm )
1822
{
1823
    ALIGNED_16( int32_t sum4_tab[4] );
1824
    ALIGNED_16( int32_t sum8_tab[4] );
1825
    LOAD_ZERO;
1826

1827
    VEC_LOAD_HIGH( pix, 0 );
1828
    VEC_LOAD_HIGH( pix, 1 );
1829
    VEC_LOAD_HIGH( pix, 2 );
1830
    VEC_LOAD_HIGH( pix, 3 );
1831
    HADAMARD4_ALTIVEC(pix16_d0,pix16_d1,pix16_d2,pix16_d3,
1832
                      pix16_s0,pix16_s1,pix16_s2,pix16_s3);
1833

1834
    VEC_LOAD_HIGH( pix, 4 );
1835
    VEC_LOAD_HIGH( pix, 5 );
1836
    VEC_LOAD_HIGH( pix, 6 );
1837
    VEC_LOAD_HIGH( pix, 7 );
1838
    HADAMARD4_ALTIVEC(pix16_d4,pix16_d5,pix16_d6,pix16_d7,
1839
                      pix16_s4,pix16_s5,pix16_s6,pix16_s7);
1840

1841
    VEC_TRANSPOSE_8(pix16_d0, pix16_d1, pix16_d2, pix16_d3,
1842
                    pix16_d4, pix16_d5, pix16_d6, pix16_d7,
1843
                    pix16_s0, pix16_s1, pix16_s2, pix16_s3,
1844
                    pix16_s4, pix16_s5, pix16_s6, pix16_s7);
1845

1846
    HADAMARD4_ALTIVEC(pix16_d0,pix16_d1,pix16_d2,pix16_d3,
1847
                      pix16_s0,pix16_s1,pix16_s2,pix16_s3);
1848

1849
    HADAMARD4_ALTIVEC(pix16_d4,pix16_d5,pix16_d6,pix16_d7,
1850
                      pix16_s4,pix16_s5,pix16_s6,pix16_s7);
1851

1852
    vec_u16_t addabs01 = vec_add( VEC_ABSOLUTE(pix16_d0), VEC_ABSOLUTE(pix16_d1) );
1853
    vec_u16_t addabs23 = vec_add( VEC_ABSOLUTE(pix16_d2), VEC_ABSOLUTE(pix16_d3) );
1854
    vec_u16_t addabs45 = vec_add( VEC_ABSOLUTE(pix16_d4), VEC_ABSOLUTE(pix16_d5) );
1855
    vec_u16_t addabs67 = vec_add( VEC_ABSOLUTE(pix16_d6), VEC_ABSOLUTE(pix16_d7) );
1856

1857
    vec_u16_t sum4_v = vec_add(vec_add(addabs01, addabs23), vec_add(addabs45, addabs67));
1858
    vec_ste(vec_sums(vec_sum4s((vec_s16_t)sum4_v, zero_s32v), zero_s32v), 12, sum4_tab);
1859

1860
    vec_s16_t tmpi0 = vec_add(pix16_d0, pix16_d4);
1861
    vec_s16_t tmpi4 = vec_sub(pix16_d0, pix16_d4);
1862
    vec_s16_t tmpi1 = vec_add(pix16_d1, pix16_d5);
1863
    vec_s16_t tmpi5 = vec_sub(pix16_d1, pix16_d5);
1864
    vec_s16_t tmpi2 = vec_add(pix16_d2, pix16_d6);
1865
    vec_s16_t tmpi6 = vec_sub(pix16_d2, pix16_d6);
1866
    vec_s16_t tmpi3 = vec_add(pix16_d3, pix16_d7);
1867
    vec_s16_t tmpi7 = vec_sub(pix16_d3, pix16_d7);
1868

1869
    int sum4 = sum4_tab[3];
1870

1871
    VEC_TRANSPOSE_8(tmpi0, tmpi1, tmpi2, tmpi3,
1872
                    tmpi4, tmpi5, tmpi6, tmpi7,
1873
                    pix16_d0, pix16_d1, pix16_d2, pix16_d3,
1874
                    pix16_d4, pix16_d5, pix16_d6, pix16_d7);
1875

1876
    vec_u16_t addsum04 = vec_add( VEC_ABSOLUTE( vec_add(pix16_d0, pix16_d4) ),
1877
                                  VEC_ABSOLUTE( vec_sub(pix16_d0, pix16_d4) ) );
1878
    vec_u16_t addsum15 = vec_add( VEC_ABSOLUTE( vec_add(pix16_d1, pix16_d5) ),
1879
                                  VEC_ABSOLUTE( vec_sub(pix16_d1, pix16_d5) ) );
1880
    vec_u16_t addsum26 = vec_add( VEC_ABSOLUTE( vec_add(pix16_d2, pix16_d6) ),
1881
                                  VEC_ABSOLUTE( vec_sub(pix16_d2, pix16_d6) ) );
1882
    vec_u16_t addsum37 = vec_add( VEC_ABSOLUTE( vec_add(pix16_d3, pix16_d7) ),
1883
                                  VEC_ABSOLUTE( vec_sub(pix16_d3, pix16_d7) ) );
1884

1885
    vec_u16_t sum8_v = vec_add( vec_add(addsum04, addsum15), vec_add(addsum26, addsum37) );
1886
    vec_ste(vec_sums(vec_sum4s((vec_s16_t)sum8_v, zero_s32v), zero_s32v), 12, sum8_tab);
1887

1888
    int sum8 = sum8_tab[3];
1889

1890
    ALIGNED_16( int16_t tmp0_4_tab[8] );
1891
    vec_ste(vec_add(pix16_d0, pix16_d4), 0, tmp0_4_tab);
1892

1893
    sum4 -= tmp0_4_tab[0];
1894
    sum8 -= tmp0_4_tab[0];
1895
    return ((uint64_t)sum8<<32) + sum4;
1896
}
1897

1898

1899
static const vec_u8_t hadamard_permtab[] =
1900
{
1901
    CV(0x10,0x00,0x11,0x01, 0x12,0x02,0x13,0x03,     /* pix = mod16 */
1902
       0x14,0x04,0x15,0x05, 0x16,0x06,0x17,0x07 ),
1903
    CV(0x18,0x08,0x19,0x09, 0x1A,0x0A,0x1B,0x0B,     /* pix = mod8 */
1904
       0x1C,0x0C,0x1D,0x0D, 0x1E,0x0E,0x1F,0x0F )
1905
 };
1906

1907
static uint64_t x264_pixel_hadamard_ac_16x16_altivec( uint8_t *pix, intptr_t stride )
1908
{
1909
    int idx =  ((uintptr_t)pix & 8) >> 3;
1910
    vec_u8_t permh = hadamard_permtab[idx];
1911
    vec_u8_t perml = hadamard_permtab[!idx];
1912
    uint64_t sum = pixel_hadamard_ac_altivec( pix, stride, permh );
1913
    sum += pixel_hadamard_ac_altivec( pix+8, stride, perml );
1914
    sum += pixel_hadamard_ac_altivec( pix+8*stride, stride, permh );
1915
    sum += pixel_hadamard_ac_altivec( pix+8*stride+8, stride, perml );
1916
    return ((sum>>34)<<32) + ((uint32_t)sum>>1);
1917
}
1918

1919
static uint64_t x264_pixel_hadamard_ac_16x8_altivec( uint8_t *pix, intptr_t stride )
1920
{
1921
    int idx =  ((uintptr_t)pix & 8) >> 3;
1922
    vec_u8_t permh = hadamard_permtab[idx];
1923
    vec_u8_t perml = hadamard_permtab[!idx];
1924
    uint64_t sum = pixel_hadamard_ac_altivec( pix, stride, permh );
1925
    sum += pixel_hadamard_ac_altivec( pix+8, stride, perml );
1926
    return ((sum>>34)<<32) + ((uint32_t)sum>>1);
1927
}
1928

1929
static uint64_t x264_pixel_hadamard_ac_8x16_altivec( uint8_t *pix, intptr_t stride )
1930
{
1931
    vec_u8_t perm = hadamard_permtab[ (((uintptr_t)pix & 8) >> 3) ];
1932
    uint64_t sum = pixel_hadamard_ac_altivec( pix, stride, perm );
1933
    sum += pixel_hadamard_ac_altivec( pix+8*stride, stride, perm );
1934
    return ((sum>>34)<<32) + ((uint32_t)sum>>1);
1935
}
1936

1937
static uint64_t x264_pixel_hadamard_ac_8x8_altivec( uint8_t *pix, intptr_t stride )
1938
{
1939
    vec_u8_t perm = hadamard_permtab[ (((uintptr_t)pix & 8) >> 3) ];
1940
    uint64_t sum = pixel_hadamard_ac_altivec( pix, stride, perm );
1941
    return ((sum>>34)<<32) + ((uint32_t)sum>>1);
1942
}
1943

1944

1945
/****************************************************************************
1946
 * structural similarity metric
1947
 ****************************************************************************/
1948
static void ssim_4x4x2_core_altivec( const uint8_t *pix1, intptr_t stride1,
1949
                                     const uint8_t *pix2, intptr_t stride2,
1950
                                     int sums[2][4] )
1951
{
1952
    ALIGNED_16( int temp[4] );
1953

1954
    vec_u8_t pix1v, pix2v;
1955
    vec_u32_t s1v, s2v, ssv, s12v;
1956
    PREP_LOAD;
1957
    PREP_LOAD_SRC (pix1);
1958
    PREP_LOAD_SRC (pix2);
1959
    LOAD_ZERO;
1960

1961
    s1v = s2v = ssv = s12v = zero_u32v;
1962

1963
    for( int y = 0; y < 4; y++ )
1964
    {
1965
        VEC_LOAD( &pix1[y*stride1], pix1v, 16, vec_u8_t, pix1 );
1966
        VEC_LOAD( &pix2[y*stride2], pix2v, 16, vec_u8_t, pix2 );
1967

1968
        s1v = vec_sum4s( pix1v, s1v );
1969
        s2v = vec_sum4s( pix2v, s2v );
1970
        ssv = vec_msum( pix1v, pix1v, ssv );
1971
        ssv = vec_msum( pix2v, pix2v, ssv );
1972
        s12v = vec_msum( pix1v, pix2v, s12v );
1973
    }
1974

1975
    vec_st( (vec_s32_t)s1v, 0, temp );
1976
    sums[0][0] = temp[0];
1977
    sums[1][0] = temp[1];
1978
    vec_st( (vec_s32_t)s2v, 0, temp );
1979
    sums[0][1] = temp[0];
1980
    sums[1][1] = temp[1];
1981
    vec_st( (vec_s32_t)ssv, 0, temp );
1982
    sums[0][2] = temp[0];
1983
    sums[1][2] = temp[1];
1984
    vec_st( (vec_s32_t)s12v, 0, temp );
1985
    sums[0][3] = temp[0];
1986
    sums[1][3] = temp[1];
1987
}
1988

1989
#define SATD_X( size ) \
1990
static void pixel_satd_x3_##size##_altivec( uint8_t *fenc, uint8_t *pix0, uint8_t *pix1, uint8_t *pix2,\
1991
                                            intptr_t i_stride, int scores[3] )\
1992
{\
1993
    scores[0] = pixel_satd_##size##_altivec( fenc, FENC_STRIDE, pix0, i_stride );\
1994
    scores[1] = pixel_satd_##size##_altivec( fenc, FENC_STRIDE, pix1, i_stride );\
1995
    scores[2] = pixel_satd_##size##_altivec( fenc, FENC_STRIDE, pix2, i_stride );\
1996
}\
1997
static void pixel_satd_x4_##size##_altivec( uint8_t *fenc, uint8_t *pix0, uint8_t *pix1, uint8_t *pix2,\
1998
                                            uint8_t *pix3, intptr_t i_stride, int scores[4] )\
1999
{\
2000
    scores[0] = pixel_satd_##size##_altivec( fenc, FENC_STRIDE, pix0, i_stride );\
2001
    scores[1] = pixel_satd_##size##_altivec( fenc, FENC_STRIDE, pix1, i_stride );\
2002
    scores[2] = pixel_satd_##size##_altivec( fenc, FENC_STRIDE, pix2, i_stride );\
2003
    scores[3] = pixel_satd_##size##_altivec( fenc, FENC_STRIDE, pix3, i_stride );\
2004
}
2005
SATD_X( 16x16 )\
2006
SATD_X( 16x8 )\
2007
SATD_X( 8x16 )\
2008
SATD_X( 8x8 )\
2009
SATD_X( 8x4 )\
2010
SATD_X( 4x8 )\
2011
SATD_X( 4x4 )
2012

2013

2014
#define INTRA_MBCMP_8x8( mbcmp )\
2015
void intra_##mbcmp##_x3_8x8_altivec( uint8_t *fenc, uint8_t edge[36], int res[3] )\
2016
{\
2017
    ALIGNED_8( uint8_t pix[8*FDEC_STRIDE] );\
2018
    x264_predict_8x8_v_c( pix, edge );\
2019
    res[0] = pixel_##mbcmp##_8x8_altivec( pix, FDEC_STRIDE, fenc, FENC_STRIDE );\
2020
    x264_predict_8x8_h_c( pix, edge );\
2021
    res[1] = pixel_##mbcmp##_8x8_altivec( pix, FDEC_STRIDE, fenc, FENC_STRIDE );\
2022
    x264_predict_8x8_dc_c( pix, edge );\
2023
    res[2] = pixel_##mbcmp##_8x8_altivec( pix, FDEC_STRIDE, fenc, FENC_STRIDE );\
2024
}
2025

2026
INTRA_MBCMP_8x8(sad)
2027
INTRA_MBCMP_8x8(sa8d)
2028

2029
#define INTRA_MBCMP( mbcmp, size, pred1, pred2, pred3, chroma )\
2030
void intra_##mbcmp##_x3_##size##x##size##chroma##_altivec( uint8_t *fenc, uint8_t *fdec, int res[3] )\
2031
{\
2032
    x264_predict_##size##x##size##chroma##_##pred1##_c( fdec );\
2033
    res[0] = pixel_##mbcmp##_##size##x##size##_altivec( fdec, FDEC_STRIDE, fenc, FENC_STRIDE );\
2034
    x264_predict_##size##x##size##chroma##_##pred2##_c( fdec );\
2035
    res[1] = pixel_##mbcmp##_##size##x##size##_altivec( fdec, FDEC_STRIDE, fenc, FENC_STRIDE );\
2036
    x264_predict_##size##x##size##chroma##_##pred3##_c( fdec );\
2037
    res[2] = pixel_##mbcmp##_##size##x##size##_altivec( fdec, FDEC_STRIDE, fenc, FENC_STRIDE );\
2038
}
2039

2040
INTRA_MBCMP(satd, 4, v, h, dc, )
2041
INTRA_MBCMP(sad, 8, dc, h, v, c )
2042
INTRA_MBCMP(satd, 8, dc, h, v, c )
2043
INTRA_MBCMP(sad, 16, v, h, dc, )
2044
INTRA_MBCMP(satd, 16, v, h, dc, )
2045
#endif // !HIGH_BIT_DEPTH
2046

2047
/****************************************************************************
2048
 * x264_pixel_init:
2049
 ****************************************************************************/
2050
void x264_pixel_altivec_init( x264_pixel_function_t *pixf )
2051
{
2052
#if !HIGH_BIT_DEPTH
2053
    pixf->sad[PIXEL_16x16]  = pixel_sad_16x16_altivec;
2054
    pixf->sad[PIXEL_8x16]   = pixel_sad_8x16_altivec;
2055
    pixf->sad[PIXEL_16x8]   = pixel_sad_16x8_altivec;
2056
    pixf->sad[PIXEL_8x8]    = pixel_sad_8x8_altivec;
2057

2058
    pixf->sad_x3[PIXEL_16x16] = pixel_sad_x3_16x16_altivec;
2059
    pixf->sad_x3[PIXEL_8x16]  = pixel_sad_x3_8x16_altivec;
2060
    pixf->sad_x3[PIXEL_16x8]  = pixel_sad_x3_16x8_altivec;
2061
    pixf->sad_x3[PIXEL_8x8]   = pixel_sad_x3_8x8_altivec;
2062

2063
    pixf->sad_x4[PIXEL_16x16] = pixel_sad_x4_16x16_altivec;
2064
    pixf->sad_x4[PIXEL_8x16]  = pixel_sad_x4_8x16_altivec;
2065
    pixf->sad_x4[PIXEL_16x8]  = pixel_sad_x4_16x8_altivec;
2066
    pixf->sad_x4[PIXEL_8x8]   = pixel_sad_x4_8x8_altivec;
2067

2068
    pixf->satd[PIXEL_16x16] = pixel_satd_16x16_altivec;
2069
    pixf->satd[PIXEL_8x16]  = pixel_satd_8x16_altivec;
2070
    pixf->satd[PIXEL_16x8]  = pixel_satd_16x8_altivec;
2071
    pixf->satd[PIXEL_8x8]   = pixel_satd_8x8_altivec;
2072
    pixf->satd[PIXEL_8x4]   = pixel_satd_8x4_altivec;
2073
    pixf->satd[PIXEL_4x8]   = pixel_satd_4x8_altivec;
2074
    pixf->satd[PIXEL_4x4]   = pixel_satd_4x4_altivec;
2075

2076
    pixf->satd_x3[PIXEL_16x16] = pixel_satd_x3_16x16_altivec;
2077
    pixf->satd_x3[PIXEL_8x16]  = pixel_satd_x3_8x16_altivec;
2078
    pixf->satd_x3[PIXEL_16x8]  = pixel_satd_x3_16x8_altivec;
2079
    pixf->satd_x3[PIXEL_8x8]   = pixel_satd_x3_8x8_altivec;
2080
    pixf->satd_x3[PIXEL_8x4]   = pixel_satd_x3_8x4_altivec;
2081
    pixf->satd_x3[PIXEL_4x8]   = pixel_satd_x3_4x8_altivec;
2082
    pixf->satd_x3[PIXEL_4x4]   = pixel_satd_x3_4x4_altivec;
2083

2084
    pixf->satd_x4[PIXEL_16x16] = pixel_satd_x4_16x16_altivec;
2085
    pixf->satd_x4[PIXEL_8x16]  = pixel_satd_x4_8x16_altivec;
2086
    pixf->satd_x4[PIXEL_16x8]  = pixel_satd_x4_16x8_altivec;
2087
    pixf->satd_x4[PIXEL_8x8]   = pixel_satd_x4_8x8_altivec;
2088
    pixf->satd_x4[PIXEL_8x4]   = pixel_satd_x4_8x4_altivec;
2089
    pixf->satd_x4[PIXEL_4x8]   = pixel_satd_x4_4x8_altivec;
2090
    pixf->satd_x4[PIXEL_4x4]   = pixel_satd_x4_4x4_altivec;
2091

2092
    pixf->intra_sad_x3_8x8    = intra_sad_x3_8x8_altivec;
2093
    pixf->intra_sad_x3_8x8c   = intra_sad_x3_8x8c_altivec;
2094
    pixf->intra_sad_x3_16x16  = intra_sad_x3_16x16_altivec;
2095

2096
    pixf->intra_satd_x3_4x4   = intra_satd_x3_4x4_altivec;
2097
    pixf->intra_satd_x3_8x8c  = intra_satd_x3_8x8c_altivec;
2098
    pixf->intra_satd_x3_16x16 = intra_satd_x3_16x16_altivec;
2099

2100
    pixf->ssd[PIXEL_16x16] = pixel_ssd_16x16_altivec;
2101
    pixf->ssd[PIXEL_8x8]   = pixel_ssd_8x8_altivec;
2102

2103
    pixf->sa8d[PIXEL_16x16] = pixel_sa8d_16x16_altivec;
2104
    pixf->sa8d[PIXEL_8x8]   = pixel_sa8d_8x8_altivec;
2105

2106
    pixf->intra_sa8d_x3_8x8   = intra_sa8d_x3_8x8_altivec;
2107

2108
    pixf->var[PIXEL_16x16] = x264_pixel_var_16x16_altivec;
2109
    pixf->var[PIXEL_8x8]   = x264_pixel_var_8x8_altivec;
2110

2111
    pixf->hadamard_ac[PIXEL_16x16] = x264_pixel_hadamard_ac_16x16_altivec;
2112
    pixf->hadamard_ac[PIXEL_16x8]  = x264_pixel_hadamard_ac_16x8_altivec;
2113
    pixf->hadamard_ac[PIXEL_8x16]  = x264_pixel_hadamard_ac_8x16_altivec;
2114
    pixf->hadamard_ac[PIXEL_8x8]   = x264_pixel_hadamard_ac_8x8_altivec;
2115

2116
    pixf->ssim_4x4x2_core = ssim_4x4x2_core_altivec;
2117
#endif // !HIGH_BIT_DEPTH
2118
}
2119

2120
Product

Resources

Company
