changed rrt planner to make sure np arrays are used