METHOD AND SYSTEM FOR PATH PLANNING AND CONTROLLING

A path planning system for bringing state of an object into a target state includes a search tree production unit for producing in advance, in a state space with said target state defined as a root, a search tree having a branch at each one of a plurality of sections of the state space, said state space being divided into the plurality of sections in advance. The system also includes a search tree memory unit for storing the search tree, and a path generation unit for determining, a route on the search tree from the branch corresponding to the current state to the root. The path planning/control system further includes a path control unit for controlling the path of the object to bring the state of the object into the target state in accordance with the route on the search tree determined by the path planning system.