[eigen] Replace jrl-mal with eigen

Author: Rohan Budhiraja

.gitmodules

@@ -1,6 +1,6 @@
 [submodule "jrl-cmakemodules"]
-	path = jrl-cmakemodules
-	url = git://github.com/jrl-umi3218/jrl-cmakemodules.git
+	   path = jrl-cmakemodules
+	   url = git://github.com/jrl-umi3218/jrl-cmakemodules.git
 [submodule "cmake"]
 	path = cmake
 	url = git://github.com/jrl-umi3218/jrl-cmakemodules.git

.travis.yml

@@ -1,4 +1,5 @@
 language: cpp
+sudo: required
 compiler:
   - gcc
   - clang

CMakeLists.txt

@@ -17,6 +17,7 @@ CMAKE_MINIMUM_REQUIRED(VERSION 2.6)
 
 INCLUDE(cmake/base.cmake)
 INCLUDE(cmake/boost.cmake)
+INCLUDE(cmake/eigen.cmake)
 INCLUDE(cmake/pthread.cmake)
 INCLUDE(cmake/cpack.cmake)
 
@@ -31,9 +32,6 @@ SET(LIBRARY_OUTPUT_PATH ${PROJECT_BINARY_DIR}/lib)
 
 SETUP_PROJECT()
 
-# Trigger dependency to jrl-mal
-ADD_REQUIRED_DEPENDENCY("jrl-mal >= 1.8.0")
-
 # Add configuration headers for plug-ins.
 GENERATE_CONFIGURATION_HEADER(
   ${HEADER_DIR} config-tracer.hh DG_TRACER tracer_EXPORTS)
@@ -62,6 +60,9 @@ PKG_CONFIG_APPEND_LIBS("dynamic-graph")
 SEARCH_FOR_BOOST()
 SEARCH_FOR_PTHREAD()
 
+# Search for Boost.
+SEARCH_FOR_EIGEN()
+
 ADD_SUBDIRECTORY(src)
 ADD_SUBDIRECTORY(include)
 ADD_SUBDIRECTORY(doc)

include/CMakeLists.txt

@@ -67,6 +67,7 @@ tracer.h
 tracer-real-time.h
 
 command.h
+eigen-io.h
 linear-algebra.h
 value.h
 

include/dynamic-graph/eigen-io.h

