The International Archives of the Photogrammetry, Remote Sensing and Spatial Information Sciences
Download
Publications Copernicus
Download
Citation
Articles | Volume XLVI-3/W1-2022
Int. Arch. Photogramm. Remote Sens. Spatial Inf. Sci., XLVI-3/W1-2022, 263–269, 2022
https://doi.org/10.5194/isprs-archives-XLVI-3-W1-2022-263-2022
Int. Arch. Photogramm. Remote Sens. Spatial Inf. Sci., XLVI-3/W1-2022, 263–269, 2022
https://doi.org/10.5194/isprs-archives-XLVI-3-W1-2022-263-2022
 
22 Apr 2022
22 Apr 2022

LEADER-FOLLOWER COOPERATIVE LOCALIZATION BASED ON VIO / UWB LOOSE COUPLING FOR AGV GROUP

H. Zhang1,2, Z. Li1, S. Zheng1,2, Y. Liu1,2, P. Zheng1,2, and X. Zou1,2,3 H. Zhang et al.
  • 1The State Key Laboratory of Transducer Technology, Aerospace Information Research Institute, Chinese Academy of Sciences, Beijing, 100010, China
  • 2School of Electronic, Electrical and Communication Engineering, University of Chinese Academy of Sciences, Beijing, 100010, China
  • 3QiLu Research Institute, Aerospace Information Research Institute Chinese Academy of Sciences, Jinan, 250000, China

Keywords: Cooperative localization, Leader-Follower, VIO, UWB, Graph optimization

Abstract. In this paper, we propose a Leader-Follower cooperative localization system for AGV group, which equipped with camera/IMU/UWB anchors as the Leader and IMU/UWB tags as the Follower. Firstly, we introduce the plane constraint with SE(2) into VIO to suppress drift in 2D motion; Secondly, the Follower receives the Leader's VIO pose and calculates the relative pose through the multiple groups of UWB ranging. The algorithm of Leader and Follower is decoupled, which means Leader can choose different self_localization technology to adapt to different scenario, such as LiDAR-Inertial Odometry(LIO), GNSS, etc. In the Follower, a tightly coupled graph optimization based algorithm to fuse UWB ranging and IMU is proposed to estimate its relative pose to the Leader. Lastly, extensive field experiment shows the system can realize omni-directional cooperative positioning in indoor and outdoor environments and the accuracy of collaborative positioning reaches centimeter level.