@@ -338,7 +338,7 @@ def eulervec(self) -> R3:
338
338
"""
339
339
theta , v = smb .tr2angvec (self .R )
340
340
return theta * v
341
-
341
+
342
342
# ------------------------------------------------------------------------ #
343
343
344
344
@staticmethod
@@ -1209,11 +1209,11 @@ def yaw_SE2(self, order: str = "zyx") -> SE2:
1209
1209
"""
1210
1210
if len (self ) == 1 :
1211
1211
if order == "zyx" :
1212
- return SE2 (self .x , self .y , self .rpy (order = order )[2 ])
1212
+ return SE2 (self .x , self .y , self .rpy (order = order )[2 ])
1213
1213
elif order == "xyz" :
1214
- return SE2 (self .z , self .y , self .rpy (order = order )[2 ])
1214
+ return SE2 (self .z , self .y , self .rpy (order = order )[2 ])
1215
1215
elif order == "yxz" :
1216
- return SE2 (self .z , self .x , self .rpy (order = order )[2 ])
1216
+ return SE2 (self .z , self .x , self .rpy (order = order )[2 ])
1217
1217
else :
1218
1218
return SE2 ([e .yaw_SE2 () for e in self ])
1219
1219
@@ -1957,7 +1957,11 @@ def Rt(
1957
1957
return cls (smb .rt2tr (R , t , check = check ), check = check )
1958
1958
1959
1959
@classmethod
1960
- def CopyFrom (cls , T : SE3Array , check : bool = True ) -> SE3 :
1960
+ def CopyFrom (
1961
+ cls ,
1962
+ T : SE3Array ,
1963
+ check : bool = True
1964
+ ) -> SE3 :
1961
1965
"""
1962
1966
Create an SE(3) from a 4x4 numpy array that is passed by value.
1963
1967
0 commit comments