Fully templated - Explicit instantiations are made for Matrix and Vector (defined using double) - Consider defining a MatrixF, VectorF, ArrayF and ArrayD to support single-precision#164