Cooperative Localization of Low-cost UAV Using Relative Range Measurements in Multi-UAV Flight

This paper investigates the fault-tolerant localization problem when the GPS receiver of one low-cost UAV in a fleet works improperly due to failure. A cooperative localization algorithm based on inter-UAV range measurements is proposed. Similar to the principle of GPS, the UAV’s location in 2D horizontal plane can be determined using the relative ranges to the other three UAVs at known location in inertial coordinate system. Considering the fact that accuracy of UAV’s location is worse than a positioning satellite, a Kalman filter is employed respectively on the three UAVs to estimate their locations with a constant velocity (CV) model during each computing cycle. Based on the estimations and the geometric relationship of the relative ranges, the location of UAV with GPS communication malfunction is calculated. Furthermore, in order to know well about the accuracy and statistic characteristics of calculation result, the horizontal dilution of positioning (HDOP) at length is analyzed through constructing the error equations. Taking the calculation results as observation data, another Kalman filter is applied to the UAV with malfunction, which can calculate the variance of observation noise adaptively on real-time. At last, by programming in Matlab/Simulink, a simulation example with four UAVs in a 2D scenario is shown to evaluate the effectiveness of the proposed algorithm.

[1]  Randal W. Beard,et al.  A feedback architecture for formation control , 2000, Proceedings of the 2000 American Control Conference. ACC (IEEE Cat. No.00CH36334).

[2]  Yong Li,et al.  Low-cost tightly coupled GPS / INS integration based on a nonlinear Kalman filtering design , 2006 .

[3]  Timothy W. McLain,et al.  Autonomous Vehicle Technologies for Small Fixed Wing UAVs , 2003 .

[4]  John D'Azzo,et al.  Close formation flight control , 1999 .

[5]  Demoz Gebre-Egziabher,et al.  An Inexpensive DME-Aided Dead Reckoning Navigator , 2003 .

[6]  Jonathan P. How,et al.  Cooperative path planning for multiple UAVs in dynamic and uncertain environments , 2002, Proceedings of the 41st IEEE Conference on Decision and Control, 2002..

[7]  Timothy W. McLain,et al.  Coordinated target assignment and intercept for unmanned air vehicles , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[8]  Randal W. Beard,et al.  A coordination architecture for spacecraft formation control , 2001, IEEE Trans. Control. Syst. Technol..

[9]  D. Gebre-Egziabher,et al.  A low-cost GPS/inertial attitude heading reference system (AHRS) for general aviation applications , 1998, IEEE 1998 Position Location and Navigation Symposium (Cat. No.98CH36153).

[10]  Wei Kang,et al.  Co-ordinated attitude control of multi-satellite systems† , 2002 .

[11]  Timothy W. McLain,et al.  Autonomous Vehicle Technologies for Small Fixed-Wing UAVs , 2003, J. Aerosp. Comput. Inf. Commun..

[12]  R. D'Andrea,et al.  Distributed control of close formation flight , 2002, Proceedings of the 41st IEEE Conference on Decision and Control, 2002..

[13]  Dong-Hwan Hwang,et al.  Attitude determination GPS/INS integrated navigation system with FDI algorithm for a UAV , 2005 .

[14]  P. Wang,et al.  Coordination and control of multiple microspacecraft moving in formation , 1996 .

[15]  Gérard Lachapelle,et al.  Attitude Determination with GPS-Aided Inertial Navigation Systems , 2000 .

[16]  Jonathan P. How,et al.  COORDINATION AND CONTROL OF MULTIPLE UAVs , 2002 .

[17]  X. R. Li,et al.  Survey of maneuvering target tracking. Part I. Dynamic models , 2003 .

[18]  Guoqiang Mao,et al.  Design of an Extended Kalman Filter for UAV Localization , 2007, 2007 Information, Decision and Control.

[19]  Rafael F. Rincon,et al.  Lightweight linear broadband antennas enabling small UAV wing systems and space flight nanosat concept , 2004, IGARSS 2004. 2004 IEEE International Geoscience and Remote Sensing Symposium.

[20]  G. Inalhan,et al.  Decentralized overlapping control of a formation of unmanned aerial vehicles , 2002, Proceedings of the 41st IEEE Conference on Decision and Control, 2002..

[21]  Mohinder S. Grewal,et al.  Global Positioning Systems, Inertial Navigation, and Integration , 2000 .