vda: Check the correct pointer for buffer allocation
[ffmpeg.git] / libavcodec / ppc / idctdsp.c
1 /*
2  * Copyright (c) 2001 Michel Lespinasse
3  *
4  * This file is part of Libav.
5  *
6  * Libav is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU Lesser General Public
8  * License as published by the Free Software Foundation; either
9  * version 2.1 of the License, or (at your option) any later version.
10  *
11  * Libav is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  * Lesser General Public License for more details.
15  *
16  * You should have received a copy of the GNU Lesser General Public
17  * License along with Libav; if not, write to the Free Software
18  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
19  */
20
21 /* NOTE: This code is based on GPL code from the libmpeg2 project.  The
22  * author, Michel Lespinasses, has given explicit permission to release
23  * under LGPL as part of Libav.
24  *
25  * Libav integration by Dieter Shirley
26  *
27  * This file is a direct copy of the AltiVec IDCT module from the libmpeg2
28  * project.  I've deleted all of the libmpeg2-specific code, renamed the
29  * functions and reordered the function parameters.  The only change to the
30  * IDCT function itself was to factor out the partial transposition, and to
31  * perform a full transpose at the end of the function. */
32
33 #include <stdlib.h>
34 #include <string.h>
35 #include "config.h"
36 #if HAVE_ALTIVEC_H
37 #include <altivec.h>
38 #endif
39
40 #include "libavutil/attributes.h"
41 #include "libavutil/cpu.h"
42 #include "libavutil/ppc/cpu.h"
43 #include "libavutil/ppc/types_altivec.h"
44 #include "libavcodec/idctdsp.h"
45
46 #if HAVE_ALTIVEC && HAVE_BIGENDIAN
47
48 #define IDCT_HALF                                       \
49     /* 1st stage */                                     \
50     t1 = vec_mradds(a1, vx7, vx1);                      \
51     t8 = vec_mradds(a1, vx1, vec_subs(zero, vx7));      \
52     t7 = vec_mradds(a2, vx5, vx3);                      \
53     t3 = vec_mradds(ma2, vx3, vx5);                     \
54                                                         \
55     /* 2nd stage */                                     \
56     t5 = vec_adds(vx0, vx4);                            \
57     t0 = vec_subs(vx0, vx4);                            \
58     t2 = vec_mradds(a0, vx6, vx2);                      \
59     t4 = vec_mradds(a0, vx2, vec_subs(zero, vx6));      \
60     t6 = vec_adds(t8, t3);                              \
61     t3 = vec_subs(t8, t3);                              \
62     t8 = vec_subs(t1, t7);                              \
63     t1 = vec_adds(t1, t7);                              \
64                                                         \
65     /* 3rd stage */                                     \
66     t7 = vec_adds(t5, t2);                              \
67     t2 = vec_subs(t5, t2);                              \
68     t5 = vec_adds(t0, t4);                              \
69     t0 = vec_subs(t0, t4);                              \
70     t4 = vec_subs(t8, t3);                              \
71     t3 = vec_adds(t8, t3);                              \
72                                                         \
73     /* 4th stage */                                     \
74     vy0 = vec_adds(t7, t1);                             \
75     vy7 = vec_subs(t7, t1);                             \
76     vy1 = vec_mradds(c4, t3, t5);                       \
77     vy6 = vec_mradds(mc4, t3, t5);                      \
78     vy2 = vec_mradds(c4, t4, t0);                       \
79     vy5 = vec_mradds(mc4, t4, t0);                      \
80     vy3 = vec_adds(t2, t6);                             \
81     vy4 = vec_subs(t2, t6)
82
83 #define IDCT                                                                \
84     vec_s16 vy0, vy1, vy2, vy3, vy4, vy5, vy6, vy7;                         \
85     vec_s16 t0, t1, t2, t3, t4, t5, t6, t7, t8;                             \
86                                                                             \
87     vec_s16 c4   = vec_splat(constants[0], 0);                              \
88     vec_s16 a0   = vec_splat(constants[0], 1);                              \
89     vec_s16 a1   = vec_splat(constants[0], 2);                              \
90     vec_s16 a2   = vec_splat(constants[0], 3);                              \
91     vec_s16 mc4  = vec_splat(constants[0], 4);                              \
92     vec_s16 ma2  = vec_splat(constants[0], 5);                              \
93     vec_s16 bias = (vec_s16) vec_splat((vec_s32) constants[0], 3);          \
94                                                                             \
95     vec_s16 zero  = vec_splat_s16(0);                                       \
96     vec_u16 shift = vec_splat_u16(4);                                       \
97                                                                             \
98     vec_s16 vx0 = vec_mradds(vec_sl(block[0], shift), constants[1], zero);  \
99     vec_s16 vx1 = vec_mradds(vec_sl(block[1], shift), constants[2], zero);  \
100     vec_s16 vx2 = vec_mradds(vec_sl(block[2], shift), constants[3], zero);  \
101     vec_s16 vx3 = vec_mradds(vec_sl(block[3], shift), constants[4], zero);  \
102     vec_s16 vx4 = vec_mradds(vec_sl(block[4], shift), constants[1], zero);  \
103     vec_s16 vx5 = vec_mradds(vec_sl(block[5], shift), constants[4], zero);  \
104     vec_s16 vx6 = vec_mradds(vec_sl(block[6], shift), constants[3], zero);  \
105     vec_s16 vx7 = vec_mradds(vec_sl(block[7], shift), constants[2], zero);  \
106                                                                             \
107     IDCT_HALF;                                                              \
108                                                                             \
109     vx0 = vec_mergeh(vy0, vy4);                                             \
110     vx1 = vec_mergel(vy0, vy4);                                             \
111     vx2 = vec_mergeh(vy1, vy5);                                             \
112     vx3 = vec_mergel(vy1, vy5);                                             \
113     vx4 = vec_mergeh(vy2, vy6);                                             \
114     vx5 = vec_mergel(vy2, vy6);                                             \
115     vx6 = vec_mergeh(vy3, vy7);                                             \
116     vx7 = vec_mergel(vy3, vy7);                                             \
117                                                                             \
118     vy0 = vec_mergeh(vx0, vx4);                                             \
119     vy1 = vec_mergel(vx0, vx4);                                             \
120     vy2 = vec_mergeh(vx1, vx5);                                             \
121     vy3 = vec_mergel(vx1, vx5);                                             \
122     vy4 = vec_mergeh(vx2, vx6);                                             \
123     vy5 = vec_mergel(vx2, vx6);                                             \
124     vy6 = vec_mergeh(vx3, vx7);                                             \
125     vy7 = vec_mergel(vx3, vx7);                                             \
126                                                                             \
127     vx0 = vec_adds(vec_mergeh(vy0, vy4), bias);                             \
128     vx1 = vec_mergel(vy0, vy4);                                             \
129     vx2 = vec_mergeh(vy1, vy5);                                             \
130     vx3 = vec_mergel(vy1, vy5);                                             \
131     vx4 = vec_mergeh(vy2, vy6);                                             \
132     vx5 = vec_mergel(vy2, vy6);                                             \
133     vx6 = vec_mergeh(vy3, vy7);                                             \
134     vx7 = vec_mergel(vy3, vy7);                                             \
135                                                                             \
136     IDCT_HALF;                                                              \
137                                                                             \
138     shift = vec_splat_u16(6);                                               \
139     vx0 = vec_sra(vy0, shift);                                              \
140     vx1 = vec_sra(vy1, shift);                                              \
141     vx2 = vec_sra(vy2, shift);                                              \
142     vx3 = vec_sra(vy3, shift);                                              \
143     vx4 = vec_sra(vy4, shift);                                              \
144     vx5 = vec_sra(vy5, shift);                                              \
145     vx6 = vec_sra(vy6, shift);                                              \
146     vx7 = vec_sra(vy7, shift)
147
148 static const vec_s16 constants[5] = {
149     { 23170, 13573,  6518, 21895, -23170, -21895,    32,    31 },
150     { 16384, 22725, 21407, 19266,  16384,  19266, 21407, 22725 },
151     { 22725, 31521, 29692, 26722,  22725,  26722, 29692, 31521 },
152     { 21407, 29692, 27969, 25172,  21407,  25172, 27969, 29692 },
153     { 19266, 26722, 25172, 22654,  19266,  22654, 25172, 26722 }
154 };
155
156 static void idct_put_altivec(uint8_t *dest, int stride, int16_t *blk)
157 {
158     vec_s16 *block = (vec_s16 *) blk;
159     vec_u8 tmp;
160
161     IDCT;
162
163 #define COPY(dest, src)                                     \
164     tmp = vec_packsu(src, src);                             \
165     vec_ste((vec_u32) tmp, 0, (unsigned int *) dest);       \
166     vec_ste((vec_u32) tmp, 4, (unsigned int *) dest)
167
168     COPY(dest, vx0);
169     dest += stride;
170     COPY(dest, vx1);
171     dest += stride;
172     COPY(dest, vx2);
173     dest += stride;
174     COPY(dest, vx3);
175     dest += stride;
176     COPY(dest, vx4);
177     dest += stride;
178     COPY(dest, vx5);
179     dest += stride;
180     COPY(dest, vx6);
181     dest += stride;
182     COPY(dest, vx7);
183 }
184
185 static void idct_add_altivec(uint8_t *dest, int stride, int16_t *blk)
186 {
187     vec_s16 *block = (vec_s16 *) blk;
188     vec_u8 tmp;
189     vec_s16 tmp2, tmp3;
190     vec_u8 perm0;
191     vec_u8 perm1;
192     vec_u8 p0, p1, p;
193
194     IDCT;
195
196     p0    = vec_lvsl(0, dest);
197     p1    = vec_lvsl(stride, dest);
198     p     = vec_splat_u8(-1);
199     perm0 = vec_mergeh(p, p0);
200     perm1 = vec_mergeh(p, p1);
201
202 #define ADD(dest, src, perm)                                \
203     /* *(uint64_t *) &tmp = *(uint64_t *) dest; */          \
204     tmp  = vec_ld(0, dest);                                 \
205     tmp2 = (vec_s16) vec_perm(tmp, (vec_u8) zero, perm);    \
206     tmp3 = vec_adds(tmp2, src);                             \
207     tmp  = vec_packsu(tmp3, tmp3);                          \
208     vec_ste((vec_u32) tmp, 0, (unsigned int *) dest);       \
209     vec_ste((vec_u32) tmp, 4, (unsigned int *) dest)
210
211     ADD(dest, vx0, perm0);
212     dest += stride;
213     ADD(dest, vx1, perm1);
214     dest += stride;
215     ADD(dest, vx2, perm0);
216     dest += stride;
217     ADD(dest, vx3, perm1);
218     dest += stride;
219     ADD(dest, vx4, perm0);
220     dest += stride;
221     ADD(dest, vx5, perm1);
222     dest += stride;
223     ADD(dest, vx6, perm0);
224     dest += stride;
225     ADD(dest, vx7, perm1);
226 }
227
228 #endif /* HAVE_ALTIVEC */
229
230 av_cold void ff_idctdsp_init_ppc(IDCTDSPContext *c, AVCodecContext *avctx,
231                                  unsigned high_bit_depth)
232 {
233 #if HAVE_ALTIVEC && HAVE_BIGENDIAN
234     if (!PPC_ALTIVEC(av_get_cpu_flags()))
235         return;
236
237     if (!high_bit_depth) {
238         if ((avctx->idct_algo == FF_IDCT_AUTO) ||
239             (avctx->idct_algo == FF_IDCT_ALTIVEC)) {
240             c->idct_add  = idct_add_altivec;
241             c->idct_put  = idct_put_altivec;
242             c->perm_type = FF_IDCT_PERM_TRANSPOSE;
243         }
244     }
245 #endif /* HAVE_ALTIVEC */
246 }