adds open loop odometry
Cosmetic refactoring
adds open loop test
adds odometry init to reset timestamp and accs
Merge pull request #136 from bmagyar/diff_drive_open_loop_odom

Diff drive open loop odom