File tree Expand file tree Collapse file tree 1 file changed +7
-2
lines changed
Filter options
Expand file tree Collapse file tree 1 file changed +7
-2
lines changed
Original file line number Diff line number Diff line change @@ -1169,7 +1169,7 @@ def yaw_SE2(self, order: str = "zyx") -> SE2:
1169
1169
:param order: angle sequence order, default to 'zyx'
1170
1170
:type order: str
1171
1171
:return: SE(2) with same rotation as the yaw angle using the roll-pitch-yaw convention,
1172
- and translation in x,y .
1172
+ and translation along the roll-pitch axes .
1173
1173
:rtype: SE2 instance
1174
1174
1175
1175
Roll-pitch-yaw corresponds to successive rotations about the axes specified by ``order``:
@@ -1186,7 +1186,12 @@ def yaw_SE2(self, order: str = "zyx") -> SE2:
1186
1186
1187
1187
"""
1188
1188
if len (self ) == 1 :
1189
- return SE2 (self .x , self .y , self .rpy (order = order )[2 ])
1189
+ if order in "zyx" :
1190
+ return SE2 (self .x , self .y , self .rpy (order = order )[2 ])
1191
+ elif order in "xyz" :
1192
+ return SE2 (self .z , self .y , self .rpy (order = order )[2 ])
1193
+ elif order in "yxz" :
1194
+ return SE2 (self .z , self .x , self .rpy (order = order )[2 ])
1190
1195
else :
1191
1196
return SE2 ([e .yaw_SE2 () for e in self ])
1192
1197
You can’t perform that action at this time.
0 commit comments