Fixing CMakeLists and package.xml. Not done yet. Probably need to include moveit stuff in those as dependencies. Maybe Eigen as well.