Added test code for FloydWarshall