goal_publish 0.0.0 The goal_publish package xulin TODO catkin rosbag roscpp rospy std_msgs gazebo_msgs rosbag roscpp rospy std_msgs gazebo_msgs rosbag roscpp rospy std_msgs gazebo_msgs