118 lines
2.9 KiB
C++
Executable File
118 lines
2.9 KiB
C++
Executable File
//-----------------------------------------------------------------------------
|
|
// Torque Game Engine
|
|
// Copyright (C) GarageGames.com, Inc.
|
|
//-----------------------------------------------------------------------------
|
|
|
|
#include "platform/platform.h"
|
|
#include "dgl/dgl.h"
|
|
#include "math/mMath.h"
|
|
#include "console/console.h"
|
|
#include "collision/planeExtractor.h"
|
|
|
|
//----------------------------------------------------------------------------
|
|
// Plane matching parameters
|
|
static F32 NormalEpsilon = 0.93969; // 20 deg.
|
|
static F32 DistanceEpsilon = 100;
|
|
|
|
|
|
//----------------------------------------------------------------------------
|
|
|
|
PlaneExtractorPolyList::PlaneExtractorPolyList()
|
|
{
|
|
VECTOR_SET_ASSOCIATION(mVertexList);
|
|
VECTOR_SET_ASSOCIATION(mPolyPlaneList);
|
|
}
|
|
|
|
PlaneExtractorPolyList::~PlaneExtractorPolyList()
|
|
{
|
|
}
|
|
|
|
|
|
//----------------------------------------------------------------------------
|
|
|
|
void PlaneExtractorPolyList::clear()
|
|
{
|
|
mVertexList.clear();
|
|
mPolyPlaneList.clear();
|
|
}
|
|
|
|
U32 PlaneExtractorPolyList::addPoint(const Point3F& p)
|
|
{
|
|
mVertexList.increment();
|
|
Point3F& v = mVertexList.last();
|
|
v.x = p.x * mScale.x;
|
|
v.y = p.y * mScale.y;
|
|
v.z = p.z * mScale.z;
|
|
mMatrix.mulP(v);
|
|
return mVertexList.size() - 1;
|
|
}
|
|
|
|
U32 PlaneExtractorPolyList::addPlane(const PlaneF& plane)
|
|
{
|
|
mPolyPlaneList.increment();
|
|
mPlaneTransformer.transform(plane, mPolyPlaneList.last());
|
|
|
|
return mPolyPlaneList.size() - 1;
|
|
}
|
|
|
|
|
|
//----------------------------------------------------------------------------
|
|
|
|
void PlaneExtractorPolyList::plane(U32 v1,U32 v2,U32 v3)
|
|
{
|
|
mPlaneList->last().set(mVertexList[v1],
|
|
mVertexList[v2],mVertexList[v3]);
|
|
}
|
|
|
|
void PlaneExtractorPolyList::plane(const PlaneF& p)
|
|
{
|
|
mPlaneTransformer.transform(p, mPlaneList->last());
|
|
}
|
|
|
|
void PlaneExtractorPolyList::plane(const U32 index)
|
|
{
|
|
AssertFatal(index < mPolyPlaneList.size(), "Out of bounds index!");
|
|
mPlaneList->last() = mPolyPlaneList[index];
|
|
}
|
|
|
|
const PlaneF& PlaneExtractorPolyList::getIndexedPlane(const U32 index)
|
|
{
|
|
AssertFatal(index < mPolyPlaneList.size(), "Out of bounds index!");
|
|
return mPolyPlaneList[index];
|
|
}
|
|
|
|
|
|
//----------------------------------------------------------------------------
|
|
|
|
bool PlaneExtractorPolyList::isEmpty() const
|
|
{
|
|
return true;
|
|
}
|
|
|
|
void PlaneExtractorPolyList::begin(U32,U32)
|
|
{
|
|
mPlaneList->increment();
|
|
}
|
|
|
|
void PlaneExtractorPolyList::end()
|
|
{
|
|
// See if there are any duplicate planes
|
|
PlaneF &plane = mPlaneList->last();
|
|
PlaneF *ptr = mPlaneList->begin();
|
|
for (; ptr != &plane; ptr++)
|
|
if (mFabs(ptr->d - plane.d) < DistanceEpsilon &&
|
|
mDot(*ptr,plane) > NormalEpsilon) {
|
|
mPlaneList->decrement();
|
|
return;
|
|
}
|
|
}
|
|
|
|
void PlaneExtractorPolyList::vertex(U32)
|
|
{
|
|
}
|
|
|
|
void PlaneExtractorPolyList::render()
|
|
{
|
|
}
|
|
|