Still trying for catkin compatibility
Merge branch 'feature/catkin-compatibility' of https://github.com/ethz-asl/kindr into feature/catkin-compatibility