Work on matmult algorithm, add test data