Control Theory and Technology

, Volume 16, Issue 2, pp 122–132 | Cite as

Ranging-aided relative navigation of multi-platforms

  • Hai-Long Pei
  • Ruican Xia


This paper proposes a relative attitude and distance estimation algorithm based on pairwise range measurements between vehicles as well as inertial measurement of each platform. The solution of Wahba’s Problem is introduced to compute the relative attitude between multi-platforms with the sampled pairwise ranges, in which the relative distance estimation is derived and the estimation error distributions are analyzed. An extended Kalman filter is designed to fuse the estimated attitude and distance with the inertial measurement of each platform. The relative poses between platforms are determined without any external aided measurement. To show this novelty, a real testbed is constructed by our research lab. And the experiment results are positive.


Multi-vehicles relative navigation Wahba’s Problem pose estimation extended Kalman filter 


Unable to display preview. Download preview PDF.

Unable to display preview. Download preview PDF.


  1. [1]
    D. O. Wheeler, D. P. Koch, J. S. Jackson, et al. Relative navigation of autonomous gps-degraded micro air vehicles. All Faculty Publications. Provo: Ira A. Fulton College of Engineering and Technology, 2017: Google Scholar
  2. [2]
    G. Di Mauro, M. Lawn, R. Bevilacqua. Survey on guidance navigation and control requirements for spacecraft formation flying missions. AIAA Journal of Guidance, Control, and Dynamics, 2018, 41(3): 581–602.CrossRefGoogle Scholar
  3. [3]
    Time Domain. PulsON 440 Module:
  4. [4]
    B. K. P. Horn. Closed-form solution of absolute orientation using unit quaternions. Journal of the Optical Society of America A (Optics and Image Science), 1987, 4(4): 629–646.CrossRefGoogle Scholar
  5. [5]
    D. W. Eggert, A. Lorusso, R. B. Fisher. Estimating 3-D rigid body transformations: A comparison of four major algorithms. Machine Vision and Applications, 1997, 9(5/6): 272–290.CrossRefGoogle Scholar
  6. [6]
    L. Elden, H. Park. A Procrustes problem on the Stiefel manifold. Numerische Mathematik, 1999, 82(4): 599–619.MathSciNetCrossRefzbMATHGoogle Scholar
  7. [7]
    F. L. Markley, J. L. Crassidis. Fundamentals of Spacecraft Attitude Determination and Control. New York: Springer, 2014.CrossRefzbMATHGoogle Scholar
  8. [8]
    M. D. Shuster, S. D. Oh. Three-axis attitude determination from vector observations. Journal of Guidance, Control, and Dynamics, 1981, 4(1): 70–77.CrossRefzbMATHGoogle Scholar
  9. [9]
    J. L. Crassidis, J. L. Junkins. Optimal Estimation of Dynamic Systems. 2nd ed. Boca Raton: CRC Press, 2012.zbMATHGoogle Scholar
  10. [10]
    A. Thomas, Z. Renato, C. John, et al. Q-method extended Kalman filter. Journal of Guidance, Control, and Dynamics, 2015, 38(4): 752–760.CrossRefGoogle Scholar
  11. [11]
    A. M. Fosbury, J. L. Crassidis. Relative navigation of air vehicles. Journal of Guidance, Control, and Dynamics, 2008, 31(4): 824–834.CrossRefGoogle Scholar
  12. [12]
    L. Dorst. First order error propagation of the Procrustes method for 3D attitude estimation. IEEE Transactions on Pattern Analysis and Machine Intelligence, 2005, 27(2): 221–229.CrossRefGoogle Scholar
  13. [13]
    S. P. Chepuri, G. Leus, A. J. Van der Veen. Rigid body localization using sensor networks. IEEE Transactions on Signal Processing, 2014, 62(18): 4911–4924.MathSciNetCrossRefGoogle Scholar

Copyright information

© South China University of Technology, Academy of Mathematics and Systems Science, Chinese Academy of Sciences and Springer-Verlag GmbH Germany, part of Springer Nature 2018

Authors and Affiliations

  1. 1.Key Lab of Autonomous Systems and Networked ControlMinistry of EducationGuangzhouChina
  2. 2.Unmanned System Engineering Center of Guangdong ProvinceGuangzhou GuangdongChina
  3. 3.School of AutomationSouth China University of TechnologyGuangzhou GuangdongChina

Personalised recommendations