How liangheming/voxelmapplus_fastlio2 works
FastLIO2-based ROS1 LiDAR-inertial mapping with voxel-plane mapping and an optional STD loop-closure/pose-graph workflow. The principal flow synchronizes Livox and IMU data, estimates motion and builds a map, then can pass odometry-aligned clouds into loop detection and pose-graph optimization. README capabilities include plane fusion and LRU map management. Some runtime calls and configuration wiring are only partially sampled; edges are limited to shown references/calls or README statements.
Main entry points: lio_node.cpp LIO ROS node · lio_builder.cpp LIO processing · pgo_node.cpp Loop and pose graph · ieskf.cpp Iterated Kalman filter
Components 15
Sensor ingestion
- LIO ROS node
voxel_plus/src/lio_node.cpp - Sensor synchronization
voxel_plus/src/lio_node.cpp
LIO mapping
- LIO processing
voxel_plus/src/map_builder/lio_builder.cpp - Iterated Kalman filter
voxel_plus/src/map_builder/ieskf.cpp - Voxel plane map
voxel_plus/src/map_builder/voxel_map.cpp - Odometry and clouds
voxel_plus/src/lio_node.cpp
Loop closure
- Loop and pose graph
std_matcher/src/pgo_node.cpp - STD descriptors
std_matcher/src/std_manager/descriptor.cpp
Shared support
- Livox conversion
voxel_plus/src/utils.cpp - LIO data types
voxel_plus/src/map_builder/commons.h - Cloud with odometry
interface/msg/PointCloudWithOdom.msg
Other components
- Livox LiDAR
- IMU
- ROS bag playback
- ROS visualization
Connections 15
- Livox LiDAR → LIO ROS node: publishes scans
README.md - IMU → LIO ROS node: publishes measurements
voxel_plus/src/lio_node.cpp - ROS bag playback → Livox LiDAR: plays recorded data
README.md - LIO ROS node → Livox conversion: converts scans
voxel_plus/src/lio_node.cpp - LIO ROS node → Sensor synchronization: buffers and synchronizes
voxel_plus/src/lio_node.cpp - LIO ROS node → LIO processing: processes synchronized data
voxel_plus/src/lio_node.cpp - LIO processing → Iterated Kalman filter: predicts and updates
voxel_plus/src/map_builder/lio_builder.cpp - LIO processing → Voxel plane map: uses map
- LIO processing → LIO data types: uses shared types
- LIO ROS node → Odometry and clouds: publishes results
voxel_plus/src/lio_node.cpp - Odometry and clouds → Cloud with odometry: packages cloud and pose
voxel_plus/src/lio_node.cpp - Odometry and clouds → ROS visualization: publishes map and clouds
voxel_plus/src/lio_node.cpp - Odometry and clouds → Loop and pose graph: provides loop input
std_matcher/src/pgo_node.cpp - Loop and pose graph → STD descriptors: uses STD manager
std_matcher/src/pgo_node.cpp - Loop and pose graph → ROS visualization: publishes paths and constraints
std_matcher/src/pgo_node.cpp