Added catkin_package to CMakeLists.txt