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 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 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 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
