| /* |
| * Copyright (c) 2024, Alliance for Open Media. All rights reserved. |
| * |
| * This source code is subject to the terms of the BSD 2 Clause License and |
| * the Alliance for Open Media Patent License 1.0. If the BSD 2 Clause License |
| * was not distributed with this source code in the LICENSE file, you can |
| * obtain it at www.aomedia.org/license/software. 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 www.aomedia.org/license/patent. |
| */ |
| #include <immintrin.h> |
| |
| #include "config/av1_rtcd.h" |
| |
| #include "av1/common/resize.h" |
| |
| #include "aom_dsp/x86/synonyms.h" |
| |
| #define ROW_OFFSET 5 |
| |
| #define PROCESS_RESIZE_Y_WD8 \ |
| /* ah0 ah1 ... ah7 */ \ |
| const __m128i AH = _mm_add_epi16(l0, l7); \ |
| /* bg0 bg1 ... bh7 */ \ |
| const __m128i BG = _mm_add_epi16(l1, l6); \ |
| /* cf0 cf1 ... cf7 */ \ |
| const __m128i CF = _mm_add_epi16(l2, l5); \ |
| /* de0 de1 ... de7 */ \ |
| const __m128i DE = _mm_add_epi16(l3, l4); \ |
| \ |
| /* ah0 bg0 ... ah3 bg3 */ \ |
| const __m128i AHBG_low = _mm_unpacklo_epi16(AH, BG); \ |
| /*cf0 de0 ... cf2 de2 */ \ |
| const __m128i CFDE_low = _mm_unpacklo_epi16(CF, DE); \ |
| \ |
| /* ah4 bg4... ah7 bg7 */ \ |
| const __m128i AHBG_hi = _mm_unpackhi_epi16(AH, BG); \ |
| /* cf4 de4... cf7 de7 */ \ |
| const __m128i CFDE_hi = _mm_unpackhi_epi16(CF, DE); \ |
| \ |
| /* r00 r01 r02 r03 */ \ |
| const __m128i r00 = _mm_madd_epi16(AHBG_low, coeffs_y[0]); \ |
| const __m128i r01 = _mm_madd_epi16(CFDE_low, coeffs_y[1]); \ |
| __m128i r0 = _mm_add_epi32(r00, r01); \ |
| /* r04 r05 r06 r07 */ \ |
| const __m128i r10 = _mm_madd_epi16(AHBG_hi, coeffs_y[0]); \ |
| const __m128i r11 = _mm_madd_epi16(CFDE_hi, coeffs_y[1]); \ |
| __m128i r1 = _mm_add_epi32(r10, r11); \ |
| \ |
| r0 = _mm_add_epi32(r0, round_const_bits); \ |
| r1 = _mm_add_epi32(r1, round_const_bits); \ |
| r0 = _mm_sra_epi32(r0, round_shift_bits); \ |
| r1 = _mm_sra_epi32(r1, round_shift_bits); \ |
| \ |
| /* r00 ... r07 (8 values of each 16bit) */ \ |
| const __m128i res_16b = _mm_packs_epi32(r0, r1); \ |
| /* r00 ... r07 | r00 ... r07 (16 values of each 8bit) */ \ |
| const __m128i res_8b0 = _mm_packus_epi16(res_16b, res_16b); \ |
| \ |
| __m128i res = _mm_min_epu8(res_8b0, clip_pixel); \ |
| res = _mm_max_epu8(res, zero); \ |
| _mm_storel_epi64((__m128i *)&output[(i / 2) * out_stride + j], res); \ |
| \ |
| l0 = l2; \ |
| l1 = l3; \ |
| l2 = l4; \ |
| l3 = l5; \ |
| l4 = l6; \ |
| l5 = l7; \ |
| data += 2 * stride; |
| |
| static inline void prepare_filter_coeffs(const int16_t *filter, |
| __m128i *const coeffs /* [2] */) { |
| // f0 f1 f2 f3 x x x x |
| const __m128i sym_even_filter = _mm_loadl_epi64((__m128i *)filter); |
| |
| // f1 f0 f3 f2 x x x x |
| const __m128i tmp1 = _mm_shufflelo_epi16(sym_even_filter, 0xb1); |
| |
| // f3 f2 f3 f2 ... |
| coeffs[0] = _mm_shuffle_epi32(tmp1, 0x55); |
| // f1 f0 f1 f0 ... |
| coeffs[1] = _mm_shuffle_epi32(tmp1, 0x00); |
| } |
| |
| bool av1_resize_vert_dir_sse2(uint8_t *intbuf, uint8_t *output, int out_stride, |
| int height, int height2, int stride, |
| int start_col) { |
| // For the GM tool, the input layer height or width is assured to be an even |
| // number. Hence the function 'down2_symodd()' is not invoked and SIMD |
| // optimization of the same is not implemented. |
| // When the input height is less than 8 and even, the potential input |
| // heights are limited to 2, 4, or 6. These scenarios require seperate |
| // handling due to padding requirements. Invoking the C function here will |
| // eliminate the need for conditional statements within the subsequent SIMD |
| // code to manage these cases. |
| if (height & 1 || height < 8) { |
| return av1_resize_vert_dir_c(intbuf, output, out_stride, height, height2, |
| stride, start_col); |
| } |
| |
| __m128i coeffs_y[2]; |
| const int bits = FILTER_BITS; |
| const __m128i round_const_bits = _mm_set1_epi32((1 << bits) >> 1); |
| const __m128i round_shift_bits = _mm_cvtsi32_si128(bits); |
| const uint8_t max_pixel = 255; |
| const __m128i clip_pixel = _mm_set1_epi8((char)max_pixel); |
| const __m128i zero = _mm_setzero_si128(); |
| prepare_filter_coeffs(av1_down2_symeven_half_filter, coeffs_y); |
| |
| const int remain_col = stride % 8; |
| |
| for (int j = start_col; j < stride - remain_col; j += 8) { |
| uint8_t *data = &intbuf[j]; |
| // d0 ... d7 |
| const __m128i l8_3 = _mm_loadl_epi64((__m128i *)(data + 0 * stride)); |
| // Padding top 3 rows with the last available row at the top. |
| // a0 ... a7 |
| const __m128i l8_0 = l8_3; |
| // b0 ... b7 |
| const __m128i l8_1 = l8_3; |
| // c0 ... c7 |
| const __m128i l8_2 = l8_3; |
| // e0 ... e7 |
| const __m128i l8_4 = _mm_loadl_epi64((__m128i *)(data + 1 * stride)); |
| // f0 ... f7 |
| const __m128i l8_5 = _mm_loadl_epi64((__m128i *)(data + 2 * stride)); |
| |
| // Convert to 16bit as addition of 2 source pixel crosses 8 bit. |
| __m128i l0 = _mm_unpacklo_epi8(l8_0, zero); // A(128bit) = a0 - a7(16 bit) |
| __m128i l1 = _mm_unpacklo_epi8(l8_1, zero); // B(128bit) = b0 - b7(16 bit) |
| __m128i l2 = _mm_unpacklo_epi8(l8_2, zero); // C(128bit) = c0 - c7(16 bit) |
| __m128i l3 = _mm_unpacklo_epi8(l8_3, zero); // D(128bit) = d0 - d7(16 bit) |
| __m128i l4 = _mm_unpacklo_epi8(l8_4, zero); // E(128bit) = e0 - e7(16 bit) |
| __m128i l5 = _mm_unpacklo_epi8(l8_5, zero); // F(128bit) = f0 - f7(16 bit) |
| |
| // Increment the pointer such that the loading starts from row G. |
| data = data + 3 * stride; |
| // The core vertical SIMD processes 2 input rows simultaneously to generate |
| // output corresponding to 1 row. To streamline the core loop and eliminate |
| // the need for conditional checks, the remaining rows 4 are processed |
| // separately. |
| for (int i = 0; i < height - 4; i += 2) { |
| // g0 ... g7 |
| __m128i l8_6 = _mm_loadl_epi64((__m128i *)(data)); |
| // h0 ... h7 |
| __m128i l8_7 = _mm_loadl_epi64((__m128i *)(data + stride)); |
| __m128i l6 = _mm_unpacklo_epi8(l8_6, zero); // G(128bit):g0-g7(16b) |
| __m128i l7 = _mm_unpacklo_epi8(l8_7, zero); // H(128bit):h0-h7(16b) |
| |
| PROCESS_RESIZE_Y_WD8 |
| } |
| |
| __m128i l8_6 = _mm_loadl_epi64((__m128i *)(data)); |
| __m128i l6 = _mm_unpacklo_epi8(l8_6, zero); |
| // Process the last 4 input rows here. |
| for (int i = height - 4; i < height; i += 2) { |
| __m128i l7 = l6; |
| PROCESS_RESIZE_Y_WD8 |
| } |
| } |
| |
| if (remain_col) |
| return av1_resize_vert_dir_c(intbuf, output, out_stride, height, height2, |
| stride, stride - remain_col); |
| |
| return true; |
| } |
| |
| // Blends a and b using mask and returns the result. |
| static inline __m128i blend(__m128i a, __m128i b, __m128i mask) { |
| const __m128i masked_b = _mm_and_si128(mask, b); |
| const __m128i masked_a = _mm_andnot_si128(mask, a); |
| return (_mm_or_si128(masked_a, masked_b)); |
| } |
| |
| // Masks used for width 16 pixels, with left and right padding |
| // requirements. |
| static const uint8_t left_padding_mask[16] = { |
| 255, 255, 255, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
| }; |
| |
| static const uint8_t right_padding_mask[16] = { 0, 0, 0, 0, 0, 0, |
| 0, 0, 0, 0, 255, 255, |
| 255, 255, 255, 255 }; |
| |
| static const uint8_t mask_16[16] = { |
| 255, 0, 255, 0, 255, 0, 255, 0, 255, 0, 255, 0, 255, 0, 255, 0, |
| }; |
| |
| void av1_resize_horz_dir_sse2(const uint8_t *const input, int in_stride, |
| uint8_t *intbuf, int height, int filtered_length, |
| int width2) { |
| assert(height % 2 == 0); |
| // Invoke C for width less than 16. |
| if (filtered_length < 16) { |
| av1_resize_horz_dir_c(input, in_stride, intbuf, height, filtered_length, |
| width2); |
| return; |
| } |
| |
| __m128i coeffs_x[2]; |
| const int bits = FILTER_BITS; |
| const int dst_stride = width2; |
| const __m128i round_const_bits = _mm_set1_epi32((1 << bits) >> 1); |
| const __m128i round_shift_bits = _mm_cvtsi32_si128(bits); |
| |
| const uint8_t max_pixel = 255; |
| const __m128i clip_pixel = _mm_set1_epi8((char)max_pixel); |
| const __m128i zero = _mm_setzero_si128(); |
| |
| const __m128i start_pad_mask = _mm_loadu_si128((__m128i *)left_padding_mask); |
| const __m128i end_pad_mask = _mm_loadu_si128((__m128i *)right_padding_mask); |
| const __m128i mask_even = _mm_loadu_si128((__m128i *)mask_16); |
| prepare_filter_coeffs(av1_down2_symeven_half_filter, coeffs_x); |
| |
| for (int i = 0; i < height; ++i) { |
| int filter_offset = 0; |
| int row01_offset = ROW_OFFSET; |
| int remain_col = filtered_length; |
| // To avoid pixel over-read at frame boundary, processing of 16 pixels |
| // is done using the core loop only if sufficient number of pixels required |
| // for the load are present.The remaining pixels are processed separately. |
| for (int j = 0; j <= filtered_length - 16; j += 16) { |
| if (remain_col == 18 || remain_col == 20) { |
| break; |
| } |
| const int is_last_cols16 = (j == filtered_length - 16); |
| // While processing the last 16 pixels of the row, ensure that only valid |
| // pixels are loaded. |
| if (is_last_cols16) row01_offset = 0; |
| const int in_idx = i * in_stride + j - filter_offset; |
| const int out_idx = i * dst_stride + j / 2; |
| remain_col -= 16; |
| // a0 a1 a2 a3 .... a15 |
| __m128i row00 = _mm_loadu_si128((__m128i *)&input[in_idx]); |
| // a8 a9 a10 a11 .... a23 |
| __m128i row01 = _mm_loadu_si128( |
| (__m128i *)&input[in_idx + row01_offset + filter_offset]); |
| filter_offset = 3; |
| |
| // Pad start pixels to the left, while processing the first pixels in the |
| // row. |
| if (j == 0) { |
| const __m128i start_pixel_row0 = |
| _mm_set1_epi8((char)input[i * in_stride]); |
| row00 = |
| blend(_mm_slli_si128(row00, 3), start_pixel_row0, start_pad_mask); |
| } |
| |
| // Pad end pixels to the right, while processing the last pixels in the |
| // row. |
| if (is_last_cols16) { |
| const __m128i end_pixel_row0 = |
| _mm_set1_epi8((char)input[i * in_stride + filtered_length - 1]); |
| row01 = blend(_mm_srli_si128(row01, ROW_OFFSET), end_pixel_row0, |
| end_pad_mask); |
| } |
| |
| // a2 a3 a4 a5 a6 a7 a8 a9 .... a17 |
| const __m128i row0_1 = _mm_unpacklo_epi64(_mm_srli_si128(row00, 2), |
| _mm_srli_si128(row01, 2)); |
| // a4 a5 a6 a7 a9 10 a11 a12 .... a19 |
| const __m128i row0_2 = _mm_unpacklo_epi64(_mm_srli_si128(row00, 4), |
| _mm_srli_si128(row01, 4)); |
| // a6 a7 a8 a9 a10 a11 a12 a13 .... a21 |
| const __m128i row0_3 = _mm_unpacklo_epi64(_mm_srli_si128(row00, 6), |
| _mm_srli_si128(row01, 6)); |
| |
| // a0 a2 a4 a6 a8 a10 a12 a14 (each 16 bit) |
| const __m128i s0 = _mm_and_si128(row00, mask_even); |
| // a1 a3 a5 a7 a9 a11 a13 a15 |
| const __m128i s1 = _mm_and_si128(_mm_srli_epi16(row00, 8), mask_even); |
| // a2 a4 a6 a8 a10 a12 a14 a16 |
| const __m128i s2 = _mm_and_si128(row0_1, mask_even); |
| // a3 a5 a7 a9 a11 a13 a15 a17 |
| const __m128i s3 = _mm_and_si128(_mm_srli_epi16(row0_1, 8), mask_even); |
| // a4 a6 a8 a10 a12 a14 a16 a18 |
| const __m128i s4 = _mm_and_si128(row0_2, mask_even); |
| // a5 a7 a9 a11 a13 a15 a17 a19 |
| const __m128i s5 = _mm_and_si128(_mm_srli_epi16(row0_2, 8), mask_even); |
| // a6 a8 a10 a12 a14 a16 a18 a20 |
| const __m128i s6 = _mm_and_si128(row0_3, mask_even); |
| // a7 a9 a11 a13 a15 a17 a19 a21 |
| const __m128i s7 = _mm_and_si128(_mm_srli_epi16(row0_3, 8), mask_even); |
| |
| // a0a7 a2a9 a4a11 .... a12a19 a14a21 |
| const __m128i s07 = _mm_add_epi16(s0, s7); |
| // a1a6 a3a8 a5a10 .... a13a18 a15a20 |
| const __m128i s16 = _mm_add_epi16(s1, s6); |
| // a2a5 a4a7 a6a9 .... a14a17 a16a19 |
| const __m128i s25 = _mm_add_epi16(s2, s5); |
| // a3a4 a5a6 a7a8 .... a15a16 a17a18 |
| const __m128i s34 = _mm_add_epi16(s3, s4); |
| |
| // a0a7 a1a6 a2a9 a3a8 a4a11 a5a10 a6a13 a7a12 |
| const __m128i s1607_low = _mm_unpacklo_epi16(s07, s16); |
| // a2a5 a3a4 a4a7 a5a6 a6a9 a7a8 a8a11 a9a10 |
| const __m128i s3425_low = _mm_unpacklo_epi16(s25, s34); |
| |
| // a8a15 a9a14 a10a17 a11a16 a12a19 a13a18 a14a21 a15a20 |
| const __m128i s1607_high = _mm_unpackhi_epi16(s07, s16); |
| // a10a13 a11a12 a12a15 a13a14 a14a17 a15a16 a16a19 a17a18 |
| const __m128i s3425_high = _mm_unpackhi_epi16(s25, s34); |
| |
| const __m128i r01_0 = _mm_madd_epi16(s3425_low, coeffs_x[1]); |
| const __m128i r01_1 = _mm_madd_epi16(s1607_low, coeffs_x[0]); |
| const __m128i r01_2 = _mm_madd_epi16(s3425_high, coeffs_x[1]); |
| const __m128i r01_3 = _mm_madd_epi16(s1607_high, coeffs_x[0]); |
| |
| // Result of first 8 pixels of row0 (a0 to a7). |
| // r0_0 r0_1 r0_2 r0_3 |
| __m128i r00 = _mm_add_epi32(r01_0, r01_1); |
| r00 = _mm_add_epi32(r00, round_const_bits); |
| r00 = _mm_sra_epi32(r00, round_shift_bits); |
| |
| // Result of next 8 pixels of row0 (a8 to 15). |
| // r0_4 r0_5 r0_6 r0_7 |
| __m128i r01 = _mm_add_epi32(r01_2, r01_3); |
| r01 = _mm_add_epi32(r01, round_const_bits); |
| r01 = _mm_sra_epi32(r01, round_shift_bits); |
| |
| // r0_0 r0_1 r1_2 r0_3 r0_4 r0_5 r0_6 r0_7 |
| const __m128i res_16 = _mm_packs_epi32(r00, r01); |
| const __m128i res_8 = _mm_packus_epi16(res_16, res_16); |
| __m128i res = _mm_min_epu8(res_8, clip_pixel); |
| res = _mm_max_epu8(res, zero); |
| |
| // r0_0 r0_1 r1_2 r0_3 r0_4 r0_5 r0_6 r0_7 |
| _mm_storel_epi64((__m128i *)&intbuf[out_idx], res); |
| } |
| |
| int wd_processed = filtered_length - remain_col; |
| if (remain_col) { |
| const int in_idx = (in_stride * i); |
| const int out_idx = (wd_processed / 2) + width2 * i; |
| |
| down2_symeven(input + in_idx, filtered_length, intbuf + out_idx, |
| wd_processed); |
| } |
| } |
| } |