ieee2014_localization: fixed determining angle from quaternion