Revert "Move deskewing (#49)" (#51)

This reverts commit 7244238.

Author: Benedikt Mersch

src/mos4d/odometry.py

@@ -70,6 +70,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
 
@@ -79,9 +81,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 transform(self, points, pose):
         points_hom = np.hstack((points, np.ones((len(points), 1))))