Method and apparatus to plan motion path of robot
First Claim
1. A method of planning a path of a robot, the method comprising:
- forming a configuration space to generate a motion path of a manipulator of the robot using a processor;
recognizing an obstacle as an intermediate point and selecting a waypoint having a smallest goal score from a plurality of waypoints located at predetermined distances from the intermediate point, when there is an obstacle between a start point and a goal point of the configuration space, using the processor;
dividing a section from the start point to the goal point into a plurality of sections based on the selected waypoint, using the processor;
determining whether a solution of inverse kinematics of the selected waypoint is present, using the processor;
simultaneously expanding trees with respect to sections each having a waypoint with a solution of inverse kinematics, and expanding a tree, after the expansion of the trees is finished in the sections each having the waypoint with the solution of inverse kinematics, with respect to a section having a waypoint without a solution of inverse kinematics, to generate a search graph, using the processor; and
connecting the start point and the goal point using the search graph to generate an optimal path to avoid the obstacle, using the processor.
1 Assignment
0 Petitions
Accused Products
Abstract
A suitable waypoint is selected using a goal score, a section from a start point to a goal point through the waypoint is divided into a plurality of sections based on the waypoint with a solution of inverse kinematics, and trees are simultaneously expanded in the sections using a Best First Search & Rapidly Random Tree (BF-RRT) algorithm so as to generate a path. By this configuration, a probability of local minima occurring is decreased compared with the case where the waypoint is randomly selected. In addition, since the trees are simultaneously expanded in the sections each having the waypoint with a solution of inverse kinematics, the solution may be rapidly obtained. A time consumed to search for an optimal motion path may be shortened and path plan performance may be improved.
-
Citations
9 Claims
-
1. A method of planning a path of a robot, the method comprising:
-
forming a configuration space to generate a motion path of a manipulator of the robot using a processor; recognizing an obstacle as an intermediate point and selecting a waypoint having a smallest goal score from a plurality of waypoints located at predetermined distances from the intermediate point, when there is an obstacle between a start point and a goal point of the configuration space, using the processor; dividing a section from the start point to the goal point into a plurality of sections based on the selected waypoint, using the processor; determining whether a solution of inverse kinematics of the selected waypoint is present, using the processor; simultaneously expanding trees with respect to sections each having a waypoint with a solution of inverse kinematics, and expanding a tree, after the expansion of the trees is finished in the sections each having the waypoint with the solution of inverse kinematics, with respect to a section having a waypoint without a solution of inverse kinematics, to generate a search graph, using the processor; and connecting the start point and the goal point using the search graph to generate an optimal path to avoid the obstacle, using the processor. - View Dependent Claims (2, 3, 4, 5)
-
-
6. An apparatus to plan a motion path of a robot, the apparatus comprising:
-
a recognizer using a processor to recognize a start point and a goal point respectively corresponding to an initial configuration and a goal configuration of a manipulator, and an obstacle located between the start point and the goal point; and a path planning generator using the processor to recognize the obstacle as an intermediate point when there is an obstacle between a start point and a goal point of a configuration space, to select a waypoint having a smallest goal score from a plurality of waypoints located at predetermined distances from the intermediate point, to divide a section from the start point to the goal point into a plurality of sections based on the selected waypoint, to simultaneously expand trees with respect to sections each having a waypoint with a solution of inverse kinematics and to expand a tree after the expansion of the trees is finished in the sections each having the waypoint with the solution of inverse kinematics, with respect to a section having a waypoint without a solution of inverse kinematics, to generate a search graph, and to connect the start point and the goal point using the search graph to generate an optimal path to avoid the obstacle. - View Dependent Claims (7, 8, 9)
-
Specification