Function swri_transform_util::GetLowerRight

• Defined in File transform_util.h

Function Documentation

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

Gets the lower-right 3x3 sub-matrix of a 6x6 matrix.

Parameters:

matrix – [in] The 6x6 matrix.

Returns:

The lower-right 3x3 sub-matrix.