Optimal Motion Generation for Groups of Robots: A Geometric Approach

In this paper we generate optimal smooth trajectories for a set of fully-actuated mobile robots. Given two end configurations, by tuning one parameter, the user can choose an interpolating trajectory from a continuum of curves varying from that corresponding to maintaining a rigid formation to motion of the robots toward each other. The idea behind our method is to change the original constant kinetic energy metric in the configuration space and can be summarized into three steps. First, the energy of the motion as a rigid structure is decoupled from the energy of motion along directions that violate the rigid constraints. Second, the metric is shaped by assigning different weights to each term. Third, geodesic flow is constructed for the modified metric. The optimal motions generated on the manifolds of rigid body displacements in 3-D space (SE(3)) or in plane (SE(2)) and the uniform rectilinear motion of each robot corresponding to a totally uncorrelated approach are particular cases of our general treatment.

[1]  I. Holopainen Riemannian Geometry , 1927, Nature.

[2]  Bahram Ravani,et al.  Computer aided geometric design of motion interpolants , 1994 .

[3]  Roger W. Brockett,et al.  Kinematic Dexterity of Robotic Mechanisms , 1994, Int. J. Robotics Res..

[4]  Kar-Han Tan,et al.  Virtual structures for high-precision cooperative mobile robotic control , 1996, Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems. IROS '96.

[5]  R. Beard,et al.  Constellation Templates: An Approach to Autonomous Formation Flying , 1998 .

[6]  Tucker R. Balch,et al.  Behavior-based formation control for multirobot teams , 1998, IEEE Trans. Robotics Autom..

[7]  Vijay Kumar,et al.  Controlling formations of multiple mobile robots , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[8]  Vijay Kumar,et al.  On the generation of smooth three-dimensional rigid body motions , 1998, IEEE Trans. Robotics Autom..

[9]  Jason L. Speyer,et al.  Peak-seeking control with application to formation flight , 1999, Proceedings of the 38th IEEE Conference on Decision and Control (Cat. No.99CH36304).

[10]  Wei Kang,et al.  Formation control of autonomous agents in 3D workspace , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[11]  Jun Ota,et al.  Motion planning for cooperative transportation of a large object by multiple mobile robots in a 3D environment , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[12]  Naomi Ehrich Leonard,et al.  Controlled Lagrangians and the stabilization of mechanical systems. I. The first matching theorem , 2000, IEEE Trans. Autom. Control..

[13]  Lynne E. Parker,et al.  Current State of the Art in Distributed Autonomous Mobile Robotics , 2000 .

[14]  Wolfram Burgard,et al.  Collaborative multi-robot exploration , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[15]  Wolfram Burgard,et al.  A Probabilistic Approach to Collaborative Multi-Robot Localization , 2000, Auton. Robots.

[16]  G. Chirikjian,et al.  Engineering Applications of Noncommutative Harmonic Analysis: With Emphasis on Rotation and Motion Groups , 2000 .

[17]  David A. Schoenwald,et al.  Decentralized control of cooperative robotic vehicles , 2001, SPIE Defense + Commercial Sensing.

[18]  J. Marsden,et al.  Physical dissipation and the method of controlled Lagrangians , 2001, 2001 European Control Conference (ECC).

[19]  Vijay Kumar,et al.  Motion generation for formations of robots: A geometric approach , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[20]  Vijay Kumar,et al.  An architecture for tightly coupled multi-robot cooperation , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[21]  Camillo J. Taylor,et al.  A framework for sensor planning and control with applications to vision guided multi-robot systems , 2001, Proceedings of the 2001 IEEE Computer Society Conference on Computer Vision and Pattern Recognition. CVPR 2001.

[22]  V. Kumar,et al.  Ad hoc networks for localization and control , 2002, Proceedings of the 41st IEEE Conference on Decision and Control, 2002..

[23]  Vijay Kumar,et al.  Cooperative Control of Robot Formations , 2002 .

[24]  Calin Belta,et al.  An SVD-based projection method for interpolation on SE(3) , 2002, IEEE Trans. Robotics Autom..

[25]  Vijay R. Kumar,et al.  Euclidean metrics for motion generation on SE(3) , 2002 .

[26]  William H. Press,et al.  Numerical recipes in C , 2002 .