@@ -0,0 +1,126 @@
+//
+// Copyright 2010 CNRS
+//
+// Author: Rohan Budhiraja
+//
+// This file is part of dynamic-graph.
+// dynamic-graph is free software: you can redistribute it and/or
+// modify it under the terms of the GNU Lesser General Public License
+// as published by the Free Software Foundation, either version 3 of
+// the License, or (at your option) any later version.
+// dynamic-graph is distributed in the hope that it will be
+// useful, but WITHOUT ANY WARRANTY; without even the implied warranty
+// of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+// GNU Lesser General Public License for more details.  You should
+// have received a copy of the GNU Lesser General Public License along
+// with dynamic-graph.  If not, see <http://www.gnu.org/licenses/>.
+
+#ifndef DYNAMIC_GRAPH_EIGEN_IO_H
+#define DYNAMIC_GRAPH_EIGEN_IO_H
+
+#include <iostream>
+#include <boost/format.hpp>
+#include <boost/numeric/conversion/cast.hpp>
+
+#include <dynamic-graph/exception-signal.h>
+#include <dynamic-graph/linear-algebra.h>
+#include <Eigen/Geometry>
+
+using dynamicgraph::ExceptionSignal;
+
+//TODO: Eigen 3.3 onwards has a global Eigen::Index definition.
+//If Eigen version is updated, use Eigen::Index instead of this macro.
+
+
+  /* \brief Eigen Vector input from istream
+   *
+   * Input Vector format: val1 val2 val3 ... valN
+   * e.g. 1 23 32.2 12.12 32
+   */
+namespace Eigen {
+  typedef EIGEN_DEFAULT_DENSE_INDEX_TYPE eigen_index;
+  inline std::istringstream& operator >> (std::istringstream &iss, 
+					  dynamicgraph::Vector &inst)
+    {
+      std::vector<double> _stdvec;
+      double _dbl_val;
+      
+      boost::format fmt ("Failed to enter %s as vector. Reenter as [val1 val2 ... valN]");
+      fmt %iss.str();
+      
+      while(iss >> _dbl_val && !iss.fail()) {
+	_stdvec.push_back(_dbl_val);
+      }
+      try {
+	inst = Eigen::VectorXd::Map (_stdvec.data(),
+				     boost::numeric_cast<eigen_index> (_stdvec.size()) );
+      }
+      catch (boost::bad_numeric_cast&) {
+	throw ExceptionSignal(ExceptionSignal::GENERIC, fmt.str() );
+      }
+      
+      return iss;
+    }
+
+  /* \brief Eigen Matrix input from istream
+   *
+   * Matrix format: [[val11 val12 val13 ... val1N] ... [valM1 valM2 ... valMN]]
+   * e.g. [[1 23 32.2 12.12 32][2 32 23 92.01 19.2]]
+   */
+
+  template<typename Derived>
+  inline std::istringstream& operator >> (std::istringstream &iss, 
+					  DenseBase<Derived> &inst)
+    {
+      std::vector<dynamicgraph::Vector> _stdmat;
+      char _ch;
+      int _vec_size;
+      bool _vec_size_set = false;
+
+      boost::format fmt 
+	("Failed to enter %s as matrix. Reenter as [[val11 val12 ... val1N]...[valM1 valM2 ... valMN]]. Check that vector sizes are consistent.");
+      fmt %iss.str();
+      
+      if(iss>> _ch && _ch != '['){
+	throw ExceptionSignal(ExceptionSignal::GENERIC, fmt.str());
+      }
+      else{
+	dynamicgraph::Vector _eigvec;
+	while(iss >> _eigvec && !iss.fail()){
+	  if (!_vec_size_set) {
+	    try {
+	      _vec_size = boost::numeric_cast <int> (_eigvec.size());
+	    }
+	    catch (boost::bad_numeric_cast&) {
+	      throw ExceptionSignal(ExceptionSignal::GENERIC, fmt.str());
+	  }
+	    _vec_size_set = true;
+	  }
+	  else {
+	    if (_eigvec.size() != _vec_size) {
+	      throw ExceptionSignal(ExceptionSignal::GENERIC, fmt.str());
+	    }
+	  }
+	  _stdmat.push_back(_eigvec);
+	}
+	if(iss>> _ch && _ch != ']'){
+	  throw ExceptionSignal(ExceptionSignal::GENERIC, fmt.str());
+	}
+	else {
+	  try {
+	    inst.resize(boost::numeric_cast<eigen_index> (_stdmat.size()), _vec_size);
+	  }
+	  catch (boost::bad_numeric_cast&) {
+	    throw ExceptionSignal(ExceptionSignal::GENERIC, fmt.str());
+	  }
+	  for (unsigned int i =0;i<_stdmat.size(); i++) {
+	    inst.row(i) = _stdmat[i];
+	  }
+	}
+      }
+      return iss;
+    }
+}
+
+
+#endif //DYNAMIC_GRAPH_EIGEN_IO_H

include/dynamic-graph/linear-algebra.h

@@ -17,15 +17,12 @@
 
 #ifndef DYNAMIC_GRAPH_LINEAR_ALGEBRA_H
 #define DYNAMIC_GRAPH_LINEAR_ALGEBRA_H
-
-#include <jrl/mal/boost.hh>
-#include <boost/numeric/ublas/matrix.hpp>
+#include <Eigen/Core>
 
 namespace dynamicgraph {
-  typedef maal::boost::Vector Vector;
-  typedef maal::boost::Matrix Matrix;
+  typedef Eigen::MatrixXd Matrix;
+  typedef Eigen::VectorXd Vector;
 }
 
