Skip to main content

Towards Resilient Autonomous Navigation of Drones

Part of the Springer Proceedings in Advanced Robotics book series (SPAR,volume 20)


Robots and particularly drones are especially useful in exploring extreme environments that pose hazards to humans. To ensure safe operations in these situations, usually perceptually degraded and without good GNSS, it is critical to have a reliable and robust state estimation solution. The main body of literature in robot state estimation focuses on developing complex algorithms favoring accuracy. Typically, these approaches rely on a strong underlying assumption: the main estimation engine will not fail during operation. In contrast, we propose an architecture that pursues robustness in state estimation by considering redundancy and heterogeneity in both sensing and estimation algorithms. The architecture is designed to expect and detect failures and adapt the behavior of the system to ensure safety. To this end, we present HeRO (Heterogeneous Redundant Odometry): a stack of estimation algorithms running in parallel supervised by a resiliency logic. This logic carries out three main functions: a) perform confidence tests both in data quality and algorithm health; b) re-initialize those algorithms that might be malfunctioning; c) generate a smooth state estimate by multiplexing the inputs based on their quality. The state and quality estimates are used by the guidance and control modules to adapt the mobility behaviors of the system. The validation and utility of the approach are shown with real experiments on a flying robot for the use case of autonomous exploration of subterranean environments, with particular results from the STIX event of the DARPA Subterranean Challenge.

A. Santamaria-Navarro and R. Thakker contributed equally to this manuscript.

The paper has supplementary material including a video showing experimental results of the methods presented in the paper.

Copyright 2019 California Institute of Technology. U.S. Government sponsorship acknowledged.

This is a preview of subscription content, access via your institution.

Buying options

USD   29.95
Price excludes VAT (USA)
  • DOI: 10.1007/978-3-030-95459-8_57
  • Chapter length: 16 pages
  • Instant PDF download
  • Readable on all devices
  • Own it forever
  • Exclusive offer for individuals only
  • Tax calculation will be finalised during checkout
USD   299.00
Price excludes VAT (USA)
  • ISBN: 978-3-030-95459-8
  • Instant PDF download
  • Readable on all devices
  • Own it forever
  • Exclusive offer for individuals only
  • Tax calculation will be finalised during checkout
Hardcover Book
USD   379.99
Price excludes VAT (USA)
Fig. 1.
Fig. 2.
Fig. 3.
Fig. 4.
Fig. 5.
Fig. 6.
Fig. 7.
Fig. 8.


  1. 1.

  2. 2.

  3. 3.

  4. 4.

  5. 5.

  6. 6.


  1. Carnevale, D., Martinelli, F.: State estimation for robots with complementary redundant sensors. Int. J. Adv. Robot. Syst. 12(10), 138 (2015)

    Google Scholar 

  2. Falanga, D., Foehn, P., Lu, P., Scaramuzza, D.: PAMPC: perception-aware model predictive control for quadrotors. In: IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 1–8 (2018)

    Google Scholar 

  3. Florence, P., Carter, J., Tedrake, R.: Integrated perception and control at high speed: evaluating collision avoidance maneuvers without maps. In: Workshop on the Algorithmic Foundations of Robotics (WAFR) (2016)

    Google Scholar 

  4. Geiger, A., Lenz, P., Urtasun, R.: Are we ready for autonomous driving? The kitti vision benchmark suite. In: IEEE Conference on Computer Vision and Pattern Recognition, pp. 3354–3361 (2012)

    Google Scholar 

  5. Gosala, N., et al: Redundant perception and state estimation for reliable autonomous racing. In: IEEE International Conference on Robotics and Automation, pp. 6561–6567 (2019)

    Google Scholar 

  6. Kim, J., Lee, C., Shim, H., Eun, Y., Seo, J.H.: Detection of sensor attack and resilient state estimation for uniformly observable nonlinear systems having redundant sensors. IEEE Trans. Autom. Control 64(3), 1162–1169 (2019)

    Google Scholar 

  7. Morrell, B., et al.: Comparison of trajectory optimization algorithms for high-speed quadrotor flight near obstacles. IEEE Robot. Autom. Lett. 3(4), 4399–4406 (2018)

    Google Scholar 

  8. Mur-Artal, R., Tardós, J.D.: ORB-SLAM2: an open-source slam system for monocular, stereo, and RGB-D cameras. IEEE Trans. Robot. 33(5), 1255–1262 (2017)

    Google Scholar 

  9. Nobili, S., et al.: Heterogeneous sensor fusion for accurate state estimation of dynamic legged robots. In: Robotics: Science and Systems Foundation (2017)

    Google Scholar 

  10. Rollinson, D., Choset, H., Tully, S.: Robust state estimation with redundant proprioceptive sensors. In: ASME 2013 Dynamic Systems and Control Conference (2013)

    Google Scholar 

  11. Santamaria-Navarro, A., Loianno, G., Solà, J., Kumar, V., Andrade-Cetto, J.: Autonomous navigation of micro aerial vehicles using high-rate and low-cost sensors. Autonom. Robots 42(6), 1263–1280 (2018)

    Google Scholar 

  12. Tomic, T., et al.: Toward a fully autonomous UAV: research platform for indoor and outdoor urban search and rescue. IEEE Robot. Autom. Magaz. 19(3), 46–56 (2012)

    Google Scholar 

  13. Weiss, S., Achtelik, M.W., Lynen, S., Achtelik, M.C., Kneip, L., Chli, M., Siegwart, R.: Monocular vision for long-term micro aerial vehicle state estimation: a compendium. J. Field Robot. 30(5), 803–831 (2013)

    Google Scholar 

  14. Zhang, J., Singh, S.: Visual-lidar odometry and mapping: low-drift, robust, and fast. In: IEEE Int. Conf. Robot. Autom. 2174–2181 (2015)

    Google Scholar 

Download references


This research was carried out at the Jet Propulsion Laboratory, California Institute of Technology, under a contract with the National Aeronautics and Space Administration.

Author information

Authors and Affiliations


Corresponding author

Correspondence to Angel Santamaria-Navarro .

Editor information

Editors and Affiliations

1 Electronic supplementary material

Below is the link to the electronic supplementary material.

Supplementary material 1 (zip 6917 KB)

Rights and permissions

Reprints and Permissions

Copyright information

© 2022 The Author(s), under exclusive license to Springer Nature Switzerland AG

About this paper

Verify currency and authenticity via CrossMark

Cite this paper

Santamaria-Navarro, A., Thakker, R., Fan, D.D., Morrell, B., Agha-mohammadi, Aa. (2022). Towards Resilient Autonomous Navigation of Drones. In: Asfour, T., Yoshida, E., Park, J., Christensen, H., Khatib, O. (eds) Robotics Research. ISRR 2019. Springer Proceedings in Advanced Robotics, vol 20. Springer, Cham.

Download citation