Finished unittest for vector and matrix