Path plan generating apparatus for mobile body
First Claim
Patent Images
1. A path plan generating apparatus for a mobile body, comprising:
- an obstacle information acquiring section which acquires obstacle information including at least information indicating an existence position of each obstacle present in an operating environment of the mobile body;
an initial path plan generating section which generates an initial path plan that is a path plan from an initial position, where the mobile body starts moving, to a goal point;
an RRT path plan generating section which is operable, in a case where future occurrence of interference between the mobile body on the initial path plan and any obstacle is predicted based on the initial path plan and the obstacle information, to generate a path plan from a current position of the mobile body to the goal point, by processing based on an rapidly-exploring random tree (RRT) algorithm, so as to be able to avoid future interference between the mobile body and each obstacle; and
a path plan correcting section which sets, using the obstacle information, a potential field that generates a virtual repulsive force in a region surrounding each obstacle, and, in a case where a generated path plan includes a section that is predicted to be affected by the potential field of at least one obstacle, corrects the generated path plan, by processing based on a potential method, so as to reduce the repulsive force acting on the section from the potential field, the path plan correcting section sequentially performing the correction on at least an RRT path plan among the initial path plan and the RRT path plan, the RRT path plan being a path plan generated by the RRT path plan generating section.
1 Assignment
0 Petitions
Accused Products
Abstract
A path plan generating apparatus 10 corrects an RRT path plan that an RRT path plan generating section 22 has generated by processing based on the RRT algorithm, by a path plan correcting section 23 by processing based on the potential method. If the corrected path plan becomes a path plan with which interference between the mobile body 1 and an obstacle A is unavoidable, the apparatus 10 causes the RRT path plan generating section 22 to generate a new RRT path plan.
-
Citations
8 Claims
-
1. A path plan generating apparatus for a mobile body, comprising:
-
an obstacle information acquiring section which acquires obstacle information including at least information indicating an existence position of each obstacle present in an operating environment of the mobile body; an initial path plan generating section which generates an initial path plan that is a path plan from an initial position, where the mobile body starts moving, to a goal point; an RRT path plan generating section which is operable, in a case where future occurrence of interference between the mobile body on the initial path plan and any obstacle is predicted based on the initial path plan and the obstacle information, to generate a path plan from a current position of the mobile body to the goal point, by processing based on an rapidly-exploring random tree (RRT) algorithm, so as to be able to avoid future interference between the mobile body and each obstacle; and a path plan correcting section which sets, using the obstacle information, a potential field that generates a virtual repulsive force in a region surrounding each obstacle, and, in a case where a generated path plan includes a section that is predicted to be affected by the potential field of at least one obstacle, corrects the generated path plan, by processing based on a potential method, so as to reduce the repulsive force acting on the section from the potential field, the path plan correcting section sequentially performing the correction on at least an RRT path plan among the initial path plan and the RRT path plan, the RRT path plan being a path plan generated by the RRT path plan generating section. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8)
-
Specification