Fix missing findpackage catkin
Merge pull request #49 from ethz-asl/fix/cmake_lists

Fix missing findpackage catkin