Added utilities to the catkin buildsystem