You've already forked UnrealEngineUWP
mirror of
https://github.com/izzy2lost/UnrealEngineUWP.git
synced 2026-03-26 18:15:20 -07:00
7ee1676796
When using bRestrictBuildingToActiveTiles, GetDebugGeometry() would gather the data for all the active tiles for each tile in the TileSet instead of only once, leading to unsuable framerate. #rb Mieszko.Zielinski #jira none #preflight 627434d8fd59d6606e05341a [CL 20064369 by Aris Theophanidis in ue5-main branch]
1566 lines
56 KiB
C++
1566 lines
56 KiB
C++
// Copyright Epic Games, Inc. All Rights Reserved.
|
|
|
|
/*=============================================================================
|
|
NavMeshRenderingComponent.cpp: A component that renders a navmesh.
|
|
=============================================================================*/
|
|
|
|
#include "NavMesh/NavMeshRenderingComponent.h"
|
|
#include "NavigationSystem.h"
|
|
#include "Engine/Canvas.h"
|
|
#include "Engine/Engine.h"
|
|
#include "NavigationOctree.h"
|
|
#include "NavMesh/RecastHelpers.h"
|
|
#include "NavMesh/RecastNavMesh.h"
|
|
#include "NavMesh/RecastNavMeshGenerator.h"
|
|
#include "Debug/DebugDrawService.h"
|
|
#include "SceneManagement.h"
|
|
#include "TimerManager.h"
|
|
|
|
#if RECAST_INTERNAL_DEBUG_DATA
|
|
#include "NavMesh/RecastInternalDebugData.h"
|
|
#endif
|
|
|
|
#if WITH_EDITOR
|
|
#include "Editor.h"
|
|
#include "EditorViewportClient.h"
|
|
#endif
|
|
|
|
static constexpr FColor NavMeshRenderColor_Recast_TriangleEdges(255, 255, 255);
|
|
static constexpr FColor NavMeshRenderColor_Recast_TileEdges(16, 16, 16, 32);
|
|
static constexpr FColor NavMeshRenderColor_RecastMesh(140, 255, 0, 164);
|
|
static constexpr FColor NavMeshRenderColor_TileBounds(255, 255, 64, 255);
|
|
static constexpr FColor NavMeshRenderColor_PathCollidingGeom(255, 255, 255, 40);
|
|
static constexpr FColor NavMeshRenderColor_RecastTileBeingRebuilt(255, 0, 0, 64);
|
|
static constexpr FColor NavMeshRenderColor_OffMeshConnectionInvalid(64, 64, 64);
|
|
static const FColor NavMeshRenderColor_PolyForbidden(FColorList::Black);
|
|
|
|
static constexpr float DefaultEdges_LineThickness = 0.0f;
|
|
static constexpr float PolyEdges_LineThickness = 1.5f;
|
|
static constexpr float NavMeshEdges_LineThickness = 3.5f;
|
|
static constexpr float LinkLines_LineThickness = 2.0f;
|
|
static constexpr float ClusterLinkLines_LineThickness = 2.0f;
|
|
|
|
namespace FNavMeshRenderingHelpers
|
|
{
|
|
void DrawDebugBox(FPrimitiveDrawInterface* PDI, FVector const& Center, FVector const& Box, FColor const& Color)
|
|
{
|
|
// no debug line drawing on dedicated server
|
|
if (PDI != nullptr)
|
|
{
|
|
PDI->DrawLine(Center + FVector(Box.X, Box.Y, Box.Z), Center + FVector(Box.X, -Box.Y, Box.Z), Color, SDPG_World);
|
|
PDI->DrawLine(Center + FVector(Box.X, -Box.Y, Box.Z), Center + FVector(-Box.X, -Box.Y, Box.Z), Color, SDPG_World);
|
|
PDI->DrawLine(Center + FVector(-Box.X, -Box.Y, Box.Z), Center + FVector(-Box.X, Box.Y, Box.Z), Color, SDPG_World);
|
|
PDI->DrawLine(Center + FVector(-Box.X, Box.Y, Box.Z), Center + FVector(Box.X, Box.Y, Box.Z), Color, SDPG_World);
|
|
|
|
PDI->DrawLine(Center + FVector(Box.X, Box.Y, -Box.Z), Center + FVector(Box.X, -Box.Y, -Box.Z), Color, SDPG_World);
|
|
PDI->DrawLine(Center + FVector(Box.X, -Box.Y, -Box.Z), Center + FVector(-Box.X, -Box.Y, -Box.Z), Color, SDPG_World);
|
|
PDI->DrawLine(Center + FVector(-Box.X, -Box.Y, -Box.Z), Center + FVector(-Box.X, Box.Y, -Box.Z), Color, SDPG_World);
|
|
PDI->DrawLine(Center + FVector(-Box.X, Box.Y, -Box.Z), Center + FVector(Box.X, Box.Y, -Box.Z), Color, SDPG_World);
|
|
|
|
PDI->DrawLine(Center + FVector(Box.X, Box.Y, Box.Z), Center + FVector(Box.X, Box.Y, -Box.Z), Color, SDPG_World);
|
|
PDI->DrawLine(Center + FVector(Box.X, -Box.Y, Box.Z), Center + FVector(Box.X, -Box.Y, -Box.Z), Color, SDPG_World);
|
|
PDI->DrawLine(Center + FVector(-Box.X, -Box.Y, Box.Z), Center + FVector(-Box.X, -Box.Y, -Box.Z), Color, SDPG_World);
|
|
PDI->DrawLine(Center + FVector(-Box.X, Box.Y, Box.Z), Center + FVector(-Box.X, Box.Y, -Box.Z), Color, SDPG_World);
|
|
}
|
|
}
|
|
|
|
bool LineInView(const FVector& Start, const FVector& End, const FSceneView* View)
|
|
{
|
|
if (FVector::DistSquaredXY(Start, View->ViewMatrices.GetViewOrigin()) > ARecastNavMesh::GetDrawDistanceSq() ||
|
|
FVector::DistSquaredXY(End, View->ViewMatrices.GetViewOrigin()) > ARecastNavMesh::GetDrawDistanceSq())
|
|
{
|
|
return false;
|
|
}
|
|
|
|
for (int32 PlaneIdx = 0; PlaneIdx < View->ViewFrustum.Planes.Num(); ++PlaneIdx)
|
|
{
|
|
const FPlane& CurPlane = View->ViewFrustum.Planes[PlaneIdx];
|
|
if (CurPlane.PlaneDot(Start) > 0.f && CurPlane.PlaneDot(End) > 0.f)
|
|
{
|
|
return false;
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool PointInView(const FVector& Position, const FSceneView* View)
|
|
{
|
|
if (FVector::DistSquaredXY(Position, View->ViewMatrices.GetViewOrigin()) > ARecastNavMesh::GetDrawDistanceSq())
|
|
{
|
|
return false;
|
|
}
|
|
|
|
for (int32 PlaneIdx = 0; PlaneIdx < View->ViewFrustum.Planes.Num(); ++PlaneIdx)
|
|
{
|
|
const FPlane& CurPlane = View->ViewFrustum.Planes[PlaneIdx];
|
|
if (CurPlane.PlaneDot(Position) > 0.f)
|
|
{
|
|
return false;
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool LineInCorrectDistance(const FVector& Start, const FVector& End, const FSceneView* View, float CorrectDistance = -1)
|
|
{
|
|
const float MaxDistanceSq = (CorrectDistance > 0) ? FMath::Square(CorrectDistance) : ARecastNavMesh::GetDrawDistanceSq();
|
|
return FVector::DistSquaredXY(Start, View->ViewMatrices.GetViewOrigin()) < MaxDistanceSq &&
|
|
FVector::DistSquaredXY(End, View->ViewMatrices.GetViewOrigin()) < MaxDistanceSq;
|
|
}
|
|
|
|
FVector EvalArc(const FVector& Org, const FVector& Dir, const float h, const float u)
|
|
{
|
|
FVector Pt = Org + Dir * u;
|
|
Pt.Z += h * (1 - (u * 2 - 1)*(u * 2 - 1));
|
|
|
|
return Pt;
|
|
}
|
|
|
|
void CacheArc(TArray<FDebugRenderSceneProxy::FDebugLine>& DebugLines, const FVector& Start, const FVector& End, const float Height, const uint32 Segments, const FLinearColor& Color, float LineThickness = 0)
|
|
{
|
|
if (Segments == 0)
|
|
{
|
|
return;
|
|
}
|
|
|
|
const float ArcPtsScale = 1.0f / (float)Segments;
|
|
const FVector Dir = End - Start;
|
|
const float Length = Dir.Size();
|
|
|
|
FVector Prev = Start;
|
|
for (uint32 i = 1; i <= Segments; ++i)
|
|
{
|
|
const float u = i * ArcPtsScale;
|
|
const FVector Pt = EvalArc(Start, Dir, Length*Height, u);
|
|
|
|
DebugLines.Add(FDebugRenderSceneProxy::FDebugLine(Prev, Pt, Color.ToFColor(true)));
|
|
Prev = Pt;
|
|
}
|
|
}
|
|
|
|
void CacheArrowHead(TArray<FDebugRenderSceneProxy::FDebugLine>& DebugLines, const FVector& Tip, const FVector& Origin, const float Size, const FLinearColor& Color, float LineThickness = 0)
|
|
{
|
|
const FVector Az(0.f, 1.f, 0.f);
|
|
const FVector Ay = (Origin - Tip).GetSafeNormal();
|
|
const FVector Ax = FVector::CrossProduct(Az, Ay);
|
|
|
|
DebugLines.Add(FDebugRenderSceneProxy::FDebugLine(Tip, FVector(Tip.X + Ay.X*Size + Ax.X*Size / 3, Tip.Y + Ay.Y*Size + Ax.Y*Size / 3, Tip.Z + Ay.Z*Size + Ax.Z*Size / 3), Color.ToFColor(true)));
|
|
DebugLines.Add(FDebugRenderSceneProxy::FDebugLine(Tip, FVector(Tip.X + Ay.X*Size - Ax.X*Size / 3, Tip.Y + Ay.Y*Size - Ax.Y*Size / 3, Tip.Z + Ay.Z*Size - Ax.Z*Size / 3), Color.ToFColor(true)));
|
|
}
|
|
|
|
void CacheLink(TArray<FDebugRenderSceneProxy::FDebugLine>& DebugLines, const FVector V0, const FVector V1, const FColor LinkColor, const uint8 LinkDirection)
|
|
{
|
|
FNavMeshRenderingHelpers::CacheArc(DebugLines, V0, V1, 0.4f, 4, LinkColor, LinkLines_LineThickness);
|
|
|
|
const FVector VOffset(0, 0, FVector::Dist(V0, V1) * 1.333f);
|
|
FNavMeshRenderingHelpers::CacheArrowHead(DebugLines, V1, V0 + VOffset, 30.f, LinkColor, LinkLines_LineThickness);
|
|
if (LinkDirection)
|
|
{
|
|
FNavMeshRenderingHelpers::CacheArrowHead(DebugLines, V0, V1 + VOffset, 30.f, LinkColor, LinkLines_LineThickness);
|
|
}
|
|
}
|
|
|
|
void DrawWireCylinder(TArray<FDebugRenderSceneProxy::FDebugLine>& DebugLines, const FVector& Base, const FVector& X, const FVector& Y, const FVector& Z, FColor Color, float Radius, float HalfHeight, int32 NumSides, uint8 DepthPriority, float LineThickness = 0)
|
|
{
|
|
const float AngleDelta = 2.0f * PI / NumSides;
|
|
FVector LastVertex = Base + X * Radius;
|
|
|
|
for (int32 SideIndex = 0; SideIndex < NumSides; SideIndex++)
|
|
{
|
|
const FVector Vertex = Base + (X * FMath::Cos(AngleDelta * (SideIndex + 1)) + Y * FMath::Sin(AngleDelta * (SideIndex + 1))) * Radius;
|
|
|
|
DebugLines.Add(FDebugRenderSceneProxy::FDebugLine(LastVertex - Z * HalfHeight, Vertex - Z * HalfHeight, Color));
|
|
DebugLines.Add(FDebugRenderSceneProxy::FDebugLine(LastVertex + Z * HalfHeight, Vertex + Z * HalfHeight, Color));
|
|
DebugLines.Add(FDebugRenderSceneProxy::FDebugLine(LastVertex - Z * HalfHeight, LastVertex + Z * HalfHeight, Color));
|
|
|
|
LastVertex = Vertex;
|
|
}
|
|
}
|
|
|
|
inline uint8 GetBit(int32 v, uint8 bit)
|
|
{
|
|
return (v & (1 << bit)) >> bit;
|
|
}
|
|
|
|
FColor GetClusterColor(int32 Idx)
|
|
{
|
|
const uint8 r = 1 + GetBit(Idx, 1) + GetBit(Idx, 3) * 2;
|
|
const uint8 g = 1 + GetBit(Idx, 2) + GetBit(Idx, 4) * 2;
|
|
const uint8 b = 1 + GetBit(Idx, 0) + GetBit(Idx, 5) * 2;
|
|
return FColor(r * 63, g * 63, b * 63, 164);
|
|
}
|
|
|
|
FColor DarkenColor(const FColor& Base)
|
|
{
|
|
const uint32 Col = Base.DWColor();
|
|
return FColor(((Col >> 1) & 0x007f7f7f) | (Col & 0xff000000));
|
|
}
|
|
|
|
FColor SemiDarkenColor(const FColor& Base)
|
|
{
|
|
const uint32 Col = Base.DWColor();
|
|
// 1/2 can be too dark(DarkenColor) - use 3/4 here.
|
|
const uint32 QuarterCol = ((Col >> 2) & 0x003f3f3f);
|
|
const uint32 HalfCol = ((Col >> 1) & 0x007f7f7f);
|
|
const uint32 ThreeQuarterCol = QuarterCol + HalfCol;
|
|
return FColor(ThreeQuarterCol | (Col & 0xff000000));
|
|
}
|
|
|
|
void AddVertex(FNavMeshSceneProxyData::FDebugMeshData& MeshData, const FVector& Pos, const FColor Color)
|
|
{
|
|
FDynamicMeshVertex* Vertex = new(MeshData.Vertices) FDynamicMeshVertex;
|
|
Vertex->Position = (FVector3f)Pos;
|
|
Vertex->TextureCoordinate[0] = FVector2f::ZeroVector;
|
|
Vertex->TangentX = FVector(1.0f, 0.0f, 0.0f);
|
|
Vertex->TangentZ = FVector(0.0f, 1.0f, 0.0f);
|
|
// store the sign of the determinant in TangentZ.W (-1=-128,+1=127)
|
|
Vertex->TangentZ.Vector.W = 127;
|
|
Vertex->Color = Color;
|
|
}
|
|
|
|
void AddTriangleIndices(FNavMeshSceneProxyData::FDebugMeshData& MeshData, int32 V0, int32 V1, int32 V2)
|
|
{
|
|
MeshData.Indices.Add(V0);
|
|
MeshData.Indices.Add(V1);
|
|
MeshData.Indices.Add(V2);
|
|
}
|
|
|
|
void AddArea(TArray<FNavMeshSceneProxyData::FDebugMeshData>& MeshBuilders, const TArray<int32>& MeshIndices, const TArray<FVector>& MeshVerts, const FColor Color, const FVector DrawOffset)
|
|
{
|
|
if (MeshIndices.Num() == 0)
|
|
{
|
|
return;
|
|
}
|
|
|
|
FNavMeshSceneProxyData::FDebugMeshData DebugMeshData;
|
|
for (int32 VertIdx = 0; VertIdx < MeshVerts.Num(); ++VertIdx)
|
|
{
|
|
FNavMeshRenderingHelpers::AddVertex(DebugMeshData, MeshVerts[VertIdx] + DrawOffset, Color);
|
|
}
|
|
for (int32 TriIdx = 0; TriIdx < MeshIndices.Num(); TriIdx += 3)
|
|
{
|
|
FNavMeshRenderingHelpers::AddTriangleIndices(DebugMeshData, MeshIndices[TriIdx], MeshIndices[TriIdx + 1], MeshIndices[TriIdx + 2]);
|
|
}
|
|
|
|
DebugMeshData.ClusterColor = Color;
|
|
MeshBuilders.Add(DebugMeshData);
|
|
}
|
|
|
|
void AddRecastGeometry(TArray<FVector>& OutVertexBuffer, TArray<uint32>& OutIndexBuffer, const FVector::FReal* Coords, int32 NumVerts, const int32* Faces, int32 NumFaces, const FTransform& Transform = FTransform::Identity)
|
|
{
|
|
const int32 VertIndexBase = OutVertexBuffer.Num();
|
|
for (int32 VertIdx = 0; VertIdx < NumVerts * 3; VertIdx += 3)
|
|
{
|
|
OutVertexBuffer.Add(Transform.TransformPosition(Recast2UnrealPoint(&Coords[VertIdx])));
|
|
}
|
|
|
|
const int32 FirstNewFaceVertexIndex = OutIndexBuffer.Num();
|
|
const uint32 NumIndices = NumFaces * 3;
|
|
OutIndexBuffer.AddUninitialized(NumIndices);
|
|
for (uint32 Index = 0; Index < NumIndices; ++Index)
|
|
{
|
|
OutIndexBuffer[FirstNewFaceVertexIndex + Index] = VertIndexBase + Faces[Index];
|
|
}
|
|
}
|
|
|
|
inline bool HasFlag(int32 Flags, ENavMeshDetailFlags TestFlag)
|
|
{
|
|
return (Flags & (1 << static_cast<int32>(TestFlag))) != 0;
|
|
}
|
|
|
|
#if WITH_RECAST
|
|
int32 GetDetailFlags(const ARecastNavMesh* NavMesh)
|
|
{
|
|
return (NavMesh == nullptr) ? 0 : 0 |
|
|
(NavMesh->bDrawTriangleEdges ? (1 << static_cast<int32>(ENavMeshDetailFlags::TriangleEdges)) : 0) |
|
|
(NavMesh->bDrawPolyEdges ? (1 << static_cast<int32>(ENavMeshDetailFlags::PolyEdges)) : 0) |
|
|
(NavMesh->bDrawFilledPolys ? (1 << static_cast<int32>(ENavMeshDetailFlags::FilledPolys)) : 0) |
|
|
(NavMesh->bDrawNavMeshEdges ? (1 << static_cast<int32>(ENavMeshDetailFlags::BoundaryEdges)) : 0) |
|
|
(NavMesh->bDrawTileBounds ? (1 << static_cast<int32>(ENavMeshDetailFlags::TileBounds)) : 0) |
|
|
(NavMesh->bDrawPathCollidingGeometry ? (1 << static_cast<int32>(ENavMeshDetailFlags::PathCollidingGeometry)) : 0) |
|
|
(NavMesh->bDrawTileLabels ? (1 << static_cast<int32>(ENavMeshDetailFlags::TileLabels)) : 0) |
|
|
(NavMesh->bDrawPolygonLabels ? (1 << static_cast<int32>(ENavMeshDetailFlags::PolygonLabels)) : 0) |
|
|
(NavMesh->bDrawDefaultPolygonCost ? (1 << static_cast<int32>(ENavMeshDetailFlags::PolygonCost)) : 0) |
|
|
(NavMesh->bDrawPolygonFlags ? (1 << static_cast<int32>(ENavMeshDetailFlags::PolygonFlags)) : 0) |
|
|
(NavMesh->bDrawLabelsOnPathNodes ? (1 << static_cast<int32>(ENavMeshDetailFlags::PathLabels)) : 0) |
|
|
(NavMesh->bDrawNavLinks ? (1 << static_cast<int32>(ENavMeshDetailFlags::NavLinks)) : 0) |
|
|
(NavMesh->bDrawFailedNavLinks ? (1 << static_cast<int32>(ENavMeshDetailFlags::FailedNavLinks)) : 0) |
|
|
(NavMesh->bDrawClusters ? (1 << static_cast<int32>(ENavMeshDetailFlags::Clusters)) : 0) |
|
|
(NavMesh->bDrawOctree ? (1 << static_cast<int32>(ENavMeshDetailFlags::NavOctree)) : 0) |
|
|
(NavMesh->bDrawOctreeDetails ? (1 << static_cast<int32>(ENavMeshDetailFlags::NavOctreeDetails)) : 0) |
|
|
(NavMesh->bDrawMarkedForbiddenPolys ? (1 << static_cast<int32>(ENavMeshDetailFlags::MarkForbiddenPolys)) : 0);
|
|
}
|
|
#endif // WITH_RECAST
|
|
|
|
}
|
|
|
|
//////////////////////////////////////////////////////////////////////////
|
|
// FNavMeshSceneProxyData
|
|
|
|
void FNavMeshSceneProxyData::Reset()
|
|
{
|
|
MeshBuilders.Reset();
|
|
ThickLineItems.Reset();
|
|
TileEdgeLines.Reset();
|
|
NavMeshEdgeLines.Reset();
|
|
NavLinkLines.Reset();
|
|
ClusterLinkLines.Reset();
|
|
AuxLines.Reset();
|
|
AuxPoints.Reset();
|
|
AuxBoxes.Reset();
|
|
DebugLabels.Reset();
|
|
OctreeBounds.Reset();
|
|
Bounds.Init();
|
|
|
|
bNeedsNewData = true;
|
|
bDataGathered = false;
|
|
NavDetailFlags = 0;
|
|
}
|
|
|
|
void FNavMeshSceneProxyData::Serialize(FArchive& Ar)
|
|
{
|
|
int32 NumMeshBuilders = MeshBuilders.Num();
|
|
Ar << NumMeshBuilders;
|
|
if (Ar.IsLoading())
|
|
{
|
|
MeshBuilders.SetNum(NumMeshBuilders);
|
|
}
|
|
|
|
for (int32 Idx = 0; Idx < NumMeshBuilders; Idx++)
|
|
{
|
|
FDebugMeshData& MeshBuilder = MeshBuilders[Idx];
|
|
|
|
int32 NumVerts = MeshBuilder.Vertices.Num();
|
|
Ar << NumVerts;
|
|
if (Ar.IsLoading())
|
|
{
|
|
MeshBuilder.Vertices.SetNum(NumVerts);
|
|
}
|
|
|
|
for (int32 VertIdx = 0; VertIdx < NumVerts; VertIdx++)
|
|
{
|
|
FVector3f SerializedVert = MeshBuilder.Vertices[VertIdx].Position;
|
|
Ar << SerializedVert;
|
|
|
|
if (Ar.IsLoading())
|
|
{
|
|
MeshBuilder.Vertices[VertIdx] = FDynamicMeshVertex(SerializedVert);
|
|
}
|
|
}
|
|
|
|
Ar << MeshBuilder.Indices;
|
|
Ar << MeshBuilder.ClusterColor;
|
|
}
|
|
|
|
TArray<FDebugRenderSceneProxy::FDebugLine>* LineArraysToSerialize[] = { &ThickLineItems, &TileEdgeLines, &NavMeshEdgeLines, &NavLinkLines, &ClusterLinkLines, &AuxLines };
|
|
for (int32 ArrIdx = 0; ArrIdx < UE_ARRAY_COUNT(LineArraysToSerialize); ArrIdx++)
|
|
{
|
|
int32 NumItems = LineArraysToSerialize[ArrIdx]->Num();
|
|
Ar << NumItems;
|
|
if (Ar.IsLoading())
|
|
{
|
|
LineArraysToSerialize[ArrIdx]->Reset(NumItems);
|
|
LineArraysToSerialize[ArrIdx]->AddUninitialized(NumItems);
|
|
}
|
|
|
|
for (int32 Idx = 0; Idx < NumItems; Idx++)
|
|
{
|
|
Ar << (*LineArraysToSerialize[ArrIdx])[Idx].Thickness;
|
|
Ar << (*LineArraysToSerialize[ArrIdx])[Idx].Start;
|
|
Ar << (*LineArraysToSerialize[ArrIdx])[Idx].End;
|
|
Ar << (*LineArraysToSerialize[ArrIdx])[Idx].Color;
|
|
}
|
|
}
|
|
|
|
int32 NumPoints = AuxPoints.Num();
|
|
Ar << NumPoints;
|
|
if (Ar.IsLoading())
|
|
{
|
|
FDebugPoint TmpPoint(FVector::ZeroVector, FColor::Black, 0.0f);
|
|
AuxPoints.Reserve(NumPoints);
|
|
for (int32 Idx = 0; Idx < NumPoints; Idx++)
|
|
{
|
|
Ar << TmpPoint.Position;
|
|
Ar << TmpPoint.Color;
|
|
Ar << TmpPoint.Size;
|
|
|
|
AuxPoints.Add(TmpPoint);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
for (int32 Idx = 0; Idx < NumPoints; Idx++)
|
|
{
|
|
Ar << AuxPoints[Idx].Position;
|
|
Ar << AuxPoints[Idx].Color;
|
|
Ar << AuxPoints[Idx].Size;
|
|
}
|
|
}
|
|
|
|
int32 NumBoxes = AuxBoxes.Num();
|
|
Ar << NumBoxes;
|
|
if (Ar.IsLoading())
|
|
{
|
|
FDebugRenderSceneProxy::FDebugBox TmpBox = FDebugRenderSceneProxy::FDebugBox(FBox(), FColor());
|
|
AuxBoxes.Reserve(NumBoxes);
|
|
for (int32 Idx = 0; Idx < NumBoxes; Idx++)
|
|
{
|
|
Ar << TmpBox.Box;
|
|
Ar << TmpBox.Color;
|
|
Ar << TmpBox.Transform;
|
|
|
|
AuxBoxes.Add(TmpBox);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
for (int32 Idx = 0; Idx < NumBoxes; Idx++)
|
|
{
|
|
Ar << AuxBoxes[Idx].Box;
|
|
Ar << AuxBoxes[Idx].Color;
|
|
Ar << AuxBoxes[Idx].Transform;
|
|
}
|
|
}
|
|
|
|
int32 NumLabels = DebugLabels.Num();
|
|
Ar << NumLabels;
|
|
if (Ar.IsLoading())
|
|
{
|
|
DebugLabels.SetNum(NumLabels);
|
|
}
|
|
|
|
for (int32 Idx = 0; Idx < NumLabels; Idx++)
|
|
{
|
|
Ar << DebugLabels[Idx].Location;
|
|
Ar << DebugLabels[Idx].Text;
|
|
}
|
|
|
|
int32 NumBounds = OctreeBounds.Num();
|
|
Ar << NumBounds;
|
|
if (Ar.IsLoading())
|
|
{
|
|
OctreeBounds.SetNum(NumBounds);
|
|
}
|
|
|
|
for (int32 Idx = 0; Idx < NumBounds; Idx++)
|
|
{
|
|
Ar << OctreeBounds[Idx].Center;
|
|
Ar << OctreeBounds[Idx].Extent;
|
|
}
|
|
|
|
Ar << Bounds;
|
|
Ar << NavMeshDrawOffset;
|
|
Ar << NavDetailFlags;
|
|
|
|
int32 BitFlags = ((bDataGathered ? 1 : 0) << 0) | ((bNeedsNewData ? 1 : 0) << 1);
|
|
Ar << BitFlags;
|
|
bDataGathered = (BitFlags & (1 << 0)) != 0;
|
|
bNeedsNewData = (BitFlags & (1 << 1)) != 0;
|
|
}
|
|
|
|
uint32 FNavMeshSceneProxyData::GetAllocatedSize() const
|
|
{
|
|
return MeshBuilders.GetAllocatedSize() +
|
|
ThickLineItems.GetAllocatedSize() +
|
|
TileEdgeLines.GetAllocatedSize() +
|
|
NavMeshEdgeLines.GetAllocatedSize() +
|
|
NavLinkLines.GetAllocatedSize() +
|
|
ClusterLinkLines.GetAllocatedSize() +
|
|
AuxLines.GetAllocatedSize() +
|
|
AuxPoints.GetAllocatedSize() +
|
|
AuxBoxes.GetAllocatedSize() +
|
|
DebugLabels.GetAllocatedSize() +
|
|
OctreeBounds.GetAllocatedSize();
|
|
}
|
|
|
|
#if WITH_RECAST
|
|
|
|
void FNavMeshSceneProxyData::GatherData(const ARecastNavMesh* NavMesh, int32 InNavDetailFlags, const TArray<int32>& TileSet)
|
|
{
|
|
QUICK_SCOPE_CYCLE_COUNTER(STAT_NavMesh_GatherDebugDrawingGeometry);
|
|
Reset();
|
|
|
|
NavDetailFlags = InNavDetailFlags;
|
|
if (NavMesh && NavDetailFlags)
|
|
{
|
|
bNeedsNewData = false;
|
|
bDataGathered = true;
|
|
|
|
NavMeshDrawOffset.Z = NavMesh->DrawOffset;
|
|
|
|
FRecastDebugGeometry NavMeshGeometry;
|
|
NavMeshGeometry.bGatherPolyEdges = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::PolyEdges);
|
|
NavMeshGeometry.bGatherNavMeshEdges = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::BoundaryEdges);
|
|
NavMeshGeometry.bMarkForbiddenPolys = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::MarkForbiddenPolys);
|
|
|
|
const FNavDataConfig& NavConfig = NavMesh->GetConfig();
|
|
TArray<FColor> NavMeshColors;
|
|
NavMeshColors.AddDefaulted(RECAST_MAX_AREAS);
|
|
|
|
for (uint8 Idx = 0; Idx < RECAST_MAX_AREAS; Idx++)
|
|
{
|
|
NavMeshColors[Idx] = NavMesh->GetAreaIDColor(Idx);
|
|
}
|
|
NavMeshColors[RECAST_DEFAULT_AREA] = NavConfig.Color.DWColor() > 0 ? NavConfig.Color : NavMeshRenderColor_RecastMesh;
|
|
|
|
// just a little trick to make sure navmeshes with different sized are not drawn with same offset
|
|
NavMeshDrawOffset.Z += NavMesh->GetConfig().AgentRadius / 10.f;
|
|
|
|
NavMesh->BeginBatchQuery();
|
|
if (TileSet.Num() > 0)
|
|
{
|
|
bool bDone = false;
|
|
for (int32 Idx = 0; Idx < TileSet.Num() && !bDone; Idx++)
|
|
{
|
|
bDone = NavMesh->GetDebugGeometryForTile(NavMeshGeometry, TileSet[Idx]);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
NavMesh->GetDebugGeometryForTile(NavMeshGeometry, INDEX_NONE);
|
|
}
|
|
|
|
const TArray<FVector>& MeshVerts = NavMeshGeometry.MeshVerts;
|
|
|
|
// @fixme, this is going to double up on lots of interior lines
|
|
const bool bGatherTriEdges = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::TriangleEdges);
|
|
if (bGatherTriEdges)
|
|
{
|
|
for (int32 AreaIdx = 0; AreaIdx < RECAST_MAX_AREAS; ++AreaIdx)
|
|
{
|
|
const TArray<int32>& MeshIndices = NavMeshGeometry.AreaIndices[AreaIdx];
|
|
for (int32 Idx = 0; Idx < MeshIndices.Num(); Idx += 3)
|
|
{
|
|
ThickLineItems.Add(FDebugRenderSceneProxy::FDebugLine(MeshVerts[MeshIndices[Idx + 0]] + NavMeshDrawOffset, MeshVerts[MeshIndices[Idx + 1]] + NavMeshDrawOffset, NavMeshRenderColor_Recast_TriangleEdges, DefaultEdges_LineThickness));
|
|
ThickLineItems.Add(FDebugRenderSceneProxy::FDebugLine(MeshVerts[MeshIndices[Idx + 1]] + NavMeshDrawOffset, MeshVerts[MeshIndices[Idx + 2]] + NavMeshDrawOffset, NavMeshRenderColor_Recast_TriangleEdges, DefaultEdges_LineThickness));
|
|
ThickLineItems.Add(FDebugRenderSceneProxy::FDebugLine(MeshVerts[MeshIndices[Idx + 2]] + NavMeshDrawOffset, MeshVerts[MeshIndices[Idx + 0]] + NavMeshDrawOffset, NavMeshRenderColor_Recast_TriangleEdges, DefaultEdges_LineThickness));
|
|
}
|
|
}
|
|
}
|
|
|
|
// make lines for tile edges
|
|
const bool bGatherPolyEdges = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::PolyEdges);
|
|
if (bGatherPolyEdges)
|
|
{
|
|
const TArray<FVector>& TileEdgeVerts = NavMeshGeometry.PolyEdges;
|
|
for (int32 Idx = 0; Idx < TileEdgeVerts.Num(); Idx += 2)
|
|
{
|
|
TileEdgeLines.Add(FDebugRenderSceneProxy::FDebugLine(TileEdgeVerts[Idx] + NavMeshDrawOffset, TileEdgeVerts[Idx + 1] + NavMeshDrawOffset, NavMeshRenderColor_Recast_TileEdges));
|
|
}
|
|
}
|
|
|
|
// make lines for navmesh edges
|
|
const bool bGatherBoundaryEdges = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::BoundaryEdges);
|
|
if (bGatherBoundaryEdges)
|
|
{
|
|
const FColor EdgesColor = FNavMeshRenderingHelpers::DarkenColor(NavMeshColors[RECAST_DEFAULT_AREA]);
|
|
const TArray<FVector>& NavMeshEdgeVerts = NavMeshGeometry.NavMeshEdges;
|
|
for (int32 Idx = 0; Idx < NavMeshEdgeVerts.Num(); Idx += 2)
|
|
{
|
|
NavMeshEdgeLines.Add(FDebugRenderSceneProxy::FDebugLine(NavMeshEdgeVerts[Idx] + NavMeshDrawOffset, NavMeshEdgeVerts[Idx + 1] + NavMeshDrawOffset, EdgesColor));
|
|
}
|
|
}
|
|
|
|
// offset all navigation-link positions
|
|
const bool bGatherNavLinks = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::NavLinks);
|
|
const bool bGatherFailedNavLinks = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::FailedNavLinks);
|
|
|
|
#if WITH_NAVMESH_CLUSTER_LINKS
|
|
const bool bGatherClusters = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::Clusters);
|
|
if (bGatherClusters == false)
|
|
#endif // WITH_NAVMESH_CLUSTER_LINKS
|
|
{
|
|
for (int32 OffMeshLineIndex = 0; OffMeshLineIndex < NavMeshGeometry.OffMeshLinks.Num(); ++OffMeshLineIndex)
|
|
{
|
|
FRecastDebugGeometry::FOffMeshLink& Link = NavMeshGeometry.OffMeshLinks[OffMeshLineIndex];
|
|
const bool bLinkValid = (Link.ValidEnds & FRecastDebugGeometry::OMLE_Left) && (Link.ValidEnds & FRecastDebugGeometry::OMLE_Right);
|
|
|
|
if (bGatherFailedNavLinks || (bGatherNavLinks && bLinkValid))
|
|
{
|
|
const FVector V0 = Link.Left + NavMeshDrawOffset;
|
|
const FVector V1 = Link.Right + NavMeshDrawOffset;
|
|
const FColor LinkColor = ((Link.Direction && Link.ValidEnds) || (Link.ValidEnds & FRecastDebugGeometry::OMLE_Left)) ? FNavMeshRenderingHelpers::SemiDarkenColor(NavMeshColors[Link.AreaID]) : NavMeshRenderColor_OffMeshConnectionInvalid;
|
|
|
|
FNavMeshRenderingHelpers::CacheLink(NavLinkLines, V0, V1, LinkColor, Link.Direction);
|
|
|
|
// if the connection as a whole is valid check if there are any of ends is invalid
|
|
if (LinkColor != NavMeshRenderColor_OffMeshConnectionInvalid)
|
|
{
|
|
if (Link.Direction && (Link.ValidEnds & FRecastDebugGeometry::OMLE_Left) == 0)
|
|
{
|
|
// left end invalid - mark it
|
|
FNavMeshRenderingHelpers::DrawWireCylinder(NavLinkLines, V0, FVector(1, 0, 0), FVector(0, 1, 0), FVector(0, 0, 1), NavMeshRenderColor_OffMeshConnectionInvalid, Link.Radius, NavMesh->AgentMaxStepHeight, 16, 0, DefaultEdges_LineThickness);
|
|
}
|
|
if ((Link.ValidEnds & FRecastDebugGeometry::OMLE_Right) == 0)
|
|
{
|
|
FNavMeshRenderingHelpers::DrawWireCylinder(NavLinkLines, V1, FVector(1, 0, 0), FVector(0, 1, 0), FVector(0, 0, 1), NavMeshRenderColor_OffMeshConnectionInvalid, Link.Radius, NavMesh->AgentMaxStepHeight, 16, 0, DefaultEdges_LineThickness);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
if (NavMeshGeometry.bMarkForbiddenPolys)
|
|
{
|
|
for (int32 OffMeshLineIndex = 0; OffMeshLineIndex < NavMeshGeometry.ForbiddenLinks.Num(); ++OffMeshLineIndex)
|
|
{
|
|
FRecastDebugGeometry::FOffMeshLink& Link = NavMeshGeometry.ForbiddenLinks[OffMeshLineIndex];
|
|
|
|
const FVector V0 = Link.Left + NavMeshDrawOffset;
|
|
const FVector V1 = Link.Right + NavMeshDrawOffset;
|
|
const FColor LinkColor = NavMeshRenderColor_PolyForbidden;
|
|
|
|
FNavMeshRenderingHelpers::CacheLink(NavLinkLines, V0, V1, LinkColor, Link.Direction);
|
|
}
|
|
}
|
|
}
|
|
|
|
const bool bGatherTileLabels = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::TileLabels);
|
|
const bool bGatherTileBounds = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::TileBounds);
|
|
const bool bGatherPolygonLabels = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::PolygonLabels);
|
|
const bool bGatherPolygonCost = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::PolygonCost);
|
|
const bool bGatherPolygonFlags = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::PolygonFlags);
|
|
|
|
if (bGatherTileLabels || bGatherTileBounds || bGatherPolygonLabels || bGatherPolygonCost || bGatherPolygonFlags)
|
|
{
|
|
TArray<int32> UseTileIndices;
|
|
if (TileSet.Num() > 0)
|
|
{
|
|
UseTileIndices = TileSet;
|
|
}
|
|
else
|
|
{
|
|
const int32 TilesCount = NavMesh->GetNavMeshTilesCount();
|
|
for (int32 Idx = 0; Idx < TilesCount; Idx++)
|
|
{
|
|
UseTileIndices.Add(Idx);
|
|
}
|
|
}
|
|
|
|
// calculate appropriate points for displaying debug labels
|
|
DebugLabels.Reserve(UseTileIndices.Num());
|
|
for (int32 TileSetIdx = 0; TileSetIdx < UseTileIndices.Num(); TileSetIdx++)
|
|
{
|
|
const int32 TileIndex = UseTileIndices[TileSetIdx];
|
|
int32 X, Y, Layer;
|
|
if (NavMesh->GetNavMeshTileXY(TileIndex, X, Y, Layer))
|
|
{
|
|
const FBox TileBoundingBox = NavMesh->GetNavMeshTileBounds(TileIndex);
|
|
FVector TileLabelLocation = TileBoundingBox.GetCenter();
|
|
TileLabelLocation.Z = TileBoundingBox.Max.Z;
|
|
|
|
FNavLocation NavLocation(TileLabelLocation);
|
|
if (!NavMesh->ProjectPoint(TileLabelLocation, NavLocation, FVector(NavMesh->TileSizeUU / 100, NavMesh->TileSizeUU / 100, TileBoundingBox.Max.Z - TileBoundingBox.Min.Z)))
|
|
{
|
|
NavMesh->ProjectPoint(TileLabelLocation, NavLocation, FVector(NavMesh->TileSizeUU / 2, NavMesh->TileSizeUU / 2, TileBoundingBox.Max.Z - TileBoundingBox.Min.Z));
|
|
}
|
|
|
|
if (bGatherTileLabels)
|
|
{
|
|
DebugLabels.Add(FDebugText(NavLocation.Location + NavMeshDrawOffset, FString::Printf(TEXT("(%d,%d:%d)"), X, Y, Layer)));
|
|
}
|
|
|
|
if (bGatherPolygonLabels || bGatherPolygonCost || bGatherPolygonFlags)
|
|
{
|
|
TArray<FNavPoly> Polys;
|
|
NavMesh->GetPolysInTile(TileIndex, Polys);
|
|
|
|
float DefaultCosts[RECAST_MAX_AREAS];
|
|
float FixedCosts[RECAST_MAX_AREAS];
|
|
|
|
if (bGatherPolygonCost)
|
|
{
|
|
NavMesh->GetDefaultQueryFilter()->GetAllAreaCosts(DefaultCosts, FixedCosts, RECAST_MAX_AREAS);
|
|
}
|
|
|
|
for (const FNavPoly& Poly : Polys)
|
|
{
|
|
TStringBuilder<100> StringBuilder;
|
|
|
|
if (bGatherPolygonLabels)
|
|
{
|
|
uint32 NavPolyIndex = 0;
|
|
uint32 NavTileIndex = 0;
|
|
NavMesh->GetPolyTileIndex(Poly.Ref, NavPolyIndex, NavTileIndex);
|
|
|
|
if (StringBuilder.Len() > 0)
|
|
{
|
|
StringBuilder.Append(TEXT("\n"));
|
|
}
|
|
StringBuilder.Appendf(TEXT("Index Tile/Poly: [%d : %d]"), NavTileIndex, NavPolyIndex);
|
|
}
|
|
|
|
if (bGatherPolygonCost)
|
|
{
|
|
const uint32 AreaID = NavMesh->GetPolyAreaID(Poly.Ref);
|
|
|
|
if (StringBuilder.Len() > 0)
|
|
{
|
|
StringBuilder.Append(TEXT("\n"));
|
|
}
|
|
StringBuilder.Appendf(TEXT("Cost Default/Fixed: [%.3f : %.3f]"), DefaultCosts[AreaID], FixedCosts[AreaID]);
|
|
}
|
|
|
|
if (bGatherPolygonFlags)
|
|
{
|
|
uint16 PolyFlags = 0;
|
|
uint16 AreaFlags = 0;
|
|
NavMesh->GetPolyFlags(Poly.Ref, PolyFlags, AreaFlags);
|
|
|
|
if (StringBuilder.Len() > 0)
|
|
{
|
|
StringBuilder.Append(TEXT("\n"));
|
|
}
|
|
StringBuilder.Appendf(TEXT("Flags Poly/Area: [0x%X : 0x%X]"), PolyFlags, AreaFlags);
|
|
}
|
|
|
|
DebugLabels.Add(FDebugText(Poly.Center + NavMeshDrawOffset, StringBuilder.ToString()));
|
|
}
|
|
}
|
|
|
|
if (bGatherTileBounds)
|
|
{
|
|
const FBox TileBox = NavMesh->GetNavMeshTileBounds(TileIndex);
|
|
const float DrawZ = (TileBox.Min.Z + TileBox.Max.Z) * 0.5f;
|
|
const FVector LL(TileBox.Min.X, TileBox.Min.Y, DrawZ);
|
|
const FVector UR(TileBox.Max.X, TileBox.Max.Y, DrawZ);
|
|
const FVector UL(LL.X, UR.Y, DrawZ);
|
|
const FVector LR(UR.X, LL.Y, DrawZ);
|
|
|
|
ThickLineItems.Add(FDebugRenderSceneProxy::FDebugLine(LL, UL, NavMeshRenderColor_TileBounds, DefaultEdges_LineThickness));
|
|
ThickLineItems.Add(FDebugRenderSceneProxy::FDebugLine(UL, UR, NavMeshRenderColor_TileBounds, DefaultEdges_LineThickness));
|
|
ThickLineItems.Add(FDebugRenderSceneProxy::FDebugLine(UR, LR, NavMeshRenderColor_TileBounds, DefaultEdges_LineThickness));
|
|
ThickLineItems.Add(FDebugRenderSceneProxy::FDebugLine(LR, LL, NavMeshRenderColor_TileBounds, DefaultEdges_LineThickness));
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
#if RECAST_INTERNAL_DEBUG_DATA
|
|
// Display internal debug data
|
|
for (const FIntPoint& point : NavMeshGeometry.TilesToDisplayInternalData)
|
|
{
|
|
if (NavMesh->GetDebugDataMap())
|
|
{
|
|
const FRecastInternalDebugData& DebugData = NavMesh->GetDebugDataMap()->FindRef(point);
|
|
AddMeshForInternalData(DebugData);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
NavMesh->FinishBatchQuery();
|
|
|
|
// Draw Mesh
|
|
const bool bGatherFilledPolys = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::FilledPolys);
|
|
if (bGatherFilledPolys)
|
|
{
|
|
#if WITH_NAVMESH_CLUSTER_LINKS
|
|
if (bGatherClusters)
|
|
{
|
|
for (int32 Idx = 0; Idx < NavMeshGeometry.Clusters.Num(); ++Idx)
|
|
{
|
|
const TArray<int32>& MeshIndices = NavMeshGeometry.Clusters[Idx].MeshIndices;
|
|
if (MeshIndices.Num() == 0)
|
|
{
|
|
continue;
|
|
}
|
|
|
|
FDebugMeshData DebugMeshData;
|
|
DebugMeshData.ClusterColor = FNavMeshRenderingHelpers::GetClusterColor(Idx);
|
|
for (int32 VertIdx = 0; VertIdx < MeshVerts.Num(); ++VertIdx)
|
|
{
|
|
FNavMeshRenderingHelpers::AddVertex(DebugMeshData, MeshVerts[VertIdx] + NavMeshDrawOffset, DebugMeshData.ClusterColor);
|
|
}
|
|
for (int32 TriIdx = 0; TriIdx < MeshIndices.Num(); TriIdx += 3)
|
|
{
|
|
FNavMeshRenderingHelpers::AddTriangleIndices(DebugMeshData, MeshIndices[TriIdx], MeshIndices[TriIdx + 1], MeshIndices[TriIdx + 2]);
|
|
}
|
|
|
|
MeshBuilders.Add(DebugMeshData);
|
|
}
|
|
}
|
|
else
|
|
#endif // WITH_NAVMESH_CLUSTER_LINKS
|
|
{
|
|
for (int32 AreaType = 0; AreaType < RECAST_MAX_AREAS; ++AreaType)
|
|
{
|
|
FNavMeshRenderingHelpers::AddArea(MeshBuilders, NavMeshGeometry.AreaIndices[AreaType], NavMeshGeometry.MeshVerts, NavMeshColors[AreaType], NavMeshDrawOffset);
|
|
}
|
|
FNavMeshRenderingHelpers::AddArea(MeshBuilders, NavMeshGeometry.ForbiddenIndices, NavMeshGeometry.MeshVerts, NavMeshRenderColor_PolyForbidden, NavMeshDrawOffset);
|
|
}
|
|
}
|
|
|
|
const bool bGatherOctree = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::NavOctree);
|
|
const bool bGatherOctreeDetails = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::NavOctreeDetails);
|
|
const bool bGatherPathCollidingGeometry = FNavMeshRenderingHelpers::HasFlag(NavDetailFlags, ENavMeshDetailFlags::PathCollidingGeometry);
|
|
if (bGatherOctree || bGatherPathCollidingGeometry)
|
|
{
|
|
const UNavigationSystemV1* NavSys = FNavigationSystem::GetCurrent<UNavigationSystemV1>(NavMesh->GetWorld());
|
|
const FNavigationOctree* NavOctree = NavSys ? NavSys->GetNavOctree() : nullptr;
|
|
if (NavOctree)
|
|
{
|
|
TArray<FVector> CollidingVerts;
|
|
TArray<uint32> CollidingIndices;
|
|
|
|
FBox CurrentNodeBoundsBox;
|
|
NavOctree->FindElementsWithPredicate([bGatherOctree, bGatherPathCollidingGeometry, this, &CurrentNodeBoundsBox](FNavigationOctree::FNodeIndex /*ParentNodeIndex*/, FNavigationOctree::FNodeIndex /*NodeIndex*/, const FBoxCenterAndExtent& NodeBounds)
|
|
{
|
|
if (bGatherOctree)
|
|
{
|
|
OctreeBounds.Add(NodeBounds);
|
|
}
|
|
|
|
if (bGatherPathCollidingGeometry)
|
|
{
|
|
CurrentNodeBoundsBox = NodeBounds.GetBox();
|
|
}
|
|
return true;
|
|
},
|
|
[bGatherOctree, bGatherOctreeDetails, bGatherPathCollidingGeometry, this, NavMesh, &CollidingVerts, &CollidingIndices, &CurrentNodeBoundsBox](FNavigationOctree::FNodeIndex /*ParentNodeIndex*/, const FNavigationOctreeElement& Element)
|
|
{
|
|
if (bGatherOctree && bGatherOctreeDetails)
|
|
{
|
|
OctreeBounds.Add(FBoxCenterAndExtent(Element.Bounds));
|
|
}
|
|
|
|
if (bGatherPathCollidingGeometry)
|
|
{
|
|
if (Element.ShouldUseGeometry(NavMesh->GetConfig()) && Element.Data->CollisionData.Num())
|
|
{
|
|
const FRecastGeometryCache CachedGeometry(Element.Data->CollisionData.GetData());
|
|
TArray<FTransform> InstanceTransforms;
|
|
Element.Data->NavDataPerInstanceTransformDelegate.ExecuteIfBound(CurrentNodeBoundsBox, InstanceTransforms);
|
|
|
|
if (InstanceTransforms.Num() == 0)
|
|
{
|
|
FNavMeshRenderingHelpers::AddRecastGeometry(CollidingVerts, CollidingIndices, CachedGeometry.Verts, CachedGeometry.Header.NumVerts, CachedGeometry.Indices, CachedGeometry.Header.NumFaces);
|
|
}
|
|
else
|
|
{
|
|
for (const auto& Transform : InstanceTransforms)
|
|
{
|
|
FNavMeshRenderingHelpers::AddRecastGeometry(CollidingVerts, CollidingIndices, CachedGeometry.Verts, CachedGeometry.Header.NumVerts, CachedGeometry.Indices, CachedGeometry.Header.NumFaces, Transform);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
});
|
|
|
|
if (CollidingVerts.Num())
|
|
{
|
|
FDebugMeshData DebugMeshData;
|
|
for (int32 VertIdx = 0; VertIdx < CollidingVerts.Num(); ++VertIdx)
|
|
{
|
|
FNavMeshRenderingHelpers::AddVertex(DebugMeshData, CollidingVerts[VertIdx], NavMeshRenderColor_PathCollidingGeom);
|
|
}
|
|
DebugMeshData.Indices = CollidingIndices;
|
|
DebugMeshData.ClusterColor = NavMeshRenderColor_PathCollidingGeom;
|
|
MeshBuilders.Add(DebugMeshData);
|
|
}
|
|
}
|
|
}
|
|
|
|
if (NavMeshGeometry.BuiltMeshIndices.Num() > 0)
|
|
{
|
|
FDebugMeshData DebugMeshData;
|
|
for (int32 VertIdx = 0; VertIdx < MeshVerts.Num(); ++VertIdx)
|
|
{
|
|
FNavMeshRenderingHelpers::AddVertex(DebugMeshData, MeshVerts[VertIdx] + NavMeshDrawOffset, NavMeshRenderColor_RecastTileBeingRebuilt);
|
|
}
|
|
DebugMeshData.Indices.Append(NavMeshGeometry.BuiltMeshIndices);
|
|
DebugMeshData.ClusterColor = NavMeshRenderColor_RecastTileBeingRebuilt;
|
|
MeshBuilders.Add(DebugMeshData);
|
|
}
|
|
|
|
#if WITH_NAVMESH_CLUSTER_LINKS
|
|
if (bGatherClusters)
|
|
{
|
|
for (int32 Idx = 0; Idx < NavMeshGeometry.ClusterLinks.Num(); Idx++)
|
|
{
|
|
const FRecastDebugGeometry::FClusterLink& CLink = NavMeshGeometry.ClusterLinks[Idx];
|
|
const FVector V0 = CLink.FromCluster + NavMeshDrawOffset;
|
|
const FVector V1 = CLink.ToCluster + NavMeshDrawOffset + FVector(0, 0, 20.0f);
|
|
|
|
FNavMeshRenderingHelpers::CacheArc(ClusterLinkLines, V0, V1, 0.4f, 4, FColor::Black, ClusterLinkLines_LineThickness);
|
|
const FVector VOffset(0, 0, FVector::Dist(V0, V1) * 1.333f);
|
|
FNavMeshRenderingHelpers::CacheArrowHead(ClusterLinkLines, V1, V0 + VOffset, 30.f, FColor::Black, ClusterLinkLines_LineThickness);
|
|
}
|
|
}
|
|
#endif // WITH_NAVMESH_CLUSTER_LINKS
|
|
|
|
#if WITH_NAVMESH_SEGMENT_LINKS
|
|
// cache segment links
|
|
if (bGatherNavLinks)
|
|
{
|
|
for (int32 AreaIdx = 0; AreaIdx < RECAST_MAX_AREAS; AreaIdx++)
|
|
{
|
|
const TArray<int32>& Indices = NavMeshGeometry.OffMeshSegmentAreas[AreaIdx];
|
|
FNavMeshSceneProxyData::FDebugMeshData DebugMeshData;
|
|
int32 VertBase = 0;
|
|
|
|
for (int32 Idx = 0; Idx < Indices.Num(); Idx++)
|
|
{
|
|
FRecastDebugGeometry::FOffMeshSegment& SegInfo = NavMeshGeometry.OffMeshSegments[Indices[Idx]];
|
|
const FVector A0 = SegInfo.LeftStart + NavMeshDrawOffset;
|
|
const FVector A1 = SegInfo.LeftEnd + NavMeshDrawOffset;
|
|
const FVector B0 = SegInfo.RightStart + NavMeshDrawOffset;
|
|
const FVector B1 = SegInfo.RightEnd + NavMeshDrawOffset;
|
|
const FVector Edge0 = B0 - A0;
|
|
const FVector Edge1 = B1 - A1;
|
|
const float Len0 = Edge0.Size();
|
|
const float Len1 = Edge1.Size();
|
|
const FColor SegColor = FNavMeshRenderingHelpers::DarkenColor(NavMeshColors[SegInfo.AreaID]);
|
|
const FColor ColA = (SegInfo.ValidEnds & FRecastDebugGeometry::OMLE_Left) ? FColor::White : FColor::Black;
|
|
const FColor ColB = (SegInfo.ValidEnds & FRecastDebugGeometry::OMLE_Right) ? FColor::White : FColor::Black;
|
|
|
|
constexpr int32 NumArcPoints = 8;
|
|
constexpr float ArcPtsScale = 1.0f / NumArcPoints;
|
|
|
|
FVector Prev0 = FNavMeshRenderingHelpers::EvalArc(A0, Edge0, Len0*0.25f, 0);
|
|
FVector Prev1 = FNavMeshRenderingHelpers::EvalArc(A1, Edge1, Len1*0.25f, 0);
|
|
FNavMeshRenderingHelpers::AddVertex(DebugMeshData, Prev0, ColA);
|
|
FNavMeshRenderingHelpers::AddVertex(DebugMeshData, Prev1, ColA);
|
|
for (int32 ArcIdx = 1; ArcIdx <= NumArcPoints; ArcIdx++)
|
|
{
|
|
const float u = ArcIdx * ArcPtsScale;
|
|
FVector Pt0 = FNavMeshRenderingHelpers::EvalArc(A0, Edge0, Len0*0.25f, u);
|
|
FVector Pt1 = FNavMeshRenderingHelpers::EvalArc(A1, Edge1, Len1*0.25f, u);
|
|
|
|
FNavMeshRenderingHelpers::AddVertex(DebugMeshData, Pt0, (ArcIdx == NumArcPoints) ? ColB : FColor::White);
|
|
FNavMeshRenderingHelpers::AddVertex(DebugMeshData, Pt1, (ArcIdx == NumArcPoints) ? ColB : FColor::White);
|
|
|
|
FNavMeshRenderingHelpers::AddTriangleIndices(DebugMeshData, VertBase + 0, VertBase + 2, VertBase + 1);
|
|
FNavMeshRenderingHelpers::AddTriangleIndices(DebugMeshData, VertBase + 2, VertBase + 3, VertBase + 1);
|
|
FNavMeshRenderingHelpers::AddTriangleIndices(DebugMeshData, VertBase + 0, VertBase + 1, VertBase + 2);
|
|
FNavMeshRenderingHelpers::AddTriangleIndices(DebugMeshData, VertBase + 2, VertBase + 1, VertBase + 3);
|
|
|
|
VertBase += 2;
|
|
Prev0 = Pt0;
|
|
Prev1 = Pt1;
|
|
}
|
|
VertBase += 2;
|
|
|
|
DebugMeshData.ClusterColor = SegColor;
|
|
}
|
|
|
|
if (DebugMeshData.Indices.Num())
|
|
{
|
|
MeshBuilders.Add(DebugMeshData);
|
|
}
|
|
}
|
|
}
|
|
#endif // WITH_NAVMESH_SEGMENT_LINKS
|
|
}
|
|
}
|
|
|
|
|
|
#if RECAST_INTERNAL_DEBUG_DATA
|
|
|
|
namespace FNavMeshRenderingHelpers
|
|
{
|
|
struct FUniqueColor
|
|
{
|
|
FUniqueColor() : Color(0), Count(0) {}
|
|
FUniqueColor(const FColor InColor, const uint32 InCount) : Color(InColor), Count(InCount) {}
|
|
FColor Color;
|
|
uint32 Count;
|
|
bool operator==(const FUniqueColor& Other) const
|
|
{
|
|
return Color == Other.Color;
|
|
|
|
}
|
|
};
|
|
FORCEINLINE uint32 GetTypeHash(const FUniqueColor& UniqueColor)
|
|
{
|
|
return UniqueColor.Color.DWColor();
|
|
}
|
|
}
|
|
|
|
void FNavMeshSceneProxyData::AddMeshForInternalData(const FRecastInternalDebugData& InInternalData)
|
|
{
|
|
if (InInternalData.TriangleIndices.Num() > 0)
|
|
{
|
|
const TArray<uint32>& Indices = InInternalData.TriangleIndices;
|
|
const TArray<FVector>& Vertices = InInternalData.TriangleVertices;
|
|
const TArray<FColor>& Colors = InInternalData.TriangleColors;
|
|
|
|
if (ensure(Vertices.Num() == Colors.Num()))
|
|
{
|
|
// Split the mesh into different colored pieces (because we cannot use vertex colors).
|
|
TSet<FNavMeshRenderingHelpers::FUniqueColor> UniqueColors;
|
|
FColor PrevColor = Colors[Indices[0]];
|
|
FSetElementId ColorIdx = UniqueColors.Add(FNavMeshRenderingHelpers::FUniqueColor(PrevColor, 1));
|
|
for (int32 i = 3; i < Indices.Num(); i += 3)
|
|
{
|
|
const FColor Color = Colors[Indices[i]]; // Use the first color as representative of the triangle color.
|
|
if (Color != PrevColor)
|
|
{
|
|
ColorIdx = UniqueColors.Add(FNavMeshRenderingHelpers::FUniqueColor(Color, 1));
|
|
PrevColor = Color;
|
|
}
|
|
else
|
|
{
|
|
UniqueColors[ColorIdx].Count++;
|
|
}
|
|
}
|
|
|
|
// Add triangles
|
|
for (const FNavMeshRenderingHelpers::FUniqueColor& CurrentColor : UniqueColors)
|
|
{
|
|
const uint32 VertexCount = CurrentColor.Count * 3;
|
|
FDebugMeshData& MeshData = MeshBuilders.AddDefaulted_GetRef();
|
|
|
|
MeshData.Indices.Reserve(VertexCount);
|
|
MeshData.Vertices.Reserve(VertexCount);
|
|
for (int32 i = 0; i < Indices.Num(); i += 3)
|
|
{
|
|
const FColor Color = Colors[Indices[i]];
|
|
if (Color == CurrentColor.Color)
|
|
{
|
|
const int32 VertexBase = MeshData.Vertices.Num();
|
|
FNavMeshRenderingHelpers::AddVertex(MeshData, Vertices[Indices[i]] + NavMeshDrawOffset, Color);
|
|
FNavMeshRenderingHelpers::AddVertex(MeshData, Vertices[Indices[i + 1]] + NavMeshDrawOffset, Color);
|
|
FNavMeshRenderingHelpers::AddVertex(MeshData, Vertices[Indices[i + 2]] + NavMeshDrawOffset, Color);
|
|
MeshData.Indices.Add(VertexBase);
|
|
MeshData.Indices.Add(VertexBase + 1);
|
|
MeshData.Indices.Add(VertexBase + 2);
|
|
}
|
|
}
|
|
MeshData.ClusterColor = CurrentColor.Color;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (InInternalData.LineVertices.Num() > 0)
|
|
{
|
|
const TArray<FVector>& Vertices = InInternalData.LineVertices;
|
|
const TArray<FColor>& Colors = InInternalData.LineColors;
|
|
if (ensure(Vertices.Num() == Colors.Num()))
|
|
{
|
|
for (int32 i = 0; i < Vertices.Num(); i += 2)
|
|
{
|
|
AuxLines.Emplace(Vertices[i] + NavMeshDrawOffset, Vertices[i + 1] + NavMeshDrawOffset, Colors[i], 0.0f);
|
|
}
|
|
}
|
|
}
|
|
|
|
if (InInternalData.PointVertices.Num() > 0)
|
|
{
|
|
const TArray<FVector>& Vertices = InInternalData.PointVertices;
|
|
const TArray<FColor>& Colors = InInternalData.PointColors;
|
|
if (ensure(Vertices.Num() == Colors.Num()))
|
|
{
|
|
for (int32 i = 0; i < Vertices.Num(); i++)
|
|
{
|
|
AuxPoints.Emplace(Vertices[i] + NavMeshDrawOffset, Colors[i], 5.0f);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
#endif //RECAST_INTERNAL_DEBUG_DATA
|
|
|
|
#endif
|
|
|
|
//////////////////////////////////////////////////////////////////////////
|
|
// FNavMeshSceneProxy
|
|
|
|
SIZE_T FNavMeshSceneProxy::GetTypeHash() const
|
|
{
|
|
static size_t UniquePointer;
|
|
return reinterpret_cast<size_t>(&UniquePointer);
|
|
}
|
|
|
|
FNavMeshSceneProxy::FNavMeshSceneProxy(const UPrimitiveComponent* InComponent, FNavMeshSceneProxyData* InProxyData, bool ForceToRender)
|
|
: FDebugRenderSceneProxy(InComponent)
|
|
, VertexFactory(GetScene().GetFeatureLevel(), "FNavMeshSceneProxy")
|
|
, bForceRendering(ForceToRender)
|
|
{
|
|
DrawType = EDrawType::SolidAndWireMeshes;
|
|
ViewFlagName = TEXT("Navigation");
|
|
|
|
if (InProxyData)
|
|
{
|
|
ProxyData = *InProxyData;
|
|
Boxes.Append(InProxyData->AuxBoxes);
|
|
}
|
|
|
|
RenderingComponent = MakeWeakObjectPtr(const_cast<UNavMeshRenderingComponent*>(Cast<UNavMeshRenderingComponent>(InComponent)));
|
|
bSkipDistanceCheck = GIsEditor && (GEngine->GetDebugLocalPlayer() == nullptr);
|
|
bUseThickLines = GIsEditor;
|
|
|
|
const int32 NumberOfMeshes = ProxyData.MeshBuilders.Num();
|
|
if (!NumberOfMeshes)
|
|
{
|
|
return;
|
|
}
|
|
|
|
MeshColors.Reserve(NumberOfMeshes + 1); // we add one more proxy after the loop
|
|
MeshBatchElements.Reserve(NumberOfMeshes);
|
|
const FMaterialRenderProxy* ParentMaterial = GEngine->DebugMeshMaterial->GetRenderProxy();
|
|
|
|
TArray<FDynamicMeshVertex> Vertices;
|
|
for (int32 Index = 0; Index < NumberOfMeshes; ++Index)
|
|
{
|
|
const auto& CurrentMeshBuilder = ProxyData.MeshBuilders[Index];
|
|
|
|
FMeshBatchElement Element;
|
|
Element.FirstIndex = IndexBuffer.Indices.Num();
|
|
Element.NumPrimitives = FMath::FloorToInt((float)CurrentMeshBuilder.Indices.Num() / 3);
|
|
Element.MinVertexIndex = Vertices.Num();
|
|
Element.MaxVertexIndex = Element.MinVertexIndex + CurrentMeshBuilder.Vertices.Num() - 1;
|
|
Element.IndexBuffer = &IndexBuffer;
|
|
MeshBatchElements.Add(Element);
|
|
|
|
MeshColors.Add(MakeUnique<FColoredMaterialRenderProxy>(ParentMaterial, CurrentMeshBuilder.ClusterColor));
|
|
|
|
const int32 VertexIndexOffset = Vertices.Num();
|
|
Vertices.Append(CurrentMeshBuilder.Vertices);
|
|
if (VertexIndexOffset == 0)
|
|
{
|
|
IndexBuffer.Indices.Append(CurrentMeshBuilder.Indices);
|
|
}
|
|
else
|
|
{
|
|
IndexBuffer.Indices.Reserve(IndexBuffer.Indices.Num() + CurrentMeshBuilder.Indices.Num());
|
|
for (const auto VertIndex : CurrentMeshBuilder.Indices)
|
|
{
|
|
IndexBuffer.Indices.Add(VertIndex + VertexIndexOffset);
|
|
}
|
|
}
|
|
}
|
|
|
|
MeshColors.Add(MakeUnique<FColoredMaterialRenderProxy>(ParentMaterial, NavMeshRenderColor_PathCollidingGeom));
|
|
|
|
if (Vertices.Num())
|
|
{
|
|
VertexBuffers.InitFromDynamicVertex(&VertexFactory, Vertices);
|
|
}
|
|
if (IndexBuffer.Indices.Num())
|
|
{
|
|
BeginInitResource(&IndexBuffer);
|
|
}
|
|
}
|
|
|
|
FNavMeshSceneProxy::~FNavMeshSceneProxy()
|
|
{
|
|
VertexBuffers.PositionVertexBuffer.ReleaseResource();
|
|
VertexBuffers.StaticMeshVertexBuffer.ReleaseResource();
|
|
VertexBuffers.ColorVertexBuffer.ReleaseResource();
|
|
IndexBuffer.ReleaseResource();
|
|
VertexFactory.ReleaseResource();
|
|
}
|
|
|
|
void FNavMeshSceneProxy::GetDynamicMeshElements(const TArray<const FSceneView*>& Views, const FSceneViewFamily& ViewFamily, uint32 VisibilityMap, FMeshElementCollector& Collector) const
|
|
{
|
|
QUICK_SCOPE_CYCLE_COUNTER(STAT_RecastRenderingSceneProxy_GetDynamicMeshElements);
|
|
|
|
FDebugRenderSceneProxy::GetDynamicMeshElements(Views, ViewFamily, VisibilityMap, Collector);
|
|
|
|
for (int32 ViewIndex = 0; ViewIndex < Views.Num(); ViewIndex++)
|
|
{
|
|
if (VisibilityMap & (1 << ViewIndex))
|
|
{
|
|
const FSceneView* View = Views[ViewIndex];
|
|
const bool bVisible = !!View->Family->EngineShowFlags.Navigation || bForceRendering;
|
|
if (!bVisible)
|
|
{
|
|
continue;
|
|
}
|
|
FPrimitiveDrawInterface* PDI = Collector.GetPDI(ViewIndex);
|
|
|
|
for (int32 Index = 0; Index < ProxyData.OctreeBounds.Num(); ++Index)
|
|
{
|
|
const FBoxCenterAndExtent& ProxyBounds = ProxyData.OctreeBounds[Index];
|
|
FNavMeshRenderingHelpers::DrawDebugBox(PDI, ProxyBounds.Center, ProxyBounds.Extent, FColor::White);
|
|
}
|
|
|
|
// Draw Mesh
|
|
if (MeshBatchElements.Num())
|
|
{
|
|
for (int32 Index = 0; Index < MeshBatchElements.Num(); ++Index)
|
|
{
|
|
if (MeshBatchElements[Index].NumPrimitives == 0)
|
|
{
|
|
continue;
|
|
}
|
|
|
|
FMeshBatch& Mesh = Collector.AllocateMesh();
|
|
FMeshBatchElement& BatchElement = Mesh.Elements[0];
|
|
BatchElement = MeshBatchElements[Index];
|
|
|
|
FDynamicPrimitiveUniformBuffer& DynamicPrimitiveUniformBuffer = Collector.AllocateOneFrameResource<FDynamicPrimitiveUniformBuffer>();
|
|
DynamicPrimitiveUniformBuffer.Set(FMatrix::Identity, FMatrix::Identity, GetBounds(), GetLocalBounds(), false, false, DrawsVelocity(), false);
|
|
BatchElement.PrimitiveUniformBufferResource = &DynamicPrimitiveUniformBuffer.UniformBuffer;
|
|
|
|
Mesh.bWireframe = false;
|
|
Mesh.VertexFactory = &VertexFactory;
|
|
Mesh.MaterialRenderProxy = MeshColors[Index].Get();
|
|
Mesh.ReverseCulling = IsLocalToWorldDeterminantNegative();
|
|
Mesh.Type = PT_TriangleList;
|
|
Mesh.DepthPriorityGroup = SDPG_World;
|
|
Mesh.bCanApplyViewModeOverrides = false;
|
|
Collector.AddMesh(ViewIndex, Mesh);
|
|
}
|
|
}
|
|
|
|
int32 Num = ProxyData.NavMeshEdgeLines.Num();
|
|
PDI->AddReserveLines(SDPG_World, Num, false, false);
|
|
PDI->AddReserveLines(SDPG_Foreground, Num, false, true);
|
|
for (int32 Index = 0; Index < Num; ++Index)
|
|
{
|
|
const FDebugLine &Line = ProxyData.NavMeshEdgeLines[Index];
|
|
if (FNavMeshRenderingHelpers::LineInView(Line.Start, Line.End, View))
|
|
{
|
|
if (FNavMeshRenderingHelpers::LineInCorrectDistance(Line.Start, Line.End, View))
|
|
{
|
|
PDI->DrawLine(Line.Start, Line.End, Line.Color, SDPG_World, NavMeshEdges_LineThickness, 0, true);
|
|
}
|
|
else if (bUseThickLines)
|
|
{
|
|
PDI->DrawLine(Line.Start, Line.End, Line.Color, SDPG_Foreground, DefaultEdges_LineThickness, 0, true);
|
|
}
|
|
}
|
|
}
|
|
|
|
Num = ProxyData.ClusterLinkLines.Num();
|
|
PDI->AddReserveLines(SDPG_World, Num, false, false);
|
|
PDI->AddReserveLines(SDPG_Foreground, Num, false, true);
|
|
for (int32 Index = 0; Index < Num; ++Index)
|
|
{
|
|
const FDebugLine &Line = ProxyData.ClusterLinkLines[Index];
|
|
if (FNavMeshRenderingHelpers::LineInView(Line.Start, Line.End, View))
|
|
{
|
|
if (FNavMeshRenderingHelpers::LineInCorrectDistance(Line.Start, Line.End, View))
|
|
{
|
|
PDI->DrawLine(Line.Start, Line.End, Line.Color, SDPG_World, ClusterLinkLines_LineThickness, 0, true);
|
|
}
|
|
else if (bUseThickLines)
|
|
{
|
|
PDI->DrawLine(Line.Start, Line.End, Line.Color, SDPG_Foreground, DefaultEdges_LineThickness, 0, true);
|
|
}
|
|
}
|
|
}
|
|
|
|
Num = ProxyData.TileEdgeLines.Num();
|
|
PDI->AddReserveLines(SDPG_World, Num, false, false);
|
|
PDI->AddReserveLines(SDPG_Foreground, Num, false, true);
|
|
for (int32 Index = 0; Index < Num; ++Index)
|
|
{
|
|
const FDebugLine &Line = ProxyData.TileEdgeLines[Index];
|
|
if (FNavMeshRenderingHelpers::LineInView(Line.Start, Line.End, View))
|
|
{
|
|
if (FNavMeshRenderingHelpers::LineInCorrectDistance(Line.Start, Line.End, View))
|
|
{
|
|
PDI->DrawLine(Line.Start, Line.End, Line.Color, SDPG_World, PolyEdges_LineThickness, 0, true);
|
|
}
|
|
else if (bUseThickLines)
|
|
{
|
|
PDI->DrawLine(Line.Start, Line.End, Line.Color, SDPG_Foreground, DefaultEdges_LineThickness, 0, true);
|
|
}
|
|
}
|
|
}
|
|
|
|
Num = ProxyData.NavLinkLines.Num();
|
|
PDI->AddReserveLines(SDPG_World, Num, false, false);
|
|
PDI->AddReserveLines(SDPG_Foreground, Num, false, true);
|
|
for (int32 Index = 0; Index < Num; ++Index)
|
|
{
|
|
const FDebugLine &Line = ProxyData.NavLinkLines[Index];
|
|
if (FNavMeshRenderingHelpers::LineInView(Line.Start, Line.End, View))
|
|
{
|
|
if (FNavMeshRenderingHelpers::LineInCorrectDistance(Line.Start, Line.End, View))
|
|
{
|
|
PDI->DrawLine(Line.Start, Line.End, Line.Color, SDPG_World, LinkLines_LineThickness, 0, true);
|
|
}
|
|
else if (bUseThickLines)
|
|
{
|
|
PDI->DrawLine(Line.Start, Line.End, Line.Color, SDPG_Foreground, DefaultEdges_LineThickness, 0, true);
|
|
}
|
|
}
|
|
}
|
|
|
|
Num = ProxyData.AuxLines.Num();
|
|
PDI->AddReserveLines(SDPG_World, Num, false, false);
|
|
PDI->AddReserveLines(SDPG_Foreground, Num, false, true);
|
|
for (int32 Index = 0; Index < Num; ++Index)
|
|
{
|
|
const auto& Line = ProxyData.AuxLines[Index];
|
|
if (FNavMeshRenderingHelpers::LineInView(Line.Start, Line.End, View))
|
|
{
|
|
PDI->DrawLine(Line.Start, Line.End, Line.Color, SDPG_World, Line.Thickness, 0, true);
|
|
}
|
|
}
|
|
|
|
Num = ProxyData.AuxPoints.Num();
|
|
for (int32 Index = 0; Index < Num; ++Index)
|
|
{
|
|
const auto& Point = ProxyData.AuxPoints[Index];
|
|
if (FNavMeshRenderingHelpers::PointInView(Point.Position, View))
|
|
{
|
|
PDI->DrawPoint(Point.Position, Point.Color, Point.Size, SDPG_World);
|
|
}
|
|
}
|
|
|
|
Num = ProxyData.ThickLineItems.Num();
|
|
PDI->AddReserveLines(SDPG_Foreground, Num, false, true);
|
|
for (int32 Index = 0; Index < Num; ++Index)
|
|
{
|
|
const auto &Line = ProxyData.ThickLineItems[Index];
|
|
if (FNavMeshRenderingHelpers::LineInView(Line.Start, Line.End, View))
|
|
{
|
|
if (FNavMeshRenderingHelpers::LineInCorrectDistance(Line.Start, Line.End, View))
|
|
{
|
|
PDI->DrawLine(Line.Start, Line.End, Line.Color, SDPG_World, Line.Thickness, 0, true);
|
|
}
|
|
else if (bUseThickLines)
|
|
{
|
|
PDI->DrawLine(Line.Start, Line.End, Line.Color, SDPG_Foreground, DefaultEdges_LineThickness, 0, true);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
#if WITH_RECAST && UE_ENABLE_DEBUG_DRAWING
|
|
void FNavMeshDebugDrawDelegateHelper::DrawDebugLabels(UCanvas* Canvas, APlayerController*)
|
|
{
|
|
if (!Canvas)
|
|
{
|
|
return;
|
|
}
|
|
|
|
const bool bVisible = (Canvas->SceneView && !!Canvas->SceneView->Family->EngineShowFlags.Navigation) || bForceRendering;
|
|
if (!bVisible || bNeedsNewData || DebugLabels.Num() == 0)
|
|
{
|
|
return;
|
|
}
|
|
|
|
const FColor OldDrawColor = Canvas->DrawColor;
|
|
Canvas->SetDrawColor(FColor::White);
|
|
const FSceneView* View = Canvas->SceneView;
|
|
const UFont* Font = GEngine->GetSmallFont();
|
|
const FNavMeshSceneProxyData::FDebugText* DebugText = DebugLabels.GetData();
|
|
for (int32 Idx = 0; Idx < DebugLabels.Num(); ++Idx, ++DebugText)
|
|
{
|
|
if (View->ViewFrustum.IntersectSphere(DebugText->Location, 1.0f))
|
|
{
|
|
const FVector ScreenLoc = Canvas->Project(DebugText->Location);
|
|
Canvas->DrawText(Font, DebugText->Text, ScreenLoc.X, ScreenLoc.Y);
|
|
}
|
|
}
|
|
|
|
Canvas->SetDrawColor(OldDrawColor);
|
|
}
|
|
#endif
|
|
|
|
FPrimitiveViewRelevance FNavMeshSceneProxy::GetViewRelevance(const FSceneView* View) const
|
|
{
|
|
const bool bVisible = !!View->Family->EngineShowFlags.Navigation || bForceRendering;
|
|
FPrimitiveViewRelevance Result;
|
|
Result.bDrawRelevance = bVisible && IsShown(View);
|
|
Result.bDynamicRelevance = true;
|
|
// ideally the TranslucencyRelevance should be filled out by the material, here we do it conservative
|
|
Result.bSeparateTranslucency = Result.bNormalTranslucency = bVisible && IsShown(View);
|
|
return Result;
|
|
}
|
|
|
|
uint32 FNavMeshSceneProxy::GetAllocatedSizeInternal() const
|
|
{
|
|
return FDebugRenderSceneProxy::GetAllocatedSize() +
|
|
ProxyData.GetAllocatedSize() +
|
|
IndexBuffer.Indices.GetAllocatedSize() +
|
|
VertexBuffers.PositionVertexBuffer.GetNumVertices() * VertexBuffers.PositionVertexBuffer.GetStride() +
|
|
VertexBuffers.StaticMeshVertexBuffer.GetResourceSize() +
|
|
VertexBuffers.ColorVertexBuffer.GetNumVertices() * VertexBuffers.ColorVertexBuffer.GetStride() +
|
|
MeshColors.GetAllocatedSize() + MeshColors.Num() * sizeof(FColoredMaterialRenderProxy) +
|
|
MeshBatchElements.GetAllocatedSize();
|
|
}
|
|
|
|
//////////////////////////////////////////////////////////////////////////
|
|
// NavMeshRenderingComponent
|
|
|
|
#if WITH_EDITOR
|
|
namespace
|
|
{
|
|
bool AreAnyViewportsRelevant(const UWorld* World)
|
|
{
|
|
FWorldContext* WorldContext = GEngine->GetWorldContextFromWorld(World);
|
|
if (WorldContext && WorldContext->GameViewport)
|
|
{
|
|
return true;
|
|
}
|
|
|
|
for (FEditorViewportClient* CurrentViewport : GEditor->GetAllViewportClients())
|
|
{
|
|
if (CurrentViewport && CurrentViewport->IsVisible())
|
|
{
|
|
return true;
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
UNavMeshRenderingComponent::UNavMeshRenderingComponent(const FObjectInitializer& ObjectInitializer)
|
|
: Super(ObjectInitializer)
|
|
{
|
|
SetCollisionProfileName(UCollisionProfile::NoCollision_ProfileName);
|
|
bIsEditorOnly = true;
|
|
bSelectable = false;
|
|
bCollectNavigationData = false;
|
|
bForceUpdate = false;
|
|
}
|
|
|
|
bool UNavMeshRenderingComponent::IsNavigationShowFlagSet(const UWorld* World)
|
|
{
|
|
bool bShowNavigation = false;
|
|
|
|
FWorldContext* WorldContext = GEngine->GetWorldContextFromWorld(World);
|
|
|
|
#if WITH_EDITOR
|
|
if (GEditor && WorldContext && WorldContext->WorldType != EWorldType::Game)
|
|
{
|
|
bShowNavigation = WorldContext->GameViewport != nullptr && WorldContext->GameViewport->EngineShowFlags.Navigation;
|
|
if (bShowNavigation == false)
|
|
{
|
|
// we have to check all viewports because we can't to distinguish between SIE and PIE at this point.
|
|
for (FEditorViewportClient* CurrentViewport : GEditor->GetAllViewportClients())
|
|
{
|
|
if (CurrentViewport && CurrentViewport->EngineShowFlags.Navigation)
|
|
{
|
|
bShowNavigation = true;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
#endif //WITH_EDITOR
|
|
{
|
|
bShowNavigation = WorldContext && WorldContext->GameViewport && WorldContext->GameViewport->EngineShowFlags.Navigation;
|
|
}
|
|
|
|
return bShowNavigation;
|
|
}
|
|
|
|
void UNavMeshRenderingComponent::TimerFunction()
|
|
{
|
|
const UWorld* World = GetWorld();
|
|
#if WITH_EDITOR
|
|
if (GEditor && (AreAnyViewportsRelevant(World) == false))
|
|
{
|
|
// unable to tell if the flag is on or not
|
|
return;
|
|
}
|
|
#endif // WITH_EDITOR
|
|
|
|
const bool bShowNavigation = bForceUpdate || IsNavigationShowFlagSet(World);
|
|
|
|
if (bShowNavigation != !!bCollectNavigationData && bShowNavigation == true)
|
|
{
|
|
bForceUpdate = false;
|
|
bCollectNavigationData = bShowNavigation;
|
|
MarkRenderStateDirty();
|
|
}
|
|
}
|
|
|
|
void UNavMeshRenderingComponent::OnRegister()
|
|
{
|
|
Super::OnRegister();
|
|
|
|
#if WITH_RECAST && UE_ENABLE_DEBUG_DRAWING
|
|
// it's a kind of HACK but there is no event or other information that show flag was changed by user => we have to check it periodically
|
|
#if WITH_EDITOR
|
|
if (GEditor)
|
|
{
|
|
GEditor->GetTimerManager()->SetTimer(TimerHandle, FTimerDelegate::CreateUObject(this, &UNavMeshRenderingComponent::TimerFunction), 1, true);
|
|
}
|
|
else
|
|
#endif //WITH_EDITOR
|
|
{
|
|
GetWorld()->GetTimerManager().SetTimer(TimerHandle, FTimerDelegate::CreateUObject(this, &UNavMeshRenderingComponent::TimerFunction), 1, true);
|
|
}
|
|
#endif //WITH_RECAST && UE_ENABLE_DEBUG_DRAWING
|
|
}
|
|
|
|
void UNavMeshRenderingComponent::OnUnregister()
|
|
{
|
|
#if WITH_RECAST && UE_ENABLE_DEBUG_DRAWING
|
|
// it's a kind of HACK but there is no event or other information that show flag was changed by user => we have to check it periodically
|
|
#if WITH_EDITOR
|
|
if (GEditor)
|
|
{
|
|
GEditor->GetTimerManager()->ClearTimer(TimerHandle);
|
|
}
|
|
else
|
|
#endif //WITH_EDITOR
|
|
{
|
|
GetWorld()->GetTimerManager().ClearTimer(TimerHandle);
|
|
}
|
|
#endif //WITH_RECAST && UE_ENABLE_DEBUG_DRAWING
|
|
Super::OnUnregister();
|
|
}
|
|
|
|
void UNavMeshRenderingComponent::GatherData(const ARecastNavMesh& NavMesh, FNavMeshSceneProxyData& OutProxyData) const
|
|
{
|
|
const int32 DetailFlags = FNavMeshRenderingHelpers::GetDetailFlags(&NavMesh);
|
|
const TArray<int32> EmptyTileSet;
|
|
OutProxyData.GatherData(&NavMesh, DetailFlags, EmptyTileSet);
|
|
}
|
|
|
|
#if UE_ENABLE_DEBUG_DRAWING
|
|
FDebugRenderSceneProxy* UNavMeshRenderingComponent::CreateDebugSceneProxy()
|
|
{
|
|
#if WITH_RECAST
|
|
FNavMeshSceneProxy* NavMeshSceneProxy = nullptr;
|
|
|
|
const bool bShowNavigation = IsNavigationShowFlagSet(GetWorld());
|
|
|
|
bCollectNavigationData = bShowNavigation;
|
|
|
|
if (bCollectNavigationData && IsVisible())
|
|
{
|
|
const ARecastNavMesh* NavMesh = Cast<ARecastNavMesh>(GetOwner());
|
|
if (NavMesh && NavMesh->IsDrawingEnabled())
|
|
{
|
|
FNavMeshSceneProxyData ProxyData;
|
|
GatherData(*NavMesh, ProxyData);
|
|
|
|
NavMeshSceneProxy = new FNavMeshSceneProxy(this, &ProxyData);
|
|
NavMeshDebugDrawDelegateManager.SetupFromProxy(NavMeshSceneProxy);
|
|
}
|
|
}
|
|
|
|
return NavMeshSceneProxy;
|
|
#else
|
|
return nullptr;
|
|
#endif // WITH_RECAST
|
|
}
|
|
#endif
|
|
|
|
FBoxSphereBounds UNavMeshRenderingComponent::CalcBounds(const FTransform& LocalToWorld) const
|
|
{
|
|
FBox BoundingBox(ForceInit);
|
|
#if WITH_RECAST
|
|
ARecastNavMesh* NavMesh = Cast<ARecastNavMesh>(GetOwner());
|
|
if (NavMesh)
|
|
{
|
|
BoundingBox = NavMesh->GetNavMeshBounds();
|
|
if (NavMesh->bDrawOctree)
|
|
{
|
|
const UNavigationSystemV1* NavSys = FNavigationSystem::GetCurrent<UNavigationSystemV1>(GetWorld());
|
|
const FNavigationOctree* NavOctree = NavSys ? NavSys->GetNavOctree() : nullptr;
|
|
if (NavOctree)
|
|
{
|
|
//this is only iterating over the root node
|
|
BoundingBox += NavOctree->GetRootBounds().GetBox();
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
return FBoxSphereBounds(BoundingBox);
|
|
}
|