Fix bug on odometry listener