Cooperative exploration of level surfaces of three dimensional scalar fields

We develop strategies for a group of mobile sensing agents to cooperatively explore level surfaces of an unknown 3D scalar field. A cooperative Kalman filter is constructed to combine sensor readings from all agents and give estimates of the field value and gradient at the center of the formation formed by the sensing agents. The formation formed by the agents is controlled to track curves on a level surface in the field under steering control laws. We prove that the formation center can move to a desired level surface and can follow a curve with known frame and curvatures. In particular, we present results on tracking lines of curvature on a desired level surface, revealing the 3D geometry of the scalar field. Taubin's algorithm is modified and applied to detect and estimate principal curvatures and principal directions for lines of curvature. We prove the sufficient and necessary conditions that ensure reliable estimates using Taubin's algorithm. We also theoretically justify the minimum number of agents that can be utilized to accomplish the exploration tasks. Simulation results demonstrate that a line of curvature on a desired level surface can be detected and traced successfully.

[1]  Michael R. M. Jenkin,et al.  A taxonomy for multi-agent robotics , 1996, Auton. Robots.

[2]  Petter Ögren,et al.  Cooperative control of mobile sensor networks:Adaptive gradient climbing in a distributed environment , 2004, IEEE Transactions on Automatic Control.

[3]  Fumin Zhang,et al.  Geometric Cooperative Control of Particle Formations , 2010, IEEE Transactions on Automatic Control.

[4]  Francis Schmitt,et al.  Intrinsic Surface Properties from Surface Triangulation , 1992, ECCV.

[5]  P. S. Krishnaprasad,et al.  Equilibria and steering laws for planar formations , 2004, Syst. Control. Lett..

[6]  R. Bishop There is More than One Way to Frame a Curve , 1975 .

[7]  Fumin Zhang,et al.  Control of small formations using shape coordinates , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[8]  Naomi Ehrich Leonard,et al.  Cooperative Filters and Control for Cooperative Exploration , 2010, IEEE Transactions on Automatic Control.

[9]  Carlos Silvestre,et al.  Coordinated Path-Following in the Presence of Communication Losses and Time Delays , 2009, SIAM J. Control. Optim..

[10]  R. Millman,et al.  Elements of Differential Geometry , 2018, Applications of Tensor Analysis in Continuum Mechanics.

[11]  Manfredo P. do Carmo,et al.  Differential geometry of curves and surfaces , 1976 .

[12]  Ilan Shimshoni,et al.  Estimating the principal curvatures and the Darboux frame from real 3D range data , 2002, Proceedings. First International Symposium on 3D Data Processing Visualization and Transmission.

[13]  E. W. Justh,et al.  Natural frames and interacting particles in three dimensions , 2005, Proceedings of the 44th IEEE Conference on Decision and Control.

[14]  Ilan Shimshoni,et al.  Estimating the principal curvatures and the darboux frame from real 3-D range data , 2003, IEEE Trans. Syst. Man Cybern. Part B.

[15]  Gabriel Taubin,et al.  Estimating the tensor of curvature of a surface from a polyhedral approximation , 1995, Proceedings of IEEE International Conference on Computer Vision.

[16]  Alexander Kirillov,et al.  An Introduction to Lie Groups and Lie Algebras , 2008 .

[17]  Andrew B. Kahng,et al.  Cooperative Mobile Robotics: Antecedents and Directions , 1997, Auton. Robots.

[18]  P.V. Reddy,et al.  Motion camouflage in three dimensions , 2006, Proceedings of the 45th IEEE Conference on Decision and Control.

[19]  Andrea L. Bertozzi,et al.  Experimental validation of cooperative environmental boundary tracking with on-board sensors , 2009, 2009 American Control Conference.

[20]  Andrea L. Bertozzi,et al.  Environmental boundary tracking and estimation using multiple autonomous vehicles , 2007, 2007 46th IEEE Conference on Decision and Control.