Study on angle-only relative navigation for unmanned aerial vehicle formation in GPS-denied environment

Abstract

To satisfy the autonomous relative navigation demand of unmanned aerial vehicle (UAV) formation in a GPS-denied environment, an angle-only relative navigation algorithm is proposed. First, the relative states in 3-dimension space are decoupled into relative motion along the horizontal plane and altitude by applying the relative azimuth between the north-east-down global frame and the body-fixed horizontal frame belonging to UAVs. Second, a relative dynamic and measurement model considering the measurement deviation of sensors are established. This solves the problem of colored noise in a majority of sensors used in practical engineering. Third, a consensus constraint model of relative states is established by introducing a geometric constraint among formation members. Additionally, a consensus-extended Kalman filter is designed. Finally, the angle-only relative navigation method is validated using standard Monte Carlo simulations. The simulation results show that all the states of the system are observable when the observability criterion is satisfied. The relative position accuracy achieved using gyros with a drift rate of 50°/h, accelerometers with 1 mg deviation, and optical cameras with 1° Gaussian white noise is within 10 m (3σ). Additionally, the method proposed in this study can be used to estimate the sensor measurement deviations effectively. Furthermore, it can be potentially applied to improve the absolute navigation accuracy of UAVs.

Keywords

Unmanned aerial vehicle consensus-extended Kalman filter angle-only navigation observability analysis

Get full access to this article

View all access options for this article.

References

Tahir

Böling

Haghbayan

M-H

, et al. Swarms of unmanned aerial vehicles-A survey. J Ind Inf Integr 2019; 16: 100106.

Zhou

Chen

Han

, et al. Multi-UAV cooperative multiple targets assignment based on improved wolf pack algorithm. Navig Position Timing 2022; 9(No. 5): 46–55.

Chung

Paranjape

Dames

, et al. A Survey on aerial swarm robotics. IEEE Trans Robotics 2018; 34(No. 4): 837–855.

Coppola

McGuire

De Wagter

, et al. A survey on swarming with micro air vehicles: fundamental challenges and constraints. Front Robotics AI 2020; 7: 18.

Zhang

. Reviews on unmanned aerial vehicle formation flight. Flight Dyn 2007; 2007(01): 9–11+18.

Zhang

Fang

Mao

, et al. Adaptive sliding-mode controller design for missile cooperative engagement. J Astronautics 2014; 35(6): 700–707.

Yan

Huang

Zhang

. Relative navigation based on inertial navigation/data link ranging. Computer Simulation 2020; 37(05): 55–60+109.

Buechett

. Unscented Kalman filters for range-only cooperative localization of swarms of munitions in three-dimensional flight. Aerospace Science and Technology 2018 85: 259–269.

Shalaby

Cossette

Forbes

, et al. Relative position estimation in multi-agent systems using attitude-coupled range measurements. IEEE Robotics Automation Lett 2021; 6(99): 1–1.

10.

Xiong

Cheong

, et al. Cooperative positioning for low-cost close formation flight based on relative estimation and belief propagation. Aerospace Sci Technol 2020; 106: 106068.

11.

Nguyen

Qiu

Cao

, et al. Single landmark distance-based navigation. IEEE Trans Control Syst Technol 2019; 28(99): 1–8.

12.

Guo

Qiu

Meng

, et al. Ultra-wideband based cooperative relative localization algorithm and experiments for multiple unmanned aerial vehicles in GPS denied environments. Int J Micro Air Vehicles 2017; 9(3): 169–186.

13.

Qiu

Miao

, et al. Ultra-wideband-based localization for quadcopter navigation. Unmanned Syst 2016; 4(1): 23–34.

14.

Cao

Yang

, et al. Accurate position tracking with a single UWB anchor. In: 2020 IEEE International Conference on Robotics and Automation (ICRA), 2020, pp. 2344–2350.

15.

van der Helm

Coppola

McGuire

, et al. On-board range-based relative localization for micro air vehicles in indoor leader-follower flight. Autonomous Robots 2020; 44(3): 415–441.

16.

Gong

Wang

Hao

, et al. Range-based collaborative relative navigation for multiple unmanned aerial vehicles using consensus extended Kalman filter. Aerosp Sci Technol 2021; 112: 106647.

17.

Molina

Juri

Christoph

, et al. Unique 4-DOF relative pose estimation with six distances for UWB/V-SLAM-Based devices. Sensors (Basel, Switzerland) 2019; 19(20): 4366.

18.

Wang

, et al. Error analysis and formation design for double line-of-sight measuring relative navigation method. Acta Aeronautica et Astronautica Sinica 2018; 39(09): 152–166.

19.

Woffinden

Geller

. Optimal orbital rendezvous maneuvering for angles-only navigation. J Guidance, Control Dyn 2009; 32(4): 1382–1387.

20.

Gong

Wang

Hao

, et al. Cooperative relative navigation algorithm for multi-spacecraft close-range formation based. J Astronautics 2021; 42(03): 344–350.

21.

Wang

Guo

Cui

. Roubust sigma-point filtering and its application to relative navigation. Acta Aeronautica et Astronautica Sinica 2010; 31(05): 1024–1029. (in Chinese).

22.

Wang

, et al. Onboard compensation method for gyroscope drift by capturing non-maneuvering window. J Chin Inertial Technol 2020; 28(03): 365–371.

23.

. Research on angles-only relative navigation and autonomous control for space Rendezvous. Ph.D dissertation, Changsha, China: National University of Defense Technology, 2011.

24.

Qin

. Inertial navigation. Beijing Science and Technology Press, 2014.

25.

Wang

Butcher

Tansel

. Space-based relative orbit estimation using information sharing and the consensus kalman filter. J Guidance Control Dyn 2019; 42(3): 491–507.

26.

Wang

Butcher

. Decentralized estimation of spacecraft relative motion using consensus extended Kalman filter. In: 2018 Space Flight Mechanics Meeting, Kissimmee, Florida, 8–12 January, 2018.