Keeping highest odometry variance between two rtabmap updates. Fixed map id increment on odometry reset (identity pose was missed because of the high rate of odometry).