Improvement on the quaternion test + slerp