Compound path iterator test.
Explicitly recalculating travel time when returning path from prm.
Display intended robot position in the gui.
Path following.