From 20dadd11911aa8a68e672f245980ed4bc49d298f Mon Sep 17 00:00:00 2001 From: Benedikt Mersch Date: Sun, 6 Apr 2025 11:13:10 +0200 Subject: [PATCH] Revert "Move deskewing (#35)" This reverts commit 57d49810502206ad3bdd1bba817846f57c38065b. --- src/mapmos/odometry.py | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/src/mapmos/odometry.py b/src/mapmos/odometry.py index 8eed56c..1fb2cf4 100644 --- a/src/mapmos/odometry.py +++ b/src/mapmos/odometry.py @@ -79,6 +79,8 @@ def register_points(self, points, timestamps, scan_index): kernel=sigma / 3, ) + point_deskewed = self.deskew(points, timestamps, self.last_delta) + # Compute the difference between the prediction and the actual estimate model_deviation = np.linalg.inv(initial_guess) @ new_pose @@ -88,9 +90,7 @@ def register_points(self, points, timestamps, scan_index): self.last_delta = np.linalg.inv(self.last_pose) @ new_pose self.last_pose = new_pose - points_deskewed = self.deskew(points, timestamps, self.last_delta) - - return self.transform(points_deskewed, self.last_pose) + return self.transform(point_deskewed, self.last_pose) def get_map_points(self): map_points, map_timestamps = self.local_map.point_cloud_with_timestamps()