Path planning method for mobile robots

• US 5,109,340 A
• Filed: 06/19/1990
• Issued: 04/28/1992
• Est. Priority Date: 06/22/1989
• Status: Expired due to Fees

• Current Assignee: Shinko Electric Industries Company Limited (Fujitsu Limited), Varco International Inc. (NOV, Inc.), Sogo Security Services Co., Ltd.
• Original Assignee: Shinko Electric Industries Company Limited (Fujitsu Limited), Sogo Security Services Co., Ltd.
• Inventors: Kanayama, Yutaka
• Primary Examiner(s): Lall, Parshotam S.
• Assistant Examiner(s): ZANELLI, MICHAEL J
• Application Number:
  US07/540,152
• Time in Patent Office: 679 Days
• Field of Search: 364/424.01, 364/424.02, 364/443, 364/444, 364/513, 518/587, 518/568, 180/167-169, 901/1
• US Class Current: 701/25
• CPC Class Codes: G05D 1/0212 with means for defining a desired trajectory involving a plurality of land vehicles G05D1/0287
• CPC Class Codes: G05D 1/0263 using magnetic strips

Abstract

A method of planning paths for autonomous carrier vehicles, such as a mobile robots, capable of planning curved paths consisting of cubic spirals smoother than those planned by conventional path planning methods. The path planned by the method of the invention is defined by one or two of cubic spirals with curvature expressed by a quadratic function of distance measured along the cubic spiral with zero curvatures at its opposite ends. The path is designed so that curvatures at the junctions are zero and the integral of the square of the derivative of curvature function between the opposite ends of the path is minimized. The mobile robot is able to travel very smoothly across the junctions when the integral of the square of the derivative of curvature is minimized.

Claims

1. A method of planning a path for a mobile robot to travel from a first posture to a second posture, comprising the steps of:

specifying the path in the form of at least one cubic spiral which has curvature expressed by a quadratic function of distance measured along the curve, and has zero curvature at each end thereof; and

controlling movement of the mobile robot along the path as defined by said cubic spiral.

2. A method of planning a path for a mobile robot to travel from a first posture to a second posture according to claim 1, wherein the path is specified using two cubic spirals, wherein an intermediate posture symmetric with both the first and second postures is determined, and wherein the path is specified by a first cubic spiral connecting the first posture and the intermediate posture, and a second cubic spiral connecting the second posture and the intermediate posture.

3. A method of planning a path for a mobile robot to travel from a first posture to a second posture according to claim 2, wherein the path is specified through steps of:

calculating the angular difference α

between the first and intermediate postures;

calculating the scalar distance d between the positional coordinates of the first and intermediate postures;

determining the distance of travel of the mobile robot, including the step of calculating a length l of said first cubic spiral on the basis of said scalar distance and the distance between opposite ends of a reference cubic spiral having a unit length and having curvatures of zero at the opposite ends thereof, and said last-mentioned calculating step including the step of using said angular difference to determine said distance between said ends of said reference cubic spiral;

calculating curvature k by using a formula;

space="preserve" listing-type="equation">k=6α

(l.sup.2 /4-s.sup.2)/l.sup.2 (-l/2≦

s≦

l/2); and

periodically calculating the posture of the mobile robot on the basis of the calculated curvature k.

4. A method of planning a path for a mobile robot to travel from a first posture to a second posture according to claim 1, wherein the path is specified through steps of:

calculating the angular difference α

between the first and second postures;

calculating the scalar distance d between the positional coordinates of the first and second postures;

determining the distance of travel of the mobile robot, including the step of calculating a length l of said cubic spiral on the basis of said scalar distance and the distance between opposite ends of a reference cubic spiral having a unit length and having curvatures of zero at the opposite ends thereof, and said last-mentioned calculating step including the step of using said angular difference to determine said distance between said ends of said reference cubic spiral;

calculating curvature k by using a formula;

space="preserve" listing-type="equation">k=6α

(l.sup.2 /4-s.sup.2)/l.sup.2 (-l/2≦

s≦

l/2); and

periodically calculating the posture of the mobile robot on the basis of the calculated curvature k.