public void CheckOneVertice() { double[,] graph = { { 0.0 } }; DijkstraAlgorithm.Dijkstra AlgorithmClass = new DijkstraAlgorithm.Dijkstra(graph); AlgorithmClass.CallDijkstraAlgorithm(0, 0); Assert.AreEqual(AlgorithmClass.GetMinimumDistance(0), 0.0); List <int> VerticesPath = new List <int> { 0 }; Assert.AreEqual(AlgorithmClass.GetVerticesPath(), VerticesPath); }
public void TestWikipediaExample() { double[,] graph = { { 0.0, 7.0, 9.0, 0.0, 0.0, 14.0 }, { 7.0, 0.0, 10.0, 15.0, 0.0, 0.0 }, { 9.0, 10.0, 0.0, 11.0, 0.0, 2.0 }, { 0.0, 15.0, 11.0, 0.0, 6.0, 0.0 }, { 0.0, 0.0, 0.0, 6.0, 0.0, 9.0 }, { 14.0, 0.0, 2.0, 0.0, 9.0, 0.0 } }; DijkstraAlgorithm.Dijkstra AlgorithmClass = new DijkstraAlgorithm.Dijkstra(graph); AlgorithmClass.CallDijkstraAlgorithm(0, 5); Assert.AreEqual(AlgorithmClass.GetMinimumDistance(0), 0.0); Assert.AreEqual(AlgorithmClass.GetMinimumDistance(1), 7.0); Assert.AreEqual(AlgorithmClass.GetMinimumDistance(2), 9.0); Assert.AreEqual(AlgorithmClass.GetMinimumDistance(3), 20.0); Assert.AreEqual(AlgorithmClass.GetMinimumDistance(4), 20.0); Assert.AreEqual(AlgorithmClass.GetMinimumDistance(5), 11.0); List <int> VerticesPath = new List <int> { 0, 2, 5 }; Assert.AreEqual(AlgorithmClass.GetVerticesPath(), VerticesPath); }
// Use this for initialization void Start() { // Исходные данные по сетке tgs = TerrainGridSystem.instance; List <Cell> myCells = tgs.cells; int Nx = tgs.rowCount; int Nz = tgs.columnCount; // Задать исходную высоту Cell zeroCell = myCells[0]; Vector3 zeroCoord = tgs.CellGetPosition(0); using (var file = new StreamWriter(@"D:\Vec_grid.txt", true)) { for (int row = 0; row < Nx; row++) { for (int column = 0; column < Nz; column++) { Vector3 centerCoord = tgs.CellGetPosition(myCells[column + Nz * row]); String str = centerCoord.x.ToString() + "\t" + centerCoord.z.ToString() + "\t" + centerCoord.y.ToString(); file.WriteLine(str); } file.WriteLine("\n"); } } // Заполнить весы графа double[,] dijk_grid = new double[Nx * Nz, Nx *Nz]; for (int row = 0; row < Nx; row++) { for (int column = 0; column < Nz; column++) { int currentIndex = column + Nz * row; Vector3 centerCoord = tgs.CellGetPosition(myCells[currentIndex]); if (row != 0) { int leftIndex = column + Nz * (row - 1); Vector3 leftCoord = tgs.CellGetPosition(myCells[leftIndex]); dijk_grid[currentIndex, leftIndex] = Vector3.Distance(centerCoord, leftCoord); } if (row != (Nx - 1)) { int rightIndex = column + Nz * (row + 1); Vector3 rightCoord = tgs.CellGetPosition(myCells[rightIndex]); dijk_grid[currentIndex, rightIndex] = Vector3.Distance(centerCoord, rightCoord); } if (column != (Nz - 1)) { int upIndex = (column + 1) + Nz * row; Vector3 upCoord = tgs.CellGetPosition(myCells[upIndex]); dijk_grid[currentIndex, upIndex] = Vector3.Distance(centerCoord, upCoord); } if (column != 0) { int downIndex = (column - 1) + Nz * row; Vector3 downCoord = tgs.CellGetPosition(myCells[downIndex]); dijk_grid[currentIndex, downIndex] = Vector3.Distance(centerCoord, downCoord); } // ---------------- if ((row != 0) && (column != 0)) { int leftDownIndex = (column - 1) + Nz * (row - 1); Vector3 leftDownCoord = tgs.CellGetPosition(myCells[leftDownIndex]); dijk_grid[currentIndex, leftDownIndex] = Vector3.Distance(centerCoord, leftDownCoord); } if ((row != (Nx - 1)) && (column != 0)) { int rightDownIndex = (column - 1) + Nz * (row + 1); Vector3 rightDownCoord = tgs.CellGetPosition(myCells[rightDownIndex]); dijk_grid[currentIndex, rightDownIndex] = Vector3.Distance(centerCoord, rightDownCoord); } if ((row != 0) && (column != (Nz - 1))) { int leftUpIndex = (column + 1) + Nz * (row - 1); Vector3 leftUpCoord = tgs.CellGetPosition(myCells[leftUpIndex]); dijk_grid[currentIndex, leftUpIndex] = Vector3.Distance(centerCoord, leftUpCoord); } if ((row != (Nx - 1)) && (column != (Nz - 1))) { int rightUpIndex = (column + 1) + Nz * (row + 1); Vector3 rightUpCoord = tgs.CellGetPosition(myCells[rightUpIndex]); dijk_grid[currentIndex, rightUpIndex] = Vector3.Distance(centerCoord, rightUpCoord); } } } DijkstraAlgorithm.Dijkstra AlgorithmClass = new DijkstraAlgorithm.Dijkstra(dijk_grid); AlgorithmClass.CallDijkstraAlgorithm(0, Nx * Nz - 1); double distance = AlgorithmClass.GetMinimumDistance(Nx * Nz - 1); List <int> a = AlgorithmClass.GetVerticesPath(); using (var file = new StreamWriter(@"D:\Dijk_grid.txt", true)) { for (int row = 0; row < Nx * Nz; row++) { for (int column = 0; column < Nx * Nz; column++) { String str = dijk_grid[row, column] + "\t"; file.Write(str); } file.WriteLine("\n"); } } }