adds open loop odometry

updateOpenLoop