mirror of https://github.com/AxioDL/zeus.git
163 lines
4.7 KiB
C++
163 lines
4.7 KiB
C++
#include "zeus/CAABox.hpp"
|
|
#include "zeus/CVector3f.hpp"
|
|
|
|
namespace zeus {
|
|
static const int ProjWindings[6][4] = {
|
|
{2, 0, 4, 6}, // -X
|
|
{0, 1, 5, 4}, // -Y
|
|
{2, 3, 1, 0}, // -Z
|
|
{1, 3, 7, 5}, // +X
|
|
{3, 2, 6, 7}, // +Y
|
|
{4, 5, 7, 6}, // +Z
|
|
};
|
|
|
|
static bool testProjectedLine(const CVector2f& a, const CVector2f& b, const CVector2f& point) {
|
|
zeus::CVector2f normal = (b - a).perpendicularVector().normalized();
|
|
return point.dot(normal) >= a.dot(normal);
|
|
}
|
|
|
|
bool CAABox::projectedPointTest(const CMatrix4f& mvp, const CVector2f& point) const {
|
|
CVector2f projPoints[8];
|
|
for (int i = 0; i < 8; ++i)
|
|
projPoints[i] = mvp.multiplyOneOverW(getPoint(i)).toVec2f();
|
|
|
|
for (int i = 0, j; i < 6; ++i) {
|
|
for (j = 0; j < 3; ++j) {
|
|
if (!testProjectedLine(projPoints[ProjWindings[i][j]], projPoints[ProjWindings[i][j + 1]], point))
|
|
break;
|
|
}
|
|
if (j == 3 && testProjectedLine(projPoints[ProjWindings[i][3]], projPoints[ProjWindings[i][0]], point))
|
|
return true;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
bool CAABox::intersects(const CSphere& other) const {
|
|
float dist = 0.f;
|
|
int comps = 0;
|
|
for (int i = 0; i < 3; i++) {
|
|
if (other.position[i] < min[i]) {
|
|
if (other.position[i] + other.radius >= min[i]) {
|
|
float comp = other.position[i] - min[i];
|
|
dist += comp * comp;
|
|
comps |= 1 << i;
|
|
} else {
|
|
return false;
|
|
}
|
|
} else if (other.position[i] > max[i]) {
|
|
if (other.position[i] - other.radius <= max[i]) {
|
|
float comp = other.position[i] - max[i];
|
|
dist += comp * comp;
|
|
comps |= 1 << i;
|
|
} else {
|
|
return false;
|
|
}
|
|
}
|
|
}
|
|
if (comps == 0)
|
|
return true;
|
|
return dist <= other.radius * other.radius;
|
|
}
|
|
|
|
float CAABox::intersectionRadius(const CSphere& other) const {
|
|
float dist = 0.f;
|
|
int comps = 0;
|
|
for (int i = 0; i < 3; i++) {
|
|
if (other.position[i] < min[i]) {
|
|
if (other.position[i] + other.radius >= min[i]) {
|
|
float comp = other.position[i] - min[i];
|
|
dist += comp * comp;
|
|
comps |= 1 << i;
|
|
} else {
|
|
return -1.f;
|
|
}
|
|
} else if (other.position[i] > max[i]) {
|
|
if (other.position[i] - other.radius <= max[i]) {
|
|
float comp = other.position[i] - max[i];
|
|
dist += comp * comp;
|
|
comps |= 1 << i;
|
|
} else {
|
|
return -1.f;
|
|
}
|
|
}
|
|
}
|
|
if (comps == 0)
|
|
return dist;
|
|
return (dist <= other.radius * other.radius) ? dist : -1.f;
|
|
}
|
|
|
|
CAABox CAABox::booleanIntersection(const CAABox& other) const {
|
|
CVector3f minVec;
|
|
CVector3f maxVec;
|
|
|
|
for (int i = 0; i < 3; ++i) {
|
|
if (min[i] <= other.min[i] && max[i] >= other.max[i]) {
|
|
minVec[i] = other.min[i];
|
|
maxVec[i] = other.max[i];
|
|
} else if (other.min[i] <= min[i] && other.max[i] >= max[i]) {
|
|
minVec[i] = min[i];
|
|
maxVec[i] = max[i];
|
|
} else if (other.min[i] <= min[i] && other.max[i] >= min[i]) {
|
|
minVec[i] = min[i];
|
|
maxVec[i] = other.max[i];
|
|
} else if (other.min[i] <= max[i] && other.max[i] >= max[i]) {
|
|
minVec[i] = other.min[i];
|
|
maxVec[i] = max[i];
|
|
}
|
|
}
|
|
|
|
return {minVec, maxVec};
|
|
}
|
|
|
|
CAABox::Tri CAABox::getTri(EBoxFaceId face, int windOffset) const {
|
|
zeus::CVector3f verts[] = {
|
|
{min.x(), min.y(), max.z()},
|
|
min,
|
|
{max.x(), min.y(), min.z()},
|
|
{max.x(), min.y(), max.z()}};
|
|
switch (face) {
|
|
case EBoxFaceId::YMin:
|
|
default:
|
|
verts[0].assign(min.x(), min.y(), max.z());
|
|
verts[1].assign(max.x(), min.y(), max.z());
|
|
verts[2].assign(max.x(), min.y(), min.z());
|
|
verts[3] = min;
|
|
break;
|
|
case EBoxFaceId::YMax:
|
|
verts[0] = max;
|
|
verts[1].assign(min.x(), max.y(), max.z());
|
|
verts[2].assign(min.x(), max.y(), min.z());
|
|
verts[3].assign(max.x(), max.y(), min.z());
|
|
break;
|
|
case EBoxFaceId::XMin:
|
|
verts[0].assign(min.x(), max.y(), max.z());
|
|
verts[1].assign(min.x(), min.y(), max.z());
|
|
verts[2] = min;
|
|
verts[3].assign(min.x(), max.y(), min.z());
|
|
break;
|
|
case EBoxFaceId::XMax:
|
|
verts[0].assign(max.x(), min.y(), max.z());
|
|
verts[1] = max;
|
|
verts[2].assign(max.x(), max.y(), min.z());
|
|
verts[3].assign(max.x(), min.y(), min.z());
|
|
break;
|
|
case EBoxFaceId::ZMax:
|
|
verts[0].assign(min.x(), max.y(), max.z());
|
|
verts[1] = max;
|
|
verts[2].assign(max.x(), min.y(), max.z());
|
|
verts[3].assign(min.x(), min.y(), max.z());
|
|
break;
|
|
case EBoxFaceId::ZMin:
|
|
verts[0] = min;
|
|
verts[1].assign(max.x(), min.y(), min.z());
|
|
verts[2].assign(max.x(), max.y(), min.z());
|
|
verts[3].assign(min.x(), max.y(), min.z());
|
|
break;
|
|
}
|
|
return {zeus::CPlane(verts[windOffset % 2], verts[(windOffset + 1) % 2], verts[(windOffset + 2) % 2]),
|
|
{verts[windOffset % 2], verts[(windOffset + 1) % 2], verts[(windOffset + 2) % 2]}};
|
|
}
|
|
|
|
} // namespace zeus
|