融合多棱镜式雷达/IMU/RTK的轨道车辆高精度实时定位与建图

Real Time Localization and Mapping Integrating Multiple Prism LiDARs/IMU/RTK on Railway Locomotive

  • 摘要: 传统铁路基础设施维护手段单一,依赖于作业车辆上的工程人员进行手动操作,耗费大量人力物力。作为一种多尺度、多概率及长周期的数字映射方案,数字孪生系统近年来在工程建设领域发展迅速。为了推动轨道交通领域的数字孪生建设,设计了一种基于轨道车辆的高精度同时定位与建图(simultaneous localization and mapping, SLAM)方案。不同于传统移动测量方法需要高精度三维激光扫描仪、高精度惯性测量单元(inertial measurement unit,IMU)、实时动态差分定位(real time kinematic,RTK)以及复杂的后处理手段,该方案基于因子图优化的紧耦合方案,融合多个棱镜式雷达、IMU及RTK观测,实现了实时建图可视化。经过超300 km的场景验证,发现所提方案在良好环境下可以达到厘米级定位精度,实时输出的建图结果中可清晰观测到各种轨道特征。

     

    Abstract:
      Objectives  The current railway maintenance method is unitary and simple, which is a human force intensive work, requiring tedious and interminable manual check from professional technicians. As a multi-scale, multi-probability and long-term digital representation approach, the digital-twin has seen a rising popularity in engineering construction. Inspired by the convenience of digital-twin, this paper designs a simultaneous localization and mapping (SLAM) system for railway locomotives.
      Methods  Unlike traditional mobile mapping system which demands high precision three-dimensional laser scanning, inertial measurement unit (IMU) / real time kinematic (RTK), as well as complicated post-processing methods, our solution is capable of real time mapping and odometry visualization through constructed factor graph. The factor graph is a bipartite graph with two node types: Factor nodes and variables nodes, and they are always connected by edges. A new variable node is added to the graph when the pose displacements exceed a certain threshold, then the factor graph is optimized upon the insertion. We use three types of factors for graph construction: IMU preintegration factors, light detection and ranging (LiDAR) odometry factors, RTK factors.
      Results and Conclusions  The real time performance is further achieved through sliding window optimization. Under more than 300 km field test in various environments, our approach can achieve centimeter-lever positioning accuracy in feature rich and low speed cases, and the structures are clearly visible in the real time mapping result.

     

/

返回文章
返回