使用OpenCV最小化方程中的矩阵

Question

我需要在以下等式中最小化H：

其中H是3x3矩阵 Pn是3x1矩阵（点） Euclidean()给出2点之间的距离 Dn是实际距离。

我有H和m点（P0到Pm）的初步估算值 我需要优化H的值，以便对所有m点误差最小化。 （表达式中的所有值都是已知的） 如何使用opencv或dlib（或使用boost / NLopt）实现此目的。

Answer 1

尽管find_optimal_parameters库的dlib函数的文档确实不够，但您可以在github上找到一个单元测试，其中显示了如何使用该函数。

我看到你问过的另一个question，似乎解决方案与此问题有所不同。但是，这里有一个例子，如何使用库（这是我第一次听到它）来计算你需要的东西或非常接近的东西。可能你需要更改 DistanceQuality（）功能（通过用两个嵌套的循环替换现有循环），我会让你自己动手。

请注意，代码中的所有内容都是硬编码的，没有进行错误处理，测试是在 main（）函数中完成的。虽然您可以找到适用于说明目的的代码，但仍有许多工作要做。

我们走了：

#include <iostream>
#include <dlib/optimization.h>
#include <dlib/optimization/find_optimal_parameters.h>

using namespace dlib;

typedef matrix<double, 3, 1> MyPoint;

std::vector<MyPoint> points;
std::vector<double> distances;

double MyDistance(MyPoint point1, MyPoint point2)
{
   double sum = 0;
   for (int i = 0; i < 3; i++)
   {
      sum += (point1(i, 0) - point2(i, 0)) * (point1(i, 0) - point2(i, 0));
   }
   return sqrt(sum);
}

double DistanceQuality(const matrix<double, 3, 3>& H)
{
   double sum = 0;

   for (int i = 0; i < points.size() - 1; i++)
   {
      auto proj1 = H*points[i];
      auto proj2 = H*points[i+1];
      sum += abs(MyDistance(proj1, proj2) - distances[i]);
   }
   return sum;
}

matrix<double, 3, 3> VecToMatrix(matrix<double, 0, 1> vec)
{
   matrix<double, 3, 3> matrix;
   for (int i = 0; i < 9; i++)
   {
      matrix(i / 3, i % 3) = vec(i);
   }
   return matrix;
}

double test_function(matrix<double, 0, 1> H)
{
   matrix<double, 3, 3> newH = VecToMatrix(H);
   auto result = DistanceQuality(newH);
   return result;
}

int main()
{
   matrix<double, 3, 1> p1;
   matrix<double, 3, 1> p2;
   matrix<double, 3, 1> p3;

   p1 = { 1, 1, 1 };
   p2 = { 2, 2, 3 };
   p3 = { 3, 1.6, 7};

   points.push_back(p1);
   points.push_back(p2);
   points.push_back(p3);

   double d1 = 2.44949;
   double d2 = 4.142463;

   distances.push_back(d1);
   distances.push_back(d2);

   matrix<double, 0, 1> H;
   H = { 3, 1, 1,
         1, 1, 6,
         1, 4, 1 };

   matrix<double, 0, 1> H_min;
   matrix<double, 0, 1> H_max;

   H_min = { 0.5, 0.6, 0.5,
             0.5, 0.7, 0.5,
             0.8, 0.3, 0.5, };

   H_max = { 10, 10, 10,
             10, 10, 10,
             10, 10, 10, };

   dlib::find_optimal_parameters(4, 0.001, 1000, H, H_min, H_max, test_function);
   std::cout << "new H: " << std::endl << VecToMatrix(H) << std::endl;

   return 0;
}

希望您能根据具体情况调整参数。