Join GitHub today
GitHub is home to over 36 million developers working together to host and review code, manage projects, and build software together.Sign up
check for quaternion normalization before inserting into storage #194
If this is not done. Invalid quaternions can cause future queries to return nan values.
But time specific queries which use the interpolation give nans due to the interpolation trying to use the quaternions.
I expect that the most common case is all zero quaternions that have not been initialized correctly.
It should be checked approximately here: https://github.com/ros/geometry2/blob/indigo-devel/tf2/src/buffer_core.cpp#L243