internal void ProcessFinishedPath(AStarMachine.AStarMachine path, EPathType pathType, bool canAddRevs = false)//todo
{
if (path.Agent != null)
{
AgentBase agent = path.Agent as AgentBase;
if (agent != null && agent.searchFinished != null)
{
agent.searchFinished(path, pathType, canAddRevs);
}
if (!path.IsWorking)
{
((AStarAgent)agent)._asm = null;
}
}
if (!path.IsWorking && !path._inQueue)
{
ClearFinishedPath(path);
}
}
/// <summary>
/// when the agent will reach quick path target ,and is still finding the full path,
/// then request a priority path to finish the full path finding
/// </summary>
/// <param name="agent"></param>
internal void DoPriorityPath(AgentBase agent)
{
//if(_revsCompleted>AStarMachine.AStarMachine.MAX_REVS)
//{
// return;
//}
//
// UnityEngine.Debug.Log(agent.gameObject.name+ " DoPriorityPath");
AStarMachine.AStarMachine thePath = ((AStarAgent)agent)._asm;
if (thePath != null && thePath.IsWorking)
{
// not to pause
thePath.SetPauseCount(-1);
//
thePath.AddToMaxRevolutions(AStarMachine.AStarMachine.MAX_REVS);//
//
thePath.RunAStar();
//_revsCompleted += thePath.RevsCurrentRun;
#if UNITY_EDITOR && PATHMANAGER_DEBUG && !MULTI_THREAD
if (PathFindingManager.DEBUG)
{
if (thePath.IsWorking)
{
UnityEngine.Debug.LogError("DoPriorityPath failed:" + ((PathFindingAgentBehaviour)(agent._behaviour)).name);
}
else
{
UnityEngine.Debug.Log("DoPriorityPath succeed:" + ((PathFindingAgentBehaviour)(agent._behaviour)).name + " revs:" + thePath._totalRevs);
}
}
#endif
thePath.IsWorking = false;
ProcessFinishedPath((AStarMachine.AStarMachine)thePath, EPathType.fullPath, false);
// ClearFinishedPath(thePath);
}
}
/// <summary>
/// three step:first step,find fast path,maybe not a valid path navigating to target position
/// </summary>
/// <param name="agent"></param>
/// <param name="start"></param>
/// <param name="target"></param>
/// <param name="mapId"></param>
/// <param name="isTried">is tried to find quick path and finished </param>
/// <returns></returns>
public EPathReturnStatus FindQuickPath(AgentBase agent, int revs, TSVector start, TSVector target, GridMap map, bool isTried)//, List<TSVector> vecPath
{
//GridMap map = GridMapManager.instance.GetMap(mapId);
if (map.GetGridNodeId(start) == map.GetGridNodeId(target))
{
return(EPathReturnStatus.ok);
}
AStarAgent aAgent = ((AStarAgent)agent);
AStarMachine.AStarMachine asm = isTried?null: aAgent._asm;
bool bInqueue = asm != null && asm.IsWorking;
if (asm == null)
{
asm = _pathPool.New();
GridAStarGoal goal = _goalPool.New();
goal.Ini(agent);
GridAStarStorage storage = _storagePool.New();
storage.Ini();
asm.Ini(agent, goal, storage, map);
}
int curIdx = map.GetGridNodeId(aAgent._behaviour.position);
StartFindingPath(asm, start, target, true, curIdx);
if (asm.IsWorking)
{
int startIdx = map.GetGridNodeId(start);
int tIdx = map.GetGridNodeId(target);
IInt2 pos = map.GetGridPos(tIdx);
bool isReachable = map.IsExistingNeighbourWalkable(pos.x, pos.y, startIdx, tIdx, curIdx);
if (!isTried && isReachable)
{
ProcessFinishedPath(asm, EPathType.quickPath, false);//quick path is valid
}
if (!isReachable)
{
aAgent._behaviour.AddUnReachablePos(map, tIdx);
}
if (!isTried && isReachable)//target possible reachable
{
int sIdx = map.GetGridNodeId(aAgent._vecRunningPath[0]);
asm.StartSearch(sIdx, tIdx, false, start, _pathId++, startIdx);//
//if (!bInqueue)
//{
// _pathQueue.Enqueue(asm);//find full path
//}
aAgent._asm = asm;
}
else//can't reach target
{
asm.IsWorking = false;
// asm.Reset();
ClearFinishedPath(asm);
if (!isTried)
{
return(EPathReturnStatus.fail);
#if UNITY_EDITOR && !MULTI_THREAD
if (PathFindingManager.DEBUG)
{
UnityEngine.Debug.LogWarning("can't reach target:" + pos.x + "," + pos.y);
}
#endif
}
else
{
return(EPathReturnStatus.fail);
}
}
// asm._start=
}
else
{
if (isTried)//remove working asm
{
if (aAgent._asm != null)
{
aAgent._asm.IsWorking = false;
ClearFinishedPath(aAgent._asm);
}
aAgent._asm = asm;
}
ProcessFinishedPath(asm, EPathType.quickPath);//quick path is valid
}
if (aAgent._vecRunningPath.Count > 0)
{
return(EPathReturnStatus.ok);
}
return(EPathReturnStatus.fail);//warning
}
public void Ini(AgentBase ai)//, AStarGridMap map
{
_Owner = ai;
// _Goal = goal;
}