added dft for CCORR
authorElena Gvozdeva <elena.gvozdeva@itseez.com>
Thu, 5 Jun 2014 13:21:25 +0000 (17:21 +0400)
committerElena Gvozdeva <elena.gvozdeva@itseez.com>
Tue, 17 Jun 2014 13:09:38 +0000 (17:09 +0400)
modules/imgproc/src/opencl/match_template.cl
modules/imgproc/src/templmatch.cpp

index cb76bc0..efc7922 100644 (file)
 // or tort (including negligence or otherwise) arising in any way out of
 // the use of this software, even if advised of the possibility of such damage.
 
-#define DATA_SIZE ((int)sizeof(type))
-#define ELEM_TYPE elem_type
-#define ELEM_SIZE ((int)sizeof(elem_type))
-
 #define SQSUMS_PTR(ox, oy) mad24(y + oy, src_sqsums_step, mad24(x + ox, cn, src_sqsums_offset))
 #define SUMS_PTR(ox, oy) mad24(y + oy, src_sums_step, mad24(x + ox, cn, src_sums_offset))
 #define SUMS(ox, oy)    mad24(y+oy, src_sums_step, mad24(x+ox, (int)sizeof(T1)*cn, src_sums_offset))
@@ -123,6 +119,26 @@ __kernel void calcSum(__global const uchar * srcptr, int src_step, int src_offse
         dst[0] = convertToDT(localmem[0]);
 }
 
+#elif defined FIRST_CHANNEL
+
+__kernel void extractFirstChannel( const __global uchar* img, int img_step, int img_offset,
+                                   __global uchar* res, int res_step, int res_offset, int rows, int cols)
+{
+    int x = get_global_id(0);
+    int y = get_global_id(1)*PIX_PER_WI_Y;
+
+    if(x < cols )
+    {
+        #pragma unroll
+        for (int cy=0; cy < PIX_PER_WI_Y && y < rows; ++cy, ++y)
+        {
+            T1 image = *(__global const T1*)(img + mad24(y, img_step, mad24(x, (int)sizeof(T1)*cn, img_offset)));;
+            int res_idx = mad24(y, res_step, mad24(x, (int)sizeof(float), res_offset));
+            *(__global float *)(res + res_idx) = image;
+        }
+    }
+}
+
 #elif defined CCORR
 
 #if cn==3
