Add package.xml and cmakelists