From 1f63ab85facb36dafc2ecd17f496c18850241c25 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Fl=C3=B6ssie?= <floessie.mail@gmail.com>
Date: Thu, 30 Jun 2016 18:18:13 +0200
Subject: [PATCH] Vectorize 49 and 81 in ImProcFunctions::Median_Denoise()
 (#3346)

---
 rtengine/FTblockDN.cc | 34 ++++++++++++++++++++++++++++------
 1 file changed, 28 insertions(+), 6 deletions(-)

diff --git a/rtengine/FTblockDN.cc b/rtengine/FTblockDN.cc
index 44b86d0b8..1097d5a0f 100644
--- a/rtengine/FTblockDN.cc
+++ b/rtengine/FTblockDN.cc
@@ -376,10 +376,21 @@ void ImProcFunctions::Median_Denoise( float **src, float **dst, const int width,
                     medianOut[i][j] = medianIn[i][j];
                 }
 
-                for (; j < width - border; ++j) {
-                    int kk = 0;
+#ifdef __SSE2__
+                std::array<vfloat, 49> vpp ALIGNED16;
+                for (; j < width - border - 3; j += 4) {
+                    for (int kk = 0, ii = -border; ii <= border; ++ii) {
+                        for (int jj = -border; jj <= border; ++jj, ++kk) {
+                            vpp[kk] = LVFU(medianIn[i + ii][j + jj]);
+                        }
+                    }
 
-                    for (int ii = -border; ii <= border; ++ii) {
+                    STVFU(medianOut[i][j], median(vpp));
+                }
+#endif
+
+                for (; j < width - border; ++j) {
+                    for (int kk = 0, ii = -border; ii <= border; ++ii) {
                         for (int jj = -border; jj <= border; ++jj, ++kk) {
                             pp[kk] = medianIn[i + ii][j + jj];
                         }
@@ -399,10 +410,21 @@ void ImProcFunctions::Median_Denoise( float **src, float **dst, const int width,
                     medianOut[i][j] = medianIn[i][j];
                 }
 
-                for (; j < width - border; ++j) {
-                    int kk = 0;
+#ifdef __SSE2__
+                std::array<vfloat, 81> vpp ALIGNED16;
+                for (; j < width - border - 3; j += 4) {
+                    for (int kk = 0, ii = -border; ii <= border; ++ii) {
+                        for (int jj = -border; jj <= border; ++jj, ++kk) {
+                            vpp[kk] = LVFU(medianIn[i + ii][j + jj]);
+                        }
+                    }
 
-                    for (int ii = -border; ii <= border; ++ii) {
+                    STVFU(medianOut[i][j], median(vpp));
+                }
+#endif
+
+                for (; j < width - border; ++j) {
+                    for (int kk = 0, ii = -border; ii <= border; ++ii) {
                         for (int jj = -border; jj <= border; ++jj, ++kk) {
                             pp[kk] = medianIn[i + ii][j + jj];
                         }