| /* |
| * Copyright (c) 2021, Alliance for Open Media. All rights reserved |
| * |
| * This source code is subject to the terms of the BSD 3-Clause Clear License |
| * and the Alliance for Open Media Patent License 1.0. If the BSD 3-Clause Clear |
| * License was not distributed with this source code in the LICENSE file, you |
| * can obtain it at aomedia.org/license/software-license/bsd-3-c-c/. If the |
| * Alliance for Open Media Patent License 1.0 was not distributed with this |
| * source code in the PATENTS file, you can obtain it at |
| * aomedia.org/license/patent-license/. |
| */ |
| #include <immintrin.h> |
| |
| #include "config/av1_rtcd.h" |
| |
| #include "aom_dsp/x86/convolve_sse4_1.h" |
| #include "av1/common/warped_motion.h" |
| |
| #if CONFIG_EXT_WARP_FILTER |
| DECLARE_ALIGNED(32, static const uint8_t, |
| shuffle_pattern_0[32]) = { 0, 1, 2, 3, 2, 3, 4, 5, 4, 5, 6, |
| 7, 6, 7, 8, 9, 0, 1, 2, 3, 2, 3, |
| 4, 5, 4, 5, 6, 7, 6, 7, 8, 9 }; |
| |
| DECLARE_ALIGNED(32, static const uint8_t, shuffle_pattern_1[32]) = { |
| 4, 5, 6, 7, 6, 7, 8, 9, 8, 9, 10, 11, 10, 11, 12, 13, |
| 4, 5, 6, 7, 6, 7, 8, 9, 8, 9, 10, 11, 10, 11, 12, 13 |
| }; |
| |
| DECLARE_ALIGNED(32, static const uint8_t, shuffle_pattern_2[32]) = { |
| 6, 7, 8, 9, 8, 9, 10, 11, 10, 11, 12, 13, 12, 13, 14, 15, |
| 6, 7, 8, 9, 8, 9, 10, 11, 10, 11, 12, 13, 12, 13, 14, 15 |
| }; |
| #endif // CONFIG_EXT_WARP_FILTER |
| |
| DECLARE_ALIGNED(32, static const uint8_t, shuffle_input_mask[32]) = { |
| 0, 1, 8, 9, 2, 3, 10, 11, 4, 5, 12, 13, 6, 7, 14, 15, |
| 0, 1, 8, 9, 2, 3, 10, 11, 4, 5, 12, 13, 6, 7, 14, 15 |
| }; |
| |
| DECLARE_ALIGNED(32, static const uint8_t, |
| shuffle_gamma0_mask0[32]) = { 0, 1, 2, 3, 0, 1, 2, 3, 0, 1, 2, |
| 3, 0, 1, 2, 3, 0, 1, 2, 3, 0, 1, |
| 2, 3, 0, 1, 2, 3, 0, 1, 2, 3 }; |
| |
| DECLARE_ALIGNED(32, static const uint8_t, |
| shuffle_gamma0_mask1[32]) = { 4, 5, 6, 7, 4, 5, 6, 7, 4, 5, 6, |
| 7, 4, 5, 6, 7, 4, 5, 6, 7, 4, 5, |
| 6, 7, 4, 5, 6, 7, 4, 5, 6, 7 }; |
| |
| DECLARE_ALIGNED(32, static const uint8_t, shuffle_gamma0_mask2[32]) = { |
| 8, 9, 10, 11, 8, 9, 10, 11, 8, 9, 10, 11, 8, 9, 10, 11, |
| 8, 9, 10, 11, 8, 9, 10, 11, 8, 9, 10, 11, 8, 9, 10, 11 |
| }; |
| |
| DECLARE_ALIGNED(32, static const uint8_t, shuffle_gamma0_mask3[32]) = { |
| 12, 13, 14, 15, 12, 13, 14, 15, 12, 13, 14, 15, 12, 13, 14, 15, |
| 12, 13, 14, 15, 12, 13, 14, 15, 12, 13, 14, 15, 12, 13, 14, 15 |
| }; |
| |
| static INLINE void prepare_vertical_filter_coeffs_avx2(int sy, int gamma, |
| __m256i *coeffs) { |
| // A7 A6 A5 A4 A3 A2 A1 A0 |
| __m256i v_coeff01 = _mm256_castsi128_si256(_mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sy) >> WARPEDDIFF_PREC_BITS])); |
| // B7 B6 B5 B4 B3 B2 B1 B0 | A7 A6 A5 A4 A3 A2 A1 A0 |
| v_coeff01 = _mm256_inserti128_si256( |
| v_coeff01, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sy + gamma) >> WARPEDDIFF_PREC_BITS]), |
| 1); |
| // C7 C6 C5 C4 C3 C2 C1 C0 |
| __m256i v_coeff23 = _mm256_castsi128_si256(_mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sy + 2 * gamma) >> WARPEDDIFF_PREC_BITS])); |
| // D7 D6 D5 D4 D3 D2 D1 D0 | C7 C6 C5 C4 C3 C2 C1 C0 |
| v_coeff23 = _mm256_inserti128_si256( |
| v_coeff23, |
| _mm_loadu_si128( |
| (__m128i *) |
| av1_warped_filter[(sy + 3 * gamma) >> WARPEDDIFF_PREC_BITS]), |
| 1); |
| // E7 E6 E5 E4 E3 E2 E1 E0 |
| __m256i v_coeff45 = _mm256_castsi128_si256(_mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sy + 4 * gamma) >> WARPEDDIFF_PREC_BITS])); |
| // F7 F6 F5 F4 F3 F2 F1 F0 | E7 E6 E5 E4 E3 E2 E1 E0 |
| v_coeff45 = _mm256_inserti128_si256( |
| v_coeff45, |
| _mm_loadu_si128( |
| (__m128i *) |
| av1_warped_filter[(sy + 5 * gamma) >> WARPEDDIFF_PREC_BITS]), |
| 1); |
| // G7 G6 G5 G4 G3 G2 G1 G0 |
| __m256i v_coeff67 = _mm256_castsi128_si256(_mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sy + 6 * gamma) >> WARPEDDIFF_PREC_BITS])); |
| // H7 H6 H5 H4 H3 H2 H1 H0 | G7 G6 G5 G4 G3 G2 G1 G0 |
| v_coeff67 = _mm256_inserti128_si256( |
| v_coeff67, |
| _mm_loadu_si128( |
| (__m128i *) |
| av1_warped_filter[(sy + 7 * gamma) >> WARPEDDIFF_PREC_BITS]), |
| 1); |
| // D3 D2 B3 B2 D1 D0 B1 B0 | C3 C2 A3 A2 C1 C0 A1 A0 |
| __m256i v_c0123 = _mm256_unpacklo_epi32(v_coeff01, v_coeff23); |
| // D7 D6 B7 B6 D5 D4 B5 B4 | C7 C6 A7 A6 C5 C4 A5 A4 |
| __m256i v_c0123u = _mm256_unpackhi_epi32(v_coeff01, v_coeff23); |
| // H3 H2 F3 F2 H1 H0 F1 F0 | G3 G2 E3 E2 G1 G0 E1 E0 |
| __m256i v_c4567 = _mm256_unpacklo_epi32(v_coeff45, v_coeff67); |
| // H7 H6 F7 F6 H5 H4 F5 F4 | G7 G6 E7 E6 G5 G4 E5 E4 |
| __m256i v_c4567u = _mm256_unpackhi_epi32(v_coeff45, v_coeff67); |
| |
| coeffs[0] = _mm256_unpacklo_epi64(v_c0123, v_c4567); |
| coeffs[1] = _mm256_unpackhi_epi64(v_c0123, v_c4567); |
| coeffs[2] = _mm256_unpacklo_epi64(v_c0123u, v_c4567u); |
| coeffs[3] = _mm256_unpackhi_epi64(v_c0123u, v_c4567u); |
| } |
| |
| static INLINE void prepare_vertical_filter_coeffs_gamma0_avx2(int32_t sy, |
| __m256i *coeffs) { |
| __m256i v_coeff = _mm256_castsi128_si256(_mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sy) >> WARPEDDIFF_PREC_BITS])); |
| v_coeff = |
| _mm256_inserti128_si256(v_coeff, _mm256_castsi256_si128(v_coeff), 1); |
| |
| coeffs[0] = _mm256_shuffle_epi8( |
| v_coeff, _mm256_load_si256((__m256i *)shuffle_gamma0_mask0)); |
| coeffs[1] = _mm256_shuffle_epi8( |
| v_coeff, _mm256_load_si256((__m256i *)shuffle_gamma0_mask1)); |
| coeffs[2] = _mm256_shuffle_epi8( |
| v_coeff, _mm256_load_si256((__m256i *)shuffle_gamma0_mask2)); |
| coeffs[3] = _mm256_shuffle_epi8( |
| v_coeff, _mm256_load_si256((__m256i *)shuffle_gamma0_mask3)); |
| } |
| |
| static INLINE void prepare_input_data(__m256i *input, __m256i *src) { |
| __m256i input_01 = _mm256_packus_epi32(input[0], input[1]); |
| __m256i input_23 = _mm256_packus_epi32(input[2], input[3]); |
| __m256i input_45 = _mm256_packus_epi32(input[4], input[5]); |
| |
| __m256i input_12 = _mm256_packus_epi32(input[1], input[2]); |
| __m256i input_34 = _mm256_packus_epi32(input[3], input[4]); |
| __m256i input_56 = _mm256_packus_epi32(input[5], input[6]); |
| |
| src[0] = _mm256_shuffle_epi8( |
| input_01, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| src[1] = _mm256_shuffle_epi8( |
| input_23, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| src[2] = _mm256_shuffle_epi8( |
| input_45, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| src[4] = _mm256_shuffle_epi8( |
| input_12, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| src[5] = _mm256_shuffle_epi8( |
| input_34, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| src[6] = _mm256_shuffle_epi8( |
| input_56, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| } |
| |
| static INLINE void filter_src_pixels_vertical_avx2(__m256i *tmp, __m256i *src, |
| __m256i *coeffs, |
| __m256i *v_sum_r0, |
| __m256i *v_sum_r1, int k) { |
| __m256i input_67 = _mm256_packus_epi32(tmp[k + 10], tmp[k + 11]); |
| __m256i input_78 = _mm256_packus_epi32(tmp[k + 11], tmp[k + 12]); |
| src[3] = _mm256_shuffle_epi8( |
| input_67, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| src[7] = _mm256_shuffle_epi8( |
| input_78, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| |
| __m256i sum_r0 = _mm256_madd_epi16(src[0], coeffs[0]); |
| sum_r0 = _mm256_add_epi32(sum_r0, _mm256_madd_epi16(src[1], coeffs[1])); |
| sum_r0 = _mm256_add_epi32(sum_r0, _mm256_madd_epi16(src[2], coeffs[2])); |
| sum_r0 = _mm256_add_epi32(sum_r0, _mm256_madd_epi16(src[3], coeffs[3])); |
| *v_sum_r0 = sum_r0; |
| |
| __m256i sum_r1 = _mm256_madd_epi16(src[4], coeffs[4]); |
| sum_r1 = _mm256_add_epi32(sum_r1, _mm256_madd_epi16(src[5], coeffs[5])); |
| sum_r1 = _mm256_add_epi32(sum_r1, _mm256_madd_epi16(src[6], coeffs[6])); |
| sum_r1 = _mm256_add_epi32(sum_r1, _mm256_madd_epi16(src[7], coeffs[7])); |
| *v_sum_r1 = sum_r1; |
| |
| src[0] = src[1]; |
| src[1] = src[2]; |
| src[2] = src[3]; |
| |
| src[4] = src[5]; |
| src[5] = src[6]; |
| src[6] = src[7]; |
| } |
| |
| static INLINE void store_vertical_filter_output_avx2( |
| uint16_t *pred, int p_stride, ConvolveParams *conv_params, int bd, |
| const __m256i *res_lo, const __m256i *res_hi, const __m256i *res_add_const, |
| const __m256i *reduce_bits_vert_const, |
| const __m128i *reduce_bits_vert_shift, const int use_wtd_comp_avg, |
| const __m256i *wt0, const __m256i *wt1, const __m256i *res_sub_const, |
| const __m256i *round_bits_const, __m128i *round_bits_shift, int i, int j, |
| int k, const int reduce_bits_vert) { |
| const __m256i clip_pixel = |
| _mm256_set1_epi16(bd == 10 ? 1023 : (bd == 12 ? 4095 : 255)); |
| __m256i v_sum = *res_lo; |
| __m256i v_sum_r1 = *res_hi; |
| |
| if (conv_params->is_compound) { |
| __m128i *const p = |
| (__m128i *)&conv_params->dst[(i + k + 4) * conv_params->dst_stride + j]; |
| |
| __m128i *const p_r1 = |
| (__m128i *)&conv_params->dst[(i + k + 5) * conv_params->dst_stride + j]; |
| |
| v_sum = _mm256_add_epi32(v_sum, *res_add_const); |
| v_sum = _mm256_sra_epi32(_mm256_add_epi32(v_sum, *reduce_bits_vert_const), |
| *reduce_bits_vert_shift); |
| v_sum_r1 = _mm256_add_epi32(v_sum_r1, *res_add_const); |
| v_sum_r1 = |
| _mm256_sra_epi32(_mm256_add_epi32(v_sum_r1, *reduce_bits_vert_const), |
| *reduce_bits_vert_shift); |
| if (conv_params->do_average) { |
| __m128i *const dst16 = (__m128i *)&pred[(i + k + 4) * p_stride + j]; |
| __m128i *const dst16_r1 = (__m128i *)&pred[(i + k + 5) * p_stride + j]; |
| __m256i p_32 = _mm256_cvtepu16_epi32(_mm_loadu_si128(p)); |
| __m256i p_32_r1 = _mm256_cvtepu16_epi32(_mm_loadu_si128(p_r1)); |
| v_sum = _mm256_shuffle_epi32(_mm256_permute4x64_epi64(v_sum, 0xD8), 0xD8); |
| v_sum_r1 = |
| _mm256_shuffle_epi32(_mm256_permute4x64_epi64(v_sum_r1, 0xD8), 0xD8); |
| |
| if (use_wtd_comp_avg) { |
| v_sum = _mm256_add_epi32(_mm256_mullo_epi32(p_32, *wt0), |
| _mm256_mullo_epi32(v_sum, *wt1)); |
| v_sum = _mm256_srai_epi32(v_sum, DIST_PRECISION_BITS); |
| |
| v_sum_r1 = _mm256_add_epi32(_mm256_mullo_epi32(p_32_r1, *wt0), |
| _mm256_mullo_epi32(v_sum_r1, *wt1)); |
| v_sum_r1 = _mm256_srai_epi32(v_sum_r1, DIST_PRECISION_BITS); |
| } else { |
| v_sum = _mm256_srai_epi32(_mm256_add_epi32(p_32, v_sum), 1); |
| v_sum_r1 = _mm256_srai_epi32(_mm256_add_epi32(p_32_r1, v_sum_r1), 1); |
| } |
| |
| __m256i v_sum1 = _mm256_add_epi32(v_sum, *res_sub_const); |
| v_sum1 = _mm256_sra_epi32(_mm256_add_epi32(v_sum1, *round_bits_const), |
| *round_bits_shift); |
| __m256i v_sum1_r1 = _mm256_add_epi32(v_sum_r1, *res_sub_const); |
| v_sum1_r1 = _mm256_sra_epi32( |
| _mm256_add_epi32(v_sum1_r1, *round_bits_const), *round_bits_shift); |
| |
| __m256i v_sum16 = _mm256_packus_epi32(v_sum1, v_sum1_r1); |
| v_sum16 = |
| _mm256_permute4x64_epi64(_mm256_min_epi16(v_sum16, clip_pixel), 0xD8); |
| _mm_storeu_si128(dst16, _mm256_castsi256_si128(v_sum16)); |
| _mm_storeu_si128(dst16_r1, _mm256_extracti128_si256(v_sum16, 1)); |
| } else { |
| v_sum = _mm256_packus_epi32(v_sum, v_sum_r1); |
| __m256i v_sum16 = |
| _mm256_shuffle_epi8(_mm256_permute4x64_epi64(v_sum, 0xD8), |
| _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| _mm_storeu_si128(p, _mm256_castsi256_si128(v_sum16)); |
| _mm_storeu_si128(p_r1, _mm256_extracti128_si256(v_sum16, 1)); |
| } |
| } else { |
| // Round and pack into 16 bits |
| const __m256i round_const = _mm256_set1_epi32( |
| -(1 << (bd + reduce_bits_vert - 1)) + ((1 << reduce_bits_vert) >> 1)); |
| const __m256i zero = _mm256_setzero_si256(); |
| |
| __m256i v_sum1 = _mm256_srai_epi32(_mm256_add_epi32(v_sum, round_const), |
| reduce_bits_vert); |
| __m256i v_sum1_r1 = _mm256_srai_epi32( |
| _mm256_add_epi32(v_sum_r1, round_const), reduce_bits_vert); |
| |
| v_sum1 = _mm256_packus_epi32(v_sum1, v_sum1_r1); |
| v_sum1 = _mm256_permute4x64_epi64(v_sum1, 0xD8); |
| __m256i v_sum16 = _mm256_shuffle_epi8( |
| v_sum1, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| v_sum16 = _mm256_max_epi16(_mm256_min_epi16(v_sum16, clip_pixel), zero); |
| __m128i *const p = (__m128i *)&pred[(i + k + 4) * p_stride + j]; |
| __m128i *const p_r1 = (__m128i *)&pred[(i + k + 5) * p_stride + j]; |
| |
| _mm_storeu_si128(p, _mm256_castsi256_si128(v_sum16)); |
| _mm_storeu_si128(p_r1, _mm256_extracti128_si256(v_sum16, 1)); |
| } |
| } |
| |
| void av1_highbd_warp_affine_avx2(const int32_t *mat, const uint16_t *ref, |
| int width, int height, int stride, |
| uint16_t *pred, int p_col, int p_row, |
| int p_width, int p_height, int p_stride, |
| int subsampling_x, int subsampling_y, int bd, |
| ConvolveParams *conv_params, int16_t alpha, |
| int16_t beta, int16_t gamma, int16_t delta) { |
| __m256i tmp[15]; |
| const int reduce_bits_horiz = conv_params->round_0; |
| const int reduce_bits_vert = conv_params->is_compound |
| ? conv_params->round_1 |
| : 2 * FILTER_BITS - reduce_bits_horiz; |
| const int max_bits_horiz = bd + FILTER_BITS + 1 - reduce_bits_horiz; |
| const int offset_bits_horiz = bd + FILTER_BITS - 1; |
| const int offset_bits_vert = bd + 2 * FILTER_BITS - reduce_bits_horiz; |
| const int round_bits = |
| 2 * FILTER_BITS - conv_params->round_0 - conv_params->round_1; |
| const int offset_bits = bd + 2 * FILTER_BITS - conv_params->round_0; |
| (void)max_bits_horiz; |
| assert(IMPLIES(conv_params->is_compound, conv_params->dst != NULL)); |
| |
| // Check that, even with 12-bit input, the intermediate values will fit |
| // into an unsigned 16-bit intermediate array. |
| assert(bd + FILTER_BITS + 2 - conv_params->round_0 <= 16); |
| |
| const __m128i reduce_bits_vert_shift = _mm_cvtsi32_si128(reduce_bits_vert); |
| const __m256i reduce_bits_vert_const = |
| _mm256_set1_epi32(((1 << reduce_bits_vert) >> 1)); |
| const __m256i res_add_const = _mm256_set1_epi32(1 << offset_bits_vert); |
| const __m256i res_sub_const = |
| _mm256_set1_epi32(-(1 << (offset_bits - conv_params->round_1)) - |
| (1 << (offset_bits - conv_params->round_1 - 1))); |
| __m128i round_bits_shift = _mm_cvtsi32_si128(round_bits); |
| __m256i round_bits_const = _mm256_set1_epi32(((1 << round_bits) >> 1)); |
| |
| const int use_wtd_comp_avg = is_uneven_wtd_comp_avg(conv_params); |
| const int w0 = conv_params->fwd_offset; |
| const int w1 = conv_params->bck_offset; |
| const __m256i wt0 = _mm256_set1_epi32(w0); |
| const __m256i wt1 = _mm256_set1_epi32(w1); |
| |
| __m256i v_rbhoriz = _mm256_set1_epi32(1 << (reduce_bits_horiz - 1)); |
| __m256i v_zeros = _mm256_setzero_si256(); |
| int ohoriz = 1 << offset_bits_horiz; |
| int mhoriz = 1 << max_bits_horiz; |
| (void)mhoriz; |
| int sx; |
| |
| for (int i = 0; i < p_height; i += 8) { |
| for (int j = 0; j < p_width; j += 8) { |
| // Calculate the center of this 8x8 block, |
| // project to luma coordinates (if in a subsampled chroma plane), |
| // apply the affine transformation, |
| // then convert back to the original coordinates (if necessary) |
| const int32_t src_x = (p_col + j + 4) << subsampling_x; |
| const int32_t src_y = (p_row + i + 4) << subsampling_y; |
| const int64_t dst_x = |
| (int64_t)mat[2] * src_x + (int64_t)mat[3] * src_y + (int64_t)mat[0]; |
| const int64_t dst_y = |
| (int64_t)mat[4] * src_x + (int64_t)mat[5] * src_y + (int64_t)mat[1]; |
| const int64_t x4 = dst_x >> subsampling_x; |
| const int64_t y4 = dst_y >> subsampling_y; |
| |
| const int16_t ix4 = (int16_t)(x4 >> WARPEDMODEL_PREC_BITS); |
| int32_t sx4 = x4 & ((1 << WARPEDMODEL_PREC_BITS) - 1); |
| const int16_t iy4 = (int16_t)(y4 >> WARPEDMODEL_PREC_BITS); |
| int32_t sy4 = y4 & ((1 << WARPEDMODEL_PREC_BITS) - 1); |
| |
| sx4 += alpha * (-4) + beta * (-4) + (1 << (WARPEDDIFF_PREC_BITS - 1)) + |
| (WARPEDPIXEL_PREC_SHIFTS << WARPEDDIFF_PREC_BITS); |
| sy4 += gamma * (-4) + delta * (-4) + (1 << (WARPEDDIFF_PREC_BITS - 1)) + |
| (WARPEDPIXEL_PREC_SHIFTS << WARPEDDIFF_PREC_BITS); |
| |
| sx4 &= ~((1 << WARP_PARAM_REDUCE_BITS) - 1); |
| sy4 &= ~((1 << WARP_PARAM_REDUCE_BITS) - 1); |
| |
| // Horizontal filter |
| if (ix4 <= -7) { |
| for (int k = -7; k < AOMMIN(8, p_height - i); ++k) { |
| int iy = iy4 + k; |
| if (iy < 0) |
| iy = 0; |
| else if (iy > height - 1) |
| iy = height - 1; |
| tmp[k + 7] = _mm256_cvtepi16_epi32(_mm_set1_epi16( |
| (1 << (bd + FILTER_BITS - reduce_bits_horiz - 1)) + |
| ref[iy * stride] * (1 << (FILTER_BITS - reduce_bits_horiz)))); |
| } |
| } else if (ix4 >= width + 6) { |
| for (int k = -7; k < AOMMIN(8, p_height - i); ++k) { |
| int iy = iy4 + k; |
| if (iy < 0) |
| iy = 0; |
| else if (iy > height - 1) |
| iy = height - 1; |
| tmp[k + 7] = _mm256_cvtepi16_epi32( |
| _mm_set1_epi16((1 << (bd + FILTER_BITS - reduce_bits_horiz - 1)) + |
| ref[iy * stride + (width - 1)] * |
| (1 << (FILTER_BITS - reduce_bits_horiz)))); |
| } |
| } else if (((ix4 - 7) < 0) || ((ix4 + 9) > width)) { |
| int32_t tmp1[8]; |
| for (int k = -7; k < AOMMIN(8, p_height - i); ++k) { |
| const int iy = clamp(iy4 + k, 0, height - 1); |
| |
| sx = sx4 + beta * (k + 4); |
| for (int l = -4; l < 4; ++l) { |
| int ix = ix4 + l - 3; |
| const int offs = sx >> WARPEDDIFF_PREC_BITS; |
| const int16_t *coeffs = av1_warped_filter[offs]; |
| |
| int32_t sum = 1 << offset_bits_horiz; |
| for (int m = 0; m < 8; ++m) { |
| const int sample_x = clamp(ix + m, 0, width - 1); |
| sum += ref[iy * stride + sample_x] * coeffs[m]; |
| } |
| sum = ROUND_POWER_OF_TWO(sum, reduce_bits_horiz); |
| tmp1[(l + 4) / 2 + ((l + 4) % 2) * 4] = sum; |
| sx += alpha; |
| } |
| tmp[k + 7] = _mm256_loadu_si256((__m256i *)tmp1); |
| } |
| } else { |
| if (beta == 0 && alpha == 0) { |
| sx = sx4; |
| __m128i v_01 = _mm_loadu_si128( |
| (__m128i *) |
| av1_warped_filter[sx >> |
| WARPEDDIFF_PREC_BITS]); // A7A6A5A4A3A2A1A0 |
| __m256i v_c01 = _mm256_broadcastd_epi32(v_01); // A1A0A1A0A1A0A1A0 |
| __m256i v_c23 = _mm256_broadcastd_epi32( |
| _mm_shuffle_epi32(v_01, 1)); // A3A2A3A2A3A2A3A2 |
| __m256i v_c45 = _mm256_broadcastd_epi32( |
| _mm_shuffle_epi32(v_01, 2)); // A5A4A5A4A5A4A5A4 |
| __m256i v_c67 = _mm256_broadcastd_epi32( |
| _mm_shuffle_epi32(v_01, 3)); // A7A6A7A6A7A6A7A6 |
| for (int k = -7; k < AOMMIN(8, p_height - i); ++k) { |
| int iy = iy4 + k; |
| if (iy < 0) |
| iy = 0; |
| else if (iy > height - 1) |
| iy = height - 1; |
| iy = iy * stride; |
| |
| __m256i v_refl = _mm256_inserti128_si256( |
| _mm256_set1_epi16(0), |
| _mm_loadu_si128((__m128i *)&ref[iy + ix4 - 7]), 0); |
| v_refl = _mm256_inserti128_si256( |
| v_refl, _mm_loadu_si128((__m128i *)&ref[iy + ix4 + 1]), |
| 1); // R15 .. R0 |
| |
| __m256i v_ref = _mm256_permute4x64_epi64(v_refl, 0xEE); |
| |
| __m256i v_refu = |
| _mm256_alignr_epi8(v_ref, v_refl, 2); // R8R15R14...R2R1 |
| v_refl = _mm256_inserti128_si256( |
| v_refl, _mm256_extracti128_si256(v_refu, 0), 1); |
| v_refu = _mm256_inserti128_si256( |
| v_refu, _mm256_extracti128_si256(v_ref, 0), 0); |
| |
| __m256i v_sum = _mm256_set1_epi32(ohoriz); |
| __m256i parsum = _mm256_madd_epi16( |
| v_c01, _mm256_alignr_epi8(v_refu, v_refl, |
| 0)); // R8R7R6..R1R7R6R5..R1R0 |
| __m256i v_sum1 = _mm256_add_epi32(v_sum, parsum); |
| |
| parsum = _mm256_madd_epi16( |
| v_c23, |
| _mm256_alignr_epi8(v_refu, v_refl, 4)); // R10R9..R3R9R8..R3R2 |
| __m256i v_sum2 = _mm256_add_epi32(v_sum1, parsum); |
| parsum = _mm256_madd_epi16( |
| v_c45, _mm256_alignr_epi8(v_refu, v_refl, |
| 8)); // R12R11..R5R11R10..R5R4 |
| __m256i v_sum3 = _mm256_add_epi32(v_sum2, parsum); |
| parsum = _mm256_madd_epi16( |
| v_c67, _mm256_alignr_epi8(v_refu, v_refl, |
| 12)); // R14R13..R7R13R12..R7R6 |
| __m256i v_sum4 = _mm256_add_epi32(v_sum3, parsum); |
| |
| tmp[k + 7] = _mm256_srai_epi32(_mm256_add_epi32(v_sum4, v_rbhoriz), |
| reduce_bits_horiz); |
| } |
| } else if (alpha == 0) { |
| for (int k = -7; k < AOMMIN(8, p_height - i); ++k) { |
| int iy = iy4 + k; |
| if (iy < 0) |
| iy = 0; |
| else if (iy > height - 1) |
| iy = height - 1; |
| iy = iy * stride; |
| |
| sx = sx4 + beta * (k + 4); |
| |
| __m128i v_01 = _mm_loadu_si128( |
| (__m128i *)av1_warped_filter |
| [sx >> WARPEDDIFF_PREC_BITS]); // A7A6A5A4A3A2A1A0 |
| __m256i v_c01 = _mm256_broadcastd_epi32(v_01); // A1A0A1A0A1A0A1A0 |
| __m256i v_c23 = _mm256_broadcastd_epi32( |
| _mm_shuffle_epi32(v_01, 1)); // A3A2A3A2A3A2A3A2 |
| __m256i v_c45 = _mm256_broadcastd_epi32( |
| _mm_shuffle_epi32(v_01, 2)); // A5A4A5A4A5A4A5A4 |
| __m256i v_c67 = _mm256_broadcastd_epi32( |
| _mm_shuffle_epi32(v_01, 3)); // A7A6A7A6A7A6A7A6 |
| |
| __m256i v_refl = _mm256_inserti128_si256( |
| _mm256_set1_epi16(0), |
| _mm_loadu_si128((__m128i *)&ref[iy + ix4 - 7]), 0); |
| v_refl = _mm256_inserti128_si256( |
| v_refl, _mm_loadu_si128((__m128i *)&ref[iy + ix4 + 1]), |
| 1); // R15 .. R0 |
| |
| __m256i v_ref = _mm256_permute4x64_epi64(v_refl, 0xEE); |
| |
| __m256i v_refu = |
| _mm256_alignr_epi8(v_ref, v_refl, 2); // R8R15R14...R2R1 |
| |
| v_refl = _mm256_inserti128_si256( |
| v_refl, _mm256_extracti128_si256(v_refu, 0), 1); |
| v_refu = _mm256_inserti128_si256( |
| v_refu, _mm256_extracti128_si256(v_ref, 0), 0); |
| |
| __m256i v_sum = _mm256_set1_epi32(ohoriz); |
| __m256i parsum = |
| _mm256_madd_epi16(v_c01, _mm256_alignr_epi8(v_refu, v_refl, 0)); |
| __m256i v_sum1 = _mm256_add_epi32(v_sum, parsum); |
| |
| parsum = |
| _mm256_madd_epi16(v_c23, _mm256_alignr_epi8(v_refu, v_refl, 4)); |
| __m256i v_sum2 = _mm256_add_epi32(v_sum1, parsum); |
| parsum = |
| _mm256_madd_epi16(v_c45, _mm256_alignr_epi8(v_refu, v_refl, 8)); |
| __m256i v_sum3 = _mm256_add_epi32(v_sum2, parsum); |
| parsum = _mm256_madd_epi16(v_c67, |
| _mm256_alignr_epi8(v_refu, v_refl, 12)); |
| __m256i v_sum4 = _mm256_add_epi32(v_sum3, parsum); |
| |
| tmp[k + 7] = _mm256_srai_epi32(_mm256_add_epi32(v_sum4, v_rbhoriz), |
| reduce_bits_horiz); |
| } |
| } else if (beta == 0) { |
| sx = sx4; |
| __m256i v_coeff01 = _mm256_inserti128_si256( |
| v_zeros, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx) >> WARPEDDIFF_PREC_BITS]), |
| 0); |
| v_coeff01 = _mm256_inserti128_si256( |
| v_coeff01, |
| _mm_loadu_si128( |
| (__m128i *) |
| av1_warped_filter[(sx + alpha) >> WARPEDDIFF_PREC_BITS]), |
| 1); // B7B6..B1B0A7A6..A1A0 |
| __m256i v_coeff23 = _mm256_inserti128_si256( |
| v_zeros, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 2 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 0); |
| v_coeff23 = _mm256_inserti128_si256( |
| v_coeff23, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 3 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 1); // D7D6..D1D0C7C6..C1C0 |
| __m256i v_coeff45 = _mm256_inserti128_si256( |
| v_zeros, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 4 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 0); |
| v_coeff45 = _mm256_inserti128_si256( |
| v_coeff45, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 5 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 1); // F7F6..F1F0E7E6..E1E0 |
| __m256i v_coeff67 = _mm256_inserti128_si256( |
| v_zeros, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 6 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 0); |
| v_coeff67 = _mm256_inserti128_si256( |
| v_coeff67, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 7 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 1); // H7H6..H1H0G7G6..G1G0 |
| |
| __m256i v_c0123 = _mm256_unpacklo_epi32( |
| v_coeff01, |
| v_coeff23); // D3D2B3B2D1D0B1B0C3C2A3A2C1C0A1A0 |
| __m256i v_c0123u = _mm256_unpackhi_epi32( |
| v_coeff01, |
| v_coeff23); // D7D6B7B6D5D4B5B4C7C6A7A6C5C4A5A4 |
| __m256i v_c4567 = _mm256_unpacklo_epi32( |
| v_coeff45, |
| v_coeff67); // H3H2F3F2H1H0F1F0G3G2E3E2G1G0E1E0 |
| __m256i v_c4567u = _mm256_unpackhi_epi32( |
| v_coeff45, |
| v_coeff67); // H7H6F7F6H5H4F5F4G7G6E7E6G5G4E5E4 |
| |
| __m256i v_c01 = _mm256_unpacklo_epi64( |
| v_c0123, v_c4567); // H1H0F1F0D1D0B1B0G1G0E1E0C1C0A1A0 |
| __m256i v_c23 = |
| _mm256_unpackhi_epi64(v_c0123, v_c4567); // H3H2 ... A3A2 |
| __m256i v_c45 = |
| _mm256_unpacklo_epi64(v_c0123u, v_c4567u); // H5H4 ... A5A4 |
| __m256i v_c67 = |
| _mm256_unpackhi_epi64(v_c0123u, v_c4567u); // H7H6 ... A7A6 |
| |
| for (int k = -7; k < AOMMIN(8, p_height - i); ++k) { |
| int iy = iy4 + k; |
| if (iy < 0) |
| iy = 0; |
| else if (iy > height - 1) |
| iy = height - 1; |
| iy = iy * stride; |
| |
| __m256i v_refl = _mm256_inserti128_si256( |
| _mm256_set1_epi16(0), |
| _mm_loadu_si128((__m128i *)&ref[iy + ix4 - 7]), 0); |
| v_refl = _mm256_inserti128_si256( |
| v_refl, _mm_loadu_si128((__m128i *)&ref[iy + ix4 + 1]), |
| 1); // R15 .. R0 |
| |
| __m256i v_ref = _mm256_permute4x64_epi64(v_refl, 0xEE); |
| |
| __m256i v_refu = |
| _mm256_alignr_epi8(v_ref, v_refl, 2); // R8R15R14...R2R1 |
| |
| v_refl = _mm256_inserti128_si256( |
| v_refl, _mm256_extracti128_si256(v_refu, 0), 1); |
| v_refu = _mm256_inserti128_si256( |
| v_refu, _mm256_extracti128_si256(v_ref, 0), 0); |
| |
| __m256i v_sum = _mm256_set1_epi32(ohoriz); |
| __m256i parsum = _mm256_madd_epi16( |
| v_c01, _mm256_alignr_epi8(v_refu, v_refl, |
| 0)); // R8R7R6..R1R7R6R5..R1R0 |
| __m256i v_sum1 = _mm256_add_epi32(v_sum, parsum); |
| |
| parsum = _mm256_madd_epi16( |
| v_c23, |
| _mm256_alignr_epi8(v_refu, v_refl, 4)); // R10R9..R3R9R8..R3R2 |
| __m256i v_sum2 = _mm256_add_epi32(v_sum1, parsum); |
| parsum = _mm256_madd_epi16( |
| v_c45, _mm256_alignr_epi8(v_refu, v_refl, |
| 8)); // R12R11..R5R11R10..R5R4 |
| __m256i v_sum3 = _mm256_add_epi32(v_sum2, parsum); |
| parsum = _mm256_madd_epi16( |
| v_c67, _mm256_alignr_epi8(v_refu, v_refl, |
| 12)); // R14R13..R7R13R12..R7R6 |
| __m256i v_sum4 = _mm256_add_epi32(v_sum3, parsum); |
| |
| tmp[k + 7] = _mm256_srai_epi32(_mm256_add_epi32(v_sum4, v_rbhoriz), |
| reduce_bits_horiz); |
| } |
| |
| } else { |
| for (int k = -7; k < AOMMIN(8, p_height - i); ++k) { |
| int iy = iy4 + k; |
| if (iy < 0) |
| iy = 0; |
| else if (iy > height - 1) |
| iy = height - 1; |
| iy = iy * stride; |
| |
| sx = sx4 + beta * (k + 4); |
| |
| __m256i v_coeff01 = _mm256_inserti128_si256( |
| v_zeros, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx) >> WARPEDDIFF_PREC_BITS]), |
| 0); |
| v_coeff01 = _mm256_inserti128_si256( |
| v_coeff01, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 1); // B7B6..B1B0A7A6..A1A0 |
| __m256i v_coeff23 = _mm256_inserti128_si256( |
| v_zeros, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 2 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 0); |
| v_coeff23 = _mm256_inserti128_si256( |
| v_coeff23, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 3 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 1); // D7D6..D1D0C7C6..C1C0 |
| __m256i v_coeff45 = _mm256_inserti128_si256( |
| v_zeros, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 4 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 0); |
| v_coeff45 = _mm256_inserti128_si256( |
| v_coeff45, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 5 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 1); // F7F6..F1F0E7E6..E1E0 |
| __m256i v_coeff67 = _mm256_inserti128_si256( |
| v_zeros, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 6 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 0); |
| v_coeff67 = _mm256_inserti128_si256( |
| v_coeff67, |
| _mm_loadu_si128( |
| (__m128i *)av1_warped_filter[(sx + 7 * alpha) >> |
| WARPEDDIFF_PREC_BITS]), |
| 1); // H7H6..H1H0G7G6..G1G0 |
| |
| __m256i v_c0123 = _mm256_unpacklo_epi32( |
| v_coeff01, |
| v_coeff23); // D3D2B3B2D1D0B1B0C3C2A3A2C1C0A1A0 |
| __m256i v_c0123u = _mm256_unpackhi_epi32( |
| v_coeff01, |
| v_coeff23); // D7D6B7B6D5D4B5B4C7C6A7A6C5C4A5A4 |
| __m256i v_c4567 = _mm256_unpacklo_epi32( |
| v_coeff45, |
| v_coeff67); // H3H2F3F2H1H0F1F0G3G2E3E2G1G0E1E0 |
| __m256i v_c4567u = _mm256_unpackhi_epi32( |
| v_coeff45, |
| v_coeff67); // H7H6F7F6H5H4F5F4G7G6E7E6G5G4E5E4 |
| |
| __m256i v_c01 = _mm256_unpacklo_epi64( |
| v_c0123, v_c4567); // H1H0F1F0D1D0B1B0G1G0E1E0C1C0A1A0 |
| __m256i v_c23 = |
| _mm256_unpackhi_epi64(v_c0123, v_c4567); // H3H2 ... A3A2 |
| __m256i v_c45 = |
| _mm256_unpacklo_epi64(v_c0123u, v_c4567u); // H5H4 ... A5A4 |
| __m256i v_c67 = |
| _mm256_unpackhi_epi64(v_c0123u, v_c4567u); // H7H6 ... A7A6 |
| |
| __m256i v_refl = _mm256_inserti128_si256( |
| _mm256_set1_epi16(0), |
| _mm_loadu_si128((__m128i *)&ref[iy + ix4 - 7]), 0); |
| v_refl = _mm256_inserti128_si256( |
| v_refl, _mm_loadu_si128((__m128i *)&ref[iy + ix4 + 1]), |
| 1); // R15 .. R0 |
| |
| __m256i v_ref = _mm256_permute4x64_epi64(v_refl, 0xEE); |
| |
| __m256i v_refu = |
| _mm256_alignr_epi8(v_ref, v_refl, 2); // R8R15R14...R2R1 |
| |
| v_refl = _mm256_inserti128_si256( |
| v_refl, _mm256_extracti128_si256(v_refu, 0), 1); |
| v_refu = _mm256_inserti128_si256( |
| v_refu, _mm256_extracti128_si256(v_ref, 0), 0); |
| |
| __m256i v_sum = _mm256_set1_epi32(ohoriz); |
| __m256i parsum = |
| _mm256_madd_epi16(v_c01, _mm256_alignr_epi8(v_refu, v_refl, 0)); |
| __m256i v_sum1 = _mm256_add_epi32(v_sum, parsum); |
| |
| parsum = |
| _mm256_madd_epi16(v_c23, _mm256_alignr_epi8(v_refu, v_refl, 4)); |
| __m256i v_sum2 = _mm256_add_epi32(v_sum1, parsum); |
| parsum = |
| _mm256_madd_epi16(v_c45, _mm256_alignr_epi8(v_refu, v_refl, 8)); |
| __m256i v_sum3 = _mm256_add_epi32(v_sum2, parsum); |
| parsum = _mm256_madd_epi16(v_c67, |
| _mm256_alignr_epi8(v_refu, v_refl, 12)); |
| __m256i v_sum4 = _mm256_add_epi32(v_sum3, parsum); |
| |
| tmp[k + 7] = _mm256_srai_epi32(_mm256_add_epi32(v_sum4, v_rbhoriz), |
| reduce_bits_horiz); |
| } |
| } |
| } |
| |
| // Vertical filter |
| if (gamma == 0 && delta == 0) { |
| __m256i coeffs[8], src[8]; |
| |
| prepare_vertical_filter_coeffs_gamma0_avx2(sy4, coeffs); |
| coeffs[4] = coeffs[0]; |
| coeffs[5] = coeffs[1]; |
| coeffs[6] = coeffs[2]; |
| coeffs[7] = coeffs[3]; |
| |
| prepare_input_data(tmp, src); |
| |
| for (int k = -4; k < AOMMIN(4, p_height - i - 4); k += 2) { |
| __m256i v_sum_r0, v_sum_r1; |
| filter_src_pixels_vertical_avx2(tmp, src, coeffs, &v_sum_r0, |
| &v_sum_r1, k); |
| |
| store_vertical_filter_output_avx2( |
| pred, p_stride, conv_params, bd, &v_sum_r0, &v_sum_r1, |
| &res_add_const, &reduce_bits_vert_const, &reduce_bits_vert_shift, |
| use_wtd_comp_avg, &wt0, &wt1, &res_sub_const, &round_bits_const, |
| &round_bits_shift, i, j, k, reduce_bits_vert); |
| } |
| } else if (gamma == 0) { |
| __m256i coeffs[8], src[8]; |
| prepare_input_data(tmp, src); |
| |
| for (int k = -4; k < AOMMIN(4, p_height - i - 4); k += 2) { |
| __m256i v_sum_r0, v_sum_r1; |
| int sy_0 = sy4 + delta * (k + 4); |
| prepare_vertical_filter_coeffs_gamma0_avx2(sy_0, &coeffs[0]); |
| |
| int sy_1 = sy4 + delta * (k + 5); |
| prepare_vertical_filter_coeffs_gamma0_avx2(sy_1, &coeffs[4]); |
| |
| filter_src_pixels_vertical_avx2(tmp, src, coeffs, &v_sum_r0, |
| &v_sum_r1, k); |
| |
| store_vertical_filter_output_avx2( |
| pred, p_stride, conv_params, bd, &v_sum_r0, &v_sum_r1, |
| &res_add_const, &reduce_bits_vert_const, &reduce_bits_vert_shift, |
| use_wtd_comp_avg, &wt0, &wt1, &res_sub_const, &round_bits_const, |
| &round_bits_shift, i, j, k, reduce_bits_vert); |
| } |
| } else if (delta == 0) { |
| __m256i coeffs[8], src[8]; |
| prepare_vertical_filter_coeffs_avx2(sy4, gamma, &coeffs[0]); |
| |
| coeffs[4] = coeffs[0]; |
| coeffs[5] = coeffs[1]; |
| coeffs[6] = coeffs[2]; |
| coeffs[7] = coeffs[3]; |
| |
| prepare_input_data(tmp, src); |
| |
| for (int k = -4; k < AOMMIN(4, p_height - i - 4); k += 2) { |
| __m256i v_sum_r0, v_sum_r1; |
| filter_src_pixels_vertical_avx2(tmp, src, coeffs, &v_sum_r0, |
| &v_sum_r1, k); |
| |
| store_vertical_filter_output_avx2( |
| pred, p_stride, conv_params, bd, &v_sum_r0, &v_sum_r1, |
| &res_add_const, &reduce_bits_vert_const, &reduce_bits_vert_shift, |
| use_wtd_comp_avg, &wt0, &wt1, &res_sub_const, &round_bits_const, |
| &round_bits_shift, i, j, k, reduce_bits_vert); |
| } |
| } else { |
| __m256i src[8]; |
| prepare_input_data(tmp, src); |
| |
| for (int k = -4; k < AOMMIN(4, p_height - i - 4); k += 2) { |
| __m256i coeffs[8]; |
| __m256i v_sum_r0, v_sum_r1; |
| int sy_0 = sy4 + delta * (k + 4); |
| prepare_vertical_filter_coeffs_avx2(sy_0, gamma, &coeffs[0]); |
| |
| int sy_1 = sy4 + delta * (k + 5); |
| prepare_vertical_filter_coeffs_avx2(sy_1, gamma, &coeffs[4]); |
| |
| filter_src_pixels_vertical_avx2(tmp, src, coeffs, &v_sum_r0, |
| &v_sum_r1, k); |
| |
| store_vertical_filter_output_avx2( |
| pred, p_stride, conv_params, bd, &v_sum_r0, &v_sum_r1, |
| &res_add_const, &reduce_bits_vert_const, &reduce_bits_vert_shift, |
| use_wtd_comp_avg, &wt0, &wt1, &res_sub_const, &round_bits_const, |
| &round_bits_shift, i, j, k, reduce_bits_vert); |
| } |
| } |
| } |
| } |
| } |
| |
| #if CONFIG_EXT_WARP_FILTER |
| static INLINE void av1_ext_highbd_filter_coeff_avx2(int offset_j0, |
| int offset_j4, |
| __m256i *coeff) { |
| // c0 c1 c2 c3 c4 c5 0 0 | f0 f1 f2 f3 f4 f5 0 0 |
| const __m256i filt = _mm256_inserti128_si256( |
| _mm256_castsi128_si256( |
| _mm_loadu_si128((__m128i *)(av1_ext_warped_filter + offset_j0))), |
| _mm_loadu_si128((__m128i *)(av1_ext_warped_filter + offset_j4)), 1); |
| |
| // c0 c1 c0 c1 c0 c1 c0 c1 | f0 f1 f0 f1 f0 f1 f0 f1 |
| coeff[0] = _mm256_shuffle_epi8( |
| filt, _mm256_load_si256((__m256i *)shuffle_gamma0_mask0)); |
| // c2 c3 c2 c3 c2 c3 c2 c3 | f2 f3 f2 f3 f2 f3 f2 f3 |
| coeff[1] = _mm256_shuffle_epi8( |
| filt, _mm256_load_si256((__m256i *)shuffle_gamma0_mask1)); |
| // c4 c5 c4 c5 c4 c5 c4 c5 | f4 f5 f4 f5 f4 f5 f4 f5 |
| coeff[2] = _mm256_shuffle_epi8( |
| filt, _mm256_load_si256((__m256i *)shuffle_gamma0_mask2)); |
| } |
| |
| static INLINE void ext_highbd_warp_horizontal_filter_avx2( |
| const uint16_t *ref, __m256i *tmp, int stride, int32_t ix_j0, int32_t ix_j4, |
| int32_t iy_j0, int32_t iy_j4, int32_t offset_j0, int32_t offset_j4, |
| int height, const int offset_bits_horiz, const int reduce_bits_horiz) { |
| const __m256i round_const = _mm256_set1_epi32( |
| (1 << offset_bits_horiz) + ((1 << reduce_bits_horiz) >> 1)); |
| __m256i coeff[3]; |
| av1_ext_highbd_filter_coeff_avx2(offset_j0, offset_j4, coeff); |
| |
| for (int k = -4; k < 5; ++k) { |
| int iy0 = iy_j0 + k; |
| int iy4 = iy_j4 + k; |
| iy0 = (iy0 < 0 ? 0 : ((iy0 > height - 1) ? height - 1 : iy0)); |
| iy4 = (iy4 < 0 ? 0 : ((iy4 > height - 1) ? height - 1 : iy4)); |
| |
| // s00 s01 s02 s03 s04 s05 s06 s07 |
| const __m128i src00 = |
| _mm_loadu_si128((__m128i *)(ref + iy0 * stride + ix_j0 - 4)); |
| // s01 s02 s03 s04 s05 s06 s07 s08 |
| const __m128i src01 = |
| _mm_loadu_si128((__m128i *)(ref + iy0 * stride + ix_j0 - 3)); |
| // r00 r01 r02 r03 r04 r05 r06 r07 |
| const __m128i src10 = |
| _mm_loadu_si128((__m128i *)(ref + iy4 * stride + ix_j4 - 4)); |
| // r01 r02 r03 r04 r05 r06 r07 r08 |
| const __m128i src11 = |
| _mm_loadu_si128((__m128i *)(ref + iy4 * stride + ix_j4 - 3)); |
| |
| // s00 s01 s02 s03 s04 s05 s06 s07 | x x x x x x x x |
| __m256i src0 = _mm256_castsi128_si256(src00); |
| // s00 s01 s02 s03 s04 s05 s06 s07 | r00 r01 r02 r03 r04 r05 r06 r07 |
| src0 = _mm256_inserti128_si256(src0, src10, 1); |
| // s01 s02 s03 s04 s05 s06 s07 s08 | x x x x x x x x |
| __m256i src1 = _mm256_castsi128_si256(src01); |
| // s01 s02 s03 s04 s05 s06 s07 s08 | r01 r02 r03 r04 r05 r06 r07 r08 |
| src1 = _mm256_inserti128_si256(src1, src11, 1); |
| |
| // s00 s01 s01 s02 s02 s03 s03 s04 | r00 r01 r01 r02 r02 r03 r03 r04 |
| const __m256i reg_0 = _mm256_shuffle_epi8( |
| src0, _mm256_load_si256((__m256i *)shuffle_pattern_0)); |
| // s02 s03 s03 s04 s04 s05 s05 s06 | r02 r03 r03 r04 r04 r05 r05 r06 |
| const __m256i reg_1 = _mm256_shuffle_epi8( |
| src0, _mm256_load_si256((__m256i *)shuffle_pattern_1)); |
| // s04 s05 s05 s06 s06 s07 s07 s08 | r04 r05 r05 r06 r06 r07 r07 r08 |
| const __m256i reg_2 = _mm256_shuffle_epi8( |
| src1, _mm256_load_si256((__m256i *)shuffle_pattern_2)); |
| |
| const __m256i res_0 = _mm256_madd_epi16(reg_0, coeff[0]); |
| const __m256i res_1 = _mm256_madd_epi16(reg_1, coeff[1]); |
| const __m256i res_2 = _mm256_madd_epi16(reg_2, coeff[2]); |
| |
| __m256i res = _mm256_add_epi32(_mm256_add_epi32(res_0, res_2), res_1); |
| |
| // s00 s01 s02 s03 | r00 r01 r02 r03 |
| tmp[k + 4] = _mm256_sra_epi32(_mm256_add_epi32(res, round_const), |
| _mm_cvtsi32_si128(reduce_bits_horiz)); |
| } |
| } |
| |
| void av1_ext_highbd_warp_affine_avx2(const int32_t *mat, const uint16_t *ref, |
| int width, int height, int stride, |
| uint16_t *pred, int p_col, int p_row, |
| int p_width, int p_height, int p_stride, |
| int subsampling_x, int subsampling_y, |
| int bd, ConvolveParams *conv_params) { |
| if (p_width == 4) { |
| av1_ext_highbd_warp_affine_sse4_1( |
| mat, ref, width, height, stride, pred, p_col, p_row, p_width, p_height, |
| p_stride, subsampling_x, subsampling_y, bd, conv_params); |
| } else { |
| assert(p_width % 8 == 0); |
| __m256i tmp[9]; |
| int i, j; |
| const int reduce_bits_horiz = conv_params->round_0; |
| const int reduce_bits_vert = conv_params->is_compound |
| ? conv_params->round_1 |
| : 2 * FILTER_BITS - reduce_bits_horiz; |
| const int offset_bits_horiz = bd + FILTER_BITS - 1; |
| assert(IMPLIES(conv_params->is_compound, conv_params->dst != NULL)); |
| assert(!(bd == 12 && reduce_bits_horiz < 5)); |
| assert(IMPLIES(conv_params->do_average, conv_params->is_compound)); |
| |
| // Check that, even with 12-bit input, the intermediate values will fit |
| // into an unsigned 16-bit intermediate array. |
| assert(bd + FILTER_BITS + 2 - conv_params->round_0 <= 16); |
| |
| const int offset_bits_vert = bd + 2 * FILTER_BITS - reduce_bits_horiz; |
| const __m256i clip_pixel = |
| _mm256_set1_epi16(bd == 10 ? 1023 : (bd == 12 ? 4095 : 255)); |
| const __m256i reduce_bits_vert_const = |
| _mm256_set1_epi32(((1 << reduce_bits_vert) >> 1)); |
| const __m256i res_add_const = _mm256_set1_epi32(1 << offset_bits_vert); |
| const int round_bits = |
| 2 * FILTER_BITS - conv_params->round_0 - conv_params->round_1; |
| const int offset_bits = bd + 2 * FILTER_BITS - conv_params->round_0; |
| const __m256i res_sub_const = |
| _mm256_set1_epi32(-(1 << (offset_bits - conv_params->round_1)) - |
| (1 << (offset_bits - conv_params->round_1 - 1))); |
| __m256i round_bits_const = _mm256_set1_epi32(((1 << round_bits) >> 1)); |
| |
| const int w0 = conv_params->fwd_offset; |
| const int w1 = conv_params->bck_offset; |
| const __m256i wt0 = _mm256_set1_epi32(w0); |
| const __m256i wt1 = _mm256_set1_epi32(w1); |
| const int use_wtd_comp_avg = is_uneven_wtd_comp_avg(conv_params); |
| |
| for (i = 0; i < p_height; i += 4) { |
| for (j = 0; j < p_width; j += 8) { |
| const int32_t src_x_j0 = (p_col + j + 2) << subsampling_x; |
| const int32_t src_x_j4 = (p_col + j + 6) << subsampling_x; |
| const int32_t src_y = (p_row + i + 2) << subsampling_y; |
| const int32_t dst_x_j0 = mat[2] * src_x_j0 + mat[3] * src_y + mat[0]; |
| const int32_t dst_x_j4 = mat[2] * src_x_j4 + mat[3] * src_y + mat[0]; |
| const int32_t dst_y_j0 = mat[4] * src_x_j0 + mat[5] * src_y + mat[1]; |
| const int32_t dst_y_j4 = mat[4] * src_x_j4 + mat[5] * src_y + mat[1]; |
| const int32_t x4_j0 = dst_x_j0 >> subsampling_x; |
| const int32_t x4_j4 = dst_x_j4 >> subsampling_x; |
| const int32_t y4_j0 = dst_y_j0 >> subsampling_y; |
| const int32_t y4_j4 = dst_y_j4 >> subsampling_y; |
| |
| int32_t ix4_j0 = x4_j0 >> WARPEDMODEL_PREC_BITS; |
| int32_t ix4_j4 = x4_j4 >> WARPEDMODEL_PREC_BITS; |
| int32_t sx4_j0 = x4_j0 & ((1 << WARPEDMODEL_PREC_BITS) - 1); |
| int32_t sx4_j4 = x4_j4 & ((1 << WARPEDMODEL_PREC_BITS) - 1); |
| int32_t iy4_j0 = y4_j0 >> WARPEDMODEL_PREC_BITS; |
| int32_t iy4_j4 = y4_j4 >> WARPEDMODEL_PREC_BITS; |
| int32_t sy4_j0 = y4_j0 & ((1 << WARPEDMODEL_PREC_BITS) - 1); |
| int32_t sy4_j4 = y4_j4 & ((1 << WARPEDMODEL_PREC_BITS) - 1); |
| |
| // Horizontal Filter |
| const int offs_x_j0 = ROUND_POWER_OF_TWO(sx4_j0, WARPEDDIFF_PREC_BITS); |
| const int offs_x_j4 = ROUND_POWER_OF_TWO(sx4_j4, WARPEDDIFF_PREC_BITS); |
| assert(offs_x_j0 >= 0 && offs_x_j0 <= WARPEDPIXEL_PREC_SHIFTS); |
| assert(offs_x_j4 >= 0 && offs_x_j4 <= WARPEDPIXEL_PREC_SHIFTS); |
| if (ix4_j0 >= 4 && ix4_j0 <= width - 12 && ix4_j4 >= 4 && |
| ix4_j4 <= width - 12) { |
| ext_highbd_warp_horizontal_filter_avx2( |
| ref, tmp, stride, ix4_j0, ix4_j4, iy4_j0, iy4_j4, offs_x_j0, |
| offs_x_j4, height, offset_bits_horiz, reduce_bits_horiz); |
| } else { |
| __m128i tmp_reg_lo[9], tmp_reg_hi[9]; |
| av1_ext_highbd_warp_horiz_sse4_1( |
| ref, tmp_reg_lo, stride, ix4_j0, iy4_j0, offs_x_j0, height, width, |
| bd, offset_bits_horiz, reduce_bits_horiz); |
| av1_ext_highbd_warp_horiz_sse4_1( |
| ref, tmp_reg_hi, stride, ix4_j4, iy4_j4, offs_x_j4, height, width, |
| bd, offset_bits_horiz, reduce_bits_horiz); |
| for (int k = -4; k < 5; ++k) { |
| // s00 s01 s02 s03 | r00 r01 r02 r03 |
| tmp[k + 4] = _mm256_inserti128_si256( |
| _mm256_castsi128_si256(tmp_reg_lo[k + 4]), tmp_reg_hi[k + 4], |
| 1); |
| } |
| } |
| |
| // Vertical filter |
| const int offs_y_j0 = ROUND_POWER_OF_TWO(sy4_j0, WARPEDDIFF_PREC_BITS); |
| const int offs_y_j4 = ROUND_POWER_OF_TWO(sy4_j4, WARPEDDIFF_PREC_BITS); |
| assert(offs_y_j0 >= 0 && offs_y_j0 <= WARPEDPIXEL_PREC_SHIFTS); |
| assert(offs_y_j4 >= 0 && offs_y_j4 <= WARPEDPIXEL_PREC_SHIFTS); |
| |
| __m256i coeff[3]; |
| av1_ext_highbd_filter_coeff_avx2(offs_y_j0, offs_y_j4, coeff); |
| |
| const __m256i *src = tmp; |
| // s00 s01 s02 s03 s10 s11 s12 s13 | r00 r01 r02 r03 r10 r11 r12 r13 |
| const __m256i src_01 = _mm256_packs_epi32(src[0], src[1]); |
| // s20 s21 s22 s23 s30 s31 s32 s33 | r20 r21 r22 r23 r30 r31 r32 r33 |
| const __m256i src_23 = _mm256_packs_epi32(src[2], src[3]); |
| |
| // s10 s11 s12 s13 s20 s21 s22 s23 | r10 r11 r12 r13 r20 r21 r22 r23 |
| const __m256i src_12 = _mm256_packs_epi32(src[1], src[2]); |
| // s30 s31 s32 s33 s40 s41 s42 s43 | r30 r31 r32 r33 r40 r41 r42 r43 |
| const __m256i src_34 = _mm256_packs_epi32(src[3], src[4]); |
| |
| // s00 s10 s01 s11 s02 s12 s03 s13 | r00 r10 r01 r11 r02 r12 r03 r13 |
| __m256i src_r00 = _mm256_shuffle_epi8( |
| src_01, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| // s20 s30 s21 s32 s22 s32 s23 s33 | r20 r30 r21 r32 r22 r32 r23 r33 |
| __m256i src_r01 = _mm256_shuffle_epi8( |
| src_23, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| // |
| __m256i src_r10 = _mm256_shuffle_epi8( |
| src_12, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| // |
| __m256i src_r11 = _mm256_shuffle_epi8( |
| src_34, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| for (int k = -2; k < AOMMIN(2, p_height - i - 2); k += 2) { |
| // s40 s41 s42 s43 s50 s51 s52 s53 | r40 r41 r42 r43 r50 r51 r52 r53 |
| const __m256i src_45 = _mm256_packs_epi32(src[k + 6], src[k + 7]); |
| // s50 s51 s52 s53 s60 s61 s62 s63 | r50 r51 r52 r53 r60 r61 r62 r63 |
| const __m256i src_56 = _mm256_packs_epi32(src[k + 7], src[k + 8]); |
| // s40 s50 s41 s51 s42 s52 s43 s53 | r40 r50 r41 r51 r42 r52 r43 r53 |
| __m256i src_r02 = _mm256_shuffle_epi8( |
| src_45, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| // |
| __m256i src_r12 = _mm256_shuffle_epi8( |
| src_56, _mm256_load_si256((__m256i *)shuffle_input_mask)); |
| |
| const __m256i res_r00 = _mm256_madd_epi16(src_r00, coeff[0]); |
| const __m256i res_r01 = _mm256_madd_epi16(src_r01, coeff[1]); |
| const __m256i res_r02 = _mm256_madd_epi16(src_r02, coeff[2]); |
| // s00 s01 s02 s03 | r00 r01 r02 r03 |
| __m256i res_r0 = |
| _mm256_add_epi32(_mm256_add_epi32(res_r00, res_r01), res_r02); |
| |
| const __m256i res_r10 = _mm256_madd_epi16(src_r10, coeff[0]); |
| const __m256i res_r11 = _mm256_madd_epi16(src_r11, coeff[1]); |
| const __m256i res_r12 = _mm256_madd_epi16(src_r12, coeff[2]); |
| // s10 s11 s12 s13 | r10 r11 r12 r13 |
| __m256i res_r1 = |
| _mm256_add_epi32(_mm256_add_epi32(res_r10, res_r11), res_r12); |
| |
| src_r00 = src_r01; |
| src_r01 = src_r02; |
| src_r10 = src_r11; |
| src_r11 = src_r12; |
| |
| if (conv_params->is_compound) { |
| __m128i *const p0_r0 = |
| (__m128i *)&conv_params |
| ->dst[(i + k + 2) * conv_params->dst_stride + j]; |
| __m128i *const p0_r1 = |
| (__m128i *)&conv_params |
| ->dst[(i + k + 3) * conv_params->dst_stride + j]; |
| |
| res_r0 = _mm256_add_epi32(res_r0, res_add_const); |
| res_r0 = _mm256_srai_epi32( |
| _mm256_add_epi32(res_r0, reduce_bits_vert_const), |
| reduce_bits_vert); |
| res_r1 = _mm256_add_epi32(res_r1, res_add_const); |
| res_r1 = _mm256_srai_epi32( |
| _mm256_add_epi32(res_r1, reduce_bits_vert_const), |
| reduce_bits_vert); |
| |
| if (conv_params->do_average) { |
| __m128i *const dst16_r0 = |
| (__m128i *)&pred[(i + k + 2) * p_stride + j]; |
| __m128i *const dst16_r1 = |
| (__m128i *)&pred[(i + k + 3) * p_stride + j]; |
| // p00 p01 p02 p03 p04 p05 p06 p07 |
| __m256i p_r0 = _mm256_cvtepu16_epi32(_mm_loadu_si128(p0_r0)); |
| // p10 p11 p12 p13 p14 p15 p16 p17 |
| __m256i p_r1 = _mm256_cvtepu16_epi32(_mm_loadu_si128(p0_r1)); |
| if (use_wtd_comp_avg) { |
| res_r0 = _mm256_add_epi32(_mm256_mullo_epi32(p_r0, wt0), |
| _mm256_mullo_epi32(res_r0, wt1)); |
| res_r0 = _mm256_srai_epi32(res_r0, DIST_PRECISION_BITS); |
| res_r1 = _mm256_add_epi32(_mm256_mullo_epi32(p_r1, wt0), |
| _mm256_mullo_epi32(res_r1, wt1)); |
| res_r1 = _mm256_srai_epi32(res_r1, DIST_PRECISION_BITS); |
| } else { |
| res_r0 = _mm256_srai_epi32(_mm256_add_epi32(p_r0, res_r0), 1); |
| res_r1 = _mm256_srai_epi32(_mm256_add_epi32(p_r1, res_r1), 1); |
| } |
| |
| __m256i res32_r0 = _mm256_add_epi32(res_r0, res_sub_const); |
| res32_r0 = _mm256_srai_epi32( |
| _mm256_add_epi32(res32_r0, round_bits_const), round_bits); |
| __m256i res32_r1 = _mm256_add_epi32(res_r1, res_sub_const); |
| res32_r1 = _mm256_srai_epi32( |
| _mm256_add_epi32(res32_r1, round_bits_const), round_bits); |
| |
| // s00 s01 s02 s03 s10 s11 s12 s13 | r00 r01 r02 r03 r10 r11 r12 |
| // r13 |
| __m256i res16_r0 = _mm256_packus_epi32(res32_r0, res32_r1); |
| res16_r0 = _mm256_min_epi16(res16_r0, clip_pixel); |
| // s00 s01 s02 s03 r00 r01 r02 r03 | s10 s11 s12 s13 r10 r11 r12 |
| // r13 |
| res16_r0 = _mm256_permute4x64_epi64(res16_r0, 0xd8); |
| |
| _mm_storeu_si128(dst16_r0, _mm256_castsi256_si128(res16_r0)); |
| _mm_storeu_si128(dst16_r1, _mm256_extracti128_si256(res16_r0, 1)); |
| } else { |
| const __m256i res = _mm256_permute4x64_epi64( |
| _mm256_packus_epi32(res_r0, res_r1), 0xd8); |
| |
| _mm_storeu_si128(p0_r0, _mm256_castsi256_si128(res)); |
| _mm_storeu_si128(p0_r1, _mm256_extracti128_si256(res, 1)); |
| } |
| } else { |
| // Round and pack into 16 bits |
| const __m256i round_const = |
| _mm256_set1_epi32(-(1 << (bd + reduce_bits_vert - 1)) + |
| ((1 << reduce_bits_vert) >> 1)); |
| |
| const __m256i res_r0_round = _mm256_srai_epi32( |
| _mm256_add_epi32(res_r0, round_const), reduce_bits_vert); |
| const __m256i res_r1_round = _mm256_srai_epi32( |
| _mm256_add_epi32(res_r1, round_const), reduce_bits_vert); |
| |
| __m256i res_16bit = _mm256_packs_epi32(res_r0_round, res_r1_round); |
| // Clamp res_16bit to the range [0, 2^bd - 1] |
| const __m256i max_val = _mm256_set1_epi16((1 << bd) - 1); |
| const __m256i zero = _mm256_setzero_si256(); |
| res_16bit = |
| _mm256_max_epi16(_mm256_min_epi16(res_16bit, max_val), zero); |
| |
| // Store, blending with 'pred' if needed |
| __m128i *const p0_r0 = (__m128i *)&pred[(i + k + 2) * p_stride + j]; |
| __m128i *const p0_r1 = (__m128i *)&pred[(i + k + 3) * p_stride + j]; |
| |
| const __m256i res = _mm256_permute4x64_epi64(res_16bit, 0xd8); |
| _mm_storeu_si128(p0_r0, _mm256_castsi256_si128(res)); |
| _mm_storeu_si128(p0_r1, _mm256_extracti128_si256(res, 1)); |
| } |
| } |
| } |
| } |
| } |
| } |
| #endif // CONFIG_EXT_WARP_FILTER |
