#include <visp3/core/vpImage.h>
#include <visp3/core/vpIoTools.h>
#include <visp3/core/vpImageTools.h>
#include <visp3/io/vpVideoReader.h>
#include <visp3/io/vpParseArgv.h>
#include <visp3/gui/vpDisplayX.h>
#include <visp3/gui/vpDisplayGDI.h>
#include <visp3/gui/vpDisplayOpenCV.h>
#define GETOPTARGS "cdi:h"
namespace
{
void usage(const char *name, const char *badparam, std::string ipath)
{
fprintf(stdout, "\n\
Test vpImageTools::normalizedCorrelation().\n\
\n\
SYNOPSIS\n\
%s [-i <VISP_IMAGES directory>] \n\
[-h]\n \
", name);
fprintf(stdout, "\n\
OPTIONS: Default\n\
-i <VISP_IMAGES directory> %s\n\
Set VISP_IMAGES input path.\n\
Setting the VISP_INPUT_IMAGE_PATH environment\n\
variable produces the same behaviour than using\n\
this option.\n\
-h\n\
Print the help.\n\n", ipath.c_str());
if (badparam)
fprintf(stdout, "\nERROR: Bad parameter [%s]\n", badparam);
}
bool getOptions(int argc, const char **argv, std::string &ipath)
{
const char *optarg_;
int c;
switch (c) {
case 'i':
ipath = optarg_;
break;
case 'h':
usage(argv[0], NULL, ipath);
return false;
break;
case 'c':
case 'd':
break;
default:
usage(argv[0], optarg_, ipath);
return false;
break;
}
}
if ((c == 1) || (c == -1)) {
usage(argv[0], NULL, ipath);
std::cerr << "ERROR: " << std::endl;
std::cerr << " Bad argument " << optarg_ << std::endl << std::endl;
return false;
}
return true;
}
const unsigned int step_v, const bool useOptimized)
{
for (
unsigned int i = 0; i < I.
getHeight()-height_tpl; i += step_v) {
for (
unsigned int j = 0; j < I.
getWidth()-width_tpl; j += step_u) {
}
}
}
}
int main(int argc, const char **argv)
{
try {
std::string env_ipath;
std::string opt_ipath;
std::string ipath;
std::string filename;
if (!env_ipath.empty()) {
ipath = env_ipath;
}
if (!getOptions(argc, argv, opt_ipath)) {
exit(EXIT_FAILURE);
}
if (!opt_ipath.empty()) {
ipath = opt_ipath;
}
if (!opt_ipath.empty() && !env_ipath.empty()) {
if (ipath != env_ipath) {
std::cout << std::endl << "WARNING: " << std::endl;
std::cout << " Since -i <visp image path=" << ipath << "> "
<< " is different from VISP_IMAGE_PATH=" << env_ipath << std::endl
<< " we skip the environment variable." << std::endl;
}
}
if (opt_ipath.empty() && env_ipath.empty()) {
usage(argv[0], NULL, ipath);
std::cerr << std::endl << "ERROR:" << std::endl;
std::cerr << " Use -i <visp image path> option or set VISP_INPUT_IMAGE_PATH " << std::endl
<< " environment variable to specify the location of the " << std::endl
<< " image path where test images are located." << std::endl
<< std::endl;
exit(EXIT_FAILURE);
}
const unsigned int step_i = 5, step_j = 5;
templateMatching(I, I_template, I_score, step_i, step_j, true);
templateMatching(I, I_template, I_score_gold, step_i, step_j, false);
for (
unsigned int i = 0; i < I_score.
getHeight(); i++) {
for (
unsigned int j = 0; j < I_score.
getWidth(); j++) {
std::cerr << "Issue with normalizedCorrelation, gold: " << std::setprecision(17)
<< I_score_gold[i][j] << " ; compute: " << I_score[i][j] << std::endl;
return EXIT_FAILURE;
}
}
}
double max_correlation = -1.0, max_correlation_gold = -1.0;
I_score.
getMinMaxLoc(NULL, &max_loc, NULL, &max_correlation);
I_score_gold.
getMinMaxLoc(NULL, &max_loc_gold, NULL, &max_correlation_gold);
std::cout << "Compare regular and SSE version of vpImageTools::normalizedCorrelation()" << std::endl;
std::cout << "vpImageTools::normalizedCorrelation(): " << max_correlation << " ; " << t << " ms" << std::endl;
std::cout << "Gold normalizedCorrelation(): " << max_correlation_gold << " ; " << t_gold << " ms" << std::endl;
std::cerr <<
"\nTrue template position: " << template_roi.
getTopLeft() << std::endl;
std::cerr << "Found template position: " << max_loc << std::endl;
std::cerr << "Issue with vpImageTools::normalizedCorrelation:" << std::endl;
return EXIT_FAILURE;
}
std::cerr << "\nCatch an exception: " << e << std::endl;
return EXIT_FAILURE;
}
return EXIT_SUCCESS;
}