Skip to content

Add FASTLIO2 with logging and auto-relocalization#1

Closed
baishibona wants to merge 1 commit intoVectorRobotics:jazzyfrom
baishibona:jazzy
Closed

Add FASTLIO2 with logging and auto-relocalization#1
baishibona wants to merge 1 commit intoVectorRobotics:jazzyfrom
baishibona:jazzy

Conversation

@baishibona
Copy link

Summary

  • Added FASTLIO2_ROS2 package
  • Added logging for odometry, relocalization events, and TF
  • Added auto-relocalization on startup feature

A few things before you can run it:

To enable auto-relocalization, edit localizer.yaml:
  auto_relocalize: true
  default_pcd_path: "/path/to/your/map.pcd"
  initial_x: 1.0
  initial_y: 2.0
  initial_z: 0.0
  initial_yaw: 1.57  # radians

Expected Log Output

  [INFO] [localizer_node]: [AUTO-RELOC] Enabled with map: /path/to/map.pcd
  [INFO] [localizer_node]: [AUTO-RELOC] Initial pose: x=1.000, y=2.000, z=0.000, yaw=1.570
  ...
  [INFO] [localizer_node]: [AUTO-RELOC] Triggering relocalization...
  [INFO] [localizer_node]: [AUTO-RELOC] Map: /path/to/map.pcd
  [INFO] [localizer_node]: [AUTO-RELOC] Map loaded successfully
  [INFO] [localizer_node]: [AUTO-RELOC] Initial guess set, waiting for localization...
  [INFO] [localizer_node]: [RELOCALIZE] SUCCESS - Localization converged

Usage:

  FASTLIO2 only (SLAM):
  ros2 launch fastlio2 lio_launch.py

  FASTLIO2 + Localizer (with relocalization):
  ros2 launch localizer localizer_launch.py

  Both launch files include rviz2 automatically.
@alexlin2 alexlin2 closed this Mar 23, 2026
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

3 participants