Algorithms with applications in robotics