| /* |
| * Copyright (c) 2012 The WebM project authors. All Rights Reserved. |
| * |
| * Use of this source code is governed by a BSD-style license |
| * that can be found in the LICENSE file in the root of the source |
| * tree. An additional intellectual property rights grant can be found |
| * in the file PATENTS. All contributing project authors may |
| * be found in the AUTHORS file in the root of the source tree. |
| */ |
| |
| #include <immintrin.h> // AVX2 |
| #include "vpx_ports/mem.h" |
| #include "vp9/encoder/vp9_variance.h" |
| |
| DECLARE_ALIGNED(32, static const uint8_t, bilinear_filters_avx2[512]) = { |
| 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, |
| 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, 16, 0, |
| 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, |
| 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, |
| 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, |
| 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, |
| 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, |
| 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, |
| 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, |
| 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, |
| 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, |
| 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, |
| 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, |
| 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, |
| 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, |
| 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, |
| 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, |
| 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, 8, |
| 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, |
| 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, 7, 9, |
| 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, |
| 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, 6, 10, |
| 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, |
| 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, 5, 11, |
| 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, |
| 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, 4, 12, |
| 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, |
| 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, 3, 13, |
| 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, |
| 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, 2, 14, |
| 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, |
| 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15, 1, 15 |
| }; |
| |
| unsigned int vp9_sub_pixel_variance32xh_avx2(const uint8_t *src, |
| int src_stride, |
| int x_offset, |
| int y_offset, |
| const uint8_t *dst, |
| int dst_stride, |
| int height, |
| unsigned int *sse) { |
| __m256i src_reg, dst_reg, exp_src_lo, exp_src_hi, exp_dst_lo, exp_dst_hi; |
| __m256i sse_reg, sum_reg, sse_reg_hi, res_cmp, sum_reg_lo, sum_reg_hi; |
| __m256i zero_reg; |
| int i, sum; |
| sum_reg = _mm256_set1_epi16(0); |
| sse_reg = _mm256_set1_epi16(0); |
| zero_reg = _mm256_set1_epi16(0); |
| |
| if (x_offset == 0) { |
| // x_offset = 0 and y_offset = 0 |
| if (y_offset == 0) { |
| for (i = 0; i < height ; i++) { |
| // load source and destination |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| dst_reg = _mm256_load_si256((__m256i const *) (dst)); |
| |
| // expend each byte to 2 bytes |
| exp_src_lo = _mm256_unpacklo_epi8(src_reg, zero_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_reg, zero_reg); |
| |
| exp_dst_lo = _mm256_unpacklo_epi8(dst_reg, zero_reg); |
| exp_dst_hi = _mm256_unpackhi_epi8(dst_reg, zero_reg); |
| |
| // source - dest |
| exp_src_lo = _mm256_sub_epi16(exp_src_lo, exp_dst_lo); |
| exp_src_hi = _mm256_sub_epi16(exp_src_hi, exp_dst_hi); |
| |
| // calculate sum |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_lo); |
| exp_src_lo = _mm256_madd_epi16(exp_src_lo, exp_src_lo); |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_hi); |
| exp_src_hi = _mm256_madd_epi16(exp_src_hi, exp_src_hi); |
| |
| // calculate sse |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_lo); |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_hi); |
| |
| src+= src_stride; |
| dst+= dst_stride; |
| } |
| // x_offset = 0 and y_offset = 8 |
| } else if (y_offset == 8) { |
| __m256i src_next_reg; |
| for (i = 0; i < height ; i++) { |
| // load source + next source + destination |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) |
| (src + src_stride)); |
| dst_reg = _mm256_load_si256((__m256i const *) (dst)); |
| // average between current and next stride source |
| src_reg = _mm256_avg_epu8(src_reg, src_next_reg); |
| |
| // expend each byte to 2 bytes |
| exp_src_lo = _mm256_unpacklo_epi8(src_reg, zero_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_reg, zero_reg); |
| |
| exp_dst_lo = _mm256_unpacklo_epi8(dst_reg, zero_reg); |
| exp_dst_hi = _mm256_unpackhi_epi8(dst_reg, zero_reg); |
| |
| // source - dest |
| exp_src_lo = _mm256_sub_epi16(exp_src_lo, exp_dst_lo); |
| exp_src_hi = _mm256_sub_epi16(exp_src_hi, exp_dst_hi); |
| |
| // calculate sum |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_lo); |
| exp_src_lo = _mm256_madd_epi16(exp_src_lo, exp_src_lo); |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_hi); |
| exp_src_hi = _mm256_madd_epi16(exp_src_hi, exp_src_hi); |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_lo); |
| |
| // calculate sse |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_hi); |
| |
| src+= src_stride; |
| dst+= dst_stride; |
| } |
| // x_offset = 0 and y_offset = bilin interpolation |
| } else { |
| __m256i filter, pw8, src_next_reg; |
| #if (ARCH_X86_64) |
| int64_t y_offset64; |
| y_offset64 = y_offset; |
| y_offset64 <<= 5; |
| filter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + y_offset64)); |
| #else |
| y_offset <<= 5; |
| filter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + y_offset)); |
| #endif |
| pw8 = _mm256_set1_epi16(8); |
| for (i = 0; i < height ; i++) { |
| // load current and next source + destination |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) |
| (src + src_stride)); |
| dst_reg = _mm256_load_si256((__m256i const *) (dst)); |
| |
| // merge current and next source |
| exp_src_lo = _mm256_unpacklo_epi8(src_reg, src_next_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_reg, src_next_reg); |
| |
| // filter the source |
| exp_src_lo = _mm256_maddubs_epi16(exp_src_lo, filter); |
| exp_src_hi = _mm256_maddubs_epi16(exp_src_hi, filter); |
| |
| // add 8 to the source |
| exp_src_lo = _mm256_add_epi16(exp_src_lo, pw8); |
| exp_src_hi = _mm256_add_epi16(exp_src_hi, pw8); |
| |
| // divide by 16 |
| exp_src_lo = _mm256_srai_epi16(exp_src_lo, 4); |
| exp_src_hi = _mm256_srai_epi16(exp_src_hi, 4); |
| |
| // expand each byte to 2 byte in the destination |
| exp_dst_lo = _mm256_unpacklo_epi8(dst_reg, zero_reg); |
| exp_dst_hi = _mm256_unpackhi_epi8(dst_reg, zero_reg); |
| |
| // source - dest |
| exp_src_lo = _mm256_sub_epi16(exp_src_lo, exp_dst_lo); |
| exp_src_hi = _mm256_sub_epi16(exp_src_hi, exp_dst_hi); |
| |
| // calculate sum |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_lo); |
| exp_src_lo = _mm256_madd_epi16(exp_src_lo, exp_src_lo); |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_hi); |
| exp_src_hi = _mm256_madd_epi16(exp_src_hi, exp_src_hi); |
| |
| // calculate sse |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_lo); |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_hi); |
| |
| src+= src_stride; |
| dst+= dst_stride; |
| } |
| } |
| // x_offset = 8 and y_offset = 0 |
| } else if (x_offset == 8) { |
| if (y_offset == 0) { |
| __m256i src_next_reg; |
| for (i = 0; i < height ; i++) { |
| // load source and another source starting from the next |
| // following byte + destination |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) (src + 1)); |
| dst_reg = _mm256_load_si256((__m256i const *) (dst)); |
| |
| // average between source and the next byte following source |
| src_reg = _mm256_avg_epu8(src_reg, src_next_reg); |
| |
| // expand each byte to 2 bytes |
| exp_src_lo = _mm256_unpacklo_epi8(src_reg, zero_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_reg, zero_reg); |
| |
| exp_dst_lo = _mm256_unpacklo_epi8(dst_reg, zero_reg); |
| exp_dst_hi = _mm256_unpackhi_epi8(dst_reg, zero_reg); |
| |
| // source - dest |
| exp_src_lo = _mm256_sub_epi16(exp_src_lo, exp_dst_lo); |
| exp_src_hi = _mm256_sub_epi16(exp_src_hi, exp_dst_hi); |
| |
| // calculate sum |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_lo); |
| exp_src_lo = _mm256_madd_epi16(exp_src_lo, exp_src_lo); |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_hi); |
| exp_src_hi = _mm256_madd_epi16(exp_src_hi, exp_src_hi); |
| |
| // calculate sse |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_lo); |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_hi); |
| |
| src+= src_stride; |
| dst+= dst_stride; |
| } |
| // x_offset = 8 and y_offset = 8 |
| } else if (y_offset == 8) { |
| __m256i src_next_reg, src_avg; |
| // load source and another source starting from the next |
| // following byte |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) (src + 1)); |
| |
| // average between source and the next byte following source |
| src_avg = _mm256_avg_epu8(src_reg, src_next_reg); |
| for (i = 0; i < height ; i++) { |
| src+= src_stride; |
| // load source and another source starting from the next |
| // following byte + destination |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) (src + 1)); |
| dst_reg = _mm256_load_si256((__m256i const *) (dst)); |
| // average between source and the next byte following source |
| src_reg = _mm256_avg_epu8(src_reg, src_next_reg); |
| |
| // expand each byte to 2 bytes |
| exp_dst_lo = _mm256_unpacklo_epi8(dst_reg, zero_reg); |
| exp_dst_hi = _mm256_unpackhi_epi8(dst_reg, zero_reg); |
| |
| // average between previous average to current average |
| src_avg = _mm256_avg_epu8(src_avg, src_reg); |
| // expand each byte to 2 bytes |
| exp_src_lo = _mm256_unpacklo_epi8(src_avg, zero_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_avg, zero_reg); |
| |
| // save current source average |
| src_avg = src_reg; |
| // source - dest |
| exp_src_lo = _mm256_sub_epi16(exp_src_lo, exp_dst_lo); |
| exp_src_hi = _mm256_sub_epi16(exp_src_hi, exp_dst_hi); |
| |
| // calculate sum |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_lo); |
| exp_src_lo = _mm256_madd_epi16(exp_src_lo, exp_src_lo); |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_hi); |
| exp_src_hi = _mm256_madd_epi16(exp_src_hi, exp_src_hi); |
| |
| // calculate sse |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_lo); |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_hi); |
| |
| dst+= dst_stride; |
| } |
| // x_offset = 8 and y_offset = bilin interpolation |
| } else { |
| __m256i filter, pw8, src_next_reg, src_avg; |
| #if (ARCH_X86_64) |
| int64_t y_offset64; |
| y_offset64 = y_offset; |
| y_offset64 <<= 5; |
| filter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + y_offset64)); |
| #else |
| y_offset <<= 5; |
| filter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + y_offset)); |
| #endif |
| pw8 = _mm256_set1_epi16(8); |
| // load source and another source starting from the next |
| // following byte |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) (src + 1)); |
| // average between source and the next byte following source |
| src_avg = _mm256_avg_epu8(src_reg, src_next_reg); |
| for (i = 0; i < height ; i++) { |
| src+= src_stride; |
| // load source and another source starting from the next |
| // following byte + destination |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) (src + 1)); |
| dst_reg = _mm256_load_si256((__m256i const *) (dst)); |
| // average between source and the next byte following source |
| src_reg = _mm256_avg_epu8(src_reg, src_next_reg); |
| |
| // merge previous average and current average |
| exp_src_lo = _mm256_unpacklo_epi8(src_avg, src_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_avg, src_reg); |
| |
| // filter the source |
| exp_src_lo = _mm256_maddubs_epi16(exp_src_lo, filter); |
| exp_src_hi = _mm256_maddubs_epi16(exp_src_hi, filter); |
| |
| // add 8 to the source |
| exp_src_lo = _mm256_add_epi16(exp_src_lo, pw8); |
| exp_src_hi = _mm256_add_epi16(exp_src_hi, pw8); |
| |
| // divide the source by 16 |
| exp_src_lo = _mm256_srai_epi16(exp_src_lo, 4); |
| exp_src_hi = _mm256_srai_epi16(exp_src_hi, 4); |
| |
| // expand each byte to 2 bytes |
| exp_dst_lo = _mm256_unpacklo_epi8(dst_reg, zero_reg); |
| exp_dst_hi = _mm256_unpackhi_epi8(dst_reg, zero_reg); |
| |
| // save current source average |
| src_avg = src_reg; |
| // source - dest |
| exp_src_lo = _mm256_sub_epi16(exp_src_lo, exp_dst_lo); |
| exp_src_hi = _mm256_sub_epi16(exp_src_hi, exp_dst_hi); |
| |
| // calculate sum |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_lo); |
| exp_src_lo = _mm256_madd_epi16(exp_src_lo, exp_src_lo); |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_hi); |
| exp_src_hi = _mm256_madd_epi16(exp_src_hi, exp_src_hi); |
| |
| // calculate sse |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_lo); |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_hi); |
| |
| dst+= dst_stride; |
| } |
| } |
| // x_offset = bilin interpolation and y_offset = 0 |
| } else { |
| if (y_offset == 0) { |
| __m256i filter, pw8, src_next_reg; |
| #if (ARCH_X86_64) |
| int64_t x_offset64; |
| x_offset64 = x_offset; |
| x_offset64 <<= 5; |
| filter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + x_offset64)); |
| #else |
| x_offset <<= 5; |
| filter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + x_offset)); |
| #endif |
| pw8 = _mm256_set1_epi16(8); |
| for (i = 0; i < height ; i++) { |
| // load source and another source starting from the next |
| // following byte + destination |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) (src + 1)); |
| dst_reg = _mm256_load_si256((__m256i const *) (dst)); |
| |
| // merge current and next source |
| exp_src_lo = _mm256_unpacklo_epi8(src_reg, src_next_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_reg, src_next_reg); |
| |
| // filter the source |
| exp_src_lo = _mm256_maddubs_epi16(exp_src_lo, filter); |
| exp_src_hi = _mm256_maddubs_epi16(exp_src_hi, filter); |
| |
| // add 8 to source |
| exp_src_lo = _mm256_add_epi16(exp_src_lo, pw8); |
| exp_src_hi = _mm256_add_epi16(exp_src_hi, pw8); |
| |
| // divide the source by 16 |
| exp_src_lo = _mm256_srai_epi16(exp_src_lo, 4); |
| exp_src_hi = _mm256_srai_epi16(exp_src_hi, 4); |
| |
| // expand each byte to 2 bytes |
| exp_dst_lo = _mm256_unpacklo_epi8(dst_reg, zero_reg); |
| exp_dst_hi = _mm256_unpackhi_epi8(dst_reg, zero_reg); |
| |
| // source - dest |
| exp_src_lo = _mm256_sub_epi16(exp_src_lo, exp_dst_lo); |
| exp_src_hi = _mm256_sub_epi16(exp_src_hi, exp_dst_hi); |
| |
| // calculate sum |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_lo); |
| exp_src_lo = _mm256_madd_epi16(exp_src_lo, exp_src_lo); |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_hi); |
| exp_src_hi = _mm256_madd_epi16(exp_src_hi, exp_src_hi); |
| |
| // calculate sse |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_lo); |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_hi); |
| |
| src+= src_stride; |
| dst+= dst_stride; |
| } |
| // x_offset = bilin interpolation and y_offset = 8 |
| } else if (y_offset == 8) { |
| __m256i filter, pw8, src_next_reg, src_pack; |
| #if (ARCH_X86_64) |
| int64_t x_offset64; |
| x_offset64 = x_offset; |
| x_offset64 <<= 5; |
| filter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + x_offset64)); |
| #else |
| x_offset <<= 5; |
| filter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + x_offset)); |
| #endif |
| pw8 = _mm256_set1_epi16(8); |
| // load source and another source starting from the next |
| // following byte |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) (src + 1)); |
| |
| // merge current and next stride source |
| exp_src_lo = _mm256_unpacklo_epi8(src_reg, src_next_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_reg, src_next_reg); |
| |
| // filter the source |
| exp_src_lo = _mm256_maddubs_epi16(exp_src_lo, filter); |
| exp_src_hi = _mm256_maddubs_epi16(exp_src_hi, filter); |
| |
| // add 8 to source |
| exp_src_lo = _mm256_add_epi16(exp_src_lo, pw8); |
| exp_src_hi = _mm256_add_epi16(exp_src_hi, pw8); |
| |
| // divide source by 16 |
| exp_src_lo = _mm256_srai_epi16(exp_src_lo, 4); |
| exp_src_hi = _mm256_srai_epi16(exp_src_hi, 4); |
| |
| // convert each 16 bit to 8 bit to each low and high lane source |
| src_pack = _mm256_packus_epi16(exp_src_lo, exp_src_hi); |
| for (i = 0; i < height ; i++) { |
| src+= src_stride; |
| |
| // load source and another source starting from the next |
| // following byte + destination |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) (src + 1)); |
| dst_reg = _mm256_load_si256((__m256i const *) (dst)); |
| |
| // merge current and next stride source |
| exp_src_lo = _mm256_unpacklo_epi8(src_reg, src_next_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_reg, src_next_reg); |
| |
| // filter the source |
| exp_src_lo = _mm256_maddubs_epi16(exp_src_lo, filter); |
| exp_src_hi = _mm256_maddubs_epi16(exp_src_hi, filter); |
| |
| // add 8 to source |
| exp_src_lo = _mm256_add_epi16(exp_src_lo, pw8); |
| exp_src_hi = _mm256_add_epi16(exp_src_hi, pw8); |
| |
| // divide source by 16 |
| exp_src_lo = _mm256_srai_epi16(exp_src_lo, 4); |
| exp_src_hi = _mm256_srai_epi16(exp_src_hi, 4); |
| |
| // convert each 16 bit to 8 bit to each low and high lane source |
| src_reg = _mm256_packus_epi16(exp_src_lo, exp_src_hi); |
| // average between previous pack to the current |
| src_pack = _mm256_avg_epu8(src_pack, src_reg); |
| |
| // expand each byte to 2 bytes |
| exp_dst_lo = _mm256_unpacklo_epi8(dst_reg, zero_reg); |
| exp_dst_hi = _mm256_unpackhi_epi8(dst_reg, zero_reg); |
| |
| exp_src_lo = _mm256_unpacklo_epi8(src_pack, zero_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_pack, zero_reg); |
| |
| // source - dest |
| exp_src_lo = _mm256_sub_epi16(exp_src_lo, exp_dst_lo); |
| exp_src_hi = _mm256_sub_epi16(exp_src_hi, exp_dst_hi); |
| |
| // calculate sum |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_lo); |
| exp_src_lo = _mm256_madd_epi16(exp_src_lo, exp_src_lo); |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_hi); |
| exp_src_hi = _mm256_madd_epi16(exp_src_hi, exp_src_hi); |
| |
| // calculate sse |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_lo); |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_hi); |
| |
| // save previous pack |
| src_pack = src_reg; |
| dst+= dst_stride; |
| } |
| // x_offset = bilin interpolation and y_offset = bilin interpolation |
| } else { |
| __m256i xfilter, yfilter, pw8, src_next_reg, src_pack; |
| #if (ARCH_X86_64) |
| int64_t x_offset64, y_offset64; |
| x_offset64 = x_offset; |
| x_offset64 <<= 5; |
| y_offset64 = y_offset; |
| y_offset64 <<= 5; |
| xfilter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + x_offset64)); |
| yfilter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + y_offset64)); |
| #else |
| x_offset <<= 5; |
| xfilter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + x_offset)); |
| y_offset <<= 5; |
| yfilter = _mm256_load_si256( |
| (__m256i const *)(bilinear_filters_avx2 + y_offset)); |
| #endif |
| pw8 = _mm256_set1_epi16(8); |
| // load source and another source starting from the next |
| // following byte |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) (src + 1)); |
| // merge current and next stride source |
| exp_src_lo = _mm256_unpacklo_epi8(src_reg, src_next_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_reg, src_next_reg); |
| |
| // filter the source |
| exp_src_lo = _mm256_maddubs_epi16(exp_src_lo, xfilter); |
| exp_src_hi = _mm256_maddubs_epi16(exp_src_hi, xfilter); |
| |
| // add 8 to the source |
| exp_src_lo = _mm256_add_epi16(exp_src_lo, pw8); |
| exp_src_hi = _mm256_add_epi16(exp_src_hi, pw8); |
| |
| // divide the source by 16 |
| exp_src_lo = _mm256_srai_epi16(exp_src_lo, 4); |
| exp_src_hi = _mm256_srai_epi16(exp_src_hi, 4); |
| |
| // convert each 16 bit to 8 bit to each low and high lane source |
| src_pack = _mm256_packus_epi16(exp_src_lo, exp_src_hi); |
| for (i = 0; i < height ; i++) { |
| src+= src_stride; |
| // load source and another source starting from the next |
| // following byte + destination |
| src_reg = _mm256_loadu_si256((__m256i const *) (src)); |
| src_next_reg = _mm256_loadu_si256((__m256i const *) (src + 1)); |
| dst_reg = _mm256_load_si256((__m256i const *) (dst)); |
| |
| // merge current and next stride source |
| exp_src_lo = _mm256_unpacklo_epi8(src_reg, src_next_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_reg, src_next_reg); |
| |
| // filter the source |
| exp_src_lo = _mm256_maddubs_epi16(exp_src_lo, xfilter); |
| exp_src_hi = _mm256_maddubs_epi16(exp_src_hi, xfilter); |
| |
| // add 8 to source |
| exp_src_lo = _mm256_add_epi16(exp_src_lo, pw8); |
| exp_src_hi = _mm256_add_epi16(exp_src_hi, pw8); |
| |
| // divide source by 16 |
| exp_src_lo = _mm256_srai_epi16(exp_src_lo, 4); |
| exp_src_hi = _mm256_srai_epi16(exp_src_hi, 4); |
| |
| // convert each 16 bit to 8 bit to each low and high lane source |
| src_reg = _mm256_packus_epi16(exp_src_lo, exp_src_hi); |
| |
| // merge previous pack to current pack source |
| exp_src_lo = _mm256_unpacklo_epi8(src_pack, src_reg); |
| exp_src_hi = _mm256_unpackhi_epi8(src_pack, src_reg); |
| |
| // filter the source |
| exp_src_lo = _mm256_maddubs_epi16(exp_src_lo, yfilter); |
| exp_src_hi = _mm256_maddubs_epi16(exp_src_hi, yfilter); |
| |
| // expand each byte to 2 bytes |
| exp_dst_lo = _mm256_unpacklo_epi8(dst_reg, zero_reg); |
| exp_dst_hi = _mm256_unpackhi_epi8(dst_reg, zero_reg); |
| |
| // add 8 to source |
| exp_src_lo = _mm256_add_epi16(exp_src_lo, pw8); |
| exp_src_hi = _mm256_add_epi16(exp_src_hi, pw8); |
| |
| // divide source by 16 |
| exp_src_lo = _mm256_srai_epi16(exp_src_lo, 4); |
| exp_src_hi = _mm256_srai_epi16(exp_src_hi, 4); |
| |
| // source - dest |
| exp_src_lo = _mm256_sub_epi16(exp_src_lo, exp_dst_lo); |
| exp_src_hi = _mm256_sub_epi16(exp_src_hi, exp_dst_hi); |
| |
| // caculate sum |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_lo); |
| exp_src_lo = _mm256_madd_epi16(exp_src_lo, exp_src_lo); |
| sum_reg = _mm256_add_epi16(sum_reg, exp_src_hi); |
| exp_src_hi = _mm256_madd_epi16(exp_src_hi, exp_src_hi); |
| |
| // calculate sse |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_lo); |
| sse_reg = _mm256_add_epi32(sse_reg, exp_src_hi); |
| |
| src_pack = src_reg; |
| dst+= dst_stride; |
| } |
| } |
| } |
| // sum < 0 |
| res_cmp = _mm256_cmpgt_epi16(zero_reg, sum_reg); |
| // save the next 8 bytes of each lane of sse |
| sse_reg_hi = _mm256_srli_si256(sse_reg, 8); |
| // merge the result of sum < 0 with sum to add sign to the next 16 bits |
| sum_reg_lo = _mm256_unpacklo_epi16(sum_reg, res_cmp); |
| sum_reg_hi = _mm256_unpackhi_epi16(sum_reg, res_cmp); |
| // add each 8 bytes from every lane of sse and sum |
| sse_reg = _mm256_add_epi32(sse_reg, sse_reg_hi); |
| sum_reg = _mm256_add_epi32(sum_reg_lo, sum_reg_hi); |
| |
| // save the next 4 bytes of each lane sse |
| sse_reg_hi = _mm256_srli_si256(sse_reg, 4); |
| // save the next 8 bytes of each lane of sum |
| sum_reg_hi = _mm256_srli_si256(sum_reg, 8); |
| |
| // add the first 4 bytes to the next 4 bytes sse |
| sse_reg = _mm256_add_epi32(sse_reg, sse_reg_hi); |
| // add the first 8 bytes to the next 8 bytes |
| sum_reg = _mm256_add_epi32(sum_reg, sum_reg_hi); |
| // extract the low lane and the high lane and add the results |
| *((int*)sse)= _mm_cvtsi128_si32(_mm256_castsi256_si128(sse_reg)) + |
| _mm_cvtsi128_si32(_mm256_extractf128_si256(sse_reg, 1)); |
| sum_reg_hi = _mm256_srli_si256(sum_reg, 4); |
| sum_reg = _mm256_add_epi32(sum_reg, sum_reg_hi); |
| sum = _mm_cvtsi128_si32(_mm256_castsi256_si128(sum_reg)) + |
| _mm_cvtsi128_si32(_mm256_extractf128_si256(sum_reg, 1)); |
| return sum; |
| } |
