Probabilistic Roadmap Algorithm