Отсортировать массив, который ищет самый короткий путь до точки

using System;
using System.Collections.Generic;
using System.IO;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
 
namespace ConsoleApp7
{
    class Program
    {
 
        static void Main(string[] args)
        {
 
            var a = new int[,]{ { 0, 1, 1, 1, 1 ,1 ,1 ,1, 1, 1 }, // 0-положение игрока. 1- пустые ячейки. 6- стена. 3-положение монстра
                                { 6, 1, 6, 6, 6 ,6 ,6 ,6, 6, 1 },
                                { 1, 1, 1, 6, 6 ,1 ,1 ,1, 6, 1 },
                                { 1, 6, 1, 1, 1 ,1 ,6 ,1, 1, 1 },
                                { 1, 6, 6, 6, 6 ,6 ,6 ,1, 6, 1 },
                                { 1, 6, 6, 6, 6 ,6 ,6 ,1, 1, 1 },
                                { 1, 1, 1, 1, 1 ,1 ,1 ,1, 1, 3 },};
 
            var b = FindWave(a, 9, 6, 0, 0);                                  
            Console.ReadLine();
        }
 
 
        public static int[,] FindWave(int[,] Map, int startX, int startY, int targetX, int targetY)
        {
 
            bool add = true;
            int[,] cMap = new int[Map.GetLength(0), Map.GetLength(1)]; // создали новый массив cMap чтоб по нему искать путь
            int step = 0;
            for (var y = 0; y < Map.GetLength(0); y++)
                for (var x = 0; x < Map.GetLength(1); x++)
                {
                    if (Map[y, x] == 6) // если в искомом массиве стена то
                        cMap[y, x] = -2;//ставим стену в новом массиве по этому же элементу                   
                    else
                        cMap[y, x] = -1; //-1 это пустое место
                }
            cMap[startY, startX] = 0;
            while (add == true)
            {
                var MapHeight = cMap.GetLength(0);
                var MapWidht = cMap.GetLength(1);
                for (var y = 0; y < cMap.GetLength(0); y++)
                    for (var x = 0; x < cMap.GetLength(1); x++)
                    {
                        if (cMap[y, x] == step)
                        {
                            //Ставим значение шага+1 в соседние ячейки (если они проходимы)
                            if (y - 1 >= 0)
                            {
                                if (cMap[y - 1, x] != -2 && cMap[y - 1, x] == -1)
                                    cMap[y - 1, x] = step + 1;
                            }
                            if (x - 1 >= 0)
                            {
                                if (cMap[y, x - 1] != -2 && cMap[y, x - 1] == -1)
                                    cMap[y, x - 1] = step + 1;
                            }
                            if (y + 1 < MapHeight)
                            {
                                if (cMap[y + 1, x] != -2 && cMap[y + 1, x] == -1)
                                    cMap[y + 1, x] = step + 1;
                            }
                            if (x + 1 < MapWidht)
                            {
                                if (cMap[y, x + 1] != -2 && cMap[y, x + 1] == -1)
                                    cMap[y, x + 1] = step + 1;
                            }
                        }
 
                    }
                step++;
                add = true;
                if (cMap[targetY, targetX] == step)
                {
                    add = false;
                    Console.WriteLine("Решение найдено");
 
                }
                if (step > cMap.GetLength(0) * cMap.GetLength(1))
                {
                    add = false;
                    Console.WriteLine("Решение не найдено");
                }
            }
 
            return cMap;
        }
}