GoaLitiuM/FlaxEngine
1
0
Fork 0
Code Issues Pull Requests Actions 7 Packages Projects Releases Wiki Activity

Add Terrain physics collision debug drawing support

Browse Source
This commit is contained in:
Wojtek Figat
2021-07-14 14:51:20 +02:00
parent 04c6ecc963
commit 42f05a5072
4 changed files with 72 additions and 63 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
Source/Engine/Terrain/Terrain.cpp
View File

@@ -261,10 +261,10 @@ void Terrain::OnPhysicalMaterialChanged()
void Terrain::DrawPhysicsDebug(RenderView& view)
{
for (int32 pathIndex = 0; pathIndex < _patches.Count(); pathIndex++)
{
_patches[pathIndex]->DrawPhysicsDebug(view);
}
for (int32 pathIndex = 0; pathIndex < _patches.Count(); pathIndex++)
{
_patches[pathIndex]->DrawPhysicsDebug(view);
}
}
#endif
@@ -756,7 +756,7 @@ void Terrain::OnEnable()
{
_sceneRenderingKey = GetSceneRendering()->AddGeometry(this);
#if TERRAIN_USE_PHYSICS_DEBUG
GetSceneRendering()->AddPhysicsDebug<Terrain, &Terrain::DrawPhysicsDebug>(this);
GetSceneRendering()->AddPhysicsDebug<Terrain, &Terrain::DrawPhysicsDebug>(this);
#endif
// Base
@@ -767,7 +767,7 @@ void Terrain::OnDisable()
{
GetSceneRendering()->RemoveGeometry(this, _sceneRenderingKey);
#if TERRAIN_USE_PHYSICS_DEBUG
GetSceneRendering()->RemovePhysicsDebug<Terrain, &Terrain::DrawPhysicsDebug>(this);
GetSceneRendering()->RemovePhysicsDebug<Terrain, &Terrain::DrawPhysicsDebug>(this);
#endif
// Base

2
Source/Engine/Terrain/Terrain.h
View File

@@ -29,7 +29,7 @@ struct RenderView;
#define USE_PRECISE_TERRAIN_INTERSECTS (USE_EDITOR)
// Enable/disable terrain physics collision drawing
#define TERRAIN_USE_PHYSICS_DEBUG (USE_EDITOR && 0)
#define TERRAIN_USE_PHYSICS_DEBUG (USE_EDITOR && 1)
// Terrain splatmaps amount limit. Each splatmap can hold up to 4 layer weights.
#define TERRAIN_MAX_SPLATMAPS_COUNT 2

117
Source/Engine/Terrain/TerrainPatch.cpp
View File

@@ -83,7 +83,7 @@ void TerrainPatch::Init(Terrain* terrain, int16 x, int16 z)
}
#endif
#if TERRAIN_USE_PHYSICS_DEBUG
_debugLines.Resize(0);
_debugLines.Resize(0);
#endif
#if USE_EDITOR
_collisionTriangles.Resize(0);
@@ -1817,7 +1817,7 @@ bool TerrainPatch::UpdateHeightData(const TerrainDataUpdateInfo& info, const Int
// Invalidate cache
#if TERRAIN_USE_PHYSICS_DEBUG
_debugLines.Resize(0);
_debugLines.Resize(0);
#endif
#if USE_EDITOR
_collisionTriangles.Resize(0);
@@ -1948,7 +1948,7 @@ bool TerrainPatch::UpdateCollision()
{
// Invalidate cache
#if TERRAIN_USE_PHYSICS_DEBUG
_debugLines.Resize(0);
_debugLines.Resize(0);
#endif
#if USE_EDITOR
_collisionTriangles.Resize(0);
@@ -2120,7 +2120,7 @@ void TerrainPatch::UpdatePostManualDeserialization()
{
// Invalidate cache
#if TERRAIN_USE_PHYSICS_DEBUG
_debugLines.Resize(0);
_debugLines.Resize(0);
#endif
#if USE_EDITOR
_collisionTriangles.Resize(0);
@@ -2250,7 +2250,7 @@ void TerrainPatch::DestroyCollision()
_physicsShape = nullptr;
_physicsHeightField = nullptr;
#if TERRAIN_USE_PHYSICS_DEBUG
_debugLines.Resize(0);
_debugLines.Resize(0);
#endif
#if USE_EDITOR
_collisionTriangles.Resize(0);
@@ -2262,74 +2262,83 @@ void TerrainPatch::DestroyCollision()
void TerrainPatch::CacheDebugLines()
{
ASSERT(_debugLines.IsEmpty() && _physicsHeightField);
ASSERT(_debugLines.IsEmpty() && _physicsHeightField);
const uint32 rows = _physicsHeightField->getNbRows();
const uint32 cols = _physicsHeightField->getNbColumns();
const uint32 rows = _physicsHeightField->getNbRows();
const uint32 cols = _physicsHeightField->getNbColumns();
_debugLines.Resize((rows - 1) * (cols - 1) * 6 + (cols + rows - 2) * 2);
Vector3* data = _debugLines.Get();
_debugLines.Resize((rows - 1) * (cols - 1) * 6 + (cols + rows - 2) * 2);
Vector3* data = _debugLines.Get();
#define GET_VERTEX(x, y) const Vector3 v##x##y(row + (x), _physicsHeightField->getHeight((PxReal)(row + (x)), (PxReal)(col + (y))) / TERRAIN_PATCH_COLLISION_QUANTIZATION, col + (y))
#define GET_VERTEX(x, y) const Vector3 v##x##y((float)(row + (x)), _physicsHeightField->getHeight((PxReal)(row + (x)), (PxReal)(col + (y))) / TERRAIN_PATCH_COLLISION_QUANTIZATION, (float)(col + (y)))
for (uint32 row = 0; row < rows - 1; row++)
{
for (uint32 col = 0; col < cols - 1; col++)
{
GET_VERTEX(0, 0);
GET_VERTEX(0, 1);
GET_VERTEX(1, 0);
GET_VERTEX(1, 1);
for (uint32 row = 0; row < rows - 1; row++)
{
for (uint32 col = 0; col < cols - 1; col++)
{
GET_VERTEX(0, 0);
GET_VERTEX(0, 1);
GET_VERTEX(1, 0);
GET_VERTEX(1, 1);
*data++ = v00;
*data++ = v01;
*data++ = v00;
*data++ = v01;
*data++ = v00;
*data++ = v10;
*data++ = v00;
*data++ = v10;
*data++ = v00;
*data++ = v11;
}
}
*data++ = v00;
*data++ = v11;
}
}
for (uint32 row = 0; row < rows - 1; row++)
{
const uint32 col = cols - 1;
for (uint32 row = 0; row < rows - 1; row++)
{
const uint32 col = cols - 1;
GET_VERTEX(0, 0);
GET_VERTEX(1, 0);
GET_VERTEX(0, 0);
GET_VERTEX(1, 0);
*data++ = v00;
*data++ = v10;
}
*data++ = v00;
*data++ = v10;
}
for (uint32 col = 0; col < cols - 1; col++)
{
const uint32 row = rows - 1;
GET_VERTEX(0, 0);
GET_VERTEX(0, 1);
for (uint32 col = 0; col < cols - 1; col++)
{
const uint32 row = rows - 1;
GET_VERTEX(0, 0);
GET_VERTEX(0, 1);
*data++ = v00;
*data++ = v01;
}
*data++ = v00;
*data++ = v01;
}
#undef GET_VERTEX
}
void TerrainPatch::DrawPhysicsDebug(RenderView& view)
{
if (!_physicsShape)
return;
if (!_physicsShape || !view.CullingFrustum.Intersects(_bounds))
return;
if (_debugLines.IsEmpty())
CacheDebugLines();
const Transform terrainTransform = _terrain->_transform;
const Transform localTransform(Vector3(0, _yOffset, 0), Quaternion::Identity, Vector3(_collisionScaleXZ, _yHeight, _collisionScaleXZ));
const Matrix world = localTransform.GetWorld() * terrainTransform.GetWorld();
const Transform terrainTransform = _terrain->_transform;
Transform localTransform(Vector3(0, _yOffset, 0), Quaternion::Identity, Vector3(_collisionScaleXZ, _yHeight, _collisionScaleXZ));
const Matrix world = localTransform.GetWorld() * terrainTransform.GetWorld();
DebugDraw::DrawLines(_debugLines.Get(), _debugLines.Count() / 2, world, Color::GreenYellow * 0.8f, 0, false);
if (view.Mode == ViewMode::PhysicsColliders)
{
DebugDraw::DrawTriangles(GetCollisionTriangles(), Color::DarkOliveGreen, 0, true);
}
else
{
BoundingSphere sphere;
BoundingSphere::FromBox(_bounds, sphere);
if (Vector3::Distance(sphere.Center, view.Position) - sphere.Radius < 4000.0f)
{
if (_debugLines.IsEmpty())
CacheDebugLines();
DebugDraw::DrawLines(_debugLines, world, Color::GreenYellow * 0.8f, 0, true);
}
}
}
#endif

4
Source/Engine/Terrain/TerrainPatch.h
View File

@@ -349,14 +349,14 @@ public:
/// <summary>
/// Gets the collision mesh triangles array (3 vertices per triangle in linear list). Cached internally to reuse data.
/// </summary>
/// <returns>The collision triangles vertices list.</returns>
/// <returns>The collision triangles vertices list (in world-space).</returns>
const Array<Vector3>& GetCollisionTriangles();
/// <summary>
/// Gets the collision mesh triangles array (3 vertices per triangle in linear list) that intersect with the given bounds.
/// </summary>
/// <param name="bounds">The world-space bounds to find terrain triangles that intersect with it.</param>
/// <param name="result">The result triangles that intersect with the given bounds.</param>
/// <param name="result">The result triangles that intersect with the given bounds (in world-space).</param>
void GetCollisionTriangles(const BoundingSphere& bounds, Array<Vector3>& result);
#endif