Add initial test.
Implement Floyd-Warshall and add a second test.