summaryrefslogtreecommitdiffhomepage
path: root/opentrack/tracker.cpp
diff options
context:
space:
mode:
authorStanislaw Halik <sthalik@misaki.pl>2014-10-26 06:18:14 +0100
committerStanislaw Halik <sthalik@misaki.pl>2014-10-26 06:18:14 +0100
commita7012fe2c2a532843f14016ddad243b154b790fa (patch)
tree26fe5a0388da99c0c4827c4deaaff24fbff009d1 /opentrack/tracker.cpp
parent089d07189294e1bcb6eefad838cf5a683fa1451b (diff)
swap axes only after mapping them, not before
@KyokushinPL mumbled something about Google Cardboard being unusable. If breaks existing use-cases, need reverting though.
Diffstat (limited to 'opentrack/tracker.cpp')
-rw-r--r--opentrack/tracker.cpp34
1 files changed, 16 insertions, 18 deletions
diff --git a/opentrack/tracker.cpp b/opentrack/tracker.cpp
index d0a0b8f2..96838571 100644
--- a/opentrack/tracker.cpp
+++ b/opentrack/tracker.cpp
@@ -105,24 +105,9 @@ void Tracker::logic()
{
libs.pTracker->data(newpose);
- Pose final_raw_;
-
if (enabledp)
- {
for (int i = 0; i < 6; i++)
- {
- auto& axis = m(i);
- int k = axis.opts.src;
- if (k < 0 || k >= 6)
- {
- final_raw_(i) = 0;
- continue;
- }
- // not really raw, after axis remap -sh
- final_raw_(i) = newpose[k];
- }
- final_raw = final_raw_;
- }
+ final_raw(i) = newpose[i];
Pose filtered_pose;
@@ -163,14 +148,27 @@ void Tracker::logic()
for (int i = 0; i < 6; i++)
mapped_pose_precomp(i) = map(raw_centered(i), m(i));
- Pose mapped_pose = mapped_pose_precomp;
+ Pose mapped_pose_ = mapped_pose_precomp;
if (s.tcomp_p)
t_compensate(euler_to_rmat(&mapped_pose_precomp[Yaw]),
mapped_pose_precomp,
- mapped_pose,
+ mapped_pose_,
s.tcomp_tz);
+ Pose mapped_pose;
+
+ for (int i = 0; i < 6; i++)
+ {
+ auto& axis = m(i);
+ int k = axis.opts.src;
+ if (k < 0 || k >= 6)
+ mapped_pose(i) = 0;
+ else
+ mapped_pose(i) = mapped_pose_(i);
+ }
+
+
libs.pProtocol->pose(mapped_pose);
QMutexLocker foo(&mtx);