FloydWarshall_dev: Bug fix for indexing

Bug recognized by comparing output of FlyodWarshall and Johnson