Updated odometry and gt-agent test