Motion planning

shape