| OLD | NEW |
| 1 /* | 1 /* |
| 2 * Copyright (c) 2012 The WebM project authors. All Rights Reserved. | 2 * Copyright (c) 2012 The WebM project authors. All Rights Reserved. |
| 3 * | 3 * |
| 4 * Use of this source code is governed by a BSD-style license | 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 | 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 | 6 * tree. An additional intellectual property rights grant can be found |
| 7 * in the file PATENTS. All contributing project authors may | 7 * in the file PATENTS. All contributing project authors may |
| 8 * be found in the AUTHORS file in the root of the source tree. | 8 * be found in the AUTHORS file in the root of the source tree. |
| 9 */ | 9 */ |
| 10 | 10 |
| (...skipping 2554 matching lines...) Expand 10 before | Expand all | Expand 10 after Loading... |
| 2565 right_shift_16x16(in0, in1); | 2565 right_shift_16x16(in0, in1); |
| 2566 fadst16_1d_sse2(in0, in1); | 2566 fadst16_1d_sse2(in0, in1); |
| 2567 break; | 2567 break; |
| 2568 default: | 2568 default: |
| 2569 assert(0); | 2569 assert(0); |
| 2570 break; | 2570 break; |
| 2571 } | 2571 } |
| 2572 write_buffer_16x16(output, in0, in1, 16); | 2572 write_buffer_16x16(output, in0, in1, 16); |
| 2573 } | 2573 } |
| 2574 | 2574 |
| 2575 void vp9_short_fdct32x32_rd_sse2(int16_t *input, | 2575 #define FDCT32x32_2D vp9_short_fdct32x32_rd_sse2 |
| 2576 int16_t *output_org, int pitch) { | 2576 #define FDCT32x32_HIGH_PRECISION 0 |
| 2577 // Calculate pre-multiplied strides | 2577 #include "vp9/encoder/x86/vp9_dct32x32_sse2.c" |
| 2578 const int str1 = pitch >> 1; | 2578 #undef FDCT32x32_2D |
| 2579 const int str2 = pitch; | 2579 #undef FDCT32x32_HIGH_PRECISION |
| 2580 const int str3 = pitch + str1; | 2580 |
| 2581 // We need an intermediate buffer between passes. | 2581 #define FDCT32x32_2D vp9_short_fdct32x32_sse2 |
| 2582 DECLARE_ALIGNED(16, int16_t, intermediate[32 * 32]); | 2582 #define FDCT32x32_HIGH_PRECISION 1 |
| 2583 // Constants | 2583 #include "vp9/encoder/x86/vp9_dct32x32_sse2.c" // NOLINT |
| 2584 // When we use them, in one case, they are all the same. In all others | 2584 #undef FDCT32x32_2D |
| 2585 // it's a pair of them that we need to repeat four times. This is done | 2585 #undef FDCT32x32_HIGH_PRECISION |
| 2586 // by constructing the 32 bit constant corresponding to that pair. | |
| 2587 const __m128i k__cospi_p16_p16 = _mm_set1_epi16(+cospi_16_64); | |
| 2588 const __m128i k__cospi_p16_m16 = pair_set_epi16(+cospi_16_64, -cospi_16_64); | |
| 2589 const __m128i k__cospi_m08_p24 = pair_set_epi16(-cospi_8_64, cospi_24_64); | |
| 2590 const __m128i k__cospi_m24_m08 = pair_set_epi16(-cospi_24_64, -cospi_8_64); | |
| 2591 const __m128i k__cospi_p24_p08 = pair_set_epi16(+cospi_24_64, cospi_8_64); | |
| 2592 const __m128i k__cospi_p12_p20 = pair_set_epi16(+cospi_12_64, cospi_20_64); | |
| 2593 const __m128i k__cospi_m20_p12 = pair_set_epi16(-cospi_20_64, cospi_12_64); | |
| 2594 const __m128i k__cospi_m04_p28 = pair_set_epi16(-cospi_4_64, cospi_28_64); | |
| 2595 const __m128i k__cospi_p28_p04 = pair_set_epi16(+cospi_28_64, cospi_4_64); | |
| 2596 const __m128i k__cospi_m28_m04 = pair_set_epi16(-cospi_28_64, -cospi_4_64); | |
| 2597 const __m128i k__cospi_m12_m20 = pair_set_epi16(-cospi_12_64, -cospi_20_64); | |
| 2598 const __m128i k__cospi_p30_p02 = pair_set_epi16(+cospi_30_64, cospi_2_64); | |
| 2599 const __m128i k__cospi_p14_p18 = pair_set_epi16(+cospi_14_64, cospi_18_64); | |
| 2600 const __m128i k__cospi_p22_p10 = pair_set_epi16(+cospi_22_64, cospi_10_64); | |
| 2601 const __m128i k__cospi_p06_p26 = pair_set_epi16(+cospi_6_64, cospi_26_64); | |
| 2602 const __m128i k__cospi_m26_p06 = pair_set_epi16(-cospi_26_64, cospi_6_64); | |
| 2603 const __m128i k__cospi_m10_p22 = pair_set_epi16(-cospi_10_64, cospi_22_64); | |
| 2604 const __m128i k__cospi_m18_p14 = pair_set_epi16(-cospi_18_64, cospi_14_64); | |
| 2605 const __m128i k__cospi_m02_p30 = pair_set_epi16(-cospi_2_64, cospi_30_64); | |
| 2606 const __m128i k__cospi_p31_p01 = pair_set_epi16(+cospi_31_64, cospi_1_64); | |
| 2607 const __m128i k__cospi_p15_p17 = pair_set_epi16(+cospi_15_64, cospi_17_64); | |
| 2608 const __m128i k__cospi_p23_p09 = pair_set_epi16(+cospi_23_64, cospi_9_64); | |
| 2609 const __m128i k__cospi_p07_p25 = pair_set_epi16(+cospi_7_64, cospi_25_64); | |
| 2610 const __m128i k__cospi_m25_p07 = pair_set_epi16(-cospi_25_64, cospi_7_64); | |
| 2611 const __m128i k__cospi_m09_p23 = pair_set_epi16(-cospi_9_64, cospi_23_64); | |
| 2612 const __m128i k__cospi_m17_p15 = pair_set_epi16(-cospi_17_64, cospi_15_64); | |
| 2613 const __m128i k__cospi_m01_p31 = pair_set_epi16(-cospi_1_64, cospi_31_64); | |
| 2614 const __m128i k__cospi_p27_p05 = pair_set_epi16(+cospi_27_64, cospi_5_64); | |
| 2615 const __m128i k__cospi_p11_p21 = pair_set_epi16(+cospi_11_64, cospi_21_64); | |
| 2616 const __m128i k__cospi_p19_p13 = pair_set_epi16(+cospi_19_64, cospi_13_64); | |
| 2617 const __m128i k__cospi_p03_p29 = pair_set_epi16(+cospi_3_64, cospi_29_64); | |
| 2618 const __m128i k__cospi_m29_p03 = pair_set_epi16(-cospi_29_64, cospi_3_64); | |
| 2619 const __m128i k__cospi_m13_p19 = pair_set_epi16(-cospi_13_64, cospi_19_64); | |
| 2620 const __m128i k__cospi_m21_p11 = pair_set_epi16(-cospi_21_64, cospi_11_64); | |
| 2621 const __m128i k__cospi_m05_p27 = pair_set_epi16(-cospi_5_64, cospi_27_64); | |
| 2622 const __m128i k__DCT_CONST_ROUNDING = _mm_set1_epi32(DCT_CONST_ROUNDING); | |
| 2623 const __m128i kZero = _mm_set1_epi16(0); | |
| 2624 const __m128i kOne = _mm_set1_epi16(1); | |
| 2625 // Do the two transform/transpose passes | |
| 2626 int pass; | |
| 2627 for (pass = 0; pass < 2; ++pass) { | |
| 2628 // We process eight columns (transposed rows in second pass) at a time. | |
| 2629 int column_start; | |
| 2630 for (column_start = 0; column_start < 32; column_start += 8) { | |
| 2631 __m128i step1[32]; | |
| 2632 __m128i step2[32]; | |
| 2633 __m128i step3[32]; | |
| 2634 __m128i out[32]; | |
| 2635 // Stage 1 | |
| 2636 // Note: even though all the loads below are aligned, using the aligned | |
| 2637 // intrinsic make the code slightly slower. | |
| 2638 if (0 == pass) { | |
| 2639 int16_t *in = &input[column_start]; | |
| 2640 // step1[i] = (in[ 0 * stride] + in[(32 - 1) * stride]) << 2; | |
| 2641 // Note: the next four blocks could be in a loop. That would help the | |
| 2642 // instruction cache but is actually slower. | |
| 2643 { | |
| 2644 int16_t *ina = in + 0 * str1; | |
| 2645 int16_t *inb = in + 31 * str1; | |
| 2646 __m128i *step1a = &step1[ 0]; | |
| 2647 __m128i *step1b = &step1[31]; | |
| 2648 const __m128i ina0 = _mm_loadu_si128((const __m128i *)(ina)); | |
| 2649 const __m128i ina1 = _mm_loadu_si128((const __m128i *)(ina + str1)); | |
| 2650 const __m128i ina2 = _mm_loadu_si128((const __m128i *)(ina + str2)); | |
| 2651 const __m128i ina3 = _mm_loadu_si128((const __m128i *)(ina + str3)); | |
| 2652 const __m128i inb3 = _mm_loadu_si128((const __m128i *)(inb - str3)); | |
| 2653 const __m128i inb2 = _mm_loadu_si128((const __m128i *)(inb - str2)); | |
| 2654 const __m128i inb1 = _mm_loadu_si128((const __m128i *)(inb - str1)); | |
| 2655 const __m128i inb0 = _mm_loadu_si128((const __m128i *)(inb)); | |
| 2656 step1a[ 0] = _mm_add_epi16(ina0, inb0); | |
| 2657 step1a[ 1] = _mm_add_epi16(ina1, inb1); | |
| 2658 step1a[ 2] = _mm_add_epi16(ina2, inb2); | |
| 2659 step1a[ 3] = _mm_add_epi16(ina3, inb3); | |
| 2660 step1b[-3] = _mm_sub_epi16(ina3, inb3); | |
| 2661 step1b[-2] = _mm_sub_epi16(ina2, inb2); | |
| 2662 step1b[-1] = _mm_sub_epi16(ina1, inb1); | |
| 2663 step1b[-0] = _mm_sub_epi16(ina0, inb0); | |
| 2664 step1a[ 0] = _mm_slli_epi16(step1a[ 0], 2); | |
| 2665 step1a[ 1] = _mm_slli_epi16(step1a[ 1], 2); | |
| 2666 step1a[ 2] = _mm_slli_epi16(step1a[ 2], 2); | |
| 2667 step1a[ 3] = _mm_slli_epi16(step1a[ 3], 2); | |
| 2668 step1b[-3] = _mm_slli_epi16(step1b[-3], 2); | |
| 2669 step1b[-2] = _mm_slli_epi16(step1b[-2], 2); | |
| 2670 step1b[-1] = _mm_slli_epi16(step1b[-1], 2); | |
| 2671 step1b[-0] = _mm_slli_epi16(step1b[-0], 2); | |
| 2672 } | |
| 2673 { | |
| 2674 int16_t *ina = in + 4 * str1; | |
| 2675 int16_t *inb = in + 27 * str1; | |
| 2676 __m128i *step1a = &step1[ 4]; | |
| 2677 __m128i *step1b = &step1[27]; | |
| 2678 const __m128i ina0 = _mm_loadu_si128((const __m128i *)(ina)); | |
| 2679 const __m128i ina1 = _mm_loadu_si128((const __m128i *)(ina + str1)); | |
| 2680 const __m128i ina2 = _mm_loadu_si128((const __m128i *)(ina + str2)); | |
| 2681 const __m128i ina3 = _mm_loadu_si128((const __m128i *)(ina + str3)); | |
| 2682 const __m128i inb3 = _mm_loadu_si128((const __m128i *)(inb - str3)); | |
| 2683 const __m128i inb2 = _mm_loadu_si128((const __m128i *)(inb - str2)); | |
| 2684 const __m128i inb1 = _mm_loadu_si128((const __m128i *)(inb - str1)); | |
| 2685 const __m128i inb0 = _mm_loadu_si128((const __m128i *)(inb)); | |
| 2686 step1a[ 0] = _mm_add_epi16(ina0, inb0); | |
| 2687 step1a[ 1] = _mm_add_epi16(ina1, inb1); | |
| 2688 step1a[ 2] = _mm_add_epi16(ina2, inb2); | |
| 2689 step1a[ 3] = _mm_add_epi16(ina3, inb3); | |
| 2690 step1b[-3] = _mm_sub_epi16(ina3, inb3); | |
| 2691 step1b[-2] = _mm_sub_epi16(ina2, inb2); | |
| 2692 step1b[-1] = _mm_sub_epi16(ina1, inb1); | |
| 2693 step1b[-0] = _mm_sub_epi16(ina0, inb0); | |
| 2694 step1a[ 0] = _mm_slli_epi16(step1a[ 0], 2); | |
| 2695 step1a[ 1] = _mm_slli_epi16(step1a[ 1], 2); | |
| 2696 step1a[ 2] = _mm_slli_epi16(step1a[ 2], 2); | |
| 2697 step1a[ 3] = _mm_slli_epi16(step1a[ 3], 2); | |
| 2698 step1b[-3] = _mm_slli_epi16(step1b[-3], 2); | |
| 2699 step1b[-2] = _mm_slli_epi16(step1b[-2], 2); | |
| 2700 step1b[-1] = _mm_slli_epi16(step1b[-1], 2); | |
| 2701 step1b[-0] = _mm_slli_epi16(step1b[-0], 2); | |
| 2702 } | |
| 2703 { | |
| 2704 int16_t *ina = in + 8 * str1; | |
| 2705 int16_t *inb = in + 23 * str1; | |
| 2706 __m128i *step1a = &step1[ 8]; | |
| 2707 __m128i *step1b = &step1[23]; | |
| 2708 const __m128i ina0 = _mm_loadu_si128((const __m128i *)(ina)); | |
| 2709 const __m128i ina1 = _mm_loadu_si128((const __m128i *)(ina + str1)); | |
| 2710 const __m128i ina2 = _mm_loadu_si128((const __m128i *)(ina + str2)); | |
| 2711 const __m128i ina3 = _mm_loadu_si128((const __m128i *)(ina + str3)); | |
| 2712 const __m128i inb3 = _mm_loadu_si128((const __m128i *)(inb - str3)); | |
| 2713 const __m128i inb2 = _mm_loadu_si128((const __m128i *)(inb - str2)); | |
| 2714 const __m128i inb1 = _mm_loadu_si128((const __m128i *)(inb - str1)); | |
| 2715 const __m128i inb0 = _mm_loadu_si128((const __m128i *)(inb)); | |
| 2716 step1a[ 0] = _mm_add_epi16(ina0, inb0); | |
| 2717 step1a[ 1] = _mm_add_epi16(ina1, inb1); | |
| 2718 step1a[ 2] = _mm_add_epi16(ina2, inb2); | |
| 2719 step1a[ 3] = _mm_add_epi16(ina3, inb3); | |
| 2720 step1b[-3] = _mm_sub_epi16(ina3, inb3); | |
| 2721 step1b[-2] = _mm_sub_epi16(ina2, inb2); | |
| 2722 step1b[-1] = _mm_sub_epi16(ina1, inb1); | |
| 2723 step1b[-0] = _mm_sub_epi16(ina0, inb0); | |
| 2724 step1a[ 0] = _mm_slli_epi16(step1a[ 0], 2); | |
| 2725 step1a[ 1] = _mm_slli_epi16(step1a[ 1], 2); | |
| 2726 step1a[ 2] = _mm_slli_epi16(step1a[ 2], 2); | |
| 2727 step1a[ 3] = _mm_slli_epi16(step1a[ 3], 2); | |
| 2728 step1b[-3] = _mm_slli_epi16(step1b[-3], 2); | |
| 2729 step1b[-2] = _mm_slli_epi16(step1b[-2], 2); | |
| 2730 step1b[-1] = _mm_slli_epi16(step1b[-1], 2); | |
| 2731 step1b[-0] = _mm_slli_epi16(step1b[-0], 2); | |
| 2732 } | |
| 2733 { | |
| 2734 int16_t *ina = in + 12 * str1; | |
| 2735 int16_t *inb = in + 19 * str1; | |
| 2736 __m128i *step1a = &step1[12]; | |
| 2737 __m128i *step1b = &step1[19]; | |
| 2738 const __m128i ina0 = _mm_loadu_si128((const __m128i *)(ina)); | |
| 2739 const __m128i ina1 = _mm_loadu_si128((const __m128i *)(ina + str1)); | |
| 2740 const __m128i ina2 = _mm_loadu_si128((const __m128i *)(ina + str2)); | |
| 2741 const __m128i ina3 = _mm_loadu_si128((const __m128i *)(ina + str3)); | |
| 2742 const __m128i inb3 = _mm_loadu_si128((const __m128i *)(inb - str3)); | |
| 2743 const __m128i inb2 = _mm_loadu_si128((const __m128i *)(inb - str2)); | |
| 2744 const __m128i inb1 = _mm_loadu_si128((const __m128i *)(inb - str1)); | |
| 2745 const __m128i inb0 = _mm_loadu_si128((const __m128i *)(inb)); | |
| 2746 step1a[ 0] = _mm_add_epi16(ina0, inb0); | |
| 2747 step1a[ 1] = _mm_add_epi16(ina1, inb1); | |
| 2748 step1a[ 2] = _mm_add_epi16(ina2, inb2); | |
| 2749 step1a[ 3] = _mm_add_epi16(ina3, inb3); | |
| 2750 step1b[-3] = _mm_sub_epi16(ina3, inb3); | |
| 2751 step1b[-2] = _mm_sub_epi16(ina2, inb2); | |
| 2752 step1b[-1] = _mm_sub_epi16(ina1, inb1); | |
| 2753 step1b[-0] = _mm_sub_epi16(ina0, inb0); | |
| 2754 step1a[ 0] = _mm_slli_epi16(step1a[ 0], 2); | |
| 2755 step1a[ 1] = _mm_slli_epi16(step1a[ 1], 2); | |
| 2756 step1a[ 2] = _mm_slli_epi16(step1a[ 2], 2); | |
| 2757 step1a[ 3] = _mm_slli_epi16(step1a[ 3], 2); | |
| 2758 step1b[-3] = _mm_slli_epi16(step1b[-3], 2); | |
| 2759 step1b[-2] = _mm_slli_epi16(step1b[-2], 2); | |
| 2760 step1b[-1] = _mm_slli_epi16(step1b[-1], 2); | |
| 2761 step1b[-0] = _mm_slli_epi16(step1b[-0], 2); | |
| 2762 } | |
| 2763 } else { | |
| 2764 int16_t *in = &intermediate[column_start]; | |
| 2765 // step1[i] = in[ 0 * 32] + in[(32 - 1) * 32]; | |
| 2766 // Note: using the same approach as above to have common offset is | |
| 2767 // counter-productive as all offsets can be calculated at compile | |
| 2768 // time. | |
| 2769 // Note: the next four blocks could be in a loop. That would help the | |
| 2770 // instruction cache but is actually slower. | |
| 2771 { | |
| 2772 __m128i in00 = _mm_loadu_si128((const __m128i *)(in + 0 * 32)); | |
| 2773 __m128i in01 = _mm_loadu_si128((const __m128i *)(in + 1 * 32)); | |
| 2774 __m128i in02 = _mm_loadu_si128((const __m128i *)(in + 2 * 32)); | |
| 2775 __m128i in03 = _mm_loadu_si128((const __m128i *)(in + 3 * 32)); | |
| 2776 __m128i in28 = _mm_loadu_si128((const __m128i *)(in + 28 * 32)); | |
| 2777 __m128i in29 = _mm_loadu_si128((const __m128i *)(in + 29 * 32)); | |
| 2778 __m128i in30 = _mm_loadu_si128((const __m128i *)(in + 30 * 32)); | |
| 2779 __m128i in31 = _mm_loadu_si128((const __m128i *)(in + 31 * 32)); | |
| 2780 step1[ 0] = _mm_add_epi16(in00, in31); | |
| 2781 step1[ 1] = _mm_add_epi16(in01, in30); | |
| 2782 step1[ 2] = _mm_add_epi16(in02, in29); | |
| 2783 step1[ 3] = _mm_add_epi16(in03, in28); | |
| 2784 step1[28] = _mm_sub_epi16(in03, in28); | |
| 2785 step1[29] = _mm_sub_epi16(in02, in29); | |
| 2786 step1[30] = _mm_sub_epi16(in01, in30); | |
| 2787 step1[31] = _mm_sub_epi16(in00, in31); | |
| 2788 } | |
| 2789 { | |
| 2790 __m128i in04 = _mm_loadu_si128((const __m128i *)(in + 4 * 32)); | |
| 2791 __m128i in05 = _mm_loadu_si128((const __m128i *)(in + 5 * 32)); | |
| 2792 __m128i in06 = _mm_loadu_si128((const __m128i *)(in + 6 * 32)); | |
| 2793 __m128i in07 = _mm_loadu_si128((const __m128i *)(in + 7 * 32)); | |
| 2794 __m128i in24 = _mm_loadu_si128((const __m128i *)(in + 24 * 32)); | |
| 2795 __m128i in25 = _mm_loadu_si128((const __m128i *)(in + 25 * 32)); | |
| 2796 __m128i in26 = _mm_loadu_si128((const __m128i *)(in + 26 * 32)); | |
| 2797 __m128i in27 = _mm_loadu_si128((const __m128i *)(in + 27 * 32)); | |
| 2798 step1[ 4] = _mm_add_epi16(in04, in27); | |
| 2799 step1[ 5] = _mm_add_epi16(in05, in26); | |
| 2800 step1[ 6] = _mm_add_epi16(in06, in25); | |
| 2801 step1[ 7] = _mm_add_epi16(in07, in24); | |
| 2802 step1[24] = _mm_sub_epi16(in07, in24); | |
| 2803 step1[25] = _mm_sub_epi16(in06, in25); | |
| 2804 step1[26] = _mm_sub_epi16(in05, in26); | |
| 2805 step1[27] = _mm_sub_epi16(in04, in27); | |
| 2806 } | |
| 2807 { | |
| 2808 __m128i in08 = _mm_loadu_si128((const __m128i *)(in + 8 * 32)); | |
| 2809 __m128i in09 = _mm_loadu_si128((const __m128i *)(in + 9 * 32)); | |
| 2810 __m128i in10 = _mm_loadu_si128((const __m128i *)(in + 10 * 32)); | |
| 2811 __m128i in11 = _mm_loadu_si128((const __m128i *)(in + 11 * 32)); | |
| 2812 __m128i in20 = _mm_loadu_si128((const __m128i *)(in + 20 * 32)); | |
| 2813 __m128i in21 = _mm_loadu_si128((const __m128i *)(in + 21 * 32)); | |
| 2814 __m128i in22 = _mm_loadu_si128((const __m128i *)(in + 22 * 32)); | |
| 2815 __m128i in23 = _mm_loadu_si128((const __m128i *)(in + 23 * 32)); | |
| 2816 step1[ 8] = _mm_add_epi16(in08, in23); | |
| 2817 step1[ 9] = _mm_add_epi16(in09, in22); | |
| 2818 step1[10] = _mm_add_epi16(in10, in21); | |
| 2819 step1[11] = _mm_add_epi16(in11, in20); | |
| 2820 step1[20] = _mm_sub_epi16(in11, in20); | |
| 2821 step1[21] = _mm_sub_epi16(in10, in21); | |
| 2822 step1[22] = _mm_sub_epi16(in09, in22); | |
| 2823 step1[23] = _mm_sub_epi16(in08, in23); | |
| 2824 } | |
| 2825 { | |
| 2826 __m128i in12 = _mm_loadu_si128((const __m128i *)(in + 12 * 32)); | |
| 2827 __m128i in13 = _mm_loadu_si128((const __m128i *)(in + 13 * 32)); | |
| 2828 __m128i in14 = _mm_loadu_si128((const __m128i *)(in + 14 * 32)); | |
| 2829 __m128i in15 = _mm_loadu_si128((const __m128i *)(in + 15 * 32)); | |
| 2830 __m128i in16 = _mm_loadu_si128((const __m128i *)(in + 16 * 32)); | |
| 2831 __m128i in17 = _mm_loadu_si128((const __m128i *)(in + 17 * 32)); | |
| 2832 __m128i in18 = _mm_loadu_si128((const __m128i *)(in + 18 * 32)); | |
| 2833 __m128i in19 = _mm_loadu_si128((const __m128i *)(in + 19 * 32)); | |
| 2834 step1[12] = _mm_add_epi16(in12, in19); | |
| 2835 step1[13] = _mm_add_epi16(in13, in18); | |
| 2836 step1[14] = _mm_add_epi16(in14, in17); | |
| 2837 step1[15] = _mm_add_epi16(in15, in16); | |
| 2838 step1[16] = _mm_sub_epi16(in15, in16); | |
| 2839 step1[17] = _mm_sub_epi16(in14, in17); | |
| 2840 step1[18] = _mm_sub_epi16(in13, in18); | |
| 2841 step1[19] = _mm_sub_epi16(in12, in19); | |
| 2842 } | |
| 2843 } | |
| 2844 // Stage 2 | |
| 2845 { | |
| 2846 step2[ 0] = _mm_add_epi16(step1[0], step1[15]); | |
| 2847 step2[ 1] = _mm_add_epi16(step1[1], step1[14]); | |
| 2848 step2[ 2] = _mm_add_epi16(step1[2], step1[13]); | |
| 2849 step2[ 3] = _mm_add_epi16(step1[3], step1[12]); | |
| 2850 step2[ 4] = _mm_add_epi16(step1[4], step1[11]); | |
| 2851 step2[ 5] = _mm_add_epi16(step1[5], step1[10]); | |
| 2852 step2[ 6] = _mm_add_epi16(step1[6], step1[ 9]); | |
| 2853 step2[ 7] = _mm_add_epi16(step1[7], step1[ 8]); | |
| 2854 step2[ 8] = _mm_sub_epi16(step1[7], step1[ 8]); | |
| 2855 step2[ 9] = _mm_sub_epi16(step1[6], step1[ 9]); | |
| 2856 step2[10] = _mm_sub_epi16(step1[5], step1[10]); | |
| 2857 step2[11] = _mm_sub_epi16(step1[4], step1[11]); | |
| 2858 step2[12] = _mm_sub_epi16(step1[3], step1[12]); | |
| 2859 step2[13] = _mm_sub_epi16(step1[2], step1[13]); | |
| 2860 step2[14] = _mm_sub_epi16(step1[1], step1[14]); | |
| 2861 step2[15] = _mm_sub_epi16(step1[0], step1[15]); | |
| 2862 } | |
| 2863 { | |
| 2864 const __m128i s2_20_0 = _mm_unpacklo_epi16(step1[27], step1[20]); | |
| 2865 const __m128i s2_20_1 = _mm_unpackhi_epi16(step1[27], step1[20]); | |
| 2866 const __m128i s2_21_0 = _mm_unpacklo_epi16(step1[26], step1[21]); | |
| 2867 const __m128i s2_21_1 = _mm_unpackhi_epi16(step1[26], step1[21]); | |
| 2868 const __m128i s2_22_0 = _mm_unpacklo_epi16(step1[25], step1[22]); | |
| 2869 const __m128i s2_22_1 = _mm_unpackhi_epi16(step1[25], step1[22]); | |
| 2870 const __m128i s2_23_0 = _mm_unpacklo_epi16(step1[24], step1[23]); | |
| 2871 const __m128i s2_23_1 = _mm_unpackhi_epi16(step1[24], step1[23]); | |
| 2872 const __m128i s2_20_2 = _mm_madd_epi16(s2_20_0, k__cospi_p16_m16); | |
| 2873 const __m128i s2_20_3 = _mm_madd_epi16(s2_20_1, k__cospi_p16_m16); | |
| 2874 const __m128i s2_21_2 = _mm_madd_epi16(s2_21_0, k__cospi_p16_m16); | |
| 2875 const __m128i s2_21_3 = _mm_madd_epi16(s2_21_1, k__cospi_p16_m16); | |
| 2876 const __m128i s2_22_2 = _mm_madd_epi16(s2_22_0, k__cospi_p16_m16); | |
| 2877 const __m128i s2_22_3 = _mm_madd_epi16(s2_22_1, k__cospi_p16_m16); | |
| 2878 const __m128i s2_23_2 = _mm_madd_epi16(s2_23_0, k__cospi_p16_m16); | |
| 2879 const __m128i s2_23_3 = _mm_madd_epi16(s2_23_1, k__cospi_p16_m16); | |
| 2880 const __m128i s2_24_2 = _mm_madd_epi16(s2_23_0, k__cospi_p16_p16); | |
| 2881 const __m128i s2_24_3 = _mm_madd_epi16(s2_23_1, k__cospi_p16_p16); | |
| 2882 const __m128i s2_25_2 = _mm_madd_epi16(s2_22_0, k__cospi_p16_p16); | |
| 2883 const __m128i s2_25_3 = _mm_madd_epi16(s2_22_1, k__cospi_p16_p16); | |
| 2884 const __m128i s2_26_2 = _mm_madd_epi16(s2_21_0, k__cospi_p16_p16); | |
| 2885 const __m128i s2_26_3 = _mm_madd_epi16(s2_21_1, k__cospi_p16_p16); | |
| 2886 const __m128i s2_27_2 = _mm_madd_epi16(s2_20_0, k__cospi_p16_p16); | |
| 2887 const __m128i s2_27_3 = _mm_madd_epi16(s2_20_1, k__cospi_p16_p16); | |
| 2888 // dct_const_round_shift | |
| 2889 const __m128i s2_20_4 = _mm_add_epi32(s2_20_2, k__DCT_CONST_ROUNDING); | |
| 2890 const __m128i s2_20_5 = _mm_add_epi32(s2_20_3, k__DCT_CONST_ROUNDING); | |
| 2891 const __m128i s2_21_4 = _mm_add_epi32(s2_21_2, k__DCT_CONST_ROUNDING); | |
| 2892 const __m128i s2_21_5 = _mm_add_epi32(s2_21_3, k__DCT_CONST_ROUNDING); | |
| 2893 const __m128i s2_22_4 = _mm_add_epi32(s2_22_2, k__DCT_CONST_ROUNDING); | |
| 2894 const __m128i s2_22_5 = _mm_add_epi32(s2_22_3, k__DCT_CONST_ROUNDING); | |
| 2895 const __m128i s2_23_4 = _mm_add_epi32(s2_23_2, k__DCT_CONST_ROUNDING); | |
| 2896 const __m128i s2_23_5 = _mm_add_epi32(s2_23_3, k__DCT_CONST_ROUNDING); | |
| 2897 const __m128i s2_24_4 = _mm_add_epi32(s2_24_2, k__DCT_CONST_ROUNDING); | |
| 2898 const __m128i s2_24_5 = _mm_add_epi32(s2_24_3, k__DCT_CONST_ROUNDING); | |
| 2899 const __m128i s2_25_4 = _mm_add_epi32(s2_25_2, k__DCT_CONST_ROUNDING); | |
| 2900 const __m128i s2_25_5 = _mm_add_epi32(s2_25_3, k__DCT_CONST_ROUNDING); | |
| 2901 const __m128i s2_26_4 = _mm_add_epi32(s2_26_2, k__DCT_CONST_ROUNDING); | |
| 2902 const __m128i s2_26_5 = _mm_add_epi32(s2_26_3, k__DCT_CONST_ROUNDING); | |
| 2903 const __m128i s2_27_4 = _mm_add_epi32(s2_27_2, k__DCT_CONST_ROUNDING); | |
| 2904 const __m128i s2_27_5 = _mm_add_epi32(s2_27_3, k__DCT_CONST_ROUNDING); | |
| 2905 const __m128i s2_20_6 = _mm_srai_epi32(s2_20_4, DCT_CONST_BITS); | |
| 2906 const __m128i s2_20_7 = _mm_srai_epi32(s2_20_5, DCT_CONST_BITS); | |
| 2907 const __m128i s2_21_6 = _mm_srai_epi32(s2_21_4, DCT_CONST_BITS); | |
| 2908 const __m128i s2_21_7 = _mm_srai_epi32(s2_21_5, DCT_CONST_BITS); | |
| 2909 const __m128i s2_22_6 = _mm_srai_epi32(s2_22_4, DCT_CONST_BITS); | |
| 2910 const __m128i s2_22_7 = _mm_srai_epi32(s2_22_5, DCT_CONST_BITS); | |
| 2911 const __m128i s2_23_6 = _mm_srai_epi32(s2_23_4, DCT_CONST_BITS); | |
| 2912 const __m128i s2_23_7 = _mm_srai_epi32(s2_23_5, DCT_CONST_BITS); | |
| 2913 const __m128i s2_24_6 = _mm_srai_epi32(s2_24_4, DCT_CONST_BITS); | |
| 2914 const __m128i s2_24_7 = _mm_srai_epi32(s2_24_5, DCT_CONST_BITS); | |
| 2915 const __m128i s2_25_6 = _mm_srai_epi32(s2_25_4, DCT_CONST_BITS); | |
| 2916 const __m128i s2_25_7 = _mm_srai_epi32(s2_25_5, DCT_CONST_BITS); | |
| 2917 const __m128i s2_26_6 = _mm_srai_epi32(s2_26_4, DCT_CONST_BITS); | |
| 2918 const __m128i s2_26_7 = _mm_srai_epi32(s2_26_5, DCT_CONST_BITS); | |
| 2919 const __m128i s2_27_6 = _mm_srai_epi32(s2_27_4, DCT_CONST_BITS); | |
| 2920 const __m128i s2_27_7 = _mm_srai_epi32(s2_27_5, DCT_CONST_BITS); | |
| 2921 // Combine | |
| 2922 step2[20] = _mm_packs_epi32(s2_20_6, s2_20_7); | |
| 2923 step2[21] = _mm_packs_epi32(s2_21_6, s2_21_7); | |
| 2924 step2[22] = _mm_packs_epi32(s2_22_6, s2_22_7); | |
| 2925 step2[23] = _mm_packs_epi32(s2_23_6, s2_23_7); | |
| 2926 step2[24] = _mm_packs_epi32(s2_24_6, s2_24_7); | |
| 2927 step2[25] = _mm_packs_epi32(s2_25_6, s2_25_7); | |
| 2928 step2[26] = _mm_packs_epi32(s2_26_6, s2_26_7); | |
| 2929 step2[27] = _mm_packs_epi32(s2_27_6, s2_27_7); | |
| 2930 } | |
| 2931 // Stage 3 | |
| 2932 { | |
| 2933 step3[0] = _mm_add_epi16(step2[(8 - 1)], step2[0]); | |
| 2934 step3[1] = _mm_add_epi16(step2[(8 - 2)], step2[1]); | |
| 2935 step3[2] = _mm_add_epi16(step2[(8 - 3)], step2[2]); | |
| 2936 step3[3] = _mm_add_epi16(step2[(8 - 4)], step2[3]); | |
| 2937 step3[4] = _mm_sub_epi16(step2[(8 - 5)], step2[4]); | |
| 2938 step3[5] = _mm_sub_epi16(step2[(8 - 6)], step2[5]); | |
| 2939 step3[6] = _mm_sub_epi16(step2[(8 - 7)], step2[6]); | |
| 2940 step3[7] = _mm_sub_epi16(step2[(8 - 8)], step2[7]); | |
| 2941 } | |
| 2942 { | |
| 2943 const __m128i s3_10_0 = _mm_unpacklo_epi16(step2[13], step2[10]); | |
| 2944 const __m128i s3_10_1 = _mm_unpackhi_epi16(step2[13], step2[10]); | |
| 2945 const __m128i s3_11_0 = _mm_unpacklo_epi16(step2[12], step2[11]); | |
| 2946 const __m128i s3_11_1 = _mm_unpackhi_epi16(step2[12], step2[11]); | |
| 2947 const __m128i s3_10_2 = _mm_madd_epi16(s3_10_0, k__cospi_p16_m16); | |
| 2948 const __m128i s3_10_3 = _mm_madd_epi16(s3_10_1, k__cospi_p16_m16); | |
| 2949 const __m128i s3_11_2 = _mm_madd_epi16(s3_11_0, k__cospi_p16_m16); | |
| 2950 const __m128i s3_11_3 = _mm_madd_epi16(s3_11_1, k__cospi_p16_m16); | |
| 2951 const __m128i s3_12_2 = _mm_madd_epi16(s3_11_0, k__cospi_p16_p16); | |
| 2952 const __m128i s3_12_3 = _mm_madd_epi16(s3_11_1, k__cospi_p16_p16); | |
| 2953 const __m128i s3_13_2 = _mm_madd_epi16(s3_10_0, k__cospi_p16_p16); | |
| 2954 const __m128i s3_13_3 = _mm_madd_epi16(s3_10_1, k__cospi_p16_p16); | |
| 2955 // dct_const_round_shift | |
| 2956 const __m128i s3_10_4 = _mm_add_epi32(s3_10_2, k__DCT_CONST_ROUNDING); | |
| 2957 const __m128i s3_10_5 = _mm_add_epi32(s3_10_3, k__DCT_CONST_ROUNDING); | |
| 2958 const __m128i s3_11_4 = _mm_add_epi32(s3_11_2, k__DCT_CONST_ROUNDING); | |
| 2959 const __m128i s3_11_5 = _mm_add_epi32(s3_11_3, k__DCT_CONST_ROUNDING); | |
| 2960 const __m128i s3_12_4 = _mm_add_epi32(s3_12_2, k__DCT_CONST_ROUNDING); | |
| 2961 const __m128i s3_12_5 = _mm_add_epi32(s3_12_3, k__DCT_CONST_ROUNDING); | |
| 2962 const __m128i s3_13_4 = _mm_add_epi32(s3_13_2, k__DCT_CONST_ROUNDING); | |
| 2963 const __m128i s3_13_5 = _mm_add_epi32(s3_13_3, k__DCT_CONST_ROUNDING); | |
| 2964 const __m128i s3_10_6 = _mm_srai_epi32(s3_10_4, DCT_CONST_BITS); | |
| 2965 const __m128i s3_10_7 = _mm_srai_epi32(s3_10_5, DCT_CONST_BITS); | |
| 2966 const __m128i s3_11_6 = _mm_srai_epi32(s3_11_4, DCT_CONST_BITS); | |
| 2967 const __m128i s3_11_7 = _mm_srai_epi32(s3_11_5, DCT_CONST_BITS); | |
| 2968 const __m128i s3_12_6 = _mm_srai_epi32(s3_12_4, DCT_CONST_BITS); | |
| 2969 const __m128i s3_12_7 = _mm_srai_epi32(s3_12_5, DCT_CONST_BITS); | |
| 2970 const __m128i s3_13_6 = _mm_srai_epi32(s3_13_4, DCT_CONST_BITS); | |
| 2971 const __m128i s3_13_7 = _mm_srai_epi32(s3_13_5, DCT_CONST_BITS); | |
| 2972 // Combine | |
| 2973 step3[10] = _mm_packs_epi32(s3_10_6, s3_10_7); | |
| 2974 step3[11] = _mm_packs_epi32(s3_11_6, s3_11_7); | |
| 2975 step3[12] = _mm_packs_epi32(s3_12_6, s3_12_7); | |
| 2976 step3[13] = _mm_packs_epi32(s3_13_6, s3_13_7); | |
| 2977 } | |
| 2978 { | |
| 2979 step3[16] = _mm_add_epi16(step2[23], step1[16]); | |
| 2980 step3[17] = _mm_add_epi16(step2[22], step1[17]); | |
| 2981 step3[18] = _mm_add_epi16(step2[21], step1[18]); | |
| 2982 step3[19] = _mm_add_epi16(step2[20], step1[19]); | |
| 2983 step3[20] = _mm_sub_epi16(step1[19], step2[20]); | |
| 2984 step3[21] = _mm_sub_epi16(step1[18], step2[21]); | |
| 2985 step3[22] = _mm_sub_epi16(step1[17], step2[22]); | |
| 2986 step3[23] = _mm_sub_epi16(step1[16], step2[23]); | |
| 2987 step3[24] = _mm_sub_epi16(step1[31], step2[24]); | |
| 2988 step3[25] = _mm_sub_epi16(step1[30], step2[25]); | |
| 2989 step3[26] = _mm_sub_epi16(step1[29], step2[26]); | |
| 2990 step3[27] = _mm_sub_epi16(step1[28], step2[27]); | |
| 2991 step3[28] = _mm_add_epi16(step2[27], step1[28]); | |
| 2992 step3[29] = _mm_add_epi16(step2[26], step1[29]); | |
| 2993 step3[30] = _mm_add_epi16(step2[25], step1[30]); | |
| 2994 step3[31] = _mm_add_epi16(step2[24], step1[31]); | |
| 2995 } | |
| 2996 // dump the magnitude by half, hence the intermediate values are within | |
| 2997 // the range of 16 bits. | |
| 2998 if (1 == pass) { | |
| 2999 __m128i s3_00_0 = _mm_cmplt_epi16(step3[ 0], kZero); | |
| 3000 __m128i s3_01_0 = _mm_cmplt_epi16(step3[ 1], kZero); | |
| 3001 __m128i s3_02_0 = _mm_cmplt_epi16(step3[ 2], kZero); | |
| 3002 __m128i s3_03_0 = _mm_cmplt_epi16(step3[ 3], kZero); | |
| 3003 __m128i s3_04_0 = _mm_cmplt_epi16(step3[ 4], kZero); | |
| 3004 __m128i s3_05_0 = _mm_cmplt_epi16(step3[ 5], kZero); | |
| 3005 __m128i s3_06_0 = _mm_cmplt_epi16(step3[ 6], kZero); | |
| 3006 __m128i s3_07_0 = _mm_cmplt_epi16(step3[ 7], kZero); | |
| 3007 __m128i s2_08_0 = _mm_cmplt_epi16(step2[ 8], kZero); | |
| 3008 __m128i s2_09_0 = _mm_cmplt_epi16(step2[ 9], kZero); | |
| 3009 __m128i s3_10_0 = _mm_cmplt_epi16(step3[10], kZero); | |
| 3010 __m128i s3_11_0 = _mm_cmplt_epi16(step3[11], kZero); | |
| 3011 __m128i s3_12_0 = _mm_cmplt_epi16(step3[12], kZero); | |
| 3012 __m128i s3_13_0 = _mm_cmplt_epi16(step3[13], kZero); | |
| 3013 __m128i s2_14_0 = _mm_cmplt_epi16(step2[14], kZero); | |
| 3014 __m128i s2_15_0 = _mm_cmplt_epi16(step2[15], kZero); | |
| 3015 __m128i s3_16_0 = _mm_cmplt_epi16(step3[16], kZero); | |
| 3016 __m128i s3_17_0 = _mm_cmplt_epi16(step3[17], kZero); | |
| 3017 __m128i s3_18_0 = _mm_cmplt_epi16(step3[18], kZero); | |
| 3018 __m128i s3_19_0 = _mm_cmplt_epi16(step3[19], kZero); | |
| 3019 __m128i s3_20_0 = _mm_cmplt_epi16(step3[20], kZero); | |
| 3020 __m128i s3_21_0 = _mm_cmplt_epi16(step3[21], kZero); | |
| 3021 __m128i s3_22_0 = _mm_cmplt_epi16(step3[22], kZero); | |
| 3022 __m128i s3_23_0 = _mm_cmplt_epi16(step3[23], kZero); | |
| 3023 __m128i s3_24_0 = _mm_cmplt_epi16(step3[24], kZero); | |
| 3024 __m128i s3_25_0 = _mm_cmplt_epi16(step3[25], kZero); | |
| 3025 __m128i s3_26_0 = _mm_cmplt_epi16(step3[26], kZero); | |
| 3026 __m128i s3_27_0 = _mm_cmplt_epi16(step3[27], kZero); | |
| 3027 __m128i s3_28_0 = _mm_cmplt_epi16(step3[28], kZero); | |
| 3028 __m128i s3_29_0 = _mm_cmplt_epi16(step3[29], kZero); | |
| 3029 __m128i s3_30_0 = _mm_cmplt_epi16(step3[30], kZero); | |
| 3030 __m128i s3_31_0 = _mm_cmplt_epi16(step3[31], kZero); | |
| 3031 step3[ 0] = _mm_sub_epi16(step3[ 0], s3_00_0); | |
| 3032 step3[ 1] = _mm_sub_epi16(step3[ 1], s3_01_0); | |
| 3033 step3[ 2] = _mm_sub_epi16(step3[ 2], s3_02_0); | |
| 3034 step3[ 3] = _mm_sub_epi16(step3[ 3], s3_03_0); | |
| 3035 step3[ 4] = _mm_sub_epi16(step3[ 4], s3_04_0); | |
| 3036 step3[ 5] = _mm_sub_epi16(step3[ 5], s3_05_0); | |
| 3037 step3[ 6] = _mm_sub_epi16(step3[ 6], s3_06_0); | |
| 3038 step3[ 7] = _mm_sub_epi16(step3[ 7], s3_07_0); | |
| 3039 step2[ 8] = _mm_sub_epi16(step2[ 8], s2_08_0); | |
| 3040 step2[ 9] = _mm_sub_epi16(step2[ 9], s2_09_0); | |
| 3041 step3[10] = _mm_sub_epi16(step3[10], s3_10_0); | |
| 3042 step3[11] = _mm_sub_epi16(step3[11], s3_11_0); | |
| 3043 step3[12] = _mm_sub_epi16(step3[12], s3_12_0); | |
| 3044 step3[13] = _mm_sub_epi16(step3[13], s3_13_0); | |
| 3045 step2[14] = _mm_sub_epi16(step2[14], s2_14_0); | |
| 3046 step2[15] = _mm_sub_epi16(step2[15], s2_15_0); | |
| 3047 step3[16] = _mm_sub_epi16(step3[16], s3_16_0); | |
| 3048 step3[17] = _mm_sub_epi16(step3[17], s3_17_0); | |
| 3049 step3[18] = _mm_sub_epi16(step3[18], s3_18_0); | |
| 3050 step3[19] = _mm_sub_epi16(step3[19], s3_19_0); | |
| 3051 step3[20] = _mm_sub_epi16(step3[20], s3_20_0); | |
| 3052 step3[21] = _mm_sub_epi16(step3[21], s3_21_0); | |
| 3053 step3[22] = _mm_sub_epi16(step3[22], s3_22_0); | |
| 3054 step3[23] = _mm_sub_epi16(step3[23], s3_23_0); | |
| 3055 step3[24] = _mm_sub_epi16(step3[24], s3_24_0); | |
| 3056 step3[25] = _mm_sub_epi16(step3[25], s3_25_0); | |
| 3057 step3[26] = _mm_sub_epi16(step3[26], s3_26_0); | |
| 3058 step3[27] = _mm_sub_epi16(step3[27], s3_27_0); | |
| 3059 step3[28] = _mm_sub_epi16(step3[28], s3_28_0); | |
| 3060 step3[29] = _mm_sub_epi16(step3[29], s3_29_0); | |
| 3061 step3[30] = _mm_sub_epi16(step3[30], s3_30_0); | |
| 3062 step3[31] = _mm_sub_epi16(step3[31], s3_31_0); | |
| 3063 step3[ 0] = _mm_add_epi16(step3[ 0], kOne); | |
| 3064 step3[ 1] = _mm_add_epi16(step3[ 1], kOne); | |
| 3065 step3[ 2] = _mm_add_epi16(step3[ 2], kOne); | |
| 3066 step3[ 3] = _mm_add_epi16(step3[ 3], kOne); | |
| 3067 step3[ 4] = _mm_add_epi16(step3[ 4], kOne); | |
| 3068 step3[ 5] = _mm_add_epi16(step3[ 5], kOne); | |
| 3069 step3[ 6] = _mm_add_epi16(step3[ 6], kOne); | |
| 3070 step3[ 7] = _mm_add_epi16(step3[ 7], kOne); | |
| 3071 step2[ 8] = _mm_add_epi16(step2[ 8], kOne); | |
| 3072 step2[ 9] = _mm_add_epi16(step2[ 9], kOne); | |
| 3073 step3[10] = _mm_add_epi16(step3[10], kOne); | |
| 3074 step3[11] = _mm_add_epi16(step3[11], kOne); | |
| 3075 step3[12] = _mm_add_epi16(step3[12], kOne); | |
| 3076 step3[13] = _mm_add_epi16(step3[13], kOne); | |
| 3077 step2[14] = _mm_add_epi16(step2[14], kOne); | |
| 3078 step2[15] = _mm_add_epi16(step2[15], kOne); | |
| 3079 step3[16] = _mm_add_epi16(step3[16], kOne); | |
| 3080 step3[17] = _mm_add_epi16(step3[17], kOne); | |
| 3081 step3[18] = _mm_add_epi16(step3[18], kOne); | |
| 3082 step3[19] = _mm_add_epi16(step3[19], kOne); | |
| 3083 step3[20] = _mm_add_epi16(step3[20], kOne); | |
| 3084 step3[21] = _mm_add_epi16(step3[21], kOne); | |
| 3085 step3[22] = _mm_add_epi16(step3[22], kOne); | |
| 3086 step3[23] = _mm_add_epi16(step3[23], kOne); | |
| 3087 step3[24] = _mm_add_epi16(step3[24], kOne); | |
| 3088 step3[25] = _mm_add_epi16(step3[25], kOne); | |
| 3089 step3[26] = _mm_add_epi16(step3[26], kOne); | |
| 3090 step3[27] = _mm_add_epi16(step3[27], kOne); | |
| 3091 step3[28] = _mm_add_epi16(step3[28], kOne); | |
| 3092 step3[29] = _mm_add_epi16(step3[29], kOne); | |
| 3093 step3[30] = _mm_add_epi16(step3[30], kOne); | |
| 3094 step3[31] = _mm_add_epi16(step3[31], kOne); | |
| 3095 step3[ 0] = _mm_srai_epi16(step3[ 0], 2); | |
| 3096 step3[ 1] = _mm_srai_epi16(step3[ 1], 2); | |
| 3097 step3[ 2] = _mm_srai_epi16(step3[ 2], 2); | |
| 3098 step3[ 3] = _mm_srai_epi16(step3[ 3], 2); | |
| 3099 step3[ 4] = _mm_srai_epi16(step3[ 4], 2); | |
| 3100 step3[ 5] = _mm_srai_epi16(step3[ 5], 2); | |
| 3101 step3[ 6] = _mm_srai_epi16(step3[ 6], 2); | |
| 3102 step3[ 7] = _mm_srai_epi16(step3[ 7], 2); | |
| 3103 step2[ 8] = _mm_srai_epi16(step2[ 8], 2); | |
| 3104 step2[ 9] = _mm_srai_epi16(step2[ 9], 2); | |
| 3105 step3[10] = _mm_srai_epi16(step3[10], 2); | |
| 3106 step3[11] = _mm_srai_epi16(step3[11], 2); | |
| 3107 step3[12] = _mm_srai_epi16(step3[12], 2); | |
| 3108 step3[13] = _mm_srai_epi16(step3[13], 2); | |
| 3109 step2[14] = _mm_srai_epi16(step2[14], 2); | |
| 3110 step2[15] = _mm_srai_epi16(step2[15], 2); | |
| 3111 step3[16] = _mm_srai_epi16(step3[16], 2); | |
| 3112 step3[17] = _mm_srai_epi16(step3[17], 2); | |
| 3113 step3[18] = _mm_srai_epi16(step3[18], 2); | |
| 3114 step3[19] = _mm_srai_epi16(step3[19], 2); | |
| 3115 step3[20] = _mm_srai_epi16(step3[20], 2); | |
| 3116 step3[21] = _mm_srai_epi16(step3[21], 2); | |
| 3117 step3[22] = _mm_srai_epi16(step3[22], 2); | |
| 3118 step3[23] = _mm_srai_epi16(step3[23], 2); | |
| 3119 step3[24] = _mm_srai_epi16(step3[24], 2); | |
| 3120 step3[25] = _mm_srai_epi16(step3[25], 2); | |
| 3121 step3[26] = _mm_srai_epi16(step3[26], 2); | |
| 3122 step3[27] = _mm_srai_epi16(step3[27], 2); | |
| 3123 step3[28] = _mm_srai_epi16(step3[28], 2); | |
| 3124 step3[29] = _mm_srai_epi16(step3[29], 2); | |
| 3125 step3[30] = _mm_srai_epi16(step3[30], 2); | |
| 3126 step3[31] = _mm_srai_epi16(step3[31], 2); | |
| 3127 } | |
| 3128 // Stage 4 | |
| 3129 { | |
| 3130 step1[ 0] = _mm_add_epi16(step3[ 3], step3[ 0]); | |
| 3131 step1[ 1] = _mm_add_epi16(step3[ 2], step3[ 1]); | |
| 3132 step1[ 2] = _mm_sub_epi16(step3[ 1], step3[ 2]); | |
| 3133 step1[ 3] = _mm_sub_epi16(step3[ 0], step3[ 3]); | |
| 3134 step1[ 8] = _mm_add_epi16(step3[11], step2[ 8]); | |
| 3135 step1[ 9] = _mm_add_epi16(step3[10], step2[ 9]); | |
| 3136 step1[10] = _mm_sub_epi16(step2[ 9], step3[10]); | |
| 3137 step1[11] = _mm_sub_epi16(step2[ 8], step3[11]); | |
| 3138 step1[12] = _mm_sub_epi16(step2[15], step3[12]); | |
| 3139 step1[13] = _mm_sub_epi16(step2[14], step3[13]); | |
| 3140 step1[14] = _mm_add_epi16(step3[13], step2[14]); | |
| 3141 step1[15] = _mm_add_epi16(step3[12], step2[15]); | |
| 3142 } | |
| 3143 { | |
| 3144 const __m128i s1_05_0 = _mm_unpacklo_epi16(step3[6], step3[5]); | |
| 3145 const __m128i s1_05_1 = _mm_unpackhi_epi16(step3[6], step3[5]); | |
| 3146 const __m128i s1_05_2 = _mm_madd_epi16(s1_05_0, k__cospi_p16_m16); | |
| 3147 const __m128i s1_05_3 = _mm_madd_epi16(s1_05_1, k__cospi_p16_m16); | |
| 3148 const __m128i s1_06_2 = _mm_madd_epi16(s1_05_0, k__cospi_p16_p16); | |
| 3149 const __m128i s1_06_3 = _mm_madd_epi16(s1_05_1, k__cospi_p16_p16); | |
| 3150 // dct_const_round_shift | |
| 3151 const __m128i s1_05_4 = _mm_add_epi32(s1_05_2, k__DCT_CONST_ROUNDING); | |
| 3152 const __m128i s1_05_5 = _mm_add_epi32(s1_05_3, k__DCT_CONST_ROUNDING); | |
| 3153 const __m128i s1_06_4 = _mm_add_epi32(s1_06_2, k__DCT_CONST_ROUNDING); | |
| 3154 const __m128i s1_06_5 = _mm_add_epi32(s1_06_3, k__DCT_CONST_ROUNDING); | |
| 3155 const __m128i s1_05_6 = _mm_srai_epi32(s1_05_4, DCT_CONST_BITS); | |
| 3156 const __m128i s1_05_7 = _mm_srai_epi32(s1_05_5, DCT_CONST_BITS); | |
| 3157 const __m128i s1_06_6 = _mm_srai_epi32(s1_06_4, DCT_CONST_BITS); | |
| 3158 const __m128i s1_06_7 = _mm_srai_epi32(s1_06_5, DCT_CONST_BITS); | |
| 3159 // Combine | |
| 3160 step1[5] = _mm_packs_epi32(s1_05_6, s1_05_7); | |
| 3161 step1[6] = _mm_packs_epi32(s1_06_6, s1_06_7); | |
| 3162 } | |
| 3163 { | |
| 3164 const __m128i s1_18_0 = _mm_unpacklo_epi16(step3[18], step3[29]); | |
| 3165 const __m128i s1_18_1 = _mm_unpackhi_epi16(step3[18], step3[29]); | |
| 3166 const __m128i s1_19_0 = _mm_unpacklo_epi16(step3[19], step3[28]); | |
| 3167 const __m128i s1_19_1 = _mm_unpackhi_epi16(step3[19], step3[28]); | |
| 3168 const __m128i s1_20_0 = _mm_unpacklo_epi16(step3[20], step3[27]); | |
| 3169 const __m128i s1_20_1 = _mm_unpackhi_epi16(step3[20], step3[27]); | |
| 3170 const __m128i s1_21_0 = _mm_unpacklo_epi16(step3[21], step3[26]); | |
| 3171 const __m128i s1_21_1 = _mm_unpackhi_epi16(step3[21], step3[26]); | |
| 3172 const __m128i s1_18_2 = _mm_madd_epi16(s1_18_0, k__cospi_m08_p24); | |
| 3173 const __m128i s1_18_3 = _mm_madd_epi16(s1_18_1, k__cospi_m08_p24); | |
| 3174 const __m128i s1_19_2 = _mm_madd_epi16(s1_19_0, k__cospi_m08_p24); | |
| 3175 const __m128i s1_19_3 = _mm_madd_epi16(s1_19_1, k__cospi_m08_p24); | |
| 3176 const __m128i s1_20_2 = _mm_madd_epi16(s1_20_0, k__cospi_m24_m08); | |
| 3177 const __m128i s1_20_3 = _mm_madd_epi16(s1_20_1, k__cospi_m24_m08); | |
| 3178 const __m128i s1_21_2 = _mm_madd_epi16(s1_21_0, k__cospi_m24_m08); | |
| 3179 const __m128i s1_21_3 = _mm_madd_epi16(s1_21_1, k__cospi_m24_m08); | |
| 3180 const __m128i s1_26_2 = _mm_madd_epi16(s1_21_0, k__cospi_m08_p24); | |
| 3181 const __m128i s1_26_3 = _mm_madd_epi16(s1_21_1, k__cospi_m08_p24); | |
| 3182 const __m128i s1_27_2 = _mm_madd_epi16(s1_20_0, k__cospi_m08_p24); | |
| 3183 const __m128i s1_27_3 = _mm_madd_epi16(s1_20_1, k__cospi_m08_p24); | |
| 3184 const __m128i s1_28_2 = _mm_madd_epi16(s1_19_0, k__cospi_p24_p08); | |
| 3185 const __m128i s1_28_3 = _mm_madd_epi16(s1_19_1, k__cospi_p24_p08); | |
| 3186 const __m128i s1_29_2 = _mm_madd_epi16(s1_18_0, k__cospi_p24_p08); | |
| 3187 const __m128i s1_29_3 = _mm_madd_epi16(s1_18_1, k__cospi_p24_p08); | |
| 3188 // dct_const_round_shift | |
| 3189 const __m128i s1_18_4 = _mm_add_epi32(s1_18_2, k__DCT_CONST_ROUNDING); | |
| 3190 const __m128i s1_18_5 = _mm_add_epi32(s1_18_3, k__DCT_CONST_ROUNDING); | |
| 3191 const __m128i s1_19_4 = _mm_add_epi32(s1_19_2, k__DCT_CONST_ROUNDING); | |
| 3192 const __m128i s1_19_5 = _mm_add_epi32(s1_19_3, k__DCT_CONST_ROUNDING); | |
| 3193 const __m128i s1_20_4 = _mm_add_epi32(s1_20_2, k__DCT_CONST_ROUNDING); | |
| 3194 const __m128i s1_20_5 = _mm_add_epi32(s1_20_3, k__DCT_CONST_ROUNDING); | |
| 3195 const __m128i s1_21_4 = _mm_add_epi32(s1_21_2, k__DCT_CONST_ROUNDING); | |
| 3196 const __m128i s1_21_5 = _mm_add_epi32(s1_21_3, k__DCT_CONST_ROUNDING); | |
| 3197 const __m128i s1_26_4 = _mm_add_epi32(s1_26_2, k__DCT_CONST_ROUNDING); | |
| 3198 const __m128i s1_26_5 = _mm_add_epi32(s1_26_3, k__DCT_CONST_ROUNDING); | |
| 3199 const __m128i s1_27_4 = _mm_add_epi32(s1_27_2, k__DCT_CONST_ROUNDING); | |
| 3200 const __m128i s1_27_5 = _mm_add_epi32(s1_27_3, k__DCT_CONST_ROUNDING); | |
| 3201 const __m128i s1_28_4 = _mm_add_epi32(s1_28_2, k__DCT_CONST_ROUNDING); | |
| 3202 const __m128i s1_28_5 = _mm_add_epi32(s1_28_3, k__DCT_CONST_ROUNDING); | |
| 3203 const __m128i s1_29_4 = _mm_add_epi32(s1_29_2, k__DCT_CONST_ROUNDING); | |
| 3204 const __m128i s1_29_5 = _mm_add_epi32(s1_29_3, k__DCT_CONST_ROUNDING); | |
| 3205 const __m128i s1_18_6 = _mm_srai_epi32(s1_18_4, DCT_CONST_BITS); | |
| 3206 const __m128i s1_18_7 = _mm_srai_epi32(s1_18_5, DCT_CONST_BITS); | |
| 3207 const __m128i s1_19_6 = _mm_srai_epi32(s1_19_4, DCT_CONST_BITS); | |
| 3208 const __m128i s1_19_7 = _mm_srai_epi32(s1_19_5, DCT_CONST_BITS); | |
| 3209 const __m128i s1_20_6 = _mm_srai_epi32(s1_20_4, DCT_CONST_BITS); | |
| 3210 const __m128i s1_20_7 = _mm_srai_epi32(s1_20_5, DCT_CONST_BITS); | |
| 3211 const __m128i s1_21_6 = _mm_srai_epi32(s1_21_4, DCT_CONST_BITS); | |
| 3212 const __m128i s1_21_7 = _mm_srai_epi32(s1_21_5, DCT_CONST_BITS); | |
| 3213 const __m128i s1_26_6 = _mm_srai_epi32(s1_26_4, DCT_CONST_BITS); | |
| 3214 const __m128i s1_26_7 = _mm_srai_epi32(s1_26_5, DCT_CONST_BITS); | |
| 3215 const __m128i s1_27_6 = _mm_srai_epi32(s1_27_4, DCT_CONST_BITS); | |
| 3216 const __m128i s1_27_7 = _mm_srai_epi32(s1_27_5, DCT_CONST_BITS); | |
| 3217 const __m128i s1_28_6 = _mm_srai_epi32(s1_28_4, DCT_CONST_BITS); | |
| 3218 const __m128i s1_28_7 = _mm_srai_epi32(s1_28_5, DCT_CONST_BITS); | |
| 3219 const __m128i s1_29_6 = _mm_srai_epi32(s1_29_4, DCT_CONST_BITS); | |
| 3220 const __m128i s1_29_7 = _mm_srai_epi32(s1_29_5, DCT_CONST_BITS); | |
| 3221 // Combine | |
| 3222 step1[18] = _mm_packs_epi32(s1_18_6, s1_18_7); | |
| 3223 step1[19] = _mm_packs_epi32(s1_19_6, s1_19_7); | |
| 3224 step1[20] = _mm_packs_epi32(s1_20_6, s1_20_7); | |
| 3225 step1[21] = _mm_packs_epi32(s1_21_6, s1_21_7); | |
| 3226 step1[26] = _mm_packs_epi32(s1_26_6, s1_26_7); | |
| 3227 step1[27] = _mm_packs_epi32(s1_27_6, s1_27_7); | |
| 3228 step1[28] = _mm_packs_epi32(s1_28_6, s1_28_7); | |
| 3229 step1[29] = _mm_packs_epi32(s1_29_6, s1_29_7); | |
| 3230 } | |
| 3231 // Stage 5 | |
| 3232 { | |
| 3233 step2[4] = _mm_add_epi16(step1[5], step3[4]); | |
| 3234 step2[5] = _mm_sub_epi16(step3[4], step1[5]); | |
| 3235 step2[6] = _mm_sub_epi16(step3[7], step1[6]); | |
| 3236 step2[7] = _mm_add_epi16(step1[6], step3[7]); | |
| 3237 } | |
| 3238 { | |
| 3239 const __m128i out_00_0 = _mm_unpacklo_epi16(step1[0], step1[1]); | |
| 3240 const __m128i out_00_1 = _mm_unpackhi_epi16(step1[0], step1[1]); | |
| 3241 const __m128i out_08_0 = _mm_unpacklo_epi16(step1[2], step1[3]); | |
| 3242 const __m128i out_08_1 = _mm_unpackhi_epi16(step1[2], step1[3]); | |
| 3243 const __m128i out_00_2 = _mm_madd_epi16(out_00_0, k__cospi_p16_p16); | |
| 3244 const __m128i out_00_3 = _mm_madd_epi16(out_00_1, k__cospi_p16_p16); | |
| 3245 const __m128i out_16_2 = _mm_madd_epi16(out_00_0, k__cospi_p16_m16); | |
| 3246 const __m128i out_16_3 = _mm_madd_epi16(out_00_1, k__cospi_p16_m16); | |
| 3247 const __m128i out_08_2 = _mm_madd_epi16(out_08_0, k__cospi_p24_p08); | |
| 3248 const __m128i out_08_3 = _mm_madd_epi16(out_08_1, k__cospi_p24_p08); | |
| 3249 const __m128i out_24_2 = _mm_madd_epi16(out_08_0, k__cospi_m08_p24); | |
| 3250 const __m128i out_24_3 = _mm_madd_epi16(out_08_1, k__cospi_m08_p24); | |
| 3251 // dct_const_round_shift | |
| 3252 const __m128i out_00_4 = _mm_add_epi32(out_00_2, k__DCT_CONST_ROUNDING); | |
| 3253 const __m128i out_00_5 = _mm_add_epi32(out_00_3, k__DCT_CONST_ROUNDING); | |
| 3254 const __m128i out_16_4 = _mm_add_epi32(out_16_2, k__DCT_CONST_ROUNDING); | |
| 3255 const __m128i out_16_5 = _mm_add_epi32(out_16_3, k__DCT_CONST_ROUNDING); | |
| 3256 const __m128i out_08_4 = _mm_add_epi32(out_08_2, k__DCT_CONST_ROUNDING); | |
| 3257 const __m128i out_08_5 = _mm_add_epi32(out_08_3, k__DCT_CONST_ROUNDING); | |
| 3258 const __m128i out_24_4 = _mm_add_epi32(out_24_2, k__DCT_CONST_ROUNDING); | |
| 3259 const __m128i out_24_5 = _mm_add_epi32(out_24_3, k__DCT_CONST_ROUNDING); | |
| 3260 const __m128i out_00_6 = _mm_srai_epi32(out_00_4, DCT_CONST_BITS); | |
| 3261 const __m128i out_00_7 = _mm_srai_epi32(out_00_5, DCT_CONST_BITS); | |
| 3262 const __m128i out_16_6 = _mm_srai_epi32(out_16_4, DCT_CONST_BITS); | |
| 3263 const __m128i out_16_7 = _mm_srai_epi32(out_16_5, DCT_CONST_BITS); | |
| 3264 const __m128i out_08_6 = _mm_srai_epi32(out_08_4, DCT_CONST_BITS); | |
| 3265 const __m128i out_08_7 = _mm_srai_epi32(out_08_5, DCT_CONST_BITS); | |
| 3266 const __m128i out_24_6 = _mm_srai_epi32(out_24_4, DCT_CONST_BITS); | |
| 3267 const __m128i out_24_7 = _mm_srai_epi32(out_24_5, DCT_CONST_BITS); | |
| 3268 // Combine | |
| 3269 out[ 0] = _mm_packs_epi32(out_00_6, out_00_7); | |
| 3270 out[16] = _mm_packs_epi32(out_16_6, out_16_7); | |
| 3271 out[ 8] = _mm_packs_epi32(out_08_6, out_08_7); | |
| 3272 out[24] = _mm_packs_epi32(out_24_6, out_24_7); | |
| 3273 } | |
| 3274 { | |
| 3275 const __m128i s2_09_0 = _mm_unpacklo_epi16(step1[ 9], step1[14]); | |
| 3276 const __m128i s2_09_1 = _mm_unpackhi_epi16(step1[ 9], step1[14]); | |
| 3277 const __m128i s2_10_0 = _mm_unpacklo_epi16(step1[10], step1[13]); | |
| 3278 const __m128i s2_10_1 = _mm_unpackhi_epi16(step1[10], step1[13]); | |
| 3279 const __m128i s2_09_2 = _mm_madd_epi16(s2_09_0, k__cospi_m08_p24); | |
| 3280 const __m128i s2_09_3 = _mm_madd_epi16(s2_09_1, k__cospi_m08_p24); | |
| 3281 const __m128i s2_10_2 = _mm_madd_epi16(s2_10_0, k__cospi_m24_m08); | |
| 3282 const __m128i s2_10_3 = _mm_madd_epi16(s2_10_1, k__cospi_m24_m08); | |
| 3283 const __m128i s2_13_2 = _mm_madd_epi16(s2_10_0, k__cospi_m08_p24); | |
| 3284 const __m128i s2_13_3 = _mm_madd_epi16(s2_10_1, k__cospi_m08_p24); | |
| 3285 const __m128i s2_14_2 = _mm_madd_epi16(s2_09_0, k__cospi_p24_p08); | |
| 3286 const __m128i s2_14_3 = _mm_madd_epi16(s2_09_1, k__cospi_p24_p08); | |
| 3287 // dct_const_round_shift | |
| 3288 const __m128i s2_09_4 = _mm_add_epi32(s2_09_2, k__DCT_CONST_ROUNDING); | |
| 3289 const __m128i s2_09_5 = _mm_add_epi32(s2_09_3, k__DCT_CONST_ROUNDING); | |
| 3290 const __m128i s2_10_4 = _mm_add_epi32(s2_10_2, k__DCT_CONST_ROUNDING); | |
| 3291 const __m128i s2_10_5 = _mm_add_epi32(s2_10_3, k__DCT_CONST_ROUNDING); | |
| 3292 const __m128i s2_13_4 = _mm_add_epi32(s2_13_2, k__DCT_CONST_ROUNDING); | |
| 3293 const __m128i s2_13_5 = _mm_add_epi32(s2_13_3, k__DCT_CONST_ROUNDING); | |
| 3294 const __m128i s2_14_4 = _mm_add_epi32(s2_14_2, k__DCT_CONST_ROUNDING); | |
| 3295 const __m128i s2_14_5 = _mm_add_epi32(s2_14_3, k__DCT_CONST_ROUNDING); | |
| 3296 const __m128i s2_09_6 = _mm_srai_epi32(s2_09_4, DCT_CONST_BITS); | |
| 3297 const __m128i s2_09_7 = _mm_srai_epi32(s2_09_5, DCT_CONST_BITS); | |
| 3298 const __m128i s2_10_6 = _mm_srai_epi32(s2_10_4, DCT_CONST_BITS); | |
| 3299 const __m128i s2_10_7 = _mm_srai_epi32(s2_10_5, DCT_CONST_BITS); | |
| 3300 const __m128i s2_13_6 = _mm_srai_epi32(s2_13_4, DCT_CONST_BITS); | |
| 3301 const __m128i s2_13_7 = _mm_srai_epi32(s2_13_5, DCT_CONST_BITS); | |
| 3302 const __m128i s2_14_6 = _mm_srai_epi32(s2_14_4, DCT_CONST_BITS); | |
| 3303 const __m128i s2_14_7 = _mm_srai_epi32(s2_14_5, DCT_CONST_BITS); | |
| 3304 // Combine | |
| 3305 step2[ 9] = _mm_packs_epi32(s2_09_6, s2_09_7); | |
| 3306 step2[10] = _mm_packs_epi32(s2_10_6, s2_10_7); | |
| 3307 step2[13] = _mm_packs_epi32(s2_13_6, s2_13_7); | |
| 3308 step2[14] = _mm_packs_epi32(s2_14_6, s2_14_7); | |
| 3309 } | |
| 3310 { | |
| 3311 step2[16] = _mm_add_epi16(step1[19], step3[16]); | |
| 3312 step2[17] = _mm_add_epi16(step1[18], step3[17]); | |
| 3313 step2[18] = _mm_sub_epi16(step3[17], step1[18]); | |
| 3314 step2[19] = _mm_sub_epi16(step3[16], step1[19]); | |
| 3315 step2[20] = _mm_sub_epi16(step3[23], step1[20]); | |
| 3316 step2[21] = _mm_sub_epi16(step3[22], step1[21]); | |
| 3317 step2[22] = _mm_add_epi16(step1[21], step3[22]); | |
| 3318 step2[23] = _mm_add_epi16(step1[20], step3[23]); | |
| 3319 step2[24] = _mm_add_epi16(step1[27], step3[24]); | |
| 3320 step2[25] = _mm_add_epi16(step1[26], step3[25]); | |
| 3321 step2[26] = _mm_sub_epi16(step3[25], step1[26]); | |
| 3322 step2[27] = _mm_sub_epi16(step3[24], step1[27]); | |
| 3323 step2[28] = _mm_sub_epi16(step3[31], step1[28]); | |
| 3324 step2[29] = _mm_sub_epi16(step3[30], step1[29]); | |
| 3325 step2[30] = _mm_add_epi16(step1[29], step3[30]); | |
| 3326 step2[31] = _mm_add_epi16(step1[28], step3[31]); | |
| 3327 } | |
| 3328 // Stage 6 | |
| 3329 { | |
| 3330 const __m128i out_04_0 = _mm_unpacklo_epi16(step2[4], step2[7]); | |
| 3331 const __m128i out_04_1 = _mm_unpackhi_epi16(step2[4], step2[7]); | |
| 3332 const __m128i out_20_0 = _mm_unpacklo_epi16(step2[5], step2[6]); | |
| 3333 const __m128i out_20_1 = _mm_unpackhi_epi16(step2[5], step2[6]); | |
| 3334 const __m128i out_12_0 = _mm_unpacklo_epi16(step2[5], step2[6]); | |
| 3335 const __m128i out_12_1 = _mm_unpackhi_epi16(step2[5], step2[6]); | |
| 3336 const __m128i out_28_0 = _mm_unpacklo_epi16(step2[4], step2[7]); | |
| 3337 const __m128i out_28_1 = _mm_unpackhi_epi16(step2[4], step2[7]); | |
| 3338 const __m128i out_04_2 = _mm_madd_epi16(out_04_0, k__cospi_p28_p04); | |
| 3339 const __m128i out_04_3 = _mm_madd_epi16(out_04_1, k__cospi_p28_p04); | |
| 3340 const __m128i out_20_2 = _mm_madd_epi16(out_20_0, k__cospi_p12_p20); | |
| 3341 const __m128i out_20_3 = _mm_madd_epi16(out_20_1, k__cospi_p12_p20); | |
| 3342 const __m128i out_12_2 = _mm_madd_epi16(out_12_0, k__cospi_m20_p12); | |
| 3343 const __m128i out_12_3 = _mm_madd_epi16(out_12_1, k__cospi_m20_p12); | |
| 3344 const __m128i out_28_2 = _mm_madd_epi16(out_28_0, k__cospi_m04_p28); | |
| 3345 const __m128i out_28_3 = _mm_madd_epi16(out_28_1, k__cospi_m04_p28); | |
| 3346 // dct_const_round_shift | |
| 3347 const __m128i out_04_4 = _mm_add_epi32(out_04_2, k__DCT_CONST_ROUNDING); | |
| 3348 const __m128i out_04_5 = _mm_add_epi32(out_04_3, k__DCT_CONST_ROUNDING); | |
| 3349 const __m128i out_20_4 = _mm_add_epi32(out_20_2, k__DCT_CONST_ROUNDING); | |
| 3350 const __m128i out_20_5 = _mm_add_epi32(out_20_3, k__DCT_CONST_ROUNDING); | |
| 3351 const __m128i out_12_4 = _mm_add_epi32(out_12_2, k__DCT_CONST_ROUNDING); | |
| 3352 const __m128i out_12_5 = _mm_add_epi32(out_12_3, k__DCT_CONST_ROUNDING); | |
| 3353 const __m128i out_28_4 = _mm_add_epi32(out_28_2, k__DCT_CONST_ROUNDING); | |
| 3354 const __m128i out_28_5 = _mm_add_epi32(out_28_3, k__DCT_CONST_ROUNDING); | |
| 3355 const __m128i out_04_6 = _mm_srai_epi32(out_04_4, DCT_CONST_BITS); | |
| 3356 const __m128i out_04_7 = _mm_srai_epi32(out_04_5, DCT_CONST_BITS); | |
| 3357 const __m128i out_20_6 = _mm_srai_epi32(out_20_4, DCT_CONST_BITS); | |
| 3358 const __m128i out_20_7 = _mm_srai_epi32(out_20_5, DCT_CONST_BITS); | |
| 3359 const __m128i out_12_6 = _mm_srai_epi32(out_12_4, DCT_CONST_BITS); | |
| 3360 const __m128i out_12_7 = _mm_srai_epi32(out_12_5, DCT_CONST_BITS); | |
| 3361 const __m128i out_28_6 = _mm_srai_epi32(out_28_4, DCT_CONST_BITS); | |
| 3362 const __m128i out_28_7 = _mm_srai_epi32(out_28_5, DCT_CONST_BITS); | |
| 3363 // Combine | |
| 3364 out[ 4] = _mm_packs_epi32(out_04_6, out_04_7); | |
| 3365 out[20] = _mm_packs_epi32(out_20_6, out_20_7); | |
| 3366 out[12] = _mm_packs_epi32(out_12_6, out_12_7); | |
| 3367 out[28] = _mm_packs_epi32(out_28_6, out_28_7); | |
| 3368 } | |
| 3369 { | |
| 3370 step3[ 8] = _mm_add_epi16(step2[ 9], step1[ 8]); | |
| 3371 step3[ 9] = _mm_sub_epi16(step1[ 8], step2[ 9]); | |
| 3372 step3[10] = _mm_sub_epi16(step1[11], step2[10]); | |
| 3373 step3[11] = _mm_add_epi16(step2[10], step1[11]); | |
| 3374 step3[12] = _mm_add_epi16(step2[13], step1[12]); | |
| 3375 step3[13] = _mm_sub_epi16(step1[12], step2[13]); | |
| 3376 step3[14] = _mm_sub_epi16(step1[15], step2[14]); | |
| 3377 step3[15] = _mm_add_epi16(step2[14], step1[15]); | |
| 3378 } | |
| 3379 { | |
| 3380 const __m128i s3_17_0 = _mm_unpacklo_epi16(step2[17], step2[30]); | |
| 3381 const __m128i s3_17_1 = _mm_unpackhi_epi16(step2[17], step2[30]); | |
| 3382 const __m128i s3_18_0 = _mm_unpacklo_epi16(step2[18], step2[29]); | |
| 3383 const __m128i s3_18_1 = _mm_unpackhi_epi16(step2[18], step2[29]); | |
| 3384 const __m128i s3_21_0 = _mm_unpacklo_epi16(step2[21], step2[26]); | |
| 3385 const __m128i s3_21_1 = _mm_unpackhi_epi16(step2[21], step2[26]); | |
| 3386 const __m128i s3_22_0 = _mm_unpacklo_epi16(step2[22], step2[25]); | |
| 3387 const __m128i s3_22_1 = _mm_unpackhi_epi16(step2[22], step2[25]); | |
| 3388 const __m128i s3_17_2 = _mm_madd_epi16(s3_17_0, k__cospi_m04_p28); | |
| 3389 const __m128i s3_17_3 = _mm_madd_epi16(s3_17_1, k__cospi_m04_p28); | |
| 3390 const __m128i s3_18_2 = _mm_madd_epi16(s3_18_0, k__cospi_m28_m04); | |
| 3391 const __m128i s3_18_3 = _mm_madd_epi16(s3_18_1, k__cospi_m28_m04); | |
| 3392 const __m128i s3_21_2 = _mm_madd_epi16(s3_21_0, k__cospi_m20_p12); | |
| 3393 const __m128i s3_21_3 = _mm_madd_epi16(s3_21_1, k__cospi_m20_p12); | |
| 3394 const __m128i s3_22_2 = _mm_madd_epi16(s3_22_0, k__cospi_m12_m20); | |
| 3395 const __m128i s3_22_3 = _mm_madd_epi16(s3_22_1, k__cospi_m12_m20); | |
| 3396 const __m128i s3_25_2 = _mm_madd_epi16(s3_22_0, k__cospi_m20_p12); | |
| 3397 const __m128i s3_25_3 = _mm_madd_epi16(s3_22_1, k__cospi_m20_p12); | |
| 3398 const __m128i s3_26_2 = _mm_madd_epi16(s3_21_0, k__cospi_p12_p20); | |
| 3399 const __m128i s3_26_3 = _mm_madd_epi16(s3_21_1, k__cospi_p12_p20); | |
| 3400 const __m128i s3_29_2 = _mm_madd_epi16(s3_18_0, k__cospi_m04_p28); | |
| 3401 const __m128i s3_29_3 = _mm_madd_epi16(s3_18_1, k__cospi_m04_p28); | |
| 3402 const __m128i s3_30_2 = _mm_madd_epi16(s3_17_0, k__cospi_p28_p04); | |
| 3403 const __m128i s3_30_3 = _mm_madd_epi16(s3_17_1, k__cospi_p28_p04); | |
| 3404 // dct_const_round_shift | |
| 3405 const __m128i s3_17_4 = _mm_add_epi32(s3_17_2, k__DCT_CONST_ROUNDING); | |
| 3406 const __m128i s3_17_5 = _mm_add_epi32(s3_17_3, k__DCT_CONST_ROUNDING); | |
| 3407 const __m128i s3_18_4 = _mm_add_epi32(s3_18_2, k__DCT_CONST_ROUNDING); | |
| 3408 const __m128i s3_18_5 = _mm_add_epi32(s3_18_3, k__DCT_CONST_ROUNDING); | |
| 3409 const __m128i s3_21_4 = _mm_add_epi32(s3_21_2, k__DCT_CONST_ROUNDING); | |
| 3410 const __m128i s3_21_5 = _mm_add_epi32(s3_21_3, k__DCT_CONST_ROUNDING); | |
| 3411 const __m128i s3_22_4 = _mm_add_epi32(s3_22_2, k__DCT_CONST_ROUNDING); | |
| 3412 const __m128i s3_22_5 = _mm_add_epi32(s3_22_3, k__DCT_CONST_ROUNDING); | |
| 3413 const __m128i s3_17_6 = _mm_srai_epi32(s3_17_4, DCT_CONST_BITS); | |
| 3414 const __m128i s3_17_7 = _mm_srai_epi32(s3_17_5, DCT_CONST_BITS); | |
| 3415 const __m128i s3_18_6 = _mm_srai_epi32(s3_18_4, DCT_CONST_BITS); | |
| 3416 const __m128i s3_18_7 = _mm_srai_epi32(s3_18_5, DCT_CONST_BITS); | |
| 3417 const __m128i s3_21_6 = _mm_srai_epi32(s3_21_4, DCT_CONST_BITS); | |
| 3418 const __m128i s3_21_7 = _mm_srai_epi32(s3_21_5, DCT_CONST_BITS); | |
| 3419 const __m128i s3_22_6 = _mm_srai_epi32(s3_22_4, DCT_CONST_BITS); | |
| 3420 const __m128i s3_22_7 = _mm_srai_epi32(s3_22_5, DCT_CONST_BITS); | |
| 3421 const __m128i s3_25_4 = _mm_add_epi32(s3_25_2, k__DCT_CONST_ROUNDING); | |
| 3422 const __m128i s3_25_5 = _mm_add_epi32(s3_25_3, k__DCT_CONST_ROUNDING); | |
| 3423 const __m128i s3_26_4 = _mm_add_epi32(s3_26_2, k__DCT_CONST_ROUNDING); | |
| 3424 const __m128i s3_26_5 = _mm_add_epi32(s3_26_3, k__DCT_CONST_ROUNDING); | |
| 3425 const __m128i s3_29_4 = _mm_add_epi32(s3_29_2, k__DCT_CONST_ROUNDING); | |
| 3426 const __m128i s3_29_5 = _mm_add_epi32(s3_29_3, k__DCT_CONST_ROUNDING); | |
| 3427 const __m128i s3_30_4 = _mm_add_epi32(s3_30_2, k__DCT_CONST_ROUNDING); | |
| 3428 const __m128i s3_30_5 = _mm_add_epi32(s3_30_3, k__DCT_CONST_ROUNDING); | |
| 3429 const __m128i s3_25_6 = _mm_srai_epi32(s3_25_4, DCT_CONST_BITS); | |
| 3430 const __m128i s3_25_7 = _mm_srai_epi32(s3_25_5, DCT_CONST_BITS); | |
| 3431 const __m128i s3_26_6 = _mm_srai_epi32(s3_26_4, DCT_CONST_BITS); | |
| 3432 const __m128i s3_26_7 = _mm_srai_epi32(s3_26_5, DCT_CONST_BITS); | |
| 3433 const __m128i s3_29_6 = _mm_srai_epi32(s3_29_4, DCT_CONST_BITS); | |
| 3434 const __m128i s3_29_7 = _mm_srai_epi32(s3_29_5, DCT_CONST_BITS); | |
| 3435 const __m128i s3_30_6 = _mm_srai_epi32(s3_30_4, DCT_CONST_BITS); | |
| 3436 const __m128i s3_30_7 = _mm_srai_epi32(s3_30_5, DCT_CONST_BITS); | |
| 3437 // Combine | |
| 3438 step3[17] = _mm_packs_epi32(s3_17_6, s3_17_7); | |
| 3439 step3[18] = _mm_packs_epi32(s3_18_6, s3_18_7); | |
| 3440 step3[21] = _mm_packs_epi32(s3_21_6, s3_21_7); | |
| 3441 step3[22] = _mm_packs_epi32(s3_22_6, s3_22_7); | |
| 3442 // Combine | |
| 3443 step3[25] = _mm_packs_epi32(s3_25_6, s3_25_7); | |
| 3444 step3[26] = _mm_packs_epi32(s3_26_6, s3_26_7); | |
| 3445 step3[29] = _mm_packs_epi32(s3_29_6, s3_29_7); | |
| 3446 step3[30] = _mm_packs_epi32(s3_30_6, s3_30_7); | |
| 3447 } | |
| 3448 // Stage 7 | |
| 3449 { | |
| 3450 const __m128i out_02_0 = _mm_unpacklo_epi16(step3[ 8], step3[15]); | |
| 3451 const __m128i out_02_1 = _mm_unpackhi_epi16(step3[ 8], step3[15]); | |
| 3452 const __m128i out_18_0 = _mm_unpacklo_epi16(step3[ 9], step3[14]); | |
| 3453 const __m128i out_18_1 = _mm_unpackhi_epi16(step3[ 9], step3[14]); | |
| 3454 const __m128i out_10_0 = _mm_unpacklo_epi16(step3[10], step3[13]); | |
| 3455 const __m128i out_10_1 = _mm_unpackhi_epi16(step3[10], step3[13]); | |
| 3456 const __m128i out_26_0 = _mm_unpacklo_epi16(step3[11], step3[12]); | |
| 3457 const __m128i out_26_1 = _mm_unpackhi_epi16(step3[11], step3[12]); | |
| 3458 const __m128i out_02_2 = _mm_madd_epi16(out_02_0, k__cospi_p30_p02); | |
| 3459 const __m128i out_02_3 = _mm_madd_epi16(out_02_1, k__cospi_p30_p02); | |
| 3460 const __m128i out_18_2 = _mm_madd_epi16(out_18_0, k__cospi_p14_p18); | |
| 3461 const __m128i out_18_3 = _mm_madd_epi16(out_18_1, k__cospi_p14_p18); | |
| 3462 const __m128i out_10_2 = _mm_madd_epi16(out_10_0, k__cospi_p22_p10); | |
| 3463 const __m128i out_10_3 = _mm_madd_epi16(out_10_1, k__cospi_p22_p10); | |
| 3464 const __m128i out_26_2 = _mm_madd_epi16(out_26_0, k__cospi_p06_p26); | |
| 3465 const __m128i out_26_3 = _mm_madd_epi16(out_26_1, k__cospi_p06_p26); | |
| 3466 const __m128i out_06_2 = _mm_madd_epi16(out_26_0, k__cospi_m26_p06); | |
| 3467 const __m128i out_06_3 = _mm_madd_epi16(out_26_1, k__cospi_m26_p06); | |
| 3468 const __m128i out_22_2 = _mm_madd_epi16(out_10_0, k__cospi_m10_p22); | |
| 3469 const __m128i out_22_3 = _mm_madd_epi16(out_10_1, k__cospi_m10_p22); | |
| 3470 const __m128i out_14_2 = _mm_madd_epi16(out_18_0, k__cospi_m18_p14); | |
| 3471 const __m128i out_14_3 = _mm_madd_epi16(out_18_1, k__cospi_m18_p14); | |
| 3472 const __m128i out_30_2 = _mm_madd_epi16(out_02_0, k__cospi_m02_p30); | |
| 3473 const __m128i out_30_3 = _mm_madd_epi16(out_02_1, k__cospi_m02_p30); | |
| 3474 // dct_const_round_shift | |
| 3475 const __m128i out_02_4 = _mm_add_epi32(out_02_2, k__DCT_CONST_ROUNDING); | |
| 3476 const __m128i out_02_5 = _mm_add_epi32(out_02_3, k__DCT_CONST_ROUNDING); | |
| 3477 const __m128i out_18_4 = _mm_add_epi32(out_18_2, k__DCT_CONST_ROUNDING); | |
| 3478 const __m128i out_18_5 = _mm_add_epi32(out_18_3, k__DCT_CONST_ROUNDING); | |
| 3479 const __m128i out_10_4 = _mm_add_epi32(out_10_2, k__DCT_CONST_ROUNDING); | |
| 3480 const __m128i out_10_5 = _mm_add_epi32(out_10_3, k__DCT_CONST_ROUNDING); | |
| 3481 const __m128i out_26_4 = _mm_add_epi32(out_26_2, k__DCT_CONST_ROUNDING); | |
| 3482 const __m128i out_26_5 = _mm_add_epi32(out_26_3, k__DCT_CONST_ROUNDING); | |
| 3483 const __m128i out_06_4 = _mm_add_epi32(out_06_2, k__DCT_CONST_ROUNDING); | |
| 3484 const __m128i out_06_5 = _mm_add_epi32(out_06_3, k__DCT_CONST_ROUNDING); | |
| 3485 const __m128i out_22_4 = _mm_add_epi32(out_22_2, k__DCT_CONST_ROUNDING); | |
| 3486 const __m128i out_22_5 = _mm_add_epi32(out_22_3, k__DCT_CONST_ROUNDING); | |
| 3487 const __m128i out_14_4 = _mm_add_epi32(out_14_2, k__DCT_CONST_ROUNDING); | |
| 3488 const __m128i out_14_5 = _mm_add_epi32(out_14_3, k__DCT_CONST_ROUNDING); | |
| 3489 const __m128i out_30_4 = _mm_add_epi32(out_30_2, k__DCT_CONST_ROUNDING); | |
| 3490 const __m128i out_30_5 = _mm_add_epi32(out_30_3, k__DCT_CONST_ROUNDING); | |
| 3491 const __m128i out_02_6 = _mm_srai_epi32(out_02_4, DCT_CONST_BITS); | |
| 3492 const __m128i out_02_7 = _mm_srai_epi32(out_02_5, DCT_CONST_BITS); | |
| 3493 const __m128i out_18_6 = _mm_srai_epi32(out_18_4, DCT_CONST_BITS); | |
| 3494 const __m128i out_18_7 = _mm_srai_epi32(out_18_5, DCT_CONST_BITS); | |
| 3495 const __m128i out_10_6 = _mm_srai_epi32(out_10_4, DCT_CONST_BITS); | |
| 3496 const __m128i out_10_7 = _mm_srai_epi32(out_10_5, DCT_CONST_BITS); | |
| 3497 const __m128i out_26_6 = _mm_srai_epi32(out_26_4, DCT_CONST_BITS); | |
| 3498 const __m128i out_26_7 = _mm_srai_epi32(out_26_5, DCT_CONST_BITS); | |
| 3499 const __m128i out_06_6 = _mm_srai_epi32(out_06_4, DCT_CONST_BITS); | |
| 3500 const __m128i out_06_7 = _mm_srai_epi32(out_06_5, DCT_CONST_BITS); | |
| 3501 const __m128i out_22_6 = _mm_srai_epi32(out_22_4, DCT_CONST_BITS); | |
| 3502 const __m128i out_22_7 = _mm_srai_epi32(out_22_5, DCT_CONST_BITS); | |
| 3503 const __m128i out_14_6 = _mm_srai_epi32(out_14_4, DCT_CONST_BITS); | |
| 3504 const __m128i out_14_7 = _mm_srai_epi32(out_14_5, DCT_CONST_BITS); | |
| 3505 const __m128i out_30_6 = _mm_srai_epi32(out_30_4, DCT_CONST_BITS); | |
| 3506 const __m128i out_30_7 = _mm_srai_epi32(out_30_5, DCT_CONST_BITS); | |
| 3507 // Combine | |
| 3508 out[ 2] = _mm_packs_epi32(out_02_6, out_02_7); | |
| 3509 out[18] = _mm_packs_epi32(out_18_6, out_18_7); | |
| 3510 out[10] = _mm_packs_epi32(out_10_6, out_10_7); | |
| 3511 out[26] = _mm_packs_epi32(out_26_6, out_26_7); | |
| 3512 out[ 6] = _mm_packs_epi32(out_06_6, out_06_7); | |
| 3513 out[22] = _mm_packs_epi32(out_22_6, out_22_7); | |
| 3514 out[14] = _mm_packs_epi32(out_14_6, out_14_7); | |
| 3515 out[30] = _mm_packs_epi32(out_30_6, out_30_7); | |
| 3516 } | |
| 3517 { | |
| 3518 step1[16] = _mm_add_epi16(step3[17], step2[16]); | |
| 3519 step1[17] = _mm_sub_epi16(step2[16], step3[17]); | |
| 3520 step1[18] = _mm_sub_epi16(step2[19], step3[18]); | |
| 3521 step1[19] = _mm_add_epi16(step3[18], step2[19]); | |
| 3522 step1[20] = _mm_add_epi16(step3[21], step2[20]); | |
| 3523 step1[21] = _mm_sub_epi16(step2[20], step3[21]); | |
| 3524 step1[22] = _mm_sub_epi16(step2[23], step3[22]); | |
| 3525 step1[23] = _mm_add_epi16(step3[22], step2[23]); | |
| 3526 step1[24] = _mm_add_epi16(step3[25], step2[24]); | |
| 3527 step1[25] = _mm_sub_epi16(step2[24], step3[25]); | |
| 3528 step1[26] = _mm_sub_epi16(step2[27], step3[26]); | |
| 3529 step1[27] = _mm_add_epi16(step3[26], step2[27]); | |
| 3530 step1[28] = _mm_add_epi16(step3[29], step2[28]); | |
| 3531 step1[29] = _mm_sub_epi16(step2[28], step3[29]); | |
| 3532 step1[30] = _mm_sub_epi16(step2[31], step3[30]); | |
| 3533 step1[31] = _mm_add_epi16(step3[30], step2[31]); | |
| 3534 } | |
| 3535 // Final stage --- outputs indices are bit-reversed. | |
| 3536 { | |
| 3537 const __m128i out_01_0 = _mm_unpacklo_epi16(step1[16], step1[31]); | |
| 3538 const __m128i out_01_1 = _mm_unpackhi_epi16(step1[16], step1[31]); | |
| 3539 const __m128i out_17_0 = _mm_unpacklo_epi16(step1[17], step1[30]); | |
| 3540 const __m128i out_17_1 = _mm_unpackhi_epi16(step1[17], step1[30]); | |
| 3541 const __m128i out_09_0 = _mm_unpacklo_epi16(step1[18], step1[29]); | |
| 3542 const __m128i out_09_1 = _mm_unpackhi_epi16(step1[18], step1[29]); | |
| 3543 const __m128i out_25_0 = _mm_unpacklo_epi16(step1[19], step1[28]); | |
| 3544 const __m128i out_25_1 = _mm_unpackhi_epi16(step1[19], step1[28]); | |
| 3545 const __m128i out_01_2 = _mm_madd_epi16(out_01_0, k__cospi_p31_p01); | |
| 3546 const __m128i out_01_3 = _mm_madd_epi16(out_01_1, k__cospi_p31_p01); | |
| 3547 const __m128i out_17_2 = _mm_madd_epi16(out_17_0, k__cospi_p15_p17); | |
| 3548 const __m128i out_17_3 = _mm_madd_epi16(out_17_1, k__cospi_p15_p17); | |
| 3549 const __m128i out_09_2 = _mm_madd_epi16(out_09_0, k__cospi_p23_p09); | |
| 3550 const __m128i out_09_3 = _mm_madd_epi16(out_09_1, k__cospi_p23_p09); | |
| 3551 const __m128i out_25_2 = _mm_madd_epi16(out_25_0, k__cospi_p07_p25); | |
| 3552 const __m128i out_25_3 = _mm_madd_epi16(out_25_1, k__cospi_p07_p25); | |
| 3553 const __m128i out_07_2 = _mm_madd_epi16(out_25_0, k__cospi_m25_p07); | |
| 3554 const __m128i out_07_3 = _mm_madd_epi16(out_25_1, k__cospi_m25_p07); | |
| 3555 const __m128i out_23_2 = _mm_madd_epi16(out_09_0, k__cospi_m09_p23); | |
| 3556 const __m128i out_23_3 = _mm_madd_epi16(out_09_1, k__cospi_m09_p23); | |
| 3557 const __m128i out_15_2 = _mm_madd_epi16(out_17_0, k__cospi_m17_p15); | |
| 3558 const __m128i out_15_3 = _mm_madd_epi16(out_17_1, k__cospi_m17_p15); | |
| 3559 const __m128i out_31_2 = _mm_madd_epi16(out_01_0, k__cospi_m01_p31); | |
| 3560 const __m128i out_31_3 = _mm_madd_epi16(out_01_1, k__cospi_m01_p31); | |
| 3561 // dct_const_round_shift | |
| 3562 const __m128i out_01_4 = _mm_add_epi32(out_01_2, k__DCT_CONST_ROUNDING); | |
| 3563 const __m128i out_01_5 = _mm_add_epi32(out_01_3, k__DCT_CONST_ROUNDING); | |
| 3564 const __m128i out_17_4 = _mm_add_epi32(out_17_2, k__DCT_CONST_ROUNDING); | |
| 3565 const __m128i out_17_5 = _mm_add_epi32(out_17_3, k__DCT_CONST_ROUNDING); | |
| 3566 const __m128i out_09_4 = _mm_add_epi32(out_09_2, k__DCT_CONST_ROUNDING); | |
| 3567 const __m128i out_09_5 = _mm_add_epi32(out_09_3, k__DCT_CONST_ROUNDING); | |
| 3568 const __m128i out_25_4 = _mm_add_epi32(out_25_2, k__DCT_CONST_ROUNDING); | |
| 3569 const __m128i out_25_5 = _mm_add_epi32(out_25_3, k__DCT_CONST_ROUNDING); | |
| 3570 const __m128i out_07_4 = _mm_add_epi32(out_07_2, k__DCT_CONST_ROUNDING); | |
| 3571 const __m128i out_07_5 = _mm_add_epi32(out_07_3, k__DCT_CONST_ROUNDING); | |
| 3572 const __m128i out_23_4 = _mm_add_epi32(out_23_2, k__DCT_CONST_ROUNDING); | |
| 3573 const __m128i out_23_5 = _mm_add_epi32(out_23_3, k__DCT_CONST_ROUNDING); | |
| 3574 const __m128i out_15_4 = _mm_add_epi32(out_15_2, k__DCT_CONST_ROUNDING); | |
| 3575 const __m128i out_15_5 = _mm_add_epi32(out_15_3, k__DCT_CONST_ROUNDING); | |
| 3576 const __m128i out_31_4 = _mm_add_epi32(out_31_2, k__DCT_CONST_ROUNDING); | |
| 3577 const __m128i out_31_5 = _mm_add_epi32(out_31_3, k__DCT_CONST_ROUNDING); | |
| 3578 const __m128i out_01_6 = _mm_srai_epi32(out_01_4, DCT_CONST_BITS); | |
| 3579 const __m128i out_01_7 = _mm_srai_epi32(out_01_5, DCT_CONST_BITS); | |
| 3580 const __m128i out_17_6 = _mm_srai_epi32(out_17_4, DCT_CONST_BITS); | |
| 3581 const __m128i out_17_7 = _mm_srai_epi32(out_17_5, DCT_CONST_BITS); | |
| 3582 const __m128i out_09_6 = _mm_srai_epi32(out_09_4, DCT_CONST_BITS); | |
| 3583 const __m128i out_09_7 = _mm_srai_epi32(out_09_5, DCT_CONST_BITS); | |
| 3584 const __m128i out_25_6 = _mm_srai_epi32(out_25_4, DCT_CONST_BITS); | |
| 3585 const __m128i out_25_7 = _mm_srai_epi32(out_25_5, DCT_CONST_BITS); | |
| 3586 const __m128i out_07_6 = _mm_srai_epi32(out_07_4, DCT_CONST_BITS); | |
| 3587 const __m128i out_07_7 = _mm_srai_epi32(out_07_5, DCT_CONST_BITS); | |
| 3588 const __m128i out_23_6 = _mm_srai_epi32(out_23_4, DCT_CONST_BITS); | |
| 3589 const __m128i out_23_7 = _mm_srai_epi32(out_23_5, DCT_CONST_BITS); | |
| 3590 const __m128i out_15_6 = _mm_srai_epi32(out_15_4, DCT_CONST_BITS); | |
| 3591 const __m128i out_15_7 = _mm_srai_epi32(out_15_5, DCT_CONST_BITS); | |
| 3592 const __m128i out_31_6 = _mm_srai_epi32(out_31_4, DCT_CONST_BITS); | |
| 3593 const __m128i out_31_7 = _mm_srai_epi32(out_31_5, DCT_CONST_BITS); | |
| 3594 // Combine | |
| 3595 out[ 1] = _mm_packs_epi32(out_01_6, out_01_7); | |
| 3596 out[17] = _mm_packs_epi32(out_17_6, out_17_7); | |
| 3597 out[ 9] = _mm_packs_epi32(out_09_6, out_09_7); | |
| 3598 out[25] = _mm_packs_epi32(out_25_6, out_25_7); | |
| 3599 out[ 7] = _mm_packs_epi32(out_07_6, out_07_7); | |
| 3600 out[23] = _mm_packs_epi32(out_23_6, out_23_7); | |
| 3601 out[15] = _mm_packs_epi32(out_15_6, out_15_7); | |
| 3602 out[31] = _mm_packs_epi32(out_31_6, out_31_7); | |
| 3603 } | |
| 3604 { | |
| 3605 const __m128i out_05_0 = _mm_unpacklo_epi16(step1[20], step1[27]); | |
| 3606 const __m128i out_05_1 = _mm_unpackhi_epi16(step1[20], step1[27]); | |
| 3607 const __m128i out_21_0 = _mm_unpacklo_epi16(step1[21], step1[26]); | |
| 3608 const __m128i out_21_1 = _mm_unpackhi_epi16(step1[21], step1[26]); | |
| 3609 const __m128i out_13_0 = _mm_unpacklo_epi16(step1[22], step1[25]); | |
| 3610 const __m128i out_13_1 = _mm_unpackhi_epi16(step1[22], step1[25]); | |
| 3611 const __m128i out_29_0 = _mm_unpacklo_epi16(step1[23], step1[24]); | |
| 3612 const __m128i out_29_1 = _mm_unpackhi_epi16(step1[23], step1[24]); | |
| 3613 const __m128i out_05_2 = _mm_madd_epi16(out_05_0, k__cospi_p27_p05); | |
| 3614 const __m128i out_05_3 = _mm_madd_epi16(out_05_1, k__cospi_p27_p05); | |
| 3615 const __m128i out_21_2 = _mm_madd_epi16(out_21_0, k__cospi_p11_p21); | |
| 3616 const __m128i out_21_3 = _mm_madd_epi16(out_21_1, k__cospi_p11_p21); | |
| 3617 const __m128i out_13_2 = _mm_madd_epi16(out_13_0, k__cospi_p19_p13); | |
| 3618 const __m128i out_13_3 = _mm_madd_epi16(out_13_1, k__cospi_p19_p13); | |
| 3619 const __m128i out_29_2 = _mm_madd_epi16(out_29_0, k__cospi_p03_p29); | |
| 3620 const __m128i out_29_3 = _mm_madd_epi16(out_29_1, k__cospi_p03_p29); | |
| 3621 const __m128i out_03_2 = _mm_madd_epi16(out_29_0, k__cospi_m29_p03); | |
| 3622 const __m128i out_03_3 = _mm_madd_epi16(out_29_1, k__cospi_m29_p03); | |
| 3623 const __m128i out_19_2 = _mm_madd_epi16(out_13_0, k__cospi_m13_p19); | |
| 3624 const __m128i out_19_3 = _mm_madd_epi16(out_13_1, k__cospi_m13_p19); | |
| 3625 const __m128i out_11_2 = _mm_madd_epi16(out_21_0, k__cospi_m21_p11); | |
| 3626 const __m128i out_11_3 = _mm_madd_epi16(out_21_1, k__cospi_m21_p11); | |
| 3627 const __m128i out_27_2 = _mm_madd_epi16(out_05_0, k__cospi_m05_p27); | |
| 3628 const __m128i out_27_3 = _mm_madd_epi16(out_05_1, k__cospi_m05_p27); | |
| 3629 // dct_const_round_shift | |
| 3630 const __m128i out_05_4 = _mm_add_epi32(out_05_2, k__DCT_CONST_ROUNDING); | |
| 3631 const __m128i out_05_5 = _mm_add_epi32(out_05_3, k__DCT_CONST_ROUNDING); | |
| 3632 const __m128i out_21_4 = _mm_add_epi32(out_21_2, k__DCT_CONST_ROUNDING); | |
| 3633 const __m128i out_21_5 = _mm_add_epi32(out_21_3, k__DCT_CONST_ROUNDING); | |
| 3634 const __m128i out_13_4 = _mm_add_epi32(out_13_2, k__DCT_CONST_ROUNDING); | |
| 3635 const __m128i out_13_5 = _mm_add_epi32(out_13_3, k__DCT_CONST_ROUNDING); | |
| 3636 const __m128i out_29_4 = _mm_add_epi32(out_29_2, k__DCT_CONST_ROUNDING); | |
| 3637 const __m128i out_29_5 = _mm_add_epi32(out_29_3, k__DCT_CONST_ROUNDING); | |
| 3638 const __m128i out_03_4 = _mm_add_epi32(out_03_2, k__DCT_CONST_ROUNDING); | |
| 3639 const __m128i out_03_5 = _mm_add_epi32(out_03_3, k__DCT_CONST_ROUNDING); | |
| 3640 const __m128i out_19_4 = _mm_add_epi32(out_19_2, k__DCT_CONST_ROUNDING); | |
| 3641 const __m128i out_19_5 = _mm_add_epi32(out_19_3, k__DCT_CONST_ROUNDING); | |
| 3642 const __m128i out_11_4 = _mm_add_epi32(out_11_2, k__DCT_CONST_ROUNDING); | |
| 3643 const __m128i out_11_5 = _mm_add_epi32(out_11_3, k__DCT_CONST_ROUNDING); | |
| 3644 const __m128i out_27_4 = _mm_add_epi32(out_27_2, k__DCT_CONST_ROUNDING); | |
| 3645 const __m128i out_27_5 = _mm_add_epi32(out_27_3, k__DCT_CONST_ROUNDING); | |
| 3646 const __m128i out_05_6 = _mm_srai_epi32(out_05_4, DCT_CONST_BITS); | |
| 3647 const __m128i out_05_7 = _mm_srai_epi32(out_05_5, DCT_CONST_BITS); | |
| 3648 const __m128i out_21_6 = _mm_srai_epi32(out_21_4, DCT_CONST_BITS); | |
| 3649 const __m128i out_21_7 = _mm_srai_epi32(out_21_5, DCT_CONST_BITS); | |
| 3650 const __m128i out_13_6 = _mm_srai_epi32(out_13_4, DCT_CONST_BITS); | |
| 3651 const __m128i out_13_7 = _mm_srai_epi32(out_13_5, DCT_CONST_BITS); | |
| 3652 const __m128i out_29_6 = _mm_srai_epi32(out_29_4, DCT_CONST_BITS); | |
| 3653 const __m128i out_29_7 = _mm_srai_epi32(out_29_5, DCT_CONST_BITS); | |
| 3654 const __m128i out_03_6 = _mm_srai_epi32(out_03_4, DCT_CONST_BITS); | |
| 3655 const __m128i out_03_7 = _mm_srai_epi32(out_03_5, DCT_CONST_BITS); | |
| 3656 const __m128i out_19_6 = _mm_srai_epi32(out_19_4, DCT_CONST_BITS); | |
| 3657 const __m128i out_19_7 = _mm_srai_epi32(out_19_5, DCT_CONST_BITS); | |
| 3658 const __m128i out_11_6 = _mm_srai_epi32(out_11_4, DCT_CONST_BITS); | |
| 3659 const __m128i out_11_7 = _mm_srai_epi32(out_11_5, DCT_CONST_BITS); | |
| 3660 const __m128i out_27_6 = _mm_srai_epi32(out_27_4, DCT_CONST_BITS); | |
| 3661 const __m128i out_27_7 = _mm_srai_epi32(out_27_5, DCT_CONST_BITS); | |
| 3662 // Combine | |
| 3663 out[ 5] = _mm_packs_epi32(out_05_6, out_05_7); | |
| 3664 out[21] = _mm_packs_epi32(out_21_6, out_21_7); | |
| 3665 out[13] = _mm_packs_epi32(out_13_6, out_13_7); | |
| 3666 out[29] = _mm_packs_epi32(out_29_6, out_29_7); | |
| 3667 out[ 3] = _mm_packs_epi32(out_03_6, out_03_7); | |
| 3668 out[19] = _mm_packs_epi32(out_19_6, out_19_7); | |
| 3669 out[11] = _mm_packs_epi32(out_11_6, out_11_7); | |
| 3670 out[27] = _mm_packs_epi32(out_27_6, out_27_7); | |
| 3671 } | |
| 3672 // Transpose the results, do it as four 8x8 transposes. | |
| 3673 { | |
| 3674 int transpose_block; | |
| 3675 int16_t *output; | |
| 3676 if (0 == pass) { | |
| 3677 output = &intermediate[column_start * 32]; | |
| 3678 } else { | |
| 3679 output = &output_org[column_start * 32]; | |
| 3680 } | |
| 3681 for (transpose_block = 0; transpose_block < 4; ++transpose_block) { | |
| 3682 __m128i *this_out = &out[8 * transpose_block]; | |
| 3683 // 00 01 02 03 04 05 06 07 | |
| 3684 // 10 11 12 13 14 15 16 17 | |
| 3685 // 20 21 22 23 24 25 26 27 | |
| 3686 // 30 31 32 33 34 35 36 37 | |
| 3687 // 40 41 42 43 44 45 46 47 | |
| 3688 // 50 51 52 53 54 55 56 57 | |
| 3689 // 60 61 62 63 64 65 66 67 | |
| 3690 // 70 71 72 73 74 75 76 77 | |
| 3691 const __m128i tr0_0 = _mm_unpacklo_epi16(this_out[0], this_out[1]); | |
| 3692 const __m128i tr0_1 = _mm_unpacklo_epi16(this_out[2], this_out[3]); | |
| 3693 const __m128i tr0_2 = _mm_unpackhi_epi16(this_out[0], this_out[1]); | |
| 3694 const __m128i tr0_3 = _mm_unpackhi_epi16(this_out[2], this_out[3]); | |
| 3695 const __m128i tr0_4 = _mm_unpacklo_epi16(this_out[4], this_out[5]); | |
| 3696 const __m128i tr0_5 = _mm_unpacklo_epi16(this_out[6], this_out[7]); | |
| 3697 const __m128i tr0_6 = _mm_unpackhi_epi16(this_out[4], this_out[5]); | |
| 3698 const __m128i tr0_7 = _mm_unpackhi_epi16(this_out[6], this_out[7]); | |
| 3699 // 00 10 01 11 02 12 03 13 | |
| 3700 // 20 30 21 31 22 32 23 33 | |
| 3701 // 04 14 05 15 06 16 07 17 | |
| 3702 // 24 34 25 35 26 36 27 37 | |
| 3703 // 40 50 41 51 42 52 43 53 | |
| 3704 // 60 70 61 71 62 72 63 73 | |
| 3705 // 54 54 55 55 56 56 57 57 | |
| 3706 // 64 74 65 75 66 76 67 77 | |
| 3707 const __m128i tr1_0 = _mm_unpacklo_epi32(tr0_0, tr0_1); | |
| 3708 const __m128i tr1_1 = _mm_unpacklo_epi32(tr0_2, tr0_3); | |
| 3709 const __m128i tr1_2 = _mm_unpackhi_epi32(tr0_0, tr0_1); | |
| 3710 const __m128i tr1_3 = _mm_unpackhi_epi32(tr0_2, tr0_3); | |
| 3711 const __m128i tr1_4 = _mm_unpacklo_epi32(tr0_4, tr0_5); | |
| 3712 const __m128i tr1_5 = _mm_unpacklo_epi32(tr0_6, tr0_7); | |
| 3713 const __m128i tr1_6 = _mm_unpackhi_epi32(tr0_4, tr0_5); | |
| 3714 const __m128i tr1_7 = _mm_unpackhi_epi32(tr0_6, tr0_7); | |
| 3715 // 00 10 20 30 01 11 21 31 | |
| 3716 // 40 50 60 70 41 51 61 71 | |
| 3717 // 02 12 22 32 03 13 23 33 | |
| 3718 // 42 52 62 72 43 53 63 73 | |
| 3719 // 04 14 24 34 05 15 21 36 | |
| 3720 // 44 54 64 74 45 55 61 76 | |
| 3721 // 06 16 26 36 07 17 27 37 | |
| 3722 // 46 56 66 76 47 57 67 77 | |
| 3723 __m128i tr2_0 = _mm_unpacklo_epi64(tr1_0, tr1_4); | |
| 3724 __m128i tr2_1 = _mm_unpackhi_epi64(tr1_0, tr1_4); | |
| 3725 __m128i tr2_2 = _mm_unpacklo_epi64(tr1_2, tr1_6); | |
| 3726 __m128i tr2_3 = _mm_unpackhi_epi64(tr1_2, tr1_6); | |
| 3727 __m128i tr2_4 = _mm_unpacklo_epi64(tr1_1, tr1_5); | |
| 3728 __m128i tr2_5 = _mm_unpackhi_epi64(tr1_1, tr1_5); | |
| 3729 __m128i tr2_6 = _mm_unpacklo_epi64(tr1_3, tr1_7); | |
| 3730 __m128i tr2_7 = _mm_unpackhi_epi64(tr1_3, tr1_7); | |
| 3731 // 00 10 20 30 40 50 60 70 | |
| 3732 // 01 11 21 31 41 51 61 71 | |
| 3733 // 02 12 22 32 42 52 62 72 | |
| 3734 // 03 13 23 33 43 53 63 73 | |
| 3735 // 04 14 24 34 44 54 64 74 | |
| 3736 // 05 15 25 35 45 55 65 75 | |
| 3737 // 06 16 26 36 46 56 66 76 | |
| 3738 // 07 17 27 37 47 57 67 77 | |
| 3739 if (0 == pass) { | |
| 3740 // output[j] = (output[j] + 1 + (output[j] > 0)) >> 2; | |
| 3741 // TODO(cd): see quality impact of only doing | |
| 3742 // output[j] = (output[j] + 1) >> 2; | |
| 3743 // which would remove the code between here ... | |
| 3744 __m128i tr2_0_0 = _mm_cmpgt_epi16(tr2_0, kZero); | |
| 3745 __m128i tr2_1_0 = _mm_cmpgt_epi16(tr2_1, kZero); | |
| 3746 __m128i tr2_2_0 = _mm_cmpgt_epi16(tr2_2, kZero); | |
| 3747 __m128i tr2_3_0 = _mm_cmpgt_epi16(tr2_3, kZero); | |
| 3748 __m128i tr2_4_0 = _mm_cmpgt_epi16(tr2_4, kZero); | |
| 3749 __m128i tr2_5_0 = _mm_cmpgt_epi16(tr2_5, kZero); | |
| 3750 __m128i tr2_6_0 = _mm_cmpgt_epi16(tr2_6, kZero); | |
| 3751 __m128i tr2_7_0 = _mm_cmpgt_epi16(tr2_7, kZero); | |
| 3752 tr2_0 = _mm_sub_epi16(tr2_0, tr2_0_0); | |
| 3753 tr2_1 = _mm_sub_epi16(tr2_1, tr2_1_0); | |
| 3754 tr2_2 = _mm_sub_epi16(tr2_2, tr2_2_0); | |
| 3755 tr2_3 = _mm_sub_epi16(tr2_3, tr2_3_0); | |
| 3756 tr2_4 = _mm_sub_epi16(tr2_4, tr2_4_0); | |
| 3757 tr2_5 = _mm_sub_epi16(tr2_5, tr2_5_0); | |
| 3758 tr2_6 = _mm_sub_epi16(tr2_6, tr2_6_0); | |
| 3759 tr2_7 = _mm_sub_epi16(tr2_7, tr2_7_0); | |
| 3760 // ... and here. | |
| 3761 // PS: also change code in vp9/encoder/vp9_dct.c | |
| 3762 tr2_0 = _mm_add_epi16(tr2_0, kOne); | |
| 3763 tr2_1 = _mm_add_epi16(tr2_1, kOne); | |
| 3764 tr2_2 = _mm_add_epi16(tr2_2, kOne); | |
| 3765 tr2_3 = _mm_add_epi16(tr2_3, kOne); | |
| 3766 tr2_4 = _mm_add_epi16(tr2_4, kOne); | |
| 3767 tr2_5 = _mm_add_epi16(tr2_5, kOne); | |
| 3768 tr2_6 = _mm_add_epi16(tr2_6, kOne); | |
| 3769 tr2_7 = _mm_add_epi16(tr2_7, kOne); | |
| 3770 tr2_0 = _mm_srai_epi16(tr2_0, 2); | |
| 3771 tr2_1 = _mm_srai_epi16(tr2_1, 2); | |
| 3772 tr2_2 = _mm_srai_epi16(tr2_2, 2); | |
| 3773 tr2_3 = _mm_srai_epi16(tr2_3, 2); | |
| 3774 tr2_4 = _mm_srai_epi16(tr2_4, 2); | |
| 3775 tr2_5 = _mm_srai_epi16(tr2_5, 2); | |
| 3776 tr2_6 = _mm_srai_epi16(tr2_6, 2); | |
| 3777 tr2_7 = _mm_srai_epi16(tr2_7, 2); | |
| 3778 } | |
| 3779 // Note: even though all these stores are aligned, using the aligned | |
| 3780 // intrinsic make the code slightly slower. | |
| 3781 _mm_storeu_si128((__m128i *)(output + 0 * 32), tr2_0); | |
| 3782 _mm_storeu_si128((__m128i *)(output + 1 * 32), tr2_1); | |
| 3783 _mm_storeu_si128((__m128i *)(output + 2 * 32), tr2_2); | |
| 3784 _mm_storeu_si128((__m128i *)(output + 3 * 32), tr2_3); | |
| 3785 _mm_storeu_si128((__m128i *)(output + 4 * 32), tr2_4); | |
| 3786 _mm_storeu_si128((__m128i *)(output + 5 * 32), tr2_5); | |
| 3787 _mm_storeu_si128((__m128i *)(output + 6 * 32), tr2_6); | |
| 3788 _mm_storeu_si128((__m128i *)(output + 7 * 32), tr2_7); | |
| 3789 // Process next 8x8 | |
| 3790 output += 8; | |
| 3791 } | |
| 3792 } | |
| 3793 } | |
| 3794 } | |
| 3795 } | |
| OLD | NEW |