Sending a goal to the Navigation stack from a ROS node