diff_drive: refactor integrate* methods in odometry

This implements some re-factoring discussed in issue #30