MCPcopy Create free account
hub / github.com/PX4/eigen / sparse_solvers

Function sparse_solvers

test/sparse_solvers.cpp:33–102  ·  view source on GitHub ↗

Source from the content-addressed store, hash-verified

31}
32
33template<typename Scalar> void sparse_solvers(int rows, int cols)
34{
35 double density = (std::max)(8./(rows*cols), 0.01);
36 typedef Matrix<Scalar,Dynamic,Dynamic> DenseMatrix;
37 typedef Matrix<Scalar,Dynamic,1> DenseVector;
38 // Scalar eps = 1e-6;
39
40 DenseVector vec1 = DenseVector::Random(rows);
41
42 std::vector<Vector2i> zeroCoords;
43 std::vector<Vector2i> nonzeroCoords;
44
45 // test triangular solver
46 {
47 DenseVector vec2 = vec1, vec3 = vec1;
48 SparseMatrix<Scalar> m2(rows, cols);
49 DenseMatrix refMat2 = DenseMatrix::Zero(rows, cols);
50
51 // lower - dense
52 initSparse<Scalar>(density, refMat2, m2, ForceNonZeroDiag|MakeLowerTriangular, &zeroCoords, &nonzeroCoords);
53 VERIFY_IS_APPROX(refMat2.template triangularView<Lower>().solve(vec2),
54 m2.template triangularView<Lower>().solve(vec3));
55
56 // upper - dense
57 initSparse<Scalar>(density, refMat2, m2, ForceNonZeroDiag|MakeUpperTriangular, &zeroCoords, &nonzeroCoords);
58 VERIFY_IS_APPROX(refMat2.template triangularView<Upper>().solve(vec2),
59 m2.template triangularView<Upper>().solve(vec3));
60 VERIFY_IS_APPROX(refMat2.conjugate().template triangularView<Upper>().solve(vec2),
61 m2.conjugate().template triangularView<Upper>().solve(vec3));
62 {
63 SparseMatrix<Scalar> cm2(m2);
64 //Index rows, Index cols, Index nnz, Index* outerIndexPtr, Index* innerIndexPtr, Scalar* valuePtr
65 MappedSparseMatrix<Scalar> mm2(rows, cols, cm2.nonZeros(), cm2.outerIndexPtr(), cm2.innerIndexPtr(), cm2.valuePtr());
66 VERIFY_IS_APPROX(refMat2.conjugate().template triangularView<Upper>().solve(vec2),
67 mm2.conjugate().template triangularView<Upper>().solve(vec3));
68 }
69
70 // lower - transpose
71 initSparse<Scalar>(density, refMat2, m2, ForceNonZeroDiag|MakeLowerTriangular, &zeroCoords, &nonzeroCoords);
72 VERIFY_IS_APPROX(refMat2.transpose().template triangularView<Upper>().solve(vec2),
73 m2.transpose().template triangularView<Upper>().solve(vec3));
74
75 // upper - transpose
76 initSparse<Scalar>(density, refMat2, m2, ForceNonZeroDiag|MakeUpperTriangular, &zeroCoords, &nonzeroCoords);
77 VERIFY_IS_APPROX(refMat2.transpose().template triangularView<Lower>().solve(vec2),
78 m2.transpose().template triangularView<Lower>().solve(vec3));
79
80 SparseMatrix<Scalar> matB(rows, rows);
81 DenseMatrix refMatB = DenseMatrix::Zero(rows, rows);
82
83 // lower - sparse
84 initSparse<Scalar>(density, refMat2, m2, ForceNonZeroDiag|MakeLowerTriangular);
85 initSparse<Scalar>(density, refMatB, matB);
86 refMat2.template triangularView<Lower>().solveInPlace(refMatB);
87 m2.template triangularView<Lower>().solveInPlace(matB);
88 VERIFY_IS_APPROX(matB.toDense(), refMatB);
89
90 // upper - sparse

Callers

nothing calls this directly

Calls 9

solveMethod · 0.45
conjugateMethod · 0.45
nonZerosMethod · 0.45
outerIndexPtrMethod · 0.45
innerIndexPtrMethod · 0.45
valuePtrMethod · 0.45
transposeMethod · 0.45
solveInPlaceMethod · 0.45
toDenseMethod · 0.45

Tested by

no test coverage detected