Fig. 15. Screenshot from execution of the plan (top). The goal position is
determined by the yellow circle. The graph shows the plan (red) and the observed
trajectory (green) together with robot’s actual position (blue). The position of
the robot is determined from the top camera using the roundel marker. (For
interpretation of the references to color in this figure legend, the reader is referred
to the web version of this article.)