According to design spec of QueuedActionServer:
If another goal is received, add it to the queue. If the queue is already full, then set the current goal to preempted, start executing the next one in the queue, and add the new one to the queue.
What actually happens is that the new goal preempts the second goal in Queue and executes it after it finishes the first.
According to design spec of QueuedActionServer: If another goal is received, add it to the queue. If the queue is already full, then set the current goal to preempted, start executing the next one in the queue, and add the new one to the queue.
What actually happens is that the new goal preempts the second goal in Queue and executes it after it finishes the first.