Fixing catkin_package call in CMakeLists, adding needed deps to package.xml, and adding include directories to cmakelists