1 /*
2 * Copyright (c) 2015 The WebRTC project authors. All Rights Reserved.
3 *
4 * Use of this source code is governed by a BSD-style license
5 * that can be found in the LICENSE file in the root of the source
6 * tree. An additional intellectual property rights grant can be found
7 * in the file PATENTS. All contributing project authors may
8 * be found in the AUTHORS file in the root of the source tree.
9 */
10
11 #include "modules/video_processing/util/denoiser_filter_sse2.h"
12
13 #include <emmintrin.h>
14 #include <stdlib.h>
15 #include <string.h>
16
17 namespace webrtc {
18
Get8x8varSse2(const uint8_t * src,int src_stride,const uint8_t * ref,int ref_stride,unsigned int * sse,int * sum)19 static void Get8x8varSse2(const uint8_t* src,
20 int src_stride,
21 const uint8_t* ref,
22 int ref_stride,
23 unsigned int* sse,
24 int* sum) {
25 const __m128i zero = _mm_setzero_si128();
26 __m128i vsum = _mm_setzero_si128();
27 __m128i vsse = _mm_setzero_si128();
28
29 for (int i = 0; i < 8; i += 2) {
30 const __m128i src0 = _mm_unpacklo_epi8(
31 _mm_loadl_epi64((const __m128i*)(src + i * src_stride)), zero);
32 const __m128i ref0 = _mm_unpacklo_epi8(
33 _mm_loadl_epi64((const __m128i*)(ref + i * ref_stride)), zero);
34 const __m128i diff0 = _mm_sub_epi16(src0, ref0);
35
36 const __m128i src1 = _mm_unpacklo_epi8(
37 _mm_loadl_epi64((const __m128i*)(src + (i + 1) * src_stride)), zero);
38 const __m128i ref1 = _mm_unpacklo_epi8(
39 _mm_loadl_epi64((const __m128i*)(ref + (i + 1) * ref_stride)), zero);
40 const __m128i diff1 = _mm_sub_epi16(src1, ref1);
41
42 vsum = _mm_add_epi16(vsum, diff0);
43 vsum = _mm_add_epi16(vsum, diff1);
44 vsse = _mm_add_epi32(vsse, _mm_madd_epi16(diff0, diff0));
45 vsse = _mm_add_epi32(vsse, _mm_madd_epi16(diff1, diff1));
46 }
47
48 // sum
49 vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 8));
50 vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 4));
51 vsum = _mm_add_epi16(vsum, _mm_srli_si128(vsum, 2));
52 *sum = static_cast<int16_t>(_mm_extract_epi16(vsum, 0));
53
54 // sse
55 vsse = _mm_add_epi32(vsse, _mm_srli_si128(vsse, 8));
56 vsse = _mm_add_epi32(vsse, _mm_srli_si128(vsse, 4));
57 *sse = _mm_cvtsi128_si32(vsse);
58 }
59
VarianceSSE2(const unsigned char * src,int src_stride,const unsigned char * ref,int ref_stride,int w,int h,uint32_t * sse,int64_t * sum,int block_size)60 static void VarianceSSE2(const unsigned char* src,
61 int src_stride,
62 const unsigned char* ref,
63 int ref_stride,
64 int w,
65 int h,
66 uint32_t* sse,
67 int64_t* sum,
68 int block_size) {
69 *sse = 0;
70 *sum = 0;
71
72 for (int i = 0; i < h; i += block_size) {
73 for (int j = 0; j < w; j += block_size) {
74 uint32_t sse0 = 0;
75 int32_t sum0 = 0;
76
77 Get8x8varSse2(src + src_stride * i + j, src_stride,
78 ref + ref_stride * i + j, ref_stride, &sse0, &sum0);
79 *sse += sse0;
80 *sum += sum0;
81 }
82 }
83 }
84
85 // Compute the sum of all pixel differences of this MB.
AbsSumDiff16x1(__m128i acc_diff)86 static uint32_t AbsSumDiff16x1(__m128i acc_diff) {
87 const __m128i k_1 = _mm_set1_epi16(1);
88 const __m128i acc_diff_lo =
89 _mm_srai_epi16(_mm_unpacklo_epi8(acc_diff, acc_diff), 8);
90 const __m128i acc_diff_hi =
91 _mm_srai_epi16(_mm_unpackhi_epi8(acc_diff, acc_diff), 8);
92 const __m128i acc_diff_16 = _mm_add_epi16(acc_diff_lo, acc_diff_hi);
93 const __m128i hg_fe_dc_ba = _mm_madd_epi16(acc_diff_16, k_1);
94 const __m128i hgfe_dcba =
95 _mm_add_epi32(hg_fe_dc_ba, _mm_srli_si128(hg_fe_dc_ba, 8));
96 const __m128i hgfedcba =
97 _mm_add_epi32(hgfe_dcba, _mm_srli_si128(hgfe_dcba, 4));
98 unsigned int sum_diff = abs(_mm_cvtsi128_si32(hgfedcba));
99
100 return sum_diff;
101 }
102
103 // TODO(jackychen): Optimize this function using SSE2.
CopyMem16x16(const uint8_t * src,int src_stride,uint8_t * dst,int dst_stride)104 void DenoiserFilterSSE2::CopyMem16x16(const uint8_t* src,
105 int src_stride,
106 uint8_t* dst,
107 int dst_stride) {
108 for (int i = 0; i < 16; i++) {
109 memcpy(dst, src, 16);
110 src += src_stride;
111 dst += dst_stride;
112 }
113 }
114
Variance16x8(const uint8_t * src,int src_stride,const uint8_t * ref,int ref_stride,uint32_t * sse)115 uint32_t DenoiserFilterSSE2::Variance16x8(const uint8_t* src,
116 int src_stride,
117 const uint8_t* ref,
118 int ref_stride,
119 uint32_t* sse) {
120 int64_t sum = 0;
121 VarianceSSE2(src, src_stride << 1, ref, ref_stride << 1, 16, 8, sse, &sum, 8);
122 return *sse - ((sum * sum) >> 7);
123 }
124
MbDenoise(const uint8_t * mc_running_avg_y,int mc_avg_y_stride,uint8_t * running_avg_y,int avg_y_stride,const uint8_t * sig,int sig_stride,uint8_t motion_magnitude,int increase_denoising)125 DenoiserDecision DenoiserFilterSSE2::MbDenoise(const uint8_t* mc_running_avg_y,
126 int mc_avg_y_stride,
127 uint8_t* running_avg_y,
128 int avg_y_stride,
129 const uint8_t* sig,
130 int sig_stride,
131 uint8_t motion_magnitude,
132 int increase_denoising) {
133 DenoiserDecision decision = FILTER_BLOCK;
134 unsigned int sum_diff_thresh = 0;
135 int shift_inc =
136 (increase_denoising && motion_magnitude <= kMotionMagnitudeThreshold) ? 1
137 : 0;
138 __m128i acc_diff = _mm_setzero_si128();
139 const __m128i k_0 = _mm_setzero_si128();
140 const __m128i k_4 = _mm_set1_epi8(4 + shift_inc);
141 const __m128i k_8 = _mm_set1_epi8(8);
142 const __m128i k_16 = _mm_set1_epi8(16);
143 // Modify each level's adjustment according to motion_magnitude.
144 const __m128i l3 = _mm_set1_epi8(
145 (motion_magnitude <= kMotionMagnitudeThreshold) ? 7 + shift_inc : 6);
146 // Difference between level 3 and level 2 is 2.
147 const __m128i l32 = _mm_set1_epi8(2);
148 // Difference between level 2 and level 1 is 1.
149 const __m128i l21 = _mm_set1_epi8(1);
150
151 for (int r = 0; r < 16; ++r) {
152 // Calculate differences.
153 const __m128i v_sig =
154 _mm_loadu_si128(reinterpret_cast<const __m128i*>(&sig[0]));
155 const __m128i v_mc_running_avg_y =
156 _mm_loadu_si128(reinterpret_cast<const __m128i*>(&mc_running_avg_y[0]));
157 __m128i v_running_avg_y;
158 const __m128i pdiff = _mm_subs_epu8(v_mc_running_avg_y, v_sig);
159 const __m128i ndiff = _mm_subs_epu8(v_sig, v_mc_running_avg_y);
160 // Obtain the sign. FF if diff is negative.
161 const __m128i diff_sign = _mm_cmpeq_epi8(pdiff, k_0);
162 // Clamp absolute difference to 16 to be used to get mask. Doing this
163 // allows us to use _mm_cmpgt_epi8, which operates on signed byte.
164 const __m128i clamped_absdiff =
165 _mm_min_epu8(_mm_or_si128(pdiff, ndiff), k_16);
166 // Get masks for l2 l1 and l0 adjustments.
167 const __m128i mask2 = _mm_cmpgt_epi8(k_16, clamped_absdiff);
168 const __m128i mask1 = _mm_cmpgt_epi8(k_8, clamped_absdiff);
169 const __m128i mask0 = _mm_cmpgt_epi8(k_4, clamped_absdiff);
170 // Get adjustments for l2, l1, and l0.
171 __m128i adj2 = _mm_and_si128(mask2, l32);
172 const __m128i adj1 = _mm_and_si128(mask1, l21);
173 const __m128i adj0 = _mm_and_si128(mask0, clamped_absdiff);
174 __m128i adj, padj, nadj;
175
176 // Combine the adjustments and get absolute adjustments.
177 adj2 = _mm_add_epi8(adj2, adj1);
178 adj = _mm_sub_epi8(l3, adj2);
179 adj = _mm_andnot_si128(mask0, adj);
180 adj = _mm_or_si128(adj, adj0);
181
182 // Restore the sign and get positive and negative adjustments.
183 padj = _mm_andnot_si128(diff_sign, adj);
184 nadj = _mm_and_si128(diff_sign, adj);
185
186 // Calculate filtered value.
187 v_running_avg_y = _mm_adds_epu8(v_sig, padj);
188 v_running_avg_y = _mm_subs_epu8(v_running_avg_y, nadj);
189 _mm_storeu_si128(reinterpret_cast<__m128i*>(running_avg_y),
190 v_running_avg_y);
191
192 // Adjustments <=7, and each element in acc_diff can fit in signed
193 // char.
194 acc_diff = _mm_adds_epi8(acc_diff, padj);
195 acc_diff = _mm_subs_epi8(acc_diff, nadj);
196
197 // Update pointers for next iteration.
198 sig += sig_stride;
199 mc_running_avg_y += mc_avg_y_stride;
200 running_avg_y += avg_y_stride;
201 }
202
203 // Compute the sum of all pixel differences of this MB.
204 unsigned int abs_sum_diff = AbsSumDiff16x1(acc_diff);
205 sum_diff_thresh =
206 increase_denoising ? kSumDiffThresholdHigh : kSumDiffThreshold;
207 if (abs_sum_diff > sum_diff_thresh)
208 decision = COPY_BLOCK;
209 return decision;
210 }
211
212 } // namespace webrtc
213