C++ roy-warshall algoritm