Added FloydWarshall algorithm and a unit test.
Also cleaned up some crap left by Jannick/Nicolai.