An integrated localization-navigation scheme for distance-based docking of UAVs

Thien-Minh Nguyen, Zhirong Qiu, Muqing Cao, Lihua Xie

Abstract

In this paper we study the distance-based docking problem of unmanned aerial vehicles (UAVs) by using a single landmark placed at an arbitrarily unknown position. To solve the problem, we propose an integrated estimation-control scheme to simultaneously achieve the relative localization and navigation tasks for discrete-time integrators under bounded velocity: a nonlinear adaptive estimation scheme to estimate the relative position to the landmark, and a delicate control scheme to ensure both the convergence of the estimation and the asymptotic docking at the given landmark. A rigorous proof of convergence is provided by invoking the discrete-time LaSalle's invariance principle, and we also validate our theoretical findings on quadcopters equipped with ultra-wideband ranging sensors and optical flow sensors in a GPS-less environment.

Introduction

In autonomous drone operations, precise localization is the prerequisite for navigation. While GPS or motion-capture systems often provide "ground truth," these signals are frequently unavailable in indoor environments or urban canyons. This paper addresses the "chicken and egg" problem of range-only navigation: a UAV must move to determine a landmark's relative position, but it needs that position to navigate efficiently toward it.

Existing solutions often rely on continuous-time models that are difficult to implement on digital flight controllers or ignore physical constraints like input saturation (maximum speed). This research proposes a discrete-time integrated localization-navigation framework that allows a UAV to dock at an unknown landmark using only distance measurements and basic onboard odometry.

Methods

The proposed scheme integrates a nonlinear adaptive estimator with a bounded controller. The system architecture is designed to handle the interdependency of estimation and control in a single loop.

Block diagram of the integrated localization-navigation scheme showing the feedback loop between the estimator, controller, and UAV.
  1. Adaptive Estimator: This component estimates the landmark's position based on changes in squared distance between time steps. By using a discrete-time formulation, it avoids the complexity of time-varying observers found in continuous-time models.
  2. Bounded Controller: The control signal $u_k$ combines a "docking term" (pointing toward the estimated landmark) and an "excitation term" (inducing circular or oscillatory motion). This excitation is critical; by moving in a curve rather than a straight line, the UAV creates the geometric variety needed for the estimator to triangulate the landmark's position accurately.
  3. Saturation Handling: The system includes a projection operator to ensure commanded velocities never exceed the physical limits of the UAV. Stability and convergence are rigorously proven using the discrete-time LaSalle's invariance principle.

Experimental Results

The framework was validated through both numerical simulations and real-world flight tests in GPS-denied environments.

Trajectory plot showing the UAV (red) converging toward the target (green) while performing exploratory oscillatory motions to improve estimation (blue).

Key findings include:

  • Movement as Information: Simulations demonstrate that the circular component of the controller is essential for accuracy. Without it, the landmark's position remains unobservable if the drone flies in a perfectly straight line.
  • Convergence: In real-world tests using quadcopters equipped with Ultra-Wideband (UWB) ranging sensors and optical flow sensors, the UAVs consistently reduced their distance to the landmark from ~35 meters to a terminal safety distance of 1.5 meters within 80–100 seconds.
  • Robustness: The estimator successfully tracked landmarks even when they were subjected to slow drift, demonstrating the practical utility of the adaptive approach.

Conclusion

This research provides a mathematically rigorous yet practical solution for UAV docking in GPS-denied environments. By fusing estimation and control into a discrete-time framework that respects physical velocity limits, the authors have created a "plug-and-play" algorithm for modern microcontrollers. Future work will look to extend these 2D planar results into full 3D navigation and multi-landmark environments.

Summary updated

Abstract

In this paper we study the distance-based docking problem of unmanned aerial vehicles (UAVs) by using a single landmark placed at an arbitrarily unknown position. To solve the problem, we propose an integrated estimation-control scheme to simultaneously achieve the relative localization and navigation tasks for discrete-time integrators under bounded velocity: a nonlinear adaptive estimation scheme to estimate the relative position to the landmark, and a delicate control scheme to ensure both the convergence of the estimation and the asymptotic docking at the given landmark. A rigorous proof of convergence is provided by invoking the discrete-time LaSalle's invariance principle, and we also validate our theoretical findings on quadcopters equipped with ultra-wideband ranging sensors and optical flow sensors in a GPS-less environment.
BibTeX
@inproceedings{nguyen2018integrated,
  author = {Thien-Minh Nguyen and Zhirong Qiu and Muqing Cao and Thien Hoang Nguyen and Lihua Xie},
  title = {{An integrated localization-navigation scheme for distance-based docking of UAVs}},
  booktitle = {IEEE/RSJ International Conference on Intelligent Robots and Systems},
  year = {2018},
  url = {https://openreview.net/forum?id=ztq4kVPTZnv},
}
Figure