Skip to content

Commit 958f529

Browse files
committed
use previous poses' constant velocity estimates for deskewing
1 parent 4cc304e commit 958f529

File tree

1 file changed

+1
-4
lines changed

1 file changed

+1
-4
lines changed

kiss_slam/pipeline.py

Lines changed: 1 addition & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -87,10 +87,7 @@ def _global_mapping(self):
8787

8888
if hasattr(self._dataset, "reset"):
8989
self._dataset.reset()
90-
ref_ground_alignment = map_closures.align_map_to_local_ground(
91-
self.kiss_slam.local_map_graph[0].pcd.point.positions.cpu().numpy(),
92-
self.slam_config.odometry.mapping.voxel_size,
93-
)
90+
ref_ground_alignment = self.kiss_slam.closer.detector.get_ground_alignment_from_id(0)
9491
deskewing_deltas = np.vstack(
9592
(np.eye(4)[None], np.linalg.inv(self.poses[:-1]) @ self.poses[1:])
9693
)

0 commit comments

Comments
 (0)