From 9366de846d8c6e9c14f0dea0d668672dc4293e05 Mon Sep 17 00:00:00 2001 From: Stanislaw Halik Date: Wed, 21 Sep 2016 20:00:09 +0200 Subject: tracker/pt: fix cross location formula --- tracker-pt/ftnoir_tracker_pt.cpp | 12 ++++++++---- 1 file changed, 8 insertions(+), 4 deletions(-) diff --git a/tracker-pt/ftnoir_tracker_pt.cpp b/tracker-pt/ftnoir_tracker_pt.cpp index 562ffcf1..8b0075d1 100755 --- a/tracker-pt/ftnoir_tracker_pt.cpp +++ b/tracker-pt/ftnoir_tracker_pt.cpp @@ -144,19 +144,23 @@ void Tracker_PT::run() Affine X_CM = pose(); - std::function fun = [&](const cv::Vec2d& p, const cv::Scalar& color) + auto fun = [&](const cv::Vec2d& p, const cv::Scalar& color) { - cv::Point p2(int(p[0]) * frame_.cols + frame_.cols/2, -int(p[1]) * frame_.cols + frame_.rows/2); + using std::round; + + cv::Point p2(round(p[0] * frame_.cols + frame_.cols/2), + round(-p[1] * frame_.cols + frame_.rows/2)); + cv::line(frame_, cv::Point(p2.x - 20, p2.y), cv::Point(p2.x + 20, p2.y), color, - 4); + 2); cv::line(frame_, cv::Point(p2.x, p2.y - 20), cv::Point(p2.x, p2.y + 20), color, - 4); + 2); }; for (unsigned i = 0; i < points.size(); i++) -- cgit v1.2.3