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 |