Sampling-Based Planning Foundations & Applications