2009-09-20 18:00:39 +08:00
|
|
|
// This file is part of Eigen, a lightweight C++ template library
|
|
|
|
// for linear algebra.
|
|
|
|
//
|
|
|
|
// Copyright (C) 2009 Benoit Jacob <jacob.benoit.1@gmail.com>
|
|
|
|
//
|
2012-07-14 02:42:47 +08:00
|
|
|
// This Source Code Form is subject to the terms of the Mozilla
|
|
|
|
// Public License v. 2.0. If a copy of the MPL was not distributed
|
|
|
|
// with this file, You can obtain one at http://mozilla.org/MPL/2.0/.
|
2009-09-20 18:00:39 +08:00
|
|
|
|
2009-09-20 17:49:17 +08:00
|
|
|
// This C++ file compiles to binary code that can be linked to by your C program,
|
|
|
|
// thanks to the extern "C" syntax used in the declarations in binary_library.h.
|
|
|
|
|
|
|
|
#include "binary_library.h"
|
|
|
|
|
|
|
|
#include <Eigen/Core>
|
|
|
|
|
|
|
|
using namespace Eigen;
|
|
|
|
|
|
|
|
/************************* pointer conversion methods **********************************************/
|
|
|
|
|
|
|
|
////// class MatrixXd //////
|
|
|
|
|
|
|
|
inline MatrixXd& c_to_eigen(C_MatrixXd* ptr)
|
|
|
|
{
|
|
|
|
return *reinterpret_cast<MatrixXd*>(ptr);
|
|
|
|
}
|
|
|
|
|
|
|
|
inline const MatrixXd& c_to_eigen(const C_MatrixXd* ptr)
|
|
|
|
{
|
|
|
|
return *reinterpret_cast<const MatrixXd*>(ptr);
|
|
|
|
}
|
|
|
|
|
|
|
|
inline C_MatrixXd* eigen_to_c(MatrixXd& ref)
|
|
|
|
{
|
|
|
|
return reinterpret_cast<C_MatrixXd*>(&ref);
|
|
|
|
}
|
|
|
|
|
|
|
|
inline const C_MatrixXd* eigen_to_c(const MatrixXd& ref)
|
|
|
|
{
|
|
|
|
return reinterpret_cast<const C_MatrixXd*>(&ref);
|
|
|
|
}
|
|
|
|
|
|
|
|
////// class Map<MatrixXd> //////
|
|
|
|
|
|
|
|
inline Map<MatrixXd>& c_to_eigen(C_Map_MatrixXd* ptr)
|
|
|
|
{
|
|
|
|
return *reinterpret_cast<Map<MatrixXd>*>(ptr);
|
|
|
|
}
|
|
|
|
|
|
|
|
inline const Map<MatrixXd>& c_to_eigen(const C_Map_MatrixXd* ptr)
|
|
|
|
{
|
|
|
|
return *reinterpret_cast<const Map<MatrixXd>*>(ptr);
|
|
|
|
}
|
|
|
|
|
|
|
|
inline C_Map_MatrixXd* eigen_to_c(Map<MatrixXd>& ref)
|
|
|
|
{
|
|
|
|
return reinterpret_cast<C_Map_MatrixXd*>(&ref);
|
|
|
|
}
|
|
|
|
|
|
|
|
inline const C_Map_MatrixXd* eigen_to_c(const Map<MatrixXd>& ref)
|
|
|
|
{
|
|
|
|
return reinterpret_cast<const C_Map_MatrixXd*>(&ref);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/************************* implementation of classes **********************************************/
|
|
|
|
|
|
|
|
|
|
|
|
////// class MatrixXd //////
|
|
|
|
|
|
|
|
|
|
|
|
C_MatrixXd* MatrixXd_new(int rows, int cols)
|
|
|
|
{
|
|
|
|
return eigen_to_c(*new MatrixXd(rows,cols));
|
|
|
|
}
|
|
|
|
|
|
|
|
void MatrixXd_delete(C_MatrixXd *m)
|
|
|
|
{
|
|
|
|
delete &c_to_eigen(m);
|
|
|
|
}
|
|
|
|
|
|
|
|
double* MatrixXd_data(C_MatrixXd *m)
|
|
|
|
{
|
|
|
|
return c_to_eigen(m).data();
|
|
|
|
}
|
|
|
|
|
|
|
|
void MatrixXd_set_zero(C_MatrixXd *m)
|
|
|
|
{
|
|
|
|
c_to_eigen(m).setZero();
|
|
|
|
}
|
|
|
|
|
|
|
|
void MatrixXd_resize(C_MatrixXd *m, int rows, int cols)
|
|
|
|
{
|
|
|
|
c_to_eigen(m).resize(rows,cols);
|
|
|
|
}
|
|
|
|
|
|
|
|
void MatrixXd_copy(C_MatrixXd *dst, const C_MatrixXd *src)
|
|
|
|
{
|
|
|
|
c_to_eigen(dst) = c_to_eigen(src);
|
|
|
|
}
|
|
|
|
|
|
|
|
void MatrixXd_copy_map(C_MatrixXd *dst, const C_Map_MatrixXd *src)
|
|
|
|
{
|
|
|
|
c_to_eigen(dst) = c_to_eigen(src);
|
|
|
|
}
|
|
|
|
|
|
|
|
void MatrixXd_set_coeff(C_MatrixXd *m, int i, int j, double coeff)
|
|
|
|
{
|
|
|
|
c_to_eigen(m)(i,j) = coeff;
|
|
|
|
}
|
|
|
|
|
|
|
|
double MatrixXd_get_coeff(const C_MatrixXd *m, int i, int j)
|
|
|
|
{
|
|
|
|
return c_to_eigen(m)(i,j);
|
|
|
|
}
|
|
|
|
|
|
|
|
void MatrixXd_print(const C_MatrixXd *m)
|
|
|
|
{
|
|
|
|
std::cout << c_to_eigen(m) << std::endl;
|
|
|
|
}
|
|
|
|
|
|
|
|
void MatrixXd_multiply(const C_MatrixXd *m1, const C_MatrixXd *m2, C_MatrixXd *result)
|
|
|
|
{
|
|
|
|
c_to_eigen(result) = c_to_eigen(m1) * c_to_eigen(m2);
|
|
|
|
}
|
|
|
|
|
|
|
|
void MatrixXd_add(const C_MatrixXd *m1, const C_MatrixXd *m2, C_MatrixXd *result)
|
|
|
|
{
|
|
|
|
c_to_eigen(result) = c_to_eigen(m1) + c_to_eigen(m2);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
////// class Map_MatrixXd //////
|
|
|
|
|
|
|
|
|
|
|
|
C_Map_MatrixXd* Map_MatrixXd_new(double *array, int rows, int cols)
|
|
|
|
{
|
|
|
|
return eigen_to_c(*new Map<MatrixXd>(array,rows,cols));
|
|
|
|
}
|
|
|
|
|
|
|
|
void Map_MatrixXd_delete(C_Map_MatrixXd *m)
|
|
|
|
{
|
|
|
|
delete &c_to_eigen(m);
|
|
|
|
}
|
|
|
|
|
|
|
|
void Map_MatrixXd_set_zero(C_Map_MatrixXd *m)
|
|
|
|
{
|
|
|
|
c_to_eigen(m).setZero();
|
|
|
|
}
|
|
|
|
|
|
|
|
void Map_MatrixXd_copy(C_Map_MatrixXd *dst, const C_Map_MatrixXd *src)
|
|
|
|
{
|
|
|
|
c_to_eigen(dst) = c_to_eigen(src);
|
|
|
|
}
|
|
|
|
|
|
|
|
void Map_MatrixXd_copy_matrix(C_Map_MatrixXd *dst, const C_MatrixXd *src)
|
|
|
|
{
|
|
|
|
c_to_eigen(dst) = c_to_eigen(src);
|
|
|
|
}
|
|
|
|
|
|
|
|
void Map_MatrixXd_set_coeff(C_Map_MatrixXd *m, int i, int j, double coeff)
|
|
|
|
{
|
|
|
|
c_to_eigen(m)(i,j) = coeff;
|
|
|
|
}
|
|
|
|
|
|
|
|
double Map_MatrixXd_get_coeff(const C_Map_MatrixXd *m, int i, int j)
|
|
|
|
{
|
|
|
|
return c_to_eigen(m)(i,j);
|
|
|
|
}
|
|
|
|
|
|
|
|
void Map_MatrixXd_print(const C_Map_MatrixXd *m)
|
|
|
|
{
|
|
|
|
std::cout << c_to_eigen(m) << std::endl;
|
|
|
|
}
|
|
|
|
|
|
|
|
void Map_MatrixXd_multiply(const C_Map_MatrixXd *m1, const C_Map_MatrixXd *m2, C_Map_MatrixXd *result)
|
|
|
|
{
|
|
|
|
c_to_eigen(result) = c_to_eigen(m1) * c_to_eigen(m2);
|
|
|
|
}
|
|
|
|
|
|
|
|
void Map_MatrixXd_add(const C_Map_MatrixXd *m1, const C_Map_MatrixXd *m2, C_Map_MatrixXd *result)
|
|
|
|
{
|
|
|
|
c_to_eigen(result) = c_to_eigen(m1) + c_to_eigen(m2);
|
|
|
|
}
|