Update changelog and package.xml