update CMakeList and package.xml