Move tests into seperate file.
Add start of experiment to figure out why the floyd-warshall implementation is so slow.