The planner is given an initial state xs and a goal state xgoal. A Kd-tree data structure T is initialized with the number of dimensions utilized by the model of the system
The planner is given an initial state xs and a goal statexgoal. A Kd-tree data structure T is initialized with the numberof dimensions utilized by the model of the system