prevent nan values in measure of angularVelocity

This commit is contained in:
Andrew Meadows 2015-12-18 13:40:35 -08:00
parent d6541e9ee7
commit 4e76e9e50b

View file

@ -466,9 +466,10 @@ void SixenseManager::InputDevice::handlePoseEvent(float deltaTime, glm::vec3 pos
samples.first.addSample(velocity);
velocity = samples.first.average;
auto deltaRot = rotation * glm::conjugate(prevPose.getRotation());
auto deltaRot = glm::normalize(rotation * glm::conjugate(prevPose.getRotation()));
auto axis = glm::axis(deltaRot);
auto speed = glm::angle(deltaRot) / deltaTime;
assert(!glm::isnan(speed));
angularVelocity = speed * axis;
samples.second.addSample(angularVelocity);
angularVelocity = samples.second.average;