public void StartPathfinding()
 {
     Debug.Log("LETS GO!!");
     Pathfinding.StartPathfinding(StartAndEnd.GetStartNode(), StartAndEnd.GetEndNode(), DoDiagonal);
     IsPathfinding       = true;
     FinishedPathfinding = false;
 }