hdl_localization hdl_localization

Real-time 3D localization using a (velodyne) 3D LIDAR

hdl_localization 是一个基于 ROS 的实时 3D 激光雷达定位开源项目，专为 Velodyne HDL32e、VLP16 等 3D LiDAR 设计，核心解决在已知全局地图中实现高精度、低延迟的位姿估计问题。该项目采用无迹卡尔曼滤波（UKF）框架，首先利用 LiDAR 内置的 IMU 数据预测传感器初始位姿，随后通过多线程 NDT（正态分布变换）扫描匹配，将实时点云与全局地图进行配准，从而修正预测位姿。若 IMU 数据不可用，系统会自动切换至恒速运动模型，保证鲁棒性。技术栈上，项目依赖 PCL、OpenMP 实现点云处理与并行加速，并集成了 ndt_omp 和 fast_gicp 等高效配准库，同时支持 CUDA 加速的 NDT 计算，进一步提升性能。主要特点包括：实时性高，适合车载或机器人平台；提供 /odom、/aligned_points 等话题输出位姿与对齐点云，以及 /relocalize 服务支持全局重定位；参数高度可配置，用户可通过 launch 文件调整扫描匹配策略。适用场景涵盖自动驾驶、移动机器人导航、仓储物流等需要长期稳定定位的环境。例如，在户外大范围场景中，项目提供的示例 bag 文件可演示从全局定位到持续跟踪的完整流程。此外，项目与 hdl_graph_slam、hdl_global_localization 等包形成生态，便于构建从建图到定位的完整解决方案。对于 CPU 占用过高的情况，可通过调整 ndt_neighbor_search_method 为 DIRECT1 换取速度与稳定性的平衡。