12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Added GSL/ATLAS version of multiplyAdd() and transposeMultiplyAdd()

release/4.3a0
Alex Cunningham 2010-01-31 18:25:03 +00:00
parent 74dd7128ac
commit c266012dcd
1 changed files with 18 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
cpp/Matrix.cpp
View File

@ -138,14 +138,20 @@ bool assert_equal(const Matrix& expected, const Matrix& actual, double tol) {
/* ************************************************************************* */
void multiplyAdd(double alpha, const Matrix& A, const Vector& x, Vector& e) {
#ifdef GSL
gsl_vector_const_view xg = gsl_vector_const_view_array(x.data().begin(), x.size());
gsl_vector_view eg = gsl_vector_view_array(e.data().begin(), e.size());
gsl_matrix_const_view Ag = gsl_matrix_const_view_array(A.data().begin(), A.size1(), A.size2());
gsl_blas_dgemv (CblasNoTrans, alpha, &(Ag.matrix), &(xg.vector), 1.0, &(eg.vector));
#else
// ublas e += prod(A,x) is terribly slow
// TODO: use BLAS
for (int i = 0; i < A.size1(); i++) {
double& ei = e(i);
for (int j = 0; j < A.size2(); j++) {
ei += alpha * A(i, j) * x(j);
}
double& ei = e(i);
for (int j = 0; j < A.size2(); j++) {
ei += alpha * A(i, j) * x(j);
}
}
#endif
}
/* ************************************************************************* */
@ -159,6 +165,12 @@ Vector operator^(const Matrix& A, const Vector & v) {
/* ************************************************************************* */
void transposeMultiplyAdd(double alpha, const Matrix& A, const Vector& e, Vector& x) {
#ifdef GSL
gsl_vector_const_view eg = gsl_vector_const_view_array(e.data().begin(), e.size());
gsl_vector_view xg = gsl_vector_view_array(x.data().begin(), x.size());
gsl_matrix_const_view Ag = gsl_matrix_const_view_array(A.data().begin(), A.size1(), A.size2());
gsl_blas_dgemv (CblasTrans, alpha, &(Ag.matrix), &(eg.vector), 1.0, &(xg.vector));
#else
// ublas x += prod(trans(A),e) is terribly slow
// TODO: use BLAS
for (int j = 0; j < A.size2(); j++) {
@ -167,6 +179,7 @@ void transposeMultiplyAdd(double alpha, const Matrix& A, const Vector& e, Vector
xj += alpha * A(i, j) * e(i);
}
}
#endif
}
/* ************************************************************************* */