Added odometry output from drive controller