Robotics algorithms

shape