A Single-Query Bi-Directional Probabilistic Roadmap Planner with Lazy Collision Checking