Catkin buildsystem development

Seperate branch for Catkin build system. The tools folder should be checked as it's not completely catkin yet.