Complete design of Matrixd and Vector<T>
Add auxiliary static functions for Matrix