Robotic leader-follower navigation and fleet management control method

• US 9,146,561 B2
• Filed: 12/03/2013
• Issued: 09/29/2015
• Est. Priority Date: 12/03/2013
• Status: Expired due to Fees

• 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.
• Primary Examiner(s): To, Tuan C.
• Assistant Examiner(s): PATEL, SHARDUL D
• Application Number:
  US14/095,995
• Publication Number:
  US 20150153738A1
• Time in Patent Office: 665 Days
• Field of Search: 701/23, 701/24, 701/25, 701/26, 701/117, 701/120, 701/301, 701/300, 340/961, 340/435, 340/436, 342/455, 342/29, 342/458, 342/457
• 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:

performing Simultaneous Localization and Mapping (SLAM) in a group leader of a nonholonomic group of autonomous robots using at least one sensor, the SLAM generating a map of landmarks in an environment;

the group leader localizing itself with respect to the map to navigate the environment;

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

computing a desired formation of the autonomous robots by utilizing a control law characterized by the relation

2. The robotic leader-follower navigation and fleet management control method according to claim 1, wherein the steps 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 utilizing an outer control loop and an inner control loop to execute the field formation control.

4. The robotic leader-follower navigation and fleet management control method according to claim 3, 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 u_l in the outer control loop;

performing a coordinate transformation based on u_l;

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)}.

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

6. The robotic leader-follower navigation and fleet management control method according to claim 3, 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.

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

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