Skip to content

Commit d19f9fa

Browse files
committed
tr2xyt now handles symbolic args
1 parent 43f34e0 commit d19f9fa

1 file changed

Lines changed: 13 additions & 1 deletion

File tree

‎spatialmath/base/transforms2d.py‎

Lines changed: 13 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -21,6 +21,14 @@
2121

2222
_eps = np.finfo(np.float64).eps
2323

24+
try: # pragma: no cover
25+
# print('Using SymPy')
26+
import sympy
27+
28+
_symbolics = True
29+
30+
except ImportError: # pragma: no cover
31+
_symbolics = False
2432

2533
# ---------------------------------------------------------------------------------------#
2634
def rot2(theta, unit="rad"):
@@ -142,7 +150,11 @@ def tr2xyt(T, unit="rad"):
142150
143151
:seealso: trot2
144152
"""
145-
angle = math.atan2(T[1, 0], T[0, 0])
153+
154+
if T.dtype == "O" and _symbolics:
155+
angle = sympy.atan2(T[1, 0], T[0, 0])
156+
else:
157+
angle = math.atan2(T[1, 0], T[0, 0])
146158
return np.r_[T[0, 2], T[1, 2], angle]
147159

148160

0 commit comments

Comments
 (0)