BGE: Cleanup occlusion buffer in CcdPhysicsEnvironment.cpp
This patch cleanup spaces/braces and newlines. Reviewers: moguri, kupoman Reviewed By: moguri, kupoman Subscribers: kupoman Differential Revision: https://developer.blender.org/D1607
This commit is contained in:
@@ -1405,98 +1405,111 @@ struct OcclusionBuffer
|
|||||||
{
|
{
|
||||||
struct WriteOCL
|
struct WriteOCL
|
||||||
{
|
{
|
||||||
static inline bool Process(btScalar& q,btScalar v) { if (q<v) q=v;return(false); }
|
static inline bool Process(btScalar &q, btScalar v)
|
||||||
static inline void Occlusion(bool& flag) { flag = true; }
|
{
|
||||||
|
if (q < v) {
|
||||||
|
q = v;
|
||||||
|
}
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
static inline void Occlusion(bool &flag)
|
||||||
|
{
|
||||||
|
flag = true;
|
||||||
|
}
|
||||||
};
|
};
|
||||||
|
|
||||||
struct QueryOCL
|
struct QueryOCL
|
||||||
{
|
{
|
||||||
static inline bool Process(btScalar& q,btScalar v) { return(q<=v); }
|
static inline bool Process(btScalar &q, btScalar v)
|
||||||
static inline void Occlusion(bool& flag) { }
|
{
|
||||||
|
return (q <= v);
|
||||||
|
}
|
||||||
|
static inline void Occlusion(bool &flag)
|
||||||
|
{
|
||||||
|
}
|
||||||
};
|
};
|
||||||
btScalar* m_buffer;
|
|
||||||
size_t m_bufferSize;
|
btScalar *m_buffer;
|
||||||
bool m_initialized;
|
size_t m_bufferSize;
|
||||||
bool m_occlusion;
|
bool m_initialized;
|
||||||
int m_sizes[2];
|
bool m_occlusion;
|
||||||
btScalar m_scales[2];
|
int m_sizes[2];
|
||||||
btScalar m_offsets[2];
|
btScalar m_scales[2];
|
||||||
btScalar m_wtc[16]; // world to clip transform
|
btScalar m_offsets[2];
|
||||||
btScalar m_mtc[16]; // model to clip transform
|
btScalar m_wtc[16]; // world to clip transform
|
||||||
|
btScalar m_mtc[16]; // model to clip transform
|
||||||
// constructor: size=largest dimension of the buffer.
|
// constructor: size=largest dimension of the buffer.
|
||||||
// Buffer size depends on aspect ratio
|
// Buffer size depends on aspect ratio
|
||||||
OcclusionBuffer()
|
OcclusionBuffer()
|
||||||
{
|
{
|
||||||
m_initialized=false;
|
m_initialized = false;
|
||||||
m_occlusion = false;
|
m_occlusion = false;
|
||||||
m_buffer = NULL;
|
m_buffer = NULL;
|
||||||
m_bufferSize = 0;
|
m_bufferSize = 0;
|
||||||
}
|
}
|
||||||
// multiplication of column major matrices: m=m1*m2
|
// multiplication of column major matrices: m = m1 * m2
|
||||||
template<typename T1, typename T2>
|
template<typename T1, typename T2>
|
||||||
void CMmat4mul(btScalar* m, const T1* m1, const T2* m2)
|
void CMmat4mul(btScalar *m, const T1 *m1, const T2 *m2)
|
||||||
{
|
{
|
||||||
m[ 0] = btScalar(m1[ 0]*m2[ 0]+m1[ 4]*m2[ 1]+m1[ 8]*m2[ 2]+m1[12]*m2[ 3]);
|
m[0] = btScalar(m1[0] * m2[0] + m1[4] * m2[1] + m1[8] * m2[2] + m1[12] * m2[3]);
|
||||||
m[ 1] = btScalar(m1[ 1]*m2[ 0]+m1[ 5]*m2[ 1]+m1[ 9]*m2[ 2]+m1[13]*m2[ 3]);
|
m[1] = btScalar(m1[1] * m2[0] + m1[5] * m2[1] + m1[9] * m2[2] + m1[13] * m2[3]);
|
||||||
m[ 2] = btScalar(m1[ 2]*m2[ 0]+m1[ 6]*m2[ 1]+m1[10]*m2[ 2]+m1[14]*m2[ 3]);
|
m[2] = btScalar(m1[2] * m2[0] + m1[6] * m2[1] + m1[10] * m2[2] + m1[14] * m2[3]);
|
||||||
m[ 3] = btScalar(m1[ 3]*m2[ 0]+m1[ 7]*m2[ 1]+m1[11]*m2[ 2]+m1[15]*m2[ 3]);
|
m[3] = btScalar(m1[3] * m2[0] + m1[7] * m2[1] + m1[11] * m2[2] + m1[15] * m2[3]);
|
||||||
|
|
||||||
m[ 4] = btScalar(m1[ 0]*m2[ 4]+m1[ 4]*m2[ 5]+m1[ 8]*m2[ 6]+m1[12]*m2[ 7]);
|
m[4] = btScalar(m1[0] * m2[4] + m1[4] * m2[5] + m1[8] * m2[6] + m1[12] * m2[7]);
|
||||||
m[ 5] = btScalar(m1[ 1]*m2[ 4]+m1[ 5]*m2[ 5]+m1[ 9]*m2[ 6]+m1[13]*m2[ 7]);
|
m[5] = btScalar(m1[1] * m2[4] + m1[5] * m2[5] + m1[9] * m2[6] + m1[13] * m2[7]);
|
||||||
m[ 6] = btScalar(m1[ 2]*m2[ 4]+m1[ 6]*m2[ 5]+m1[10]*m2[ 6]+m1[14]*m2[ 7]);
|
m[6] = btScalar(m1[2] * m2[4] + m1[6] * m2[5] + m1[10] * m2[6] + m1[14] * m2[7]);
|
||||||
m[ 7] = btScalar(m1[ 3]*m2[ 4]+m1[ 7]*m2[ 5]+m1[11]*m2[ 6]+m1[15]*m2[ 7]);
|
m[7] = btScalar(m1[3] * m2[4] + m1[7] * m2[5] + m1[11] * m2[6] + m1[15] * m2[7]);
|
||||||
|
|
||||||
m[ 8] = btScalar(m1[ 0]*m2[ 8]+m1[ 4]*m2[ 9]+m1[ 8]*m2[10]+m1[12]*m2[11]);
|
m[8] = btScalar(m1[0] * m2[8] + m1[4] * m2[9] + m1[8] * m2[10] + m1[12] * m2[11]);
|
||||||
m[ 9] = btScalar(m1[ 1]*m2[ 8]+m1[ 5]*m2[ 9]+m1[ 9]*m2[10]+m1[13]*m2[11]);
|
m[9] = btScalar(m1[1] * m2[8] + m1[5] * m2[9] + m1[9] * m2[10] + m1[13] * m2[11]);
|
||||||
m[10] = btScalar(m1[ 2]*m2[ 8]+m1[ 6]*m2[ 9]+m1[10]*m2[10]+m1[14]*m2[11]);
|
m[10] = btScalar(m1[2] * m2[8] + m1[6] * m2[9] + m1[10] * m2[10] + m1[14] * m2[11]);
|
||||||
m[11] = btScalar(m1[ 3]*m2[ 8]+m1[ 7]*m2[ 9]+m1[11]*m2[10]+m1[15]*m2[11]);
|
m[11] = btScalar(m1[3] * m2[8] + m1[7] * m2[9] + m1[11] * m2[10] + m1[15] * m2[11]);
|
||||||
|
|
||||||
m[12] = btScalar(m1[ 0]*m2[12]+m1[ 4]*m2[13]+m1[ 8]*m2[14]+m1[12]*m2[15]);
|
m[12] = btScalar(m1[0] * m2[12] + m1[4] * m2[13] + m1[8] * m2[14] + m1[12] * m2[15]);
|
||||||
m[13] = btScalar(m1[ 1]*m2[12]+m1[ 5]*m2[13]+m1[ 9]*m2[14]+m1[13]*m2[15]);
|
m[13] = btScalar(m1[1] * m2[12] + m1[5] * m2[13] + m1[9] * m2[14] + m1[13] * m2[15]);
|
||||||
m[14] = btScalar(m1[ 2]*m2[12]+m1[ 6]*m2[13]+m1[10]*m2[14]+m1[14]*m2[15]);
|
m[14] = btScalar(m1[2] * m2[12] + m1[6] * m2[13] + m1[10] * m2[14] + m1[14] * m2[15]);
|
||||||
m[15] = btScalar(m1[ 3]*m2[12]+m1[ 7]*m2[13]+m1[11]*m2[14]+m1[15]*m2[15]);
|
m[15] = btScalar(m1[3] * m2[12] + m1[7] * m2[13] + m1[11] * m2[14] + m1[15] * m2[15]);
|
||||||
}
|
}
|
||||||
void setup(int size, const int *view, double modelview[16], double projection[16])
|
|
||||||
|
void setup(int size, const int *view, double modelview[16], double projection[16])
|
||||||
{
|
{
|
||||||
m_initialized=false;
|
m_initialized = false;
|
||||||
m_occlusion=false;
|
m_occlusion = false;
|
||||||
// compute the size of the buffer
|
// compute the size of the buffer
|
||||||
int maxsize;
|
int maxsize = (view[2] > view[3]) ? view[2] : view[3];
|
||||||
double ratio;
|
|
||||||
maxsize = (view[2] > view[3]) ? view[2] : view[3];
|
|
||||||
assert(maxsize > 0);
|
assert(maxsize > 0);
|
||||||
ratio = 1.0/(2*maxsize);
|
double ratio = 1.0 / (2 * maxsize);
|
||||||
// ensure even number
|
// ensure even number
|
||||||
m_sizes[0] = 2*((int)(size*view[2]*ratio+0.5));
|
m_sizes[0] = 2 * ((int)(size * view[2] * ratio + 0.5));
|
||||||
m_sizes[1] = 2*((int)(size*view[3]*ratio+0.5));
|
m_sizes[1] = 2 * ((int)(size * view[3] * ratio + 0.5));
|
||||||
m_scales[0]=btScalar(m_sizes[0]/2);
|
m_scales[0] = btScalar(m_sizes[0] / 2);
|
||||||
m_scales[1]=btScalar(m_sizes[1]/2);
|
m_scales[1] = btScalar(m_sizes[1] / 2);
|
||||||
m_offsets[0]=m_scales[0]+0.5f;
|
m_offsets[0] = m_scales[0] + 0.5f;
|
||||||
m_offsets[1]=m_scales[1]+0.5f;
|
m_offsets[1] = m_scales[1] + 0.5f;
|
||||||
// prepare matrix
|
// prepare matrix
|
||||||
// at this time of the rendering, the modelview matrix is the
|
// at this time of the rendering, the modelview matrix is the
|
||||||
// world to camera transformation and the projection matrix is
|
// world to camera transformation and the projection matrix is
|
||||||
// camera to clip transformation. combine both so that
|
// camera to clip transformation. combine both so that
|
||||||
CMmat4mul(m_wtc, projection, modelview);
|
CMmat4mul(m_wtc, projection, modelview);
|
||||||
}
|
}
|
||||||
void initialize()
|
|
||||||
|
void initialize()
|
||||||
{
|
{
|
||||||
size_t newsize = (m_sizes[0]*m_sizes[1])*sizeof(btScalar);
|
size_t newsize = (m_sizes[0] * m_sizes[1]) * sizeof(btScalar);
|
||||||
if (m_buffer)
|
if (m_buffer) {
|
||||||
{
|
|
||||||
// see if we can reuse
|
// see if we can reuse
|
||||||
if (newsize > m_bufferSize)
|
if (newsize > m_bufferSize) {
|
||||||
{
|
|
||||||
free(m_buffer);
|
free(m_buffer);
|
||||||
m_buffer = NULL;
|
m_buffer = NULL;
|
||||||
m_bufferSize = 0;
|
m_bufferSize = 0;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
if (!m_buffer)
|
if (!m_buffer) {
|
||||||
{
|
m_buffer = (btScalar *)calloc(1, newsize);
|
||||||
m_buffer = (btScalar*)calloc(1, newsize);
|
|
||||||
m_bufferSize = newsize;
|
m_bufferSize = newsize;
|
||||||
} else
|
}
|
||||||
{
|
else {
|
||||||
// buffer exists already, just clears it
|
// buffer exists already, just clears it
|
||||||
memset(m_buffer, 0, newsize);
|
memset(m_buffer, 0, newsize);
|
||||||
}
|
}
|
||||||
@@ -1505,163 +1518,169 @@ struct OcclusionBuffer
|
|||||||
m_initialized = true;
|
m_initialized = true;
|
||||||
m_occlusion = false;
|
m_occlusion = false;
|
||||||
}
|
}
|
||||||
void SetModelMatrix(double *fl)
|
|
||||||
|
void SetModelMatrix(double *fl)
|
||||||
{
|
{
|
||||||
CMmat4mul(m_mtc,m_wtc,fl);
|
CMmat4mul(m_mtc,m_wtc,fl);
|
||||||
if (!m_initialized)
|
if (!m_initialized) {
|
||||||
initialize();
|
initialize();
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// transform a segment in world coordinate to clip coordinate
|
// transform a segment in world coordinate to clip coordinate
|
||||||
void transformW(const btVector3& x, btVector4& t)
|
void transformW(const btVector3 &x, btVector4 &t)
|
||||||
{
|
{
|
||||||
t[0] = x[0]*m_wtc[0]+x[1]*m_wtc[4]+x[2]*m_wtc[8]+m_wtc[12];
|
t[0] = x[0] * m_wtc[0] + x[1] * m_wtc[4] + x[2] * m_wtc[8] + m_wtc[12];
|
||||||
t[1] = x[0]*m_wtc[1]+x[1]*m_wtc[5]+x[2]*m_wtc[9]+m_wtc[13];
|
t[1] = x[0] * m_wtc[1] + x[1] * m_wtc[5] + x[2] * m_wtc[9] + m_wtc[13];
|
||||||
t[2] = x[0]*m_wtc[2]+x[1]*m_wtc[6]+x[2]*m_wtc[10]+m_wtc[14];
|
t[2] = x[0] * m_wtc[2] + x[1] * m_wtc[6] + x[2] * m_wtc[10] + m_wtc[14];
|
||||||
t[3] = x[0]*m_wtc[3]+x[1]*m_wtc[7]+x[2]*m_wtc[11]+m_wtc[15];
|
t[3] = x[0] * m_wtc[3] + x[1] * m_wtc[7] + x[2] * m_wtc[11] + m_wtc[15];
|
||||||
}
|
}
|
||||||
void transformM(const float* x, btVector4& t)
|
|
||||||
|
void transformM(const float *x, btVector4 &t)
|
||||||
{
|
{
|
||||||
t[0] = x[0]*m_mtc[0]+x[1]*m_mtc[4]+x[2]*m_mtc[8]+m_mtc[12];
|
t[0] = x[0] * m_mtc[0] + x[1] * m_mtc[4] + x[2] * m_mtc[8] + m_mtc[12];
|
||||||
t[1] = x[0]*m_mtc[1]+x[1]*m_mtc[5]+x[2]*m_mtc[9]+m_mtc[13];
|
t[1] = x[0] * m_mtc[1] + x[1] * m_mtc[5] + x[2] * m_mtc[9] + m_mtc[13];
|
||||||
t[2] = x[0]*m_mtc[2]+x[1]*m_mtc[6]+x[2]*m_mtc[10]+m_mtc[14];
|
t[2] = x[0] * m_mtc[2] + x[1] * m_mtc[6] + x[2] * m_mtc[10] + m_mtc[14];
|
||||||
t[3] = x[0]*m_mtc[3]+x[1]*m_mtc[7]+x[2]*m_mtc[11]+m_mtc[15];
|
t[3] = x[0] * m_mtc[3] + x[1] * m_mtc[7] + x[2] * m_mtc[11] + m_mtc[15];
|
||||||
}
|
}
|
||||||
// convert polygon to device coordinates
|
// convert polygon to device coordinates
|
||||||
static bool project(btVector4* p,int n)
|
static bool project(btVector4 *p, int n)
|
||||||
{
|
{
|
||||||
for (int i=0;i<n;++i)
|
for (int i = 0; i < n; ++i) {
|
||||||
{
|
p[i][2] = 1 / p[i][3];
|
||||||
p[i][2]=1/p[i][3];
|
p[i][0] *= p[i][2];
|
||||||
p[i][0]*=p[i][2];
|
p[i][1] *= p[i][2];
|
||||||
p[i][1]*=p[i][2];
|
|
||||||
}
|
}
|
||||||
return(true);
|
return true;
|
||||||
}
|
}
|
||||||
// pi: closed polygon in clip coordinate, NP = number of segments
|
// pi: closed polygon in clip coordinate, NP = number of segments
|
||||||
// po: same polygon with clipped segments removed
|
// po: same polygon with clipped segments removed
|
||||||
template <const int NP>
|
template <const int NP>
|
||||||
static int clip(const btVector4* pi,btVector4* po)
|
static int clip(const btVector4 *pi, btVector4 *po)
|
||||||
{
|
{
|
||||||
btScalar s[2*NP];
|
btScalar s[2 * NP];
|
||||||
btVector4 pn[2*NP];
|
btVector4 pn[2 * NP];
|
||||||
int i, j, m, n, ni;
|
int i, j, m, n, ni;
|
||||||
// deal with near clipping
|
// deal with near clipping
|
||||||
for (i=0, m=0;i<NP;++i)
|
for (i = 0, m = 0; i < NP; ++i) {
|
||||||
{
|
s[i] = pi[i][2] + pi[i][3];
|
||||||
s[i]=pi[i][2]+pi[i][3];
|
if (s[i] < 0) {
|
||||||
if (s[i]<0) m+=1<<i;
|
m += 1 << i;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
if (m==((1<<NP)-1))
|
if (m == ((1 << NP) - 1)) {
|
||||||
return(0);
|
return 0;
|
||||||
if (m!=0)
|
}
|
||||||
{
|
if (m != 0) {
|
||||||
for (i=NP-1,j=0,n=0;j<NP;i=j++)
|
for (i = NP - 1, j = 0, n = 0; j < NP; i = j++) {
|
||||||
{
|
const btVector4 &a = pi[i];
|
||||||
const btVector4& a=pi[i];
|
const btVector4 &b = pi[j];
|
||||||
const btVector4& b=pi[j];
|
const btScalar t = s[i] / (a[3] + a[2] - b[3] - b[2]);
|
||||||
const btScalar t=s[i]/(a[3]+a[2]-b[3]-b[2]);
|
if ((t > 0) && (t < 1)) {
|
||||||
if ((t>0)&&(t<1))
|
pn[n][0] = a[0] + (b[0] - a[0]) * t;
|
||||||
{
|
pn[n][1] = a[1] + (b[1] - a[1]) * t;
|
||||||
pn[n][0] = a[0]+(b[0]-a[0])*t;
|
pn[n][2] = a[2] + (b[2] - a[2]) * t;
|
||||||
pn[n][1] = a[1]+(b[1]-a[1])*t;
|
pn[n][3] = a[3] + (b[3] - a[3]) * t;
|
||||||
pn[n][2] = a[2]+(b[2]-a[2])*t;
|
|
||||||
pn[n][3] = a[3]+(b[3]-a[3])*t;
|
|
||||||
++n;
|
++n;
|
||||||
}
|
}
|
||||||
if (s[j]>0) pn[n++]=b;
|
if (s[j] > 0) {
|
||||||
|
pn[n++] = b;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
// ready to test far clipping, start from the modified polygon
|
// ready to test far clipping, start from the modified polygon
|
||||||
pi = pn;
|
pi = pn;
|
||||||
ni = n;
|
ni = n;
|
||||||
} else
|
}
|
||||||
{
|
else {
|
||||||
// no clipping on the near plane, keep same vector
|
// no clipping on the near plane, keep same vector
|
||||||
ni = NP;
|
ni = NP;
|
||||||
}
|
}
|
||||||
// now deal with far clipping
|
// now deal with far clipping
|
||||||
for (i=0, m=0;i<ni;++i)
|
for (i = 0, m = 0; i < ni; ++i) {
|
||||||
{
|
s[i] = pi[i][2] - pi[i][3];
|
||||||
s[i]=pi[i][2]-pi[i][3];
|
if (s[i] > 0) {
|
||||||
if (s[i]>0) m+=1<<i;
|
m += 1 << i;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
if (m==((1<<ni)-1))
|
if (m == ((1 << ni) - 1)) {
|
||||||
return(0);
|
return 0;
|
||||||
if (m!=0)
|
}
|
||||||
{
|
if (m != 0) {
|
||||||
for (i=ni-1,j=0,n=0;j<ni;i=j++)
|
for (i = ni - 1, j = 0, n = 0;j < ni; i = j++) {
|
||||||
{
|
const btVector4 &a = pi[i];
|
||||||
const btVector4& a=pi[i];
|
const btVector4 &b = pi[j];
|
||||||
const btVector4& b=pi[j];
|
const btScalar t = s[i] / (a[2] - a[3] - b[2] + b[3]);
|
||||||
const btScalar t=s[i]/(a[2]-a[3]-b[2]+b[3]);
|
if ((t > 0) && (t < 1)) {
|
||||||
if ((t>0)&&(t<1))
|
po[n][0] = a[0] + (b[0] - a[0]) * t;
|
||||||
{
|
po[n][1] = a[1] + (b[1] - a[1]) * t;
|
||||||
po[n][0] = a[0]+(b[0]-a[0])*t;
|
po[n][2] = a[2] + (b[2] - a[2]) * t;
|
||||||
po[n][1] = a[1]+(b[1]-a[1])*t;
|
po[n][3] = a[3] + (b[3] - a[3]) * t;
|
||||||
po[n][2] = a[2]+(b[2]-a[2])*t;
|
|
||||||
po[n][3] = a[3]+(b[3]-a[3])*t;
|
|
||||||
++n;
|
++n;
|
||||||
}
|
}
|
||||||
if (s[j]<0) po[n++]=b;
|
if (s[j] < 0) {
|
||||||
|
po[n++] = b;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
return(n);
|
return n;
|
||||||
}
|
}
|
||||||
for (int i=0;i<ni;++i) po[i]=pi[i];
|
for (int i = 0; i < ni; ++i) {
|
||||||
return(ni);
|
po[i] = pi[i];
|
||||||
|
}
|
||||||
|
return ni;
|
||||||
}
|
}
|
||||||
// write or check a triangle to buffer. a,b,c in device coordinates (-1,+1)
|
// write or check a triangle to buffer. a,b,c in device coordinates (-1,+1)
|
||||||
template <typename POLICY>
|
template <typename POLICY>
|
||||||
inline bool draw( const btVector4& a,
|
inline bool draw(const btVector4 &a,
|
||||||
const btVector4& b,
|
const btVector4 &b,
|
||||||
const btVector4& c,
|
const btVector4 &c,
|
||||||
const float face,
|
const float face,
|
||||||
const btScalar minarea)
|
const btScalar minarea)
|
||||||
{
|
{
|
||||||
const btScalar a2=btCross(b-a,c-a)[2];
|
const btScalar a2 = btCross(b - a, c - a)[2];
|
||||||
if ((face*a2)<0.f || btFabs(a2)<minarea)
|
if ((face * a2) < 0.0f || btFabs(a2) < minarea) {
|
||||||
return false;
|
return false;
|
||||||
|
}
|
||||||
// further down we are normally going to write to the Zbuffer, mark it so
|
// further down we are normally going to write to the Zbuffer, mark it so
|
||||||
POLICY::Occlusion(m_occlusion);
|
POLICY::Occlusion(m_occlusion);
|
||||||
|
|
||||||
int x[3], y[3], ib=1, ic=2;
|
int x[3], y[3], ib = 1, ic = 2;
|
||||||
btScalar z[3];
|
btScalar z[3];
|
||||||
x[0]=(int)(a.x()*m_scales[0]+m_offsets[0]);
|
x[0] = (int)(a.x() * m_scales[0] + m_offsets[0]);
|
||||||
y[0]=(int)(a.y()*m_scales[1]+m_offsets[1]);
|
y[0] = (int)(a.y() * m_scales[1] + m_offsets[1]);
|
||||||
z[0]=a.z();
|
z[0] = a.z();
|
||||||
if (a2 < 0.f)
|
if (a2 < 0.f) {
|
||||||
{
|
|
||||||
// negative aire is possible with double face => must
|
// negative aire is possible with double face => must
|
||||||
// change the order of b and c otherwise the algorithm doesn't work
|
// change the order of b and c otherwise the algorithm doesn't work
|
||||||
ib=2;
|
ib = 2;
|
||||||
ic=1;
|
ic = 1;
|
||||||
}
|
}
|
||||||
x[ib]=(int)(b.x()*m_scales[0]+m_offsets[0]);
|
x[ib] = (int)(b.x() * m_scales[0] + m_offsets[0]);
|
||||||
x[ic]=(int)(c.x()*m_scales[0]+m_offsets[0]);
|
x[ic] = (int)(c.x() * m_scales[0] + m_offsets[0]);
|
||||||
y[ib]=(int)(b.y()*m_scales[1]+m_offsets[1]);
|
y[ib] = (int)(b.y() * m_scales[1] + m_offsets[1]);
|
||||||
y[ic]=(int)(c.y()*m_scales[1]+m_offsets[1]);
|
y[ic] = (int)(c.y() * m_scales[1] + m_offsets[1]);
|
||||||
z[ib]=b.z();
|
z[ib] = b.z();
|
||||||
z[ic]=c.z();
|
z[ic] = c.z();
|
||||||
const int mix=btMax(0,btMin(x[0],btMin(x[1],x[2])));
|
const int mix = btMax(0, btMin(x[0], btMin(x[1], x[2])));
|
||||||
const int mxx=btMin(m_sizes[0],1+btMax(x[0],btMax(x[1],x[2])));
|
const int mxx = btMin(m_sizes[0], 1 + btMax(x[0], btMax(x[1], x[2])));
|
||||||
const int miy=btMax(0,btMin(y[0],btMin(y[1],y[2])));
|
const int miy = btMax(0, btMin(y[0], btMin(y[1], y[2])));
|
||||||
const int mxy=btMin(m_sizes[1],1+btMax(y[0],btMax(y[1],y[2])));
|
const int mxy = btMin(m_sizes[1], 1 + btMax(y[0], btMax(y[1], y[2])));
|
||||||
const int width=mxx-mix;
|
const int width = mxx - mix;
|
||||||
const int height=mxy-miy;
|
const int height = mxy - miy;
|
||||||
if ((width*height) <= 1)
|
if ((width * height) <= 1) {
|
||||||
{
|
|
||||||
// degenerated in at most one single pixel
|
// degenerated in at most one single pixel
|
||||||
btScalar* scan=&m_buffer[miy*m_sizes[0]+mix];
|
btScalar *scan = &m_buffer[miy * m_sizes[0] + mix];
|
||||||
// use for loop to detect the case where width or height == 0
|
// use for loop to detect the case where width or height == 0
|
||||||
for (int iy=miy;iy<mxy;++iy)
|
for (int iy = miy; iy < mxy; ++iy) {
|
||||||
{
|
for (int ix = mix; ix < mxx; ++ix) {
|
||||||
for (int ix=mix;ix<mxx;++ix)
|
if (POLICY::Process(*scan, z[0])) {
|
||||||
{
|
return true;
|
||||||
if (POLICY::Process(*scan,z[0]))
|
}
|
||||||
return(true);
|
if (POLICY::Process(*scan, z[1])) {
|
||||||
if (POLICY::Process(*scan,z[1]))
|
return true;
|
||||||
return(true);
|
}
|
||||||
if (POLICY::Process(*scan,z[2]))
|
if (POLICY::Process(*scan, z[2])) {
|
||||||
return(true);
|
return true;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -1673,182 +1692,236 @@ struct OcclusionBuffer
|
|||||||
// sort the y coord to make formula simpler
|
// sort the y coord to make formula simpler
|
||||||
int ytmp;
|
int ytmp;
|
||||||
btScalar ztmp;
|
btScalar ztmp;
|
||||||
if (y[0] > y[1]) { ytmp=y[1];y[1]=y[0];y[0]=ytmp;ztmp=z[1];z[1]=z[0];z[0]=ztmp; }
|
if (y[0] > y[1]) {
|
||||||
if (y[0] > y[2]) { ytmp=y[2];y[2]=y[0];y[0]=ytmp;ztmp=z[2];z[2]=z[0];z[0]=ztmp; }
|
ytmp = y[1];
|
||||||
if (y[1] > y[2]) { ytmp=y[2];y[2]=y[1];y[1]=ytmp;ztmp=z[2];z[2]=z[1];z[1]=ztmp; }
|
y[1] = y[0];
|
||||||
int dy[] = {y[0] - y[1],
|
y[0] = ytmp;
|
||||||
|
ztmp = z[1];
|
||||||
|
z[1] = z[0];
|
||||||
|
z[0] = ztmp;
|
||||||
|
}
|
||||||
|
if (y[0] > y[2]) {
|
||||||
|
ytmp = y[2];
|
||||||
|
y[2] = y[0];
|
||||||
|
y[0] = ytmp;
|
||||||
|
ztmp = z[2];
|
||||||
|
z[2] = z[0];
|
||||||
|
z[0] = ztmp;
|
||||||
|
}
|
||||||
|
if (y[1] > y[2]) {
|
||||||
|
ytmp = y[2];
|
||||||
|
y[2] = y[1];
|
||||||
|
y[1] = ytmp;
|
||||||
|
ztmp = z[2];
|
||||||
|
z[2] = z[1];
|
||||||
|
z[1] = ztmp;
|
||||||
|
}
|
||||||
|
int dy[] = {y[0] - y[1],
|
||||||
y[1] - y[2],
|
y[1] - y[2],
|
||||||
y[2] - y[0]};
|
y[2] - y[0]};
|
||||||
btScalar dzy[3];
|
btScalar dzy[3];
|
||||||
dzy[0] = (dy[0]) ? (z[0] - z[1]) / dy[0] : btScalar(0.f);
|
dzy[0] = (dy[0]) ? (z[0] - z[1]) / dy[0] : btScalar(0.0f);
|
||||||
dzy[1] = (dy[1]) ? (z[1] - z[2]) / dy[1] : btScalar(0.f);
|
dzy[1] = (dy[1]) ? (z[1] - z[2]) / dy[1] : btScalar(0.0f);
|
||||||
dzy[2] = (dy[2]) ? (z[2] - z[0]) / dy[2] : btScalar(0.f);
|
dzy[2] = (dy[2]) ? (z[2] - z[0]) / dy[2] : btScalar(0.0f);
|
||||||
btScalar v[3] = {dzy[0] * (miy - y[0]) + z[0],
|
btScalar v[3] = {dzy[0] * (miy - y[0]) + z[0],
|
||||||
dzy[1] * (miy - y[1]) + z[1],
|
dzy[1] * (miy - y[1]) + z[1],
|
||||||
dzy[2] * (miy - y[2]) + z[2]};
|
dzy[2] * (miy - y[2]) + z[2]};
|
||||||
dy[0] = y[1]-y[0];
|
dy[0] = y[1] - y[0];
|
||||||
dy[1] = y[0]-y[1];
|
dy[1] = y[0] - y[1];
|
||||||
dy[2] = y[2]-y[0];
|
dy[2] = y[2] - y[0];
|
||||||
btScalar* scan=&m_buffer[miy*m_sizes[0]+mix];
|
btScalar *scan = &m_buffer[miy * m_sizes[0] + mix];
|
||||||
for (int iy=miy;iy<mxy;++iy)
|
for (int iy = miy; iy < mxy; ++iy) {
|
||||||
{
|
if (dy[0] >= 0 && POLICY::Process(*scan, v[0])) {
|
||||||
if (dy[0] >= 0 && POLICY::Process(*scan,v[0]))
|
return true;
|
||||||
return(true);
|
}
|
||||||
if (dy[1] >= 0 && POLICY::Process(*scan,v[1]))
|
if (dy[1] >= 0 && POLICY::Process(*scan, v[1])) {
|
||||||
return(true);
|
return true;
|
||||||
if (dy[2] >= 0 && POLICY::Process(*scan,v[2]))
|
}
|
||||||
return(true);
|
if (dy[2] >= 0 && POLICY::Process(*scan, v[2])) {
|
||||||
scan+=m_sizes[0];
|
return true;
|
||||||
v[0] += dzy[0]; v[1] += dzy[1]; v[2] += dzy[2];
|
}
|
||||||
dy[0]--; dy[1]++, dy[2]--;
|
scan += m_sizes[0];
|
||||||
|
v[0] += dzy[0];
|
||||||
|
v[1] += dzy[1];
|
||||||
|
v[2] += dzy[2];
|
||||||
|
dy[0]--;
|
||||||
|
dy[1]++;
|
||||||
|
dy[2]--;
|
||||||
}
|
}
|
||||||
} else if (height == 1)
|
}
|
||||||
{
|
else if (height == 1) {
|
||||||
// Degenerated in at least 2 horizontal lines
|
// Degenerated in at least 2 horizontal lines
|
||||||
// The algorithm below doesn't work when face has a single pixel width
|
// The algorithm below doesn't work when face has a single pixel width
|
||||||
// We cannot use general formulas because the plane is degenerated.
|
// We cannot use general formulas because the plane is degenerated.
|
||||||
// We have to interpolate along the 3 edges that overlaps and process each pixel.
|
// We have to interpolate along the 3 edges that overlaps and process each pixel.
|
||||||
int xtmp;
|
int xtmp;
|
||||||
btScalar ztmp;
|
btScalar ztmp;
|
||||||
if (x[0] > x[1]) { xtmp=x[1];x[1]=x[0];x[0]=xtmp;ztmp=z[1];z[1]=z[0];z[0]=ztmp; }
|
if (x[0] > x[1]) {
|
||||||
if (x[0] > x[2]) { xtmp=x[2];x[2]=x[0];x[0]=xtmp;ztmp=z[2];z[2]=z[0];z[0]=ztmp; }
|
xtmp = x[1];
|
||||||
if (x[1] > x[2]) { xtmp=x[2];x[2]=x[1];x[1]=xtmp;ztmp=z[2];z[2]=z[1];z[1]=ztmp; }
|
x[1] = x[0];
|
||||||
|
x[0] = xtmp;
|
||||||
|
ztmp = z[1];
|
||||||
|
z[1] = z[0];
|
||||||
|
z[0] = ztmp;
|
||||||
|
}
|
||||||
|
if (x[0] > x[2]) {
|
||||||
|
xtmp = x[2];
|
||||||
|
x[2] = x[0];
|
||||||
|
x[0] = xtmp;
|
||||||
|
ztmp = z[2];
|
||||||
|
z[2] = z[0];
|
||||||
|
z[0] = ztmp;
|
||||||
|
}
|
||||||
|
if (x[1] > x[2]) {
|
||||||
|
xtmp = x[2];
|
||||||
|
x[2] = x[1];
|
||||||
|
x[1] = xtmp;
|
||||||
|
ztmp = z[2];
|
||||||
|
z[2] = z[1];
|
||||||
|
z[1] = ztmp;
|
||||||
|
}
|
||||||
int dx[] = {x[0] - x[1],
|
int dx[] = {x[0] - x[1],
|
||||||
x[1] - x[2],
|
x[1] - x[2],
|
||||||
x[2] - x[0]};
|
x[2] - x[0]};
|
||||||
btScalar dzx[3];
|
btScalar dzx[3];
|
||||||
dzx[0] = (dx[0]) ? (z[0]-z[1])/dx[0] : btScalar(0.f);
|
dzx[0] = (dx[0]) ? (z[0]-z[1]) / dx[0] : btScalar(0.0f);
|
||||||
dzx[1] = (dx[1]) ? (z[1]-z[2])/dx[1] : btScalar(0.f);
|
dzx[1] = (dx[1]) ? (z[1]-z[2]) / dx[1] : btScalar(0.0f);
|
||||||
dzx[2] = (dx[2]) ? (z[2]-z[0])/dx[2] : btScalar(0.f);
|
dzx[2] = (dx[2]) ? (z[2]-z[0]) / dx[2] : btScalar(0.0f);
|
||||||
btScalar v[3] = {dzx[0] * (mix - x[0]) + z[0],
|
btScalar v[3] = {dzx[0] * (mix - x[0]) + z[0],
|
||||||
dzx[1] * (mix - x[1]) + z[1],
|
dzx[1] * (mix - x[1]) + z[1],
|
||||||
dzx[2] * (mix - x[2]) + z[2]};
|
dzx[2] * (mix - x[2]) + z[2]};
|
||||||
dx[0] = x[1]-x[0];
|
dx[0] = x[1] - x[0];
|
||||||
dx[1] = x[0]-x[1];
|
dx[1] = x[0] - x[1];
|
||||||
dx[2] = x[2]-x[0];
|
dx[2] = x[2] - x[0];
|
||||||
btScalar* scan=&m_buffer[miy*m_sizes[0]+mix];
|
btScalar *scan = &m_buffer[miy * m_sizes[0] + mix];
|
||||||
for (int ix=mix;ix<mxx;++ix)
|
for (int ix = mix; ix < mxx; ++ix) {
|
||||||
{
|
if (dx[0] >= 0 && POLICY::Process(*scan, v[0])) {
|
||||||
if (dx[0] >= 0 && POLICY::Process(*scan,v[0]))
|
return true;
|
||||||
return(true);
|
}
|
||||||
if (dx[1] >= 0 && POLICY::Process(*scan,v[1]))
|
if (dx[1] >= 0 && POLICY::Process(*scan, v[1])) {
|
||||||
return(true);
|
return true;
|
||||||
if (dx[2] >= 0 && POLICY::Process(*scan,v[2]))
|
}
|
||||||
return(true);
|
if (dx[2] >= 0 && POLICY::Process(*scan, v[2])) {
|
||||||
|
return true;
|
||||||
|
}
|
||||||
scan++;
|
scan++;
|
||||||
v[0] += dzx[0]; v[1] += dzx[1]; v[2] += dzx[2];
|
v[0] += dzx[0];
|
||||||
dx[0]--; dx[1]++, dx[2]--;
|
v[1] += dzx[1];
|
||||||
|
v[2] += dzx[2];
|
||||||
|
dx[0]--;
|
||||||
|
dx[1]++;
|
||||||
|
dx[2]--;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
// general case
|
// general case
|
||||||
const int dx[] = {y[0] - y[1],
|
const int dx[] = {y[0] - y[1],
|
||||||
y[1] - y[2],
|
y[1] - y[2],
|
||||||
y[2] - y[0]};
|
y[2] - y[0]};
|
||||||
const int dy[] = {x[1] - x[0] - dx[0] * width,
|
const int dy[] = {x[1] - x[0] - dx[0] * width,
|
||||||
x[2] - x[1] - dx[1] * width,
|
x[2] - x[1] - dx[1] * width,
|
||||||
x[0] - x[2] - dx[2] * width};
|
x[0] - x[2] - dx[2] * width};
|
||||||
const int a = x[2] * y[0] + x[0] * y[1] - x[2] * y[1] - x[0] * y[2] + x[1] * y[2] - x[1] * y[0];
|
const int a = x[2] * y[0] + x[0] * y[1] - x[2] * y[1] - x[0] * y[2] + x[1] * y[2] - x[1] * y[0];
|
||||||
const btScalar ia = 1 / (btScalar)a;
|
const btScalar ia = 1 / (btScalar)a;
|
||||||
const btScalar dzx = ia*(y[2]*(z[1]-z[0])+y[1]*(z[0]-z[2])+y[0]*(z[2]-z[1]));
|
const btScalar dzx = ia * (y[2] * (z[1] - z[0]) + y[1] * (z[0] - z[2]) + y[0] * (z[2] - z[1]));
|
||||||
const btScalar dzy = ia*(x[2]*(z[0]-z[1])+x[0]*(z[1]-z[2])+x[1]*(z[2]-z[0]))-(dzx*width);
|
const btScalar dzy = ia * (x[2] * (z[0] - z[1]) + x[0] * (z[1] - z[2]) + x[1] * (z[2] - z[0])) - (dzx * width);
|
||||||
int c[] = {miy*x[1]+mix*y[0]-x[1]*y[0]-mix*y[1]+x[0]*y[1]-miy*x[0],
|
int c[] = {miy * x[1] + mix * y[0] - x[1] * y[0] - mix * y[1] + x[0] * y[1] - miy * x[0],
|
||||||
miy*x[2]+mix*y[1]-x[2]*y[1]-mix*y[2]+x[1]*y[2]-miy*x[1],
|
miy * x[2] + mix * y[1] - x[2] * y[1] - mix * y[2] + x[1] * y[2] - miy * x[1],
|
||||||
miy*x[0]+mix*y[2]-x[0]*y[2]-mix*y[0]+x[2]*y[0]-miy*x[2]};
|
miy * x[0] + mix * y[2] - x[0] * y[2] - mix * y[0] + x[2] * y[0] - miy * x[2]};
|
||||||
btScalar v = ia*((z[2]*c[0])+(z[0]*c[1])+(z[1]*c[2]));
|
btScalar v = ia * ((z[2] * c[0]) + (z[0] * c[1]) + (z[1] * c[2]));
|
||||||
btScalar *scan = &m_buffer[miy*m_sizes[0]];
|
btScalar *scan = &m_buffer[miy * m_sizes[0]];
|
||||||
for (int iy=miy;iy<mxy;++iy)
|
|
||||||
{
|
for (int iy = miy; iy < mxy; ++iy) {
|
||||||
for (int ix=mix;ix<mxx;++ix)
|
for (int ix = mix; ix < mxx; ++ix) {
|
||||||
{
|
if ((c[0] >= 0) && (c[1] >= 0) && (c[2] >= 0)) {
|
||||||
if ((c[0]>=0)&&(c[1]>=0)&&(c[2]>=0))
|
if (POLICY::Process(scan[ix], v)) {
|
||||||
{
|
return true;
|
||||||
if (POLICY::Process(scan[ix],v))
|
}
|
||||||
return(true);
|
|
||||||
}
|
}
|
||||||
c[0]+=dx[0];c[1]+=dx[1];c[2]+=dx[2];v+=dzx;
|
c[0] += dx[0]; c[1] += dx[1]; c[2] += dx[2]; v += dzx;
|
||||||
}
|
}
|
||||||
c[0]+=dy[0];c[1]+=dy[1];c[2]+=dy[2];v+=dzy;
|
c[0] += dy[0]; c[1] += dy[1]; c[2] += dy[2]; v += dzy;
|
||||||
scan+=m_sizes[0];
|
scan += m_sizes[0];
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
return(false);
|
return false;
|
||||||
}
|
}
|
||||||
// clip than write or check a polygon
|
// clip than write or check a polygon
|
||||||
template <const int NP,typename POLICY>
|
template <const int NP, typename POLICY>
|
||||||
inline bool clipDraw( const btVector4* p,
|
inline bool clipDraw(const btVector4 *p,
|
||||||
const float face,
|
const float face,
|
||||||
btScalar minarea)
|
btScalar minarea)
|
||||||
{
|
{
|
||||||
btVector4 o[NP*2];
|
btVector4 o[NP * 2];
|
||||||
int n=clip<NP>(p,o);
|
int n = clip<NP>(p, o);
|
||||||
bool earlyexit=false;
|
bool earlyexit = false;
|
||||||
if (n)
|
if (n) {
|
||||||
{
|
project(o, n);
|
||||||
project(o,n);
|
for (int i = 2; i < n && !earlyexit; ++i) {
|
||||||
for (int i=2;i<n && !earlyexit;++i)
|
earlyexit |= draw<POLICY>(o[0], o[i - 1], o[i], face, minarea);
|
||||||
{
|
|
||||||
earlyexit|=draw<POLICY>(o[0],o[i-1],o[i],face,minarea);
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
return(earlyexit);
|
return earlyexit;
|
||||||
}
|
}
|
||||||
// add a triangle (in model coordinate)
|
// add a triangle (in model coordinate)
|
||||||
// face = 0.f if face is double side,
|
// face = 0.f if face is double side,
|
||||||
// = 1.f if face is single sided and scale is positive
|
// = 1.f if face is single sided and scale is positive
|
||||||
// = -1.f if face is single sided and scale is negative
|
// = -1.f if face is single sided and scale is negative
|
||||||
void appendOccluderM(const float* a,
|
void appendOccluderM(const float *a,
|
||||||
const float* b,
|
const float *b,
|
||||||
const float* c,
|
const float *c,
|
||||||
const float face)
|
const float face)
|
||||||
{
|
{
|
||||||
btVector4 p[3];
|
btVector4 p[3];
|
||||||
transformM(a,p[0]);
|
transformM(a, p[0]);
|
||||||
transformM(b,p[1]);
|
transformM(b, p[1]);
|
||||||
transformM(c,p[2]);
|
transformM(c, p[2]);
|
||||||
clipDraw<3,WriteOCL>(p,face,btScalar(0.f));
|
clipDraw<3, WriteOCL>(p, face, btScalar(0.0f));
|
||||||
}
|
}
|
||||||
// add a quad (in model coordinate)
|
// add a quad (in model coordinate)
|
||||||
void appendOccluderM(const float* a,
|
void appendOccluderM(const float *a,
|
||||||
const float* b,
|
const float *b,
|
||||||
const float* c,
|
const float *c,
|
||||||
const float* d,
|
const float *d,
|
||||||
const float face)
|
const float face)
|
||||||
{
|
{
|
||||||
btVector4 p[4];
|
btVector4 p[4];
|
||||||
transformM(a,p[0]);
|
transformM(a, p[0]);
|
||||||
transformM(b,p[1]);
|
transformM(b, p[1]);
|
||||||
transformM(c,p[2]);
|
transformM(c, p[2]);
|
||||||
transformM(d,p[3]);
|
transformM(d, p[3]);
|
||||||
clipDraw<4,WriteOCL>(p,face,btScalar(0.f));
|
clipDraw<4, WriteOCL>(p, face, btScalar(0.0f));
|
||||||
}
|
}
|
||||||
// query occluder for a box (c=center, e=extend) in world coordinate
|
// query occluder for a box (c=center, e=extend) in world coordinate
|
||||||
inline bool queryOccluderW( const btVector3& c,
|
inline bool queryOccluderW(const btVector3 &c,
|
||||||
const btVector3& e)
|
const btVector3 &e)
|
||||||
{
|
{
|
||||||
if (!m_occlusion)
|
if (!m_occlusion) {
|
||||||
// no occlusion yet, no need to check
|
// no occlusion yet, no need to check
|
||||||
return true;
|
return true;
|
||||||
btVector4 x[8];
|
|
||||||
transformW(btVector3(c[0]-e[0],c[1]-e[1],c[2]-e[2]),x[0]);
|
|
||||||
transformW(btVector3(c[0]+e[0],c[1]-e[1],c[2]-e[2]),x[1]);
|
|
||||||
transformW(btVector3(c[0]+e[0],c[1]+e[1],c[2]-e[2]),x[2]);
|
|
||||||
transformW(btVector3(c[0]-e[0],c[1]+e[1],c[2]-e[2]),x[3]);
|
|
||||||
transformW(btVector3(c[0]-e[0],c[1]-e[1],c[2]+e[2]),x[4]);
|
|
||||||
transformW(btVector3(c[0]+e[0],c[1]-e[1],c[2]+e[2]),x[5]);
|
|
||||||
transformW(btVector3(c[0]+e[0],c[1]+e[1],c[2]+e[2]),x[6]);
|
|
||||||
transformW(btVector3(c[0]-e[0],c[1]+e[1],c[2]+e[2]),x[7]);
|
|
||||||
for (int i=0;i<8;++i)
|
|
||||||
{
|
|
||||||
// the box is clipped, it's probably a large box, don't waste our time to check
|
|
||||||
if ((x[i][2]+x[i][3])<=0) return(true);
|
|
||||||
}
|
}
|
||||||
static const int d[] = {1,0,3,2,
|
btVector4 x[8];
|
||||||
4,5,6,7,
|
transformW(btVector3(c[0] - e[0], c[1] - e[1], c[2] - e[2]), x[0]);
|
||||||
4,7,3,0,
|
transformW(btVector3(c[0] + e[0], c[1] - e[1], c[2] - e[2]), x[1]);
|
||||||
6,5,1,2,
|
transformW(btVector3(c[0] + e[0], c[1] + e[1], c[2] - e[2]), x[2]);
|
||||||
7,6,2,3,
|
transformW(btVector3(c[0] - e[0], c[1] + e[1], c[2] - e[2]), x[3]);
|
||||||
5,4,0,1};
|
transformW(btVector3(c[0] - e[0], c[1] - e[1], c[2] + e[2]), x[4]);
|
||||||
|
transformW(btVector3(c[0] + e[0], c[1] - e[1], c[2] + e[2]), x[5]);
|
||||||
|
transformW(btVector3(c[0] + e[0], c[1] + e[1], c[2] + e[2]), x[6]);
|
||||||
|
transformW(btVector3(c[0] - e[0], c[1] + e[1], c[2] + e[2]), x[7]);
|
||||||
|
|
||||||
|
for (int i = 0; i < 8; ++i) {
|
||||||
|
// the box is clipped, it's probably a large box, don't waste our time to check
|
||||||
|
if ((x[i][2] + x[i][3]) <= 0) {
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
static const int d[] = {1, 0, 3, 2,
|
||||||
|
4, 5, 6, 7,
|
||||||
|
4, 7, 3, 0,
|
||||||
|
6, 5, 1, 2,
|
||||||
|
7, 6, 2, 3,
|
||||||
|
5, 4, 0, 1};
|
||||||
for (unsigned int i = 0; i < (sizeof(d) / sizeof(d[0]));) {
|
for (unsigned int i = 0; i < (sizeof(d) / sizeof(d[0]));) {
|
||||||
const btVector4 p[] = {x[d[i + 0]],
|
const btVector4 p[] = {x[d[i + 0]],
|
||||||
x[d[i + 1]],
|
x[d[i + 1]],
|
||||||
|
Reference in New Issue
Block a user