Moved FloydWarshall, added basic data structures