added possibility to relocalize based on IMU