Added geometry_msgs to package.xml