summaryrefslogtreecommitdiffhomepage
path: root/ftnoir_tracker_aruco/ftnoir_tracker_aruco.cpp
diff options
context:
space:
mode:
authorStanislaw Halik <sthalik@misaki.pl>2014-12-15 21:50:46 +0100
committerStanislaw Halik <sthalik@misaki.pl>2014-12-15 21:50:46 +0100
commit0383bd9685bce8528c7ae7bd42762037552b6803 (patch)
tree6e4dd41445697e05bdb022e1911b76da8bf79a8c /ftnoir_tracker_aruco/ftnoir_tracker_aruco.cpp
parent769d1340d3a76547a2252f52eb0a8615015f20e0 (diff)
pt, aruco: fix calibration
Diffstat (limited to 'ftnoir_tracker_aruco/ftnoir_tracker_aruco.cpp')
-rw-r--r--ftnoir_tracker_aruco/ftnoir_tracker_aruco.cpp12
1 files changed, 8 insertions, 4 deletions
diff --git a/ftnoir_tracker_aruco/ftnoir_tracker_aruco.cpp b/ftnoir_tracker_aruco/ftnoir_tracker_aruco.cpp
index b86e035c..81cfb895 100644
--- a/ftnoir_tracker_aruco/ftnoir_tracker_aruco.cpp
+++ b/ftnoir_tracker_aruco/ftnoir_tracker_aruco.cpp
@@ -457,10 +457,18 @@ void TrackerControls::toggleCalibrate()
{
if (!calib_timer.isActive())
{
+ s.headpos_x = 0;
+ s.headpos_y = 0;
+ s.headpos_z = 0;
calibrator.reset();
calib_timer.start();
} else {
cleanupCalib();
+
+ auto pos = calibrator.get_estimate();
+ s.headpos_x = pos(0);
+ s.headpos_y = pos(1);
+ s.headpos_z = pos(2);
}
}
@@ -478,10 +486,6 @@ void TrackerControls::update_tracker_calibration()
cv::Vec3d t;
tracker->getRT(r, t);
calibrator.update(r, t);
- auto pos = calibrator.get_estimate() * .1;
- s.headpos_x = pos(0);
- s.headpos_y = pos(1);
- s.headpos_z = pos(2);
}
}