public pathNode(int x, int y, List<int> xHist, List<int> yHist, PathfindConstants.Directions fromDir = PathfindConstants.Directions.None)
{
FromDir = fromDir;
GridPosX = x;
GridPosY = y;
GridPathX = new List<int>(xHist);
GridPathY = new List<int>(yHist);
GridPathX.Add(x);
GridPathY.Add(y);
}
private static List<Vector2> FindPath(Vector2 origin, Vector2 target, PathfindConstants.Directions fromDir = PathfindConstants.Directions.None)
{
List<pathNode> nodes = new List<pathNode>();
List<Vector2> checkedPositions = new List<Vector2>();
nodes.Add(new pathNode((int)Math.Round(origin.X), (int)Math.Round(origin.Y), new List<int>(), new List<int>(), fromDir));
bool foundPath = false;
List<Vector2> resultPath = null;
int tries = 0;
while (!foundPath && tries < MaxTries)
{
//Debug.Log("Tries: " + tries + "Nodes: " + nodes.Count);
tries++;
List<pathNode> newNodes = new List<pathNode>();
foreach (pathNode node in nodes)
{
if (!checkedPositions.Contains(new Vector2(node.GridPosX, node.GridPosY)))
{
checkedPositions.Add(new Vector2(node.GridPosX, node.GridPosY));
if (Vector2.Distance(new Vector2(node.GridPosX, node.GridPosY), target) < 1)
{
Vector2[] path = new Vector2[node.GridPathX.Count];
for (int i = 0; i < path.Length; i++)
{
path[i].X = node.GridPathX[i];
path[i].Y = node.GridPathY[i];
}
resultPath = new List<Vector2>();
resultPath.AddRange(path);
foundPath = true;
break;
}
RoomData room = CellSpawner.GetRoomAtGridPosition(node.GridPosX, node.GridPosY);
if (room != null)
{
bool didWeightedMove = false;
if (useWeighted)
{
Vector2 delta = target - new Vector2(node.GridPosX, node.GridPosY);
if (AllowDiagonalMovement && delta.X != 0 && delta.Y != 0)
{
if (delta.X > 0)
{
if (delta.Y < 0)
{
if (room.NEPossible && node.FromDir != PathfindConstants.Directions.NorthEast)
{
newNodes.Add(new pathNode(node.GridPosX + 1, node.GridPosY + 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.SouthWest));
didWeightedMove = true;
}
}
else
{
if (room.SEPossible && node.FromDir != PathfindConstants.Directions.SouthEast)
{
newNodes.Add(new pathNode(node.GridPosX + 1, node.GridPosY - 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.NorthWest));
didWeightedMove = true;
}
}
}
else
{
if (delta.Y < 0)
{
if (room.NWPossible && node.FromDir != PathfindConstants.Directions.NorthWest)
{
newNodes.Add(new pathNode(node.GridPosX - 1, node.GridPosY + 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.SouthEast));
didWeightedMove = true;
}
}
else
{
if (room.SWPossible && node.FromDir != PathfindConstants.Directions.SouthWest)
{
newNodes.Add(new pathNode(node.GridPosX - 1, node.GridPosY - 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.NorthEast));
didWeightedMove = true;
}
}
}
}
else
{
if (delta.Y < 0 && room.NPossible && node.FromDir != PathfindConstants.Directions.North)
{
newNodes.Add(new pathNode(node.GridPosX, node.GridPosY + 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.South));
didWeightedMove = true;
}
else if (delta.X > 0 && room.EPossible && node.FromDir != PathfindConstants.Directions.East)//E
{
newNodes.Add(new pathNode(node.GridPosX + 1, node.GridPosY, node.GridPathX, node.GridPathY, PathfindConstants.Directions.West));
didWeightedMove = true;
}
else if (delta.Y > 0 && room.SPossible && node.FromDir != PathfindConstants.Directions.South)//S
{
newNodes.Add(new pathNode(node.GridPosX, node.GridPosY - 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.North));
didWeightedMove = true;
}
else if (delta.X < 0 && room.WPossible && node.FromDir != PathfindConstants.Directions.West)//W
{
newNodes.Add(new pathNode(node.GridPosX - 1, node.GridPosY, node.GridPathX, node.GridPathY, PathfindConstants.Directions.East));
didWeightedMove = true;
}
}
}
if (!didWeightedMove)
{
if (room.NPossible && node.FromDir != PathfindConstants.Directions.North)//N
{
newNodes.Add(new pathNode(node.GridPosX, node.GridPosY + 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.South));
}
if (room.EPossible && node.FromDir != PathfindConstants.Directions.East)//E
{
newNodes.Add(new pathNode(node.GridPosX + 1, node.GridPosY, node.GridPathX, node.GridPathY, PathfindConstants.Directions.West));
}
if (room.SPossible && node.FromDir != PathfindConstants.Directions.South)//S
{
newNodes.Add(new pathNode(node.GridPosX, node.GridPosY - 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.North));
}
if (room.WPossible && node.FromDir != PathfindConstants.Directions.West)//W
{
newNodes.Add(new pathNode(node.GridPosX - 1, node.GridPosY, node.GridPathX, node.GridPathY, PathfindConstants.Directions.East));
}
if (AllowDiagonalMovement)
{
if (room.NEPossible && node.FromDir != PathfindConstants.Directions.NorthEast)
{
newNodes.Add(new pathNode(node.GridPosX + 1, node.GridPosY + 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.SouthWest));
}
if (room.NWPossible && node.FromDir != PathfindConstants.Directions.NorthWest)
{
newNodes.Add(new pathNode(node.GridPosX - 1, node.GridPosY + 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.SouthEast));
}
if (room.SEPossible && node.FromDir != PathfindConstants.Directions.SouthEast)
{
newNodes.Add(new pathNode(node.GridPosX + 1, node.GridPosY - 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.NorthWest));
}
if (room.SWPossible && node.FromDir != PathfindConstants.Directions.SouthWest)
{
newNodes.Add(new pathNode(node.GridPosX - 1, node.GridPosY - 1, node.GridPathX, node.GridPathY, PathfindConstants.Directions.NorthEast));
}
}
}
}
}
}
nodes = new List<pathNode>(newNodes);
//if(tries == MaxTries)
// Debug.LogError("Pathfind unsuccessful, " + tries);
}
return resultPath;
}
