public void ManhattanGridDistanceTests() { var heuristicCalculator = new ManhattanGridDistance(); var sourcePosition = new[] { 0, 1 }; var destinationPosition = new[] { 10, 1 }; var expectedRes = Math.Abs(sourcePosition[0] - destinationPosition[0]) + Math.Abs(sourcePosition[1] - destinationPosition[1]); Assert.AreEqual(expectedRes, heuristicCalculator.GetHeuristic(sourcePosition, destinationPosition, 1)); }
public GridCostCalculator(Matrix4DGenerator matrixGenerator, ManhattanGridDistance gridDistance) { _gridDistance = gridDistance; _positionMask = matrixGenerator.GetMatrix(1); }