Corrected a bug in odometry reset in mapping