Optimal Path Planning in Complex Cost Spaces With Sampling-Based Algorithms
Anytime solution optimization for sampling-based motion planning