From 98068232a672e0e45fc921ffecb500cacc1ff004 Mon Sep 17 00:00:00 2001 From: Louka Date: Sun, 27 Mar 2022 06:33:36 -0400 Subject: [PATCH] don't create as many quaternions --- src/main/java/dev/slimevr/vr/trackers/IMUTracker.java | 7 +++++-- 1 file changed, 5 insertions(+), 2 deletions(-) diff --git a/src/main/java/dev/slimevr/vr/trackers/IMUTracker.java b/src/main/java/dev/slimevr/vr/trackers/IMUTracker.java index 6ff98f5db..4e0ffb5a1 100644 --- a/src/main/java/dev/slimevr/vr/trackers/IMUTracker.java +++ b/src/main/java/dev/slimevr/vr/trackers/IMUTracker.java @@ -21,6 +21,7 @@ public class IMUTracker implements Tracker, TrackerWithTPS, TrackerWithBattery { public final Quaternion rotAdjust = new Quaternion(); protected final Quaternion correction = new Quaternion(); protected LinkedList previousRots = new LinkedList(); + private final Quaternion buffQuat = new Quaternion(); public float movementFilterTickCount = 0; public float movementFilterAmount = 1f; protected TrackerMountingRotation mounting = null; @@ -134,7 +135,7 @@ public class IMUTracker implements Tracker, TrackerWithTPS, TrackerWithBattery { } } if(movementFilterTickCount != 0){ - previousRots.addLast(new Quaternion(rotQuaternion)); + previousRots.addLast(rotQuaternion.clone()); if(previousRots.size() > movementFilterTickCount){ previousRots.removeFirst(); } @@ -155,7 +156,9 @@ public class IMUTracker implements Tracker, TrackerWithTPS, TrackerWithBattery { @Override public boolean getRotation(Quaternion store) { if(movementFilterTickCount > 0 && movementFilterAmount != 1 && previousRots.getFirst() != null){ - store.set(new Quaternion().slerp(rotQuaternion, previousRots.getFirst(), movementFilterAmount)); + buffQuat.set(previousRots.getFirst()); + buffQuat.slerp(rotQuaternion, movementFilterAmount); + store.set(buffQuat); } else{ store.set(rotQuaternion);