mirror of https://github.com/PrimeDecomp/prime.git
Actually add CMetroidAreaColliderg
This commit is contained in:
parent
71ff684be4
commit
f535084540
|
|
@ -0,0 +1,194 @@
|
|||
#include "WorldFormat/CMetroidAreaCollider.hpp"
|
||||
|
||||
#include "Collision/CollisionUtil.hpp"
|
||||
|
||||
#include <string.h>
|
||||
|
||||
static uint gCalledClip = 0;
|
||||
static uint gRejectedByClip = 0;
|
||||
static uint gTrianglesProcessed = 0;
|
||||
static uint gDupTrianglesProcessed = 0;
|
||||
ushort CMetroidAreaCollider::sDupPrimitiveCheckCount = 0;
|
||||
ushort CMetroidAreaCollider::sDupVertexList[0x2800];
|
||||
ushort CMetroidAreaCollider::sDupEdgeList[0x6000];
|
||||
ushort CMetroidAreaCollider::sDupTriangleList[0x4000];
|
||||
|
||||
static inline CVector3f ClipRayToPlane(const CVector3f& a, const CVector3f& b,
|
||||
const CPlane& plane) {
|
||||
float f = -plane.GetHeight(a) / CVector3f::Dot(b - a, plane.GetNormal());
|
||||
return (a - b) * (1.f - f);
|
||||
}
|
||||
|
||||
bool CMetroidAreaCollider::ConvexPolyCollision(const CPlane* planes, const CVector3f* verts,
|
||||
CAABox& aabb) {
|
||||
typedef rstl::reserved_vector< CVector3f, 20 > ClipVec;
|
||||
++gCalledClip;
|
||||
++gRejectedByClip;
|
||||
|
||||
ClipVec vecs[2];
|
||||
int vecIdx = 0;
|
||||
int otherVecIdx = 1;
|
||||
|
||||
vecs[0].push_back(verts[0]);
|
||||
vecs[0].push_back(verts[1]);
|
||||
vecs[0].push_back(verts[2]);
|
||||
|
||||
for (int i = 0; i < 6; ++i) {
|
||||
ClipVec& vec = vecs[vecIdx];
|
||||
ClipVec& otherVec = vecs[otherVecIdx];
|
||||
otherVec.clear();
|
||||
|
||||
bool inFrontOf = planes[i].GetHeight(vec.front()) >= 0.f;
|
||||
for (int j = 0; j < vec.size(); ++j) {
|
||||
const CVector3f& b = vec[j == vec.size() - 1 ? 0 : j + 1];
|
||||
if (inFrontOf) {
|
||||
otherVec.push_back(vec[j]);
|
||||
}
|
||||
bool nextInFrontOf = planes[i].GetHeight(b) >= 0.f;
|
||||
if (nextInFrontOf ^ inFrontOf) {
|
||||
otherVec.push_back(ClipRayToPlane(vec[j], b, planes[i]) + b);
|
||||
}
|
||||
inFrontOf = nextInFrontOf;
|
||||
}
|
||||
|
||||
if (otherVec.empty()) {
|
||||
return false;
|
||||
}
|
||||
|
||||
otherVecIdx ^= 1;
|
||||
vecIdx ^= 1;
|
||||
}
|
||||
|
||||
ClipVec& accumVec = vecs[otherVecIdx ^ 1];
|
||||
for (ClipVec::const_iterator it = accumVec.begin(); it != accumVec.end(); ++it) {
|
||||
aabb.AccumulateBounds(*it);
|
||||
}
|
||||
|
||||
--gRejectedByClip;
|
||||
return true;
|
||||
}
|
||||
|
||||
void CMetroidAreaCollider::ResetInternalCounters() {
|
||||
gCalledClip = 0;
|
||||
gRejectedByClip = 0;
|
||||
gTrianglesProcessed = 0;
|
||||
gDupTrianglesProcessed = 0;
|
||||
if (sDupPrimitiveCheckCount == 0xffff) {
|
||||
memset(sDupVertexList, 0, sizeof(sDupVertexList));
|
||||
memset(sDupEdgeList, 0, sizeof(sDupEdgeList));
|
||||
memset(sDupTriangleList, 0, sizeof(sDupTriangleList));
|
||||
++sDupPrimitiveCheckCount;
|
||||
}
|
||||
++sDupPrimitiveCheckCount;
|
||||
}
|
||||
|
||||
bool CMetroidAreaCollider::AABoxCollisionCheck_Internal(const CAreaOctTree::Node& node,
|
||||
CAABoxAreaCache& cache) {
|
||||
bool ret = false;
|
||||
|
||||
switch (node.GetTreeType()) {
|
||||
case CAreaOctTree::Node::kTT_Invalid:
|
||||
return false;
|
||||
case CAreaOctTree::Node::kTT_Branch: {
|
||||
for (int i = 0; i < 8; ++i) {
|
||||
CAreaOctTree::Node ch = node.GetChild(i);
|
||||
CAABox box = ch.GetBoundingBox();
|
||||
if (box.DoBoundsOverlap(cache.x0_aabb))
|
||||
if (AABoxCollisionCheck_Internal(ch, cache))
|
||||
ret = true;
|
||||
}
|
||||
break;
|
||||
}
|
||||
case CAreaOctTree::Node::kTT_Leaf: {
|
||||
CAreaOctTree::TriListReference list = node.GetTriangleArray();
|
||||
const CAreaOctTree& owner = node.GetOwner();
|
||||
const CMaterialFilter& filter = cache.x8_filter;
|
||||
const CPlane* planes = cache.x4_planes;
|
||||
for (int j = 0; j < list.GetSize(); ++j) {
|
||||
++gTrianglesProcessed;
|
||||
ushort triIdx = list.GetAt(j);
|
||||
if (sDupPrimitiveCheckCount == sDupTriangleList[triIdx]) {
|
||||
++gDupTrianglesProcessed;
|
||||
} else {
|
||||
sDupTriangleList[triIdx] = sDupPrimitiveCheckCount;
|
||||
const CCollisionSurface& surf = owner.GetMasterListTriangle(triIdx);
|
||||
CMaterialList material(surf.GetSurfaceFlags());
|
||||
if (filter.Passes(material)) {
|
||||
if (CollisionUtil::TriBoxOverlap(cache.x14_center, cache.x20_halfExtent, surf.GetVert(0),
|
||||
surf.GetVert(1), surf.GetVert(2)) == true) {
|
||||
CAABox aabb = CAABox::MakeMaxInvertedBox();
|
||||
if (ConvexPolyCollision(planes, &surf.GetVert(0), aabb)) {
|
||||
CPlane plane = surf.GetPlane();
|
||||
CCollisionInfo collision(aabb, cache.xc_material, material, plane.GetNormal(),
|
||||
-plane.GetNormal());
|
||||
cache.x10_collisionList.Add(collision, false);
|
||||
ret = true;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
bool CMetroidAreaCollider::AABoxCollisionCheck_Cached(const COctreeLeafCache& leafCache,
|
||||
const CAABox& aabb,
|
||||
const CMaterialFilter& filter,
|
||||
const CMaterialList& matList,
|
||||
CCollisionInfoList& list) {
|
||||
bool ret = false;
|
||||
const CUnitVector3f right(1.f, 0.f, 0.f, CUnitVector3f::kN_No);
|
||||
const CUnitVector3f forward(0.f, 1.f, 0.f, CUnitVector3f::kN_No);
|
||||
const CUnitVector3f up(0.f, 0.f, 1.f, CUnitVector3f::kN_No);
|
||||
const CPlane planes[6] = {
|
||||
CPlane(aabb.GetMinPoint(), right),
|
||||
CPlane(aabb.GetMaxPoint(), -right),
|
||||
CPlane(aabb.GetMinPoint(), forward),
|
||||
CPlane(aabb.GetMaxPoint(), -forward),
|
||||
CPlane(aabb.GetMinPoint(), up),
|
||||
CPlane(aabb.GetMaxPoint(), -up),
|
||||
};
|
||||
|
||||
ResetInternalCounters();
|
||||
CVector3f center = aabb.GetCenterPoint();
|
||||
CVector3f halfExtent = aabb.GetHalfExtent();
|
||||
|
||||
for (int i = 0; i < leafCache.GetNumLeaves(); ++i) {
|
||||
const CAreaOctTree::Node& node = leafCache.GetLeaf(i);
|
||||
if (aabb.DoBoundsOverlap(node.GetBoundingBox())) {
|
||||
CAreaOctTree::TriListReference listRef = node.GetTriangleArray();
|
||||
for (int j = 0; j < listRef.GetSize(); ++j) {
|
||||
++gTrianglesProcessed;
|
||||
ushort triIdx = listRef.GetAt(j);
|
||||
if (sDupPrimitiveCheckCount == sDupTriangleList[triIdx]) {
|
||||
++gDupTrianglesProcessed;
|
||||
} else {
|
||||
sDupTriangleList[triIdx] = sDupPrimitiveCheckCount;
|
||||
const CCollisionSurface& surf = node.GetOwner().GetMasterListTriangle(triIdx);
|
||||
CMaterialList material(surf.GetSurfaceFlags());
|
||||
if (filter.Passes(material)) {
|
||||
if (CollisionUtil::TriBoxOverlap(center, halfExtent, surf.GetVert(0), surf.GetVert(1),
|
||||
surf.GetVert(2)) == true) {
|
||||
CAABox aabb2 = CAABox::MakeMaxInvertedBox();
|
||||
if (ConvexPolyCollision(planes, &surf.GetVert(0), aabb2)) {
|
||||
CPlane plane = surf.GetPlane();
|
||||
CCollisionInfo collision(aabb2, matList, material, plane.GetNormal(),
|
||||
-plane.GetNormal());
|
||||
list.Add(collision, false);
|
||||
ret = true;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
Loading…
Reference in New Issue