Real time path planning

shape