Test of algorithm on simple matrix