Initial commit.
This commit is contained in:
Jim Gray
366
code/ravl/CBounds.cpp
Normal file
366
code/ravl/CBounds.cpp
Normal file
@@ -0,0 +1,366 @@
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
// RAVEN STANDARD TEMPLATE LIBRARY
|
||||
// (c) 2002 Activision
|
||||
//
|
||||
//
|
||||
// Vector Library
|
||||
// --------------
|
||||
//
|
||||
//
|
||||
//
|
||||
//
|
||||
// NOTES:
|
||||
// 05/31/02 - CREATED
|
||||
//
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
#if !defined(ASSERT_H_INC)
|
||||
#include <assert.h>
|
||||
#define ASSERT_H_INC
|
||||
#endif
|
||||
|
||||
#include <math.h>
|
||||
#include <stdio.h>
|
||||
#include <float.h>
|
||||
#include "CBounds.h"
|
||||
|
||||
|
||||
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
/*void CBBox::ThroughMatrix(const CBBox &from, const CMatrix4 &mat)
|
||||
{
|
||||
Clear();
|
||||
CVec3 bb,t;
|
||||
int i;
|
||||
const CVec3 &xmn=from.GetMin();
|
||||
const CVec3 &xmx=from.GetMax();
|
||||
for ( i = 0; i < 8; i++ )
|
||||
{
|
||||
if ( i & 1 )
|
||||
bb[0] = xmn[0];
|
||||
else
|
||||
bb[0] = xmx[0];
|
||||
if ( i & 2 )
|
||||
bb[1] = xmn[1];
|
||||
else
|
||||
bb[1] = xmx[1];
|
||||
if ( i & 4 )
|
||||
bb[2] = xmn[2];
|
||||
else
|
||||
bb[2] = xmx[2];
|
||||
mat.XFormPoint(t,bb);
|
||||
AddPoint(t);
|
||||
}
|
||||
}*/
|
||||
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
float CBBox::LargestAxisSize() const
|
||||
{
|
||||
CVec3 Work(mMax);
|
||||
Work-=mMin;
|
||||
return Work.MaxElement();
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
float CBBox::DistanceEstimate(const CVec3 &p) const
|
||||
{
|
||||
float ret=0.0f;
|
||||
|
||||
// X Axis
|
||||
//--------
|
||||
if (p[0]>mMax[0])
|
||||
{
|
||||
ret=p[0]-mMax[0];
|
||||
}
|
||||
else if (p[0]<mMin[0])
|
||||
{
|
||||
ret=mMax[0]-p[0];
|
||||
}
|
||||
|
||||
// Y Axis
|
||||
//--------
|
||||
if (p[1]>mMax[1])
|
||||
{
|
||||
ret+=p[1]-mMax[1];
|
||||
}
|
||||
else if (p[1]<mMin[1])
|
||||
{
|
||||
ret+=mMax[1]-p[1];
|
||||
}
|
||||
|
||||
// Z Axis
|
||||
//--------
|
||||
if (p[2]>mMax[2])
|
||||
{
|
||||
ret+=p[2]-mMax[2];
|
||||
}
|
||||
else if (p[2]<mMin[2])
|
||||
{
|
||||
ret+=mMax[2]-p[2];
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
float CBBox::AreaEstimate(const CVec3 &p) const
|
||||
{
|
||||
float Distance=DistanceEstimate(p);
|
||||
if (Distance)
|
||||
{
|
||||
return LargestAxisSize()/Distance;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
void CBBox::Intersect(const CBBox &b2)
|
||||
{
|
||||
mMin.Max(b2.mMin);
|
||||
mMax.Min(b2.mMax);
|
||||
Validate();
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
void CBBox::Union(const CBBox &b2)
|
||||
{
|
||||
mMin.Min(b2.mMin);
|
||||
mMax.Max(b2.mMax);
|
||||
Validate();
|
||||
}
|
||||
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
ESide CBBox::InOutTest(const CVec3 &v) const
|
||||
{
|
||||
if (v>mMin && v<mMax)
|
||||
{
|
||||
return Side_In;
|
||||
}
|
||||
return Side_Out;
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
ESide CBBox::InOutTest(const CVec3 &v,float tolout,float tolin) const
|
||||
{
|
||||
if (v[0]<mMin[0]-tolout||v[0]>mMax[0]+tolout||
|
||||
v[1]<mMin[1]-tolout||v[1]>mMax[1]+tolout||
|
||||
v[2]<mMin[2]-tolout||v[2]>mMax[2]+tolout)
|
||||
{
|
||||
return Side_Out;
|
||||
}
|
||||
if (v[0]>mMin[0]+tolin&&v[0]<mMax[0]-tolin&&
|
||||
v[1]>mMin[1]+tolin&&v[1]<mMax[1]-tolin&&
|
||||
v[2]>mMin[2]+tolin&&v[2]<mMax[2]-tolin)
|
||||
{
|
||||
return Side_In;
|
||||
}
|
||||
return Side_None;
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
bool CBBox::BoxTouchTest(const CBBox &b2,float tolout) const
|
||||
{
|
||||
if (mMin[0]-tolout>b2.mMax[0] ||
|
||||
mMin[1]-tolout>b2.mMax[1] ||
|
||||
mMin[2]-tolout>b2.mMax[2] ||
|
||||
b2.mMin[0]-tolout>mMax[0] ||
|
||||
b2.mMin[1]-tolout>mMax[1] ||
|
||||
b2.mMin[2]-tolout>mMax[2])
|
||||
{
|
||||
return false;
|
||||
}
|
||||
return true;
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
bool CBBox::SphereTouchTest(const CVec3 &v,float rad) const
|
||||
{
|
||||
if (v[0]<mMin[0]-rad||v[0]>mMax[0]+rad||
|
||||
v[1]<mMin[1]-rad||v[1]>mMax[1]+rad||
|
||||
v[2]<mMin[2]-rad||v[2]>mMax[2]+rad)
|
||||
return false;
|
||||
return true;
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
TPlanes CBBox::PlaneFlags(const CVec3 &p)
|
||||
{
|
||||
TPlanes ret=0;
|
||||
if (p[0]<mMin[0])
|
||||
{
|
||||
ret|=1;
|
||||
}
|
||||
else if (p[0]>mMax[0])
|
||||
{
|
||||
ret|=2;
|
||||
}
|
||||
if (p[1]<mMin[1])
|
||||
{
|
||||
ret|=4;
|
||||
}
|
||||
else if (p[1]>mMax[1])
|
||||
{
|
||||
ret|=8;
|
||||
}
|
||||
if (p[2]<mMin[2])
|
||||
{
|
||||
ret|=16;
|
||||
}
|
||||
else if (p[2]>mMax[2])
|
||||
{
|
||||
ret|=32;
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
// return true if the segment intersect the box, in that case, return the first contact.
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
bool CBBox::HitTest(CBTrace& Tr) const
|
||||
{
|
||||
// Quick Box Cull
|
||||
//----------------
|
||||
CBBox tmp;
|
||||
tmp.AddPoint(Tr.mStart);
|
||||
tmp.AddPoint(Tr.mStop);
|
||||
if (!BoxTouchTest(tmp))
|
||||
{
|
||||
return false;
|
||||
}
|
||||
|
||||
|
||||
// Initialize Our Ranges
|
||||
//-----------------------
|
||||
Tr.mRange =-1E30f;
|
||||
Tr.mRangeMax = 1E30f;
|
||||
|
||||
|
||||
// For Each Non Zero Axis Of The Aim Vector
|
||||
//------------------------------------------
|
||||
float tmax,tmin,temp;
|
||||
for (int axis=0; axis<3; axis++)
|
||||
{
|
||||
if (fabs(Tr.mAim[axis])>1E-6f)
|
||||
{
|
||||
// Find Mins And Maxs From The Start Along The Axis Of Aim
|
||||
//---------------------------------------------------------
|
||||
tmax = ((mMax[axis]-Tr.mStart[axis])/Tr.mAim[axis]);
|
||||
tmin = ((mMin[axis]-Tr.mStart[axis])/Tr.mAim[axis]);
|
||||
if (tmax<tmin)
|
||||
{
|
||||
temp = tmax;
|
||||
tmax = tmin;
|
||||
tmin = temp;
|
||||
}
|
||||
|
||||
// Adjust Range Max
|
||||
//------------------
|
||||
if (tmax<Tr.mRangeMax)
|
||||
{
|
||||
Tr.mRangeMax=tmax;
|
||||
}
|
||||
|
||||
// Adjust Range Min
|
||||
//------------------
|
||||
if (tmin>Tr.mRange)
|
||||
{
|
||||
Tr.mRange=tmin;
|
||||
Tr.mNormal.Clear();
|
||||
Tr.mNormal[axis]=-1.0f;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
// Missed?
|
||||
//---------
|
||||
if (Tr.mRangeMax<Tr.mRange || Tr.mRangeMax<0.0f || Tr.mRange>Tr.mLength)
|
||||
{
|
||||
return false;
|
||||
}
|
||||
|
||||
|
||||
// Start Solid Conditions
|
||||
//------------------------
|
||||
if (Tr.mRange<0.0f)
|
||||
{
|
||||
Tr.mRange = 0.0f;
|
||||
Tr.mPoint = Tr.mStart;
|
||||
return true;
|
||||
}
|
||||
|
||||
|
||||
// Calculate The End Point
|
||||
//-------------------------
|
||||
Tr.mPoint = Tr.mAim;
|
||||
Tr.mPoint *= Tr.mRange;
|
||||
Tr.mPoint += Tr.mStart;
|
||||
return true;
|
||||
}
|
||||
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
void CBBox::FromStr(const char *s)
|
||||
{
|
||||
assert(s && s[0]);
|
||||
|
||||
char MinS[256];
|
||||
char MaxS[266];
|
||||
sscanf(s, "(%s|%s)", MinS, MaxS);
|
||||
|
||||
mMin.FromStr(MinS);
|
||||
mMax.FromStr(MaxS);
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
void CBBox::ToStr(char* s)
|
||||
{
|
||||
assert(s && s[0]);
|
||||
|
||||
char MinS[256];
|
||||
char MaxS[266];
|
||||
|
||||
mMin.ToStr(MinS);
|
||||
mMax.ToStr(MaxS);
|
||||
sprintf(s, "(%s|%s)", MinS, MaxS);
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
////////////////////////////////////////////////////////////////////////////////////////
|
||||
void CBBox::Validate()
|
||||
{
|
||||
assert(mMax>=mMin);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user