Function swri_transform_util::SetUpperLeft

• Defined in File transform_util.h

Function Documentation

void swri_transform_util::SetUpperLeft(const tf2::Matrix3x3 &sub_matrix, std::array<double, 36> &matrix)

Sets the upper-left quadrant of a 6x6 matrix with the specified 3x3 sub-matrix

Parameters:

• sub_matrix – [in] The 3x3 sub-matrix.

• matrix – [out] The 6x6 matrix to modify.