Anchor Self-Localization Algorithm Based on UWB Ranging and Inertial Measurements  

作　　者：Qin Shi Sihao Zhao Xiaowei Cui Mingquan Lu Mengdi Jia 

机构地区：[1]the Department of Electronic Engineering, Tsinghua University

出　　处：《Tsinghua Science and Technology》2019年第6期728-737,共10页清华大学学报（自然科学版（英文版）

摘　　要：Localization systems utilizing Ultra-WideBand(UWB) have been widely used in dense urban and indoor environments. A moving UWB tag can be located by ranging to fixed UWB anchors whose positions are surveyed in advance. However, manually surveying the anchors is typically a dull and time-consuming process and prone to artificial errors. In this paper, we present an accurate and easy-to-use method for UWB anchor self-localization,using the UWB ranging measurements and readings from a low-cost Inertial Measurement Unit(IMU). The locations of the anchors are automatically estimated by freely moving the tag in the environment. The method is inspired by the Simultaneous Localization And Mapping(SLAM) technique used by the robotics community. A tightly-coupled Error-State Kalman Filter(ESKF) is utilized to fuse UWB and inertial measurements, producing UWB anchor position estimates and six Degrees of Freedom(6 DoF) tag pose estimates. Simulated experiments demonstrate that our proposed method enables accurate self-localization for UWB anchors and smooth tracking of the tag.Localization systems utilizing Ultra-WideBand(UWB) have been widely used in dense urban and indoor environments. A moving UWB tag can be located by ranging to fixed UWB anchors whose positions are surveyed in advance. However, manually surveying the anchors is typically a dull and time-consuming process and prone to artificial errors. In this paper, we present an accurate and easy-to-use method for UWB anchor self-localization,using the UWB ranging measurements and readings from a low-cost Inertial Measurement Unit(IMU). The locations of the anchors are automatically estimated by freely moving the tag in the environment. The method is inspired by the Simultaneous Localization And Mapping(SLAM) technique used by the robotics community. A tightly-coupled Error-State Kalman Filter(ESKF) is utilized to fuse UWB and inertial measurements, producing UWB anchor position estimates and six Degrees of Freedom(6 DoF) tag pose estimates. Simulated experiments demonstrate that our proposed method enables accurate self-localization for UWB anchors and smooth tracking of the tag.

关 键 词：ANCHOR SELF-LOCALIZATION error-state KALMAN filter sensor fusion SIMULTANEOUS localization and mapping 

分 类 号：N[自然科学总论]