public static void TraverseLabyrinth(string[,] matrix, Coordinates coordinates)
{
var path = new Queue<Coordinates>();
Coordinates currentCoordinates = new Coordinates(coordinates.X, coordinates.Y, 1);
path.Enqueue(currentCoordinates);
while (path.Count > 0)
{
currentCoordinates = path.Dequeue();
var currentValue = currentCoordinates.Value + 1;
if (IsPossibleMove(matrix, currentCoordinates.X + 1, currentCoordinates.Y))
{
matrix[currentCoordinates.X + 1, currentCoordinates.Y] = currentCoordinates.Value.ToString();
path.Enqueue(new Coordinates(currentCoordinates.X + 1, currentCoordinates.Y, currentValue));
}
if (IsPossibleMove(matrix, currentCoordinates.X, currentCoordinates.Y + 1))
{
matrix[currentCoordinates.X, currentCoordinates.Y + 1] = currentCoordinates.Value.ToString();
path.Enqueue(new Coordinates(currentCoordinates.X, currentCoordinates.Y + 1, currentValue));
}
if (IsPossibleMove(matrix, currentCoordinates.X, currentCoordinates.Y - 1))
{
matrix[currentCoordinates.X, currentCoordinates.Y - 1] = currentCoordinates.Value.ToString();
path.Enqueue(new Coordinates(currentCoordinates.X, currentCoordinates.Y - 1, currentValue));
}
if (IsPossibleMove(matrix, currentCoordinates.X - 1, currentCoordinates.Y))
{
matrix[currentCoordinates.X - 1, currentCoordinates.Y] = currentCoordinates.Value.ToString();
path.Enqueue(new Coordinates(currentCoordinates.X - 1, currentCoordinates.Y, currentValue));
}
}
}
static void Main()
{
var startPosition = new Coordinates(2, 1, 0);
string[,] labyrinth =
{
{ "0", "0", "0", "X", "0", "X" },
{ "0", "X", "0", "X", "0", "X" },
{ "0", "*", "X", "0", "X", "0" },
{ "0", "X", "0", "0", "0", "0" },
{ "0", "0", "0", "X", "X", "0" },
{ "0", "0", "0", "X", "0", "X" }
};
TraverseLabyrinth(labyrinth, startPosition);
labyrinth[startPosition.X, startPosition.Y] = "*";
for (int i = 0; i < labyrinth.GetLength(0); i++)
{
for (int j = 0; j < labyrinth.GetLength(1); j++)
{
if (labyrinth[i, j] == "0")
{
labyrinth[i, j] = "u";
}
Console.Write(labyrinth[i, j].PadLeft(3));
}
Console.WriteLine();
}
}