-#endif //DYNAMIC_GRAPH_LINEAR_ALGEBRA_H
-
 
+#endif //DYNAMIC_GRAPH_LINEAR_ALGEBRA_H

include/dynamic-graph/signal-cast-helper.h

@@ -28,6 +28,8 @@
 # include <boost/lexical_cast.hpp>
 # include <boost/tuple/tuple.hpp>
 
+#include <dynamic-graph/eigen-io.h>
+
 # include <dynamic-graph/dynamic-graph-api.h>
 # include "dynamic-graph/exception-signal.h"
 # include "dynamic-graph/signal-caster.h"
@@ -99,8 +101,8 @@ namespace dynamicgraph
     class SignalCast
     {
     public:
-      static T cast( std::istringstream& stringValue ) { throw 1;}
-      static void disp( const T& t,std::ostream& os )  { throw 1;  }
+      static T cast( std::istringstream& ) { throw 1;}
+      static void disp( const T&,std::ostream&)  { throw 1;  }
       static void trace( const T& t,std::ostream& os ) { disp(t,os); }
     public:
       // adapter functions for SignalCast

include/dynamic-graph/value.h

@@ -23,13 +23,15 @@
 #include <cassert>
 #include <typeinfo>
 #include "dynamic-graph/dynamic-graph-api.h"
-#include "dynamic-graph/linear-algebra.h"
+#include <dynamic-graph/linear-algebra.h>
 
 namespace dynamicgraph {
   namespace command {
     class Value;
     class DYNAMIC_GRAPH_DLLAPI EitherType {
     public:
+      EIGEN_MAKE_ALIGNED_OPERATOR_NEW
+
       EitherType(const Value& value);
       ~EitherType();
       operator bool () const;
@@ -46,6 +48,9 @@ namespace dynamicgraph {
 
     class DYNAMIC_GRAPH_DLLAPI Value {
     public:
+
+      EIGEN_MAKE_ALIGNED_OPERATOR_NEW
+
       enum Type {
 	NONE,
 	BOOL,

src/CMakeLists.txt

@@ -50,17 +50,16 @@ ADD_LIBRARY(${LIBRARY_NAME}
 
 SET_TARGET_PROPERTIES(${LIBRARY_NAME} PROPERTIES SOVERSION ${PROJECT_VERSION})
 
-PKG_CONFIG_USE_DEPENDENCY(${LIBRARY_NAME} jrl-mal)
 
 IF (UNIX)
   TARGET_LINK_LIBRARIES(${LIBRARY_NAME} ${CMAKE_DL_LIBS} pthread)
 ENDIF (UNIX)
 
 TARGET_LINK_LIBRARIES(${LIBRARY_NAME} ${Boost_LIBRARIES})
 
-IF (UNIX AND NOT APPLE)
-  TARGET_LINK_LIBRARIES(${LIBRARY_NAME} ${JRL_MAL_LDFLAGS_OTHER})
-ENDIF (UNIX AND NOT APPLE)
+#IF (UNIX AND NOT APPLE)
+#  TARGET_LINK_LIBRARIES(${LIBRARY_NAME} ${JRL_MAL_LDFLAGS_OTHER})
+#ENDIF (UNIX AND NOT APPLE)
 
 INSTALL(TARGETS ${LIBRARY_NAME}
   DESTINATION ${CMAKE_INSTALL_LIBDIR})

src/command/value.cpp

@@ -15,7 +15,6 @@
 // have received a copy of the GNU Lesser General Public License along
 // with dynamic-graph.  If not, see <http://www.gnu.org/licenses/>.
 
-#include <boost/numeric/ublas/io.hpp>
 #include "dynamic-graph/value.h"
 #include "dynamic-graph/exception-abstract.h"