summaryrefslogtreecommitdiffhomepage
path: root/cv/translation-calibrator.cpp
diff options
context:
space:
mode:
authorAttila Csipa <git@csipa.net>2017-07-07 13:16:16 +0100
committerAttila Csipa <git@csipa.net>2017-07-07 13:16:16 +0100
commit89b3621079aebc04b32892b01040397044c21bf4 (patch)
treefeac22663567716e51133734d7592da64adfd239 /cv/translation-calibrator.cpp
parentb8272dabb295ff8c92cde01d8a3170aae9b180a6 (diff)
parentf013741288cbbd9a2e70aea727cbb80cf72d10cc (diff)
Merge remote-tracking branch 'upstream/unstable' into unstable
Diffstat (limited to 'cv/translation-calibrator.cpp')
-rw-r--r--cv/translation-calibrator.cpp9
1 files changed, 4 insertions, 5 deletions
diff --git a/cv/translation-calibrator.cpp b/cv/translation-calibrator.cpp
index cdd573bc..fb150bf9 100644
--- a/cv/translation-calibrator.cpp
+++ b/cv/translation-calibrator.cpp
@@ -54,12 +54,10 @@ void TranslationCalibrator::update(const cv::Matx33d& R_CM_k, const cv::Vec3d& t
y += H_k_T * t_CM_k;
}
-std::tuple<cv::Vec3f, unsigned> TranslationCalibrator::get_estimate()
+std::tuple<cv::Vec3f, cv::Vec3i> TranslationCalibrator::get_estimate()
{
cv::Vec6f x = P.inv() * y;
- qDebug() << "calibrator:" << nsamples << "samples total";
-
unsigned values[3] {};
vec* in[] { &used_yaw_poses, &used_pitch_poses, &used_roll_poses };
@@ -71,12 +69,13 @@ std::tuple<cv::Vec3f, unsigned> TranslationCalibrator::get_estimate()
values[k]++;
}
- qDebug() << "samples"
+ qDebug() << "samples total" << nsamples
<< "yaw" << values[0]
<< "pitch" << values[1]
<< "roll" << values[2];
- return std::make_tuple(cv::Vec3f(-x[0], -x[1], -x[2]), nsamples);
+ return std::make_tuple(cv::Vec3f(-x[0], -x[1], -x[2]),
+ cv::Vec3i(values[0], values[1], values[2]));
}
bool TranslationCalibrator::check_bucket(const cv::Matx33d& R_CM_k)