From 3a8d93b2a54928d258362b34b31fd8adf04a7d05 Mon Sep 17 00:00:00 2001 From: Jeff Irion Date: Wed, 25 Oct 2023 07:02:14 -0700 Subject: [PATCH] Fix SE(2) inverse (#925) * Fix SE(2) inverse * Add missing ] --- SLAM/GraphBasedSLAM/graphslam/pose/se2.py | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/SLAM/GraphBasedSLAM/graphslam/pose/se2.py b/SLAM/GraphBasedSLAM/graphslam/pose/se2.py index e89317a06f..2a32e765f7 100644 --- a/SLAM/GraphBasedSLAM/graphslam/pose/se2.py +++ b/SLAM/GraphBasedSLAM/graphslam/pose/se2.py @@ -136,8 +136,8 @@ def inverse(self): """ 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]) # ======================================================================= # # #