bug fix for Relocalization from IMU