Path planning

shape