11
11
from spatialmath import SE3 , SE2
12
12
from spatialmath .base import getvector , getunit , trotx , troty , trotz , \
13
13
issymbol , tr2jac , transl2 , trot2 , removesmall , trinv , verifymatrix , iseye
14
-
14
+
15
+
15
16
class SuperETS (UserList , ABC ):
16
17
17
18
# T is a NumPy array (4,4) or None
18
19
# ets_tuple = namedtuple('ETS3', 'eta axis_func axis joint T jindex flip')
19
20
20
21
def __init__ (
21
- self , axis = None , eta = None , axis_func = None ,
22
+ self , axis = None , eta = None , axis_func = None ,
22
23
unit = 'rad' , j = None , flip = False ):
23
24
24
25
super ().__init__ () # init UserList superclass
@@ -92,7 +93,9 @@ def __init__(
92
93
raise ValueError ('bad axis specified' )
93
94
94
95
# Save all the params in a named tuple
95
- e = SimpleNamespace (eta = eta , axis_func = axis_func , axis = axis , joint = joint , T = T , jindex = j , flip = flip )
96
+ e = SimpleNamespace (
97
+ eta = eta , axis_func = axis_func ,
98
+ axis = axis , joint = joint , T = T , jindex = j , flip = flip )
96
99
97
100
# And make it the only value of this instance
98
101
self .data = [e ]
@@ -1370,7 +1373,8 @@ def r(cls, eta=None, unit='rad', **kwargs):
1370
1373
1371
1374
:seealso: :func:`ETS`, :func:`isrevolute`
1372
1375
"""
1373
- return cls (axis = 'R' , eta = eta ,
1376
+ return cls (
1377
+ axis = 'R' , eta = eta ,
1374
1378
axis_func = lambda theta : trot2 (theta ), unit = unit , ** kwargs )
1375
1379
1376
1380
@classmethod
@@ -1395,7 +1399,8 @@ def tx(cls, eta=None, **kwargs):
1395
1399
1396
1400
:seealso: :func:`ETS`, :func:`isprismatic`
1397
1401
"""
1398
- return cls (axis = 'tx' , eta = eta ,
1402
+ return cls (
1403
+ axis = 'tx' , eta = eta ,
1399
1404
axis_func = lambda x : transl2 (x , 0 ), ** kwargs )
1400
1405
1401
1406
@classmethod
@@ -1420,7 +1425,8 @@ def ty(cls, eta=None, **kwargs):
1420
1425
1421
1426
:seealso: :func:`ETS`
1422
1427
"""
1423
- return cls (axis = 'ty' , eta = eta ,
1428
+ return cls (
1429
+ axis = 'ty' , eta = eta ,
1424
1430
axis_func = lambda y : transl2 (0 , y ), ** kwargs )
1425
1431
1426
1432
@@ -1491,7 +1497,6 @@ def ty(cls, eta=None, **kwargs):
1491
1497
# print(e.inv().eval(q))
1492
1498
# print(e.eval(q) * e.inv().eval(q))
1493
1499
1494
-
1495
1500
e = ETS .rz () * ETS .tx (- 1 ) * ETS .tx (1 ) * ETS .rz ()
1496
1501
print (e )
1497
- print (e .compile ())
1502
+ print (e .compile ())
0 commit comments