Goals are read by the robot and published to the planner