@@ -1072,19 +1072,19 @@ def trnorm(T):
1072
1072
:return: SO(3) or SE(3) matrix
1073
1073
:rtype: np.ndarray, shape=(3,3) or (4,4)
1074
1074
1075
- TRNORM (R) is guaranteed to be a proper orthogonal matrix rotation
1075
+ - ``trnorm (R)`` is guaranteed to be a proper orthogonal matrix rotation
1076
1076
matrix (3x3) which is "close" to the input matrix R (3x3). If R
1077
1077
= [N,O,A] the O and A vectors are made unit length and the normal vector
1078
1078
is formed from N = O x A, and then we ensure that O and A are orthogonal
1079
1079
by O = A x N.
1080
1080
1081
- TRNORM (T) as above but the rotational submatrix of the homogeneous
1081
+ - ``trnorm (T)`` as above but the rotational submatrix of the homogeneous
1082
1082
transformation T (4x4) is normalised while the translational part is
1083
1083
unchanged.
1084
- %
1084
+
1085
1085
If R (3x3xK) or T (4x4xK) representing a sequence then the normalisation
1086
1086
is performed on each of the K planes.
1087
- %
1087
+
1088
1088
Notes::
1089
1089
- Only the direction of A (the z-axis) is unchanged.
1090
1090
- Used to prevent finite word length arithmetic causing transforms to
@@ -1185,9 +1185,9 @@ def trinv(T):
1185
1185
:return: SE(3) matrix
1186
1186
:rtype: np.ndarray, shape=(4,4)
1187
1187
1188
- Computes an efficient inverse of an SE(3) matrix.
1188
+ Computes an efficient inverse of an SE(3) matrix:
1189
1189
1190
- :math:`\begin{pmatrix} {\bf R^T } & -{ \bf R^T} t \\ 0 0 0 & 1 \end{pmatrix}`
1190
+ :math:`\begin{pmatrix} {\bf R} & t \\ 0\,0\,0 & 1 \end{pmatrix}^{-1} = \begin{pmatrix} { \bf R}^T & -{\bf R}^T t \\ 0\,0\, 0 & 1 \end{pmatrix}`
1191
1191
1192
1192
"""
1193
1193
assert ishom (T ), 'expecting SE(3) matrix'
@@ -1511,7 +1511,7 @@ def trplot(T, axes=None, dims=None, color='blue', frame=None, textcolor=None, la
1511
1511
ax .text (y [0 ], y [1 ], y [2 ], "$%c_{%s}$" % (labels [1 ], frame ), color = color , horizontalalignment = 'center' , verticalalignment = 'center' )
1512
1512
ax .text (z [0 ], z [1 ], z [2 ], "$%c_{%s}$" % (labels [2 ], frame ), color = color , horizontalalignment = 'center' , verticalalignment = 'center' )
1513
1513
1514
- import spatialmath .base .animate
1514
+ import spatialmath .base .animate as animate
1515
1515
1516
1516
def tranimate (T , ** kwargs ):
1517
1517
"""
0 commit comments