adds open loop odometry

after Bence's refactoring it's now for both open loop and closed loop