From be13bfed4eb7fb4150ed979ea1a8bad56903efca Mon Sep 17 00:00:00 2001 From: Stanislaw Halik Date: Sun, 9 Nov 2014 09:43:23 +0100 Subject: doesn't hurt to use the commented-out formula --- opentrack/tracker.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/opentrack/tracker.cpp b/opentrack/tracker.cpp index b464dffe..a0cca2d6 100644 --- a/opentrack/tracker.cpp +++ b/opentrack/tracker.cpp @@ -145,8 +145,8 @@ void Tracker::logic() { const dmat<3, 3> rmat = euler_to_rmat(&filtered_pose[Yaw]); - const dmat<3, 3> m_ = r_b.t() * rmat; - //const dmat<3, 3> m_ = (r_b.t() * rmat) * r_b * r_b.t(); + //const dmat<3, 3> m_ = r_b.t() * rmat; + const dmat<3, 3> m_ = (r_b.t() * rmat) * r_b * r_b.t(); const dmat<3, 1> euler = rmat_to_euler(m_); for (int i = 0; i < 3; i++) { -- cgit v1.2.3