Package georegression.transform.twist
Class TwistOps_F32
java.lang.Object
georegression.transform.twist.TwistOps_F32
Operations related to twists.
- 
Constructor SummaryConstructors
- 
Method SummaryModifier and TypeMethodDescriptionstatic Se3_F32exponential(TwistCoordinate_F32 twist, float theta, @Nullable Se3_F32 motion) Computes the exponential map for a twist:
 exp(hat(xi)*theta) = [ SO , (I-SO)*(w cross v) + w*wTvΘ 0 , 1]
 SO = exp(hat(w)*theta)static FMatrixRMajhomogenous(Se3_F32 transform, @Nullable FMatrixRMaj H) Converts theSe3_F32object into homogenous notation.
 [ R , T; 0 , 1]static FMatrixRMajhomogenous(TwistCoordinate_F32 twist, @Nullable FMatrixRMaj H) Converts the twist coordinate into homogenous format.
 H = [hat(w), v; 0 , 0]static TwistCoordinate_F32twist(Se3_F32 motion, @Nullable TwistCoordinate_F32 twist) Converts a rigid body motion into a twist coordinate.
- 
Constructor Details- 
TwistOps_F32public TwistOps_F32()
 
- 
- 
Method Details- 
homogenousConverts theSe3_F32object into homogenous notation.
 [ R , T; 0 , 1]- Parameters:
- transform- transform in regular SE3 format. If null a new matrix will be declared
- H- (Optional) Storage for homogenous 4x4 matrix. If null a new matrix is declared.
- Returns:
- Homogenous matrix
 
- 
homogenousConverts the twist coordinate into homogenous format.
 H = [hat(w), v; 0 , 0]- Parameters:
- twist- Twist coordinate
- H- (Optional) Storage for homogenous 4x4 matrix. If null a new matrix is declared.
- Returns:
- Homogenous matrix
 
- 
exponentialpublic static Se3_F32 exponential(TwistCoordinate_F32 twist, float theta, @Nullable @Nullable Se3_F32 motion) Computes the exponential map for a twist: See page 42 in R. Murray, et. al. "A Mathematical Introduction to ROBOTIC MANIPULATION" 1994
 exp(hat(xi)*theta) = [ SO , (I-SO)*(w cross v) + w*wTvΘ 0 , 1]
 SO = exp(hat(w)*theta)- Parameters:
- twist- Twist coordinate
- theta- Magnitude of rotation
- motion- Storage for SE(3). If null a new instance will be returned.
- Returns:
- The transformation.
 
- 
twistpublic static TwistCoordinate_F32 twist(Se3_F32 motion, @Nullable @Nullable TwistCoordinate_F32 twist) Converts a rigid body motion into a twist coordinate. The value of theta used to generate the motion is assumed to be one.- Parameters:
- motion- (Input) The SE(3) transformation
- twist- (Output) Storage for twist.
- Returns:
- magnitude of the motion
 
 
-