Fixing math utils function declarations
Fixing math utils function declarations
Merge branch 'eigen3' into catkin-1.2.1