Implement pathfinding with Dijkstra algorithm
We need to clean some other files