Added unit test for matrix add and sub functions