×

Path plan generating apparatus for mobile body

  • US 9,995,589 B2
  • Filed: 01/05/2017
  • Issued: 06/12/2018
  • Est. Priority Date: 02/24/2016
  • Status: Active Grant
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.

View all claims
  • 1 Assignment
Timeline View
Assignment View
    ×
    ×