Add the FloydWarshall algorithm implementation