Package org.robwork.sdurw_math
Class sdurw_math
- java.lang.Object
-
- org.robwork.sdurw_math.sdurw_math
-
- All Implemented Interfaces:
sdurw_mathConstants
public class sdurw_math extends java.lang.Object implements sdurw_mathConstants
-
-
Field Summary
-
Fields inherited from interface org.robwork.sdurw_math.sdurw_mathConstants
Deg2Rad, Inch2Meter, Meter2Inch, Pi, Rad2Deg
-
-
Constructor Summary
Constructors Constructor Description sdurw_math()
-
Method Summary
All Methods Static Methods Concrete Methods Modifier and Type Method Description static Transform3DVectoradd(double lhs, Transform3DVector rhs)Scalar additionstatic Transform3DVector_fadd(float lhs, Transform3DVector_f rhs)Scalar additionstatic doubleangle(Vector2Df v1, Vector2Df v2)calculates the counter clock-wise angle from v1 to
v2.static doubleangle(Vector2D v1, Vector2D v2)calculates the counter clock-wise angle from v1 to
v2.static doubleangle(Vector3Df v1, Vector3Df v2)Calculates the angle from \mathbf{v1} to \mathbf{v2}
around the axis defined by \mathbf{v1} \times \mathbf{v2}static doubleangle(Vector3Df v1, Vector3Df v2, Vector3Df n)Calculates the angle from \mathbf{v1} to \mathbf{v2}
around the axis defined by \mathbf{v1} \times \mathbf{v2} with n
determining the sign.static doubleangle(Vector3D v1, Vector3D v2)Calculates the angle from \mathbf{v1} to \mathbf{v2}
around the axis defined by \mathbf{v1} \times \mathbf{v2}static doubleangle(Vector3D v1, Vector3D v2, Vector3D n)Calculates the angle from \mathbf{v1} to \mathbf{v2}
around the axis defined by \mathbf{v1} \times \mathbf{v2} with n
determining the sign.static EAAfcast(EAA eaa)Casts EAA<T> to EAA<Q>static EAAcast(EAAf eaa)Casts EAA<T> to EAA<Q>static InertiaMatrixfcast(InertiaMatrixd rot)Casts InertiaMatrix<T> to InertiaMatrix<Q>static InertiaMatrixdcast(InertiaMatrixf rot)Casts InertiaMatrix<T> to InertiaMatrix<Q>static Pose6Dfcast(Pose6D pose)Casts Pose6D<T> to Pose6D<Q>static Pose6Dcast(Pose6Df pose)Casts Pose6D<T> to Pose6D<Q>static Quaternion_fcast(Quaternion quaternion)Casts Quaternion<T> to Quaternion<Q>static Quaternioncast(Quaternion_f quaternion)Casts Quaternion<T> to Quaternion<Q>static Rotation2Dfcast(Rotation2D rot)Casts Rotation2D<T> to Rotation2D<Q>static Rotation2Dcast(Rotation2Df rot)Casts Rotation2D<T> to Rotation2D<Q>static Rotation3Dfcast(Rotation3D rot)Casts Rotation3D<T> to Rotation3D<S>
static Rotation3Dcast(Rotation3Df rot)Casts Rotation3D<T> to Rotation3D<S>
static RPYfcast(RPY rpy)Casts RPY<T> to RPY<Q>
static RPYcast(RPYf rpy)Casts RPY<T> to RPY<Q>
static Transform3Dfcast(Transform3D trans)Cast Transform3D<T> to Transform3D<Q>static Transform3Dcast(Transform3Df trans)Cast Transform3D<T> to Transform3D<Q>static Vector2Dfcast(Vector2D v)Casts Vector2D<T> to Vector2D<Q>
static Vector2Dcast(Vector2Df v)Casts Vector2D<T> to Vector2D<Q>
static Vector3Dfcast(Vector3D v)Casts Vector3D<T> to Vector3D<Q>static Vector3Dcast(Vector3Df v)Casts Vector3D<T> to Vector3D<Q>static VelocityScrew6Dfcast(VelocityScrew6D vs)Casts VelocityScrew6D<T> to VelocityScrew6D<Q>
static VelocityScrew6Dcast(VelocityScrew6Df vs)Casts VelocityScrew6D<T> to VelocityScrew6D<Q>
static Wrench6Dfcast(Wrench6D vs)Casts Wrench6D<T> to Wrench6D<Q>
static Wrench6Dcast(Wrench6Df vs)Casts Wrench6D<T> to Wrench6D<Q>
static EAAcastToDouble(EAAf eaa)Casts EAA<T> to EAA<Q>static InertiaMatrixdcastToDouble(InertiaMatrixf rot)Casts InertiaMatrix<T> to InertiaMatrix<Q>static Pose6DcastToDouble(Pose6Df pose)Casts Pose6D<T> to Pose6D<Q>static QuaternioncastToDouble(Quaternion_f quaternion)Casts Quaternion<T> to Quaternion<Q>static Rotation2DcastToDouble(Rotation2Df rot)Casts Rotation2D<T> to Rotation2D<Q>static Rotation3DcastToDouble(Rotation3Df rot)Casts Rotation3D<T> to Rotation3D<S>
static RPYcastToDouble(RPYf rpy)Casts RPY<T> to RPY<Q>
static Transform3DcastToDouble(Transform3Df trans)Cast Transform3D<T> to Transform3D<Q>static Vector2DcastToDouble(Vector2Df v)Casts Vector2D<T> to Vector2D<Q>
static Vector3DcastToDouble(Vector3Df v)Casts Vector3D<T> to Vector3D<Q>static VelocityScrew6DcastToDouble(VelocityScrew6Df vs)Casts VelocityScrew6D<T> to VelocityScrew6D<Q>
static Wrench6DcastToDouble(Wrench6Df vs)Casts Wrench6D<T> to Wrench6D<Q>
static EAAfcastToFloat(EAA eaa)Casts EAA<T> to EAA<Q>static InertiaMatrixfcastToFloat(InertiaMatrixd rot)Casts InertiaMatrix<T> to InertiaMatrix<Q>static Pose6DfcastToFloat(Pose6D pose)Casts Pose6D<T> to Pose6D<Q>static Quaternion_fcastToFloat(Quaternion quaternion)Casts Quaternion<T> to Quaternion<Q>static Rotation2DfcastToFloat(Rotation2D rot)Casts Rotation2D<T> to Rotation2D<Q>static Rotation3DfcastToFloat(Rotation3D rot)Casts Rotation3D<T> to Rotation3D<S>
static RPYfcastToFloat(RPY rpy)Casts RPY<T> to RPY<Q>
static Transform3DfcastToFloat(Transform3D trans)Cast Transform3D<T> to Transform3D<Q>static Vector2DfcastToFloat(Vector2D v)Casts Vector2D<T> to Vector2D<Q>
static Vector3DfcastToFloat(Vector3D v)Casts Vector3D<T> to Vector3D<Q>static VelocityScrew6DfcastToFloat(VelocityScrew6D vs)Casts VelocityScrew6D<T> to VelocityScrew6D<Q>
static Wrench6DfcastToFloat(Wrench6D vs)Casts Wrench6D<T> to Wrench6D<Q>
static Qconcat(Q q1, Q q2)concatenates q1 onto q2 such that the returned q has
the configurations of q1 in [0;q1.size()[ and has q2 in
[q1.size();q1.size()+q2.size()[static floatcross(Vector2Df v1, Vector2Df v2)Calculates the 2D vector cross product \mathbf{v1} \times \mathbf{v2}
static doublecross(Vector2D v1, Vector2D v2)Calculates the 2D vector cross product \mathbf{v1} \times \mathbf{v2}
static Vector3Dfcross(Vector3Df v1, EAAf v2)static Vector3Dfcross(Vector3Df v1, Vector3Df v2)Calculates the 3D vector cross product \mathbf{v1} \times \mathbf{v2}static voidcross(Vector3Df v1, Vector3Df v2, Vector3Df dst)Calculates the 3D vector cross product \mathbf{v1} \times \mathbf{v2}static Vector3Dcross(Vector3D v1, EAA v2)static Vector3Dcross(Vector3D v1, Vector3D v2)Calculates the 3D vector cross product \mathbf{v1} \times \mathbf{v2}static voidcross(Vector3D v1, Vector3D v2, Vector3D dst)Calculates the 3D vector cross product \mathbf{v1} \times \mathbf{v2}static Qdivide(double s, Q v)Scalar division.static Transform3DVectordivide(double lhs, Transform3DVector rhs)Scalar devisionstatic Vector3Ddivide(double lhs, Vector3D rhs)Scalar division.static Vector4Dddivide(double lhs, Vector4Dd rhs)Scalar division.static Vector5Dddivide(double lhs, Vector5Dd rhs)Scalar division.static Vector6Dddivide(double lhs, Vector6Dd rhs)Scalar division.static Transform3DVector_fdivide(float lhs, Transform3DVector_f rhs)Scalar devisionstatic Vector3Dfdivide(float lhs, Vector3Df rhs)Scalar division.static Vector4Dfdivide(float lhs, Vector4Df rhs)Scalar division.static Vector5Dfdivide(float lhs, Vector5Df rhs)Scalar division.static Vector6Dfdivide(float lhs, Vector6Df rhs)Scalar division.static doubledot(Q a, Q b)The dot product (inner product) of a and b.static doubledot(Vector2Df v1, Vector2Df v2)Calculates the dot product \mathbf{v1} .static doubledot(Vector2D v1, Vector2D v2)Calculates the dot product \mathbf{v1} .static floatdot(Vector3Df v1, Vector3Df v2)Calculates the dot product \mathbf{v1} .static doubledot(Vector3D v1, Vector3D v2)Calculates the dot product \mathbf{v1} .static floatdot(Vectorf a, Vectorf b)The dot product (inner product) of a and b.
static doubledot(Vector a, Vector b)The dot product (inner product) of a and b.
static InertiaMatrixdinverse(InertiaMatrixd aRb)static InertiaMatrixfinverse(InertiaMatrixf aRb)static PerspectiveTransform2Dinverse(PerspectiveTransform2D aRb)Take the inverse of a PerspectiveTransform2D.static PerspectiveTransform2Dfinverse(PerspectiveTransform2Df aRb)Take the inverse of a PerspectiveTransform2D.static Quaternioninverse(Quaternion q)Calculate the inverse Quaternionstatic Quaternion_finverse(Quaternion_f q)Calculate the inverse Quaternionstatic Rotation2Dinverse(Rotation2D aRb)The inverse \robabx{b}{a}{\mathbf{R}} = \robabx{a}{b}{\mathbf{R}}^{-1} of a rotation matrix
static Rotation2Dfinverse(Rotation2Df aRb)The inverse \robabx{b}{a}{\mathbf{R}} = \robabx{a}{b}{\mathbf{R}}^{-1} of a rotation matrix
static Rotation3Dinverse(Rotation3D aRb)static Rotation3Dfinverse(Rotation3Df aRb)static Transform3Dinverse(Transform3D aTb)static Transform3Dfinverse(Transform3Df aTb)static PolynomialNDdDoublemultiply(double s, PolynomialNDdDouble p)Scalar multiplicationstatic PolynomialNDEigenMatrix3dDoublemultiply(double s, PolynomialNDEigenMatrix3dDouble p)Scalar multiplicationstatic PolynomialNDEigenRowVector3dDoublemultiply(double s, PolynomialNDEigenRowVector3dDouble p)Scalar multiplicationstatic PolynomialNDEigenVector3dDoublemultiply(double s, PolynomialNDEigenVector3dDouble p)Scalar multiplicationstatic Quaternionmultiply(double s, Quaternion v)Scalar multiplication.static Transform3DVectormultiply(double lhs, Transform3DVector rhs)Scalar multiplicationstatic Vector2Dmultiply(double s, Vector2D v)Scalar multiplication.static Vector3Dmultiply(double lhs, Vector3D rhs)Scalar multiplication.static Vector4Ddmultiply(double lhs, Vector4Dd rhs)Scalar multiplication.static Vector5Ddmultiply(double lhs, Vector5Dd rhs)Scalar multiplication.static Vector6Ddmultiply(double lhs, Vector6Dd rhs)Scalar multiplication.static VelocityScrew6Dmultiply(double s, VelocityScrew6D screw)Scales velocity screw and returns scaled version
static PolynomialNDEigenMatrix3fFloatmultiply(float s, PolynomialNDEigenMatrix3fFloat p)Scalar multiplicationstatic PolynomialNDEigenRowVector3fFloatmultiply(float s, PolynomialNDEigenRowVector3fFloat p)Scalar multiplicationstatic PolynomialNDEigenVector3fFloatmultiply(float s, PolynomialNDEigenVector3fFloat p)Scalar multiplicationstatic PolynomialNDfFloatmultiply(float s, PolynomialNDfFloat p)Scalar multiplicationstatic Quaternion_fmultiply(float s, Quaternion_f v)Scalar multiplication.static Transform3DVector_fmultiply(float lhs, Transform3DVector_f rhs)Scalar multiplicationstatic Vector2Dfmultiply(float s, Vector2Df v)Scalar multiplication.static Vector3Dfmultiply(float lhs, Vector3Df rhs)Scalar multiplication.static Vector4Dfmultiply(float lhs, Vector4Df rhs)Scalar multiplication.static Vector5Dfmultiply(float lhs, Vector5Df rhs)Scalar multiplication.static Vector6Dfmultiply(float lhs, Vector6Df rhs)Scalar multiplication.static VelocityScrew6Dfmultiply(float s, VelocityScrew6Df screw)Scales velocity screw and returns scaled version
static PolynomialNDEigenRowVector3idComplexDoublemultiply(complexd s, PolynomialNDEigenRowVector3idComplexDouble p)Scalar multiplicationstatic PolynomialNDEigenVector3idComplexDoublemultiply(complexd s, PolynomialNDEigenVector3idComplexDouble p)Scalar multiplicationstatic PolynomialNDidComplexDoublemultiply(complexd s, PolynomialNDidComplexDouble p)Scalar multiplicationstatic PolynomialNDEigenMatrix3ifComplexDoublemultiply(complexf s, PolynomialNDEigenMatrix3ifComplexDouble p)Scalar multiplicationstatic Jacobianmultiply(Jacobian j1, Jacobian j2)Multiplies jacobians \mathbf{J} = \mathbf{J}_1 * \mathbf{J}_2
static VelocityScrew6Dmultiply(Jacobian Jq, Q dq)Calculates velocity vectorstatic Qmultiply(Jacobian JqInv, VelocityScrew6D v)Calculates joint velocities
static SWIGTYPE_p_rw__math__PolynomialT_double_tmultiply(PolynomialNDEigenRowVector3dDouble a, PolynomialNDEigenVector3dDouble b)Multiply 3D polynomial vector with 3D polynomial vector.static PolynomialNDEigenRowVector3dDoublemultiply(PolynomialNDEigenRowVector3dDouble a, SWIGTYPE_p_Eigen__Matrix3d A)static PolynomialNDEigenRowVector3dDoublemultiply(PolynomialNDEigenRowVector3dDouble a, SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3d_double_t A)Multiply 3D polynomial vector with 3D polynomial matrix.static PolynomialNDEigenRowVector3dDoublemultiply(PolynomialNDEigenRowVector3dDouble polynomial, SWIGTYPE_p_rw__math__PolynomialT_double_t p)static SWIGTYPE_p_rw__math__PolynomialT_float_tmultiply(PolynomialNDEigenRowVector3fFloat a, PolynomialNDEigenVector3fFloat b)static PolynomialNDEigenRowVector3fFloatmultiply(PolynomialNDEigenRowVector3fFloat a, SWIGTYPE_p_Eigen__Matrix3f A)static PolynomialNDEigenRowVector3fFloatmultiply(PolynomialNDEigenRowVector3fFloat a, SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3f_float_t A)static PolynomialNDEigenRowVector3fFloatmultiply(PolynomialNDEigenRowVector3fFloat polynomial, SWIGTYPE_p_rw__math__PolynomialT_float_t p)static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3d_double_tmultiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3d_double_t A, SWIGTYPE_p_Eigen__Vector3d b)static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3d_double_tmultiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3d_double_t A, SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3d_double_t b)Multiply 3D polynomial matrix with 3D polynomial vector.static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3d_double_tmultiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3d_double_t polynomial, SWIGTYPE_p_rw__math__PolynomialT_double_t p)Multiply 3D polynomial matrix with a polynomial with scalar coefficients.static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3f_float_tmultiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3f_float_t A, SWIGTYPE_p_Eigen__Vector3f b)static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3f_float_tmultiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3f_float_t A, SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3f_float_t b)static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3f_float_tmultiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3f_float_t polynomial, SWIGTYPE_p_rw__math__PolynomialT_float_t p)static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3d_double_tmultiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3d_double_t polynomial, SWIGTYPE_p_rw__math__PolynomialT_double_t p)Multiply 3D polynomial vector with a polynomial with scalar coefficients.static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3f_float_tmultiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3f_float_t polynomial, SWIGTYPE_p_rw__math__PolynomialT_float_t p)static Jacobianmultiply(SWIGTYPE_p_rw__math__Rotation3DT_t r, Jacobian v)Rotates each column of v by r.
The Jacobian must be of height 6.
static doublenorm1(VelocityScrew6D screw)Takes the 1-norm of the velocity screw.static floatnorm1(VelocityScrew6Df screw)Takes the 1-norm of the velocity screw.static doublenorm1(Wrench6D wrench)Takes the 1-norm of the wrench.static floatnorm1(Wrench6Df wrench)Takes the 1-norm of the wrench.static doublenorm2(VelocityScrew6D screw)Takes the 2-norm of the velocity screw.static floatnorm2(VelocityScrew6Df screw)Takes the 2-norm of the velocity screw.static doublenorm2(Wrench6D wrench)Takes the 2-norm of the wrench.static floatnorm2(Wrench6Df wrench)Takes the 2-norm of the wrench.static Vector2Dnormalize(Vector2D v)Returns the normalized vector
\mathbf{n}=\frac{\mathbf{v}}{\|\mathbf{v}\|} .
If \| \mathbf{v} \| = 0 then the zero vector is returned.
static Vector2Dfnormalize(Vector2Df v)Returns the normalized vector
\mathbf{n}=\frac{\mathbf{v}}{\|\mathbf{v}\|} .
If \| \mathbf{v} \| = 0 then the zero vector is returned.
static Vector3Dnormalize(Vector3D v)Returns the normalized vector \mathbf{n}=\frac{\mathbf{v}}{\|\mathbf{v}\|} .
In case \|mathbf{v}\| = 0 the zero vector is returned.static Vector3Dfnormalize(Vector3Df v)Returns the normalized vector \mathbf{n}=\frac{\mathbf{v}}{\|\mathbf{v}\|} .
In case \|mathbf{v}\| = 0 the zero vector is returned.static doublenormInf(VelocityScrew6D screw)Takes the infinite norm of the velocity screw.static floatnormInf(VelocityScrew6Df screw)Takes the infinite norm of the velocity screw.static doublenormInf(Wrench6D wrench)Takes the infinite norm of the wrench.static floatnormInf(Wrench6Df wrench)Takes the infinite norm of the wrench.static MetricQPtrownedPtr(MetricQ ptr)A Ptr that takes ownership over a raw pointer ptr.static MetricRotation3DPtrownedPtr(MetricRotation3D ptr)A Ptr that takes ownership over a raw pointer ptr.static MetricTransform3DPtrownedPtr(MetricTransform3D ptr)A Ptr that takes ownership over a raw pointer ptr.static MetricVector2DPtrownedPtr(MetricVector2D ptr)A Ptr that takes ownership over a raw pointer ptr.static MetricVector3DPtrownedPtr(MetricVector3D ptr)A Ptr that takes ownership over a raw pointer ptr.static Transform3DVectorsubtract(double lhs, Transform3DVector rhs)Scalar subtractionstatic Transform3DVector_fsubtract(float lhs, Transform3DVector_f rhs)Scalar subtractionstatic Rotation2Dtranspose(Rotation2D aRb)Find the transpose of aRb.
The transpose of a rotation matrix is the same as the inverse.static Rotation2Dftranspose(Rotation2Df aRb)Find the transpose of aRb.
The transpose of a rotation matrix is the same as the inverse.
-
-
-
Method Detail
-
multiply
public static VelocityScrew6D multiply(Jacobian Jq, Q dq)
Calculates velocity vector- Parameters:
Jq- [in] the jacobian \mathbf{J}_{\mathbf{q}}dq- [in] the joint velocity vector \dot{\mathbf{q}}- Returns:
- the velocity vector \mathbf{\nu}
-
multiply
public static Q multiply(Jacobian JqInv, VelocityScrew6D v)
Calculates joint velocities
- Parameters:
JqInv- [in] the inverse jacobian \mathbf{J}_{\mathbf{q}}^{-1}
v- [in] the velocity vector \mathbf{\nu}
- Returns:
- the joint velocity vector \dot{\mathbf{q}}
-
multiply
public static Jacobian multiply(Jacobian j1, Jacobian j2)
Multiplies jacobians \mathbf{J} = \mathbf{J}_1 * \mathbf{J}_2
- Parameters:
j1- [in] \mathbf{J}_1
j2- [in] \mathbf{J}_2
- Returns:
- \mathbf{J}
-
multiply
public static Jacobian multiply(SWIGTYPE_p_rw__math__Rotation3DT_t r, Jacobian v)
Rotates each column of v by r.
The Jacobian must be of height 6.
-
ownedPtr
public static MetricQPtr ownedPtr(MetricQ ptr)
A Ptr that takes ownership over a raw pointer ptr.
-
ownedPtr
public static MetricVector2DPtr ownedPtr(MetricVector2D ptr)
A Ptr that takes ownership over a raw pointer ptr.
-
ownedPtr
public static MetricVector3DPtr ownedPtr(MetricVector3D ptr)
A Ptr that takes ownership over a raw pointer ptr.
-
ownedPtr
public static MetricTransform3DPtr ownedPtr(MetricTransform3D ptr)
A Ptr that takes ownership over a raw pointer ptr.
-
ownedPtr
public static MetricRotation3DPtr ownedPtr(MetricRotation3D ptr)
A Ptr that takes ownership over a raw pointer ptr.
-
multiply
public static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3d_double_t multiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3d_double_t A, SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3d_double_t b)
Multiply 3D polynomial matrix with 3D polynomial vector.- Parameters:
A- [in] the matrix expression.b- [in] the vector expression.- Returns:
- a 3D polynomial vector.
-
multiply
public static PolynomialNDEigenRowVector3dDouble multiply(PolynomialNDEigenRowVector3dDouble a, SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3d_double_t A)
Multiply 3D polynomial vector with 3D polynomial matrix.- Parameters:
a- [in] the vector expression.A- [in] the matrix expression.- Returns:
- a 3D polynomial vector.
-
multiply
public static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3d_double_t multiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3d_double_t A, SWIGTYPE_p_Eigen__Vector3d b)
-
multiply
public static PolynomialNDEigenRowVector3dDouble multiply(PolynomialNDEigenRowVector3dDouble a, SWIGTYPE_p_Eigen__Matrix3d A)
-
multiply
public static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3f_float_t multiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3f_float_t A, SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3f_float_t b)
-
multiply
public static PolynomialNDEigenRowVector3fFloat multiply(PolynomialNDEigenRowVector3fFloat a, SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3f_float_t A)
-
multiply
public static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3f_float_t multiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3f_float_t A, SWIGTYPE_p_Eigen__Vector3f b)
-
multiply
public static PolynomialNDEigenRowVector3fFloat multiply(PolynomialNDEigenRowVector3fFloat a, SWIGTYPE_p_Eigen__Matrix3f A)
-
multiply
public static PolynomialNDdDouble multiply(double s, PolynomialNDdDouble p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static PolynomialNDfFloat multiply(float s, PolynomialNDfFloat p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static PolynomialNDEigenRowVector3dDouble multiply(double s, PolynomialNDEigenRowVector3dDouble p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static PolynomialNDEigenVector3dDouble multiply(double s, PolynomialNDEigenVector3dDouble p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static PolynomialNDEigenMatrix3dDouble multiply(double s, PolynomialNDEigenMatrix3dDouble p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static PolynomialNDEigenRowVector3fFloat multiply(float s, PolynomialNDEigenRowVector3fFloat p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static PolynomialNDEigenVector3fFloat multiply(float s, PolynomialNDEigenVector3fFloat p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static PolynomialNDEigenMatrix3fFloat multiply(float s, PolynomialNDEigenMatrix3fFloat p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static PolynomialNDidComplexDouble multiply(complexd s, PolynomialNDidComplexDouble p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static PolynomialNDEigenRowVector3idComplexDouble multiply(complexd s, PolynomialNDEigenRowVector3idComplexDouble p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static PolynomialNDEigenVector3idComplexDouble multiply(complexd s, PolynomialNDEigenVector3idComplexDouble p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static PolynomialNDEigenMatrix3ifComplexDouble multiply(complexf s, PolynomialNDEigenMatrix3ifComplexDouble p)
Scalar multiplication- Parameters:
s- [in] scalar to multiply with.p- [in] polynomial to multiply with.- Returns:
- new polynomial after multiplication.
-
multiply
public static SWIGTYPE_p_rw__math__PolynomialT_double_t multiply(PolynomialNDEigenRowVector3dDouble a, PolynomialNDEigenVector3dDouble b)
Multiply 3D polynomial vector with 3D polynomial vector.- Parameters:
a- [in] first polynomial vector (row vector).b- [in] second polynomial vector (column vector).- Returns:
- a polynomial with scalar coefficients.
-
multiply
public static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3d_double_t multiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3d_double_t polynomial, SWIGTYPE_p_rw__math__PolynomialT_double_t p)
Multiply 3D polynomial vector with a polynomial with scalar coefficients.- Parameters:
polynomial- [in] the polynomial vector.p- [in] polynomial with scalar coefficients.- Returns:
- a 3D polynomial vector.
-
multiply
public static PolynomialNDEigenRowVector3dDouble multiply(PolynomialNDEigenRowVector3dDouble polynomial, SWIGTYPE_p_rw__math__PolynomialT_double_t p)
-
multiply
public static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3d_double_t multiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3d_double_t polynomial, SWIGTYPE_p_rw__math__PolynomialT_double_t p)
Multiply 3D polynomial matrix with a polynomial with scalar coefficients.- Parameters:
polynomial- [in] the polynomial matrix.p- [in] polynomial with scalar coefficients.- Returns:
- a 3D polynomial matrix.
-
multiply
public static SWIGTYPE_p_rw__math__PolynomialT_float_t multiply(PolynomialNDEigenRowVector3fFloat a, PolynomialNDEigenVector3fFloat b)
-
multiply
public static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3f_float_t multiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Vector3f_float_t polynomial, SWIGTYPE_p_rw__math__PolynomialT_float_t p)
-
multiply
public static PolynomialNDEigenRowVector3fFloat multiply(PolynomialNDEigenRowVector3fFloat polynomial, SWIGTYPE_p_rw__math__PolynomialT_float_t p)
-
multiply
public static SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3f_float_t multiply(SWIGTYPE_p_rw__math__PolynomialNDT_Eigen__Matrix3f_float_t polynomial, SWIGTYPE_p_rw__math__PolynomialT_float_t p)
-
concat
public static Q concat(Q q1, Q q2)
concatenates q1 onto q2 such that the returned q has
the configurations of q1 in [0;q1.size()[ and has q2 in
[q1.size();q1.size()+q2.size()[- Parameters:
q1- [in] the first Qq2- [in] the second Q- Returns:
- the concatenation of q1 and q2
-
multiply
public static Quaternion multiply(double s, Quaternion v)
Scalar multiplication.
-
multiply
public static Quaternion_f multiply(float s, Quaternion_f v)
Scalar multiplication.
-
inverse
public static InertiaMatrixd inverse(InertiaMatrixd aRb)
-
inverse
public static PerspectiveTransform2D inverse(PerspectiveTransform2D aRb)
Take the inverse of a PerspectiveTransform2D.- Parameters:
aRb- [in] a PerspectiveTransform2D.- Returns:
- the inverse of aRb .
-
inverse
public static Quaternion inverse(Quaternion q)
Calculate the inverse Quaternion- Parameters:
q- [in] the quaternion being operated on- Returns:
- the inverse quaternion
-
inverse
public static Rotation2D inverse(Rotation2D aRb)
The inverse \robabx{b}{a}{\mathbf{R}} = \robabx{a}{b}{\mathbf{R}}^{-1} of a rotation matrix
- Parameters:
aRb- [in] the rotation matrix \robabx{a}{b}{\mathbf{R}}
- Returns:
- the matrix inverse \robabx{b}{a}{\mathbf{R}} =
\robabx{a}{b}{\mathbf{R}}^{-1}
\robabx{b}{a}{\mathbf{R}} = \robabx{a}{b}{\mathbf{R}}^{-1} = \robabx{a}{b}{\mathbf{R}}^T
-
inverse
public static Rotation3D inverse(Rotation3D aRb)
-
inverse
public static Transform3D inverse(Transform3D aTb)
-
inverse
public static InertiaMatrixf inverse(InertiaMatrixf aRb)
-
inverse
public static PerspectiveTransform2Df inverse(PerspectiveTransform2Df aRb)
Take the inverse of a PerspectiveTransform2D.- Parameters:
aRb- [in] a PerspectiveTransform2D.- Returns:
- the inverse of aRb .
-
inverse
public static Quaternion_f inverse(Quaternion_f q)
Calculate the inverse Quaternion- Parameters:
q- [in] the quaternion being operated on- Returns:
- the inverse quaternion
-
inverse
public static Rotation2Df inverse(Rotation2Df aRb)
The inverse \robabx{b}{a}{\mathbf{R}} = \robabx{a}{b}{\mathbf{R}}^{-1} of a rotation matrix
- Parameters:
aRb- [in] the rotation matrix \robabx{a}{b}{\mathbf{R}}
- Returns:
- the matrix inverse \robabx{b}{a}{\mathbf{R}} =
\robabx{a}{b}{\mathbf{R}}^{-1}
\robabx{b}{a}{\mathbf{R}} = \robabx{a}{b}{\mathbf{R}}^{-1} = \robabx{a}{b}{\mathbf{R}}^T
-
inverse
public static Rotation3Df inverse(Rotation3Df aRb)
-
inverse
public static Transform3Df inverse(Transform3Df aTb)
-
multiply
public static Transform3DVector multiply(double lhs, Transform3DVector rhs)
Scalar multiplication- Parameters:
lhs- [in] the scalar to multiply withrhs- [in] the Transform3DVector being multiplied with a scalar- Returns:
- product of the multiplication
-
add
public static Transform3DVector add(double lhs, Transform3DVector rhs)
Scalar addition- Parameters:
lhs- [in] the scalar to subtractionrhs- [in] the Transform3DVector being subtracted from- Returns:
- the difference
-
subtract
public static Transform3DVector subtract(double lhs, Transform3DVector rhs)
Scalar subtraction- Parameters:
lhs- [in] the scalar to subtractrhs- [in] the Transform3DVector being subtracted from- Returns:
- the difference
-
divide
public static Transform3DVector divide(double lhs, Transform3DVector rhs)
Scalar devision- Parameters:
lhs- [in] the scalar to devide withrhs- [in] the Transform3DVector being devided- Returns:
- the result
-
multiply
public static Transform3DVector_f multiply(float lhs, Transform3DVector_f rhs)
Scalar multiplication- Parameters:
lhs- [in] the scalar to multiply withrhs- [in] the Transform3DVector being multiplied with a scalar- Returns:
- product of the multiplication
-
add
public static Transform3DVector_f add(float lhs, Transform3DVector_f rhs)
Scalar addition- Parameters:
lhs- [in] the scalar to subtractionrhs- [in] the Transform3DVector being subtracted from- Returns:
- the difference
-
subtract
public static Transform3DVector_f subtract(float lhs, Transform3DVector_f rhs)
Scalar subtraction- Parameters:
lhs- [in] the scalar to subtractrhs- [in] the Transform3DVector being subtracted from- Returns:
- the difference
-
divide
public static Transform3DVector_f divide(float lhs, Transform3DVector_f rhs)
Scalar devision- Parameters:
lhs- [in] the scalar to devide withrhs- [in] the Transform3DVector being devided- Returns:
- the result
-
divide
public static Vector3D divide(double lhs, Vector3D rhs)
Scalar division.- Parameters:
lhs- [in] the scalar to devide withrhs- [out] the vector beind devided- Returns:
- result of devision
-
multiply
public static Vector3D multiply(double lhs, Vector3D rhs)
Scalar multiplication.- Parameters:
lhs- [in] the scalar to multiply withrhs- [in] the Vector to be multiplied- Returns:
- the product
-
divide
public static Vector3Df divide(float lhs, Vector3Df rhs)
Scalar division.- Parameters:
lhs- [in] the scalar to devide withrhs- [out] the vector beind devided- Returns:
- result of devision
-
multiply
public static Vector3Df multiply(float lhs, Vector3Df rhs)
Scalar multiplication.- Parameters:
lhs- [in] the scalar to multiply withrhs- [in] the Vector to be multiplied- Returns:
- the product
-
divide
public static Vector6Dd divide(double lhs, Vector6Dd rhs)
Scalar division.- Parameters:
lhs- [in] the scalar to devide withrhs- [out] the vector beind devided- Returns:
- result of devision
-
multiply
public static Vector6Dd multiply(double lhs, Vector6Dd rhs)
Scalar multiplication.- Parameters:
lhs- [in] the scalar to multiply withrhs- [in] the Vector to be multiplied- Returns:
- the product
-
divide
public static Vector6Df divide(float lhs, Vector6Df rhs)
Scalar division.- Parameters:
lhs- [in] the scalar to devide withrhs- [out] the vector beind devided- Returns:
- result of devision
-
multiply
public static Vector6Df multiply(float lhs, Vector6Df rhs)
Scalar multiplication.- Parameters:
lhs- [in] the scalar to multiply withrhs- [in] the Vector to be multiplied- Returns:
- the product
-
divide
public static Vector5Dd divide(double lhs, Vector5Dd rhs)
Scalar division.- Parameters:
lhs- [in] the scalar to devide withrhs- [out] the vector beind devided- Returns:
- result of devision
-
multiply
public static Vector5Dd multiply(double lhs, Vector5Dd rhs)
Scalar multiplication.- Parameters:
lhs- [in] the scalar to multiply withrhs- [in] the Vector to be multiplied- Returns:
- the product
-
divide
public static Vector5Df divide(float lhs, Vector5Df rhs)
Scalar division.- Parameters:
lhs- [in] the scalar to devide withrhs- [out] the vector beind devided- Returns:
- result of devision
-
multiply
public static Vector5Df multiply(float lhs, Vector5Df rhs)
Scalar multiplication.- Parameters:
lhs- [in] the scalar to multiply withrhs- [in] the Vector to be multiplied- Returns:
- the product
-
divide
public static Vector4Dd divide(double lhs, Vector4Dd rhs)
Scalar division.- Parameters:
lhs- [in] the scalar to devide withrhs- [out] the vector beind devided- Returns:
- result of devision
-
multiply
public static Vector4Dd multiply(double lhs, Vector4Dd rhs)
Scalar multiplication.- Parameters:
lhs- [in] the scalar to multiply withrhs- [in] the Vector to be multiplied- Returns:
- the product
-
divide
public static Vector4Df divide(float lhs, Vector4Df rhs)
Scalar division.- Parameters:
lhs- [in] the scalar to devide withrhs- [out] the vector beind devided- Returns:
- result of devision
-
multiply
public static Vector4Df multiply(float lhs, Vector4Df rhs)
Scalar multiplication.- Parameters:
lhs- [in] the scalar to multiply withrhs- [in] the Vector to be multiplied- Returns:
- the product
-
multiply
public static VelocityScrew6D multiply(double s, VelocityScrew6D screw)
Scales velocity screw and returns scaled version
- Parameters:
s- [in] scaling valuescrew- [in] Screw to scale- Returns:
- Scales screw
-
multiply
public static VelocityScrew6Df multiply(float s, VelocityScrew6Df screw)
Scales velocity screw and returns scaled version
- Parameters:
s- [in] scaling valuescrew- [in] Screw to scale- Returns:
- Scales screw
-
cast
public static EAAf cast(EAA eaa)
Casts EAA<T> to EAA<Q>- Parameters:
eaa- [in] EAA with type T- Returns:
- EAA with type Q
-
cast
public static InertiaMatrixf cast(InertiaMatrixd rot)
Casts InertiaMatrix<T> to InertiaMatrix<Q>- Parameters:
rot- [in] InertiaMatrix with type T- Returns:
- InertiaMatrix with type Q
-
cast
public static Pose6Df cast(Pose6D pose)
Casts Pose6D<T> to Pose6D<Q>- Parameters:
pose- [in] Pose6D with type T- Returns:
- Pose6D with type Q
-
cast
public static Quaternion_f cast(Quaternion quaternion)
Casts Quaternion<T> to Quaternion<Q>- Parameters:
quaternion- [in] Quarternion with type T- Returns:
- Quaternion with type Q
-
cast
public static Rotation2Df cast(Rotation2D rot)
Casts Rotation2D<T> to Rotation2D<Q>- Parameters:
rot- [in] Rotation2D with type T- Returns:
- Rotation2D with type R
-
cast
public static Wrench6Df cast(Wrench6D vs)
Casts Wrench6D<T> to Wrench6D<Q>
- Parameters:
vs- [in] Wrench6D with type T
- Returns:
- Wrench6D with type Q
-
cast
public static Rotation3Df cast(Rotation3D rot)
Casts Rotation3D<T> to Rotation3D<S>
- Parameters:
rot- [in] Rotation3D with type T- Returns:
- Rotation3D with type S
-
cast
public static RPYf cast(RPY rpy)
Casts RPY<T> to RPY<Q>
- Parameters:
rpy- [in] RPY with type T
- Returns:
- RPY with type Q
-
cast
public static Transform3Df cast(Transform3D trans)
Cast Transform3D<T> to Transform3D<Q>- Parameters:
trans- [in] Transform3D with type T- Returns:
- Transform3D with type Q
-
cast
public static Vector2Df cast(Vector2D v)
Casts Vector2D<T> to Vector2D<Q>
- Parameters:
v- [in] Vector2D with type T
- Returns:
- Vector2D with type Q
-
cast
public static Vector3Df cast(Vector3D v)
Casts Vector3D<T> to Vector3D<Q>- Parameters:
v- [in] Vector3D with type T- Returns:
- Vector3D with type Q
-
cast
public static VelocityScrew6Df cast(VelocityScrew6D vs)
Casts VelocityScrew6D<T> to VelocityScrew6D<Q>
- Parameters:
vs- [in] VelocityScrew6D with type T
- Returns:
- VelocityScrew6D with type Q
-
cast
public static EAA cast(EAAf eaa)
Casts EAA<T> to EAA<Q>- Parameters:
eaa- [in] EAA with type T- Returns:
- EAA with type Q
-
cast
public static InertiaMatrixd cast(InertiaMatrixf rot)
Casts InertiaMatrix<T> to InertiaMatrix<Q>- Parameters:
rot- [in] InertiaMatrix with type T- Returns:
- InertiaMatrix with type Q
-
cast
public static Pose6D cast(Pose6Df pose)
Casts Pose6D<T> to Pose6D<Q>- Parameters:
pose- [in] Pose6D with type T- Returns:
- Pose6D with type Q
-
cast
public static Quaternion cast(Quaternion_f quaternion)
Casts Quaternion<T> to Quaternion<Q>- Parameters:
quaternion- [in] Quarternion with type T- Returns:
- Quaternion with type Q
-
cast
public static Rotation2D cast(Rotation2Df rot)
Casts Rotation2D<T> to Rotation2D<Q>- Parameters:
rot- [in] Rotation2D with type T- Returns:
- Rotation2D with type R
-
cast
public static Wrench6D cast(Wrench6Df vs)
Casts Wrench6D<T> to Wrench6D<Q>
- Parameters:
vs- [in] Wrench6D with type T
- Returns:
- Wrench6D with type Q
-
cast
public static Rotation3D cast(Rotation3Df rot)
Casts Rotation3D<T> to Rotation3D<S>
- Parameters:
rot- [in] Rotation3D with type T- Returns:
- Rotation3D with type S
-
cast
public static RPY cast(RPYf rpy)
Casts RPY<T> to RPY<Q>
- Parameters:
rpy- [in] RPY with type T
- Returns:
- RPY with type Q
-
cast
public static Transform3D cast(Transform3Df trans)
Cast Transform3D<T> to Transform3D<Q>- Parameters:
trans- [in] Transform3D with type T- Returns:
- Transform3D with type Q
-
cast
public static Vector2D cast(Vector2Df v)
Casts Vector2D<T> to Vector2D<Q>
- Parameters:
v- [in] Vector2D with type T
- Returns:
- Vector2D with type Q
-
cast
public static Vector3D cast(Vector3Df v)
Casts Vector3D<T> to Vector3D<Q>- Parameters:
v- [in] Vector3D with type T- Returns:
- Vector3D with type Q
-
cast
public static VelocityScrew6D cast(VelocityScrew6Df vs)
Casts VelocityScrew6D<T> to VelocityScrew6D<Q>
- Parameters:
vs- [in] VelocityScrew6D with type T
- Returns:
- VelocityScrew6D with type Q
-
transpose
public static Rotation2D transpose(Rotation2D aRb)
Find the transpose of aRb.
The transpose of a rotation matrix is the same as the inverse.
-
transpose
public static Rotation2Df transpose(Rotation2Df aRb)
Find the transpose of aRb.
The transpose of a rotation matrix is the same as the inverse.
-
dot
public static double dot(Vector2D v1, Vector2D v2)
Calculates the dot product \mathbf{v1} . \mathbf{v2}- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}
- Returns:
- the dot product \mathbf{v1} . \mathbf{v2}
-
dot
public static double dot(Vector3D v1, Vector3D v2)
Calculates the dot product \mathbf{v1} . \mathbf{v2}- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}
- Returns:
- the dot product \mathbf{v1} . \mathbf{v2}
-
dot
public static double dot(Vector2Df v1, Vector2Df v2)
Calculates the dot product \mathbf{v1} . \mathbf{v2}- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}
- Returns:
- the dot product \mathbf{v1} . \mathbf{v2}
-
dot
public static float dot(Vector3Df v1, Vector3Df v2)
Calculates the dot product \mathbf{v1} . \mathbf{v2}- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}
- Returns:
- the dot product \mathbf{v1} . \mathbf{v2}
-
cross
public static double cross(Vector2D v1, Vector2D v2)
Calculates the 2D vector cross product \mathbf{v1} \times \mathbf{v2}
- Parameters:
v1- [in] \mathbf{v1}
v2- [in] \mathbf{v2}
- Returns:
- the cross product \mathbf{v1} \times \mathbf{v2}
The 2D vector cross product is defined as:
\mathbf{v1} \times \mathbf{v2} = v1_x * v2_y - v1_y * v2_x
-
cross
public static Vector3D cross(Vector3D v1, Vector3D v2)
Calculates the 3D vector cross product \mathbf{v1} \times \mathbf{v2}- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}
- Returns:
- the 3D vector cross product \mathbf{v1} \times \mathbf{v2}
The 3D vector cross product is defined as:
\mathbf{v1} \times \mathbf{v2} = \left[\begin{array}{c} v1_y * v2_z - v1_z * v2_y \\ v1_z * v2_x - v1_x * v2_z \\ v1_x * v2_y - v1_y * v2_x \end{array}\right]
-
cross
public static void cross(Vector3D v1, Vector3D v2, Vector3D dst)
Calculates the 3D vector cross product \mathbf{v1} \times \mathbf{v2}- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}dst- [out] the 3D vector cross product \mathbf{v1} \times \mathbf{v2}
The 3D vector cross product is defined as:
\mathbf{v1} \times \mathbf{v2} = \left[\begin{array}{c} v1_y * v2_z - v1_z * v2_y \\ v1_z * v2_x - v1_x * v2_z \\ v1_x * v2_y - v1_y * v2_x \end{array}\right]
-
cross
public static float cross(Vector2Df v1, Vector2Df v2)
Calculates the 2D vector cross product \mathbf{v1} \times \mathbf{v2}
- Parameters:
v1- [in] \mathbf{v1}
v2- [in] \mathbf{v2}
- Returns:
- the cross product \mathbf{v1} \times \mathbf{v2}
The 2D vector cross product is defined as:
\mathbf{v1} \times \mathbf{v2} = v1_x * v2_y - v1_y * v2_x
-
cross
public static Vector3Df cross(Vector3Df v1, Vector3Df v2)
Calculates the 3D vector cross product \mathbf{v1} \times \mathbf{v2}- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}
- Returns:
- the 3D vector cross product \mathbf{v1} \times \mathbf{v2}
The 3D vector cross product is defined as:
\mathbf{v1} \times \mathbf{v2} = \left[\begin{array}{c} v1_y * v2_z - v1_z * v2_y \\ v1_z * v2_x - v1_x * v2_z \\ v1_x * v2_y - v1_y * v2_x \end{array}\right]
-
cross
public static void cross(Vector3Df v1, Vector3Df v2, Vector3Df dst)
Calculates the 3D vector cross product \mathbf{v1} \times \mathbf{v2}- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}dst- [out] the 3D vector cross product \mathbf{v1} \times \mathbf{v2}
The 3D vector cross product is defined as:
\mathbf{v1} \times \mathbf{v2} = \left[\begin{array}{c} v1_y * v2_z - v1_z * v2_y \\ v1_z * v2_x - v1_x * v2_z \\ v1_x * v2_y - v1_y * v2_x \end{array}\right]
-
angle
public static double angle(Vector2D v1, Vector2D v2)
calculates the counter clock-wise angle from v1 to
v2. the value returned will be in the interval [-2Pi,2Pi]
-
angle
public static double angle(Vector3D v1, Vector3D v2, Vector3D n)
Calculates the angle from \mathbf{v1} to \mathbf{v2}
around the axis defined by \mathbf{v1} \times \mathbf{v2} with n
determining the sign.- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}n- [in] \mathbf{n}
- Returns:
- the angle
-
angle
public static double angle(Vector3D v1, Vector3D v2)
Calculates the angle from \mathbf{v1} to \mathbf{v2}
around the axis defined by \mathbf{v1} \times \mathbf{v2}- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}
- Returns:
- the angle
-
angle
public static double angle(Vector2Df v1, Vector2Df v2)
calculates the counter clock-wise angle from v1 to
v2. the value returned will be in the interval [-2Pi,2Pi]
-
angle
public static double angle(Vector3Df v1, Vector3Df v2, Vector3Df n)
Calculates the angle from \mathbf{v1} to \mathbf{v2}
around the axis defined by \mathbf{v1} \times \mathbf{v2} with n
determining the sign.- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}n- [in] \mathbf{n}
- Returns:
- the angle
-
angle
public static double angle(Vector3Df v1, Vector3Df v2)
Calculates the angle from \mathbf{v1} to \mathbf{v2}
around the axis defined by \mathbf{v1} \times \mathbf{v2}- Parameters:
v1- [in] \mathbf{v1}v2- [in] \mathbf{v2}
- Returns:
- the angle
-
normalize
public static Vector2D normalize(Vector2D v)
Returns the normalized vector
\mathbf{n}=\frac{\mathbf{v}}{\|\mathbf{v}\|} .
If \| \mathbf{v} \| = 0 then the zero vector is returned.
- Parameters:
v- [in] \mathbf{v} which should be normalized
- Returns:
- the normalized vector \mathbf{n}
-
normalize
public static Vector3D normalize(Vector3D v)
Returns the normalized vector \mathbf{n}=\frac{\mathbf{v}}{\|\mathbf{v}\|} .
In case \|mathbf{v}\| = 0 the zero vector is returned.- Parameters:
v- [in] \mathbf{v} which should be normalized- Returns:
- the normalized vector \mathbf{n}
-
normalize
public static Vector2Df normalize(Vector2Df v)
Returns the normalized vector
\mathbf{n}=\frac{\mathbf{v}}{\|\mathbf{v}\|} .
If \| \mathbf{v} \| = 0 then the zero vector is returned.
- Parameters:
v- [in] \mathbf{v} which should be normalized
- Returns:
- the normalized vector \mathbf{n}
-
normalize
public static Vector3Df normalize(Vector3Df v)
Returns the normalized vector \mathbf{n}=\frac{\mathbf{v}}{\|\mathbf{v}\|} .
In case \|mathbf{v}\| = 0 the zero vector is returned.- Parameters:
v- [in] \mathbf{v} which should be normalized- Returns:
- the normalized vector \mathbf{n}
-
norm1
public static float norm1(Wrench6Df wrench)
Takes the 1-norm of the wrench. All elements both
force and torque are given the same weight.
- Parameters:
wrench- [in] the wrench- Returns:
- the 1-norm
-
norm1
public static float norm1(VelocityScrew6Df screw)
Takes the 1-norm of the velocity screw. All elements both
angular and linear are given the same weight.
- Parameters:
screw- [in] the velocity screw- Returns:
- the 1-norm
-
norm1
public static double norm1(Wrench6D wrench)
Takes the 1-norm of the wrench. All elements both
force and torque are given the same weight.
- Parameters:
wrench- [in] the wrench- Returns:
- the 1-norm
-
norm1
public static double norm1(VelocityScrew6D screw)
Takes the 1-norm of the velocity screw. All elements both
angular and linear are given the same weight.
- Parameters:
screw- [in] the velocity screw- Returns:
- the 1-norm
-
norm2
public static float norm2(Wrench6Df wrench)
Takes the 2-norm of the wrench. All elements both
force and tporque are given the same weight
- Parameters:
wrench- [in] the wrench- Returns:
- the 2-norm
-
norm2
public static float norm2(VelocityScrew6Df screw)
Takes the 2-norm of the velocity screw. All elements both
angular and linear are given the same weight
- Parameters:
screw- [in] the velocity screw- Returns:
- the 2-norm
-
norm2
public static double norm2(Wrench6D wrench)
Takes the 2-norm of the wrench. All elements both
force and tporque are given the same weight
- Parameters:
wrench- [in] the wrench- Returns:
- the 2-norm
-
norm2
public static double norm2(VelocityScrew6D screw)
Takes the 2-norm of the velocity screw. All elements both
angular and linear are given the same weight
- Parameters:
screw- [in] the velocity screw- Returns:
- the 2-norm
-
normInf
public static float normInf(Wrench6Df wrench)
Takes the infinite norm of the wrench. All elements
both force and torque are given the same weight.
- Parameters:
wrench- [in] the wrench
- Returns:
- the infinite norm
-
normInf
public static float normInf(VelocityScrew6Df screw)
Takes the infinite norm of the velocity screw. All elements
both angular and linear are given the same weight.
- Parameters:
screw- [in] the velocity screw
- Returns:
- the infinite norm
-
normInf
public static double normInf(Wrench6D wrench)
Takes the infinite norm of the wrench. All elements
both force and torque are given the same weight.
- Parameters:
wrench- [in] the wrench
- Returns:
- the infinite norm
-
normInf
public static double normInf(VelocityScrew6D screw)
Takes the infinite norm of the velocity screw. All elements
both angular and linear are given the same weight.
- Parameters:
screw- [in] the velocity screw
- Returns:
- the infinite norm
-
castToFloat
public static EAAf castToFloat(EAA eaa)
Casts EAA<T> to EAA<Q>- Parameters:
eaa- [in] EAA with type T- Returns:
- EAA with type Q
-
castToFloat
public static InertiaMatrixf castToFloat(InertiaMatrixd rot)
Casts InertiaMatrix<T> to InertiaMatrix<Q>- Parameters:
rot- [in] InertiaMatrix with type T- Returns:
- InertiaMatrix with type Q
-
castToFloat
public static Pose6Df castToFloat(Pose6D pose)
Casts Pose6D<T> to Pose6D<Q>- Parameters:
pose- [in] Pose6D with type T- Returns:
- Pose6D with type Q
-
castToFloat
public static Quaternion_f castToFloat(Quaternion quaternion)
Casts Quaternion<T> to Quaternion<Q>- Parameters:
quaternion- [in] Quarternion with type T- Returns:
- Quaternion with type Q
-
castToFloat
public static Rotation2Df castToFloat(Rotation2D rot)
Casts Rotation2D<T> to Rotation2D<Q>- Parameters:
rot- [in] Rotation2D with type T- Returns:
- Rotation2D with type R
-
castToFloat
public static Wrench6Df castToFloat(Wrench6D vs)
Casts Wrench6D<T> to Wrench6D<Q>
- Parameters:
vs- [in] Wrench6D with type T
- Returns:
- Wrench6D with type Q
-
castToFloat
public static Rotation3Df castToFloat(Rotation3D rot)
Casts Rotation3D<T> to Rotation3D<S>
- Parameters:
rot- [in] Rotation3D with type T- Returns:
- Rotation3D with type S
-
castToFloat
public static RPYf castToFloat(RPY rpy)
Casts RPY<T> to RPY<Q>
- Parameters:
rpy- [in] RPY with type T
- Returns:
- RPY with type Q
-
castToFloat
public static Transform3Df castToFloat(Transform3D trans)
Cast Transform3D<T> to Transform3D<Q>- Parameters:
trans- [in] Transform3D with type T- Returns:
- Transform3D with type Q
-
castToFloat
public static Vector2Df castToFloat(Vector2D v)
Casts Vector2D<T> to Vector2D<Q>
- Parameters:
v- [in] Vector2D with type T
- Returns:
- Vector2D with type Q
-
castToFloat
public static Vector3Df castToFloat(Vector3D v)
Casts Vector3D<T> to Vector3D<Q>- Parameters:
v- [in] Vector3D with type T- Returns:
- Vector3D with type Q
-
castToFloat
public static VelocityScrew6Df castToFloat(VelocityScrew6D vs)
Casts VelocityScrew6D<T> to VelocityScrew6D<Q>
- Parameters:
vs- [in] VelocityScrew6D with type T
- Returns:
- VelocityScrew6D with type Q
-
castToDouble
public static EAA castToDouble(EAAf eaa)
Casts EAA<T> to EAA<Q>- Parameters:
eaa- [in] EAA with type T- Returns:
- EAA with type Q
-
castToDouble
public static InertiaMatrixd castToDouble(InertiaMatrixf rot)
Casts InertiaMatrix<T> to InertiaMatrix<Q>- Parameters:
rot- [in] InertiaMatrix with type T- Returns:
- InertiaMatrix with type Q
-
castToDouble
public static Pose6D castToDouble(Pose6Df pose)
Casts Pose6D<T> to Pose6D<Q>- Parameters:
pose- [in] Pose6D with type T- Returns:
- Pose6D with type Q
-
castToDouble
public static Quaternion castToDouble(Quaternion_f quaternion)
Casts Quaternion<T> to Quaternion<Q>- Parameters:
quaternion- [in] Quarternion with type T- Returns:
- Quaternion with type Q
-
castToDouble
public static Rotation2D castToDouble(Rotation2Df rot)
Casts Rotation2D<T> to Rotation2D<Q>- Parameters:
rot- [in] Rotation2D with type T- Returns:
- Rotation2D with type R
-
castToDouble
public static Wrench6D castToDouble(Wrench6Df vs)
Casts Wrench6D<T> to Wrench6D<Q>
- Parameters:
vs- [in] Wrench6D with type T
- Returns:
- Wrench6D with type Q
-
castToDouble
public static Rotation3D castToDouble(Rotation3Df rot)
Casts Rotation3D<T> to Rotation3D<S>
- Parameters:
rot- [in] Rotation3D with type T- Returns:
- Rotation3D with type S
-
castToDouble
public static RPY castToDouble(RPYf rpy)
Casts RPY<T> to RPY<Q>
- Parameters:
rpy- [in] RPY with type T
- Returns:
- RPY with type Q
-
castToDouble
public static Transform3D castToDouble(Transform3Df trans)
Cast Transform3D<T> to Transform3D<Q>- Parameters:
trans- [in] Transform3D with type T- Returns:
- Transform3D with type Q
-
castToDouble
public static Vector2D castToDouble(Vector2Df v)
Casts Vector2D<T> to Vector2D<Q>
- Parameters:
v- [in] Vector2D with type T
- Returns:
- Vector2D with type Q
-
castToDouble
public static Vector3D castToDouble(Vector3Df v)
Casts Vector3D<T> to Vector3D<Q>- Parameters:
v- [in] Vector3D with type T- Returns:
- Vector3D with type Q
-
castToDouble
public static VelocityScrew6D castToDouble(VelocityScrew6Df vs)
Casts VelocityScrew6D<T> to VelocityScrew6D<Q>
- Parameters:
vs- [in] VelocityScrew6D with type T
- Returns:
- VelocityScrew6D with type Q
-
-