finished sample based planner