Navigation algorithms

shape