void UCrowdManager::UpdateAgentPaths()
{
UNavigationSystem* NavSys = Cast<UNavigationSystem>(GetOuter());
ARecastNavMesh* RecastNavData = Cast<ARecastNavMesh>(MyNavData);
FPImplRecastNavMesh* PImplNavMesh = RecastNavData ? RecastNavData->RecastNavMeshImpl : NULL;
if (PImplNavMesh == NULL)
{
return;
}
const dtCrowdAgentAnimation* AgentAnims = DetourCrowd->getAgentAnims();
for (auto It = ActiveAgents.CreateIterator(); It; ++It)
{
FCrowdAgentData& AgentData = It.Value();
if (AgentData.bIsSimulated && AgentData.IsValid())
{
UCrowdFollowingComponent* CrowdComponent = nullptr;
const dtCrowdAgent* Agent = DetourCrowd->getAgent(AgentData.AgentIndex);
dtPolyRef AgentPolyRef = Agent->corridor.getFirstPoly();
// look for newly triggered smart links
const dtCrowdAgentAnimation& AnimInfo = AgentAnims[AgentData.AgentIndex];
if (AnimInfo.active)
{
AgentPolyRef = AnimInfo.polyRef;
if (AnimInfo.t == 0)
{
const uint32 NavLinkId = PImplNavMesh->GetLinkUserId(AnimInfo.polyRef);
INavLinkCustomInterface* CustomLink = NavSys->GetCustomLink(NavLinkId);
if (CustomLink)
{
FVector EndPt = Recast2UnrealPoint(AnimInfo.endPos);
// switch to waiting state
DetourCrowd->setAgentWaiting(AgentData.AgentIndex);
DetourCrowd->resetAgentVelocity(AgentData.AgentIndex);
// start using smart link
CrowdComponent = (CrowdComponent ? CrowdComponent : (UCrowdFollowingComponent*)Cast<const UCrowdFollowingComponent>(It.Key()));
if (CrowdComponent)
{
CrowdComponent->StartUsingCustomLink(CustomLink, EndPt);
}
}
}
}
// look for poly updates
if (AgentPolyRef != AgentData.PrevPoly)
{
CrowdComponent = (CrowdComponent ? CrowdComponent : (UCrowdFollowingComponent*)Cast<const UCrowdFollowingComponent>(It.Key()));
if (CrowdComponent)
{
CrowdComponent->OnNavNodeChanged(AgentPolyRef, AgentData.PrevPoly, Agent->corridor.getPathCount());
AgentData.PrevPoly = AgentPolyRef;
}
}
}
}
}
