Add src for Matrix.h