18f9902a0ff2c4673b3e470026017e858f2992838jackychen/* 28f9902a0ff2c4673b3e470026017e858f2992838jackychen * Copyright (c) 2015 The WebRTC project authors. All Rights Reserved. 38f9902a0ff2c4673b3e470026017e858f2992838jackychen * 48f9902a0ff2c4673b3e470026017e858f2992838jackychen * Use of this source code is governed by a BSD-style license 58f9902a0ff2c4673b3e470026017e858f2992838jackychen * that can be found in the LICENSE file in the root of the source 68f9902a0ff2c4673b3e470026017e858f2992838jackychen * tree. An additional intellectual property rights grant can be found 78f9902a0ff2c4673b3e470026017e858f2992838jackychen * in the file PATENTS. All contributing project authors may 88f9902a0ff2c4673b3e470026017e858f2992838jackychen * be found in the AUTHORS file in the root of the source tree. 98f9902a0ff2c4673b3e470026017e858f2992838jackychen */ 108f9902a0ff2c4673b3e470026017e858f2992838jackychen 118f9902a0ff2c4673b3e470026017e858f2992838jackychen#include <emmintrin.h> 128f9902a0ff2c4673b3e470026017e858f2992838jackychen 138f9902a0ff2c4673b3e470026017e858f2992838jackychen#include "webrtc/modules/video_processing/util/denoiser_filter_sse2.h" 148f9902a0ff2c4673b3e470026017e858f2992838jackychen 158f9902a0ff2c4673b3e470026017e858f2992838jackychennamespace webrtc { 168f9902a0ff2c4673b3e470026017e858f2992838jackychen 178f9902a0ff2c4673b3e470026017e858f2992838jackychenstatic void Get8x8varSse2(const uint8_t* src, 188f9902a0ff2c4673b3e470026017e858f2992838jackychen int src_stride, 198f9902a0ff2c4673b3e470026017e858f2992838jackychen const uint8_t* ref, 208f9902a0ff2c4673b3e470026017e858f2992838jackychen int ref_stride, 218f9902a0ff2c4673b3e470026017e858f2992838jackychen unsigned int* sse, 228f9902a0ff2c4673b3e470026017e858f2992838jackychen int* sum) { 238f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i zero = _mm_setzero_si128(); 248f9902a0ff2c4673b3e470026017e858f2992838jackychen __m128i vsum = _mm_setzero_si128(); 258f9902a0ff2c4673b3e470026017e858f2992838jackychen __m128i vsse = _mm_setzero_si128(); 268f9902a0ff2c4673b3e470026017e858f2992838jackychen 278f9902a0ff2c4673b3e470026017e858f2992838jackychen for (int i = 0; i < 8; i += 2) { 288f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i src0 = _mm_unpacklo_epi8( 298f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_loadl_epi64((const __m128i*)(src + i * src_stride)), zero); 308f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i ref0 = _mm_unpacklo_epi8( 318f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_loadl_epi64((const __m128i*)(ref + i * ref_stride)), zero); 328f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i diff0 = _mm_sub_epi16(src0, ref0); 338f9902a0ff2c4673b3e470026017e858f2992838jackychen 348f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i src1 = _mm_unpacklo_epi8( 358f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_loadl_epi64((const __m128i*)(src + (i + 1) * src_stride)), zero); 368f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i ref1 = _mm_unpacklo_epi8( 378f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_loadl_epi64((const __m128i*)(ref + (i + 1) * ref_stride)), zero); 388f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i diff1 = _mm_sub_epi16(src1, ref1); 398f9902a0ff2c4673b3e470026017e858f2992838jackychen 408f9902a0ff2c4673b3e470026017e858f2992838jackychen vsum = _mm_add_epi16(vsum, diff0); 418f9902a0ff2c4673b3e470026017e858f2992838jackychen vsum = _mm_add_epi16(vsum, diff1); 428f9902a0ff2c4673b3e470026017e858f2992838jackychen vsse = _mm_add_epi32(vsse, _mm_madd_epi16(diff0, diff0)); 438f9902a0ff2c4673b3e470026017e858f2992838jackychen vsse = _mm_add_epi32(vsse, _mm_madd_epi16(diff1, diff1)); 448f9902a0ff2c4673b3e470026017e858f2992838jackychen } 458f9902a0ff2c4673b3e470026017e858f2992838jackychen 468f9902a0ff2c4673b3e470026017e858f2992838jackychen // sum 478f9902a0ff2c4673b3e470026017e858f2992838jackychen vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 8)); 488f9902a0ff2c4673b3e470026017e858f2992838jackychen vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 4)); 498f9902a0ff2c4673b3e470026017e858f2992838jackychen vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 2)); 5067e94fb6f2a84cad97ba96abce3506c29f8ebb24jackychen *sum = static_cast<int16_t>(_mm_extract_epi16(vsum, 0)); 518f9902a0ff2c4673b3e470026017e858f2992838jackychen 528f9902a0ff2c4673b3e470026017e858f2992838jackychen // sse 538f9902a0ff2c4673b3e470026017e858f2992838jackychen vsse = _mm_add_epi32(vsse, _mm_srli_si128(vsse, 8)); 548f9902a0ff2c4673b3e470026017e858f2992838jackychen vsse = _mm_add_epi32(vsse, _mm_srli_si128(vsse, 4)); 558f9902a0ff2c4673b3e470026017e858f2992838jackychen *sse = _mm_cvtsi128_si32(vsse); 568f9902a0ff2c4673b3e470026017e858f2992838jackychen} 578f9902a0ff2c4673b3e470026017e858f2992838jackychen 588f9902a0ff2c4673b3e470026017e858f2992838jackychenstatic void VarianceSSE2(const unsigned char* src, 598f9902a0ff2c4673b3e470026017e858f2992838jackychen int src_stride, 608f9902a0ff2c4673b3e470026017e858f2992838jackychen const unsigned char* ref, 618f9902a0ff2c4673b3e470026017e858f2992838jackychen int ref_stride, 628f9902a0ff2c4673b3e470026017e858f2992838jackychen int w, 638f9902a0ff2c4673b3e470026017e858f2992838jackychen int h, 648f9902a0ff2c4673b3e470026017e858f2992838jackychen uint32_t* sse, 6567e94fb6f2a84cad97ba96abce3506c29f8ebb24jackychen int64_t* sum, 668f9902a0ff2c4673b3e470026017e858f2992838jackychen int block_size) { 678f9902a0ff2c4673b3e470026017e858f2992838jackychen *sse = 0; 688f9902a0ff2c4673b3e470026017e858f2992838jackychen *sum = 0; 698f9902a0ff2c4673b3e470026017e858f2992838jackychen 708f9902a0ff2c4673b3e470026017e858f2992838jackychen for (int i = 0; i < h; i += block_size) { 718f9902a0ff2c4673b3e470026017e858f2992838jackychen for (int j = 0; j < w; j += block_size) { 728f9902a0ff2c4673b3e470026017e858f2992838jackychen uint32_t sse0 = 0; 738f9902a0ff2c4673b3e470026017e858f2992838jackychen int32_t sum0 = 0; 748f9902a0ff2c4673b3e470026017e858f2992838jackychen 758f9902a0ff2c4673b3e470026017e858f2992838jackychen Get8x8varSse2(src + src_stride * i + j, src_stride, 768f9902a0ff2c4673b3e470026017e858f2992838jackychen ref + ref_stride * i + j, ref_stride, &sse0, &sum0); 778f9902a0ff2c4673b3e470026017e858f2992838jackychen *sse += sse0; 788f9902a0ff2c4673b3e470026017e858f2992838jackychen *sum += sum0; 798f9902a0ff2c4673b3e470026017e858f2992838jackychen } 808f9902a0ff2c4673b3e470026017e858f2992838jackychen } 818f9902a0ff2c4673b3e470026017e858f2992838jackychen} 828f9902a0ff2c4673b3e470026017e858f2992838jackychen 838f9902a0ff2c4673b3e470026017e858f2992838jackychen// Compute the sum of all pixel differences of this MB. 848f9902a0ff2c4673b3e470026017e858f2992838jackychenstatic uint32_t AbsSumDiff16x1(__m128i acc_diff) { 858f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i k_1 = _mm_set1_epi16(1); 868f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i acc_diff_lo = 878f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_srai_epi16(_mm_unpacklo_epi8(acc_diff, acc_diff), 8); 888f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i acc_diff_hi = 898f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_srai_epi16(_mm_unpackhi_epi8(acc_diff, acc_diff), 8); 908f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i acc_diff_16 = _mm_add_epi16(acc_diff_lo, acc_diff_hi); 918f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i hg_fe_dc_ba = _mm_madd_epi16(acc_diff_16, k_1); 928f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i hgfe_dcba = 938f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_add_epi32(hg_fe_dc_ba, _mm_srli_si128(hg_fe_dc_ba, 8)); 948f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i hgfedcba = 958f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_add_epi32(hgfe_dcba, _mm_srli_si128(hgfe_dcba, 4)); 968f9902a0ff2c4673b3e470026017e858f2992838jackychen unsigned int sum_diff = abs(_mm_cvtsi128_si32(hgfedcba)); 978f9902a0ff2c4673b3e470026017e858f2992838jackychen 988f9902a0ff2c4673b3e470026017e858f2992838jackychen return sum_diff; 998f9902a0ff2c4673b3e470026017e858f2992838jackychen} 1008f9902a0ff2c4673b3e470026017e858f2992838jackychen 1018f9902a0ff2c4673b3e470026017e858f2992838jackychen// TODO(jackychen): Optimize this function using SSE2. 1028f9902a0ff2c4673b3e470026017e858f2992838jackychenvoid DenoiserFilterSSE2::CopyMem16x16(const uint8_t* src, 1038f9902a0ff2c4673b3e470026017e858f2992838jackychen int src_stride, 1048f9902a0ff2c4673b3e470026017e858f2992838jackychen uint8_t* dst, 1058f9902a0ff2c4673b3e470026017e858f2992838jackychen int dst_stride) { 1068f9902a0ff2c4673b3e470026017e858f2992838jackychen for (int i = 0; i < 16; i++) { 1078f9902a0ff2c4673b3e470026017e858f2992838jackychen memcpy(dst, src, 16); 1088f9902a0ff2c4673b3e470026017e858f2992838jackychen src += src_stride; 1098f9902a0ff2c4673b3e470026017e858f2992838jackychen dst += dst_stride; 1108f9902a0ff2c4673b3e470026017e858f2992838jackychen } 1118f9902a0ff2c4673b3e470026017e858f2992838jackychen} 1128f9902a0ff2c4673b3e470026017e858f2992838jackychen 1138f9902a0ff2c4673b3e470026017e858f2992838jackychen// TODO(jackychen): Optimize this function using SSE2. 1148f9902a0ff2c4673b3e470026017e858f2992838jackychenvoid DenoiserFilterSSE2::CopyMem8x8(const uint8_t* src, 1158f9902a0ff2c4673b3e470026017e858f2992838jackychen int src_stride, 1168f9902a0ff2c4673b3e470026017e858f2992838jackychen uint8_t* dst, 1178f9902a0ff2c4673b3e470026017e858f2992838jackychen int dst_stride) { 1188f9902a0ff2c4673b3e470026017e858f2992838jackychen for (int i = 0; i < 8; i++) { 1198f9902a0ff2c4673b3e470026017e858f2992838jackychen memcpy(dst, src, 8); 1208f9902a0ff2c4673b3e470026017e858f2992838jackychen src += src_stride; 1218f9902a0ff2c4673b3e470026017e858f2992838jackychen dst += dst_stride; 1228f9902a0ff2c4673b3e470026017e858f2992838jackychen } 1238f9902a0ff2c4673b3e470026017e858f2992838jackychen} 1248f9902a0ff2c4673b3e470026017e858f2992838jackychen 1258f9902a0ff2c4673b3e470026017e858f2992838jackychenuint32_t DenoiserFilterSSE2::Variance16x8(const uint8_t* src, 1268f9902a0ff2c4673b3e470026017e858f2992838jackychen int src_stride, 1278f9902a0ff2c4673b3e470026017e858f2992838jackychen const uint8_t* ref, 1288f9902a0ff2c4673b3e470026017e858f2992838jackychen int ref_stride, 12967e94fb6f2a84cad97ba96abce3506c29f8ebb24jackychen uint32_t* sse) { 13067e94fb6f2a84cad97ba96abce3506c29f8ebb24jackychen int64_t sum = 0; 13167e94fb6f2a84cad97ba96abce3506c29f8ebb24jackychen VarianceSSE2(src, src_stride << 1, ref, ref_stride << 1, 16, 8, sse, &sum, 8); 1328f9902a0ff2c4673b3e470026017e858f2992838jackychen return *sse - ((sum * sum) >> 7); 1338f9902a0ff2c4673b3e470026017e858f2992838jackychen} 1348f9902a0ff2c4673b3e470026017e858f2992838jackychen 1358f9902a0ff2c4673b3e470026017e858f2992838jackychenDenoiserDecision DenoiserFilterSSE2::MbDenoise(uint8_t* mc_running_avg_y, 1368f9902a0ff2c4673b3e470026017e858f2992838jackychen int mc_avg_y_stride, 1378f9902a0ff2c4673b3e470026017e858f2992838jackychen uint8_t* running_avg_y, 1388f9902a0ff2c4673b3e470026017e858f2992838jackychen int avg_y_stride, 1398f9902a0ff2c4673b3e470026017e858f2992838jackychen const uint8_t* sig, 1408f9902a0ff2c4673b3e470026017e858f2992838jackychen int sig_stride, 1418f9902a0ff2c4673b3e470026017e858f2992838jackychen uint8_t motion_magnitude, 1428f9902a0ff2c4673b3e470026017e858f2992838jackychen int increase_denoising) { 1438f9902a0ff2c4673b3e470026017e858f2992838jackychen int shift_inc = 14499ab9447d1b48043adf6bfdf72cf820bbda3ee3fmflodman (increase_denoising && motion_magnitude <= kMotionMagnitudeThreshold) ? 1 14599ab9447d1b48043adf6bfdf72cf820bbda3ee3fmflodman : 0; 1468f9902a0ff2c4673b3e470026017e858f2992838jackychen __m128i acc_diff = _mm_setzero_si128(); 1478f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i k_0 = _mm_setzero_si128(); 1488f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i k_4 = _mm_set1_epi8(4 + shift_inc); 1498f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i k_8 = _mm_set1_epi8(8); 1508f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i k_16 = _mm_set1_epi8(16); 1518f9902a0ff2c4673b3e470026017e858f2992838jackychen // Modify each level's adjustment according to motion_magnitude. 1528f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i l3 = _mm_set1_epi8( 1538f9902a0ff2c4673b3e470026017e858f2992838jackychen (motion_magnitude <= kMotionMagnitudeThreshold) ? 7 + shift_inc : 6); 1548f9902a0ff2c4673b3e470026017e858f2992838jackychen // Difference between level 3 and level 2 is 2. 1558f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i l32 = _mm_set1_epi8(2); 1568f9902a0ff2c4673b3e470026017e858f2992838jackychen // Difference between level 2 and level 1 is 1. 1578f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i l21 = _mm_set1_epi8(1); 1588f9902a0ff2c4673b3e470026017e858f2992838jackychen 1598f9902a0ff2c4673b3e470026017e858f2992838jackychen for (int r = 0; r < 16; ++r) { 1608f9902a0ff2c4673b3e470026017e858f2992838jackychen // Calculate differences. 1618f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i v_sig = 1628f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_loadu_si128(reinterpret_cast<const __m128i*>(&sig[0])); 1638f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i v_mc_running_avg_y = 1648f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_loadu_si128(reinterpret_cast<__m128i*>(&mc_running_avg_y[0])); 1658f9902a0ff2c4673b3e470026017e858f2992838jackychen __m128i v_running_avg_y; 1668f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i pdiff = _mm_subs_epu8(v_mc_running_avg_y, v_sig); 1678f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i ndiff = _mm_subs_epu8(v_sig, v_mc_running_avg_y); 1688f9902a0ff2c4673b3e470026017e858f2992838jackychen // Obtain the sign. FF if diff is negative. 1698f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i diff_sign = _mm_cmpeq_epi8(pdiff, k_0); 1708f9902a0ff2c4673b3e470026017e858f2992838jackychen // Clamp absolute difference to 16 to be used to get mask. Doing this 1718f9902a0ff2c4673b3e470026017e858f2992838jackychen // allows us to use _mm_cmpgt_epi8, which operates on signed byte. 1728f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i clamped_absdiff = 1738f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_min_epu8(_mm_or_si128(pdiff, ndiff), k_16); 1748f9902a0ff2c4673b3e470026017e858f2992838jackychen // Get masks for l2 l1 and l0 adjustments. 1758f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i mask2 = _mm_cmpgt_epi8(k_16, clamped_absdiff); 1768f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i mask1 = _mm_cmpgt_epi8(k_8, clamped_absdiff); 1778f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i mask0 = _mm_cmpgt_epi8(k_4, clamped_absdiff); 1788f9902a0ff2c4673b3e470026017e858f2992838jackychen // Get adjustments for l2, l1, and l0. 1798f9902a0ff2c4673b3e470026017e858f2992838jackychen __m128i adj2 = _mm_and_si128(mask2, l32); 1808f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i adj1 = _mm_and_si128(mask1, l21); 1818f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i adj0 = _mm_and_si128(mask0, clamped_absdiff); 1828f9902a0ff2c4673b3e470026017e858f2992838jackychen __m128i adj, padj, nadj; 1838f9902a0ff2c4673b3e470026017e858f2992838jackychen 1848f9902a0ff2c4673b3e470026017e858f2992838jackychen // Combine the adjustments and get absolute adjustments. 1858f9902a0ff2c4673b3e470026017e858f2992838jackychen adj2 = _mm_add_epi8(adj2, adj1); 1868f9902a0ff2c4673b3e470026017e858f2992838jackychen adj = _mm_sub_epi8(l3, adj2); 1878f9902a0ff2c4673b3e470026017e858f2992838jackychen adj = _mm_andnot_si128(mask0, adj); 1888f9902a0ff2c4673b3e470026017e858f2992838jackychen adj = _mm_or_si128(adj, adj0); 1898f9902a0ff2c4673b3e470026017e858f2992838jackychen 1908f9902a0ff2c4673b3e470026017e858f2992838jackychen // Restore the sign and get positive and negative adjustments. 1918f9902a0ff2c4673b3e470026017e858f2992838jackychen padj = _mm_andnot_si128(diff_sign, adj); 1928f9902a0ff2c4673b3e470026017e858f2992838jackychen nadj = _mm_and_si128(diff_sign, adj); 1938f9902a0ff2c4673b3e470026017e858f2992838jackychen 1948f9902a0ff2c4673b3e470026017e858f2992838jackychen // Calculate filtered value. 1958f9902a0ff2c4673b3e470026017e858f2992838jackychen v_running_avg_y = _mm_adds_epu8(v_sig, padj); 1968f9902a0ff2c4673b3e470026017e858f2992838jackychen v_running_avg_y = _mm_subs_epu8(v_running_avg_y, nadj); 1978f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_storeu_si128(reinterpret_cast<__m128i*>(running_avg_y), 1988f9902a0ff2c4673b3e470026017e858f2992838jackychen v_running_avg_y); 1998f9902a0ff2c4673b3e470026017e858f2992838jackychen 2008f9902a0ff2c4673b3e470026017e858f2992838jackychen // Adjustments <=7, and each element in acc_diff can fit in signed 2018f9902a0ff2c4673b3e470026017e858f2992838jackychen // char. 2028f9902a0ff2c4673b3e470026017e858f2992838jackychen acc_diff = _mm_adds_epi8(acc_diff, padj); 2038f9902a0ff2c4673b3e470026017e858f2992838jackychen acc_diff = _mm_subs_epi8(acc_diff, nadj); 2048f9902a0ff2c4673b3e470026017e858f2992838jackychen 2058f9902a0ff2c4673b3e470026017e858f2992838jackychen // Update pointers for next iteration. 2068f9902a0ff2c4673b3e470026017e858f2992838jackychen sig += sig_stride; 2078f9902a0ff2c4673b3e470026017e858f2992838jackychen mc_running_avg_y += mc_avg_y_stride; 2088f9902a0ff2c4673b3e470026017e858f2992838jackychen running_avg_y += avg_y_stride; 2098f9902a0ff2c4673b3e470026017e858f2992838jackychen } 2108f9902a0ff2c4673b3e470026017e858f2992838jackychen 2118f9902a0ff2c4673b3e470026017e858f2992838jackychen { 2128f9902a0ff2c4673b3e470026017e858f2992838jackychen // Compute the sum of all pixel differences of this MB. 2138f9902a0ff2c4673b3e470026017e858f2992838jackychen unsigned int abs_sum_diff = AbsSumDiff16x1(acc_diff); 2148f9902a0ff2c4673b3e470026017e858f2992838jackychen unsigned int sum_diff_thresh = kSumDiffThreshold; 2158f9902a0ff2c4673b3e470026017e858f2992838jackychen if (increase_denoising) 2168f9902a0ff2c4673b3e470026017e858f2992838jackychen sum_diff_thresh = kSumDiffThresholdHigh; 2178f9902a0ff2c4673b3e470026017e858f2992838jackychen if (abs_sum_diff > sum_diff_thresh) { 2188f9902a0ff2c4673b3e470026017e858f2992838jackychen // Before returning to copy the block (i.e., apply no denoising), 2198f9902a0ff2c4673b3e470026017e858f2992838jackychen // check if we can still apply some (weaker) temporal filtering to 2208f9902a0ff2c4673b3e470026017e858f2992838jackychen // this block, that would otherwise not be denoised at all. Simplest 2218f9902a0ff2c4673b3e470026017e858f2992838jackychen // is to apply an additional adjustment to running_avg_y to bring it 2228f9902a0ff2c4673b3e470026017e858f2992838jackychen // closer to sig. The adjustment is capped by a maximum delta, and 2238f9902a0ff2c4673b3e470026017e858f2992838jackychen // chosen such that in most cases the resulting sum_diff will be 2248f9902a0ff2c4673b3e470026017e858f2992838jackychen // within the acceptable range given by sum_diff_thresh. 2258f9902a0ff2c4673b3e470026017e858f2992838jackychen 2268f9902a0ff2c4673b3e470026017e858f2992838jackychen // The delta is set by the excess of absolute pixel diff over the 2278f9902a0ff2c4673b3e470026017e858f2992838jackychen // threshold. 2288f9902a0ff2c4673b3e470026017e858f2992838jackychen int delta = ((abs_sum_diff - sum_diff_thresh) >> 8) + 1; 2298f9902a0ff2c4673b3e470026017e858f2992838jackychen // Only apply the adjustment for max delta up to 3. 2308f9902a0ff2c4673b3e470026017e858f2992838jackychen if (delta < 4) { 2318f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i k_delta = _mm_set1_epi8(delta); 2328f9902a0ff2c4673b3e470026017e858f2992838jackychen sig -= sig_stride * 16; 2338f9902a0ff2c4673b3e470026017e858f2992838jackychen mc_running_avg_y -= mc_avg_y_stride * 16; 2348f9902a0ff2c4673b3e470026017e858f2992838jackychen running_avg_y -= avg_y_stride * 16; 2358f9902a0ff2c4673b3e470026017e858f2992838jackychen for (int r = 0; r < 16; ++r) { 2368f9902a0ff2c4673b3e470026017e858f2992838jackychen __m128i v_running_avg_y = 2378f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_loadu_si128(reinterpret_cast<__m128i*>(&running_avg_y[0])); 2388f9902a0ff2c4673b3e470026017e858f2992838jackychen // Calculate differences. 2398f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i v_sig = 2408f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_loadu_si128(reinterpret_cast<const __m128i*>(&sig[0])); 24199ab9447d1b48043adf6bfdf72cf820bbda3ee3fmflodman const __m128i v_mc_running_avg_y = 24299ab9447d1b48043adf6bfdf72cf820bbda3ee3fmflodman _mm_loadu_si128(reinterpret_cast<__m128i*>(&mc_running_avg_y[0])); 2438f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i pdiff = _mm_subs_epu8(v_mc_running_avg_y, v_sig); 2448f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i ndiff = _mm_subs_epu8(v_sig, v_mc_running_avg_y); 2458f9902a0ff2c4673b3e470026017e858f2992838jackychen // Obtain the sign. FF if diff is negative. 2468f9902a0ff2c4673b3e470026017e858f2992838jackychen const __m128i diff_sign = _mm_cmpeq_epi8(pdiff, k_0); 2478f9902a0ff2c4673b3e470026017e858f2992838jackychen // Clamp absolute difference to delta to get the adjustment. 24899ab9447d1b48043adf6bfdf72cf820bbda3ee3fmflodman const __m128i adj = _mm_min_epu8(_mm_or_si128(pdiff, ndiff), k_delta); 2498f9902a0ff2c4673b3e470026017e858f2992838jackychen // Restore the sign and get positive and negative adjustments. 2508f9902a0ff2c4673b3e470026017e858f2992838jackychen __m128i padj, nadj; 2518f9902a0ff2c4673b3e470026017e858f2992838jackychen padj = _mm_andnot_si128(diff_sign, adj); 2528f9902a0ff2c4673b3e470026017e858f2992838jackychen nadj = _mm_and_si128(diff_sign, adj); 2538f9902a0ff2c4673b3e470026017e858f2992838jackychen // Calculate filtered value. 2548f9902a0ff2c4673b3e470026017e858f2992838jackychen v_running_avg_y = _mm_subs_epu8(v_running_avg_y, padj); 2558f9902a0ff2c4673b3e470026017e858f2992838jackychen v_running_avg_y = _mm_adds_epu8(v_running_avg_y, nadj); 2568f9902a0ff2c4673b3e470026017e858f2992838jackychen _mm_storeu_si128(reinterpret_cast<__m128i*>(running_avg_y), 2578f9902a0ff2c4673b3e470026017e858f2992838jackychen v_running_avg_y); 2588f9902a0ff2c4673b3e470026017e858f2992838jackychen 2598f9902a0ff2c4673b3e470026017e858f2992838jackychen // Accumulate the adjustments. 2608f9902a0ff2c4673b3e470026017e858f2992838jackychen acc_diff = _mm_subs_epi8(acc_diff, padj); 2618f9902a0ff2c4673b3e470026017e858f2992838jackychen acc_diff = _mm_adds_epi8(acc_diff, nadj); 2628f9902a0ff2c4673b3e470026017e858f2992838jackychen 2638f9902a0ff2c4673b3e470026017e858f2992838jackychen // Update pointers for next iteration. 2648f9902a0ff2c4673b3e470026017e858f2992838jackychen sig += sig_stride; 2658f9902a0ff2c4673b3e470026017e858f2992838jackychen mc_running_avg_y += mc_avg_y_stride; 2668f9902a0ff2c4673b3e470026017e858f2992838jackychen running_avg_y += avg_y_stride; 2678f9902a0ff2c4673b3e470026017e858f2992838jackychen } 2688f9902a0ff2c4673b3e470026017e858f2992838jackychen abs_sum_diff = AbsSumDiff16x1(acc_diff); 2698f9902a0ff2c4673b3e470026017e858f2992838jackychen if (abs_sum_diff > sum_diff_thresh) { 2708f9902a0ff2c4673b3e470026017e858f2992838jackychen return COPY_BLOCK; 2718f9902a0ff2c4673b3e470026017e858f2992838jackychen } 2728f9902a0ff2c4673b3e470026017e858f2992838jackychen } else { 2738f9902a0ff2c4673b3e470026017e858f2992838jackychen return COPY_BLOCK; 2748f9902a0ff2c4673b3e470026017e858f2992838jackychen } 2758f9902a0ff2c4673b3e470026017e858f2992838jackychen } 2768f9902a0ff2c4673b3e470026017e858f2992838jackychen } 2778f9902a0ff2c4673b3e470026017e858f2992838jackychen return FILTER_BLOCK; 2788f9902a0ff2c4673b3e470026017e858f2992838jackychen} 2798f9902a0ff2c4673b3e470026017e858f2992838jackychen 2808f9902a0ff2c4673b3e470026017e858f2992838jackychen} // namespace webrtc 281