matrix: use correct matrix multiplication functions
tests: add some matrix tests
tests: add delta to float comparision