diff_drive: odometry refactoring
fix heading normalization, using ROS angles lib + sort members constructors
diff_drive: add dependency to angles in manifest
Merge pull request #5 from po1/diff-drive-backport

#4 equivalent for fuerte branch