laser_localization is a 3D LiDAR localization algorithm applied to small area scenes, typical application scenarios are industrial parks, neighborhoods or substations, etc. It combines 3D laser point cloud, wheeled odometer and IMU angle information to achieve high precision real-time positioning. A branch-and-bound search algorithm is used for global positioning, while NDT matching is used for local point clouds and global maps. The wheeled odometer and IMU angle information are used as the motion a priori parameters of the matching algorithm to accelerate laser matching and avoid falling into local optimum.

Demo Video

sudo apt install ros-YOUR_DISTRO-desktop ros-YOUR_DISTRO-pcl

ROS2 Install WIKI

Clone the repository and build:

cd ~/catkin_ws/src
git clone https://github.com/linyicheng1/laser_localization.git
cd ../
colcon build 
source ~/catkin_ws/install/setup.bash

Download KITTI dataset： BaiDu Driver|Google Driver

Modify the path code in ./launch/kitti_test.py：

61| parameters=[
62|     {"kitti_path": "${YOUR_PATH}"}, 
63| ]

40| {"global_map": "${YOUR_PATH}"},

run cmd in shell：

ros2 launch ~/catkin_ws/src/laser_localization/launch/kitti_test.py

Point cloud maps can be constructed using the current mainstream 3D laser SLAM algorithm and saved at . /map/map.pcd.

Recommended 3D point cloud algorithm: hdl_graph_slam、ALOAM、LIO-SAM

The single laser mode requires only one 3d radar and can be used for rapid deployment to operate in low speed carts. The relative transformation relationship of base_link->laser in the tf transformation tree needs to be provided, and the 3d point cloud data topic pointcloud2 needs to be provided.

run cmd:

ros2 launch ~/catkin_ws/src/laser_localization/launch/single_laser.py

Multi-sensor fusion positioning mode improves accuracy and speed, but requires more information.

1. The odometer data, odom->base_link in the tf transformation tree, is calculated for the wheel odometer. The calculation of the odometer requires calibration of the robot's wheel radius, calibration of the wheel distance over 10m straight ahead, and multiple rotations and calibration of the axis distance.

Run in shell:

ros2 launch ~/catkin_ws/src/laser_localization/launch/localization.py

• Laser odometer + laser point cloud with map matching, laser positioning solution using only 3d radar, can reach about 10-15hz output, very easy to deploy at low speed using directly.

• Laser positioning is separated from wheel odometer, which can selectively use wheel odometer information to provide a priori for laser matching, effectively avoiding the influence of wheel slip and other disturbances.

• Provide matching confidence information and real-time feedback on current positioning status.

• Provide global positioning to obtain the initial value method, and include the function of program power down to save the current position.

The source code is released under GPLv3 license.