Moved to EIGEN library from GMTL