iDynTree/AttitudeEstimatorUtils.h file

Functions

auto checkValidMeasurement(const iDynTree::Vector3& in, const std::string& measurement_type, bool check_also_zero_vector) -> bool
check a valid measurement
auto getUnitVector(const iDynTree::Vector3& in, iDynTree::Vector3& out) -> bool
get unit vector
auto isVectorNaN(const iDynTree::Vector3& vec) -> bool
checks if vector has NaN values any element of vector is NaN implies a NaN vector
auto isZeroVector(const iDynTree::Vector3& vec) -> bool
checks if vector is a zero vector all elements of vector are zero implies a zero vector
auto crossVector(const iDynTree::Vector3& a, const iDynTree::Vector3& b) -> iDynTree::Vector3
computes the cross vector of two 3D vectors
auto mapR3Toso3(const iDynTree::Vector3& omega) -> iDynTree::Matrix3x3
computes $ 3 \times 3 $ skew-symmetric matrix ( $ \mathbb{so}(3) $ space) for a given 3d vector ( $ \mathbb{R}^3 $ space)
auto checkSkewSymmetricity(const iDynTree::Matrix3x3& S) -> bool
checks if the $ 3 \times 3 $ matrix is skew-symmetric

Defines

#define _USE_MATH_DEFINES

Function documentation

bool checkValidMeasurement(const iDynTree::Vector3& in, const std::string& measurement_type, bool check_also_zero_vector)

check a valid measurement

Returns bool true/false

bool getUnitVector(const iDynTree::Vector3& in, iDynTree::Vector3& out)

get unit vector

Returns bool false if input vector has zero norm

bool isVectorNaN(const iDynTree::Vector3& vec)

checks if vector has NaN values any element of vector is NaN implies a NaN vector

Parameters
vec in vector3
Returns bool true/false

bool isZeroVector(const iDynTree::Vector3& vec)

checks if vector is a zero vector all elements of vector are zero implies a zero vector

Parameters
vec in vector3
Returns bool true/false

iDynTree::Vector3 crossVector(const iDynTree::Vector3& a, const iDynTree::Vector3& b)

computes the cross vector of two 3D vectors

Parameters
in 3D vector
in 3D vector
Returns iDynTree::Vector3

iDynTree::Matrix3x3 mapR3Toso3(const iDynTree::Vector3& omega)

computes $ 3 \times 3 $ skew-symmetric matrix ( $ \mathbb{so}(3) $ space) for a given 3d vector ( $ \mathbb{R}^3 $ space)

Parameters
omega in 3d vector (usually angular velocity)
Returns iDynTree::Matrix3x3

bool checkSkewSymmetricity(const iDynTree::Matrix3x3& S)

checks if the $ 3 \times 3 $ matrix is skew-symmetric

Parameters
in $ 3 \times 3 $ matrix
Returns bool true/false
\[ S + S^T = 0 \]