Merged in f5soh/librepilot/update_credits (pull request #529)
[librepilot.git] / ground / gcs / src / libs / eigen / bench / BenchSparseUtil.h
blob13981f6b716b816c252c558957ae59a0b5e05a5f
2 #include <Eigen/Sparse>
3 #include <bench/BenchTimer.h>
4 #include <set>
6 using namespace std;
7 using namespace Eigen;
8 using namespace Eigen;
10 #ifndef SIZE
11 #define SIZE 1024
12 #endif
14 #ifndef DENSITY
15 #define DENSITY 0.01
16 #endif
18 #ifndef SCALAR
19 #define SCALAR double
20 #endif
22 typedef SCALAR Scalar;
23 typedef Matrix<Scalar,Dynamic,Dynamic> DenseMatrix;
24 typedef Matrix<Scalar,Dynamic,1> DenseVector;
25 typedef SparseMatrix<Scalar> EigenSparseMatrix;
27 void fillMatrix(float density, int rows, int cols, EigenSparseMatrix& dst)
29 dst.reserve(double(rows)*cols*density);
30 for(int j = 0; j < cols; j++)
32 for(int i = 0; i < rows; i++)
34 Scalar v = (internal::random<float>(0,1) < density) ? internal::random<Scalar>() : 0;
35 if (v!=0)
36 dst.insert(i,j) = v;
39 dst.finalize();
42 void fillMatrix2(int nnzPerCol, int rows, int cols, EigenSparseMatrix& dst)
44 // std::cout << "alloc " << nnzPerCol*cols << "\n";
45 dst.reserve(nnzPerCol*cols);
46 for(int j = 0; j < cols; j++)
48 std::set<int> aux;
49 for(int i = 0; i < nnzPerCol; i++)
51 int k = internal::random<int>(0,rows-1);
52 while (aux.find(k)!=aux.end())
53 k = internal::random<int>(0,rows-1);
54 aux.insert(k);
56 dst.insert(k,j) = internal::random<Scalar>();
59 dst.finalize();
62 void eiToDense(const EigenSparseMatrix& src, DenseMatrix& dst)
64 dst.setZero();
65 for (int j=0; j<src.cols(); ++j)
66 for (EigenSparseMatrix::InnerIterator it(src.derived(), j); it; ++it)
67 dst(it.index(),j) = it.value();
70 #ifndef NOGMM
71 #include "gmm/gmm.h"
72 typedef gmm::csc_matrix<Scalar> GmmSparse;
73 typedef gmm::col_matrix< gmm::wsvector<Scalar> > GmmDynSparse;
74 void eiToGmm(const EigenSparseMatrix& src, GmmSparse& dst)
76 GmmDynSparse tmp(src.rows(), src.cols());
77 for (int j=0; j<src.cols(); ++j)
78 for (EigenSparseMatrix::InnerIterator it(src.derived(), j); it; ++it)
79 tmp(it.index(),j) = it.value();
80 gmm::copy(tmp, dst);
82 #endif
84 #ifndef NOMTL
85 #include <boost/numeric/mtl/mtl.hpp>
86 typedef mtl::compressed2D<Scalar, mtl::matrix::parameters<mtl::tag::col_major> > MtlSparse;
87 typedef mtl::compressed2D<Scalar, mtl::matrix::parameters<mtl::tag::row_major> > MtlSparseRowMajor;
88 void eiToMtl(const EigenSparseMatrix& src, MtlSparse& dst)
90 mtl::matrix::inserter<MtlSparse> ins(dst);
91 for (int j=0; j<src.cols(); ++j)
92 for (EigenSparseMatrix::InnerIterator it(src.derived(), j); it; ++it)
93 ins[it.index()][j] = it.value();
95 #endif
97 #ifdef CSPARSE
98 extern "C" {
99 #include "cs.h"
101 void eiToCSparse(const EigenSparseMatrix& src, cs* &dst)
103 cs* aux = cs_spalloc (0, 0, 1, 1, 1);
104 for (int j=0; j<src.cols(); ++j)
105 for (EigenSparseMatrix::InnerIterator it(src.derived(), j); it; ++it)
106 if (!cs_entry(aux, it.index(), j, it.value()))
108 std::cout << "cs_entry error\n";
109 exit(2);
111 dst = cs_compress(aux);
112 // cs_spfree(aux);
114 #endif // CSPARSE
116 #ifndef NOUBLAS
117 #include <boost/numeric/ublas/vector.hpp>
118 #include <boost/numeric/ublas/matrix.hpp>
119 #include <boost/numeric/ublas/io.hpp>
120 #include <boost/numeric/ublas/triangular.hpp>
121 #include <boost/numeric/ublas/vector_sparse.hpp>
122 #include <boost/numeric/ublas/matrix_sparse.hpp>
123 #include <boost/numeric/ublas/vector_of_vector.hpp>
124 #include <boost/numeric/ublas/operation.hpp>
126 typedef boost::numeric::ublas::compressed_matrix<Scalar,boost::numeric::ublas::column_major> UBlasSparse;
128 void eiToUblas(const EigenSparseMatrix& src, UBlasSparse& dst)
130 dst.resize(src.rows(), src.cols(), false);
131 for (int j=0; j<src.cols(); ++j)
132 for (EigenSparseMatrix::InnerIterator it(src.derived(), j); it; ++it)
133 dst(it.index(),j) = it.value();
136 template <typename EigenType, typename UblasType>
137 void eiToUblasVec(const EigenType& src, UblasType& dst)
139 dst.resize(src.size());
140 for (int j=0; j<src.size(); ++j)
141 dst[j] = src.coeff(j);
143 #endif
145 #ifdef OSKI
146 extern "C" {
147 #include <oski/oski.h>
149 #endif