AxioDL/zeus
2
0
Fork 0
mirror of https://github.com/AxioDL/zeus.git synced 2025-12-19 09:55:21 +00:00
Code Issues Packages Projects Releases Wiki Activity

Added COBBox and renamed SBoundingBox to CAABox

Browse Source 
Reorganized code
This commit is contained in:
Phillip Stephens
2015-08-11 18:41:28 -07:00
parent 3a25f59adb
commit 9d657895cb
35 changed files with 353 additions and 233 deletions
Download Patch File Download Diff File Expand all files Collapse all files

127
include/CFrustum.hpp Normal file
View File

@@ -0,0 +1,127 @@
#ifndef CFRUSTUM_HPP
#define CFRUSTUM_HPP
#include "CPlane.hpp"
#include "CAABox.hpp"
class CFrustum
{
CPlane m_planes[6];
public:
inline void updatePlanes(const CTransform& modelview, const CProjection& projection)
{
CMatrix4f mv;
modelview.toMatrix4f(mv);
CMatrix4f mvp = projection.getCachedMatrix() * mv;
CMatrix4f mvp_rm = mvp.transposed();
#if __SSE__
/* Left */
m_planes[0].mVec128 = _mm_add_ps(mvp_rm.vec[0].mVec128, mvp_rm.vec[3].mVec128);
/* Right */
m_planes[1].mVec128 = _mm_add_ps(_mm_sub_ps(CVector3f::skZero.mVec128, mvp_rm.vec[0].mVec128), mvp_rm.vec[3].mVec128);
/* Bottom */
m_planes[2].mVec128 = _mm_add_ps(mvp_rm.vec[1].mVec128, mvp_rm.vec[3].mVec128);
/* Top */
m_planes[3].mVec128 = _mm_add_ps(_mm_sub_ps(CVector3f::skZero.mVec128, mvp_rm.vec[1].mVec128), mvp_rm.vec[3].mVec128);
/* Near */
m_planes[4].mVec128 = _mm_add_ps(mvp_rm.vec[2].mVec128, mvp_rm.vec[3].mVec128);
/* Far */
m_planes[5].mVec128 = _mm_add_ps(_mm_sub_ps(CVector3f::skZero.mVec128, mvp_rm.vec[2].mVec128), mvp_rm.vec[3].mVec128);
#else
/* Left */
m_planes[0].a = mvp_rm.m[0][0] + mvp_rm.m[3][0];
m_planes[0].b = mvp_rm.m[0][1] + mvp_rm.m[3][1];
m_planes[0].c = mvp_rm.m[0][2] + mvp_rm.m[3][2];
m_planes[0].d = mvp_rm.m[0][3] + mvp_rm.m[3][3];
/* Right */
m_planes[1].a = -mvp_rm.m[0][0] + mvp_rm.m[3][0];
m_planes[1].b = -mvp_rm.m[0][1] + mvp_rm.m[3][1];
m_planes[1].c = -mvp_rm.m[0][2] + mvp_rm.m[3][2];
m_planes[1].d = -mvp_rm.m[0][3] + mvp_rm.m[3][3];
/* Bottom */
m_planes[2].a = mvp_rm.m[1][0] + mvp_rm.m[3][0];
m_planes[2].b = mvp_rm.m[1][1] + mvp_rm.m[3][1];
m_planes[2].c = mvp_rm.m[1][2] + mvp_rm.m[3][2];
m_planes[2].d = mvp_rm.m[1][3] + mvp_rm.m[3][3];
/* Top */
m_planes[3].a = -mvp_rm.m[1][0] + mvp_rm.m[3][0];
m_planes[3].b = -mvp_rm.m[1][1] + mvp_rm.m[3][1];
m_planes[3].c = -mvp_rm.m[1][2] + mvp_rm.m[3][2];
m_planes[3].d = -mvp_rm.m[1][3] + mvp_rm.m[3][3];
/* Near */
m_planes[4].a = mvp_rm.m[2][0] + mvp_rm.m[3][0];
m_planes[4].b = mvp_rm.m[2][1] + mvp_rm.m[3][1];
m_planes[4].c = mvp_rm.m[2][2] + mvp_rm.m[3][2];
m_planes[4].d = mvp_rm.m[2][3] + mvp_rm.m[3][3];
/* Far */
m_planes[5].a = -mvp_rm.m[2][0] + mvp_rm.m[3][0];
m_planes[5].b = -mvp_rm.m[2][1] + mvp_rm.m[3][1];
m_planes[5].c = -mvp_rm.m[2][2] + mvp_rm.m[3][2];
m_planes[5].d = -mvp_rm.m[2][3] + mvp_rm.m[3][3];
#endif
m_planes[0].normalize();
m_planes[1].normalize();
m_planes[2].normalize();
m_planes[3].normalize();
m_planes[4].normalize();
m_planes[5].normalize();
}
inline bool aabbFrustumTest(const CAABox& aabb) const
{
CVector3f vmin, vmax;
int i;
for (i=0 ; i<6 ; ++i) {
const CPlane& plane = m_planes[i];
/* X axis */
if (plane.a >= 0) {
vmin[0] = aabb.m_min[0];
vmax[0] = aabb.m_max[0];
} else {
vmin[0] = aabb.m_max[0];
vmax[0] = aabb.m_min[0];
}
/* Y axis */
if (plane.b >= 0) {
vmin[1] = aabb.m_min[1];
vmax[1] = aabb.m_max[1];
} else {
vmin[1] = aabb.m_max[1];
vmax[1] = aabb.m_min[1];
}
/* Z axis */
if (plane.c >= 0) {
vmin[2] = aabb.m_min[2];
vmax[2] = aabb.m_max[2];
} else {
vmin[2] = aabb.m_max[2];
vmax[2] = aabb.m_min[2];
}
float dadot = plane.vec.dot(vmax);
if (dadot + plane.d < 0)
return false;
}
return true;
}
};
#endif // CFRUSTUM_HPP