Fix SE(2) inverse (#31)

JeffLIrion · Oct 18, 2023 · 8ab335f · 8ab335f
1 parent ef1f2bf
commit 8ab335f
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/graphslam/pose/se2.py b/graphslam/pose/se2.py
@@ -128,7 +128,7 @@ def inverse(self):
             The pose's inverse
 
         """
-        return PoseSE2([-self[0] * np.cos(self[2]) - self[1] * np.sin(self[2]), self[0] * np.sin(self[2]) - self[1] * np.cos([self[2]])], -self[2])
+        return PoseSE2([-self[0] * np.cos(self[2]) - self[1] * np.sin(self[2]), self[0] * np.sin(self[2]) - self[1] * np.cos(self[2])], -self[2])
 
     # ======================================================================= #
     #                                                                         #