Skip to content

Commit

Permalink
Fix SE(2) inverse
Browse files Browse the repository at this point in the history
  • Loading branch information
JeffLIrion authored Oct 20, 2023
1 parent 8f1306a commit e60e6a6
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions SLAM/GraphBasedSLAM/graphslam/pose/se2.py
Original file line number Diff line number Diff line change
Expand Up @@ -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])

# ======================================================================= #
# #
Expand Down

0 comments on commit e60e6a6

Please sign in to comment.