adds open loop odometry
Cosmetic refactoring
adds open loop test
adds odometry init to reset timestamp and accs
Merge pull request #39 from efernandez/open_loop_odometry

Open-loop odometry