Fix SE(2) inverse (#925)

* Fix SE(2) inverse * Add missing ]
2026-04-22 03:00:22 -04:00 · 2023-10-25 07:02:14 -07:00
parent bde8bda753
commit 3a8d93b2a5
1 changed files with 2 additions and 2 deletions
--- a/SLAM/GraphBasedSLAM/graphslam/pose/se2.py
+++ b/SLAM/GraphBasedSLAM/graphslam/pose/se2.py
@@ -136,8 +136,8 @@ class PoseSE2(np.ndarray):

        """
        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])
+                        self[0] * np.sin(self[2]) - self[1] * np.cos(self[2])],
+                        -self[2])

    # ======================================================================= #
    #                                                                         #