Added unit test for matrix rotVec function