odometry_utils: fixed bug introduced in db92497c