ROBOTIC LEADER-FOLLOWER NAVIGATION AND FLEET MANAGEMENT CONTROL METHOD

• US 20150153738A1
• Filed: 12/03/2013
• Published: 06/04/2015
• Est. Priority Date: 12/03/2013
• Status: Active Grant

• Current Assignee: King Abdul AZIZ City For Science and Technology, King Fahd University Of Petroleum And Minerals
• Original Assignee: King Abdul AZIZ City For Science and Technology, King Fahd University Of Petroleum And Minerals
• Inventors: AL-BURAIKI, OMAR SALEM, EL FERIK, SAMI A.
• Granted Patent: US 9,146,561 B2
• Time in Patent Office: Days
• US Class Current: 1/1
• CPC Class Codes: G05D 1/024 in combination with a laser lasers per se H01S
• CPC Class Codes: G05D 1/0274 using mapping information stored in a memory device navigation using map-matching G01C21/30
• CPC Class Codes: G05D 1/0295 by at least one leading vehicle of the fleet

Abstract

The robotic leader-follower navigation and fleet management control method implements SLAM in a group leader of a nonholonomic group of autonomous robots, while, at the same time, executing a potential field control strategy in follower members of the group.

Claims

1. A robotic leader-follower navigation and fleet management control method, comprising the steps of:

using at least one sensor to assist in performing Simultaneous Localization and Mapping (SLAM) in a group leader of a nonholonomic group of autonomous robots; and

executing potential field formation control in follower members of the nonholonomic group of autonomous robots;

wherein the group leader creates a map of landmarks in an environment and localizes itself based on the map to thereby navigate the environment, the follower members following the group leader in a predefined formation pattern based on the potential field with respect to each other and with respect to the group leader.

2. The robotic leader-follower navigation and fleet management control method according to claim 1, wherein the of claim 1 are performed when dynamics of the autonomous robots are known.

3. The robotic leader-follower navigation and fleet management control method according to claim 1, further comprising the step of computing a desired formation of the autonomous robots by utilizing a control law characterized by the relations:

4. The robotic leader-follower navigation and fleet management control method according to claim 3, further comprising the step of utilizing an outer control loop and an inner control loop to execute the field formation control.

5. The robotic leader-follower navigation and fleet management control method according to claim 4, further comprising the steps of:

forming a center potential field as a component of the outer control loop;

forming a repulsive potential field as a component of the outer control loop;

summing the center potential and the repulsive potential to provide a net vehicle frame control signal ū

_i in the outer control loop;

performing a coordinate transformation based on ū

_i;

forming a sum comprising an output of the coordinate transformation plus a feedback gain of the inner control loop;

performing feedback linearization control in the inner control loop based on the sum of the coordinate transformation and the inner control loop feedback gain, and based on a velocity v of the autonomous robot, output of the feedback linearization being fed as an inner loop control signal to the autonomous robot;

closing the outer control loop with a signal S(q) fed back to be used as input to the center potential forming step and as input to the repulsive potential forming step, S(q) being based on the v output of the autonomous robot and a rate of change {dot over (q)} of a vector q having 2-D coordinate components x and y and a wheel angle component θ

, where S(q)=(v(t))/{dot over (q)}.

6. The robotic leader-follower navigation and fleet management control method according to claim 5, wherein the steps of claim 5 are performed for each of the follower members.

7. The robotic leader-follower navigation and fleet management control method according to claim 4, further comprising the steps of:

forming a center potential field as a component of the outer control loop;

forming a repulsive potential field as a component of the outer control loop;

summing the center potential and the repulsive potential to provide a desired trajectory control signal q_d in the outer control loop;

forming a tracking error based on summing the desired trajectory control signal q_d and an inner loop tracking estimation q;

filtering the tracking error;

applying an inner loop gain constant K_c to the filtered tracking error to provide a gain-adjusted, filtered tracking error;

estimating nonlinear dynamics of the autonomous robot in the inner control loop based on motion output of the autonomous robot, the desired trajectory q_d and the second derivative {umlaut over (q)}_d of the desired trajectory, the nonlinear dynamics estimate forming a function ƒ

(x) of the robot summed with the gain-adjusted filtered tracking error to complete the inner control loop, the outer loop being completed by feeding the motion output of the autonomous robot back as input to the center potential forming step and as input to the repulsive potential forming step.

8. The robotic leader-follower navigation and fleet management control method according to claim 7, wherein the steps of claim 6 are performed for each of the follower members.

9. The robotic leader-follower navigation and fleet management control method according to claim 7, wherein the nonlinear dynamics estimate in the inner control loop is performed by a neural network.