Function swri_transform_util::GetUpperLeft

• Defined in File transform_util.h

Function Documentation

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

Gets the upper-left 3x3 sub-matrix of a 6x6 matrix.

Parameters:

matrix – [in] The 6x6 matrix.

Returns:

The upper-left 3x3 sub-matrix.