diff --git a/rb_ws/src/buggy/scripts/2d_sim/pose.py b/rb_ws/src/buggy/scripts/2d_sim/pose.py index e08aa7a8..3d9d0d52 100755 --- a/rb_ws/src/buggy/scripts/2d_sim/pose.py +++ b/rb_ws/src/buggy/scripts/2d_sim/pose.py @@ -94,7 +94,7 @@ def from_mat(mat): Creates a pose from a 3x3 homogeneous transformation matrix """ return Pose(mat[0, 2], mat[1, 2], np.arctan2(mat[1, 0], mat[0, 0])) - + def invert(self): """ Inverts the pose