@@ -291,6 +307,32 @@ __kernel void matchTemplate_Naive_SQDIFF(__global const uchar * srcptr, int src_
 
 #endif
 
+#elif defined SQDIFF_PREPARED
+
+__kernel void matchTemplate_Prepared_SQDIFF(__global const uchar * src_sqsums, int src_sqsums_step, int src_sqsums_offset,
+                                            __global uchar * dst, int dst_step, int dst_offset, int dst_rows, int dst_cols,
+                                            int template_rows, int template_cols, __global const float * template_sqsum)
+{
+    int x = get_global_id(0);
+    int y = get_global_id(1);
+
+    if (x < dst_cols && y < dst_rows)
+    {
+        src_sqsums_step /= sizeof(float);
+        src_sqsums_offset /= sizeof(float);
+
+        __global const float * sqsum = (__global const float *)(src_sqsums);
+        float image_sqsum_ = (float)(
+                                 (sqsum[SQSUMS_PTR(template_cols, template_rows)] - sqsum[SQSUMS_PTR(template_cols, 0)]) -
+                                 (sqsum[SQSUMS_PTR(0, template_rows)] - sqsum[SQSUMS_PTR(0, 0)]));
+        float template_sqsum_value = template_sqsum[0];
+
+        int dst_idx = mad24(y, dst_step, mad24(x, (int)sizeof(float), dst_offset));
+        __global float * dstult = (__global float *)(dst + dst_idx);
+        *dstult = image_sqsum_ - 2.0f * dstult[0] + template_sqsum_value;
+    }
+}
+
 #elif defined SQDIFF_NORMED
 
 __kernel void matchTemplate_SQDIFF_NORMED(__global const uchar * src_sqsums, int src_sqsums_step, int src_sqsums_offset,
@@ -330,14 +372,15 @@ __kernel void matchTemplate_Prepared_CCOEFF(__global const uchar * src_sums, int
 
     if (x < dst_cols && y < dst_rows)
     {
+        __global const T* sum = (__global const T*)(src_sums + mad24(y, src_sums_step, mad24(x, (int)sizeof(T), src_sums_offset)));
+
+        int step = src_sums_step/(int)sizeof(T);
+
         T image_sum = (T)(0), value;
 
-        value  = *(__global const T1 *)(src_sums + SUMS(template_cols, template_rows));
-        value -= *(__global const T1 *)(src_sums + SUMS(0, template_rows));
-        value -= *(__global const T1 *)(src_sums + SUMS(template_cols, 0));
-        value += *(__global const T1 *)(src_sums + SUMS(0, 0));
+        value = (T)(sum[mad24(template_rows, step, template_cols)] - sum[mad24(template_rows, step, 0)] - sum[template_cols] + sum[0]);
 
-        image_sum = mad(value, template_sum, 0);
+        image_sum = mad(value, template_sum , image_sum);
 
         int dst_idx = mad24(y, dst_step, mad24(x, (int)sizeof(float), dst_offset));
         *(__global float *)(dst + dst_idx) -= convertToDT(image_sum);
index 35a4757..c89b9fd 100644 (file)
@@ -56,6 +56,25 @@ enum
     SUM_1 = 0, SUM_2 = 1
 };
 
+static bool extractFirstChannel_32F(InputArray _image, OutputArray _result, int cn)
+{
+    UMat image  = _image.getUMat();
+    UMat result = _result.getUMat();
+
+    int depth = image.depth();
+
+    ocl::Device dev = ocl::Device::getDefault();
+    int pxPerWIy = (dev.isIntel() && (dev.type() & ocl::Device::TYPE_GPU)) ? 4 : 1;
+
+    ocl::Kernel k("extractFirstChannel", ocl::imgproc::match_template_oclsrc, format("-D FIRST_CHANNEL -D T1=%s -D cn=%d -D PIX_PER_WI_Y=%d",
+                                                                            ocl::typeToStr(depth), cn, pxPerWIy));
+    if (k.empty())
+        return false;
+
+    size_t globalsize[2] = {result.cols, (result.rows+pxPerWIy-1)/pxPerWIy};
+    return k.args(ocl::KernelArg::ReadOnlyNoSize(image), ocl::KernelArg::WriteOnly(result)).run( 2, globalsize, NULL, false);
+}
+
 static bool sumTemplate(InputArray _src, UMat & result)
 {
     int type = _src.type(), depth = CV_MAT_DEPTH(type), cn = CV_MAT_CN(type);
@@ -88,6 +107,160 @@ static bool sumTemplate(InputArray _src, UMat & result)
     return k.run(1, &globalsize, &wgs, false);
 }
 
+static bool useNaive(int method, int depth, Size size)
+{
+/*            if (method == TM_SQDIFF && (depth == CV_32F))
+            {
+                return true;
+            }
+            else*/ if(method == TM_CCORR || method == TM_SQDIFF )
+            {
+                return size.height < 18 && size.width < 18;
+            }
+            else
+                return false;
+}
+
+struct ConvolveBuf
+        {
+            Size result_size;
+            Size block_size;
+            Size user_block_size;
+            Size dft_size;
+
+            UMat image_spect, templ_spect, result_spect;
+            UMat image_block, templ_block, result_data;
+
+            void create(Size image_size, Size templ_size);
+            static Size estimateBlockSize(Size result_size, Size templ_size);
+        };
+
+void ConvolveBuf::create(Size image_size, Size templ_size)
+{
+    result_size = Size(image_size.width - templ_size.width + 1,
+                       image_size.height - templ_size.height + 1);
+
+    block_size = user_block_size;
+    if (user_block_size.width == 0 || user_block_size.height == 0)
+        block_size = estimateBlockSize(result_size, templ_size);
+
+    dft_size.width  = 1 << int(ceil(std::log(block_size.width + templ_size.width - 1.) / std::log(2.)));
+    dft_size.height = 1 << int(ceil(std::log(block_size.height + templ_size.height - 1.) / std::log(2.)));
+
+    dft_size.width = getOptimalDFTSize(block_size.width + templ_size.width - 1);
+    dft_size.height = getOptimalDFTSize(block_size.height + templ_size.height - 1);
+
+    // To avoid wasting time doing small DFTs
+    dft_size.width = std::max(dft_size.width, 512);
+    dft_size.height = std::max(dft_size.height, 512);
+
+    image_block.create(dft_size, CV_32F);
+    templ_block.create(dft_size, CV_32F);
+    result_data.create(dft_size, CV_32F);
+
+    image_spect.create(dft_size.height, dft_size.width / 2 + 1, CV_32FC2);
+    templ_spect.create(dft_size.height, dft_size.width / 2 + 1, CV_32FC2);
+    result_spect.create(dft_size.height, dft_size.width / 2 + 1, CV_32FC2);
+
+    // Use maximum result matrix block size for the estimated DFT block size
+    block_size.width = std::min(dft_size.width - templ_size.width + 1, result_size.width);
+    block_size.height = std::min(dft_size.height - templ_size.height + 1, result_size.height);
+}
+
+Size ConvolveBuf::estimateBlockSize(Size result_size, Size /*templ_size*/)
+{
+    int width = (result_size.width + 2) / 3;
+    int height = (result_size.height + 2) / 3;
+    width = std::min(width, result_size.width);
+    height = std::min(height, result_size.height);
+    return Size(width, height);
+}
+
+static bool convolve_dft(InputArray _image, InputArray _templ, OutputArray _result)
+{
+    ConvolveBuf buf;
+    CV_Assert(_image.type() == CV_32F);
+    CV_Assert(_templ.type() == CV_32F);
+
+    buf.create(_image.size(), _templ.size());
+    _result.create(buf.result_size, CV_32F);
+
+    UMat image  = _image.getUMat();
+    UMat templ  = _templ.getUMat();
+
+    UMat result = _result.getUMat();
+
+    Size& block_size = buf.block_size;
+    Size& dft_size = buf.dft_size;
+
+    UMat& image_block = buf.image_block;
+    UMat& templ_block = buf.templ_block;
+    UMat& result_data = buf.result_data;
+
+    UMat& image_spect = buf.image_spect;
+    UMat& templ_spect = buf.templ_spect;
+    UMat& result_spect = buf.result_spect;
+
+    UMat templ_roi = templ;
+    copyMakeBorder(templ_roi, templ_block, 0, templ_block.rows - templ_roi.rows, 0,
+                   templ_block.cols - templ_roi.cols, BORDER_ISOLATED);
+
+    dft(templ_block, templ_spect, 0);
+
+    // Process all blocks of the result matrix
+    for (int y = 0; y < result.rows; y += block_size.height)
+    {
+        for (int x = 0; x < result.cols; x += block_size.width)
+        {
+            Size image_roi_size(std::min(x + dft_size.width, image.cols) - x,
+                                std::min(y + dft_size.height, image.rows) - y);
+            Rect roi0(x, y, image_roi_size.width, image_roi_size.height);
+
+            UMat image_roi(image, roi0);
+
+            copyMakeBorder(image_roi, image_block, 0, image_block.rows - image_roi.rows,
+                           0, image_block.cols - image_roi.cols, BORDER_ISOLATED);
+
+            dft(image_block, image_spect, 0);
+
+            mulSpectrums(image_spect, templ_spect, result_spect, 0, true);
+
+            dft(result_spect, result_data, cv::DFT_INVERSE | cv::DFT_REAL_OUTPUT | cv::DFT_SCALE);
+
+            Size result_roi_size(std::min(x + block_size.width, result.cols) - x,
+                                 std::min(y + block_size.height, result.rows) - y);
+
+            Rect roi1(x, y, result_roi_size.width, result_roi_size.height);
+            Rect roi2(0, 0, result_roi_size.width, result_roi_size.height);
+
+            UMat result_roi(result, roi1);
+            UMat result_block(result_data, roi2);
+
+            result_block.copyTo(result_roi);
+        }
+    }
+    return true;
+}
+
+static bool convolve_32F(InputArray _image, InputArray _templ, OutputArray _result)
+{
+    _result.create(_image.rows() - _templ.rows() + 1, _image.cols() - _templ.cols() + 1, CV_32F);
+
+    if (_image.channels() == 1)
+        return(convolve_dft(_image, _templ, _result));
+    else
+    {
+        UMat image = _image.getUMat();
+        UMat templ = _templ.getUMat();
+        UMat result_(image.rows-templ.rows+1,(image.cols-templ.cols+1)*image.channels(), CV_32F);
+        bool ok = convolve_dft(image.reshape(1), templ.reshape(1), result_);
+        if (ok==false)
+            return false;
+        UMat result = _result.getUMat();
+        return (extractFirstChannel_32F(result_, _result, _image.channels()));
+    }
+}
+
 static bool matchTemplateNaive_CCORR(InputArray _image, InputArray _templ, OutputArray _result)
 {
     int type = _image.type(), depth = CV_MAT_DEPTH(type), cn = CV_MAT_CN(type);
@@ -111,6 +284,30 @@ static bool matchTemplateNaive_CCORR(InputArray _image, InputArray _templ, Outpu
     return k.run(2, globalsize, NULL, false);
 }
 
+
+static bool matchTemplate_CCORR(InputArray _image, InputArray _templ, OutputArray _result)
+        {
+            if (useNaive(TM_CCORR, _image.depth(), _templ.size()))
+                return( matchTemplateNaive_CCORR(_image, _templ, _result));
+
+            else
+            {
+                if(_image.depth() == CV_8U && _templ.depth() == CV_8U)
+                {
+                    UMat imagef, templf;
+                    UMat image = _image.getUMat();
+                    UMat templ = _templ.getUMat();
+                    image.convertTo(imagef, CV_32F);
+                    templ.convertTo(templf, CV_32F);
+                    return(convolve_32F(imagef, templf, _result));
+                }
+                else
+                {
+                    return(convolve_32F(_image, _templ, _result));
+                }
+            }
+        }
+
 static bool matchTemplate_CCORR_NORMED(InputArray _image, InputArray _templ, OutputArray _result)
 {
     matchTemplate(_image, _templ, _result, CV_TM_CCORR);
@@ -165,6 +362,41 @@ static bool matchTemplateNaive_SQDIFF(InputArray _image, InputArray _templ, Outp
     return k.run(2, globalsize, NULL, false);
 }
 
+static bool matchTemplate_SQDIFF(InputArray _image, InputArray _templ, OutputArray _result)
+{
+    if (useNaive(TM_SQDIFF, _image.depth(), _templ.size()))
+        return( matchTemplateNaive_SQDIFF(_image, _templ, _result));
+    else
+    {
+        matchTemplate(_image, _templ, _result, CV_TM_CCORR);
+
+        int type = _image.type(), cn = CV_MAT_CN(type);
+
+        ocl::Kernel k("matchTemplate_Prepared_SQDIFF", ocl::imgproc::match_template_oclsrc,
+                  format("-D SQDIFF_PREPARED -D T=%s -D cn=%d", ocl::typeToStr(type),  cn));
+        if (k.empty())
+            return false;
+
+        UMat image = _image.getUMat(), templ = _templ.getUMat();
+        _result.create(image.rows - templ.rows + 1, image.cols - templ.cols + 1, CV_32F);
+        UMat result = _result.getUMat();
+
+        UMat image_sums, image_sqsums;
+        integral(image.reshape(1), image_sums, image_sqsums, CV_32F, CV_32F);
+
+        UMat templ_sqsum;
+        if (!sumTemplate(_templ, templ_sqsum))
+            return false;
+
+        k.args(ocl::KernelArg::ReadOnlyNoSize(image_sqsums), ocl::KernelArg::ReadWrite(result),
+           templ.rows, templ.cols, ocl::KernelArg::PtrReadOnly(templ_sqsum));
+
+        size_t globalsize[2] = { result.cols, result.rows };
+
+        return k.run(2, globalsize, NULL, false);
+    }
+}
+
 static bool matchTemplate_SQDIFF_NORMED(InputArray _image, InputArray _templ, OutputArray _result)
 {
     matchTemplate(_image, _templ, _result, CV_TM_CCORR);
@@ -313,7 +545,7 @@ static bool ocl_matchTemplate( InputArray _img, InputArray _templ, OutputArray _
 
     static const Caller callers[] =
     {
-        matchTemplateNaive_SQDIFF, matchTemplate_SQDIFF_NORMED, matchTemplateNaive_CCORR,
+        matchTemplate_SQDIFF, matchTemplate_SQDIFF_NORMED, matchTemplate_CCORR,
         matchTemplate_CCORR_NORMED, matchTemplate_CCOEFF, matchTemplate_CCOEFF_NORMED
     };
     const Caller caller = callers[method];