diff_drive: refactor integrate* methods in odometry

refs #30
Merge pull request #31 from po1/refactor-odometry

diff_drive: refactor integrate* methods in odometry