32 #define TEST_NAME "estimators/affine_transform"
40 for (
double x = 0;
x < 1;
x += 0.1) {
41 Eigen::Matrix<double, 2, 3> A;
42 A <<
x, 0.2, 0.3, 30, 0.2, 0.1;
44 std::vector<Eigen::Vector2d> src;
45 src.emplace_back(
x, 0);
46 src.emplace_back(1, 0);
47 src.emplace_back(2, 1);
49 std::vector<Eigen::Vector2d> dst;
50 for (
size_t i = 0; i < 3; ++i) {
51 dst.push_back(A * src[i].homogeneous());
55 const auto models = estimator.
Estimate(src, dst);
57 BOOST_CHECK_EQUAL(models.size(), 1);
59 std::vector<double> residuals;
60 estimator.
Residuals(src, dst, models[0], &residuals);
62 BOOST_CHECK_EQUAL(residuals.size(), 3);
64 for (
size_t i = 0; i < 3; ++i) {
65 BOOST_CHECK_LT(residuals[i], 1
e-6);