17 #include "Eigen/Dense"
23 if (val < 0 && std::abs(val) * std::pow(10, precision) < 1.) {
37 template <
typename derived_t>
40 std::ostringstream sout;
42 sout << std::setiosflags(std::ios::fixed) << std::setprecision(
precision);
43 if (matrix.cols() == 1) {
45 for (
int i = 0;
i < matrix.rows(); ++
i) {
48 if (
i != matrix.rows() - 1) {
54 for (
int i = 0;
i < matrix.rows(); ++
i) {
55 for (
int j = 0;
j < matrix.cols(); ++
j) {
61 if (
j == matrix.cols() - 1) {
67 if (
i != matrix.rows() -
84 trans[0] = translation.x();
85 trans[1] = translation.y();
86 trans[2] = translation.z();
97 std::ostringstream sout;
101 sout <<
offset <<
"Rotation : "