1 /*
2 * Copyright (c) 2012 The WebM project authors. All Rights Reserved.
3 *
4 * Use of this source code is governed by a BSD-style license
5 * that can be found in the LICENSE file in the root of the source
6 * tree. An additional intellectual property rights grant can be found
7 * in the file PATENTS. All contributing project authors may
8 * be found in the AUTHORS file in the root of the source tree.
9 */
10
11 #include <emmintrin.h> // SSE2
12 #include "vp9/common/vp9_idct.h" // for cospi constants
13 #include "vpx_ports/mem.h"
14
15 #if FDCT32x32_HIGH_PRECISION
k_madd_epi32(__m128i a,__m128i b)16 static INLINE __m128i k_madd_epi32(__m128i a, __m128i b) {
17 __m128i buf0, buf1;
18 buf0 = _mm_mul_epu32(a, b);
19 a = _mm_srli_epi64(a, 32);
20 b = _mm_srli_epi64(b, 32);
21 buf1 = _mm_mul_epu32(a, b);
22 return _mm_add_epi64(buf0, buf1);
23 }
24
k_packs_epi64(__m128i a,__m128i b)25 static INLINE __m128i k_packs_epi64(__m128i a, __m128i b) {
26 __m128i buf0 = _mm_shuffle_epi32(a, _MM_SHUFFLE(0, 0, 2, 0));
27 __m128i buf1 = _mm_shuffle_epi32(b, _MM_SHUFFLE(0, 0, 2, 0));
28 return _mm_unpacklo_epi64(buf0, buf1);
29 }
30 #endif
31
FDCT32x32_2D(const int16_t * input,int16_t * output_org,int stride)32 void FDCT32x32_2D(const int16_t *input,
33 int16_t *output_org, int stride) {
34 // Calculate pre-multiplied strides
35 const int str1 = stride;
36 const int str2 = 2 * stride;
37 const int str3 = 2 * stride + str1;
38 // We need an intermediate buffer between passes.
39 DECLARE_ALIGNED(16, int16_t, intermediate[32 * 32]);
40 // Constants
41 // When we use them, in one case, they are all the same. In all others
42 // it's a pair of them that we need to repeat four times. This is done
43 // by constructing the 32 bit constant corresponding to that pair.
44 const __m128i k__cospi_p16_p16 = _mm_set1_epi16(+cospi_16_64);
45 const __m128i k__cospi_p16_m16 = pair_set_epi16(+cospi_16_64, -cospi_16_64);
46 const __m128i k__cospi_m08_p24 = pair_set_epi16(-cospi_8_64, cospi_24_64);
47 const __m128i k__cospi_m24_m08 = pair_set_epi16(-cospi_24_64, -cospi_8_64);
48 const __m128i k__cospi_p24_p08 = pair_set_epi16(+cospi_24_64, cospi_8_64);
49 const __m128i k__cospi_p12_p20 = pair_set_epi16(+cospi_12_64, cospi_20_64);
50 const __m128i k__cospi_m20_p12 = pair_set_epi16(-cospi_20_64, cospi_12_64);
51 const __m128i k__cospi_m04_p28 = pair_set_epi16(-cospi_4_64, cospi_28_64);
52 const __m128i k__cospi_p28_p04 = pair_set_epi16(+cospi_28_64, cospi_4_64);
53 const __m128i k__cospi_m28_m04 = pair_set_epi16(-cospi_28_64, -cospi_4_64);
54 const __m128i k__cospi_m12_m20 = pair_set_epi16(-cospi_12_64, -cospi_20_64);
55 const __m128i k__cospi_p30_p02 = pair_set_epi16(+cospi_30_64, cospi_2_64);
56 const __m128i k__cospi_p14_p18 = pair_set_epi16(+cospi_14_64, cospi_18_64);
57 const __m128i k__cospi_p22_p10 = pair_set_epi16(+cospi_22_64, cospi_10_64);
58 const __m128i k__cospi_p06_p26 = pair_set_epi16(+cospi_6_64, cospi_26_64);
59 const __m128i k__cospi_m26_p06 = pair_set_epi16(-cospi_26_64, cospi_6_64);
60 const __m128i k__cospi_m10_p22 = pair_set_epi16(-cospi_10_64, cospi_22_64);
61 const __m128i k__cospi_m18_p14 = pair_set_epi16(-cospi_18_64, cospi_14_64);
62 const __m128i k__cospi_m02_p30 = pair_set_epi16(-cospi_2_64, cospi_30_64);
63 const __m128i k__cospi_p31_p01 = pair_set_epi16(+cospi_31_64, cospi_1_64);
64 const __m128i k__cospi_p15_p17 = pair_set_epi16(+cospi_15_64, cospi_17_64);
65 const __m128i k__cospi_p23_p09 = pair_set_epi16(+cospi_23_64, cospi_9_64);
66 const __m128i k__cospi_p07_p25 = pair_set_epi16(+cospi_7_64, cospi_25_64);
67 const __m128i k__cospi_m25_p07 = pair_set_epi16(-cospi_25_64, cospi_7_64);
68 const __m128i k__cospi_m09_p23 = pair_set_epi16(-cospi_9_64, cospi_23_64);
69 const __m128i k__cospi_m17_p15 = pair_set_epi16(-cospi_17_64, cospi_15_64);
70 const __m128i k__cospi_m01_p31 = pair_set_epi16(-cospi_1_64, cospi_31_64);
71 const __m128i k__cospi_p27_p05 = pair_set_epi16(+cospi_27_64, cospi_5_64);
72 const __m128i k__cospi_p11_p21 = pair_set_epi16(+cospi_11_64, cospi_21_64);
73 const __m128i k__cospi_p19_p13 = pair_set_epi16(+cospi_19_64, cospi_13_64);
74 const __m128i k__cospi_p03_p29 = pair_set_epi16(+cospi_3_64, cospi_29_64);
75 const __m128i k__cospi_m29_p03 = pair_set_epi16(-cospi_29_64, cospi_3_64);
76 const __m128i k__cospi_m13_p19 = pair_set_epi16(-cospi_13_64, cospi_19_64);
77 const __m128i k__cospi_m21_p11 = pair_set_epi16(-cospi_21_64, cospi_11_64);
78 const __m128i k__cospi_m05_p27 = pair_set_epi16(-cospi_5_64, cospi_27_64);
79 const __m128i k__DCT_CONST_ROUNDING = _mm_set1_epi32(DCT_CONST_ROUNDING);
80 const __m128i kZero = _mm_set1_epi16(0);
81 const __m128i kOne = _mm_set1_epi16(1);
82 // Do the two transform/transpose passes
83 int pass;
84 for (pass = 0; pass < 2; ++pass) {
85 // We process eight columns (transposed rows in second pass) at a time.
86 int column_start;
87 for (column_start = 0; column_start < 32; column_start += 8) {
88 __m128i step1[32];
89 __m128i step2[32];
90 __m128i step3[32];
91 __m128i out[32];
92 // Stage 1
93 // Note: even though all the loads below are aligned, using the aligned
94 // intrinsic make the code slightly slower.
95 if (0 == pass) {
96 const int16_t *in = &input[column_start];
97 // step1[i] = (in[ 0 * stride] + in[(32 - 1) * stride]) << 2;
98 // Note: the next four blocks could be in a loop. That would help the
99 // instruction cache but is actually slower.
100 {
101 const int16_t *ina = in + 0 * str1;
102 const int16_t *inb = in + 31 * str1;
103 __m128i *step1a = &step1[ 0];
104 __m128i *step1b = &step1[31];
105 const __m128i ina0 = _mm_loadu_si128((const __m128i *)(ina));
106 const __m128i ina1 = _mm_loadu_si128((const __m128i *)(ina + str1));
107 const __m128i ina2 = _mm_loadu_si128((const __m128i *)(ina + str2));
108 const __m128i ina3 = _mm_loadu_si128((const __m128i *)(ina + str3));
109 const __m128i inb3 = _mm_loadu_si128((const __m128i *)(inb - str3));
110 const __m128i inb2 = _mm_loadu_si128((const __m128i *)(inb - str2));
111 const __m128i inb1 = _mm_loadu_si128((const __m128i *)(inb - str1));
112 const __m128i inb0 = _mm_loadu_si128((const __m128i *)(inb));
113 step1a[ 0] = _mm_add_epi16(ina0, inb0);
114 step1a[ 1] = _mm_add_epi16(ina1, inb1);
115 step1a[ 2] = _mm_add_epi16(ina2, inb2);
116 step1a[ 3] = _mm_add_epi16(ina3, inb3);
117 step1b[-3] = _mm_sub_epi16(ina3, inb3);
118 step1b[-2] = _mm_sub_epi16(ina2, inb2);
119 step1b[-1] = _mm_sub_epi16(ina1, inb1);
120 step1b[-0] = _mm_sub_epi16(ina0, inb0);
121 step1a[ 0] = _mm_slli_epi16(step1a[ 0], 2);
122 step1a[ 1] = _mm_slli_epi16(step1a[ 1], 2);
123 step1a[ 2] = _mm_slli_epi16(step1a[ 2], 2);
124 step1a[ 3] = _mm_slli_epi16(step1a[ 3], 2);
125 step1b[-3] = _mm_slli_epi16(step1b[-3], 2);
126 step1b[-2] = _mm_slli_epi16(step1b[-2], 2);
127 step1b[-1] = _mm_slli_epi16(step1b[-1], 2);
128 step1b[-0] = _mm_slli_epi16(step1b[-0], 2);
129 }
130 {
131 const int16_t *ina = in + 4 * str1;
132 const int16_t *inb = in + 27 * str1;
133 __m128i *step1a = &step1[ 4];
134 __m128i *step1b = &step1[27];
135 const __m128i ina0 = _mm_loadu_si128((const __m128i *)(ina));
136 const __m128i ina1 = _mm_loadu_si128((const __m128i *)(ina + str1));
137 const __m128i ina2 = _mm_loadu_si128((const __m128i *)(ina + str2));
138 const __m128i ina3 = _mm_loadu_si128((const __m128i *)(ina + str3));
139 const __m128i inb3 = _mm_loadu_si128((const __m128i *)(inb - str3));
140 const __m128i inb2 = _mm_loadu_si128((const __m128i *)(inb - str2));
141 const __m128i inb1 = _mm_loadu_si128((const __m128i *)(inb - str1));
142 const __m128i inb0 = _mm_loadu_si128((const __m128i *)(inb));
143 step1a[ 0] = _mm_add_epi16(ina0, inb0);
144 step1a[ 1] = _mm_add_epi16(ina1, inb1);
145 step1a[ 2] = _mm_add_epi16(ina2, inb2);
146 step1a[ 3] = _mm_add_epi16(ina3, inb3);
147 step1b[-3] = _mm_sub_epi16(ina3, inb3);
148 step1b[-2] = _mm_sub_epi16(ina2, inb2);
149 step1b[-1] = _mm_sub_epi16(ina1, inb1);
150 step1b[-0] = _mm_sub_epi16(ina0, inb0);
151 step1a[ 0] = _mm_slli_epi16(step1a[ 0], 2);
152 step1a[ 1] = _mm_slli_epi16(step1a[ 1], 2);
153 step1a[ 2] = _mm_slli_epi16(step1a[ 2], 2);
154 step1a[ 3] = _mm_slli_epi16(step1a[ 3], 2);
155 step1b[-3] = _mm_slli_epi16(step1b[-3], 2);
156 step1b[-2] = _mm_slli_epi16(step1b[-2], 2);
157 step1b[-1] = _mm_slli_epi16(step1b[-1], 2);
158 step1b[-0] = _mm_slli_epi16(step1b[-0], 2);
159 }
160 {
161 const int16_t *ina = in + 8 * str1;
162 const int16_t *inb = in + 23 * str1;
163 __m128i *step1a = &step1[ 8];
164 __m128i *step1b = &step1[23];
165 const __m128i ina0 = _mm_loadu_si128((const __m128i *)(ina));
166 const __m128i ina1 = _mm_loadu_si128((const __m128i *)(ina + str1));
167 const __m128i ina2 = _mm_loadu_si128((const __m128i *)(ina + str2));
168 const __m128i ina3 = _mm_loadu_si128((const __m128i *)(ina + str3));
169 const __m128i inb3 = _mm_loadu_si128((const __m128i *)(inb - str3));
170 const __m128i inb2 = _mm_loadu_si128((const __m128i *)(inb - str2));
171 const __m128i inb1 = _mm_loadu_si128((const __m128i *)(inb - str1));
172 const __m128i inb0 = _mm_loadu_si128((const __m128i *)(inb));
173 step1a[ 0] = _mm_add_epi16(ina0, inb0);
174 step1a[ 1] = _mm_add_epi16(ina1, inb1);
175 step1a[ 2] = _mm_add_epi16(ina2, inb2);
176 step1a[ 3] = _mm_add_epi16(ina3, inb3);
177 step1b[-3] = _mm_sub_epi16(ina3, inb3);
178 step1b[-2] = _mm_sub_epi16(ina2, inb2);
179 step1b[-1] = _mm_sub_epi16(ina1, inb1);
180 step1b[-0] = _mm_sub_epi16(ina0, inb0);
181 step1a[ 0] = _mm_slli_epi16(step1a[ 0], 2);
182 step1a[ 1] = _mm_slli_epi16(step1a[ 1], 2);
183 step1a[ 2] = _mm_slli_epi16(step1a[ 2], 2);
184 step1a[ 3] = _mm_slli_epi16(step1a[ 3], 2);
185 step1b[-3] = _mm_slli_epi16(step1b[-3], 2);
186 step1b[-2] = _mm_slli_epi16(step1b[-2], 2);
187 step1b[-1] = _mm_slli_epi16(step1b[-1], 2);
188 step1b[-0] = _mm_slli_epi16(step1b[-0], 2);
189 }
190 {
191 const int16_t *ina = in + 12 * str1;
192 const int16_t *inb = in + 19 * str1;
193 __m128i *step1a = &step1[12];
194 __m128i *step1b = &step1[19];
195 const __m128i ina0 = _mm_loadu_si128((const __m128i *)(ina));
196 const __m128i ina1 = _mm_loadu_si128((const __m128i *)(ina + str1));
197 const __m128i ina2 = _mm_loadu_si128((const __m128i *)(ina + str2));
198 const __m128i ina3 = _mm_loadu_si128((const __m128i *)(ina + str3));
199 const __m128i inb3 = _mm_loadu_si128((const __m128i *)(inb - str3));
200 const __m128i inb2 = _mm_loadu_si128((const __m128i *)(inb - str2));
201 const __m128i inb1 = _mm_loadu_si128((const __m128i *)(inb - str1));
202 const __m128i inb0 = _mm_loadu_si128((const __m128i *)(inb));
203 step1a[ 0] = _mm_add_epi16(ina0, inb0);
204 step1a[ 1] = _mm_add_epi16(ina1, inb1);
205 step1a[ 2] = _mm_add_epi16(ina2, inb2);
206 step1a[ 3] = _mm_add_epi16(ina3, inb3);
207 step1b[-3] = _mm_sub_epi16(ina3, inb3);
208 step1b[-2] = _mm_sub_epi16(ina2, inb2);
209 step1b[-1] = _mm_sub_epi16(ina1, inb1);
210 step1b[-0] = _mm_sub_epi16(ina0, inb0);
211 step1a[ 0] = _mm_slli_epi16(step1a[ 0], 2);
212 step1a[ 1] = _mm_slli_epi16(step1a[ 1], 2);
213 step1a[ 2] = _mm_slli_epi16(step1a[ 2], 2);
214 step1a[ 3] = _mm_slli_epi16(step1a[ 3], 2);
215 step1b[-3] = _mm_slli_epi16(step1b[-3], 2);
216 step1b[-2] = _mm_slli_epi16(step1b[-2], 2);
217 step1b[-1] = _mm_slli_epi16(step1b[-1], 2);
218 step1b[-0] = _mm_slli_epi16(step1b[-0], 2);
219 }
220 } else {
221 int16_t *in = &intermediate[column_start];
222 // step1[i] = in[ 0 * 32] + in[(32 - 1) * 32];
223 // Note: using the same approach as above to have common offset is
224 // counter-productive as all offsets can be calculated at compile
225 // time.
226 // Note: the next four blocks could be in a loop. That would help the
227 // instruction cache but is actually slower.
228 {
229 __m128i in00 = _mm_loadu_si128((const __m128i *)(in + 0 * 32));
230 __m128i in01 = _mm_loadu_si128((const __m128i *)(in + 1 * 32));
231 __m128i in02 = _mm_loadu_si128((const __m128i *)(in + 2 * 32));
232 __m128i in03 = _mm_loadu_si128((const __m128i *)(in + 3 * 32));
233 __m128i in28 = _mm_loadu_si128((const __m128i *)(in + 28 * 32));
234 __m128i in29 = _mm_loadu_si128((const __m128i *)(in + 29 * 32));
235 __m128i in30 = _mm_loadu_si128((const __m128i *)(in + 30 * 32));
236 __m128i in31 = _mm_loadu_si128((const __m128i *)(in + 31 * 32));
237 step1[ 0] = _mm_add_epi16(in00, in31);
238 step1[ 1] = _mm_add_epi16(in01, in30);
239 step1[ 2] = _mm_add_epi16(in02, in29);
240 step1[ 3] = _mm_add_epi16(in03, in28);
241 step1[28] = _mm_sub_epi16(in03, in28);
242 step1[29] = _mm_sub_epi16(in02, in29);
243 step1[30] = _mm_sub_epi16(in01, in30);
244 step1[31] = _mm_sub_epi16(in00, in31);
245 }
246 {
247 __m128i in04 = _mm_loadu_si128((const __m128i *)(in + 4 * 32));
248 __m128i in05 = _mm_loadu_si128((const __m128i *)(in + 5 * 32));
249 __m128i in06 = _mm_loadu_si128((const __m128i *)(in + 6 * 32));
250 __m128i in07 = _mm_loadu_si128((const __m128i *)(in + 7 * 32));
251 __m128i in24 = _mm_loadu_si128((const __m128i *)(in + 24 * 32));
252 __m128i in25 = _mm_loadu_si128((const __m128i *)(in + 25 * 32));
253 __m128i in26 = _mm_loadu_si128((const __m128i *)(in + 26 * 32));
254 __m128i in27 = _mm_loadu_si128((const __m128i *)(in + 27 * 32));
255 step1[ 4] = _mm_add_epi16(in04, in27);
256 step1[ 5] = _mm_add_epi16(in05, in26);
257 step1[ 6] = _mm_add_epi16(in06, in25);
258 step1[ 7] = _mm_add_epi16(in07, in24);
259 step1[24] = _mm_sub_epi16(in07, in24);
260 step1[25] = _mm_sub_epi16(in06, in25);
261 step1[26] = _mm_sub_epi16(in05, in26);
262 step1[27] = _mm_sub_epi16(in04, in27);
263 }
264 {
265 __m128i in08 = _mm_loadu_si128((const __m128i *)(in + 8 * 32));
266 __m128i in09 = _mm_loadu_si128((const __m128i *)(in + 9 * 32));
267 __m128i in10 = _mm_loadu_si128((const __m128i *)(in + 10 * 32));
268 __m128i in11 = _mm_loadu_si128((const __m128i *)(in + 11 * 32));
269 __m128i in20 = _mm_loadu_si128((const __m128i *)(in + 20 * 32));
270 __m128i in21 = _mm_loadu_si128((const __m128i *)(in + 21 * 32));
271 __m128i in22 = _mm_loadu_si128((const __m128i *)(in + 22 * 32));
272 __m128i in23 = _mm_loadu_si128((const __m128i *)(in + 23 * 32));
273 step1[ 8] = _mm_add_epi16(in08, in23);
274 step1[ 9] = _mm_add_epi16(in09, in22);
275 step1[10] = _mm_add_epi16(in10, in21);
276 step1[11] = _mm_add_epi16(in11, in20);
277 step1[20] = _mm_sub_epi16(in11, in20);
278 step1[21] = _mm_sub_epi16(in10, in21);
279 step1[22] = _mm_sub_epi16(in09, in22);
280 step1[23] = _mm_sub_epi16(in08, in23);
281 }
282 {
283 __m128i in12 = _mm_loadu_si128((const __m128i *)(in + 12 * 32));
284 __m128i in13 = _mm_loadu_si128((const __m128i *)(in + 13 * 32));
285 __m128i in14 = _mm_loadu_si128((const __m128i *)(in + 14 * 32));
286 __m128i in15 = _mm_loadu_si128((const __m128i *)(in + 15 * 32));
287 __m128i in16 = _mm_loadu_si128((const __m128i *)(in + 16 * 32));
288 __m128i in17 = _mm_loadu_si128((const __m128i *)(in + 17 * 32));
289 __m128i in18 = _mm_loadu_si128((const __m128i *)(in + 18 * 32));
290 __m128i in19 = _mm_loadu_si128((const __m128i *)(in + 19 * 32));
291 step1[12] = _mm_add_epi16(in12, in19);
292 step1[13] = _mm_add_epi16(in13, in18);
293 step1[14] = _mm_add_epi16(in14, in17);
294 step1[15] = _mm_add_epi16(in15, in16);
295 step1[16] = _mm_sub_epi16(in15, in16);
296 step1[17] = _mm_sub_epi16(in14, in17);
297 step1[18] = _mm_sub_epi16(in13, in18);
298 step1[19] = _mm_sub_epi16(in12, in19);
299 }
300 }
301 // Stage 2
302 {
303 step2[ 0] = _mm_add_epi16(step1[0], step1[15]);
304 step2[ 1] = _mm_add_epi16(step1[1], step1[14]);
305 step2[ 2] = _mm_add_epi16(step1[2], step1[13]);
306 step2[ 3] = _mm_add_epi16(step1[3], step1[12]);
307 step2[ 4] = _mm_add_epi16(step1[4], step1[11]);
308 step2[ 5] = _mm_add_epi16(step1[5], step1[10]);
309 step2[ 6] = _mm_add_epi16(step1[6], step1[ 9]);
310 step2[ 7] = _mm_add_epi16(step1[7], step1[ 8]);
311 step2[ 8] = _mm_sub_epi16(step1[7], step1[ 8]);
312 step2[ 9] = _mm_sub_epi16(step1[6], step1[ 9]);
313 step2[10] = _mm_sub_epi16(step1[5], step1[10]);
314 step2[11] = _mm_sub_epi16(step1[4], step1[11]);
315 step2[12] = _mm_sub_epi16(step1[3], step1[12]);
316 step2[13] = _mm_sub_epi16(step1[2], step1[13]);
317 step2[14] = _mm_sub_epi16(step1[1], step1[14]);
318 step2[15] = _mm_sub_epi16(step1[0], step1[15]);
319 }
320 {
321 const __m128i s2_20_0 = _mm_unpacklo_epi16(step1[27], step1[20]);
322 const __m128i s2_20_1 = _mm_unpackhi_epi16(step1[27], step1[20]);
323 const __m128i s2_21_0 = _mm_unpacklo_epi16(step1[26], step1[21]);
324 const __m128i s2_21_1 = _mm_unpackhi_epi16(step1[26], step1[21]);
325 const __m128i s2_22_0 = _mm_unpacklo_epi16(step1[25], step1[22]);
326 const __m128i s2_22_1 = _mm_unpackhi_epi16(step1[25], step1[22]);
327 const __m128i s2_23_0 = _mm_unpacklo_epi16(step1[24], step1[23]);
328 const __m128i s2_23_1 = _mm_unpackhi_epi16(step1[24], step1[23]);
329 const __m128i s2_20_2 = _mm_madd_epi16(s2_20_0, k__cospi_p16_m16);
330 const __m128i s2_20_3 = _mm_madd_epi16(s2_20_1, k__cospi_p16_m16);
331 const __m128i s2_21_2 = _mm_madd_epi16(s2_21_0, k__cospi_p16_m16);
332 const __m128i s2_21_3 = _mm_madd_epi16(s2_21_1, k__cospi_p16_m16);
333 const __m128i s2_22_2 = _mm_madd_epi16(s2_22_0, k__cospi_p16_m16);
334 const __m128i s2_22_3 = _mm_madd_epi16(s2_22_1, k__cospi_p16_m16);
335 const __m128i s2_23_2 = _mm_madd_epi16(s2_23_0, k__cospi_p16_m16);
336 const __m128i s2_23_3 = _mm_madd_epi16(s2_23_1, k__cospi_p16_m16);
337 const __m128i s2_24_2 = _mm_madd_epi16(s2_23_0, k__cospi_p16_p16);
338 const __m128i s2_24_3 = _mm_madd_epi16(s2_23_1, k__cospi_p16_p16);
339 const __m128i s2_25_2 = _mm_madd_epi16(s2_22_0, k__cospi_p16_p16);
340 const __m128i s2_25_3 = _mm_madd_epi16(s2_22_1, k__cospi_p16_p16);
341 const __m128i s2_26_2 = _mm_madd_epi16(s2_21_0, k__cospi_p16_p16);
342 const __m128i s2_26_3 = _mm_madd_epi16(s2_21_1, k__cospi_p16_p16);
343 const __m128i s2_27_2 = _mm_madd_epi16(s2_20_0, k__cospi_p16_p16);
344 const __m128i s2_27_3 = _mm_madd_epi16(s2_20_1, k__cospi_p16_p16);
345 // dct_const_round_shift
346 const __m128i s2_20_4 = _mm_add_epi32(s2_20_2, k__DCT_CONST_ROUNDING);
347 const __m128i s2_20_5 = _mm_add_epi32(s2_20_3, k__DCT_CONST_ROUNDING);
348 const __m128i s2_21_4 = _mm_add_epi32(s2_21_2, k__DCT_CONST_ROUNDING);
349 const __m128i s2_21_5 = _mm_add_epi32(s2_21_3, k__DCT_CONST_ROUNDING);
350 const __m128i s2_22_4 = _mm_add_epi32(s2_22_2, k__DCT_CONST_ROUNDING);
351 const __m128i s2_22_5 = _mm_add_epi32(s2_22_3, k__DCT_CONST_ROUNDING);
352 const __m128i s2_23_4 = _mm_add_epi32(s2_23_2, k__DCT_CONST_ROUNDING);
353 const __m128i s2_23_5 = _mm_add_epi32(s2_23_3, k__DCT_CONST_ROUNDING);
354 const __m128i s2_24_4 = _mm_add_epi32(s2_24_2, k__DCT_CONST_ROUNDING);
355 const __m128i s2_24_5 = _mm_add_epi32(s2_24_3, k__DCT_CONST_ROUNDING);
356 const __m128i s2_25_4 = _mm_add_epi32(s2_25_2, k__DCT_CONST_ROUNDING);
357 const __m128i s2_25_5 = _mm_add_epi32(s2_25_3, k__DCT_CONST_ROUNDING);
358 const __m128i s2_26_4 = _mm_add_epi32(s2_26_2, k__DCT_CONST_ROUNDING);
359 const __m128i s2_26_5 = _mm_add_epi32(s2_26_3, k__DCT_CONST_ROUNDING);
360 const __m128i s2_27_4 = _mm_add_epi32(s2_27_2, k__DCT_CONST_ROUNDING);
361 const __m128i s2_27_5 = _mm_add_epi32(s2_27_3, k__DCT_CONST_ROUNDING);
362 const __m128i s2_20_6 = _mm_srai_epi32(s2_20_4, DCT_CONST_BITS);
363 const __m128i s2_20_7 = _mm_srai_epi32(s2_20_5, DCT_CONST_BITS);
364 const __m128i s2_21_6 = _mm_srai_epi32(s2_21_4, DCT_CONST_BITS);
365 const __m128i s2_21_7 = _mm_srai_epi32(s2_21_5, DCT_CONST_BITS);
366 const __m128i s2_22_6 = _mm_srai_epi32(s2_22_4, DCT_CONST_BITS);
367 const __m128i s2_22_7 = _mm_srai_epi32(s2_22_5, DCT_CONST_BITS);
368 const __m128i s2_23_6 = _mm_srai_epi32(s2_23_4, DCT_CONST_BITS);
369 const __m128i s2_23_7 = _mm_srai_epi32(s2_23_5, DCT_CONST_BITS);
370 const __m128i s2_24_6 = _mm_srai_epi32(s2_24_4, DCT_CONST_BITS);
371 const __m128i s2_24_7 = _mm_srai_epi32(s2_24_5, DCT_CONST_BITS);
372 const __m128i s2_25_6 = _mm_srai_epi32(s2_25_4, DCT_CONST_BITS);
373 const __m128i s2_25_7 = _mm_srai_epi32(s2_25_5, DCT_CONST_BITS);
374 const __m128i s2_26_6 = _mm_srai_epi32(s2_26_4, DCT_CONST_BITS);
375 const __m128i s2_26_7 = _mm_srai_epi32(s2_26_5, DCT_CONST_BITS);
376 const __m128i s2_27_6 = _mm_srai_epi32(s2_27_4, DCT_CONST_BITS);
377 const __m128i s2_27_7 = _mm_srai_epi32(s2_27_5, DCT_CONST_BITS);
378 // Combine
379 step2[20] = _mm_packs_epi32(s2_20_6, s2_20_7);
380 step2[21] = _mm_packs_epi32(s2_21_6, s2_21_7);
381 step2[22] = _mm_packs_epi32(s2_22_6, s2_22_7);
382 step2[23] = _mm_packs_epi32(s2_23_6, s2_23_7);
383 step2[24] = _mm_packs_epi32(s2_24_6, s2_24_7);
384 step2[25] = _mm_packs_epi32(s2_25_6, s2_25_7);
385 step2[26] = _mm_packs_epi32(s2_26_6, s2_26_7);
386 step2[27] = _mm_packs_epi32(s2_27_6, s2_27_7);
387 }
388
389 #if !FDCT32x32_HIGH_PRECISION
390 // dump the magnitude by half, hence the intermediate values are within
391 // the range of 16 bits.
392 if (1 == pass) {
393 __m128i s3_00_0 = _mm_cmplt_epi16(step2[ 0], kZero);
394 __m128i s3_01_0 = _mm_cmplt_epi16(step2[ 1], kZero);
395 __m128i s3_02_0 = _mm_cmplt_epi16(step2[ 2], kZero);
396 __m128i s3_03_0 = _mm_cmplt_epi16(step2[ 3], kZero);
397 __m128i s3_04_0 = _mm_cmplt_epi16(step2[ 4], kZero);
398 __m128i s3_05_0 = _mm_cmplt_epi16(step2[ 5], kZero);
399 __m128i s3_06_0 = _mm_cmplt_epi16(step2[ 6], kZero);
400 __m128i s3_07_0 = _mm_cmplt_epi16(step2[ 7], kZero);
401 __m128i s2_08_0 = _mm_cmplt_epi16(step2[ 8], kZero);
402 __m128i s2_09_0 = _mm_cmplt_epi16(step2[ 9], kZero);
403 __m128i s3_10_0 = _mm_cmplt_epi16(step2[10], kZero);
404 __m128i s3_11_0 = _mm_cmplt_epi16(step2[11], kZero);
405 __m128i s3_12_0 = _mm_cmplt_epi16(step2[12], kZero);
406 __m128i s3_13_0 = _mm_cmplt_epi16(step2[13], kZero);
407 __m128i s2_14_0 = _mm_cmplt_epi16(step2[14], kZero);
408 __m128i s2_15_0 = _mm_cmplt_epi16(step2[15], kZero);
409 __m128i s3_16_0 = _mm_cmplt_epi16(step1[16], kZero);
410 __m128i s3_17_0 = _mm_cmplt_epi16(step1[17], kZero);
411 __m128i s3_18_0 = _mm_cmplt_epi16(step1[18], kZero);
412 __m128i s3_19_0 = _mm_cmplt_epi16(step1[19], kZero);
413 __m128i s3_20_0 = _mm_cmplt_epi16(step2[20], kZero);
414 __m128i s3_21_0 = _mm_cmplt_epi16(step2[21], kZero);
415 __m128i s3_22_0 = _mm_cmplt_epi16(step2[22], kZero);
416 __m128i s3_23_0 = _mm_cmplt_epi16(step2[23], kZero);
417 __m128i s3_24_0 = _mm_cmplt_epi16(step2[24], kZero);
418 __m128i s3_25_0 = _mm_cmplt_epi16(step2[25], kZero);
419 __m128i s3_26_0 = _mm_cmplt_epi16(step2[26], kZero);
420 __m128i s3_27_0 = _mm_cmplt_epi16(step2[27], kZero);
421 __m128i s3_28_0 = _mm_cmplt_epi16(step1[28], kZero);
422 __m128i s3_29_0 = _mm_cmplt_epi16(step1[29], kZero);
423 __m128i s3_30_0 = _mm_cmplt_epi16(step1[30], kZero);
424 __m128i s3_31_0 = _mm_cmplt_epi16(step1[31], kZero);
425
426 step2[ 0] = _mm_sub_epi16(step2[ 0], s3_00_0);
427 step2[ 1] = _mm_sub_epi16(step2[ 1], s3_01_0);
428 step2[ 2] = _mm_sub_epi16(step2[ 2], s3_02_0);
429 step2[ 3] = _mm_sub_epi16(step2[ 3], s3_03_0);
430 step2[ 4] = _mm_sub_epi16(step2[ 4], s3_04_0);
431 step2[ 5] = _mm_sub_epi16(step2[ 5], s3_05_0);
432 step2[ 6] = _mm_sub_epi16(step2[ 6], s3_06_0);
433 step2[ 7] = _mm_sub_epi16(step2[ 7], s3_07_0);
434 step2[ 8] = _mm_sub_epi16(step2[ 8], s2_08_0);
435 step2[ 9] = _mm_sub_epi16(step2[ 9], s2_09_0);
436 step2[10] = _mm_sub_epi16(step2[10], s3_10_0);
437 step2[11] = _mm_sub_epi16(step2[11], s3_11_0);
438 step2[12] = _mm_sub_epi16(step2[12], s3_12_0);
439 step2[13] = _mm_sub_epi16(step2[13], s3_13_0);
440 step2[14] = _mm_sub_epi16(step2[14], s2_14_0);
441 step2[15] = _mm_sub_epi16(step2[15], s2_15_0);
442 step1[16] = _mm_sub_epi16(step1[16], s3_16_0);
443 step1[17] = _mm_sub_epi16(step1[17], s3_17_0);
444 step1[18] = _mm_sub_epi16(step1[18], s3_18_0);
445 step1[19] = _mm_sub_epi16(step1[19], s3_19_0);
446 step2[20] = _mm_sub_epi16(step2[20], s3_20_0);
447 step2[21] = _mm_sub_epi16(step2[21], s3_21_0);
448 step2[22] = _mm_sub_epi16(step2[22], s3_22_0);
449 step2[23] = _mm_sub_epi16(step2[23], s3_23_0);
450 step2[24] = _mm_sub_epi16(step2[24], s3_24_0);
451 step2[25] = _mm_sub_epi16(step2[25], s3_25_0);
452 step2[26] = _mm_sub_epi16(step2[26], s3_26_0);
453 step2[27] = _mm_sub_epi16(step2[27], s3_27_0);
454 step1[28] = _mm_sub_epi16(step1[28], s3_28_0);
455 step1[29] = _mm_sub_epi16(step1[29], s3_29_0);
456 step1[30] = _mm_sub_epi16(step1[30], s3_30_0);
457 step1[31] = _mm_sub_epi16(step1[31], s3_31_0);
458
459 step2[ 0] = _mm_add_epi16(step2[ 0], kOne);
460 step2[ 1] = _mm_add_epi16(step2[ 1], kOne);
461 step2[ 2] = _mm_add_epi16(step2[ 2], kOne);
462 step2[ 3] = _mm_add_epi16(step2[ 3], kOne);
463 step2[ 4] = _mm_add_epi16(step2[ 4], kOne);
464 step2[ 5] = _mm_add_epi16(step2[ 5], kOne);
465 step2[ 6] = _mm_add_epi16(step2[ 6], kOne);
466 step2[ 7] = _mm_add_epi16(step2[ 7], kOne);
467 step2[ 8] = _mm_add_epi16(step2[ 8], kOne);
468 step2[ 9] = _mm_add_epi16(step2[ 9], kOne);
469 step2[10] = _mm_add_epi16(step2[10], kOne);
470 step2[11] = _mm_add_epi16(step2[11], kOne);
471 step2[12] = _mm_add_epi16(step2[12], kOne);
472 step2[13] = _mm_add_epi16(step2[13], kOne);
473 step2[14] = _mm_add_epi16(step2[14], kOne);
474 step2[15] = _mm_add_epi16(step2[15], kOne);
475 step1[16] = _mm_add_epi16(step1[16], kOne);
476 step1[17] = _mm_add_epi16(step1[17], kOne);
477 step1[18] = _mm_add_epi16(step1[18], kOne);
478 step1[19] = _mm_add_epi16(step1[19], kOne);
479 step2[20] = _mm_add_epi16(step2[20], kOne);
480 step2[21] = _mm_add_epi16(step2[21], kOne);
481 step2[22] = _mm_add_epi16(step2[22], kOne);
482 step2[23] = _mm_add_epi16(step2[23], kOne);
483 step2[24] = _mm_add_epi16(step2[24], kOne);
484 step2[25] = _mm_add_epi16(step2[25], kOne);
485 step2[26] = _mm_add_epi16(step2[26], kOne);
486 step2[27] = _mm_add_epi16(step2[27], kOne);
487 step1[28] = _mm_add_epi16(step1[28], kOne);
488 step1[29] = _mm_add_epi16(step1[29], kOne);
489 step1[30] = _mm_add_epi16(step1[30], kOne);
490 step1[31] = _mm_add_epi16(step1[31], kOne);
491
492 step2[ 0] = _mm_srai_epi16(step2[ 0], 2);
493 step2[ 1] = _mm_srai_epi16(step2[ 1], 2);
494 step2[ 2] = _mm_srai_epi16(step2[ 2], 2);
495 step2[ 3] = _mm_srai_epi16(step2[ 3], 2);
496 step2[ 4] = _mm_srai_epi16(step2[ 4], 2);
497 step2[ 5] = _mm_srai_epi16(step2[ 5], 2);
498 step2[ 6] = _mm_srai_epi16(step2[ 6], 2);
499 step2[ 7] = _mm_srai_epi16(step2[ 7], 2);
500 step2[ 8] = _mm_srai_epi16(step2[ 8], 2);
501 step2[ 9] = _mm_srai_epi16(step2[ 9], 2);
502 step2[10] = _mm_srai_epi16(step2[10], 2);
503 step2[11] = _mm_srai_epi16(step2[11], 2);
504 step2[12] = _mm_srai_epi16(step2[12], 2);
505 step2[13] = _mm_srai_epi16(step2[13], 2);
506 step2[14] = _mm_srai_epi16(step2[14], 2);
507 step2[15] = _mm_srai_epi16(step2[15], 2);
508 step1[16] = _mm_srai_epi16(step1[16], 2);
509 step1[17] = _mm_srai_epi16(step1[17], 2);
510 step1[18] = _mm_srai_epi16(step1[18], 2);
511 step1[19] = _mm_srai_epi16(step1[19], 2);
512 step2[20] = _mm_srai_epi16(step2[20], 2);
513 step2[21] = _mm_srai_epi16(step2[21], 2);
514 step2[22] = _mm_srai_epi16(step2[22], 2);
515 step2[23] = _mm_srai_epi16(step2[23], 2);
516 step2[24] = _mm_srai_epi16(step2[24], 2);
517 step2[25] = _mm_srai_epi16(step2[25], 2);
518 step2[26] = _mm_srai_epi16(step2[26], 2);
519 step2[27] = _mm_srai_epi16(step2[27], 2);
520 step1[28] = _mm_srai_epi16(step1[28], 2);
521 step1[29] = _mm_srai_epi16(step1[29], 2);
522 step1[30] = _mm_srai_epi16(step1[30], 2);
523 step1[31] = _mm_srai_epi16(step1[31], 2);
524 }
525 #endif
526
527 #if FDCT32x32_HIGH_PRECISION
528 if (pass == 0) {
529 #endif
530 // Stage 3
531 {
532 step3[0] = _mm_add_epi16(step2[(8 - 1)], step2[0]);
533 step3[1] = _mm_add_epi16(step2[(8 - 2)], step2[1]);
534 step3[2] = _mm_add_epi16(step2[(8 - 3)], step2[2]);
535 step3[3] = _mm_add_epi16(step2[(8 - 4)], step2[3]);
536 step3[4] = _mm_sub_epi16(step2[(8 - 5)], step2[4]);
537 step3[5] = _mm_sub_epi16(step2[(8 - 6)], step2[5]);
538 step3[6] = _mm_sub_epi16(step2[(8 - 7)], step2[6]);
539 step3[7] = _mm_sub_epi16(step2[(8 - 8)], step2[7]);
540 }
541 {
542 const __m128i s3_10_0 = _mm_unpacklo_epi16(step2[13], step2[10]);
543 const __m128i s3_10_1 = _mm_unpackhi_epi16(step2[13], step2[10]);
544 const __m128i s3_11_0 = _mm_unpacklo_epi16(step2[12], step2[11]);
545 const __m128i s3_11_1 = _mm_unpackhi_epi16(step2[12], step2[11]);
546 const __m128i s3_10_2 = _mm_madd_epi16(s3_10_0, k__cospi_p16_m16);
547 const __m128i s3_10_3 = _mm_madd_epi16(s3_10_1, k__cospi_p16_m16);
548 const __m128i s3_11_2 = _mm_madd_epi16(s3_11_0, k__cospi_p16_m16);
549 const __m128i s3_11_3 = _mm_madd_epi16(s3_11_1, k__cospi_p16_m16);
550 const __m128i s3_12_2 = _mm_madd_epi16(s3_11_0, k__cospi_p16_p16);
551 const __m128i s3_12_3 = _mm_madd_epi16(s3_11_1, k__cospi_p16_p16);
552 const __m128i s3_13_2 = _mm_madd_epi16(s3_10_0, k__cospi_p16_p16);
553 const __m128i s3_13_3 = _mm_madd_epi16(s3_10_1, k__cospi_p16_p16);
554 // dct_const_round_shift
555 const __m128i s3_10_4 = _mm_add_epi32(s3_10_2, k__DCT_CONST_ROUNDING);
556 const __m128i s3_10_5 = _mm_add_epi32(s3_10_3, k__DCT_CONST_ROUNDING);
557 const __m128i s3_11_4 = _mm_add_epi32(s3_11_2, k__DCT_CONST_ROUNDING);
558 const __m128i s3_11_5 = _mm_add_epi32(s3_11_3, k__DCT_CONST_ROUNDING);
559 const __m128i s3_12_4 = _mm_add_epi32(s3_12_2, k__DCT_CONST_ROUNDING);
560 const __m128i s3_12_5 = _mm_add_epi32(s3_12_3, k__DCT_CONST_ROUNDING);
561 const __m128i s3_13_4 = _mm_add_epi32(s3_13_2, k__DCT_CONST_ROUNDING);
562 const __m128i s3_13_5 = _mm_add_epi32(s3_13_3, k__DCT_CONST_ROUNDING);
563 const __m128i s3_10_6 = _mm_srai_epi32(s3_10_4, DCT_CONST_BITS);
564 const __m128i s3_10_7 = _mm_srai_epi32(s3_10_5, DCT_CONST_BITS);
565 const __m128i s3_11_6 = _mm_srai_epi32(s3_11_4, DCT_CONST_BITS);
566 const __m128i s3_11_7 = _mm_srai_epi32(s3_11_5, DCT_CONST_BITS);
567 const __m128i s3_12_6 = _mm_srai_epi32(s3_12_4, DCT_CONST_BITS);
568 const __m128i s3_12_7 = _mm_srai_epi32(s3_12_5, DCT_CONST_BITS);
569 const __m128i s3_13_6 = _mm_srai_epi32(s3_13_4, DCT_CONST_BITS);
570 const __m128i s3_13_7 = _mm_srai_epi32(s3_13_5, DCT_CONST_BITS);
571 // Combine
572 step3[10] = _mm_packs_epi32(s3_10_6, s3_10_7);
573 step3[11] = _mm_packs_epi32(s3_11_6, s3_11_7);
574 step3[12] = _mm_packs_epi32(s3_12_6, s3_12_7);
575 step3[13] = _mm_packs_epi32(s3_13_6, s3_13_7);
576 }
577 {
578 step3[16] = _mm_add_epi16(step2[23], step1[16]);
579 step3[17] = _mm_add_epi16(step2[22], step1[17]);
580 step3[18] = _mm_add_epi16(step2[21], step1[18]);
581 step3[19] = _mm_add_epi16(step2[20], step1[19]);
582 step3[20] = _mm_sub_epi16(step1[19], step2[20]);
583 step3[21] = _mm_sub_epi16(step1[18], step2[21]);
584 step3[22] = _mm_sub_epi16(step1[17], step2[22]);
585 step3[23] = _mm_sub_epi16(step1[16], step2[23]);
586 step3[24] = _mm_sub_epi16(step1[31], step2[24]);
587 step3[25] = _mm_sub_epi16(step1[30], step2[25]);
588 step3[26] = _mm_sub_epi16(step1[29], step2[26]);
589 step3[27] = _mm_sub_epi16(step1[28], step2[27]);
590 step3[28] = _mm_add_epi16(step2[27], step1[28]);
591 step3[29] = _mm_add_epi16(step2[26], step1[29]);
592 step3[30] = _mm_add_epi16(step2[25], step1[30]);
593 step3[31] = _mm_add_epi16(step2[24], step1[31]);
594 }
595
596 // Stage 4
597 {
598 step1[ 0] = _mm_add_epi16(step3[ 3], step3[ 0]);
599 step1[ 1] = _mm_add_epi16(step3[ 2], step3[ 1]);
600 step1[ 2] = _mm_sub_epi16(step3[ 1], step3[ 2]);
601 step1[ 3] = _mm_sub_epi16(step3[ 0], step3[ 3]);
602 step1[ 8] = _mm_add_epi16(step3[11], step2[ 8]);
603 step1[ 9] = _mm_add_epi16(step3[10], step2[ 9]);
604 step1[10] = _mm_sub_epi16(step2[ 9], step3[10]);
605 step1[11] = _mm_sub_epi16(step2[ 8], step3[11]);
606 step1[12] = _mm_sub_epi16(step2[15], step3[12]);
607 step1[13] = _mm_sub_epi16(step2[14], step3[13]);
608 step1[14] = _mm_add_epi16(step3[13], step2[14]);
609 step1[15] = _mm_add_epi16(step3[12], step2[15]);
610 }
611 {
612 const __m128i s1_05_0 = _mm_unpacklo_epi16(step3[6], step3[5]);
613 const __m128i s1_05_1 = _mm_unpackhi_epi16(step3[6], step3[5]);
614 const __m128i s1_05_2 = _mm_madd_epi16(s1_05_0, k__cospi_p16_m16);
615 const __m128i s1_05_3 = _mm_madd_epi16(s1_05_1, k__cospi_p16_m16);
616 const __m128i s1_06_2 = _mm_madd_epi16(s1_05_0, k__cospi_p16_p16);
617 const __m128i s1_06_3 = _mm_madd_epi16(s1_05_1, k__cospi_p16_p16);
618 // dct_const_round_shift
619 const __m128i s1_05_4 = _mm_add_epi32(s1_05_2, k__DCT_CONST_ROUNDING);
620 const __m128i s1_05_5 = _mm_add_epi32(s1_05_3, k__DCT_CONST_ROUNDING);
621 const __m128i s1_06_4 = _mm_add_epi32(s1_06_2, k__DCT_CONST_ROUNDING);
622 const __m128i s1_06_5 = _mm_add_epi32(s1_06_3, k__DCT_CONST_ROUNDING);
623 const __m128i s1_05_6 = _mm_srai_epi32(s1_05_4, DCT_CONST_BITS);
624 const __m128i s1_05_7 = _mm_srai_epi32(s1_05_5, DCT_CONST_BITS);
625 const __m128i s1_06_6 = _mm_srai_epi32(s1_06_4, DCT_CONST_BITS);
626 const __m128i s1_06_7 = _mm_srai_epi32(s1_06_5, DCT_CONST_BITS);
627 // Combine
628 step1[5] = _mm_packs_epi32(s1_05_6, s1_05_7);
629 step1[6] = _mm_packs_epi32(s1_06_6, s1_06_7);
630 }
631 {
632 const __m128i s1_18_0 = _mm_unpacklo_epi16(step3[18], step3[29]);
633 const __m128i s1_18_1 = _mm_unpackhi_epi16(step3[18], step3[29]);
634 const __m128i s1_19_0 = _mm_unpacklo_epi16(step3[19], step3[28]);
635 const __m128i s1_19_1 = _mm_unpackhi_epi16(step3[19], step3[28]);
636 const __m128i s1_20_0 = _mm_unpacklo_epi16(step3[20], step3[27]);
637 const __m128i s1_20_1 = _mm_unpackhi_epi16(step3[20], step3[27]);
638 const __m128i s1_21_0 = _mm_unpacklo_epi16(step3[21], step3[26]);
639 const __m128i s1_21_1 = _mm_unpackhi_epi16(step3[21], step3[26]);
640 const __m128i s1_18_2 = _mm_madd_epi16(s1_18_0, k__cospi_m08_p24);
641 const __m128i s1_18_3 = _mm_madd_epi16(s1_18_1, k__cospi_m08_p24);
642 const __m128i s1_19_2 = _mm_madd_epi16(s1_19_0, k__cospi_m08_p24);
643 const __m128i s1_19_3 = _mm_madd_epi16(s1_19_1, k__cospi_m08_p24);
644 const __m128i s1_20_2 = _mm_madd_epi16(s1_20_0, k__cospi_m24_m08);
645 const __m128i s1_20_3 = _mm_madd_epi16(s1_20_1, k__cospi_m24_m08);
646 const __m128i s1_21_2 = _mm_madd_epi16(s1_21_0, k__cospi_m24_m08);
647 const __m128i s1_21_3 = _mm_madd_epi16(s1_21_1, k__cospi_m24_m08);
648 const __m128i s1_26_2 = _mm_madd_epi16(s1_21_0, k__cospi_m08_p24);
649 const __m128i s1_26_3 = _mm_madd_epi16(s1_21_1, k__cospi_m08_p24);
650 const __m128i s1_27_2 = _mm_madd_epi16(s1_20_0, k__cospi_m08_p24);
651 const __m128i s1_27_3 = _mm_madd_epi16(s1_20_1, k__cospi_m08_p24);
652 const __m128i s1_28_2 = _mm_madd_epi16(s1_19_0, k__cospi_p24_p08);
653 const __m128i s1_28_3 = _mm_madd_epi16(s1_19_1, k__cospi_p24_p08);
654 const __m128i s1_29_2 = _mm_madd_epi16(s1_18_0, k__cospi_p24_p08);
655 const __m128i s1_29_3 = _mm_madd_epi16(s1_18_1, k__cospi_p24_p08);
656 // dct_const_round_shift
657 const __m128i s1_18_4 = _mm_add_epi32(s1_18_2, k__DCT_CONST_ROUNDING);
658 const __m128i s1_18_5 = _mm_add_epi32(s1_18_3, k__DCT_CONST_ROUNDING);
659 const __m128i s1_19_4 = _mm_add_epi32(s1_19_2, k__DCT_CONST_ROUNDING);
660 const __m128i s1_19_5 = _mm_add_epi32(s1_19_3, k__DCT_CONST_ROUNDING);
661 const __m128i s1_20_4 = _mm_add_epi32(s1_20_2, k__DCT_CONST_ROUNDING);
662 const __m128i s1_20_5 = _mm_add_epi32(s1_20_3, k__DCT_CONST_ROUNDING);
663 const __m128i s1_21_4 = _mm_add_epi32(s1_21_2, k__DCT_CONST_ROUNDING);
664 const __m128i s1_21_5 = _mm_add_epi32(s1_21_3, k__DCT_CONST_ROUNDING);
665 const __m128i s1_26_4 = _mm_add_epi32(s1_26_2, k__DCT_CONST_ROUNDING);
666 const __m128i s1_26_5 = _mm_add_epi32(s1_26_3, k__DCT_CONST_ROUNDING);
667 const __m128i s1_27_4 = _mm_add_epi32(s1_27_2, k__DCT_CONST_ROUNDING);
668 const __m128i s1_27_5 = _mm_add_epi32(s1_27_3, k__DCT_CONST_ROUNDING);
669 const __m128i s1_28_4 = _mm_add_epi32(s1_28_2, k__DCT_CONST_ROUNDING);
670 const __m128i s1_28_5 = _mm_add_epi32(s1_28_3, k__DCT_CONST_ROUNDING);
671 const __m128i s1_29_4 = _mm_add_epi32(s1_29_2, k__DCT_CONST_ROUNDING);
672 const __m128i s1_29_5 = _mm_add_epi32(s1_29_3, k__DCT_CONST_ROUNDING);
673 const __m128i s1_18_6 = _mm_srai_epi32(s1_18_4, DCT_CONST_BITS);
674 const __m128i s1_18_7 = _mm_srai_epi32(s1_18_5, DCT_CONST_BITS);
675 const __m128i s1_19_6 = _mm_srai_epi32(s1_19_4, DCT_CONST_BITS);
676 const __m128i s1_19_7 = _mm_srai_epi32(s1_19_5, DCT_CONST_BITS);
677 const __m128i s1_20_6 = _mm_srai_epi32(s1_20_4, DCT_CONST_BITS);
678 const __m128i s1_20_7 = _mm_srai_epi32(s1_20_5, DCT_CONST_BITS);
679 const __m128i s1_21_6 = _mm_srai_epi32(s1_21_4, DCT_CONST_BITS);
680 const __m128i s1_21_7 = _mm_srai_epi32(s1_21_5, DCT_CONST_BITS);
681 const __m128i s1_26_6 = _mm_srai_epi32(s1_26_4, DCT_CONST_BITS);
682 const __m128i s1_26_7 = _mm_srai_epi32(s1_26_5, DCT_CONST_BITS);
683 const __m128i s1_27_6 = _mm_srai_epi32(s1_27_4, DCT_CONST_BITS);
684 const __m128i s1_27_7 = _mm_srai_epi32(s1_27_5, DCT_CONST_BITS);
685 const __m128i s1_28_6 = _mm_srai_epi32(s1_28_4, DCT_CONST_BITS);
686 const __m128i s1_28_7 = _mm_srai_epi32(s1_28_5, DCT_CONST_BITS);
687 const __m128i s1_29_6 = _mm_srai_epi32(s1_29_4, DCT_CONST_BITS);
688 const __m128i s1_29_7 = _mm_srai_epi32(s1_29_5, DCT_CONST_BITS);
689 // Combine
690 step1[18] = _mm_packs_epi32(s1_18_6, s1_18_7);
691 step1[19] = _mm_packs_epi32(s1_19_6, s1_19_7);
692 step1[20] = _mm_packs_epi32(s1_20_6, s1_20_7);
693 step1[21] = _mm_packs_epi32(s1_21_6, s1_21_7);
694 step1[26] = _mm_packs_epi32(s1_26_6, s1_26_7);
695 step1[27] = _mm_packs_epi32(s1_27_6, s1_27_7);
696 step1[28] = _mm_packs_epi32(s1_28_6, s1_28_7);
697 step1[29] = _mm_packs_epi32(s1_29_6, s1_29_7);
698 }
699 // Stage 5
700 {
701 step2[4] = _mm_add_epi16(step1[5], step3[4]);
702 step2[5] = _mm_sub_epi16(step3[4], step1[5]);
703 step2[6] = _mm_sub_epi16(step3[7], step1[6]);
704 step2[7] = _mm_add_epi16(step1[6], step3[7]);
705 }
706 {
707 const __m128i out_00_0 = _mm_unpacklo_epi16(step1[0], step1[1]);
708 const __m128i out_00_1 = _mm_unpackhi_epi16(step1[0], step1[1]);
709 const __m128i out_08_0 = _mm_unpacklo_epi16(step1[2], step1[3]);
710 const __m128i out_08_1 = _mm_unpackhi_epi16(step1[2], step1[3]);
711 const __m128i out_00_2 = _mm_madd_epi16(out_00_0, k__cospi_p16_p16);
712 const __m128i out_00_3 = _mm_madd_epi16(out_00_1, k__cospi_p16_p16);
713 const __m128i out_16_2 = _mm_madd_epi16(out_00_0, k__cospi_p16_m16);
714 const __m128i out_16_3 = _mm_madd_epi16(out_00_1, k__cospi_p16_m16);
715 const __m128i out_08_2 = _mm_madd_epi16(out_08_0, k__cospi_p24_p08);
716 const __m128i out_08_3 = _mm_madd_epi16(out_08_1, k__cospi_p24_p08);
717 const __m128i out_24_2 = _mm_madd_epi16(out_08_0, k__cospi_m08_p24);
718 const __m128i out_24_3 = _mm_madd_epi16(out_08_1, k__cospi_m08_p24);
719 // dct_const_round_shift
720 const __m128i out_00_4 = _mm_add_epi32(out_00_2, k__DCT_CONST_ROUNDING);
721 const __m128i out_00_5 = _mm_add_epi32(out_00_3, k__DCT_CONST_ROUNDING);
722 const __m128i out_16_4 = _mm_add_epi32(out_16_2, k__DCT_CONST_ROUNDING);
723 const __m128i out_16_5 = _mm_add_epi32(out_16_3, k__DCT_CONST_ROUNDING);
724 const __m128i out_08_4 = _mm_add_epi32(out_08_2, k__DCT_CONST_ROUNDING);
725 const __m128i out_08_5 = _mm_add_epi32(out_08_3, k__DCT_CONST_ROUNDING);
726 const __m128i out_24_4 = _mm_add_epi32(out_24_2, k__DCT_CONST_ROUNDING);
727 const __m128i out_24_5 = _mm_add_epi32(out_24_3, k__DCT_CONST_ROUNDING);
728 const __m128i out_00_6 = _mm_srai_epi32(out_00_4, DCT_CONST_BITS);
729 const __m128i out_00_7 = _mm_srai_epi32(out_00_5, DCT_CONST_BITS);
730 const __m128i out_16_6 = _mm_srai_epi32(out_16_4, DCT_CONST_BITS);
731 const __m128i out_16_7 = _mm_srai_epi32(out_16_5, DCT_CONST_BITS);
732 const __m128i out_08_6 = _mm_srai_epi32(out_08_4, DCT_CONST_BITS);
733 const __m128i out_08_7 = _mm_srai_epi32(out_08_5, DCT_CONST_BITS);
734 const __m128i out_24_6 = _mm_srai_epi32(out_24_4, DCT_CONST_BITS);
735 const __m128i out_24_7 = _mm_srai_epi32(out_24_5, DCT_CONST_BITS);
736 // Combine
737 out[ 0] = _mm_packs_epi32(out_00_6, out_00_7);
738 out[16] = _mm_packs_epi32(out_16_6, out_16_7);
739 out[ 8] = _mm_packs_epi32(out_08_6, out_08_7);
740 out[24] = _mm_packs_epi32(out_24_6, out_24_7);
741 }
742 {
743 const __m128i s2_09_0 = _mm_unpacklo_epi16(step1[ 9], step1[14]);
744 const __m128i s2_09_1 = _mm_unpackhi_epi16(step1[ 9], step1[14]);
745 const __m128i s2_10_0 = _mm_unpacklo_epi16(step1[10], step1[13]);
746 const __m128i s2_10_1 = _mm_unpackhi_epi16(step1[10], step1[13]);
747 const __m128i s2_09_2 = _mm_madd_epi16(s2_09_0, k__cospi_m08_p24);
748 const __m128i s2_09_3 = _mm_madd_epi16(s2_09_1, k__cospi_m08_p24);
749 const __m128i s2_10_2 = _mm_madd_epi16(s2_10_0, k__cospi_m24_m08);
750 const __m128i s2_10_3 = _mm_madd_epi16(s2_10_1, k__cospi_m24_m08);
751 const __m128i s2_13_2 = _mm_madd_epi16(s2_10_0, k__cospi_m08_p24);
752 const __m128i s2_13_3 = _mm_madd_epi16(s2_10_1, k__cospi_m08_p24);
753 const __m128i s2_14_2 = _mm_madd_epi16(s2_09_0, k__cospi_p24_p08);
754 const __m128i s2_14_3 = _mm_madd_epi16(s2_09_1, k__cospi_p24_p08);
755 // dct_const_round_shift
756 const __m128i s2_09_4 = _mm_add_epi32(s2_09_2, k__DCT_CONST_ROUNDING);
757 const __m128i s2_09_5 = _mm_add_epi32(s2_09_3, k__DCT_CONST_ROUNDING);
758 const __m128i s2_10_4 = _mm_add_epi32(s2_10_2, k__DCT_CONST_ROUNDING);
759 const __m128i s2_10_5 = _mm_add_epi32(s2_10_3, k__DCT_CONST_ROUNDING);
760 const __m128i s2_13_4 = _mm_add_epi32(s2_13_2, k__DCT_CONST_ROUNDING);
761 const __m128i s2_13_5 = _mm_add_epi32(s2_13_3, k__DCT_CONST_ROUNDING);
762 const __m128i s2_14_4 = _mm_add_epi32(s2_14_2, k__DCT_CONST_ROUNDING);
763 const __m128i s2_14_5 = _mm_add_epi32(s2_14_3, k__DCT_CONST_ROUNDING);
764 const __m128i s2_09_6 = _mm_srai_epi32(s2_09_4, DCT_CONST_BITS);
765 const __m128i s2_09_7 = _mm_srai_epi32(s2_09_5, DCT_CONST_BITS);
766 const __m128i s2_10_6 = _mm_srai_epi32(s2_10_4, DCT_CONST_BITS);
767 const __m128i s2_10_7 = _mm_srai_epi32(s2_10_5, DCT_CONST_BITS);
768 const __m128i s2_13_6 = _mm_srai_epi32(s2_13_4, DCT_CONST_BITS);
769 const __m128i s2_13_7 = _mm_srai_epi32(s2_13_5, DCT_CONST_BITS);
770 const __m128i s2_14_6 = _mm_srai_epi32(s2_14_4, DCT_CONST_BITS);
771 const __m128i s2_14_7 = _mm_srai_epi32(s2_14_5, DCT_CONST_BITS);
772 // Combine
773 step2[ 9] = _mm_packs_epi32(s2_09_6, s2_09_7);
774 step2[10] = _mm_packs_epi32(s2_10_6, s2_10_7);
775 step2[13] = _mm_packs_epi32(s2_13_6, s2_13_7);
776 step2[14] = _mm_packs_epi32(s2_14_6, s2_14_7);
777 }
778 {
779 step2[16] = _mm_add_epi16(step1[19], step3[16]);
780 step2[17] = _mm_add_epi16(step1[18], step3[17]);
781 step2[18] = _mm_sub_epi16(step3[17], step1[18]);
782 step2[19] = _mm_sub_epi16(step3[16], step1[19]);
783 step2[20] = _mm_sub_epi16(step3[23], step1[20]);
784 step2[21] = _mm_sub_epi16(step3[22], step1[21]);
785 step2[22] = _mm_add_epi16(step1[21], step3[22]);
786 step2[23] = _mm_add_epi16(step1[20], step3[23]);
787 step2[24] = _mm_add_epi16(step1[27], step3[24]);
788 step2[25] = _mm_add_epi16(step1[26], step3[25]);
789 step2[26] = _mm_sub_epi16(step3[25], step1[26]);
790 step2[27] = _mm_sub_epi16(step3[24], step1[27]);
791 step2[28] = _mm_sub_epi16(step3[31], step1[28]);
792 step2[29] = _mm_sub_epi16(step3[30], step1[29]);
793 step2[30] = _mm_add_epi16(step1[29], step3[30]);
794 step2[31] = _mm_add_epi16(step1[28], step3[31]);
795 }
796 // Stage 6
797 {
798 const __m128i out_04_0 = _mm_unpacklo_epi16(step2[4], step2[7]);
799 const __m128i out_04_1 = _mm_unpackhi_epi16(step2[4], step2[7]);
800 const __m128i out_20_0 = _mm_unpacklo_epi16(step2[5], step2[6]);
801 const __m128i out_20_1 = _mm_unpackhi_epi16(step2[5], step2[6]);
802 const __m128i out_12_0 = _mm_unpacklo_epi16(step2[5], step2[6]);
803 const __m128i out_12_1 = _mm_unpackhi_epi16(step2[5], step2[6]);
804 const __m128i out_28_0 = _mm_unpacklo_epi16(step2[4], step2[7]);
805 const __m128i out_28_1 = _mm_unpackhi_epi16(step2[4], step2[7]);
806 const __m128i out_04_2 = _mm_madd_epi16(out_04_0, k__cospi_p28_p04);
807 const __m128i out_04_3 = _mm_madd_epi16(out_04_1, k__cospi_p28_p04);
808 const __m128i out_20_2 = _mm_madd_epi16(out_20_0, k__cospi_p12_p20);
809 const __m128i out_20_3 = _mm_madd_epi16(out_20_1, k__cospi_p12_p20);
810 const __m128i out_12_2 = _mm_madd_epi16(out_12_0, k__cospi_m20_p12);
811 const __m128i out_12_3 = _mm_madd_epi16(out_12_1, k__cospi_m20_p12);
812 const __m128i out_28_2 = _mm_madd_epi16(out_28_0, k__cospi_m04_p28);
813 const __m128i out_28_3 = _mm_madd_epi16(out_28_1, k__cospi_m04_p28);
814 // dct_const_round_shift
815 const __m128i out_04_4 = _mm_add_epi32(out_04_2, k__DCT_CONST_ROUNDING);
816 const __m128i out_04_5 = _mm_add_epi32(out_04_3, k__DCT_CONST_ROUNDING);
817 const __m128i out_20_4 = _mm_add_epi32(out_20_2, k__DCT_CONST_ROUNDING);
818 const __m128i out_20_5 = _mm_add_epi32(out_20_3, k__DCT_CONST_ROUNDING);
819 const __m128i out_12_4 = _mm_add_epi32(out_12_2, k__DCT_CONST_ROUNDING);
820 const __m128i out_12_5 = _mm_add_epi32(out_12_3, k__DCT_CONST_ROUNDING);
821 const __m128i out_28_4 = _mm_add_epi32(out_28_2, k__DCT_CONST_ROUNDING);
822 const __m128i out_28_5 = _mm_add_epi32(out_28_3, k__DCT_CONST_ROUNDING);
823 const __m128i out_04_6 = _mm_srai_epi32(out_04_4, DCT_CONST_BITS);
824 const __m128i out_04_7 = _mm_srai_epi32(out_04_5, DCT_CONST_BITS);
825 const __m128i out_20_6 = _mm_srai_epi32(out_20_4, DCT_CONST_BITS);
826 const __m128i out_20_7 = _mm_srai_epi32(out_20_5, DCT_CONST_BITS);
827 const __m128i out_12_6 = _mm_srai_epi32(out_12_4, DCT_CONST_BITS);
828 const __m128i out_12_7 = _mm_srai_epi32(out_12_5, DCT_CONST_BITS);
829 const __m128i out_28_6 = _mm_srai_epi32(out_28_4, DCT_CONST_BITS);
830 const __m128i out_28_7 = _mm_srai_epi32(out_28_5, DCT_CONST_BITS);
831 // Combine
832 out[ 4] = _mm_packs_epi32(out_04_6, out_04_7);
833 out[20] = _mm_packs_epi32(out_20_6, out_20_7);
834 out[12] = _mm_packs_epi32(out_12_6, out_12_7);
835 out[28] = _mm_packs_epi32(out_28_6, out_28_7);
836 }
837 {
838 step3[ 8] = _mm_add_epi16(step2[ 9], step1[ 8]);
839 step3[ 9] = _mm_sub_epi16(step1[ 8], step2[ 9]);
840 step3[10] = _mm_sub_epi16(step1[11], step2[10]);
841 step3[11] = _mm_add_epi16(step2[10], step1[11]);
842 step3[12] = _mm_add_epi16(step2[13], step1[12]);
843 step3[13] = _mm_sub_epi16(step1[12], step2[13]);
844 step3[14] = _mm_sub_epi16(step1[15], step2[14]);
845 step3[15] = _mm_add_epi16(step2[14], step1[15]);
846 }
847 {
848 const __m128i s3_17_0 = _mm_unpacklo_epi16(step2[17], step2[30]);
849 const __m128i s3_17_1 = _mm_unpackhi_epi16(step2[17], step2[30]);
850 const __m128i s3_18_0 = _mm_unpacklo_epi16(step2[18], step2[29]);
851 const __m128i s3_18_1 = _mm_unpackhi_epi16(step2[18], step2[29]);
852 const __m128i s3_21_0 = _mm_unpacklo_epi16(step2[21], step2[26]);
853 const __m128i s3_21_1 = _mm_unpackhi_epi16(step2[21], step2[26]);
854 const __m128i s3_22_0 = _mm_unpacklo_epi16(step2[22], step2[25]);
855 const __m128i s3_22_1 = _mm_unpackhi_epi16(step2[22], step2[25]);
856 const __m128i s3_17_2 = _mm_madd_epi16(s3_17_0, k__cospi_m04_p28);
857 const __m128i s3_17_3 = _mm_madd_epi16(s3_17_1, k__cospi_m04_p28);
858 const __m128i s3_18_2 = _mm_madd_epi16(s3_18_0, k__cospi_m28_m04);
859 const __m128i s3_18_3 = _mm_madd_epi16(s3_18_1, k__cospi_m28_m04);
860 const __m128i s3_21_2 = _mm_madd_epi16(s3_21_0, k__cospi_m20_p12);
861 const __m128i s3_21_3 = _mm_madd_epi16(s3_21_1, k__cospi_m20_p12);
862 const __m128i s3_22_2 = _mm_madd_epi16(s3_22_0, k__cospi_m12_m20);
863 const __m128i s3_22_3 = _mm_madd_epi16(s3_22_1, k__cospi_m12_m20);
864 const __m128i s3_25_2 = _mm_madd_epi16(s3_22_0, k__cospi_m20_p12);
865 const __m128i s3_25_3 = _mm_madd_epi16(s3_22_1, k__cospi_m20_p12);
866 const __m128i s3_26_2 = _mm_madd_epi16(s3_21_0, k__cospi_p12_p20);
867 const __m128i s3_26_3 = _mm_madd_epi16(s3_21_1, k__cospi_p12_p20);
868 const __m128i s3_29_2 = _mm_madd_epi16(s3_18_0, k__cospi_m04_p28);
869 const __m128i s3_29_3 = _mm_madd_epi16(s3_18_1, k__cospi_m04_p28);
870 const __m128i s3_30_2 = _mm_madd_epi16(s3_17_0, k__cospi_p28_p04);
871 const __m128i s3_30_3 = _mm_madd_epi16(s3_17_1, k__cospi_p28_p04);
872 // dct_const_round_shift
873 const __m128i s3_17_4 = _mm_add_epi32(s3_17_2, k__DCT_CONST_ROUNDING);
874 const __m128i s3_17_5 = _mm_add_epi32(s3_17_3, k__DCT_CONST_ROUNDING);
875 const __m128i s3_18_4 = _mm_add_epi32(s3_18_2, k__DCT_CONST_ROUNDING);
876 const __m128i s3_18_5 = _mm_add_epi32(s3_18_3, k__DCT_CONST_ROUNDING);
877 const __m128i s3_21_4 = _mm_add_epi32(s3_21_2, k__DCT_CONST_ROUNDING);
878 const __m128i s3_21_5 = _mm_add_epi32(s3_21_3, k__DCT_CONST_ROUNDING);
879 const __m128i s3_22_4 = _mm_add_epi32(s3_22_2, k__DCT_CONST_ROUNDING);
880 const __m128i s3_22_5 = _mm_add_epi32(s3_22_3, k__DCT_CONST_ROUNDING);
881 const __m128i s3_17_6 = _mm_srai_epi32(s3_17_4, DCT_CONST_BITS);
882 const __m128i s3_17_7 = _mm_srai_epi32(s3_17_5, DCT_CONST_BITS);
883 const __m128i s3_18_6 = _mm_srai_epi32(s3_18_4, DCT_CONST_BITS);
884 const __m128i s3_18_7 = _mm_srai_epi32(s3_18_5, DCT_CONST_BITS);
885 const __m128i s3_21_6 = _mm_srai_epi32(s3_21_4, DCT_CONST_BITS);
886 const __m128i s3_21_7 = _mm_srai_epi32(s3_21_5, DCT_CONST_BITS);
887 const __m128i s3_22_6 = _mm_srai_epi32(s3_22_4, DCT_CONST_BITS);
888 const __m128i s3_22_7 = _mm_srai_epi32(s3_22_5, DCT_CONST_BITS);
889 const __m128i s3_25_4 = _mm_add_epi32(s3_25_2, k__DCT_CONST_ROUNDING);
890 const __m128i s3_25_5 = _mm_add_epi32(s3_25_3, k__DCT_CONST_ROUNDING);
891 const __m128i s3_26_4 = _mm_add_epi32(s3_26_2, k__DCT_CONST_ROUNDING);
892 const __m128i s3_26_5 = _mm_add_epi32(s3_26_3, k__DCT_CONST_ROUNDING);
893 const __m128i s3_29_4 = _mm_add_epi32(s3_29_2, k__DCT_CONST_ROUNDING);
894 const __m128i s3_29_5 = _mm_add_epi32(s3_29_3, k__DCT_CONST_ROUNDING);
895 const __m128i s3_30_4 = _mm_add_epi32(s3_30_2, k__DCT_CONST_ROUNDING);
896 const __m128i s3_30_5 = _mm_add_epi32(s3_30_3, k__DCT_CONST_ROUNDING);
897 const __m128i s3_25_6 = _mm_srai_epi32(s3_25_4, DCT_CONST_BITS);
898 const __m128i s3_25_7 = _mm_srai_epi32(s3_25_5, DCT_CONST_BITS);
899 const __m128i s3_26_6 = _mm_srai_epi32(s3_26_4, DCT_CONST_BITS);
900 const __m128i s3_26_7 = _mm_srai_epi32(s3_26_5, DCT_CONST_BITS);
901 const __m128i s3_29_6 = _mm_srai_epi32(s3_29_4, DCT_CONST_BITS);
902 const __m128i s3_29_7 = _mm_srai_epi32(s3_29_5, DCT_CONST_BITS);
903 const __m128i s3_30_6 = _mm_srai_epi32(s3_30_4, DCT_CONST_BITS);
904 const __m128i s3_30_7 = _mm_srai_epi32(s3_30_5, DCT_CONST_BITS);
905 // Combine
906 step3[17] = _mm_packs_epi32(s3_17_6, s3_17_7);
907 step3[18] = _mm_packs_epi32(s3_18_6, s3_18_7);
908 step3[21] = _mm_packs_epi32(s3_21_6, s3_21_7);
909 step3[22] = _mm_packs_epi32(s3_22_6, s3_22_7);
910 // Combine
911 step3[25] = _mm_packs_epi32(s3_25_6, s3_25_7);
912 step3[26] = _mm_packs_epi32(s3_26_6, s3_26_7);
913 step3[29] = _mm_packs_epi32(s3_29_6, s3_29_7);
914 step3[30] = _mm_packs_epi32(s3_30_6, s3_30_7);
915 }
916 // Stage 7
917 {
918 const __m128i out_02_0 = _mm_unpacklo_epi16(step3[ 8], step3[15]);
919 const __m128i out_02_1 = _mm_unpackhi_epi16(step3[ 8], step3[15]);
920 const __m128i out_18_0 = _mm_unpacklo_epi16(step3[ 9], step3[14]);
921 const __m128i out_18_1 = _mm_unpackhi_epi16(step3[ 9], step3[14]);
922 const __m128i out_10_0 = _mm_unpacklo_epi16(step3[10], step3[13]);
923 const __m128i out_10_1 = _mm_unpackhi_epi16(step3[10], step3[13]);
924 const __m128i out_26_0 = _mm_unpacklo_epi16(step3[11], step3[12]);
925 const __m128i out_26_1 = _mm_unpackhi_epi16(step3[11], step3[12]);
926 const __m128i out_02_2 = _mm_madd_epi16(out_02_0, k__cospi_p30_p02);
927 const __m128i out_02_3 = _mm_madd_epi16(out_02_1, k__cospi_p30_p02);
928 const __m128i out_18_2 = _mm_madd_epi16(out_18_0, k__cospi_p14_p18);
929 const __m128i out_18_3 = _mm_madd_epi16(out_18_1, k__cospi_p14_p18);
930 const __m128i out_10_2 = _mm_madd_epi16(out_10_0, k__cospi_p22_p10);
931 const __m128i out_10_3 = _mm_madd_epi16(out_10_1, k__cospi_p22_p10);
932 const __m128i out_26_2 = _mm_madd_epi16(out_26_0, k__cospi_p06_p26);
933 const __m128i out_26_3 = _mm_madd_epi16(out_26_1, k__cospi_p06_p26);
934 const __m128i out_06_2 = _mm_madd_epi16(out_26_0, k__cospi_m26_p06);
935 const __m128i out_06_3 = _mm_madd_epi16(out_26_1, k__cospi_m26_p06);
936 const __m128i out_22_2 = _mm_madd_epi16(out_10_0, k__cospi_m10_p22);
937 const __m128i out_22_3 = _mm_madd_epi16(out_10_1, k__cospi_m10_p22);
938 const __m128i out_14_2 = _mm_madd_epi16(out_18_0, k__cospi_m18_p14);
939 const __m128i out_14_3 = _mm_madd_epi16(out_18_1, k__cospi_m18_p14);
940 const __m128i out_30_2 = _mm_madd_epi16(out_02_0, k__cospi_m02_p30);
941 const __m128i out_30_3 = _mm_madd_epi16(out_02_1, k__cospi_m02_p30);
942 // dct_const_round_shift
943 const __m128i out_02_4 = _mm_add_epi32(out_02_2, k__DCT_CONST_ROUNDING);
944 const __m128i out_02_5 = _mm_add_epi32(out_02_3, k__DCT_CONST_ROUNDING);
945 const __m128i out_18_4 = _mm_add_epi32(out_18_2, k__DCT_CONST_ROUNDING);
946 const __m128i out_18_5 = _mm_add_epi32(out_18_3, k__DCT_CONST_ROUNDING);
947 const __m128i out_10_4 = _mm_add_epi32(out_10_2, k__DCT_CONST_ROUNDING);
948 const __m128i out_10_5 = _mm_add_epi32(out_10_3, k__DCT_CONST_ROUNDING);
949 const __m128i out_26_4 = _mm_add_epi32(out_26_2, k__DCT_CONST_ROUNDING);
950 const __m128i out_26_5 = _mm_add_epi32(out_26_3, k__DCT_CONST_ROUNDING);
951 const __m128i out_06_4 = _mm_add_epi32(out_06_2, k__DCT_CONST_ROUNDING);
952 const __m128i out_06_5 = _mm_add_epi32(out_06_3, k__DCT_CONST_ROUNDING);
953 const __m128i out_22_4 = _mm_add_epi32(out_22_2, k__DCT_CONST_ROUNDING);
954 const __m128i out_22_5 = _mm_add_epi32(out_22_3, k__DCT_CONST_ROUNDING);
955 const __m128i out_14_4 = _mm_add_epi32(out_14_2, k__DCT_CONST_ROUNDING);
956 const __m128i out_14_5 = _mm_add_epi32(out_14_3, k__DCT_CONST_ROUNDING);
957 const __m128i out_30_4 = _mm_add_epi32(out_30_2, k__DCT_CONST_ROUNDING);
958 const __m128i out_30_5 = _mm_add_epi32(out_30_3, k__DCT_CONST_ROUNDING);
959 const __m128i out_02_6 = _mm_srai_epi32(out_02_4, DCT_CONST_BITS);
960 const __m128i out_02_7 = _mm_srai_epi32(out_02_5, DCT_CONST_BITS);
961 const __m128i out_18_6 = _mm_srai_epi32(out_18_4, DCT_CONST_BITS);
962 const __m128i out_18_7 = _mm_srai_epi32(out_18_5, DCT_CONST_BITS);
963 const __m128i out_10_6 = _mm_srai_epi32(out_10_4, DCT_CONST_BITS);
964 const __m128i out_10_7 = _mm_srai_epi32(out_10_5, DCT_CONST_BITS);
965 const __m128i out_26_6 = _mm_srai_epi32(out_26_4, DCT_CONST_BITS);
966 const __m128i out_26_7 = _mm_srai_epi32(out_26_5, DCT_CONST_BITS);
967 const __m128i out_06_6 = _mm_srai_epi32(out_06_4, DCT_CONST_BITS);
968 const __m128i out_06_7 = _mm_srai_epi32(out_06_5, DCT_CONST_BITS);
969 const __m128i out_22_6 = _mm_srai_epi32(out_22_4, DCT_CONST_BITS);
970 const __m128i out_22_7 = _mm_srai_epi32(out_22_5, DCT_CONST_BITS);
971 const __m128i out_14_6 = _mm_srai_epi32(out_14_4, DCT_CONST_BITS);
972 const __m128i out_14_7 = _mm_srai_epi32(out_14_5, DCT_CONST_BITS);
973 const __m128i out_30_6 = _mm_srai_epi32(out_30_4, DCT_CONST_BITS);
974 const __m128i out_30_7 = _mm_srai_epi32(out_30_5, DCT_CONST_BITS);
975 // Combine
976 out[ 2] = _mm_packs_epi32(out_02_6, out_02_7);
977 out[18] = _mm_packs_epi32(out_18_6, out_18_7);
978 out[10] = _mm_packs_epi32(out_10_6, out_10_7);
979 out[26] = _mm_packs_epi32(out_26_6, out_26_7);
980 out[ 6] = _mm_packs_epi32(out_06_6, out_06_7);
981 out[22] = _mm_packs_epi32(out_22_6, out_22_7);
982 out[14] = _mm_packs_epi32(out_14_6, out_14_7);
983 out[30] = _mm_packs_epi32(out_30_6, out_30_7);
984 }
985 {
986 step1[16] = _mm_add_epi16(step3[17], step2[16]);
987 step1[17] = _mm_sub_epi16(step2[16], step3[17]);
988 step1[18] = _mm_sub_epi16(step2[19], step3[18]);
989 step1[19] = _mm_add_epi16(step3[18], step2[19]);
990 step1[20] = _mm_add_epi16(step3[21], step2[20]);
991 step1[21] = _mm_sub_epi16(step2[20], step3[21]);
992 step1[22] = _mm_sub_epi16(step2[23], step3[22]);
993 step1[23] = _mm_add_epi16(step3[22], step2[23]);
994 step1[24] = _mm_add_epi16(step3[25], step2[24]);
995 step1[25] = _mm_sub_epi16(step2[24], step3[25]);
996 step1[26] = _mm_sub_epi16(step2[27], step3[26]);
997 step1[27] = _mm_add_epi16(step3[26], step2[27]);
998 step1[28] = _mm_add_epi16(step3[29], step2[28]);
999 step1[29] = _mm_sub_epi16(step2[28], step3[29]);
1000 step1[30] = _mm_sub_epi16(step2[31], step3[30]);
1001 step1[31] = _mm_add_epi16(step3[30], step2[31]);
1002 }
1003 // Final stage --- outputs indices are bit-reversed.
1004 {
1005 const __m128i out_01_0 = _mm_unpacklo_epi16(step1[16], step1[31]);
1006 const __m128i out_01_1 = _mm_unpackhi_epi16(step1[16], step1[31]);
1007 const __m128i out_17_0 = _mm_unpacklo_epi16(step1[17], step1[30]);
1008 const __m128i out_17_1 = _mm_unpackhi_epi16(step1[17], step1[30]);
1009 const __m128i out_09_0 = _mm_unpacklo_epi16(step1[18], step1[29]);
1010 const __m128i out_09_1 = _mm_unpackhi_epi16(step1[18], step1[29]);
1011 const __m128i out_25_0 = _mm_unpacklo_epi16(step1[19], step1[28]);
1012 const __m128i out_25_1 = _mm_unpackhi_epi16(step1[19], step1[28]);
1013 const __m128i out_01_2 = _mm_madd_epi16(out_01_0, k__cospi_p31_p01);
1014 const __m128i out_01_3 = _mm_madd_epi16(out_01_1, k__cospi_p31_p01);
1015 const __m128i out_17_2 = _mm_madd_epi16(out_17_0, k__cospi_p15_p17);
1016 const __m128i out_17_3 = _mm_madd_epi16(out_17_1, k__cospi_p15_p17);
1017 const __m128i out_09_2 = _mm_madd_epi16(out_09_0, k__cospi_p23_p09);
1018 const __m128i out_09_3 = _mm_madd_epi16(out_09_1, k__cospi_p23_p09);
1019 const __m128i out_25_2 = _mm_madd_epi16(out_25_0, k__cospi_p07_p25);
1020 const __m128i out_25_3 = _mm_madd_epi16(out_25_1, k__cospi_p07_p25);
1021 const __m128i out_07_2 = _mm_madd_epi16(out_25_0, k__cospi_m25_p07);
1022 const __m128i out_07_3 = _mm_madd_epi16(out_25_1, k__cospi_m25_p07);
1023 const __m128i out_23_2 = _mm_madd_epi16(out_09_0, k__cospi_m09_p23);
1024 const __m128i out_23_3 = _mm_madd_epi16(out_09_1, k__cospi_m09_p23);
1025 const __m128i out_15_2 = _mm_madd_epi16(out_17_0, k__cospi_m17_p15);
1026 const __m128i out_15_3 = _mm_madd_epi16(out_17_1, k__cospi_m17_p15);
1027 const __m128i out_31_2 = _mm_madd_epi16(out_01_0, k__cospi_m01_p31);
1028 const __m128i out_31_3 = _mm_madd_epi16(out_01_1, k__cospi_m01_p31);
1029 // dct_const_round_shift
1030 const __m128i out_01_4 = _mm_add_epi32(out_01_2, k__DCT_CONST_ROUNDING);
1031 const __m128i out_01_5 = _mm_add_epi32(out_01_3, k__DCT_CONST_ROUNDING);
1032 const __m128i out_17_4 = _mm_add_epi32(out_17_2, k__DCT_CONST_ROUNDING);
1033 const __m128i out_17_5 = _mm_add_epi32(out_17_3, k__DCT_CONST_ROUNDING);
1034 const __m128i out_09_4 = _mm_add_epi32(out_09_2, k__DCT_CONST_ROUNDING);
1035 const __m128i out_09_5 = _mm_add_epi32(out_09_3, k__DCT_CONST_ROUNDING);
1036 const __m128i out_25_4 = _mm_add_epi32(out_25_2, k__DCT_CONST_ROUNDING);
1037 const __m128i out_25_5 = _mm_add_epi32(out_25_3, k__DCT_CONST_ROUNDING);
1038 const __m128i out_07_4 = _mm_add_epi32(out_07_2, k__DCT_CONST_ROUNDING);
1039 const __m128i out_07_5 = _mm_add_epi32(out_07_3, k__DCT_CONST_ROUNDING);
1040 const __m128i out_23_4 = _mm_add_epi32(out_23_2, k__DCT_CONST_ROUNDING);
1041 const __m128i out_23_5 = _mm_add_epi32(out_23_3, k__DCT_CONST_ROUNDING);
1042 const __m128i out_15_4 = _mm_add_epi32(out_15_2, k__DCT_CONST_ROUNDING);
1043 const __m128i out_15_5 = _mm_add_epi32(out_15_3, k__DCT_CONST_ROUNDING);
1044 const __m128i out_31_4 = _mm_add_epi32(out_31_2, k__DCT_CONST_ROUNDING);
1045 const __m128i out_31_5 = _mm_add_epi32(out_31_3, k__DCT_CONST_ROUNDING);
1046 const __m128i out_01_6 = _mm_srai_epi32(out_01_4, DCT_CONST_BITS);
1047 const __m128i out_01_7 = _mm_srai_epi32(out_01_5, DCT_CONST_BITS);
1048 const __m128i out_17_6 = _mm_srai_epi32(out_17_4, DCT_CONST_BITS);
1049 const __m128i out_17_7 = _mm_srai_epi32(out_17_5, DCT_CONST_BITS);
1050 const __m128i out_09_6 = _mm_srai_epi32(out_09_4, DCT_CONST_BITS);
1051 const __m128i out_09_7 = _mm_srai_epi32(out_09_5, DCT_CONST_BITS);
1052 const __m128i out_25_6 = _mm_srai_epi32(out_25_4, DCT_CONST_BITS);
1053 const __m128i out_25_7 = _mm_srai_epi32(out_25_5, DCT_CONST_BITS);
1054 const __m128i out_07_6 = _mm_srai_epi32(out_07_4, DCT_CONST_BITS);
1055 const __m128i out_07_7 = _mm_srai_epi32(out_07_5, DCT_CONST_BITS);
1056 const __m128i out_23_6 = _mm_srai_epi32(out_23_4, DCT_CONST_BITS);
1057 const __m128i out_23_7 = _mm_srai_epi32(out_23_5, DCT_CONST_BITS);
1058 const __m128i out_15_6 = _mm_srai_epi32(out_15_4, DCT_CONST_BITS);
1059 const __m128i out_15_7 = _mm_srai_epi32(out_15_5, DCT_CONST_BITS);
1060 const __m128i out_31_6 = _mm_srai_epi32(out_31_4, DCT_CONST_BITS);
1061 const __m128i out_31_7 = _mm_srai_epi32(out_31_5, DCT_CONST_BITS);
1062 // Combine
1063 out[ 1] = _mm_packs_epi32(out_01_6, out_01_7);
1064 out[17] = _mm_packs_epi32(out_17_6, out_17_7);
1065 out[ 9] = _mm_packs_epi32(out_09_6, out_09_7);
1066 out[25] = _mm_packs_epi32(out_25_6, out_25_7);
1067 out[ 7] = _mm_packs_epi32(out_07_6, out_07_7);
1068 out[23] = _mm_packs_epi32(out_23_6, out_23_7);
1069 out[15] = _mm_packs_epi32(out_15_6, out_15_7);
1070 out[31] = _mm_packs_epi32(out_31_6, out_31_7);
1071 }
1072 {
1073 const __m128i out_05_0 = _mm_unpacklo_epi16(step1[20], step1[27]);
1074 const __m128i out_05_1 = _mm_unpackhi_epi16(step1[20], step1[27]);
1075 const __m128i out_21_0 = _mm_unpacklo_epi16(step1[21], step1[26]);
1076 const __m128i out_21_1 = _mm_unpackhi_epi16(step1[21], step1[26]);
1077 const __m128i out_13_0 = _mm_unpacklo_epi16(step1[22], step1[25]);
1078 const __m128i out_13_1 = _mm_unpackhi_epi16(step1[22], step1[25]);
1079 const __m128i out_29_0 = _mm_unpacklo_epi16(step1[23], step1[24]);
1080 const __m128i out_29_1 = _mm_unpackhi_epi16(step1[23], step1[24]);
1081 const __m128i out_05_2 = _mm_madd_epi16(out_05_0, k__cospi_p27_p05);
1082 const __m128i out_05_3 = _mm_madd_epi16(out_05_1, k__cospi_p27_p05);
1083 const __m128i out_21_2 = _mm_madd_epi16(out_21_0, k__cospi_p11_p21);
1084 const __m128i out_21_3 = _mm_madd_epi16(out_21_1, k__cospi_p11_p21);
1085 const __m128i out_13_2 = _mm_madd_epi16(out_13_0, k__cospi_p19_p13);
1086 const __m128i out_13_3 = _mm_madd_epi16(out_13_1, k__cospi_p19_p13);
1087 const __m128i out_29_2 = _mm_madd_epi16(out_29_0, k__cospi_p03_p29);
1088 const __m128i out_29_3 = _mm_madd_epi16(out_29_1, k__cospi_p03_p29);
1089 const __m128i out_03_2 = _mm_madd_epi16(out_29_0, k__cospi_m29_p03);
1090 const __m128i out_03_3 = _mm_madd_epi16(out_29_1, k__cospi_m29_p03);
1091 const __m128i out_19_2 = _mm_madd_epi16(out_13_0, k__cospi_m13_p19);
1092 const __m128i out_19_3 = _mm_madd_epi16(out_13_1, k__cospi_m13_p19);
1093 const __m128i out_11_2 = _mm_madd_epi16(out_21_0, k__cospi_m21_p11);
1094 const __m128i out_11_3 = _mm_madd_epi16(out_21_1, k__cospi_m21_p11);
1095 const __m128i out_27_2 = _mm_madd_epi16(out_05_0, k__cospi_m05_p27);
1096 const __m128i out_27_3 = _mm_madd_epi16(out_05_1, k__cospi_m05_p27);
1097 // dct_const_round_shift
1098 const __m128i out_05_4 = _mm_add_epi32(out_05_2, k__DCT_CONST_ROUNDING);
1099 const __m128i out_05_5 = _mm_add_epi32(out_05_3, k__DCT_CONST_ROUNDING);
1100 const __m128i out_21_4 = _mm_add_epi32(out_21_2, k__DCT_CONST_ROUNDING);
1101 const __m128i out_21_5 = _mm_add_epi32(out_21_3, k__DCT_CONST_ROUNDING);
1102 const __m128i out_13_4 = _mm_add_epi32(out_13_2, k__DCT_CONST_ROUNDING);
1103 const __m128i out_13_5 = _mm_add_epi32(out_13_3, k__DCT_CONST_ROUNDING);
1104 const __m128i out_29_4 = _mm_add_epi32(out_29_2, k__DCT_CONST_ROUNDING);
1105 const __m128i out_29_5 = _mm_add_epi32(out_29_3, k__DCT_CONST_ROUNDING);
1106 const __m128i out_03_4 = _mm_add_epi32(out_03_2, k__DCT_CONST_ROUNDING);
1107 const __m128i out_03_5 = _mm_add_epi32(out_03_3, k__DCT_CONST_ROUNDING);
1108 const __m128i out_19_4 = _mm_add_epi32(out_19_2, k__DCT_CONST_ROUNDING);
1109 const __m128i out_19_5 = _mm_add_epi32(out_19_3, k__DCT_CONST_ROUNDING);
1110 const __m128i out_11_4 = _mm_add_epi32(out_11_2, k__DCT_CONST_ROUNDING);
1111 const __m128i out_11_5 = _mm_add_epi32(out_11_3, k__DCT_CONST_ROUNDING);
1112 const __m128i out_27_4 = _mm_add_epi32(out_27_2, k__DCT_CONST_ROUNDING);
1113 const __m128i out_27_5 = _mm_add_epi32(out_27_3, k__DCT_CONST_ROUNDING);
1114 const __m128i out_05_6 = _mm_srai_epi32(out_05_4, DCT_CONST_BITS);
1115 const __m128i out_05_7 = _mm_srai_epi32(out_05_5, DCT_CONST_BITS);
1116 const __m128i out_21_6 = _mm_srai_epi32(out_21_4, DCT_CONST_BITS);
1117 const __m128i out_21_7 = _mm_srai_epi32(out_21_5, DCT_CONST_BITS);
1118 const __m128i out_13_6 = _mm_srai_epi32(out_13_4, DCT_CONST_BITS);
1119 const __m128i out_13_7 = _mm_srai_epi32(out_13_5, DCT_CONST_BITS);
1120 const __m128i out_29_6 = _mm_srai_epi32(out_29_4, DCT_CONST_BITS);
1121 const __m128i out_29_7 = _mm_srai_epi32(out_29_5, DCT_CONST_BITS);
1122 const __m128i out_03_6 = _mm_srai_epi32(out_03_4, DCT_CONST_BITS);
1123 const __m128i out_03_7 = _mm_srai_epi32(out_03_5, DCT_CONST_BITS);
1124 const __m128i out_19_6 = _mm_srai_epi32(out_19_4, DCT_CONST_BITS);
1125 const __m128i out_19_7 = _mm_srai_epi32(out_19_5, DCT_CONST_BITS);
1126 const __m128i out_11_6 = _mm_srai_epi32(out_11_4, DCT_CONST_BITS);
1127 const __m128i out_11_7 = _mm_srai_epi32(out_11_5, DCT_CONST_BITS);
1128 const __m128i out_27_6 = _mm_srai_epi32(out_27_4, DCT_CONST_BITS);
1129 const __m128i out_27_7 = _mm_srai_epi32(out_27_5, DCT_CONST_BITS);
1130 // Combine
1131 out[ 5] = _mm_packs_epi32(out_05_6, out_05_7);
1132 out[21] = _mm_packs_epi32(out_21_6, out_21_7);
1133 out[13] = _mm_packs_epi32(out_13_6, out_13_7);
1134 out[29] = _mm_packs_epi32(out_29_6, out_29_7);
1135 out[ 3] = _mm_packs_epi32(out_03_6, out_03_7);
1136 out[19] = _mm_packs_epi32(out_19_6, out_19_7);
1137 out[11] = _mm_packs_epi32(out_11_6, out_11_7);
1138 out[27] = _mm_packs_epi32(out_27_6, out_27_7);
1139 }
1140 #if FDCT32x32_HIGH_PRECISION
1141 } else {
1142 __m128i lstep1[64], lstep2[64], lstep3[64];
1143 __m128i u[32], v[32], sign[16];
1144 const __m128i K32One = _mm_set_epi32(1, 1, 1, 1);
1145 // start using 32-bit operations
1146 // stage 3
1147 {
1148 // expanding to 32-bit length priori to addition operations
1149 lstep2[ 0] = _mm_unpacklo_epi16(step2[ 0], kZero);
1150 lstep2[ 1] = _mm_unpackhi_epi16(step2[ 0], kZero);
1151 lstep2[ 2] = _mm_unpacklo_epi16(step2[ 1], kZero);
1152 lstep2[ 3] = _mm_unpackhi_epi16(step2[ 1], kZero);
1153 lstep2[ 4] = _mm_unpacklo_epi16(step2[ 2], kZero);
1154 lstep2[ 5] = _mm_unpackhi_epi16(step2[ 2], kZero);
1155 lstep2[ 6] = _mm_unpacklo_epi16(step2[ 3], kZero);
1156 lstep2[ 7] = _mm_unpackhi_epi16(step2[ 3], kZero);
1157 lstep2[ 8] = _mm_unpacklo_epi16(step2[ 4], kZero);
1158 lstep2[ 9] = _mm_unpackhi_epi16(step2[ 4], kZero);
1159 lstep2[10] = _mm_unpacklo_epi16(step2[ 5], kZero);
1160 lstep2[11] = _mm_unpackhi_epi16(step2[ 5], kZero);
1161 lstep2[12] = _mm_unpacklo_epi16(step2[ 6], kZero);
1162 lstep2[13] = _mm_unpackhi_epi16(step2[ 6], kZero);
1163 lstep2[14] = _mm_unpacklo_epi16(step2[ 7], kZero);
1164 lstep2[15] = _mm_unpackhi_epi16(step2[ 7], kZero);
1165 lstep2[ 0] = _mm_madd_epi16(lstep2[ 0], kOne);
1166 lstep2[ 1] = _mm_madd_epi16(lstep2[ 1], kOne);
1167 lstep2[ 2] = _mm_madd_epi16(lstep2[ 2], kOne);
1168 lstep2[ 3] = _mm_madd_epi16(lstep2[ 3], kOne);
1169 lstep2[ 4] = _mm_madd_epi16(lstep2[ 4], kOne);
1170 lstep2[ 5] = _mm_madd_epi16(lstep2[ 5], kOne);
1171 lstep2[ 6] = _mm_madd_epi16(lstep2[ 6], kOne);
1172 lstep2[ 7] = _mm_madd_epi16(lstep2[ 7], kOne);
1173 lstep2[ 8] = _mm_madd_epi16(lstep2[ 8], kOne);
1174 lstep2[ 9] = _mm_madd_epi16(lstep2[ 9], kOne);
1175 lstep2[10] = _mm_madd_epi16(lstep2[10], kOne);
1176 lstep2[11] = _mm_madd_epi16(lstep2[11], kOne);
1177 lstep2[12] = _mm_madd_epi16(lstep2[12], kOne);
1178 lstep2[13] = _mm_madd_epi16(lstep2[13], kOne);
1179 lstep2[14] = _mm_madd_epi16(lstep2[14], kOne);
1180 lstep2[15] = _mm_madd_epi16(lstep2[15], kOne);
1181
1182 lstep3[ 0] = _mm_add_epi32(lstep2[14], lstep2[ 0]);
1183 lstep3[ 1] = _mm_add_epi32(lstep2[15], lstep2[ 1]);
1184 lstep3[ 2] = _mm_add_epi32(lstep2[12], lstep2[ 2]);
1185 lstep3[ 3] = _mm_add_epi32(lstep2[13], lstep2[ 3]);
1186 lstep3[ 4] = _mm_add_epi32(lstep2[10], lstep2[ 4]);
1187 lstep3[ 5] = _mm_add_epi32(lstep2[11], lstep2[ 5]);
1188 lstep3[ 6] = _mm_add_epi32(lstep2[ 8], lstep2[ 6]);
1189 lstep3[ 7] = _mm_add_epi32(lstep2[ 9], lstep2[ 7]);
1190 lstep3[ 8] = _mm_sub_epi32(lstep2[ 6], lstep2[ 8]);
1191 lstep3[ 9] = _mm_sub_epi32(lstep2[ 7], lstep2[ 9]);
1192 lstep3[10] = _mm_sub_epi32(lstep2[ 4], lstep2[10]);
1193 lstep3[11] = _mm_sub_epi32(lstep2[ 5], lstep2[11]);
1194 lstep3[12] = _mm_sub_epi32(lstep2[ 2], lstep2[12]);
1195 lstep3[13] = _mm_sub_epi32(lstep2[ 3], lstep2[13]);
1196 lstep3[14] = _mm_sub_epi32(lstep2[ 0], lstep2[14]);
1197 lstep3[15] = _mm_sub_epi32(lstep2[ 1], lstep2[15]);
1198 }
1199 {
1200 const __m128i s3_10_0 = _mm_unpacklo_epi16(step2[13], step2[10]);
1201 const __m128i s3_10_1 = _mm_unpackhi_epi16(step2[13], step2[10]);
1202 const __m128i s3_11_0 = _mm_unpacklo_epi16(step2[12], step2[11]);
1203 const __m128i s3_11_1 = _mm_unpackhi_epi16(step2[12], step2[11]);
1204 const __m128i s3_10_2 = _mm_madd_epi16(s3_10_0, k__cospi_p16_m16);
1205 const __m128i s3_10_3 = _mm_madd_epi16(s3_10_1, k__cospi_p16_m16);
1206 const __m128i s3_11_2 = _mm_madd_epi16(s3_11_0, k__cospi_p16_m16);
1207 const __m128i s3_11_3 = _mm_madd_epi16(s3_11_1, k__cospi_p16_m16);
1208 const __m128i s3_12_2 = _mm_madd_epi16(s3_11_0, k__cospi_p16_p16);
1209 const __m128i s3_12_3 = _mm_madd_epi16(s3_11_1, k__cospi_p16_p16);
1210 const __m128i s3_13_2 = _mm_madd_epi16(s3_10_0, k__cospi_p16_p16);
1211 const __m128i s3_13_3 = _mm_madd_epi16(s3_10_1, k__cospi_p16_p16);
1212 // dct_const_round_shift
1213 const __m128i s3_10_4 = _mm_add_epi32(s3_10_2, k__DCT_CONST_ROUNDING);
1214 const __m128i s3_10_5 = _mm_add_epi32(s3_10_3, k__DCT_CONST_ROUNDING);
1215 const __m128i s3_11_4 = _mm_add_epi32(s3_11_2, k__DCT_CONST_ROUNDING);
1216 const __m128i s3_11_5 = _mm_add_epi32(s3_11_3, k__DCT_CONST_ROUNDING);
1217 const __m128i s3_12_4 = _mm_add_epi32(s3_12_2, k__DCT_CONST_ROUNDING);
1218 const __m128i s3_12_5 = _mm_add_epi32(s3_12_3, k__DCT_CONST_ROUNDING);
1219 const __m128i s3_13_4 = _mm_add_epi32(s3_13_2, k__DCT_CONST_ROUNDING);
1220 const __m128i s3_13_5 = _mm_add_epi32(s3_13_3, k__DCT_CONST_ROUNDING);
1221 lstep3[20] = _mm_srai_epi32(s3_10_4, DCT_CONST_BITS);
1222 lstep3[21] = _mm_srai_epi32(s3_10_5, DCT_CONST_BITS);
1223 lstep3[22] = _mm_srai_epi32(s3_11_4, DCT_CONST_BITS);
1224 lstep3[23] = _mm_srai_epi32(s3_11_5, DCT_CONST_BITS);
1225 lstep3[24] = _mm_srai_epi32(s3_12_4, DCT_CONST_BITS);
1226 lstep3[25] = _mm_srai_epi32(s3_12_5, DCT_CONST_BITS);
1227 lstep3[26] = _mm_srai_epi32(s3_13_4, DCT_CONST_BITS);
1228 lstep3[27] = _mm_srai_epi32(s3_13_5, DCT_CONST_BITS);
1229 }
1230 {
1231 lstep2[40] = _mm_unpacklo_epi16(step2[20], kZero);
1232 lstep2[41] = _mm_unpackhi_epi16(step2[20], kZero);
1233 lstep2[42] = _mm_unpacklo_epi16(step2[21], kZero);
1234 lstep2[43] = _mm_unpackhi_epi16(step2[21], kZero);
1235 lstep2[44] = _mm_unpacklo_epi16(step2[22], kZero);
1236 lstep2[45] = _mm_unpackhi_epi16(step2[22], kZero);
1237 lstep2[46] = _mm_unpacklo_epi16(step2[23], kZero);
1238 lstep2[47] = _mm_unpackhi_epi16(step2[23], kZero);
1239 lstep2[48] = _mm_unpacklo_epi16(step2[24], kZero);
1240 lstep2[49] = _mm_unpackhi_epi16(step2[24], kZero);
1241 lstep2[50] = _mm_unpacklo_epi16(step2[25], kZero);
1242 lstep2[51] = _mm_unpackhi_epi16(step2[25], kZero);
1243 lstep2[52] = _mm_unpacklo_epi16(step2[26], kZero);
1244 lstep2[53] = _mm_unpackhi_epi16(step2[26], kZero);
1245 lstep2[54] = _mm_unpacklo_epi16(step2[27], kZero);
1246 lstep2[55] = _mm_unpackhi_epi16(step2[27], kZero);
1247 lstep2[40] = _mm_madd_epi16(lstep2[40], kOne);
1248 lstep2[41] = _mm_madd_epi16(lstep2[41], kOne);
1249 lstep2[42] = _mm_madd_epi16(lstep2[42], kOne);
1250 lstep2[43] = _mm_madd_epi16(lstep2[43], kOne);
1251 lstep2[44] = _mm_madd_epi16(lstep2[44], kOne);
1252 lstep2[45] = _mm_madd_epi16(lstep2[45], kOne);
1253 lstep2[46] = _mm_madd_epi16(lstep2[46], kOne);
1254 lstep2[47] = _mm_madd_epi16(lstep2[47], kOne);
1255 lstep2[48] = _mm_madd_epi16(lstep2[48], kOne);
1256 lstep2[49] = _mm_madd_epi16(lstep2[49], kOne);
1257 lstep2[50] = _mm_madd_epi16(lstep2[50], kOne);
1258 lstep2[51] = _mm_madd_epi16(lstep2[51], kOne);
1259 lstep2[52] = _mm_madd_epi16(lstep2[52], kOne);
1260 lstep2[53] = _mm_madd_epi16(lstep2[53], kOne);
1261 lstep2[54] = _mm_madd_epi16(lstep2[54], kOne);
1262 lstep2[55] = _mm_madd_epi16(lstep2[55], kOne);
1263
1264 lstep1[32] = _mm_unpacklo_epi16(step1[16], kZero);
1265 lstep1[33] = _mm_unpackhi_epi16(step1[16], kZero);
1266 lstep1[34] = _mm_unpacklo_epi16(step1[17], kZero);
1267 lstep1[35] = _mm_unpackhi_epi16(step1[17], kZero);
1268 lstep1[36] = _mm_unpacklo_epi16(step1[18], kZero);
1269 lstep1[37] = _mm_unpackhi_epi16(step1[18], kZero);
1270 lstep1[38] = _mm_unpacklo_epi16(step1[19], kZero);
1271 lstep1[39] = _mm_unpackhi_epi16(step1[19], kZero);
1272 lstep1[56] = _mm_unpacklo_epi16(step1[28], kZero);
1273 lstep1[57] = _mm_unpackhi_epi16(step1[28], kZero);
1274 lstep1[58] = _mm_unpacklo_epi16(step1[29], kZero);
1275 lstep1[59] = _mm_unpackhi_epi16(step1[29], kZero);
1276 lstep1[60] = _mm_unpacklo_epi16(step1[30], kZero);
1277 lstep1[61] = _mm_unpackhi_epi16(step1[30], kZero);
1278 lstep1[62] = _mm_unpacklo_epi16(step1[31], kZero);
1279 lstep1[63] = _mm_unpackhi_epi16(step1[31], kZero);
1280 lstep1[32] = _mm_madd_epi16(lstep1[32], kOne);
1281 lstep1[33] = _mm_madd_epi16(lstep1[33], kOne);
1282 lstep1[34] = _mm_madd_epi16(lstep1[34], kOne);
1283 lstep1[35] = _mm_madd_epi16(lstep1[35], kOne);
1284 lstep1[36] = _mm_madd_epi16(lstep1[36], kOne);
1285 lstep1[37] = _mm_madd_epi16(lstep1[37], kOne);
1286 lstep1[38] = _mm_madd_epi16(lstep1[38], kOne);
1287 lstep1[39] = _mm_madd_epi16(lstep1[39], kOne);
1288 lstep1[56] = _mm_madd_epi16(lstep1[56], kOne);
1289 lstep1[57] = _mm_madd_epi16(lstep1[57], kOne);
1290 lstep1[58] = _mm_madd_epi16(lstep1[58], kOne);
1291 lstep1[59] = _mm_madd_epi16(lstep1[59], kOne);
1292 lstep1[60] = _mm_madd_epi16(lstep1[60], kOne);
1293 lstep1[61] = _mm_madd_epi16(lstep1[61], kOne);
1294 lstep1[62] = _mm_madd_epi16(lstep1[62], kOne);
1295 lstep1[63] = _mm_madd_epi16(lstep1[63], kOne);
1296
1297 lstep3[32] = _mm_add_epi32(lstep2[46], lstep1[32]);
1298 lstep3[33] = _mm_add_epi32(lstep2[47], lstep1[33]);
1299
1300 lstep3[34] = _mm_add_epi32(lstep2[44], lstep1[34]);
1301 lstep3[35] = _mm_add_epi32(lstep2[45], lstep1[35]);
1302 lstep3[36] = _mm_add_epi32(lstep2[42], lstep1[36]);
1303 lstep3[37] = _mm_add_epi32(lstep2[43], lstep1[37]);
1304 lstep3[38] = _mm_add_epi32(lstep2[40], lstep1[38]);
1305 lstep3[39] = _mm_add_epi32(lstep2[41], lstep1[39]);
1306 lstep3[40] = _mm_sub_epi32(lstep1[38], lstep2[40]);
1307 lstep3[41] = _mm_sub_epi32(lstep1[39], lstep2[41]);
1308 lstep3[42] = _mm_sub_epi32(lstep1[36], lstep2[42]);
1309 lstep3[43] = _mm_sub_epi32(lstep1[37], lstep2[43]);
1310 lstep3[44] = _mm_sub_epi32(lstep1[34], lstep2[44]);
1311 lstep3[45] = _mm_sub_epi32(lstep1[35], lstep2[45]);
1312 lstep3[46] = _mm_sub_epi32(lstep1[32], lstep2[46]);
1313 lstep3[47] = _mm_sub_epi32(lstep1[33], lstep2[47]);
1314 lstep3[48] = _mm_sub_epi32(lstep1[62], lstep2[48]);
1315 lstep3[49] = _mm_sub_epi32(lstep1[63], lstep2[49]);
1316 lstep3[50] = _mm_sub_epi32(lstep1[60], lstep2[50]);
1317 lstep3[51] = _mm_sub_epi32(lstep1[61], lstep2[51]);
1318 lstep3[52] = _mm_sub_epi32(lstep1[58], lstep2[52]);
1319 lstep3[53] = _mm_sub_epi32(lstep1[59], lstep2[53]);
1320 lstep3[54] = _mm_sub_epi32(lstep1[56], lstep2[54]);
1321 lstep3[55] = _mm_sub_epi32(lstep1[57], lstep2[55]);
1322 lstep3[56] = _mm_add_epi32(lstep2[54], lstep1[56]);
1323 lstep3[57] = _mm_add_epi32(lstep2[55], lstep1[57]);
1324 lstep3[58] = _mm_add_epi32(lstep2[52], lstep1[58]);
1325 lstep3[59] = _mm_add_epi32(lstep2[53], lstep1[59]);
1326 lstep3[60] = _mm_add_epi32(lstep2[50], lstep1[60]);
1327 lstep3[61] = _mm_add_epi32(lstep2[51], lstep1[61]);
1328 lstep3[62] = _mm_add_epi32(lstep2[48], lstep1[62]);
1329 lstep3[63] = _mm_add_epi32(lstep2[49], lstep1[63]);
1330 }
1331
1332 // stage 4
1333 {
1334 // expanding to 32-bit length priori to addition operations
1335 lstep2[16] = _mm_unpacklo_epi16(step2[ 8], kZero);
1336 lstep2[17] = _mm_unpackhi_epi16(step2[ 8], kZero);
1337 lstep2[18] = _mm_unpacklo_epi16(step2[ 9], kZero);
1338 lstep2[19] = _mm_unpackhi_epi16(step2[ 9], kZero);
1339 lstep2[28] = _mm_unpacklo_epi16(step2[14], kZero);
1340 lstep2[29] = _mm_unpackhi_epi16(step2[14], kZero);
1341 lstep2[30] = _mm_unpacklo_epi16(step2[15], kZero);
1342 lstep2[31] = _mm_unpackhi_epi16(step2[15], kZero);
1343 lstep2[16] = _mm_madd_epi16(lstep2[16], kOne);
1344 lstep2[17] = _mm_madd_epi16(lstep2[17], kOne);
1345 lstep2[18] = _mm_madd_epi16(lstep2[18], kOne);
1346 lstep2[19] = _mm_madd_epi16(lstep2[19], kOne);
1347 lstep2[28] = _mm_madd_epi16(lstep2[28], kOne);
1348 lstep2[29] = _mm_madd_epi16(lstep2[29], kOne);
1349 lstep2[30] = _mm_madd_epi16(lstep2[30], kOne);
1350 lstep2[31] = _mm_madd_epi16(lstep2[31], kOne);
1351
1352 lstep1[ 0] = _mm_add_epi32(lstep3[ 6], lstep3[ 0]);
1353 lstep1[ 1] = _mm_add_epi32(lstep3[ 7], lstep3[ 1]);
1354 lstep1[ 2] = _mm_add_epi32(lstep3[ 4], lstep3[ 2]);
1355 lstep1[ 3] = _mm_add_epi32(lstep3[ 5], lstep3[ 3]);
1356 lstep1[ 4] = _mm_sub_epi32(lstep3[ 2], lstep3[ 4]);
1357 lstep1[ 5] = _mm_sub_epi32(lstep3[ 3], lstep3[ 5]);
1358 lstep1[ 6] = _mm_sub_epi32(lstep3[ 0], lstep3[ 6]);
1359 lstep1[ 7] = _mm_sub_epi32(lstep3[ 1], lstep3[ 7]);
1360 lstep1[16] = _mm_add_epi32(lstep3[22], lstep2[16]);
1361 lstep1[17] = _mm_add_epi32(lstep3[23], lstep2[17]);
1362 lstep1[18] = _mm_add_epi32(lstep3[20], lstep2[18]);
1363 lstep1[19] = _mm_add_epi32(lstep3[21], lstep2[19]);
1364 lstep1[20] = _mm_sub_epi32(lstep2[18], lstep3[20]);
1365 lstep1[21] = _mm_sub_epi32(lstep2[19], lstep3[21]);
1366 lstep1[22] = _mm_sub_epi32(lstep2[16], lstep3[22]);
1367 lstep1[23] = _mm_sub_epi32(lstep2[17], lstep3[23]);
1368 lstep1[24] = _mm_sub_epi32(lstep2[30], lstep3[24]);
1369 lstep1[25] = _mm_sub_epi32(lstep2[31], lstep3[25]);
1370 lstep1[26] = _mm_sub_epi32(lstep2[28], lstep3[26]);
1371 lstep1[27] = _mm_sub_epi32(lstep2[29], lstep3[27]);
1372 lstep1[28] = _mm_add_epi32(lstep3[26], lstep2[28]);
1373 lstep1[29] = _mm_add_epi32(lstep3[27], lstep2[29]);
1374 lstep1[30] = _mm_add_epi32(lstep3[24], lstep2[30]);
1375 lstep1[31] = _mm_add_epi32(lstep3[25], lstep2[31]);
1376 }
1377 {
1378 // to be continued...
1379 //
1380 const __m128i k32_p16_p16 = pair_set_epi32(cospi_16_64, cospi_16_64);
1381 const __m128i k32_p16_m16 = pair_set_epi32(cospi_16_64, -cospi_16_64);
1382
1383 u[0] = _mm_unpacklo_epi32(lstep3[12], lstep3[10]);
1384 u[1] = _mm_unpackhi_epi32(lstep3[12], lstep3[10]);
1385 u[2] = _mm_unpacklo_epi32(lstep3[13], lstep3[11]);
1386 u[3] = _mm_unpackhi_epi32(lstep3[13], lstep3[11]);
1387
1388 // TODO(jingning): manually inline k_madd_epi32_ to further hide
1389 // instruction latency.
1390 v[ 0] = k_madd_epi32(u[0], k32_p16_m16);
1391 v[ 1] = k_madd_epi32(u[1], k32_p16_m16);
1392 v[ 2] = k_madd_epi32(u[2], k32_p16_m16);
1393 v[ 3] = k_madd_epi32(u[3], k32_p16_m16);
1394 v[ 4] = k_madd_epi32(u[0], k32_p16_p16);
1395 v[ 5] = k_madd_epi32(u[1], k32_p16_p16);
1396 v[ 6] = k_madd_epi32(u[2], k32_p16_p16);
1397 v[ 7] = k_madd_epi32(u[3], k32_p16_p16);
1398
1399 u[0] = k_packs_epi64(v[0], v[1]);
1400 u[1] = k_packs_epi64(v[2], v[3]);
1401 u[2] = k_packs_epi64(v[4], v[5]);
1402 u[3] = k_packs_epi64(v[6], v[7]);
1403
1404 v[0] = _mm_add_epi32(u[0], k__DCT_CONST_ROUNDING);
1405 v[1] = _mm_add_epi32(u[1], k__DCT_CONST_ROUNDING);
1406 v[2] = _mm_add_epi32(u[2], k__DCT_CONST_ROUNDING);
1407 v[3] = _mm_add_epi32(u[3], k__DCT_CONST_ROUNDING);
1408
1409 lstep1[10] = _mm_srai_epi32(v[0], DCT_CONST_BITS);
1410 lstep1[11] = _mm_srai_epi32(v[1], DCT_CONST_BITS);
1411 lstep1[12] = _mm_srai_epi32(v[2], DCT_CONST_BITS);
1412 lstep1[13] = _mm_srai_epi32(v[3], DCT_CONST_BITS);
1413 }
1414 {
1415 const __m128i k32_m08_p24 = pair_set_epi32(-cospi_8_64, cospi_24_64);
1416 const __m128i k32_m24_m08 = pair_set_epi32(-cospi_24_64, -cospi_8_64);
1417 const __m128i k32_p24_p08 = pair_set_epi32(cospi_24_64, cospi_8_64);
1418
1419 u[ 0] = _mm_unpacklo_epi32(lstep3[36], lstep3[58]);
1420 u[ 1] = _mm_unpackhi_epi32(lstep3[36], lstep3[58]);
1421 u[ 2] = _mm_unpacklo_epi32(lstep3[37], lstep3[59]);
1422 u[ 3] = _mm_unpackhi_epi32(lstep3[37], lstep3[59]);
1423 u[ 4] = _mm_unpacklo_epi32(lstep3[38], lstep3[56]);
1424 u[ 5] = _mm_unpackhi_epi32(lstep3[38], lstep3[56]);
1425 u[ 6] = _mm_unpacklo_epi32(lstep3[39], lstep3[57]);
1426 u[ 7] = _mm_unpackhi_epi32(lstep3[39], lstep3[57]);
1427 u[ 8] = _mm_unpacklo_epi32(lstep3[40], lstep3[54]);
1428 u[ 9] = _mm_unpackhi_epi32(lstep3[40], lstep3[54]);
1429 u[10] = _mm_unpacklo_epi32(lstep3[41], lstep3[55]);
1430 u[11] = _mm_unpackhi_epi32(lstep3[41], lstep3[55]);
1431 u[12] = _mm_unpacklo_epi32(lstep3[42], lstep3[52]);
1432 u[13] = _mm_unpackhi_epi32(lstep3[42], lstep3[52]);
1433 u[14] = _mm_unpacklo_epi32(lstep3[43], lstep3[53]);
1434 u[15] = _mm_unpackhi_epi32(lstep3[43], lstep3[53]);
1435
1436 v[ 0] = k_madd_epi32(u[ 0], k32_m08_p24);
1437 v[ 1] = k_madd_epi32(u[ 1], k32_m08_p24);
1438 v[ 2] = k_madd_epi32(u[ 2], k32_m08_p24);
1439 v[ 3] = k_madd_epi32(u[ 3], k32_m08_p24);
1440 v[ 4] = k_madd_epi32(u[ 4], k32_m08_p24);
1441 v[ 5] = k_madd_epi32(u[ 5], k32_m08_p24);
1442 v[ 6] = k_madd_epi32(u[ 6], k32_m08_p24);
1443 v[ 7] = k_madd_epi32(u[ 7], k32_m08_p24);
1444 v[ 8] = k_madd_epi32(u[ 8], k32_m24_m08);
1445 v[ 9] = k_madd_epi32(u[ 9], k32_m24_m08);
1446 v[10] = k_madd_epi32(u[10], k32_m24_m08);
1447 v[11] = k_madd_epi32(u[11], k32_m24_m08);
1448 v[12] = k_madd_epi32(u[12], k32_m24_m08);
1449 v[13] = k_madd_epi32(u[13], k32_m24_m08);
1450 v[14] = k_madd_epi32(u[14], k32_m24_m08);
1451 v[15] = k_madd_epi32(u[15], k32_m24_m08);
1452 v[16] = k_madd_epi32(u[12], k32_m08_p24);
1453 v[17] = k_madd_epi32(u[13], k32_m08_p24);
1454 v[18] = k_madd_epi32(u[14], k32_m08_p24);
1455 v[19] = k_madd_epi32(u[15], k32_m08_p24);
1456 v[20] = k_madd_epi32(u[ 8], k32_m08_p24);
1457 v[21] = k_madd_epi32(u[ 9], k32_m08_p24);
1458 v[22] = k_madd_epi32(u[10], k32_m08_p24);
1459 v[23] = k_madd_epi32(u[11], k32_m08_p24);
1460 v[24] = k_madd_epi32(u[ 4], k32_p24_p08);
1461 v[25] = k_madd_epi32(u[ 5], k32_p24_p08);
1462 v[26] = k_madd_epi32(u[ 6], k32_p24_p08);
1463 v[27] = k_madd_epi32(u[ 7], k32_p24_p08);
1464 v[28] = k_madd_epi32(u[ 0], k32_p24_p08);
1465 v[29] = k_madd_epi32(u[ 1], k32_p24_p08);
1466 v[30] = k_madd_epi32(u[ 2], k32_p24_p08);
1467 v[31] = k_madd_epi32(u[ 3], k32_p24_p08);
1468
1469 u[ 0] = k_packs_epi64(v[ 0], v[ 1]);
1470 u[ 1] = k_packs_epi64(v[ 2], v[ 3]);
1471 u[ 2] = k_packs_epi64(v[ 4], v[ 5]);
1472 u[ 3] = k_packs_epi64(v[ 6], v[ 7]);
1473 u[ 4] = k_packs_epi64(v[ 8], v[ 9]);
1474 u[ 5] = k_packs_epi64(v[10], v[11]);
1475 u[ 6] = k_packs_epi64(v[12], v[13]);
1476 u[ 7] = k_packs_epi64(v[14], v[15]);
1477 u[ 8] = k_packs_epi64(v[16], v[17]);
1478 u[ 9] = k_packs_epi64(v[18], v[19]);
1479 u[10] = k_packs_epi64(v[20], v[21]);
1480 u[11] = k_packs_epi64(v[22], v[23]);
1481 u[12] = k_packs_epi64(v[24], v[25]);
1482 u[13] = k_packs_epi64(v[26], v[27]);
1483 u[14] = k_packs_epi64(v[28], v[29]);
1484 u[15] = k_packs_epi64(v[30], v[31]);
1485
1486 v[ 0] = _mm_add_epi32(u[ 0], k__DCT_CONST_ROUNDING);
1487 v[ 1] = _mm_add_epi32(u[ 1], k__DCT_CONST_ROUNDING);
1488 v[ 2] = _mm_add_epi32(u[ 2], k__DCT_CONST_ROUNDING);
1489 v[ 3] = _mm_add_epi32(u[ 3], k__DCT_CONST_ROUNDING);
1490 v[ 4] = _mm_add_epi32(u[ 4], k__DCT_CONST_ROUNDING);
1491 v[ 5] = _mm_add_epi32(u[ 5], k__DCT_CONST_ROUNDING);
1492 v[ 6] = _mm_add_epi32(u[ 6], k__DCT_CONST_ROUNDING);
1493 v[ 7] = _mm_add_epi32(u[ 7], k__DCT_CONST_ROUNDING);
1494 v[ 8] = _mm_add_epi32(u[ 8], k__DCT_CONST_ROUNDING);
1495 v[ 9] = _mm_add_epi32(u[ 9], k__DCT_CONST_ROUNDING);
1496 v[10] = _mm_add_epi32(u[10], k__DCT_CONST_ROUNDING);
1497 v[11] = _mm_add_epi32(u[11], k__DCT_CONST_ROUNDING);
1498 v[12] = _mm_add_epi32(u[12], k__DCT_CONST_ROUNDING);
1499 v[13] = _mm_add_epi32(u[13], k__DCT_CONST_ROUNDING);
1500 v[14] = _mm_add_epi32(u[14], k__DCT_CONST_ROUNDING);
1501 v[15] = _mm_add_epi32(u[15], k__DCT_CONST_ROUNDING);
1502
1503 lstep1[36] = _mm_srai_epi32(v[ 0], DCT_CONST_BITS);
1504 lstep1[37] = _mm_srai_epi32(v[ 1], DCT_CONST_BITS);
1505 lstep1[38] = _mm_srai_epi32(v[ 2], DCT_CONST_BITS);
1506 lstep1[39] = _mm_srai_epi32(v[ 3], DCT_CONST_BITS);
1507 lstep1[40] = _mm_srai_epi32(v[ 4], DCT_CONST_BITS);
1508 lstep1[41] = _mm_srai_epi32(v[ 5], DCT_CONST_BITS);
1509 lstep1[42] = _mm_srai_epi32(v[ 6], DCT_CONST_BITS);
1510 lstep1[43] = _mm_srai_epi32(v[ 7], DCT_CONST_BITS);
1511 lstep1[52] = _mm_srai_epi32(v[ 8], DCT_CONST_BITS);
1512 lstep1[53] = _mm_srai_epi32(v[ 9], DCT_CONST_BITS);
1513 lstep1[54] = _mm_srai_epi32(v[10], DCT_CONST_BITS);
1514 lstep1[55] = _mm_srai_epi32(v[11], DCT_CONST_BITS);
1515 lstep1[56] = _mm_srai_epi32(v[12], DCT_CONST_BITS);
1516 lstep1[57] = _mm_srai_epi32(v[13], DCT_CONST_BITS);
1517 lstep1[58] = _mm_srai_epi32(v[14], DCT_CONST_BITS);
1518 lstep1[59] = _mm_srai_epi32(v[15], DCT_CONST_BITS);
1519 }
1520 // stage 5
1521 {
1522 lstep2[ 8] = _mm_add_epi32(lstep1[10], lstep3[ 8]);
1523 lstep2[ 9] = _mm_add_epi32(lstep1[11], lstep3[ 9]);
1524 lstep2[10] = _mm_sub_epi32(lstep3[ 8], lstep1[10]);
1525 lstep2[11] = _mm_sub_epi32(lstep3[ 9], lstep1[11]);
1526 lstep2[12] = _mm_sub_epi32(lstep3[14], lstep1[12]);
1527 lstep2[13] = _mm_sub_epi32(lstep3[15], lstep1[13]);
1528 lstep2[14] = _mm_add_epi32(lstep1[12], lstep3[14]);
1529 lstep2[15] = _mm_add_epi32(lstep1[13], lstep3[15]);
1530 }
1531 {
1532 const __m128i k32_p16_p16 = pair_set_epi32(cospi_16_64, cospi_16_64);
1533 const __m128i k32_p16_m16 = pair_set_epi32(cospi_16_64, -cospi_16_64);
1534 const __m128i k32_p24_p08 = pair_set_epi32(cospi_24_64, cospi_8_64);
1535 const __m128i k32_m08_p24 = pair_set_epi32(-cospi_8_64, cospi_24_64);
1536
1537 u[0] = _mm_unpacklo_epi32(lstep1[0], lstep1[2]);
1538 u[1] = _mm_unpackhi_epi32(lstep1[0], lstep1[2]);
1539 u[2] = _mm_unpacklo_epi32(lstep1[1], lstep1[3]);
1540 u[3] = _mm_unpackhi_epi32(lstep1[1], lstep1[3]);
1541 u[4] = _mm_unpacklo_epi32(lstep1[4], lstep1[6]);
1542 u[5] = _mm_unpackhi_epi32(lstep1[4], lstep1[6]);
1543 u[6] = _mm_unpacklo_epi32(lstep1[5], lstep1[7]);
1544 u[7] = _mm_unpackhi_epi32(lstep1[5], lstep1[7]);
1545
1546 // TODO(jingning): manually inline k_madd_epi32_ to further hide
1547 // instruction latency.
1548 v[ 0] = k_madd_epi32(u[0], k32_p16_p16);
1549 v[ 1] = k_madd_epi32(u[1], k32_p16_p16);
1550 v[ 2] = k_madd_epi32(u[2], k32_p16_p16);
1551 v[ 3] = k_madd_epi32(u[3], k32_p16_p16);
1552 v[ 4] = k_madd_epi32(u[0], k32_p16_m16);
1553 v[ 5] = k_madd_epi32(u[1], k32_p16_m16);
1554 v[ 6] = k_madd_epi32(u[2], k32_p16_m16);
1555 v[ 7] = k_madd_epi32(u[3], k32_p16_m16);
1556 v[ 8] = k_madd_epi32(u[4], k32_p24_p08);
1557 v[ 9] = k_madd_epi32(u[5], k32_p24_p08);
1558 v[10] = k_madd_epi32(u[6], k32_p24_p08);
1559 v[11] = k_madd_epi32(u[7], k32_p24_p08);
1560 v[12] = k_madd_epi32(u[4], k32_m08_p24);
1561 v[13] = k_madd_epi32(u[5], k32_m08_p24);
1562 v[14] = k_madd_epi32(u[6], k32_m08_p24);
1563 v[15] = k_madd_epi32(u[7], k32_m08_p24);
1564
1565 u[0] = k_packs_epi64(v[0], v[1]);
1566 u[1] = k_packs_epi64(v[2], v[3]);
1567 u[2] = k_packs_epi64(v[4], v[5]);
1568 u[3] = k_packs_epi64(v[6], v[7]);
1569 u[4] = k_packs_epi64(v[8], v[9]);
1570 u[5] = k_packs_epi64(v[10], v[11]);
1571 u[6] = k_packs_epi64(v[12], v[13]);
1572 u[7] = k_packs_epi64(v[14], v[15]);
1573
1574 v[0] = _mm_add_epi32(u[0], k__DCT_CONST_ROUNDING);
1575 v[1] = _mm_add_epi32(u[1], k__DCT_CONST_ROUNDING);
1576 v[2] = _mm_add_epi32(u[2], k__DCT_CONST_ROUNDING);
1577 v[3] = _mm_add_epi32(u[3], k__DCT_CONST_ROUNDING);
1578 v[4] = _mm_add_epi32(u[4], k__DCT_CONST_ROUNDING);
1579 v[5] = _mm_add_epi32(u[5], k__DCT_CONST_ROUNDING);
1580 v[6] = _mm_add_epi32(u[6], k__DCT_CONST_ROUNDING);
1581 v[7] = _mm_add_epi32(u[7], k__DCT_CONST_ROUNDING);
1582
1583 u[0] = _mm_srai_epi32(v[0], DCT_CONST_BITS);
1584 u[1] = _mm_srai_epi32(v[1], DCT_CONST_BITS);
1585 u[2] = _mm_srai_epi32(v[2], DCT_CONST_BITS);
1586 u[3] = _mm_srai_epi32(v[3], DCT_CONST_BITS);
1587 u[4] = _mm_srai_epi32(v[4], DCT_CONST_BITS);
1588 u[5] = _mm_srai_epi32(v[5], DCT_CONST_BITS);
1589 u[6] = _mm_srai_epi32(v[6], DCT_CONST_BITS);
1590 u[7] = _mm_srai_epi32(v[7], DCT_CONST_BITS);
1591
1592 sign[0] = _mm_cmplt_epi32(u[0], kZero);
1593 sign[1] = _mm_cmplt_epi32(u[1], kZero);
1594 sign[2] = _mm_cmplt_epi32(u[2], kZero);
1595 sign[3] = _mm_cmplt_epi32(u[3], kZero);
1596 sign[4] = _mm_cmplt_epi32(u[4], kZero);
1597 sign[5] = _mm_cmplt_epi32(u[5], kZero);
1598 sign[6] = _mm_cmplt_epi32(u[6], kZero);
1599 sign[7] = _mm_cmplt_epi32(u[7], kZero);
1600
1601 u[0] = _mm_sub_epi32(u[0], sign[0]);
1602 u[1] = _mm_sub_epi32(u[1], sign[1]);
1603 u[2] = _mm_sub_epi32(u[2], sign[2]);
1604 u[3] = _mm_sub_epi32(u[3], sign[3]);
1605 u[4] = _mm_sub_epi32(u[4], sign[4]);
1606 u[5] = _mm_sub_epi32(u[5], sign[5]);
1607 u[6] = _mm_sub_epi32(u[6], sign[6]);
1608 u[7] = _mm_sub_epi32(u[7], sign[7]);
1609
1610 u[0] = _mm_add_epi32(u[0], K32One);
1611 u[1] = _mm_add_epi32(u[1], K32One);
1612 u[2] = _mm_add_epi32(u[2], K32One);
1613 u[3] = _mm_add_epi32(u[3], K32One);
1614 u[4] = _mm_add_epi32(u[4], K32One);
1615 u[5] = _mm_add_epi32(u[5], K32One);
1616 u[6] = _mm_add_epi32(u[6], K32One);
1617 u[7] = _mm_add_epi32(u[7], K32One);
1618
1619 u[0] = _mm_srai_epi32(u[0], 2);
1620 u[1] = _mm_srai_epi32(u[1], 2);
1621 u[2] = _mm_srai_epi32(u[2], 2);
1622 u[3] = _mm_srai_epi32(u[3], 2);
1623 u[4] = _mm_srai_epi32(u[4], 2);
1624 u[5] = _mm_srai_epi32(u[5], 2);
1625 u[6] = _mm_srai_epi32(u[6], 2);
1626 u[7] = _mm_srai_epi32(u[7], 2);
1627
1628 // Combine
1629 out[ 0] = _mm_packs_epi32(u[0], u[1]);
1630 out[16] = _mm_packs_epi32(u[2], u[3]);
1631 out[ 8] = _mm_packs_epi32(u[4], u[5]);
1632 out[24] = _mm_packs_epi32(u[6], u[7]);
1633 }
1634 {
1635 const __m128i k32_m08_p24 = pair_set_epi32(-cospi_8_64, cospi_24_64);
1636 const __m128i k32_m24_m08 = pair_set_epi32(-cospi_24_64, -cospi_8_64);
1637 const __m128i k32_p24_p08 = pair_set_epi32(cospi_24_64, cospi_8_64);
1638
1639 u[0] = _mm_unpacklo_epi32(lstep1[18], lstep1[28]);
1640 u[1] = _mm_unpackhi_epi32(lstep1[18], lstep1[28]);
1641 u[2] = _mm_unpacklo_epi32(lstep1[19], lstep1[29]);
1642 u[3] = _mm_unpackhi_epi32(lstep1[19], lstep1[29]);
1643 u[4] = _mm_unpacklo_epi32(lstep1[20], lstep1[26]);
1644 u[5] = _mm_unpackhi_epi32(lstep1[20], lstep1[26]);
1645 u[6] = _mm_unpacklo_epi32(lstep1[21], lstep1[27]);
1646 u[7] = _mm_unpackhi_epi32(lstep1[21], lstep1[27]);
1647
1648 v[0] = k_madd_epi32(u[0], k32_m08_p24);
1649 v[1] = k_madd_epi32(u[1], k32_m08_p24);
1650 v[2] = k_madd_epi32(u[2], k32_m08_p24);
1651 v[3] = k_madd_epi32(u[3], k32_m08_p24);
1652 v[4] = k_madd_epi32(u[4], k32_m24_m08);
1653 v[5] = k_madd_epi32(u[5], k32_m24_m08);
1654 v[6] = k_madd_epi32(u[6], k32_m24_m08);
1655 v[7] = k_madd_epi32(u[7], k32_m24_m08);
1656 v[ 8] = k_madd_epi32(u[4], k32_m08_p24);
1657 v[ 9] = k_madd_epi32(u[5], k32_m08_p24);
1658 v[10] = k_madd_epi32(u[6], k32_m08_p24);
1659 v[11] = k_madd_epi32(u[7], k32_m08_p24);
1660 v[12] = k_madd_epi32(u[0], k32_p24_p08);
1661 v[13] = k_madd_epi32(u[1], k32_p24_p08);
1662 v[14] = k_madd_epi32(u[2], k32_p24_p08);
1663 v[15] = k_madd_epi32(u[3], k32_p24_p08);
1664
1665 u[0] = k_packs_epi64(v[0], v[1]);
1666 u[1] = k_packs_epi64(v[2], v[3]);
1667 u[2] = k_packs_epi64(v[4], v[5]);
1668 u[3] = k_packs_epi64(v[6], v[7]);
1669 u[4] = k_packs_epi64(v[8], v[9]);
1670 u[5] = k_packs_epi64(v[10], v[11]);
1671 u[6] = k_packs_epi64(v[12], v[13]);
1672 u[7] = k_packs_epi64(v[14], v[15]);
1673
1674 u[0] = _mm_add_epi32(u[0], k__DCT_CONST_ROUNDING);
1675 u[1] = _mm_add_epi32(u[1], k__DCT_CONST_ROUNDING);
1676 u[2] = _mm_add_epi32(u[2], k__DCT_CONST_ROUNDING);
1677 u[3] = _mm_add_epi32(u[3], k__DCT_CONST_ROUNDING);
1678 u[4] = _mm_add_epi32(u[4], k__DCT_CONST_ROUNDING);
1679 u[5] = _mm_add_epi32(u[5], k__DCT_CONST_ROUNDING);
1680 u[6] = _mm_add_epi32(u[6], k__DCT_CONST_ROUNDING);
1681 u[7] = _mm_add_epi32(u[7], k__DCT_CONST_ROUNDING);
1682
1683 lstep2[18] = _mm_srai_epi32(u[0], DCT_CONST_BITS);
1684 lstep2[19] = _mm_srai_epi32(u[1], DCT_CONST_BITS);
1685 lstep2[20] = _mm_srai_epi32(u[2], DCT_CONST_BITS);
1686 lstep2[21] = _mm_srai_epi32(u[3], DCT_CONST_BITS);
1687 lstep2[26] = _mm_srai_epi32(u[4], DCT_CONST_BITS);
1688 lstep2[27] = _mm_srai_epi32(u[5], DCT_CONST_BITS);
1689 lstep2[28] = _mm_srai_epi32(u[6], DCT_CONST_BITS);
1690 lstep2[29] = _mm_srai_epi32(u[7], DCT_CONST_BITS);
1691 }
1692 {
1693 lstep2[32] = _mm_add_epi32(lstep1[38], lstep3[32]);
1694 lstep2[33] = _mm_add_epi32(lstep1[39], lstep3[33]);
1695 lstep2[34] = _mm_add_epi32(lstep1[36], lstep3[34]);
1696 lstep2[35] = _mm_add_epi32(lstep1[37], lstep3[35]);
1697 lstep2[36] = _mm_sub_epi32(lstep3[34], lstep1[36]);
1698 lstep2[37] = _mm_sub_epi32(lstep3[35], lstep1[37]);
1699 lstep2[38] = _mm_sub_epi32(lstep3[32], lstep1[38]);
1700 lstep2[39] = _mm_sub_epi32(lstep3[33], lstep1[39]);
1701 lstep2[40] = _mm_sub_epi32(lstep3[46], lstep1[40]);
1702 lstep2[41] = _mm_sub_epi32(lstep3[47], lstep1[41]);
1703 lstep2[42] = _mm_sub_epi32(lstep3[44], lstep1[42]);
1704 lstep2[43] = _mm_sub_epi32(lstep3[45], lstep1[43]);
1705 lstep2[44] = _mm_add_epi32(lstep1[42], lstep3[44]);
1706 lstep2[45] = _mm_add_epi32(lstep1[43], lstep3[45]);
1707 lstep2[46] = _mm_add_epi32(lstep1[40], lstep3[46]);
1708 lstep2[47] = _mm_add_epi32(lstep1[41], lstep3[47]);
1709 lstep2[48] = _mm_add_epi32(lstep1[54], lstep3[48]);
1710 lstep2[49] = _mm_add_epi32(lstep1[55], lstep3[49]);
1711 lstep2[50] = _mm_add_epi32(lstep1[52], lstep3[50]);
1712 lstep2[51] = _mm_add_epi32(lstep1[53], lstep3[51]);
1713 lstep2[52] = _mm_sub_epi32(lstep3[50], lstep1[52]);
1714 lstep2[53] = _mm_sub_epi32(lstep3[51], lstep1[53]);
1715 lstep2[54] = _mm_sub_epi32(lstep3[48], lstep1[54]);
1716 lstep2[55] = _mm_sub_epi32(lstep3[49], lstep1[55]);
1717 lstep2[56] = _mm_sub_epi32(lstep3[62], lstep1[56]);
1718 lstep2[57] = _mm_sub_epi32(lstep3[63], lstep1[57]);
1719 lstep2[58] = _mm_sub_epi32(lstep3[60], lstep1[58]);
1720 lstep2[59] = _mm_sub_epi32(lstep3[61], lstep1[59]);
1721 lstep2[60] = _mm_add_epi32(lstep1[58], lstep3[60]);
1722 lstep2[61] = _mm_add_epi32(lstep1[59], lstep3[61]);
1723 lstep2[62] = _mm_add_epi32(lstep1[56], lstep3[62]);
1724 lstep2[63] = _mm_add_epi32(lstep1[57], lstep3[63]);
1725 }
1726 // stage 6
1727 {
1728 const __m128i k32_p28_p04 = pair_set_epi32(cospi_28_64, cospi_4_64);
1729 const __m128i k32_p12_p20 = pair_set_epi32(cospi_12_64, cospi_20_64);
1730 const __m128i k32_m20_p12 = pair_set_epi32(-cospi_20_64, cospi_12_64);
1731 const __m128i k32_m04_p28 = pair_set_epi32(-cospi_4_64, cospi_28_64);
1732
1733 u[0] = _mm_unpacklo_epi32(lstep2[ 8], lstep2[14]);
1734 u[1] = _mm_unpackhi_epi32(lstep2[ 8], lstep2[14]);
1735 u[2] = _mm_unpacklo_epi32(lstep2[ 9], lstep2[15]);
1736 u[3] = _mm_unpackhi_epi32(lstep2[ 9], lstep2[15]);
1737 u[4] = _mm_unpacklo_epi32(lstep2[10], lstep2[12]);
1738 u[5] = _mm_unpackhi_epi32(lstep2[10], lstep2[12]);
1739 u[6] = _mm_unpacklo_epi32(lstep2[11], lstep2[13]);
1740 u[7] = _mm_unpackhi_epi32(lstep2[11], lstep2[13]);
1741 u[8] = _mm_unpacklo_epi32(lstep2[10], lstep2[12]);
1742 u[9] = _mm_unpackhi_epi32(lstep2[10], lstep2[12]);
1743 u[10] = _mm_unpacklo_epi32(lstep2[11], lstep2[13]);
1744 u[11] = _mm_unpackhi_epi32(lstep2[11], lstep2[13]);
1745 u[12] = _mm_unpacklo_epi32(lstep2[ 8], lstep2[14]);
1746 u[13] = _mm_unpackhi_epi32(lstep2[ 8], lstep2[14]);
1747 u[14] = _mm_unpacklo_epi32(lstep2[ 9], lstep2[15]);
1748 u[15] = _mm_unpackhi_epi32(lstep2[ 9], lstep2[15]);
1749
1750 v[0] = k_madd_epi32(u[0], k32_p28_p04);
1751 v[1] = k_madd_epi32(u[1], k32_p28_p04);
1752 v[2] = k_madd_epi32(u[2], k32_p28_p04);
1753 v[3] = k_madd_epi32(u[3], k32_p28_p04);
1754 v[4] = k_madd_epi32(u[4], k32_p12_p20);
1755 v[5] = k_madd_epi32(u[5], k32_p12_p20);
1756 v[6] = k_madd_epi32(u[6], k32_p12_p20);
1757 v[7] = k_madd_epi32(u[7], k32_p12_p20);
1758 v[ 8] = k_madd_epi32(u[ 8], k32_m20_p12);
1759 v[ 9] = k_madd_epi32(u[ 9], k32_m20_p12);
1760 v[10] = k_madd_epi32(u[10], k32_m20_p12);
1761 v[11] = k_madd_epi32(u[11], k32_m20_p12);
1762 v[12] = k_madd_epi32(u[12], k32_m04_p28);
1763 v[13] = k_madd_epi32(u[13], k32_m04_p28);
1764 v[14] = k_madd_epi32(u[14], k32_m04_p28);
1765 v[15] = k_madd_epi32(u[15], k32_m04_p28);
1766
1767 u[0] = k_packs_epi64(v[0], v[1]);
1768 u[1] = k_packs_epi64(v[2], v[3]);
1769 u[2] = k_packs_epi64(v[4], v[5]);
1770 u[3] = k_packs_epi64(v[6], v[7]);
1771 u[4] = k_packs_epi64(v[8], v[9]);
1772 u[5] = k_packs_epi64(v[10], v[11]);
1773 u[6] = k_packs_epi64(v[12], v[13]);
1774 u[7] = k_packs_epi64(v[14], v[15]);
1775
1776 v[0] = _mm_add_epi32(u[0], k__DCT_CONST_ROUNDING);
1777 v[1] = _mm_add_epi32(u[1], k__DCT_CONST_ROUNDING);
1778 v[2] = _mm_add_epi32(u[2], k__DCT_CONST_ROUNDING);
1779 v[3] = _mm_add_epi32(u[3], k__DCT_CONST_ROUNDING);
1780 v[4] = _mm_add_epi32(u[4], k__DCT_CONST_ROUNDING);
1781 v[5] = _mm_add_epi32(u[5], k__DCT_CONST_ROUNDING);
1782 v[6] = _mm_add_epi32(u[6], k__DCT_CONST_ROUNDING);
1783 v[7] = _mm_add_epi32(u[7], k__DCT_CONST_ROUNDING);
1784
1785 u[0] = _mm_srai_epi32(v[0], DCT_CONST_BITS);
1786 u[1] = _mm_srai_epi32(v[1], DCT_CONST_BITS);
1787 u[2] = _mm_srai_epi32(v[2], DCT_CONST_BITS);
1788 u[3] = _mm_srai_epi32(v[3], DCT_CONST_BITS);
1789 u[4] = _mm_srai_epi32(v[4], DCT_CONST_BITS);
1790 u[5] = _mm_srai_epi32(v[5], DCT_CONST_BITS);
1791 u[6] = _mm_srai_epi32(v[6], DCT_CONST_BITS);
1792 u[7] = _mm_srai_epi32(v[7], DCT_CONST_BITS);
1793
1794 sign[0] = _mm_cmplt_epi32(u[0], kZero);
1795 sign[1] = _mm_cmplt_epi32(u[1], kZero);
1796 sign[2] = _mm_cmplt_epi32(u[2], kZero);
1797 sign[3] = _mm_cmplt_epi32(u[3], kZero);
1798 sign[4] = _mm_cmplt_epi32(u[4], kZero);
1799 sign[5] = _mm_cmplt_epi32(u[5], kZero);
1800 sign[6] = _mm_cmplt_epi32(u[6], kZero);
1801 sign[7] = _mm_cmplt_epi32(u[7], kZero);
1802
1803 u[0] = _mm_sub_epi32(u[0], sign[0]);
1804 u[1] = _mm_sub_epi32(u[1], sign[1]);
1805 u[2] = _mm_sub_epi32(u[2], sign[2]);
1806 u[3] = _mm_sub_epi32(u[3], sign[3]);
1807 u[4] = _mm_sub_epi32(u[4], sign[4]);
1808 u[5] = _mm_sub_epi32(u[5], sign[5]);
1809 u[6] = _mm_sub_epi32(u[6], sign[6]);
1810 u[7] = _mm_sub_epi32(u[7], sign[7]);
1811
1812 u[0] = _mm_add_epi32(u[0], K32One);
1813 u[1] = _mm_add_epi32(u[1], K32One);
1814 u[2] = _mm_add_epi32(u[2], K32One);
1815 u[3] = _mm_add_epi32(u[3], K32One);
1816 u[4] = _mm_add_epi32(u[4], K32One);
1817 u[5] = _mm_add_epi32(u[5], K32One);
1818 u[6] = _mm_add_epi32(u[6], K32One);
1819 u[7] = _mm_add_epi32(u[7], K32One);
1820
1821 u[0] = _mm_srai_epi32(u[0], 2);
1822 u[1] = _mm_srai_epi32(u[1], 2);
1823 u[2] = _mm_srai_epi32(u[2], 2);
1824 u[3] = _mm_srai_epi32(u[3], 2);
1825 u[4] = _mm_srai_epi32(u[4], 2);
1826 u[5] = _mm_srai_epi32(u[5], 2);
1827 u[6] = _mm_srai_epi32(u[6], 2);
1828 u[7] = _mm_srai_epi32(u[7], 2);
1829
1830 out[ 4] = _mm_packs_epi32(u[0], u[1]);
1831 out[20] = _mm_packs_epi32(u[2], u[3]);
1832 out[12] = _mm_packs_epi32(u[4], u[5]);
1833 out[28] = _mm_packs_epi32(u[6], u[7]);
1834 }
1835 {
1836 lstep3[16] = _mm_add_epi32(lstep2[18], lstep1[16]);
1837 lstep3[17] = _mm_add_epi32(lstep2[19], lstep1[17]);
1838 lstep3[18] = _mm_sub_epi32(lstep1[16], lstep2[18]);
1839 lstep3[19] = _mm_sub_epi32(lstep1[17], lstep2[19]);
1840 lstep3[20] = _mm_sub_epi32(lstep1[22], lstep2[20]);
1841 lstep3[21] = _mm_sub_epi32(lstep1[23], lstep2[21]);
1842 lstep3[22] = _mm_add_epi32(lstep2[20], lstep1[22]);
1843 lstep3[23] = _mm_add_epi32(lstep2[21], lstep1[23]);
1844 lstep3[24] = _mm_add_epi32(lstep2[26], lstep1[24]);
1845 lstep3[25] = _mm_add_epi32(lstep2[27], lstep1[25]);
1846 lstep3[26] = _mm_sub_epi32(lstep1[24], lstep2[26]);
1847 lstep3[27] = _mm_sub_epi32(lstep1[25], lstep2[27]);
1848 lstep3[28] = _mm_sub_epi32(lstep1[30], lstep2[28]);
1849 lstep3[29] = _mm_sub_epi32(lstep1[31], lstep2[29]);
1850 lstep3[30] = _mm_add_epi32(lstep2[28], lstep1[30]);
1851 lstep3[31] = _mm_add_epi32(lstep2[29], lstep1[31]);
1852 }
1853 {
1854 const __m128i k32_m04_p28 = pair_set_epi32(-cospi_4_64, cospi_28_64);
1855 const __m128i k32_m28_m04 = pair_set_epi32(-cospi_28_64, -cospi_4_64);
1856 const __m128i k32_m20_p12 = pair_set_epi32(-cospi_20_64, cospi_12_64);
1857 const __m128i k32_m12_m20 = pair_set_epi32(-cospi_12_64,
1858 -cospi_20_64);
1859 const __m128i k32_p12_p20 = pair_set_epi32(cospi_12_64, cospi_20_64);
1860 const __m128i k32_p28_p04 = pair_set_epi32(cospi_28_64, cospi_4_64);
1861
1862 u[ 0] = _mm_unpacklo_epi32(lstep2[34], lstep2[60]);
1863 u[ 1] = _mm_unpackhi_epi32(lstep2[34], lstep2[60]);
1864 u[ 2] = _mm_unpacklo_epi32(lstep2[35], lstep2[61]);
1865 u[ 3] = _mm_unpackhi_epi32(lstep2[35], lstep2[61]);
1866 u[ 4] = _mm_unpacklo_epi32(lstep2[36], lstep2[58]);
1867 u[ 5] = _mm_unpackhi_epi32(lstep2[36], lstep2[58]);
1868 u[ 6] = _mm_unpacklo_epi32(lstep2[37], lstep2[59]);
1869 u[ 7] = _mm_unpackhi_epi32(lstep2[37], lstep2[59]);
1870 u[ 8] = _mm_unpacklo_epi32(lstep2[42], lstep2[52]);
1871 u[ 9] = _mm_unpackhi_epi32(lstep2[42], lstep2[52]);
1872 u[10] = _mm_unpacklo_epi32(lstep2[43], lstep2[53]);
1873 u[11] = _mm_unpackhi_epi32(lstep2[43], lstep2[53]);
1874 u[12] = _mm_unpacklo_epi32(lstep2[44], lstep2[50]);
1875 u[13] = _mm_unpackhi_epi32(lstep2[44], lstep2[50]);
1876 u[14] = _mm_unpacklo_epi32(lstep2[45], lstep2[51]);
1877 u[15] = _mm_unpackhi_epi32(lstep2[45], lstep2[51]);
1878
1879 v[ 0] = k_madd_epi32(u[ 0], k32_m04_p28);
1880 v[ 1] = k_madd_epi32(u[ 1], k32_m04_p28);
1881 v[ 2] = k_madd_epi32(u[ 2], k32_m04_p28);
1882 v[ 3] = k_madd_epi32(u[ 3], k32_m04_p28);
1883 v[ 4] = k_madd_epi32(u[ 4], k32_m28_m04);
1884 v[ 5] = k_madd_epi32(u[ 5], k32_m28_m04);
1885 v[ 6] = k_madd_epi32(u[ 6], k32_m28_m04);
1886 v[ 7] = k_madd_epi32(u[ 7], k32_m28_m04);
1887 v[ 8] = k_madd_epi32(u[ 8], k32_m20_p12);
1888 v[ 9] = k_madd_epi32(u[ 9], k32_m20_p12);
1889 v[10] = k_madd_epi32(u[10], k32_m20_p12);
1890 v[11] = k_madd_epi32(u[11], k32_m20_p12);
1891 v[12] = k_madd_epi32(u[12], k32_m12_m20);
1892 v[13] = k_madd_epi32(u[13], k32_m12_m20);
1893 v[14] = k_madd_epi32(u[14], k32_m12_m20);
1894 v[15] = k_madd_epi32(u[15], k32_m12_m20);
1895 v[16] = k_madd_epi32(u[12], k32_m20_p12);
1896 v[17] = k_madd_epi32(u[13], k32_m20_p12);
1897 v[18] = k_madd_epi32(u[14], k32_m20_p12);
1898 v[19] = k_madd_epi32(u[15], k32_m20_p12);
1899 v[20] = k_madd_epi32(u[ 8], k32_p12_p20);
1900 v[21] = k_madd_epi32(u[ 9], k32_p12_p20);
1901 v[22] = k_madd_epi32(u[10], k32_p12_p20);
1902 v[23] = k_madd_epi32(u[11], k32_p12_p20);
1903 v[24] = k_madd_epi32(u[ 4], k32_m04_p28);
1904 v[25] = k_madd_epi32(u[ 5], k32_m04_p28);
1905 v[26] = k_madd_epi32(u[ 6], k32_m04_p28);
1906 v[27] = k_madd_epi32(u[ 7], k32_m04_p28);
1907 v[28] = k_madd_epi32(u[ 0], k32_p28_p04);
1908 v[29] = k_madd_epi32(u[ 1], k32_p28_p04);
1909 v[30] = k_madd_epi32(u[ 2], k32_p28_p04);
1910 v[31] = k_madd_epi32(u[ 3], k32_p28_p04);
1911
1912 u[ 0] = k_packs_epi64(v[ 0], v[ 1]);
1913 u[ 1] = k_packs_epi64(v[ 2], v[ 3]);
1914 u[ 2] = k_packs_epi64(v[ 4], v[ 5]);
1915 u[ 3] = k_packs_epi64(v[ 6], v[ 7]);
1916 u[ 4] = k_packs_epi64(v[ 8], v[ 9]);
1917 u[ 5] = k_packs_epi64(v[10], v[11]);
1918 u[ 6] = k_packs_epi64(v[12], v[13]);
1919 u[ 7] = k_packs_epi64(v[14], v[15]);
1920 u[ 8] = k_packs_epi64(v[16], v[17]);
1921 u[ 9] = k_packs_epi64(v[18], v[19]);
1922 u[10] = k_packs_epi64(v[20], v[21]);
1923 u[11] = k_packs_epi64(v[22], v[23]);
1924 u[12] = k_packs_epi64(v[24], v[25]);
1925 u[13] = k_packs_epi64(v[26], v[27]);
1926 u[14] = k_packs_epi64(v[28], v[29]);
1927 u[15] = k_packs_epi64(v[30], v[31]);
1928
1929 v[ 0] = _mm_add_epi32(u[ 0], k__DCT_CONST_ROUNDING);
1930 v[ 1] = _mm_add_epi32(u[ 1], k__DCT_CONST_ROUNDING);
1931 v[ 2] = _mm_add_epi32(u[ 2], k__DCT_CONST_ROUNDING);
1932 v[ 3] = _mm_add_epi32(u[ 3], k__DCT_CONST_ROUNDING);
1933 v[ 4] = _mm_add_epi32(u[ 4], k__DCT_CONST_ROUNDING);
1934 v[ 5] = _mm_add_epi32(u[ 5], k__DCT_CONST_ROUNDING);
1935 v[ 6] = _mm_add_epi32(u[ 6], k__DCT_CONST_ROUNDING);
1936 v[ 7] = _mm_add_epi32(u[ 7], k__DCT_CONST_ROUNDING);
1937 v[ 8] = _mm_add_epi32(u[ 8], k__DCT_CONST_ROUNDING);
1938 v[ 9] = _mm_add_epi32(u[ 9], k__DCT_CONST_ROUNDING);
1939 v[10] = _mm_add_epi32(u[10], k__DCT_CONST_ROUNDING);
1940 v[11] = _mm_add_epi32(u[11], k__DCT_CONST_ROUNDING);
1941 v[12] = _mm_add_epi32(u[12], k__DCT_CONST_ROUNDING);
1942 v[13] = _mm_add_epi32(u[13], k__DCT_CONST_ROUNDING);
1943 v[14] = _mm_add_epi32(u[14], k__DCT_CONST_ROUNDING);
1944 v[15] = _mm_add_epi32(u[15], k__DCT_CONST_ROUNDING);
1945
1946 lstep3[34] = _mm_srai_epi32(v[ 0], DCT_CONST_BITS);
1947 lstep3[35] = _mm_srai_epi32(v[ 1], DCT_CONST_BITS);
1948 lstep3[36] = _mm_srai_epi32(v[ 2], DCT_CONST_BITS);
1949 lstep3[37] = _mm_srai_epi32(v[ 3], DCT_CONST_BITS);
1950 lstep3[42] = _mm_srai_epi32(v[ 4], DCT_CONST_BITS);
1951 lstep3[43] = _mm_srai_epi32(v[ 5], DCT_CONST_BITS);
1952 lstep3[44] = _mm_srai_epi32(v[ 6], DCT_CONST_BITS);
1953 lstep3[45] = _mm_srai_epi32(v[ 7], DCT_CONST_BITS);
1954 lstep3[50] = _mm_srai_epi32(v[ 8], DCT_CONST_BITS);
1955 lstep3[51] = _mm_srai_epi32(v[ 9], DCT_CONST_BITS);
1956 lstep3[52] = _mm_srai_epi32(v[10], DCT_CONST_BITS);
1957 lstep3[53] = _mm_srai_epi32(v[11], DCT_CONST_BITS);
1958 lstep3[58] = _mm_srai_epi32(v[12], DCT_CONST_BITS);
1959 lstep3[59] = _mm_srai_epi32(v[13], DCT_CONST_BITS);
1960 lstep3[60] = _mm_srai_epi32(v[14], DCT_CONST_BITS);
1961 lstep3[61] = _mm_srai_epi32(v[15], DCT_CONST_BITS);
1962 }
1963 // stage 7
1964 {
1965 const __m128i k32_p30_p02 = pair_set_epi32(cospi_30_64, cospi_2_64);
1966 const __m128i k32_p14_p18 = pair_set_epi32(cospi_14_64, cospi_18_64);
1967 const __m128i k32_p22_p10 = pair_set_epi32(cospi_22_64, cospi_10_64);
1968 const __m128i k32_p06_p26 = pair_set_epi32(cospi_6_64, cospi_26_64);
1969 const __m128i k32_m26_p06 = pair_set_epi32(-cospi_26_64, cospi_6_64);
1970 const __m128i k32_m10_p22 = pair_set_epi32(-cospi_10_64, cospi_22_64);
1971 const __m128i k32_m18_p14 = pair_set_epi32(-cospi_18_64, cospi_14_64);
1972 const __m128i k32_m02_p30 = pair_set_epi32(-cospi_2_64, cospi_30_64);
1973
1974 u[ 0] = _mm_unpacklo_epi32(lstep3[16], lstep3[30]);
1975 u[ 1] = _mm_unpackhi_epi32(lstep3[16], lstep3[30]);
1976 u[ 2] = _mm_unpacklo_epi32(lstep3[17], lstep3[31]);
1977 u[ 3] = _mm_unpackhi_epi32(lstep3[17], lstep3[31]);
1978 u[ 4] = _mm_unpacklo_epi32(lstep3[18], lstep3[28]);
1979 u[ 5] = _mm_unpackhi_epi32(lstep3[18], lstep3[28]);
1980 u[ 6] = _mm_unpacklo_epi32(lstep3[19], lstep3[29]);
1981 u[ 7] = _mm_unpackhi_epi32(lstep3[19], lstep3[29]);
1982 u[ 8] = _mm_unpacklo_epi32(lstep3[20], lstep3[26]);
1983 u[ 9] = _mm_unpackhi_epi32(lstep3[20], lstep3[26]);
1984 u[10] = _mm_unpacklo_epi32(lstep3[21], lstep3[27]);
1985 u[11] = _mm_unpackhi_epi32(lstep3[21], lstep3[27]);
1986 u[12] = _mm_unpacklo_epi32(lstep3[22], lstep3[24]);
1987 u[13] = _mm_unpackhi_epi32(lstep3[22], lstep3[24]);
1988 u[14] = _mm_unpacklo_epi32(lstep3[23], lstep3[25]);
1989 u[15] = _mm_unpackhi_epi32(lstep3[23], lstep3[25]);
1990
1991 v[ 0] = k_madd_epi32(u[ 0], k32_p30_p02);
1992 v[ 1] = k_madd_epi32(u[ 1], k32_p30_p02);
1993 v[ 2] = k_madd_epi32(u[ 2], k32_p30_p02);
1994 v[ 3] = k_madd_epi32(u[ 3], k32_p30_p02);
1995 v[ 4] = k_madd_epi32(u[ 4], k32_p14_p18);
1996 v[ 5] = k_madd_epi32(u[ 5], k32_p14_p18);
1997 v[ 6] = k_madd_epi32(u[ 6], k32_p14_p18);
1998 v[ 7] = k_madd_epi32(u[ 7], k32_p14_p18);
1999 v[ 8] = k_madd_epi32(u[ 8], k32_p22_p10);
2000 v[ 9] = k_madd_epi32(u[ 9], k32_p22_p10);
2001 v[10] = k_madd_epi32(u[10], k32_p22_p10);
2002 v[11] = k_madd_epi32(u[11], k32_p22_p10);
2003 v[12] = k_madd_epi32(u[12], k32_p06_p26);
2004 v[13] = k_madd_epi32(u[13], k32_p06_p26);
2005 v[14] = k_madd_epi32(u[14], k32_p06_p26);
2006 v[15] = k_madd_epi32(u[15], k32_p06_p26);
2007 v[16] = k_madd_epi32(u[12], k32_m26_p06);
2008 v[17] = k_madd_epi32(u[13], k32_m26_p06);
2009 v[18] = k_madd_epi32(u[14], k32_m26_p06);
2010 v[19] = k_madd_epi32(u[15], k32_m26_p06);
2011 v[20] = k_madd_epi32(u[ 8], k32_m10_p22);
2012 v[21] = k_madd_epi32(u[ 9], k32_m10_p22);
2013 v[22] = k_madd_epi32(u[10], k32_m10_p22);
2014 v[23] = k_madd_epi32(u[11], k32_m10_p22);
2015 v[24] = k_madd_epi32(u[ 4], k32_m18_p14);
2016 v[25] = k_madd_epi32(u[ 5], k32_m18_p14);
2017 v[26] = k_madd_epi32(u[ 6], k32_m18_p14);
2018 v[27] = k_madd_epi32(u[ 7], k32_m18_p14);
2019 v[28] = k_madd_epi32(u[ 0], k32_m02_p30);
2020 v[29] = k_madd_epi32(u[ 1], k32_m02_p30);
2021 v[30] = k_madd_epi32(u[ 2], k32_m02_p30);
2022 v[31] = k_madd_epi32(u[ 3], k32_m02_p30);
2023
2024 u[ 0] = k_packs_epi64(v[ 0], v[ 1]);
2025 u[ 1] = k_packs_epi64(v[ 2], v[ 3]);
2026 u[ 2] = k_packs_epi64(v[ 4], v[ 5]);
2027 u[ 3] = k_packs_epi64(v[ 6], v[ 7]);
2028 u[ 4] = k_packs_epi64(v[ 8], v[ 9]);
2029 u[ 5] = k_packs_epi64(v[10], v[11]);
2030 u[ 6] = k_packs_epi64(v[12], v[13]);
2031 u[ 7] = k_packs_epi64(v[14], v[15]);
2032 u[ 8] = k_packs_epi64(v[16], v[17]);
2033 u[ 9] = k_packs_epi64(v[18], v[19]);
2034 u[10] = k_packs_epi64(v[20], v[21]);
2035 u[11] = k_packs_epi64(v[22], v[23]);
2036 u[12] = k_packs_epi64(v[24], v[25]);
2037 u[13] = k_packs_epi64(v[26], v[27]);
2038 u[14] = k_packs_epi64(v[28], v[29]);
2039 u[15] = k_packs_epi64(v[30], v[31]);
2040
2041 v[ 0] = _mm_add_epi32(u[ 0], k__DCT_CONST_ROUNDING);
2042 v[ 1] = _mm_add_epi32(u[ 1], k__DCT_CONST_ROUNDING);
2043 v[ 2] = _mm_add_epi32(u[ 2], k__DCT_CONST_ROUNDING);
2044 v[ 3] = _mm_add_epi32(u[ 3], k__DCT_CONST_ROUNDING);
2045 v[ 4] = _mm_add_epi32(u[ 4], k__DCT_CONST_ROUNDING);
2046 v[ 5] = _mm_add_epi32(u[ 5], k__DCT_CONST_ROUNDING);
2047 v[ 6] = _mm_add_epi32(u[ 6], k__DCT_CONST_ROUNDING);
2048 v[ 7] = _mm_add_epi32(u[ 7], k__DCT_CONST_ROUNDING);
2049 v[ 8] = _mm_add_epi32(u[ 8], k__DCT_CONST_ROUNDING);
2050 v[ 9] = _mm_add_epi32(u[ 9], k__DCT_CONST_ROUNDING);
2051 v[10] = _mm_add_epi32(u[10], k__DCT_CONST_ROUNDING);
2052 v[11] = _mm_add_epi32(u[11], k__DCT_CONST_ROUNDING);
2053 v[12] = _mm_add_epi32(u[12], k__DCT_CONST_ROUNDING);
2054 v[13] = _mm_add_epi32(u[13], k__DCT_CONST_ROUNDING);
2055 v[14] = _mm_add_epi32(u[14], k__DCT_CONST_ROUNDING);
2056 v[15] = _mm_add_epi32(u[15], k__DCT_CONST_ROUNDING);
2057
2058 u[ 0] = _mm_srai_epi32(v[ 0], DCT_CONST_BITS);
2059 u[ 1] = _mm_srai_epi32(v[ 1], DCT_CONST_BITS);
2060 u[ 2] = _mm_srai_epi32(v[ 2], DCT_CONST_BITS);
2061 u[ 3] = _mm_srai_epi32(v[ 3], DCT_CONST_BITS);
2062 u[ 4] = _mm_srai_epi32(v[ 4], DCT_CONST_BITS);
2063 u[ 5] = _mm_srai_epi32(v[ 5], DCT_CONST_BITS);
2064 u[ 6] = _mm_srai_epi32(v[ 6], DCT_CONST_BITS);
2065 u[ 7] = _mm_srai_epi32(v[ 7], DCT_CONST_BITS);
2066 u[ 8] = _mm_srai_epi32(v[ 8], DCT_CONST_BITS);
2067 u[ 9] = _mm_srai_epi32(v[ 9], DCT_CONST_BITS);
2068 u[10] = _mm_srai_epi32(v[10], DCT_CONST_BITS);
2069 u[11] = _mm_srai_epi32(v[11], DCT_CONST_BITS);
2070 u[12] = _mm_srai_epi32(v[12], DCT_CONST_BITS);
2071 u[13] = _mm_srai_epi32(v[13], DCT_CONST_BITS);
2072 u[14] = _mm_srai_epi32(v[14], DCT_CONST_BITS);
2073 u[15] = _mm_srai_epi32(v[15], DCT_CONST_BITS);
2074
2075 v[ 0] = _mm_cmplt_epi32(u[ 0], kZero);
2076 v[ 1] = _mm_cmplt_epi32(u[ 1], kZero);
2077 v[ 2] = _mm_cmplt_epi32(u[ 2], kZero);
2078 v[ 3] = _mm_cmplt_epi32(u[ 3], kZero);
2079 v[ 4] = _mm_cmplt_epi32(u[ 4], kZero);
2080 v[ 5] = _mm_cmplt_epi32(u[ 5], kZero);
2081 v[ 6] = _mm_cmplt_epi32(u[ 6], kZero);
2082 v[ 7] = _mm_cmplt_epi32(u[ 7], kZero);
2083 v[ 8] = _mm_cmplt_epi32(u[ 8], kZero);
2084 v[ 9] = _mm_cmplt_epi32(u[ 9], kZero);
2085 v[10] = _mm_cmplt_epi32(u[10], kZero);
2086 v[11] = _mm_cmplt_epi32(u[11], kZero);
2087 v[12] = _mm_cmplt_epi32(u[12], kZero);
2088 v[13] = _mm_cmplt_epi32(u[13], kZero);
2089 v[14] = _mm_cmplt_epi32(u[14], kZero);
2090 v[15] = _mm_cmplt_epi32(u[15], kZero);
2091
2092 u[ 0] = _mm_sub_epi32(u[ 0], v[ 0]);
2093 u[ 1] = _mm_sub_epi32(u[ 1], v[ 1]);
2094 u[ 2] = _mm_sub_epi32(u[ 2], v[ 2]);
2095 u[ 3] = _mm_sub_epi32(u[ 3], v[ 3]);
2096 u[ 4] = _mm_sub_epi32(u[ 4], v[ 4]);
2097 u[ 5] = _mm_sub_epi32(u[ 5], v[ 5]);
2098 u[ 6] = _mm_sub_epi32(u[ 6], v[ 6]);
2099 u[ 7] = _mm_sub_epi32(u[ 7], v[ 7]);
2100 u[ 8] = _mm_sub_epi32(u[ 8], v[ 8]);
2101 u[ 9] = _mm_sub_epi32(u[ 9], v[ 9]);
2102 u[10] = _mm_sub_epi32(u[10], v[10]);
2103 u[11] = _mm_sub_epi32(u[11], v[11]);
2104 u[12] = _mm_sub_epi32(u[12], v[12]);
2105 u[13] = _mm_sub_epi32(u[13], v[13]);
2106 u[14] = _mm_sub_epi32(u[14], v[14]);
2107 u[15] = _mm_sub_epi32(u[15], v[15]);
2108
2109 v[ 0] = _mm_add_epi32(u[ 0], K32One);
2110 v[ 1] = _mm_add_epi32(u[ 1], K32One);
2111 v[ 2] = _mm_add_epi32(u[ 2], K32One);
2112 v[ 3] = _mm_add_epi32(u[ 3], K32One);
2113 v[ 4] = _mm_add_epi32(u[ 4], K32One);
2114 v[ 5] = _mm_add_epi32(u[ 5], K32One);
2115 v[ 6] = _mm_add_epi32(u[ 6], K32One);
2116 v[ 7] = _mm_add_epi32(u[ 7], K32One);
2117 v[ 8] = _mm_add_epi32(u[ 8], K32One);
2118 v[ 9] = _mm_add_epi32(u[ 9], K32One);
2119 v[10] = _mm_add_epi32(u[10], K32One);
2120 v[11] = _mm_add_epi32(u[11], K32One);
2121 v[12] = _mm_add_epi32(u[12], K32One);
2122 v[13] = _mm_add_epi32(u[13], K32One);
2123 v[14] = _mm_add_epi32(u[14], K32One);
2124 v[15] = _mm_add_epi32(u[15], K32One);
2125
2126 u[ 0] = _mm_srai_epi32(v[ 0], 2);
2127 u[ 1] = _mm_srai_epi32(v[ 1], 2);
2128 u[ 2] = _mm_srai_epi32(v[ 2], 2);
2129 u[ 3] = _mm_srai_epi32(v[ 3], 2);
2130 u[ 4] = _mm_srai_epi32(v[ 4], 2);
2131 u[ 5] = _mm_srai_epi32(v[ 5], 2);
2132 u[ 6] = _mm_srai_epi32(v[ 6], 2);
2133 u[ 7] = _mm_srai_epi32(v[ 7], 2);
2134 u[ 8] = _mm_srai_epi32(v[ 8], 2);
2135 u[ 9] = _mm_srai_epi32(v[ 9], 2);
2136 u[10] = _mm_srai_epi32(v[10], 2);
2137 u[11] = _mm_srai_epi32(v[11], 2);
2138 u[12] = _mm_srai_epi32(v[12], 2);
2139 u[13] = _mm_srai_epi32(v[13], 2);
2140 u[14] = _mm_srai_epi32(v[14], 2);
2141 u[15] = _mm_srai_epi32(v[15], 2);
2142
2143 out[ 2] = _mm_packs_epi32(u[0], u[1]);
2144 out[18] = _mm_packs_epi32(u[2], u[3]);
2145 out[10] = _mm_packs_epi32(u[4], u[5]);
2146 out[26] = _mm_packs_epi32(u[6], u[7]);
2147 out[ 6] = _mm_packs_epi32(u[8], u[9]);
2148 out[22] = _mm_packs_epi32(u[10], u[11]);
2149 out[14] = _mm_packs_epi32(u[12], u[13]);
2150 out[30] = _mm_packs_epi32(u[14], u[15]);
2151 }
2152 {
2153 lstep1[32] = _mm_add_epi32(lstep3[34], lstep2[32]);
2154 lstep1[33] = _mm_add_epi32(lstep3[35], lstep2[33]);
2155 lstep1[34] = _mm_sub_epi32(lstep2[32], lstep3[34]);
2156 lstep1[35] = _mm_sub_epi32(lstep2[33], lstep3[35]);
2157 lstep1[36] = _mm_sub_epi32(lstep2[38], lstep3[36]);
2158 lstep1[37] = _mm_sub_epi32(lstep2[39], lstep3[37]);
2159 lstep1[38] = _mm_add_epi32(lstep3[36], lstep2[38]);
2160 lstep1[39] = _mm_add_epi32(lstep3[37], lstep2[39]);
2161 lstep1[40] = _mm_add_epi32(lstep3[42], lstep2[40]);
2162 lstep1[41] = _mm_add_epi32(lstep3[43], lstep2[41]);
2163 lstep1[42] = _mm_sub_epi32(lstep2[40], lstep3[42]);
2164 lstep1[43] = _mm_sub_epi32(lstep2[41], lstep3[43]);
2165 lstep1[44] = _mm_sub_epi32(lstep2[46], lstep3[44]);
2166 lstep1[45] = _mm_sub_epi32(lstep2[47], lstep3[45]);
2167 lstep1[46] = _mm_add_epi32(lstep3[44], lstep2[46]);
2168 lstep1[47] = _mm_add_epi32(lstep3[45], lstep2[47]);
2169 lstep1[48] = _mm_add_epi32(lstep3[50], lstep2[48]);
2170 lstep1[49] = _mm_add_epi32(lstep3[51], lstep2[49]);
2171 lstep1[50] = _mm_sub_epi32(lstep2[48], lstep3[50]);
2172 lstep1[51] = _mm_sub_epi32(lstep2[49], lstep3[51]);
2173 lstep1[52] = _mm_sub_epi32(lstep2[54], lstep3[52]);
2174 lstep1[53] = _mm_sub_epi32(lstep2[55], lstep3[53]);
2175 lstep1[54] = _mm_add_epi32(lstep3[52], lstep2[54]);
2176 lstep1[55] = _mm_add_epi32(lstep3[53], lstep2[55]);
2177 lstep1[56] = _mm_add_epi32(lstep3[58], lstep2[56]);
2178 lstep1[57] = _mm_add_epi32(lstep3[59], lstep2[57]);
2179 lstep1[58] = _mm_sub_epi32(lstep2[56], lstep3[58]);
2180 lstep1[59] = _mm_sub_epi32(lstep2[57], lstep3[59]);
2181 lstep1[60] = _mm_sub_epi32(lstep2[62], lstep3[60]);
2182 lstep1[61] = _mm_sub_epi32(lstep2[63], lstep3[61]);
2183 lstep1[62] = _mm_add_epi32(lstep3[60], lstep2[62]);
2184 lstep1[63] = _mm_add_epi32(lstep3[61], lstep2[63]);
2185 }
2186 // stage 8
2187 {
2188 const __m128i k32_p31_p01 = pair_set_epi32(cospi_31_64, cospi_1_64);
2189 const __m128i k32_p15_p17 = pair_set_epi32(cospi_15_64, cospi_17_64);
2190 const __m128i k32_p23_p09 = pair_set_epi32(cospi_23_64, cospi_9_64);
2191 const __m128i k32_p07_p25 = pair_set_epi32(cospi_7_64, cospi_25_64);
2192 const __m128i k32_m25_p07 = pair_set_epi32(-cospi_25_64, cospi_7_64);
2193 const __m128i k32_m09_p23 = pair_set_epi32(-cospi_9_64, cospi_23_64);
2194 const __m128i k32_m17_p15 = pair_set_epi32(-cospi_17_64, cospi_15_64);
2195 const __m128i k32_m01_p31 = pair_set_epi32(-cospi_1_64, cospi_31_64);
2196
2197 u[ 0] = _mm_unpacklo_epi32(lstep1[32], lstep1[62]);
2198 u[ 1] = _mm_unpackhi_epi32(lstep1[32], lstep1[62]);
2199 u[ 2] = _mm_unpacklo_epi32(lstep1[33], lstep1[63]);
2200 u[ 3] = _mm_unpackhi_epi32(lstep1[33], lstep1[63]);
2201 u[ 4] = _mm_unpacklo_epi32(lstep1[34], lstep1[60]);
2202 u[ 5] = _mm_unpackhi_epi32(lstep1[34], lstep1[60]);
2203 u[ 6] = _mm_unpacklo_epi32(lstep1[35], lstep1[61]);
2204 u[ 7] = _mm_unpackhi_epi32(lstep1[35], lstep1[61]);
2205 u[ 8] = _mm_unpacklo_epi32(lstep1[36], lstep1[58]);
2206 u[ 9] = _mm_unpackhi_epi32(lstep1[36], lstep1[58]);
2207 u[10] = _mm_unpacklo_epi32(lstep1[37], lstep1[59]);
2208 u[11] = _mm_unpackhi_epi32(lstep1[37], lstep1[59]);
2209 u[12] = _mm_unpacklo_epi32(lstep1[38], lstep1[56]);
2210 u[13] = _mm_unpackhi_epi32(lstep1[38], lstep1[56]);
2211 u[14] = _mm_unpacklo_epi32(lstep1[39], lstep1[57]);
2212 u[15] = _mm_unpackhi_epi32(lstep1[39], lstep1[57]);
2213
2214 v[ 0] = k_madd_epi32(u[ 0], k32_p31_p01);
2215 v[ 1] = k_madd_epi32(u[ 1], k32_p31_p01);
2216 v[ 2] = k_madd_epi32(u[ 2], k32_p31_p01);
2217 v[ 3] = k_madd_epi32(u[ 3], k32_p31_p01);
2218 v[ 4] = k_madd_epi32(u[ 4], k32_p15_p17);
2219 v[ 5] = k_madd_epi32(u[ 5], k32_p15_p17);
2220 v[ 6] = k_madd_epi32(u[ 6], k32_p15_p17);
2221 v[ 7] = k_madd_epi32(u[ 7], k32_p15_p17);
2222 v[ 8] = k_madd_epi32(u[ 8], k32_p23_p09);
2223 v[ 9] = k_madd_epi32(u[ 9], k32_p23_p09);
2224 v[10] = k_madd_epi32(u[10], k32_p23_p09);
2225 v[11] = k_madd_epi32(u[11], k32_p23_p09);
2226 v[12] = k_madd_epi32(u[12], k32_p07_p25);
2227 v[13] = k_madd_epi32(u[13], k32_p07_p25);
2228 v[14] = k_madd_epi32(u[14], k32_p07_p25);
2229 v[15] = k_madd_epi32(u[15], k32_p07_p25);
2230 v[16] = k_madd_epi32(u[12], k32_m25_p07);
2231 v[17] = k_madd_epi32(u[13], k32_m25_p07);
2232 v[18] = k_madd_epi32(u[14], k32_m25_p07);
2233 v[19] = k_madd_epi32(u[15], k32_m25_p07);
2234 v[20] = k_madd_epi32(u[ 8], k32_m09_p23);
2235 v[21] = k_madd_epi32(u[ 9], k32_m09_p23);
2236 v[22] = k_madd_epi32(u[10], k32_m09_p23);
2237 v[23] = k_madd_epi32(u[11], k32_m09_p23);
2238 v[24] = k_madd_epi32(u[ 4], k32_m17_p15);
2239 v[25] = k_madd_epi32(u[ 5], k32_m17_p15);
2240 v[26] = k_madd_epi32(u[ 6], k32_m17_p15);
2241 v[27] = k_madd_epi32(u[ 7], k32_m17_p15);
2242 v[28] = k_madd_epi32(u[ 0], k32_m01_p31);
2243 v[29] = k_madd_epi32(u[ 1], k32_m01_p31);
2244 v[30] = k_madd_epi32(u[ 2], k32_m01_p31);
2245 v[31] = k_madd_epi32(u[ 3], k32_m01_p31);
2246
2247 u[ 0] = k_packs_epi64(v[ 0], v[ 1]);
2248 u[ 1] = k_packs_epi64(v[ 2], v[ 3]);
2249 u[ 2] = k_packs_epi64(v[ 4], v[ 5]);
2250 u[ 3] = k_packs_epi64(v[ 6], v[ 7]);
2251 u[ 4] = k_packs_epi64(v[ 8], v[ 9]);
2252 u[ 5] = k_packs_epi64(v[10], v[11]);
2253 u[ 6] = k_packs_epi64(v[12], v[13]);
2254 u[ 7] = k_packs_epi64(v[14], v[15]);
2255 u[ 8] = k_packs_epi64(v[16], v[17]);
2256 u[ 9] = k_packs_epi64(v[18], v[19]);
2257 u[10] = k_packs_epi64(v[20], v[21]);
2258 u[11] = k_packs_epi64(v[22], v[23]);
2259 u[12] = k_packs_epi64(v[24], v[25]);
2260 u[13] = k_packs_epi64(v[26], v[27]);
2261 u[14] = k_packs_epi64(v[28], v[29]);
2262 u[15] = k_packs_epi64(v[30], v[31]);
2263
2264 v[ 0] = _mm_add_epi32(u[ 0], k__DCT_CONST_ROUNDING);
2265 v[ 1] = _mm_add_epi32(u[ 1], k__DCT_CONST_ROUNDING);
2266 v[ 2] = _mm_add_epi32(u[ 2], k__DCT_CONST_ROUNDING);
2267 v[ 3] = _mm_add_epi32(u[ 3], k__DCT_CONST_ROUNDING);
2268 v[ 4] = _mm_add_epi32(u[ 4], k__DCT_CONST_ROUNDING);
2269 v[ 5] = _mm_add_epi32(u[ 5], k__DCT_CONST_ROUNDING);
2270 v[ 6] = _mm_add_epi32(u[ 6], k__DCT_CONST_ROUNDING);
2271 v[ 7] = _mm_add_epi32(u[ 7], k__DCT_CONST_ROUNDING);
2272 v[ 8] = _mm_add_epi32(u[ 8], k__DCT_CONST_ROUNDING);
2273 v[ 9] = _mm_add_epi32(u[ 9], k__DCT_CONST_ROUNDING);
2274 v[10] = _mm_add_epi32(u[10], k__DCT_CONST_ROUNDING);
2275 v[11] = _mm_add_epi32(u[11], k__DCT_CONST_ROUNDING);
2276 v[12] = _mm_add_epi32(u[12], k__DCT_CONST_ROUNDING);
2277 v[13] = _mm_add_epi32(u[13], k__DCT_CONST_ROUNDING);
2278 v[14] = _mm_add_epi32(u[14], k__DCT_CONST_ROUNDING);
2279 v[15] = _mm_add_epi32(u[15], k__DCT_CONST_ROUNDING);
2280
2281 u[ 0] = _mm_srai_epi32(v[ 0], DCT_CONST_BITS);
2282 u[ 1] = _mm_srai_epi32(v[ 1], DCT_CONST_BITS);
2283 u[ 2] = _mm_srai_epi32(v[ 2], DCT_CONST_BITS);
2284 u[ 3] = _mm_srai_epi32(v[ 3], DCT_CONST_BITS);
2285 u[ 4] = _mm_srai_epi32(v[ 4], DCT_CONST_BITS);
2286 u[ 5] = _mm_srai_epi32(v[ 5], DCT_CONST_BITS);
2287 u[ 6] = _mm_srai_epi32(v[ 6], DCT_CONST_BITS);
2288 u[ 7] = _mm_srai_epi32(v[ 7], DCT_CONST_BITS);
2289 u[ 8] = _mm_srai_epi32(v[ 8], DCT_CONST_BITS);
2290 u[ 9] = _mm_srai_epi32(v[ 9], DCT_CONST_BITS);
2291 u[10] = _mm_srai_epi32(v[10], DCT_CONST_BITS);
2292 u[11] = _mm_srai_epi32(v[11], DCT_CONST_BITS);
2293 u[12] = _mm_srai_epi32(v[12], DCT_CONST_BITS);
2294 u[13] = _mm_srai_epi32(v[13], DCT_CONST_BITS);
2295 u[14] = _mm_srai_epi32(v[14], DCT_CONST_BITS);
2296 u[15] = _mm_srai_epi32(v[15], DCT_CONST_BITS);
2297
2298 v[ 0] = _mm_cmplt_epi32(u[ 0], kZero);
2299 v[ 1] = _mm_cmplt_epi32(u[ 1], kZero);
2300 v[ 2] = _mm_cmplt_epi32(u[ 2], kZero);
2301 v[ 3] = _mm_cmplt_epi32(u[ 3], kZero);
2302 v[ 4] = _mm_cmplt_epi32(u[ 4], kZero);
2303 v[ 5] = _mm_cmplt_epi32(u[ 5], kZero);
2304 v[ 6] = _mm_cmplt_epi32(u[ 6], kZero);
2305 v[ 7] = _mm_cmplt_epi32(u[ 7], kZero);
2306 v[ 8] = _mm_cmplt_epi32(u[ 8], kZero);
2307 v[ 9] = _mm_cmplt_epi32(u[ 9], kZero);
2308 v[10] = _mm_cmplt_epi32(u[10], kZero);
2309 v[11] = _mm_cmplt_epi32(u[11], kZero);
2310 v[12] = _mm_cmplt_epi32(u[12], kZero);
2311 v[13] = _mm_cmplt_epi32(u[13], kZero);
2312 v[14] = _mm_cmplt_epi32(u[14], kZero);
2313 v[15] = _mm_cmplt_epi32(u[15], kZero);
2314
2315 u[ 0] = _mm_sub_epi32(u[ 0], v[ 0]);
2316 u[ 1] = _mm_sub_epi32(u[ 1], v[ 1]);
2317 u[ 2] = _mm_sub_epi32(u[ 2], v[ 2]);
2318 u[ 3] = _mm_sub_epi32(u[ 3], v[ 3]);
2319 u[ 4] = _mm_sub_epi32(u[ 4], v[ 4]);
2320 u[ 5] = _mm_sub_epi32(u[ 5], v[ 5]);
2321 u[ 6] = _mm_sub_epi32(u[ 6], v[ 6]);
2322 u[ 7] = _mm_sub_epi32(u[ 7], v[ 7]);
2323 u[ 8] = _mm_sub_epi32(u[ 8], v[ 8]);
2324 u[ 9] = _mm_sub_epi32(u[ 9], v[ 9]);
2325 u[10] = _mm_sub_epi32(u[10], v[10]);
2326 u[11] = _mm_sub_epi32(u[11], v[11]);
2327 u[12] = _mm_sub_epi32(u[12], v[12]);
2328 u[13] = _mm_sub_epi32(u[13], v[13]);
2329 u[14] = _mm_sub_epi32(u[14], v[14]);
2330 u[15] = _mm_sub_epi32(u[15], v[15]);
2331
2332 v[0] = _mm_add_epi32(u[0], K32One);
2333 v[1] = _mm_add_epi32(u[1], K32One);
2334 v[2] = _mm_add_epi32(u[2], K32One);
2335 v[3] = _mm_add_epi32(u[3], K32One);
2336 v[4] = _mm_add_epi32(u[4], K32One);
2337 v[5] = _mm_add_epi32(u[5], K32One);
2338 v[6] = _mm_add_epi32(u[6], K32One);
2339 v[7] = _mm_add_epi32(u[7], K32One);
2340 v[8] = _mm_add_epi32(u[8], K32One);
2341 v[9] = _mm_add_epi32(u[9], K32One);
2342 v[10] = _mm_add_epi32(u[10], K32One);
2343 v[11] = _mm_add_epi32(u[11], K32One);
2344 v[12] = _mm_add_epi32(u[12], K32One);
2345 v[13] = _mm_add_epi32(u[13], K32One);
2346 v[14] = _mm_add_epi32(u[14], K32One);
2347 v[15] = _mm_add_epi32(u[15], K32One);
2348
2349 u[0] = _mm_srai_epi32(v[0], 2);
2350 u[1] = _mm_srai_epi32(v[1], 2);
2351 u[2] = _mm_srai_epi32(v[2], 2);
2352 u[3] = _mm_srai_epi32(v[3], 2);
2353 u[4] = _mm_srai_epi32(v[4], 2);
2354 u[5] = _mm_srai_epi32(v[5], 2);
2355 u[6] = _mm_srai_epi32(v[6], 2);
2356 u[7] = _mm_srai_epi32(v[7], 2);
2357 u[8] = _mm_srai_epi32(v[8], 2);
2358 u[9] = _mm_srai_epi32(v[9], 2);
2359 u[10] = _mm_srai_epi32(v[10], 2);
2360 u[11] = _mm_srai_epi32(v[11], 2);
2361 u[12] = _mm_srai_epi32(v[12], 2);
2362 u[13] = _mm_srai_epi32(v[13], 2);
2363 u[14] = _mm_srai_epi32(v[14], 2);
2364 u[15] = _mm_srai_epi32(v[15], 2);
2365
2366 out[ 1] = _mm_packs_epi32(u[0], u[1]);
2367 out[17] = _mm_packs_epi32(u[2], u[3]);
2368 out[ 9] = _mm_packs_epi32(u[4], u[5]);
2369 out[25] = _mm_packs_epi32(u[6], u[7]);
2370 out[ 7] = _mm_packs_epi32(u[8], u[9]);
2371 out[23] = _mm_packs_epi32(u[10], u[11]);
2372 out[15] = _mm_packs_epi32(u[12], u[13]);
2373 out[31] = _mm_packs_epi32(u[14], u[15]);
2374 }
2375 {
2376 const __m128i k32_p27_p05 = pair_set_epi32(cospi_27_64, cospi_5_64);
2377 const __m128i k32_p11_p21 = pair_set_epi32(cospi_11_64, cospi_21_64);
2378 const __m128i k32_p19_p13 = pair_set_epi32(cospi_19_64, cospi_13_64);
2379 const __m128i k32_p03_p29 = pair_set_epi32(cospi_3_64, cospi_29_64);
2380 const __m128i k32_m29_p03 = pair_set_epi32(-cospi_29_64, cospi_3_64);
2381 const __m128i k32_m13_p19 = pair_set_epi32(-cospi_13_64, cospi_19_64);
2382 const __m128i k32_m21_p11 = pair_set_epi32(-cospi_21_64, cospi_11_64);
2383 const __m128i k32_m05_p27 = pair_set_epi32(-cospi_5_64, cospi_27_64);
2384
2385 u[ 0] = _mm_unpacklo_epi32(lstep1[40], lstep1[54]);
2386 u[ 1] = _mm_unpackhi_epi32(lstep1[40], lstep1[54]);
2387 u[ 2] = _mm_unpacklo_epi32(lstep1[41], lstep1[55]);
2388 u[ 3] = _mm_unpackhi_epi32(lstep1[41], lstep1[55]);
2389 u[ 4] = _mm_unpacklo_epi32(lstep1[42], lstep1[52]);
2390 u[ 5] = _mm_unpackhi_epi32(lstep1[42], lstep1[52]);
2391 u[ 6] = _mm_unpacklo_epi32(lstep1[43], lstep1[53]);
2392 u[ 7] = _mm_unpackhi_epi32(lstep1[43], lstep1[53]);
2393 u[ 8] = _mm_unpacklo_epi32(lstep1[44], lstep1[50]);
2394 u[ 9] = _mm_unpackhi_epi32(lstep1[44], lstep1[50]);
2395 u[10] = _mm_unpacklo_epi32(lstep1[45], lstep1[51]);
2396 u[11] = _mm_unpackhi_epi32(lstep1[45], lstep1[51]);
2397 u[12] = _mm_unpacklo_epi32(lstep1[46], lstep1[48]);
2398 u[13] = _mm_unpackhi_epi32(lstep1[46], lstep1[48]);
2399 u[14] = _mm_unpacklo_epi32(lstep1[47], lstep1[49]);
2400 u[15] = _mm_unpackhi_epi32(lstep1[47], lstep1[49]);
2401
2402 v[ 0] = k_madd_epi32(u[ 0], k32_p27_p05);
2403 v[ 1] = k_madd_epi32(u[ 1], k32_p27_p05);
2404 v[ 2] = k_madd_epi32(u[ 2], k32_p27_p05);
2405 v[ 3] = k_madd_epi32(u[ 3], k32_p27_p05);
2406 v[ 4] = k_madd_epi32(u[ 4], k32_p11_p21);
2407 v[ 5] = k_madd_epi32(u[ 5], k32_p11_p21);
2408 v[ 6] = k_madd_epi32(u[ 6], k32_p11_p21);
2409 v[ 7] = k_madd_epi32(u[ 7], k32_p11_p21);
2410 v[ 8] = k_madd_epi32(u[ 8], k32_p19_p13);
2411 v[ 9] = k_madd_epi32(u[ 9], k32_p19_p13);
2412 v[10] = k_madd_epi32(u[10], k32_p19_p13);
2413 v[11] = k_madd_epi32(u[11], k32_p19_p13);
2414 v[12] = k_madd_epi32(u[12], k32_p03_p29);
2415 v[13] = k_madd_epi32(u[13], k32_p03_p29);
2416 v[14] = k_madd_epi32(u[14], k32_p03_p29);
2417 v[15] = k_madd_epi32(u[15], k32_p03_p29);
2418 v[16] = k_madd_epi32(u[12], k32_m29_p03);
2419 v[17] = k_madd_epi32(u[13], k32_m29_p03);
2420 v[18] = k_madd_epi32(u[14], k32_m29_p03);
2421 v[19] = k_madd_epi32(u[15], k32_m29_p03);
2422 v[20] = k_madd_epi32(u[ 8], k32_m13_p19);
2423 v[21] = k_madd_epi32(u[ 9], k32_m13_p19);
2424 v[22] = k_madd_epi32(u[10], k32_m13_p19);
2425 v[23] = k_madd_epi32(u[11], k32_m13_p19);
2426 v[24] = k_madd_epi32(u[ 4], k32_m21_p11);
2427 v[25] = k_madd_epi32(u[ 5], k32_m21_p11);
2428 v[26] = k_madd_epi32(u[ 6], k32_m21_p11);
2429 v[27] = k_madd_epi32(u[ 7], k32_m21_p11);
2430 v[28] = k_madd_epi32(u[ 0], k32_m05_p27);
2431 v[29] = k_madd_epi32(u[ 1], k32_m05_p27);
2432 v[30] = k_madd_epi32(u[ 2], k32_m05_p27);
2433 v[31] = k_madd_epi32(u[ 3], k32_m05_p27);
2434
2435 u[ 0] = k_packs_epi64(v[ 0], v[ 1]);
2436 u[ 1] = k_packs_epi64(v[ 2], v[ 3]);
2437 u[ 2] = k_packs_epi64(v[ 4], v[ 5]);
2438 u[ 3] = k_packs_epi64(v[ 6], v[ 7]);
2439 u[ 4] = k_packs_epi64(v[ 8], v[ 9]);
2440 u[ 5] = k_packs_epi64(v[10], v[11]);
2441 u[ 6] = k_packs_epi64(v[12], v[13]);
2442 u[ 7] = k_packs_epi64(v[14], v[15]);
2443 u[ 8] = k_packs_epi64(v[16], v[17]);
2444 u[ 9] = k_packs_epi64(v[18], v[19]);
2445 u[10] = k_packs_epi64(v[20], v[21]);
2446 u[11] = k_packs_epi64(v[22], v[23]);
2447 u[12] = k_packs_epi64(v[24], v[25]);
2448 u[13] = k_packs_epi64(v[26], v[27]);
2449 u[14] = k_packs_epi64(v[28], v[29]);
2450 u[15] = k_packs_epi64(v[30], v[31]);
2451
2452 v[ 0] = _mm_add_epi32(u[ 0], k__DCT_CONST_ROUNDING);
2453 v[ 1] = _mm_add_epi32(u[ 1], k__DCT_CONST_ROUNDING);
2454 v[ 2] = _mm_add_epi32(u[ 2], k__DCT_CONST_ROUNDING);
2455 v[ 3] = _mm_add_epi32(u[ 3], k__DCT_CONST_ROUNDING);
2456 v[ 4] = _mm_add_epi32(u[ 4], k__DCT_CONST_ROUNDING);
2457 v[ 5] = _mm_add_epi32(u[ 5], k__DCT_CONST_ROUNDING);
2458 v[ 6] = _mm_add_epi32(u[ 6], k__DCT_CONST_ROUNDING);
2459 v[ 7] = _mm_add_epi32(u[ 7], k__DCT_CONST_ROUNDING);
2460 v[ 8] = _mm_add_epi32(u[ 8], k__DCT_CONST_ROUNDING);
2461 v[ 9] = _mm_add_epi32(u[ 9], k__DCT_CONST_ROUNDING);
2462 v[10] = _mm_add_epi32(u[10], k__DCT_CONST_ROUNDING);
2463 v[11] = _mm_add_epi32(u[11], k__DCT_CONST_ROUNDING);
2464 v[12] = _mm_add_epi32(u[12], k__DCT_CONST_ROUNDING);
2465 v[13] = _mm_add_epi32(u[13], k__DCT_CONST_ROUNDING);
2466 v[14] = _mm_add_epi32(u[14], k__DCT_CONST_ROUNDING);
2467 v[15] = _mm_add_epi32(u[15], k__DCT_CONST_ROUNDING);
2468
2469 u[ 0] = _mm_srai_epi32(v[ 0], DCT_CONST_BITS);
2470 u[ 1] = _mm_srai_epi32(v[ 1], DCT_CONST_BITS);
2471 u[ 2] = _mm_srai_epi32(v[ 2], DCT_CONST_BITS);
2472 u[ 3] = _mm_srai_epi32(v[ 3], DCT_CONST_BITS);
2473 u[ 4] = _mm_srai_epi32(v[ 4], DCT_CONST_BITS);
2474 u[ 5] = _mm_srai_epi32(v[ 5], DCT_CONST_BITS);
2475 u[ 6] = _mm_srai_epi32(v[ 6], DCT_CONST_BITS);
2476 u[ 7] = _mm_srai_epi32(v[ 7], DCT_CONST_BITS);
2477 u[ 8] = _mm_srai_epi32(v[ 8], DCT_CONST_BITS);
2478 u[ 9] = _mm_srai_epi32(v[ 9], DCT_CONST_BITS);
2479 u[10] = _mm_srai_epi32(v[10], DCT_CONST_BITS);
2480 u[11] = _mm_srai_epi32(v[11], DCT_CONST_BITS);
2481 u[12] = _mm_srai_epi32(v[12], DCT_CONST_BITS);
2482 u[13] = _mm_srai_epi32(v[13], DCT_CONST_BITS);
2483 u[14] = _mm_srai_epi32(v[14], DCT_CONST_BITS);
2484 u[15] = _mm_srai_epi32(v[15], DCT_CONST_BITS);
2485
2486 v[ 0] = _mm_cmplt_epi32(u[ 0], kZero);
2487 v[ 1] = _mm_cmplt_epi32(u[ 1], kZero);
2488 v[ 2] = _mm_cmplt_epi32(u[ 2], kZero);
2489 v[ 3] = _mm_cmplt_epi32(u[ 3], kZero);
2490 v[ 4] = _mm_cmplt_epi32(u[ 4], kZero);
2491 v[ 5] = _mm_cmplt_epi32(u[ 5], kZero);
2492 v[ 6] = _mm_cmplt_epi32(u[ 6], kZero);
2493 v[ 7] = _mm_cmplt_epi32(u[ 7], kZero);
2494 v[ 8] = _mm_cmplt_epi32(u[ 8], kZero);
2495 v[ 9] = _mm_cmplt_epi32(u[ 9], kZero);
2496 v[10] = _mm_cmplt_epi32(u[10], kZero);
2497 v[11] = _mm_cmplt_epi32(u[11], kZero);
2498 v[12] = _mm_cmplt_epi32(u[12], kZero);
2499 v[13] = _mm_cmplt_epi32(u[13], kZero);
2500 v[14] = _mm_cmplt_epi32(u[14], kZero);
2501 v[15] = _mm_cmplt_epi32(u[15], kZero);
2502
2503 u[ 0] = _mm_sub_epi32(u[ 0], v[ 0]);
2504 u[ 1] = _mm_sub_epi32(u[ 1], v[ 1]);
2505 u[ 2] = _mm_sub_epi32(u[ 2], v[ 2]);
2506 u[ 3] = _mm_sub_epi32(u[ 3], v[ 3]);
2507 u[ 4] = _mm_sub_epi32(u[ 4], v[ 4]);
2508 u[ 5] = _mm_sub_epi32(u[ 5], v[ 5]);
2509 u[ 6] = _mm_sub_epi32(u[ 6], v[ 6]);
2510 u[ 7] = _mm_sub_epi32(u[ 7], v[ 7]);
2511 u[ 8] = _mm_sub_epi32(u[ 8], v[ 8]);
2512 u[ 9] = _mm_sub_epi32(u[ 9], v[ 9]);
2513 u[10] = _mm_sub_epi32(u[10], v[10]);
2514 u[11] = _mm_sub_epi32(u[11], v[11]);
2515 u[12] = _mm_sub_epi32(u[12], v[12]);
2516 u[13] = _mm_sub_epi32(u[13], v[13]);
2517 u[14] = _mm_sub_epi32(u[14], v[14]);
2518 u[15] = _mm_sub_epi32(u[15], v[15]);
2519
2520 v[0] = _mm_add_epi32(u[0], K32One);
2521 v[1] = _mm_add_epi32(u[1], K32One);
2522 v[2] = _mm_add_epi32(u[2], K32One);
2523 v[3] = _mm_add_epi32(u[3], K32One);
2524 v[4] = _mm_add_epi32(u[4], K32One);
2525 v[5] = _mm_add_epi32(u[5], K32One);
2526 v[6] = _mm_add_epi32(u[6], K32One);
2527 v[7] = _mm_add_epi32(u[7], K32One);
2528 v[8] = _mm_add_epi32(u[8], K32One);
2529 v[9] = _mm_add_epi32(u[9], K32One);
2530 v[10] = _mm_add_epi32(u[10], K32One);
2531 v[11] = _mm_add_epi32(u[11], K32One);
2532 v[12] = _mm_add_epi32(u[12], K32One);
2533 v[13] = _mm_add_epi32(u[13], K32One);
2534 v[14] = _mm_add_epi32(u[14], K32One);
2535 v[15] = _mm_add_epi32(u[15], K32One);
2536
2537 u[0] = _mm_srai_epi32(v[0], 2);
2538 u[1] = _mm_srai_epi32(v[1], 2);
2539 u[2] = _mm_srai_epi32(v[2], 2);
2540 u[3] = _mm_srai_epi32(v[3], 2);
2541 u[4] = _mm_srai_epi32(v[4], 2);
2542 u[5] = _mm_srai_epi32(v[5], 2);
2543 u[6] = _mm_srai_epi32(v[6], 2);
2544 u[7] = _mm_srai_epi32(v[7], 2);
2545 u[8] = _mm_srai_epi32(v[8], 2);
2546 u[9] = _mm_srai_epi32(v[9], 2);
2547 u[10] = _mm_srai_epi32(v[10], 2);
2548 u[11] = _mm_srai_epi32(v[11], 2);
2549 u[12] = _mm_srai_epi32(v[12], 2);
2550 u[13] = _mm_srai_epi32(v[13], 2);
2551 u[14] = _mm_srai_epi32(v[14], 2);
2552 u[15] = _mm_srai_epi32(v[15], 2);
2553
2554 out[ 5] = _mm_packs_epi32(u[0], u[1]);
2555 out[21] = _mm_packs_epi32(u[2], u[3]);
2556 out[13] = _mm_packs_epi32(u[4], u[5]);
2557 out[29] = _mm_packs_epi32(u[6], u[7]);
2558 out[ 3] = _mm_packs_epi32(u[8], u[9]);
2559 out[19] = _mm_packs_epi32(u[10], u[11]);
2560 out[11] = _mm_packs_epi32(u[12], u[13]);
2561 out[27] = _mm_packs_epi32(u[14], u[15]);
2562 }
2563 }
2564 #endif
2565 // Transpose the results, do it as four 8x8 transposes.
2566 {
2567 int transpose_block;
2568 int16_t *output;
2569 if (0 == pass) {
2570 output = &intermediate[column_start * 32];
2571 } else {
2572 output = &output_org[column_start * 32];
2573 }
2574 for (transpose_block = 0; transpose_block < 4; ++transpose_block) {
2575 __m128i *this_out = &out[8 * transpose_block];
2576 // 00 01 02 03 04 05 06 07
2577 // 10 11 12 13 14 15 16 17
2578 // 20 21 22 23 24 25 26 27
2579 // 30 31 32 33 34 35 36 37
2580 // 40 41 42 43 44 45 46 47
2581 // 50 51 52 53 54 55 56 57
2582 // 60 61 62 63 64 65 66 67
2583 // 70 71 72 73 74 75 76 77
2584 const __m128i tr0_0 = _mm_unpacklo_epi16(this_out[0], this_out[1]);
2585 const __m128i tr0_1 = _mm_unpacklo_epi16(this_out[2], this_out[3]);
2586 const __m128i tr0_2 = _mm_unpackhi_epi16(this_out[0], this_out[1]);
2587 const __m128i tr0_3 = _mm_unpackhi_epi16(this_out[2], this_out[3]);
2588 const __m128i tr0_4 = _mm_unpacklo_epi16(this_out[4], this_out[5]);
2589 const __m128i tr0_5 = _mm_unpacklo_epi16(this_out[6], this_out[7]);
2590 const __m128i tr0_6 = _mm_unpackhi_epi16(this_out[4], this_out[5]);
2591 const __m128i tr0_7 = _mm_unpackhi_epi16(this_out[6], this_out[7]);
2592 // 00 10 01 11 02 12 03 13
2593 // 20 30 21 31 22 32 23 33
2594 // 04 14 05 15 06 16 07 17
2595 // 24 34 25 35 26 36 27 37
2596 // 40 50 41 51 42 52 43 53
2597 // 60 70 61 71 62 72 63 73
2598 // 54 54 55 55 56 56 57 57
2599 // 64 74 65 75 66 76 67 77
2600 const __m128i tr1_0 = _mm_unpacklo_epi32(tr0_0, tr0_1);
2601 const __m128i tr1_1 = _mm_unpacklo_epi32(tr0_2, tr0_3);
2602 const __m128i tr1_2 = _mm_unpackhi_epi32(tr0_0, tr0_1);
2603 const __m128i tr1_3 = _mm_unpackhi_epi32(tr0_2, tr0_3);
2604 const __m128i tr1_4 = _mm_unpacklo_epi32(tr0_4, tr0_5);
2605 const __m128i tr1_5 = _mm_unpacklo_epi32(tr0_6, tr0_7);
2606 const __m128i tr1_6 = _mm_unpackhi_epi32(tr0_4, tr0_5);
2607 const __m128i tr1_7 = _mm_unpackhi_epi32(tr0_6, tr0_7);
2608 // 00 10 20 30 01 11 21 31
2609 // 40 50 60 70 41 51 61 71
2610 // 02 12 22 32 03 13 23 33
2611 // 42 52 62 72 43 53 63 73
2612 // 04 14 24 34 05 15 21 36
2613 // 44 54 64 74 45 55 61 76
2614 // 06 16 26 36 07 17 27 37
2615 // 46 56 66 76 47 57 67 77
2616 __m128i tr2_0 = _mm_unpacklo_epi64(tr1_0, tr1_4);
2617 __m128i tr2_1 = _mm_unpackhi_epi64(tr1_0, tr1_4);
2618 __m128i tr2_2 = _mm_unpacklo_epi64(tr1_2, tr1_6);
2619 __m128i tr2_3 = _mm_unpackhi_epi64(tr1_2, tr1_6);
2620 __m128i tr2_4 = _mm_unpacklo_epi64(tr1_1, tr1_5);
2621 __m128i tr2_5 = _mm_unpackhi_epi64(tr1_1, tr1_5);
2622 __m128i tr2_6 = _mm_unpacklo_epi64(tr1_3, tr1_7);
2623 __m128i tr2_7 = _mm_unpackhi_epi64(tr1_3, tr1_7);
2624 // 00 10 20 30 40 50 60 70
2625 // 01 11 21 31 41 51 61 71
2626 // 02 12 22 32 42 52 62 72
2627 // 03 13 23 33 43 53 63 73
2628 // 04 14 24 34 44 54 64 74
2629 // 05 15 25 35 45 55 65 75
2630 // 06 16 26 36 46 56 66 76
2631 // 07 17 27 37 47 57 67 77
2632 if (0 == pass) {
2633 // output[j] = (output[j] + 1 + (output[j] > 0)) >> 2;
2634 // TODO(cd): see quality impact of only doing
2635 // output[j] = (output[j] + 1) >> 2;
2636 // which would remove the code between here ...
2637 __m128i tr2_0_0 = _mm_cmpgt_epi16(tr2_0, kZero);
2638 __m128i tr2_1_0 = _mm_cmpgt_epi16(tr2_1, kZero);
2639 __m128i tr2_2_0 = _mm_cmpgt_epi16(tr2_2, kZero);
2640 __m128i tr2_3_0 = _mm_cmpgt_epi16(tr2_3, kZero);
2641 __m128i tr2_4_0 = _mm_cmpgt_epi16(tr2_4, kZero);
2642 __m128i tr2_5_0 = _mm_cmpgt_epi16(tr2_5, kZero);
2643 __m128i tr2_6_0 = _mm_cmpgt_epi16(tr2_6, kZero);
2644 __m128i tr2_7_0 = _mm_cmpgt_epi16(tr2_7, kZero);
2645 tr2_0 = _mm_sub_epi16(tr2_0, tr2_0_0);
2646 tr2_1 = _mm_sub_epi16(tr2_1, tr2_1_0);
2647 tr2_2 = _mm_sub_epi16(tr2_2, tr2_2_0);
2648 tr2_3 = _mm_sub_epi16(tr2_3, tr2_3_0);
2649 tr2_4 = _mm_sub_epi16(tr2_4, tr2_4_0);
2650 tr2_5 = _mm_sub_epi16(tr2_5, tr2_5_0);
2651 tr2_6 = _mm_sub_epi16(tr2_6, tr2_6_0);
2652 tr2_7 = _mm_sub_epi16(tr2_7, tr2_7_0);
2653 // ... and here.
2654 // PS: also change code in vp9/encoder/vp9_dct.c
2655 tr2_0 = _mm_add_epi16(tr2_0, kOne);
2656 tr2_1 = _mm_add_epi16(tr2_1, kOne);
2657 tr2_2 = _mm_add_epi16(tr2_2, kOne);
2658 tr2_3 = _mm_add_epi16(tr2_3, kOne);
2659 tr2_4 = _mm_add_epi16(tr2_4, kOne);
2660 tr2_5 = _mm_add_epi16(tr2_5, kOne);
2661 tr2_6 = _mm_add_epi16(tr2_6, kOne);
2662 tr2_7 = _mm_add_epi16(tr2_7, kOne);
2663 tr2_0 = _mm_srai_epi16(tr2_0, 2);
2664 tr2_1 = _mm_srai_epi16(tr2_1, 2);
2665 tr2_2 = _mm_srai_epi16(tr2_2, 2);
2666 tr2_3 = _mm_srai_epi16(tr2_3, 2);
2667 tr2_4 = _mm_srai_epi16(tr2_4, 2);
2668 tr2_5 = _mm_srai_epi16(tr2_5, 2);
2669 tr2_6 = _mm_srai_epi16(tr2_6, 2);
2670 tr2_7 = _mm_srai_epi16(tr2_7, 2);
2671 }
2672 // Note: even though all these stores are aligned, using the aligned
2673 // intrinsic make the code slightly slower.
2674 _mm_storeu_si128((__m128i *)(output + 0 * 32), tr2_0);
2675 _mm_storeu_si128((__m128i *)(output + 1 * 32), tr2_1);
2676 _mm_storeu_si128((__m128i *)(output + 2 * 32), tr2_2);
2677 _mm_storeu_si128((__m128i *)(output + 3 * 32), tr2_3);
2678 _mm_storeu_si128((__m128i *)(output + 4 * 32), tr2_4);
2679 _mm_storeu_si128((__m128i *)(output + 5 * 32), tr2_5);
2680 _mm_storeu_si128((__m128i *)(output + 6 * 32), tr2_6);
2681 _mm_storeu_si128((__m128i *)(output + 7 * 32), tr2_7);
2682 // Process next 8x8
2683 output += 8;
2684 }
2685 }
2686 }
2687 }
2688 } // NOLINT
2689