Sampling-Based Motion Planning In Configuration And State Spaces