29 Eigen::Matrix<IntScalarType, dim - 1, dim>::Zero();
32 for (
int ind = 0; ind < dim; ind++) {
41 if (firstNonZero == dim - 1)
44 out(firstNonZero, firstNonZero) =
45 -in(firstNonZero + 1) /
47 out(firstNonZero, firstNonZero + 1) =
51 for (
int ind = firstNonZero + 2; ind < dim; ind++) {
53 out.row(ind - 1) = Eigen::Vector<IntScalarType, dim>::Zero(dim);
54 out(ind - 1, ind) = 1;
57 Eigen::Vector<IntScalarType, 3> truncated_in;
58 truncated_in << in(ind - 2), in(ind - 1), in(ind);
64 truncated_in(0), truncated_in(1),
71 out(ind - 1, ind - 2) = x;
72 out(ind - 1, ind - 1) = y;