1
1
from __future__ import annotations
2
2
import numpy
3
3
import typing
4
- __all__ = ['SE3' , 'SO3' , 'interpolate' , 'iterativeMean' ]
4
+
5
+ __all__ = ["SE3" , "SO3" , "interpolate" , "iterativeMean" ]
6
+
5
7
class SE3 :
6
8
@staticmethod
7
9
@typing .overload
8
- def exp (arg0 : numpy .ndarray [numpy .float64 [3 , 1 ]], arg1 : numpy .ndarray [numpy .float64 [3 , 1 ]]) -> SE3 :
10
+ def exp (
11
+ arg0 : numpy .ndarray [numpy .float64 [3 , 1 ]],
12
+ arg1 : numpy .ndarray [numpy .float64 [3 , 1 ]],
13
+ ) -> SE3 :
9
14
"""
10
15
Create SE3 from a translational_part (3x1) and a rotation vector (3x1) of magnitude in rad. NOTE: translational_part is not translation vector in SE3
11
16
"""
12
17
@staticmethod
13
18
@typing .overload
14
- def exp (arg0 : numpy .ndarray [numpy .float64 [m , 3 ]], arg1 : numpy .ndarray [numpy .float64 [m , 3 ]]) -> SE3 :
19
+ def exp (
20
+ arg0 : numpy .ndarray [numpy .float64 [m , 3 ]],
21
+ arg1 : numpy .ndarray [numpy .float64 [m , 3 ]],
22
+ ) -> SE3 :
15
23
"""
16
24
Create a set of SE3 from translational_parts (Nx3) and rotation vectors (Nx3) of magnitude in rad. NOTE: translational_part is not translation vector in SE3
17
25
"""
18
26
@staticmethod
19
27
@typing .overload
20
- def from_matrix (arg0 : numpy .ndarray [numpy .float64 [4 , 4 ]]) -> SE3 :
21
- ...
28
+ def from_matrix (arg0 : numpy .ndarray [numpy .float64 [4 , 4 ]]) -> SE3 : ...
22
29
@staticmethod
23
30
@typing .overload
24
- def from_matrix (arg0 : numpy .ndarray [numpy .float64 ]) -> SE3 :
25
- ...
31
+ def from_matrix (arg0 : numpy .ndarray [numpy .float64 ]) -> SE3 : ...
26
32
@staticmethod
27
33
@typing .overload
28
- def from_matrix3x4 (arg0 : numpy .ndarray [numpy .float64 [3 , 4 ]]) -> SE3 :
29
- ...
34
+ def from_matrix3x4 (arg0 : numpy .ndarray [numpy .float64 [3 , 4 ]]) -> SE3 : ...
30
35
@staticmethod
31
36
@typing .overload
32
- def from_matrix3x4 (arg0 : numpy .ndarray [numpy .float64 ]) -> SE3 :
33
- ...
34
- def __copy__ (self ) -> SE3 :
35
- ...
36
- def __getitem__ (self , arg0 : typing .Any ) -> SE3 :
37
- ...
38
- def __imatmul__ (self , arg0 : SE3 ) -> SE3 :
39
- ...
37
+ def from_matrix3x4 (arg0 : numpy .ndarray [numpy .float64 ]) -> SE3 : ...
38
+ def __copy__ (self ) -> SE3 : ...
39
+ def __getitem__ (self , arg0 : typing .Any ) -> SE3 : ...
40
+ def __imatmul__ (self , arg0 : SE3 ) -> SE3 : ...
40
41
@typing .overload
41
42
def __init__ (self ) -> None :
42
43
"""
43
- Default Constructor initializing a group containing 1 identity element
44
+ Default Constructor initializing a group containing 1 identity element
44
45
"""
45
46
@typing .overload
46
47
def __init__ (self , arg0 : SE3 ) -> None :
47
48
"""
48
49
Copy constructor from single element
49
50
"""
50
- def __len__ (self ) -> int :
51
- ...
51
+ def __len__ (self ) -> int : ...
52
52
@typing .overload
53
- def __matmul__ (self , arg0 : SE3 ) -> SE3 :
54
- ...
53
+ def __matmul__ (self , arg0 : SE3 ) -> SE3 : ...
55
54
@typing .overload
56
- def __matmul__ (self , arg0 : numpy .ndarray [numpy .float64 [3 , n ]]) -> numpy .ndarray [numpy .float64 [3 , n ]]:
57
- ...
58
- def __repr__ (self ) -> str :
59
- ...
60
- def __setitem__ (self , arg0 : typing .Any , arg1 : SE3 ) -> None :
61
- ...
62
- def __str__ (self ) -> str :
63
- ...
55
+ def __matmul__ (
56
+ self , arg0 : numpy .ndarray [numpy .float64 [3 , n ]]
57
+ ) -> numpy .ndarray [numpy .float64 [3 , n ]]: ...
58
+ def __repr__ (self ) -> str : ...
59
+ def __setitem__ (self , arg0 : typing .Any , arg1 : SE3 ) -> None : ...
60
+ def __str__ (self ) -> str : ...
64
61
@typing .overload
65
- def from_quat_and_translation (self , arg0 : numpy .ndarray [numpy .float64 [3 , 1 ]], arg1 : numpy .ndarray [numpy .float64 [3 , 1 ]]) -> SE3 :
62
+ def from_quat_and_translation (
63
+ self ,
64
+ arg0 : numpy .ndarray [numpy .float64 [3 , 1 ]],
65
+ arg1 : numpy .ndarray [numpy .float64 [3 , 1 ]],
66
+ ) -> SE3 :
66
67
"""
67
68
Create SE3 from a quaternion as w, [x, y, z], and translation vector
68
69
"""
69
70
@typing .overload
70
- def from_quat_and_translation (self , arg0 : numpy .ndarray [numpy .float64 [m , 3 ]], arg1 : numpy .ndarray [numpy .float64 [m , 3 ]]) -> SE3 :
71
+ def from_quat_and_translation (
72
+ self ,
73
+ arg0 : numpy .ndarray [numpy .float64 [m , 3 ]],
74
+ arg1 : numpy .ndarray [numpy .float64 [m , 3 ]],
75
+ ) -> SE3 :
71
76
"""
72
77
Create SE3 from a list of quaternion as w_vec: Nx1, xyz_vec: Nx3, and a list of translation vectors: Nx3
73
78
"""
@@ -99,6 +104,7 @@ class SE3:
99
104
"""
100
105
Get the translation component of the transformation.
101
106
"""
107
+
102
108
class SO3 :
103
109
@staticmethod
104
110
def exp (arg0 : numpy .ndarray [numpy .float64 [m , 3 ]]) -> SO3 :
@@ -107,12 +113,10 @@ class SO3:
107
113
"""
108
114
@staticmethod
109
115
@typing .overload
110
- def from_matrix (arg0 : numpy .ndarray [numpy .float64 [3 , 3 ]]) -> SO3 :
111
- ...
116
+ def from_matrix (arg0 : numpy .ndarray [numpy .float64 [3 , 3 ]]) -> SO3 : ...
112
117
@staticmethod
113
118
@typing .overload
114
- def from_matrix (arg0 : numpy .ndarray [numpy .float64 ]) -> SO3 :
115
- ...
119
+ def from_matrix (arg0 : numpy .ndarray [numpy .float64 ]) -> SO3 : ...
116
120
@staticmethod
117
121
@typing .overload
118
122
def from_quat (arg0 : float , arg1 : numpy .ndarray [numpy .float64 [3 , 1 ]]) -> SO3 :
@@ -125,36 +129,29 @@ class SO3:
125
129
"""
126
130
Create rotations from a list of quaternions as w_vec: Nx1, xyz_vec: Nx3
127
131
"""
128
- def __copy__ (self ) -> SO3 :
129
- ...
130
- def __getitem__ (self , arg0 : typing .Any ) -> SO3 :
131
- ...
132
- def __imatmul__ (self , arg0 : SO3 ) -> SO3 :
133
- ...
132
+ def __copy__ (self ) -> SO3 : ...
133
+ def __getitem__ (self , arg0 : typing .Any ) -> SO3 : ...
134
+ def __imatmul__ (self , arg0 : SO3 ) -> SO3 : ...
134
135
@typing .overload
135
136
def __init__ (self ) -> None :
136
137
"""
137
- Default Constructor initializing a group containing 1 identity element
138
+ Default Constructor initializing a group containing 1 identity element
138
139
"""
139
140
@typing .overload
140
141
def __init__ (self , arg0 : SO3 ) -> None :
141
142
"""
142
143
Copy constructor from single element
143
144
"""
144
- def __len__ (self ) -> int :
145
- ...
145
+ def __len__ (self ) -> int : ...
146
146
@typing .overload
147
- def __matmul__ (self , arg0 : SO3 ) -> SO3 :
148
- ...
147
+ def __matmul__ (self , arg0 : SO3 ) -> SO3 : ...
149
148
@typing .overload
150
- def __matmul__ (self , arg0 : numpy .ndarray [numpy .float64 [3 , n ]]) -> numpy .ndarray [numpy .float64 [3 , n ]]:
151
- ...
152
- def __repr__ (self ) -> str :
153
- ...
154
- def __setitem__ (self , arg0 : typing .Any , arg1 : SO3 ) -> None :
155
- ...
156
- def __str__ (self ) -> str :
157
- ...
149
+ def __matmul__ (
150
+ self , arg0 : numpy .ndarray [numpy .float64 [3 , n ]]
151
+ ) -> numpy .ndarray [numpy .float64 [3 , n ]]: ...
152
+ def __repr__ (self ) -> str : ...
153
+ def __setitem__ (self , arg0 : typing .Any , arg1 : SO3 ) -> None : ...
154
+ def __str__ (self ) -> str : ...
158
155
def inverse (self ) -> SO3 :
159
156
"""
160
157
Compute the inverse of the rotations.
@@ -171,10 +168,12 @@ class SO3:
171
168
"""
172
169
Return quaternion as Nx4 vectors with the order [w x y z].
173
170
"""
171
+
174
172
def interpolate (arg0 : SE3 , arg1 : SE3 , arg2 : float ) -> SE3 :
175
173
"""
176
174
Interpolate two SE3s of size 1.
177
175
"""
176
+
178
177
def iterativeMean (arg0 : SE3 ) -> SE3 :
179
178
"""
180
179
Compute the iterative mean of a sequence.
0 commit comments