Motion planning algorithms

shape