Revision history [back]

You will have to implement a node with a state machine that describes such process.

You can store the sequence of goals in that node. First the node would publish the first goal. Then, the node would need to read the position of the robot and wait to the robot is close enough to that first goal. If the goal is considered reached, then the node would publish a next goal position. This process would be repeated until the whole sequence is accomplished.