Function swri_transform_util::Set3x3Cov

• Defined in File transform_util.h

Function Documentation

void swri_transform_util::Set3x3Cov(const tf2::Matrix3x3 &matrix_in, std::array<double, 9> &matrix_out)

Converts the Matrix3x3 matrix into a 9 element covariance matrix from Imu messages

Parameters:

• matrix_in – [in] The input matrix

• matrix_out – [out] The output matrix