beam_slam
beam_slam copied to clipboard
Fix visual path init
The current visual path init produces a path in a bad frame and the gravity estimate is wrong as a result