Sampling-based motion planning library