Fixes odometry timestamp handling