UKF sigma-point filter with quaternion - USQUE