fix heading normalization, using ROS angles lib + sort members constructors
Merge pull request #1 from efernandez/diff-drive-stuff

fix heading normalization, using ROS angles lib + sort members constructors