Papers
Topics
Authors
Recent
Search
2000 character limit reached

Dual-IMU State Estimation for Relative Localization of Two Mobile Agents

Published 28 Feb 2024 in cs.RO | (2402.18394v3)

Abstract: In this paper, we address the problem of relative localization of two mobile agents. Specifically, we consider the Dual-IMU system, where each agent is equipped with one IMU, and employs relative pose observations between them. Previous works, however, typically assumed known ego motion and ignored biases of the IMUs. Instead, we study the most general case of unknown biases for both IMUs. Besides the derivation of dynamic model equations of the proposed system, we focus on the observability analysis, for the observability under general motion and the unobservable directions arising from various special motions. Through numerical simulations, we validate our key observability findings and examine their impact on the estimation accuracy and consistency. Finally, the system is implemented to achieve effective relative localization of an HMD with respect to a vehicle moving in the real world.

Definition Search Book Streamline Icon: https://streamlinehq.com
References (35)
  1. D. Fox, W. Burgard, H. Kruppa, and S. Thrun, “Collaborative multi-robot localization,” in Proc. of the 23rd German Conference on Artificial Intelligence.   Springer, 1999, pp. 15–26.
  2. L. Freda and G. Oriolo, “Vision-based interception of a moving target with a nonholonomic mobile robot,” Robotics and Autonomous Systems, vol. 55, no. 6, pp. 419–432, 2007.
  3. D. B. Wilson, A. H. Göktoğan, and S. Sukkarieh, “A vision based relative navigation framework for formation flight,” in Proc. of the IEEE International Conference on Robotics and Automation (ICRA), 2014, pp. 4988–4995.
  4. J. Haeling, C. Winkler, S. Leenders, D. Keßelheim, A. Hildebrand, and M. Necker, “In-car 6-dof mixed reality for rear-seat and co-driver entertainment,” in Proc. of the IEEE Conference on Virtual Reality and 3D User Interfaces (VR), 2018, pp. 757–758.
  5. X. S. Zhou and S. I. Roumeliotis, “Determining 3-d relative transformations for any combination of range and bearing measurements,” IEEE Transactions on Robotics, vol. 29, no. 2, pp. 458–474, 2012.
  6. R. Hermann and A. Krener, “Nonlinear controllability and observability,” IEEE Transactions on automatic control, vol. 22, no. 5, pp. 728–740, 1977.
  7. G. P. Huang, A. I. Mourikis, and S. I. Roumeliotis, “Observability-based rules for designing consistent ekf slam estimators,” The International Journal of Robotics Research, vol. 29, no. 5, pp. 502–528, 2010.
  8. E.-H. Shin and N. El-Sheimy, “Accuracy improvement of low cost ins/gps for land applications,” in Proc. of the national technical meeting of the institute of navigation, 2002, pp. 146–157.
  9. W. Wen, X. Bai, Y. C. Kan, and L.-T. Hsu, “Tightly coupled gnss/ins integration via factor graph and aided by fish-eye camera,” IEEE Transactions on Vehicular Technology, vol. 68, no. 11, pp. 10 651–10 662, 2019.
  10. A. I. Mourikis and S. I. Roumeliotis, “A multi-state constraint kalman filter for vision-aided inertial navigation,” in Proc. of the IEEE International Conference on Robotics and Automation (ICRA), 2007, pp. 3565–3572.
  11. T. Qin, P. Li, and S. Shen, “Vins-mono: A robust and versatile monocular visual-inertial state estimator,” IEEE Transactions on Robotics, vol. 34, no. 4, pp. 1004–1020, 2018.
  12. C. Campos, R. Elvira, J. J. G. Rodríguez, J. M. Montiel, and J. D. Tardós, “Orb-slam3: An accurate open-source library for visual, visual–inertial, and multimap slam,” IEEE Transactions on Robotics, vol. 37, no. 6, pp. 1874–1890, 2021.
  13. G. Huang, “Visual-inertial navigation: A concise review,” in Proc. of the IEEE International Conference on Robotics and Automation (ICRA), 2019, pp. 9572–9582.
  14. T. Shan, B. Englot, D. Meyers, W. Wang, C. Ratti, and D. Rus, “Lio-sam: Tightly-coupled lidar inertial odometry via smoothing and mapping,” in Proc. of the IEEE/RSJ international conference on intelligent robots and systems (IROS), 2020, pp. 5135–5142.
  15. W. Xu, Y. Cai, D. He, J. Lin, and F. Zhang, “Fast-lio2: Fast direct lidar-inertial odometry,” IEEE Transactions on Robotics, vol. 38, no. 4, pp. 2053–2073, 2022.
  16. S. I. Roumeliotis and G. A. Bekey, “Distributed multirobot localization,” IEEE transactions on robotics and automation, vol. 18, no. 5, pp. 781–795, 2002.
  17. A. Martinelli, A. Oliva, and B. Mourrain, “Cooperative visual-inertial sensor fusion: The analytic solution,” IEEE Robotics and Automation Letters, vol. 4, no. 2, pp. 453–460, 2019.
  18. B. Kim, M. Kaess, L. Fletcher, J. Leonard, A. Bachrach, N. Roy, and S. Teller, “Multiple relative pose graphs for robust cooperative mapping,” in Proc. of the IEEE International Conference on Robotics and Automation (ICRA), 2010, pp. 3185–3192.
  19. S. Choudhary, L. Carlone, C. Nieto, J. Rogers, H. I. Christensen, and F. Dellaert, “Distributed mapping with privacy and communication constraints: Lightweight algorithms and object-based models,” The International Journal of Robotics Research, vol. 36, no. 12, pp. 1286–1311, 2017.
  20. C.-S. Jao, Y. Wang, and A. M. Shkel, “Pedestrian inertial navigation system augmented by vision-based foot-to-foot relative position measurements,” in Proc. of the IEEE/ION Position, Location and Navigation Symposium (PLANS), 2020, pp. 900–907.
  21. A. M. Fosbury and J. L. Crassidis, “Relative navigation of air vehicles,” Journal of Guidance, Control, and Dynamics, vol. 31, no. 4, pp. 824–834, 2008.
  22. F. Aghili and C.-Y. Su, “Robust relative navigation by integration of icp and adaptive kalman filter using laser scanner and imu,” IEEE/ASME Transactions on Mechatronics, vol. 21, no. 4, pp. 2015–2026, 2016.
  23. A. Martinelli, “Vision and imu data fusion: Closed-form solutions for attitude, speed, absolute scale, and bias determination,” IEEE Transactions on Robotics, vol. 28, no. 1, pp. 44–60, 2012.
  24. J. A. Hesch, D. G. Kottas, S. L. Bowman, and S. I. Roumeliotis, “Consistency analysis and improvement of vision-aided inertial navigation,” IEEE Transactions on Robotics, vol. 30, no. 1, pp. 158–176, 2013.
  25. A. Martinelli, “Vision and imu data fusion: Closed-form solutions for attitude, speed, absolute scale, and bias determination,” IEEE Transactions on Robotics, vol. 28, no. 1, pp. 44–60, 2011.
  26. K. J. Wu, C. X. Guo, G. Georgiou, and S. I. Roumeliotis, “Vins on wheels,” in Proc. of the IEEE International Conference on Robotics and Automation (ICRA), 2017, pp. 5155–5162.
  27. G. P. Huang, A. I. Mourikis, and S. I. Roumeliotis, “A first-estimates jacobian ekf for improving slam consistency,” in Proc. of the Experimental Robotics: The Eleventh International Symposium.   Springer, 2009, pp. 373–382.
  28. C. Chen, P. Geneva, Y. Peng, W. Lee, and G. Huang, “Optimization-based vins: Consistency, marginalization, and fej,” in Proc. of the IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2023.
  29. G. P. Huang, N. Trawny, A. I. Mourikis, and S. I. Roumeliotis, “Observability-based consistent ekf estimators for multi-robot cooperative localization,” Autonomous Robots, vol. 30, pp. 99–122, 2011.
  30. A. Cristofaro and A. Martinelli, “3d cooperative localization and mapping: Observability analysis,” in Proc. of the American Control Conference.   IEEE, 2011, pp. 1630–1635.
  31. J. Sola, “Quaternion kinematics for the error-state kalman filter,” arXiv preprint arXiv:1711.02508, 2017.
  32. R. Kümmerle, G. Grisetti, H. Strasdat, K. Konolige, and W. Burgard, “g2o: A general framework for graph optimization,” in Proc. of the IEEE International Conference on Robotics and Automation (ICRA), 2011, pp. 3607–3613.
  33. Z. Chen, K. Jiang, and J. C. Hung, “Local observability matrix and its application to observability analyses,” in Proc. of the IECON’90: 16th Annual Conference of IEEE Industrial Electronics Society, 1990, pp. 100–103.
  34. “Opencv modules: Detection of aruco markers,” https://docs.opencv.org/4.x/d5/dae/tutorial˙aruco˙detection.html.
  35. “Optitrack,” https://optitrack.com/.

Summary

No one has generated a summary of this paper yet.

Sign Up to Summarize

Paper to Video (Beta)

No one has generated a video about this paper yet.

Sign Up to Generate All Videos Subscribe on YouTube

Whiteboard

No one has generated a whiteboard explanation for this paper yet.

Sign Up to Generate

Open Problems

We haven't generated a list of open problems mentioned in this paper yet.

Generate Now

Continue Learning

We haven't generated follow-up questions for this paper yet.

Generate Now

Authors (3)

  1. Wenqian Lai 
  2. Ruonan Guo 
  3. Kejian J. Wu 

Collections

Sign up for free to add this paper to one or more collections.

Sign Up