Add matrix.h and vector.h