mirror of
https://github.com/DrBeef/ioq3quest.git
synced 2024-11-23 12:32:09 +00:00
1411 lines
33 KiB
C
1411 lines
33 KiB
C
/*
|
|
===========================================================================
|
|
Copyright (C) 1999-2005 Id Software, Inc.
|
|
|
|
This file is part of Quake III Arena source code.
|
|
|
|
Quake III Arena source code is free software; you can redistribute it
|
|
and/or modify it under the terms of the GNU General Public License as
|
|
published by the Free Software Foundation; either version 2 of the License,
|
|
or (at your option) any later version.
|
|
|
|
Quake III Arena source code is distributed in the hope that it will be
|
|
useful, but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with Foobar; if not, write to the Free Software
|
|
Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
===========================================================================
|
|
*/
|
|
|
|
#include <malloc.h>
|
|
#include "l_cmd.h"
|
|
#include "l_math.h"
|
|
#include "l_poly.h"
|
|
#include "l_log.h"
|
|
#include "l_mem.h"
|
|
|
|
#define BOGUS_RANGE 65535
|
|
|
|
extern int numthreads;
|
|
|
|
// counters are only bumped when running single threaded,
|
|
// because they are an awefull coherence problem
|
|
int c_active_windings;
|
|
int c_peak_windings;
|
|
int c_winding_allocs;
|
|
int c_winding_points;
|
|
int c_windingmemory;
|
|
int c_peak_windingmemory;
|
|
|
|
char windingerror[1024];
|
|
|
|
void pw(winding_t *w)
|
|
{
|
|
int i;
|
|
for (i=0 ; i<w->numpoints ; i++)
|
|
printf ("(%5.3f, %5.3f, %5.3f)\n",w->p[i][0], w->p[i][1],w->p[i][2]);
|
|
}
|
|
|
|
|
|
void ResetWindings(void)
|
|
{
|
|
c_active_windings = 0;
|
|
c_peak_windings = 0;
|
|
c_winding_allocs = 0;
|
|
c_winding_points = 0;
|
|
c_windingmemory = 0;
|
|
c_peak_windingmemory = 0;
|
|
|
|
strcpy(windingerror, "");
|
|
} //end of the function ResetWindings
|
|
/*
|
|
=============
|
|
AllocWinding
|
|
=============
|
|
*/
|
|
winding_t *AllocWinding (int points)
|
|
{
|
|
winding_t *w;
|
|
int s;
|
|
|
|
s = sizeof(vec_t)*3*points + sizeof(int);
|
|
w = GetMemory(s);
|
|
memset(w, 0, s);
|
|
|
|
if (numthreads == 1)
|
|
{
|
|
c_winding_allocs++;
|
|
c_winding_points += points;
|
|
c_active_windings++;
|
|
if (c_active_windings > c_peak_windings)
|
|
c_peak_windings = c_active_windings;
|
|
c_windingmemory += MemorySize(w);
|
|
if (c_windingmemory > c_peak_windingmemory)
|
|
c_peak_windingmemory = c_windingmemory;
|
|
} //end if
|
|
return w;
|
|
} //end of the function AllocWinding
|
|
|
|
void FreeWinding (winding_t *w)
|
|
{
|
|
if (*(unsigned *)w == 0xdeaddead)
|
|
Error ("FreeWinding: freed a freed winding");
|
|
|
|
if (numthreads == 1)
|
|
{
|
|
c_active_windings--;
|
|
c_windingmemory -= MemorySize(w);
|
|
} //end if
|
|
|
|
*(unsigned *)w = 0xdeaddead;
|
|
|
|
FreeMemory(w);
|
|
} //end of the function FreeWinding
|
|
|
|
int WindingMemory(void)
|
|
{
|
|
return c_windingmemory;
|
|
} //end of the function WindingMemory
|
|
|
|
int WindingPeakMemory(void)
|
|
{
|
|
return c_peak_windingmemory;
|
|
} //end of the function WindingPeakMemory
|
|
|
|
int ActiveWindings(void)
|
|
{
|
|
return c_active_windings;
|
|
} //end of the function ActiveWindings
|
|
/*
|
|
============
|
|
RemoveColinearPoints
|
|
============
|
|
*/
|
|
int c_removed;
|
|
|
|
void RemoveColinearPoints (winding_t *w)
|
|
{
|
|
int i, j, k;
|
|
vec3_t v1, v2;
|
|
int nump;
|
|
vec3_t p[MAX_POINTS_ON_WINDING];
|
|
|
|
nump = 0;
|
|
for (i=0 ; i<w->numpoints ; i++)
|
|
{
|
|
j = (i+1)%w->numpoints;
|
|
k = (i+w->numpoints-1)%w->numpoints;
|
|
VectorSubtract (w->p[j], w->p[i], v1);
|
|
VectorSubtract (w->p[i], w->p[k], v2);
|
|
VectorNormalize(v1);
|
|
VectorNormalize(v2);
|
|
if (DotProduct(v1, v2) < 0.999)
|
|
{
|
|
if (nump >= MAX_POINTS_ON_WINDING)
|
|
Error("RemoveColinearPoints: MAX_POINTS_ON_WINDING");
|
|
VectorCopy (w->p[i], p[nump]);
|
|
nump++;
|
|
}
|
|
}
|
|
|
|
if (nump == w->numpoints)
|
|
return;
|
|
|
|
if (numthreads == 1)
|
|
c_removed += w->numpoints - nump;
|
|
w->numpoints = nump;
|
|
memcpy (w->p, p, nump*sizeof(p[0]));
|
|
}
|
|
|
|
/*
|
|
============
|
|
WindingPlane
|
|
============
|
|
*/
|
|
void WindingPlane (winding_t *w, vec3_t normal, vec_t *dist)
|
|
{
|
|
vec3_t v1, v2;
|
|
int i;
|
|
|
|
//find two vectors each longer than 0.5 units
|
|
for (i = 0; i < w->numpoints; i++)
|
|
{
|
|
VectorSubtract(w->p[(i+1) % w->numpoints], w->p[i], v1);
|
|
VectorSubtract(w->p[(i+2) % w->numpoints], w->p[i], v2);
|
|
if (VectorLength(v1) > 0.5 && VectorLength(v2) > 0.5) break;
|
|
} //end for
|
|
CrossProduct(v2, v1, normal);
|
|
VectorNormalize(normal);
|
|
*dist = DotProduct(w->p[0], normal);
|
|
} //end of the function WindingPlane
|
|
|
|
/*
|
|
=============
|
|
WindingArea
|
|
=============
|
|
*/
|
|
vec_t WindingArea (winding_t *w)
|
|
{
|
|
int i;
|
|
vec3_t d1, d2, cross;
|
|
vec_t total;
|
|
|
|
total = 0;
|
|
for (i=2 ; i<w->numpoints ; i++)
|
|
{
|
|
VectorSubtract (w->p[i-1], w->p[0], d1);
|
|
VectorSubtract (w->p[i], w->p[0], d2);
|
|
CrossProduct (d1, d2, cross);
|
|
total += 0.5 * VectorLength ( cross );
|
|
}
|
|
return total;
|
|
}
|
|
|
|
void WindingBounds (winding_t *w, vec3_t mins, vec3_t maxs)
|
|
{
|
|
vec_t v;
|
|
int i,j;
|
|
|
|
mins[0] = mins[1] = mins[2] = 99999;
|
|
maxs[0] = maxs[1] = maxs[2] = -99999;
|
|
|
|
for (i=0 ; i<w->numpoints ; i++)
|
|
{
|
|
for (j=0 ; j<3 ; j++)
|
|
{
|
|
v = w->p[i][j];
|
|
if (v < mins[j])
|
|
mins[j] = v;
|
|
if (v > maxs[j])
|
|
maxs[j] = v;
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
=============
|
|
WindingCenter
|
|
=============
|
|
*/
|
|
void WindingCenter (winding_t *w, vec3_t center)
|
|
{
|
|
int i;
|
|
float scale;
|
|
|
|
VectorCopy (vec3_origin, center);
|
|
for (i=0 ; i<w->numpoints ; i++)
|
|
VectorAdd (w->p[i], center, center);
|
|
|
|
scale = 1.0/w->numpoints;
|
|
VectorScale (center, scale, center);
|
|
}
|
|
|
|
/*
|
|
=================
|
|
BaseWindingForPlane
|
|
=================
|
|
*/
|
|
winding_t *BaseWindingForPlane (vec3_t normal, vec_t dist)
|
|
{
|
|
int i, x;
|
|
vec_t max, v;
|
|
vec3_t org, vright, vup;
|
|
winding_t *w;
|
|
|
|
// find the major axis
|
|
|
|
max = -BOGUS_RANGE;
|
|
x = -1;
|
|
for (i=0 ; i<3; i++)
|
|
{
|
|
v = fabs(normal[i]);
|
|
if (v > max)
|
|
{
|
|
x = i;
|
|
max = v;
|
|
}
|
|
}
|
|
if (x==-1)
|
|
Error ("BaseWindingForPlane: no axis found");
|
|
|
|
VectorCopy (vec3_origin, vup);
|
|
switch (x)
|
|
{
|
|
case 0:
|
|
case 1:
|
|
vup[2] = 1;
|
|
break;
|
|
case 2:
|
|
vup[0] = 1;
|
|
break;
|
|
}
|
|
|
|
v = DotProduct (vup, normal);
|
|
VectorMA (vup, -v, normal, vup);
|
|
VectorNormalize (vup);
|
|
|
|
VectorScale (normal, dist, org);
|
|
|
|
CrossProduct (vup, normal, vright);
|
|
|
|
VectorScale (vup, BOGUS_RANGE, vup);
|
|
VectorScale (vright, BOGUS_RANGE, vright);
|
|
|
|
// project a really big axis aligned box onto the plane
|
|
w = AllocWinding (4);
|
|
|
|
VectorSubtract (org, vright, w->p[0]);
|
|
VectorAdd (w->p[0], vup, w->p[0]);
|
|
|
|
VectorAdd (org, vright, w->p[1]);
|
|
VectorAdd (w->p[1], vup, w->p[1]);
|
|
|
|
VectorAdd (org, vright, w->p[2]);
|
|
VectorSubtract (w->p[2], vup, w->p[2]);
|
|
|
|
VectorSubtract (org, vright, w->p[3]);
|
|
VectorSubtract (w->p[3], vup, w->p[3]);
|
|
|
|
w->numpoints = 4;
|
|
|
|
return w;
|
|
}
|
|
|
|
/*
|
|
==================
|
|
CopyWinding
|
|
==================
|
|
*/
|
|
winding_t *CopyWinding (winding_t *w)
|
|
{
|
|
int size;
|
|
winding_t *c;
|
|
|
|
c = AllocWinding (w->numpoints);
|
|
size = (int)((winding_t *)0)->p[w->numpoints];
|
|
memcpy (c, w, size);
|
|
return c;
|
|
}
|
|
|
|
/*
|
|
==================
|
|
ReverseWinding
|
|
==================
|
|
*/
|
|
winding_t *ReverseWinding (winding_t *w)
|
|
{
|
|
int i;
|
|
winding_t *c;
|
|
|
|
c = AllocWinding (w->numpoints);
|
|
for (i=0 ; i<w->numpoints ; i++)
|
|
{
|
|
VectorCopy (w->p[w->numpoints-1-i], c->p[i]);
|
|
}
|
|
c->numpoints = w->numpoints;
|
|
return c;
|
|
}
|
|
|
|
|
|
/*
|
|
=============
|
|
ClipWindingEpsilon
|
|
=============
|
|
*/
|
|
void ClipWindingEpsilon (winding_t *in, vec3_t normal, vec_t dist,
|
|
vec_t epsilon, winding_t **front, winding_t **back)
|
|
{
|
|
vec_t dists[MAX_POINTS_ON_WINDING+4];
|
|
int sides[MAX_POINTS_ON_WINDING+4];
|
|
int counts[3];
|
|
//MrElusive: DOH can't use statics when unsing multithreading!!!
|
|
vec_t dot; // VC 4.2 optimizer bug if not static
|
|
int i, j;
|
|
vec_t *p1, *p2;
|
|
vec3_t mid;
|
|
winding_t *f, *b;
|
|
int maxpts;
|
|
|
|
counts[0] = counts[1] = counts[2] = 0;
|
|
|
|
// determine sides for each point
|
|
for (i=0 ; i<in->numpoints ; i++)
|
|
{
|
|
dot = DotProduct (in->p[i], normal);
|
|
dot -= dist;
|
|
dists[i] = dot;
|
|
if (dot > epsilon)
|
|
sides[i] = SIDE_FRONT;
|
|
else if (dot < -epsilon)
|
|
sides[i] = SIDE_BACK;
|
|
else
|
|
{
|
|
sides[i] = SIDE_ON;
|
|
}
|
|
counts[sides[i]]++;
|
|
}
|
|
sides[i] = sides[0];
|
|
dists[i] = dists[0];
|
|
|
|
*front = *back = NULL;
|
|
|
|
if (!counts[0])
|
|
{
|
|
*back = CopyWinding (in);
|
|
return;
|
|
}
|
|
if (!counts[1])
|
|
{
|
|
*front = CopyWinding (in);
|
|
return;
|
|
}
|
|
|
|
maxpts = in->numpoints+4; // cant use counts[0]+2 because
|
|
// of fp grouping errors
|
|
|
|
*front = f = AllocWinding (maxpts);
|
|
*back = b = AllocWinding (maxpts);
|
|
|
|
for (i=0 ; i<in->numpoints ; i++)
|
|
{
|
|
p1 = in->p[i];
|
|
|
|
if (sides[i] == SIDE_ON)
|
|
{
|
|
VectorCopy (p1, f->p[f->numpoints]);
|
|
f->numpoints++;
|
|
VectorCopy (p1, b->p[b->numpoints]);
|
|
b->numpoints++;
|
|
continue;
|
|
}
|
|
|
|
if (sides[i] == SIDE_FRONT)
|
|
{
|
|
VectorCopy (p1, f->p[f->numpoints]);
|
|
f->numpoints++;
|
|
}
|
|
if (sides[i] == SIDE_BACK)
|
|
{
|
|
VectorCopy (p1, b->p[b->numpoints]);
|
|
b->numpoints++;
|
|
}
|
|
|
|
if (sides[i+1] == SIDE_ON || sides[i+1] == sides[i])
|
|
continue;
|
|
|
|
// generate a split point
|
|
p2 = in->p[(i+1)%in->numpoints];
|
|
|
|
dot = dists[i] / (dists[i]-dists[i+1]);
|
|
for (j=0 ; j<3 ; j++)
|
|
{ // avoid round off error when possible
|
|
if (normal[j] == 1)
|
|
mid[j] = dist;
|
|
else if (normal[j] == -1)
|
|
mid[j] = -dist;
|
|
else
|
|
mid[j] = p1[j] + dot*(p2[j]-p1[j]);
|
|
}
|
|
|
|
VectorCopy (mid, f->p[f->numpoints]);
|
|
f->numpoints++;
|
|
VectorCopy (mid, b->p[b->numpoints]);
|
|
b->numpoints++;
|
|
}
|
|
|
|
if (f->numpoints > maxpts || b->numpoints > maxpts)
|
|
Error ("ClipWinding: points exceeded estimate");
|
|
if (f->numpoints > MAX_POINTS_ON_WINDING || b->numpoints > MAX_POINTS_ON_WINDING)
|
|
Error ("ClipWinding: MAX_POINTS_ON_WINDING");
|
|
}
|
|
|
|
|
|
/*
|
|
=============
|
|
ChopWindingInPlace
|
|
=============
|
|
*/
|
|
void ChopWindingInPlace (winding_t **inout, vec3_t normal, vec_t dist, vec_t epsilon)
|
|
{
|
|
winding_t *in;
|
|
vec_t dists[MAX_POINTS_ON_WINDING+4];
|
|
int sides[MAX_POINTS_ON_WINDING+4];
|
|
int counts[3];
|
|
//MrElusive: DOH can't use statics when unsing multithreading!!!
|
|
vec_t dot; // VC 4.2 optimizer bug if not static
|
|
int i, j;
|
|
vec_t *p1, *p2;
|
|
vec3_t mid;
|
|
winding_t *f;
|
|
int maxpts;
|
|
|
|
in = *inout;
|
|
counts[0] = counts[1] = counts[2] = 0;
|
|
|
|
// determine sides for each point
|
|
for (i=0 ; i<in->numpoints ; i++)
|
|
{
|
|
dot = DotProduct (in->p[i], normal);
|
|
dot -= dist;
|
|
dists[i] = dot;
|
|
if (dot > epsilon)
|
|
sides[i] = SIDE_FRONT;
|
|
else if (dot < -epsilon)
|
|
sides[i] = SIDE_BACK;
|
|
else
|
|
{
|
|
sides[i] = SIDE_ON;
|
|
}
|
|
counts[sides[i]]++;
|
|
}
|
|
sides[i] = sides[0];
|
|
dists[i] = dists[0];
|
|
|
|
if (!counts[0])
|
|
{
|
|
FreeWinding (in);
|
|
*inout = NULL;
|
|
return;
|
|
}
|
|
if (!counts[1])
|
|
return; // inout stays the same
|
|
|
|
maxpts = in->numpoints+4; // cant use counts[0]+2 because
|
|
// of fp grouping errors
|
|
|
|
f = AllocWinding (maxpts);
|
|
|
|
for (i=0 ; i<in->numpoints ; i++)
|
|
{
|
|
p1 = in->p[i];
|
|
|
|
if (sides[i] == SIDE_ON)
|
|
{
|
|
VectorCopy (p1, f->p[f->numpoints]);
|
|
f->numpoints++;
|
|
continue;
|
|
}
|
|
|
|
if (sides[i] == SIDE_FRONT)
|
|
{
|
|
VectorCopy (p1, f->p[f->numpoints]);
|
|
f->numpoints++;
|
|
}
|
|
|
|
if (sides[i+1] == SIDE_ON || sides[i+1] == sides[i])
|
|
continue;
|
|
|
|
// generate a split point
|
|
p2 = in->p[(i+1)%in->numpoints];
|
|
|
|
dot = dists[i] / (dists[i]-dists[i+1]);
|
|
for (j=0 ; j<3 ; j++)
|
|
{ // avoid round off error when possible
|
|
if (normal[j] == 1)
|
|
mid[j] = dist;
|
|
else if (normal[j] == -1)
|
|
mid[j] = -dist;
|
|
else
|
|
mid[j] = p1[j] + dot*(p2[j]-p1[j]);
|
|
}
|
|
|
|
VectorCopy (mid, f->p[f->numpoints]);
|
|
f->numpoints++;
|
|
}
|
|
|
|
if (f->numpoints > maxpts)
|
|
Error ("ClipWinding: points exceeded estimate");
|
|
if (f->numpoints > MAX_POINTS_ON_WINDING)
|
|
Error ("ClipWinding: MAX_POINTS_ON_WINDING");
|
|
|
|
FreeWinding (in);
|
|
*inout = f;
|
|
}
|
|
|
|
|
|
/*
|
|
=================
|
|
ChopWinding
|
|
|
|
Returns the fragment of in that is on the front side
|
|
of the cliping plane. The original is freed.
|
|
=================
|
|
*/
|
|
winding_t *ChopWinding (winding_t *in, vec3_t normal, vec_t dist)
|
|
{
|
|
winding_t *f, *b;
|
|
|
|
ClipWindingEpsilon (in, normal, dist, ON_EPSILON, &f, &b);
|
|
FreeWinding (in);
|
|
if (b)
|
|
FreeWinding (b);
|
|
return f;
|
|
}
|
|
|
|
|
|
/*
|
|
=================
|
|
CheckWinding
|
|
|
|
=================
|
|
*/
|
|
void CheckWinding (winding_t *w)
|
|
{
|
|
int i, j;
|
|
vec_t *p1, *p2;
|
|
vec_t d, edgedist;
|
|
vec3_t dir, edgenormal, facenormal;
|
|
vec_t area;
|
|
vec_t facedist;
|
|
|
|
if (w->numpoints < 3)
|
|
Error ("CheckWinding: %i points",w->numpoints);
|
|
|
|
area = WindingArea(w);
|
|
if (area < 1)
|
|
Error ("CheckWinding: %f area", area);
|
|
|
|
WindingPlane (w, facenormal, &facedist);
|
|
|
|
for (i=0 ; i<w->numpoints ; i++)
|
|
{
|
|
p1 = w->p[i];
|
|
|
|
for (j=0 ; j<3 ; j++)
|
|
if (p1[j] > BOGUS_RANGE || p1[j] < -BOGUS_RANGE)
|
|
Error ("CheckWinding: BUGUS_RANGE: %f",p1[j]);
|
|
|
|
j = i+1 == w->numpoints ? 0 : i+1;
|
|
|
|
// check the point is on the face plane
|
|
d = DotProduct (p1, facenormal) - facedist;
|
|
if (d < -ON_EPSILON || d > ON_EPSILON)
|
|
Error ("CheckWinding: point off plane");
|
|
|
|
// check the edge isnt degenerate
|
|
p2 = w->p[j];
|
|
VectorSubtract (p2, p1, dir);
|
|
|
|
if (VectorLength (dir) < ON_EPSILON)
|
|
Error ("CheckWinding: degenerate edge");
|
|
|
|
CrossProduct (facenormal, dir, edgenormal);
|
|
VectorNormalize (edgenormal);
|
|
edgedist = DotProduct (p1, edgenormal);
|
|
edgedist += ON_EPSILON;
|
|
|
|
// all other points must be on front side
|
|
for (j=0 ; j<w->numpoints ; j++)
|
|
{
|
|
if (j == i)
|
|
continue;
|
|
d = DotProduct (w->p[j], edgenormal);
|
|
if (d > edgedist)
|
|
Error ("CheckWinding: non-convex");
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
============
|
|
WindingOnPlaneSide
|
|
============
|
|
*/
|
|
int WindingOnPlaneSide (winding_t *w, vec3_t normal, vec_t dist)
|
|
{
|
|
qboolean front, back;
|
|
int i;
|
|
vec_t d;
|
|
|
|
front = false;
|
|
back = false;
|
|
for (i=0 ; i<w->numpoints ; i++)
|
|
{
|
|
d = DotProduct (w->p[i], normal) - dist;
|
|
if (d < -ON_EPSILON)
|
|
{
|
|
if (front)
|
|
return SIDE_CROSS;
|
|
back = true;
|
|
continue;
|
|
}
|
|
if (d > ON_EPSILON)
|
|
{
|
|
if (back)
|
|
return SIDE_CROSS;
|
|
front = true;
|
|
continue;
|
|
}
|
|
}
|
|
|
|
if (back)
|
|
return SIDE_BACK;
|
|
if (front)
|
|
return SIDE_FRONT;
|
|
return SIDE_ON;
|
|
}
|
|
|
|
//#ifdef ME
|
|
#define CONTINUOUS_EPSILON 0.005
|
|
//#else
|
|
// #define CONTINUOUS_EPSILON 0.001
|
|
//#endif
|
|
|
|
/*
|
|
=============
|
|
TryMergeWinding
|
|
|
|
If two polygons share a common edge and the edges that meet at the
|
|
common points are both inside the other polygons, merge them
|
|
|
|
Returns NULL if the faces couldn't be merged, or the new face.
|
|
The originals will NOT be freed.
|
|
=============
|
|
*/
|
|
|
|
winding_t *TryMergeWinding (winding_t *f1, winding_t *f2, vec3_t planenormal)
|
|
{
|
|
vec_t *p1, *p2, *p3, *p4, *back;
|
|
winding_t *newf;
|
|
int i, j, k, l;
|
|
vec3_t normal, delta;
|
|
vec_t dot;
|
|
qboolean keep1, keep2;
|
|
|
|
|
|
//
|
|
// find a common edge
|
|
//
|
|
p1 = p2 = NULL; // stop compiler warning
|
|
j = 0; //
|
|
|
|
for (i = 0; i < f1->numpoints; i++)
|
|
{
|
|
p1 = f1->p[i];
|
|
p2 = f1->p[(i+1) % f1->numpoints];
|
|
for (j = 0; j < f2->numpoints; j++)
|
|
{
|
|
p3 = f2->p[j];
|
|
p4 = f2->p[(j+1) % f2->numpoints];
|
|
for (k = 0; k < 3; k++)
|
|
{
|
|
if (fabs(p1[k] - p4[k]) > 0.1)//EQUAL_EPSILON) //ME
|
|
break;
|
|
if (fabs(p2[k] - p3[k]) > 0.1)//EQUAL_EPSILON) //ME
|
|
break;
|
|
} //end for
|
|
if (k==3)
|
|
break;
|
|
} //end for
|
|
if (j < f2->numpoints)
|
|
break;
|
|
} //end for
|
|
|
|
if (i == f1->numpoints)
|
|
return NULL; // no matching edges
|
|
|
|
//
|
|
// check slope of connected lines
|
|
// if the slopes are colinear, the point can be removed
|
|
//
|
|
back = f1->p[(i+f1->numpoints-1)%f1->numpoints];
|
|
VectorSubtract (p1, back, delta);
|
|
CrossProduct (planenormal, delta, normal);
|
|
VectorNormalize (normal);
|
|
|
|
back = f2->p[(j+2)%f2->numpoints];
|
|
VectorSubtract (back, p1, delta);
|
|
dot = DotProduct (delta, normal);
|
|
if (dot > CONTINUOUS_EPSILON)
|
|
return NULL; // not a convex polygon
|
|
keep1 = (qboolean)(dot < -CONTINUOUS_EPSILON);
|
|
|
|
back = f1->p[(i+2)%f1->numpoints];
|
|
VectorSubtract (back, p2, delta);
|
|
CrossProduct (planenormal, delta, normal);
|
|
VectorNormalize (normal);
|
|
|
|
back = f2->p[(j+f2->numpoints-1)%f2->numpoints];
|
|
VectorSubtract (back, p2, delta);
|
|
dot = DotProduct (delta, normal);
|
|
if (dot > CONTINUOUS_EPSILON)
|
|
return NULL; // not a convex polygon
|
|
keep2 = (qboolean)(dot < -CONTINUOUS_EPSILON);
|
|
|
|
//
|
|
// build the new polygon
|
|
//
|
|
newf = AllocWinding (f1->numpoints + f2->numpoints);
|
|
|
|
// copy first polygon
|
|
for (k=(i+1)%f1->numpoints ; k != i ; k=(k+1)%f1->numpoints)
|
|
{
|
|
if (k==(i+1)%f1->numpoints && !keep2)
|
|
continue;
|
|
|
|
VectorCopy (f1->p[k], newf->p[newf->numpoints]);
|
|
newf->numpoints++;
|
|
}
|
|
|
|
// copy second polygon
|
|
for (l= (j+1)%f2->numpoints ; l != j ; l=(l+1)%f2->numpoints)
|
|
{
|
|
if (l==(j+1)%f2->numpoints && !keep1)
|
|
continue;
|
|
VectorCopy (f2->p[l], newf->p[newf->numpoints]);
|
|
newf->numpoints++;
|
|
}
|
|
|
|
return newf;
|
|
}
|
|
|
|
//#ifdef ME
|
|
//===========================================================================
|
|
//
|
|
// Parameter: -
|
|
// Returns: -
|
|
// Changes Globals: -
|
|
//===========================================================================
|
|
winding_t *MergeWindings(winding_t *w1, winding_t *w2, vec3_t planenormal)
|
|
{
|
|
winding_t *neww;
|
|
float dist;
|
|
int i, j, n, found, insertafter;
|
|
int sides[MAX_POINTS_ON_WINDING+4];
|
|
vec3_t newp[MAX_POINTS_ON_WINDING+4];
|
|
int numpoints;
|
|
vec3_t edgevec, sepnormal, v;
|
|
|
|
RemoveEqualPoints(w1, 0.2);
|
|
numpoints = w1->numpoints;
|
|
memcpy(newp, w1->p, w1->numpoints * sizeof(vec3_t));
|
|
//
|
|
for (i = 0; i < w2->numpoints; i++)
|
|
{
|
|
VectorCopy(w2->p[i], v);
|
|
for (j = 0; j < numpoints; j++)
|
|
{
|
|
VectorSubtract(newp[(j+1)%numpoints],
|
|
newp[(j)%numpoints], edgevec);
|
|
CrossProduct(edgevec, planenormal, sepnormal);
|
|
VectorNormalize(sepnormal);
|
|
if (VectorLength(sepnormal) < 0.9)
|
|
{
|
|
//remove the point from the new winding
|
|
for (n = j; n < numpoints-1; n++)
|
|
{
|
|
VectorCopy(newp[n+1], newp[n]);
|
|
sides[n] = sides[n+1];
|
|
} //end for
|
|
numpoints--;
|
|
j--;
|
|
Log_Print("MergeWindings: degenerate edge on winding %f %f %f\n", sepnormal[0],
|
|
sepnormal[1],
|
|
sepnormal[2]);
|
|
continue;
|
|
} //end if
|
|
dist = DotProduct(newp[(j)%numpoints], sepnormal);
|
|
if (DotProduct(v, sepnormal) - dist < -0.1) sides[j] = SIDE_BACK;
|
|
else sides[j] = SIDE_FRONT;
|
|
} //end for
|
|
//remove all unnecesary points
|
|
for (j = 0; j < numpoints;)
|
|
{
|
|
if (sides[j] == SIDE_BACK
|
|
&& sides[(j+1)%numpoints] == SIDE_BACK)
|
|
{
|
|
//remove the point from the new winding
|
|
for (n = (j+1)%numpoints; n < numpoints-1; n++)
|
|
{
|
|
VectorCopy(newp[n+1], newp[n]);
|
|
sides[n] = sides[n+1];
|
|
} //end for
|
|
numpoints--;
|
|
} //end if
|
|
else
|
|
{
|
|
j++;
|
|
} //end else
|
|
} //end for
|
|
//
|
|
found = false;
|
|
for (j = 0; j < numpoints; j++)
|
|
{
|
|
if (sides[j] == SIDE_FRONT
|
|
&& sides[(j+1)%numpoints] == SIDE_BACK)
|
|
{
|
|
if (found) Log_Print("Warning: MergeWindings: front to back found twice\n");
|
|
found = true;
|
|
} //end if
|
|
} //end for
|
|
//
|
|
for (j = 0; j < numpoints; j++)
|
|
{
|
|
if (sides[j] == SIDE_FRONT
|
|
&& sides[(j+1)%numpoints] == SIDE_BACK)
|
|
{
|
|
insertafter = (j+1)%numpoints;
|
|
//insert the new point after j+1
|
|
for (n = numpoints-1; n > insertafter; n--)
|
|
{
|
|
VectorCopy(newp[n], newp[n+1]);
|
|
} //end for
|
|
numpoints++;
|
|
VectorCopy(v, newp[(insertafter+1)%numpoints]);
|
|
break;
|
|
} //end if
|
|
} //end for
|
|
} //end for
|
|
neww = AllocWinding(numpoints);
|
|
neww->numpoints = numpoints;
|
|
memcpy(neww->p, newp, numpoints * sizeof(vec3_t));
|
|
RemoveColinearPoints(neww);
|
|
return neww;
|
|
} //end of the function MergeWindings
|
|
//===========================================================================
|
|
//
|
|
// Parameter: -
|
|
// Returns: -
|
|
// Changes Globals: -
|
|
//===========================================================================
|
|
char *WindingErrorString(void)
|
|
{
|
|
return windingerror;
|
|
} //end of the function WindingErrorString
|
|
//===========================================================================
|
|
//
|
|
// Parameter: -
|
|
// Returns: -
|
|
// Changes Globals: -
|
|
//===========================================================================
|
|
int WindingError(winding_t *w)
|
|
{
|
|
int i, j;
|
|
vec_t *p1, *p2;
|
|
vec_t d, edgedist;
|
|
vec3_t dir, edgenormal, facenormal;
|
|
vec_t area;
|
|
vec_t facedist;
|
|
|
|
if (w->numpoints < 3)
|
|
{
|
|
sprintf(windingerror, "winding %i points", w->numpoints);
|
|
return WE_NOTENOUGHPOINTS;
|
|
} //end if
|
|
|
|
area = WindingArea(w);
|
|
if (area < 1)
|
|
{
|
|
sprintf(windingerror, "winding %f area", area);
|
|
return WE_SMALLAREA;
|
|
} //end if
|
|
|
|
WindingPlane (w, facenormal, &facedist);
|
|
|
|
for (i=0 ; i<w->numpoints ; i++)
|
|
{
|
|
p1 = w->p[i];
|
|
|
|
for (j=0 ; j<3 ; j++)
|
|
{
|
|
if (p1[j] > BOGUS_RANGE || p1[j] < -BOGUS_RANGE)
|
|
{
|
|
sprintf(windingerror, "winding point %d BUGUS_RANGE \'%f %f %f\'", j, p1[0], p1[1], p1[2]);
|
|
return WE_POINTBOGUSRANGE;
|
|
} //end if
|
|
} //end for
|
|
|
|
j = i+1 == w->numpoints ? 0 : i+1;
|
|
|
|
// check the point is on the face plane
|
|
d = DotProduct (p1, facenormal) - facedist;
|
|
if (d < -ON_EPSILON || d > ON_EPSILON)
|
|
{
|
|
sprintf(windingerror, "winding point %d off plane", i);
|
|
return WE_POINTOFFPLANE;
|
|
} //end if
|
|
|
|
// check the edge isnt degenerate
|
|
p2 = w->p[j];
|
|
VectorSubtract (p2, p1, dir);
|
|
|
|
if (VectorLength (dir) < ON_EPSILON)
|
|
{
|
|
sprintf(windingerror, "winding degenerate edge %d-%d", i, j);
|
|
return WE_DEGENERATEEDGE;
|
|
} //end if
|
|
|
|
CrossProduct (facenormal, dir, edgenormal);
|
|
VectorNormalize (edgenormal);
|
|
edgedist = DotProduct (p1, edgenormal);
|
|
edgedist += ON_EPSILON;
|
|
|
|
// all other points must be on front side
|
|
for (j=0 ; j<w->numpoints ; j++)
|
|
{
|
|
if (j == i)
|
|
continue;
|
|
d = DotProduct (w->p[j], edgenormal);
|
|
if (d > edgedist)
|
|
{
|
|
sprintf(windingerror, "winding non-convex");
|
|
return WE_NONCONVEX;
|
|
} //end if
|
|
} //end for
|
|
} //end for
|
|
return WE_NONE;
|
|
} //end of the function WindingError
|
|
//===========================================================================
|
|
//
|
|
// Parameter: -
|
|
// Returns: -
|
|
// Changes Globals: -
|
|
//===========================================================================
|
|
void RemoveEqualPoints(winding_t *w, float epsilon)
|
|
{
|
|
int i, nump;
|
|
vec3_t v;
|
|
vec3_t p[MAX_POINTS_ON_WINDING];
|
|
|
|
VectorCopy(w->p[0], p[0]);
|
|
nump = 1;
|
|
for (i = 1; i < w->numpoints; i++)
|
|
{
|
|
VectorSubtract(w->p[i], p[nump-1], v);
|
|
if (VectorLength(v) > epsilon)
|
|
{
|
|
if (nump >= MAX_POINTS_ON_WINDING)
|
|
Error("RemoveColinearPoints: MAX_POINTS_ON_WINDING");
|
|
VectorCopy (w->p[i], p[nump]);
|
|
nump++;
|
|
} //end if
|
|
} //end for
|
|
|
|
if (nump == w->numpoints)
|
|
return;
|
|
|
|
w->numpoints = nump;
|
|
memcpy(w->p, p, nump * sizeof(p[0]));
|
|
} //end of the function RemoveEqualPoints
|
|
//===========================================================================
|
|
// adds the given point to a winding at the given spot
|
|
// (for instance when spot is zero then the point is added at position zero)
|
|
// the original winding is NOT freed
|
|
//
|
|
// Parameter: -
|
|
// Returns: the new winding with the added point
|
|
// Changes Globals: -
|
|
//===========================================================================
|
|
winding_t *AddWindingPoint(winding_t *w, vec3_t point, int spot)
|
|
{
|
|
int i, j;
|
|
winding_t *neww;
|
|
|
|
if (spot > w->numpoints)
|
|
{
|
|
Error("AddWindingPoint: num > w->numpoints");
|
|
} //end if
|
|
if (spot < 0)
|
|
{
|
|
Error("AddWindingPoint: num < 0");
|
|
} //end if
|
|
neww = AllocWinding(w->numpoints + 1);
|
|
neww->numpoints = w->numpoints + 1;
|
|
for (i = 0, j = 0; i < neww->numpoints; i++)
|
|
{
|
|
if (i == spot)
|
|
{
|
|
VectorCopy(point, neww->p[i]);
|
|
} //end if
|
|
else
|
|
{
|
|
VectorCopy(w->p[j], neww->p[i]);
|
|
j++;
|
|
} //end else
|
|
} //end for
|
|
return neww;
|
|
} //end of the function AddWindingPoint
|
|
//===========================================================================
|
|
// the position where the new point should be added in the winding is
|
|
// stored in *spot
|
|
//
|
|
// Parameter: -
|
|
// Returns: true if the point is on the winding
|
|
// Changes Globals: -
|
|
//===========================================================================
|
|
#define MELT_ON_EPSILON 0.2
|
|
|
|
int PointOnWinding(winding_t *w, vec3_t normal, float dist, vec3_t point, int *spot)
|
|
{
|
|
int i, j;
|
|
vec3_t v1, v2;
|
|
vec3_t edgenormal, edgevec;
|
|
float edgedist, dot;
|
|
|
|
*spot = 0;
|
|
//the point must be on the winding plane
|
|
dot = DotProduct(point, normal) - dist;
|
|
if (dot < -MELT_ON_EPSILON || dot > MELT_ON_EPSILON) return false;
|
|
//
|
|
for (i = 0; i < w->numpoints; i++)
|
|
{
|
|
j = (i+1) % w->numpoints;
|
|
//get a plane orthogonal to the winding plane through the edge
|
|
VectorSubtract(w->p[j], w->p[i], edgevec);
|
|
CrossProduct(normal, edgevec, edgenormal);
|
|
VectorNormalize(edgenormal);
|
|
edgedist = DotProduct(edgenormal, w->p[i]);
|
|
//point must be not too far from the plane
|
|
dot = DotProduct(point, edgenormal) - edgedist;
|
|
if (dot < -MELT_ON_EPSILON || dot > MELT_ON_EPSILON) continue;
|
|
//vector from first point of winding to the point to test
|
|
VectorSubtract(point, w->p[i], v1);
|
|
//vector from second point of winding to the point to test
|
|
VectorSubtract(point, w->p[j], v2);
|
|
//if the length of the vector is not larger than 0.5 units then
|
|
//the point is assumend to be the same as one of the winding points
|
|
if (VectorNormalize(v1) < 0.5) return false;
|
|
if (VectorNormalize(v2) < 0.5) return false;
|
|
//point must be between the two winding points
|
|
//(the two vectors must be directed towards each other, and on the
|
|
//same straight line)
|
|
if (DotProduct(v1, v2) < -0.99)
|
|
{
|
|
*spot = i + 1;
|
|
return true;
|
|
} //end if
|
|
} //end for
|
|
return false;
|
|
} //end of the function PointOnWinding
|
|
//===========================================================================
|
|
//
|
|
// Parameter: -
|
|
// Returns: -
|
|
// Changes Globals: -
|
|
//===========================================================================
|
|
int FindPlaneSeperatingWindings(winding_t *w1, winding_t *w2, vec3_t dir,
|
|
vec3_t normal, float *dist)
|
|
{
|
|
int i, i2, j, j2, n;
|
|
int sides1[3], sides2[3];
|
|
float dist1, dist2, dot, diff;
|
|
vec3_t normal1, normal2;
|
|
vec3_t v1, v2;
|
|
|
|
for (i = 0; i < w1->numpoints; i++)
|
|
{
|
|
i2 = (i+1) % w1->numpoints;
|
|
//
|
|
VectorSubtract(w1->p[i2], w1->p[i], v1);
|
|
if (VectorLength(v1) < 0.1)
|
|
{
|
|
//Log_Write("FindPlaneSeperatingWindings: winding1 with degenerate edge\r\n");
|
|
continue;
|
|
} //end if
|
|
CrossProduct(v1, dir, normal1);
|
|
VectorNormalize(normal1);
|
|
dist1 = DotProduct(normal1, w1->p[i]);
|
|
//
|
|
for (j = 0; j < w2->numpoints; j++)
|
|
{
|
|
j2 = (j+1) % w2->numpoints;
|
|
//
|
|
VectorSubtract(w2->p[j2], w2->p[j], v2);
|
|
if (VectorLength(v2) < 0.1)
|
|
{
|
|
//Log_Write("FindPlaneSeperatingWindings: winding2 with degenerate edge\r\n");
|
|
continue;
|
|
} //end if
|
|
CrossProduct(v2, dir, normal2);
|
|
VectorNormalize(normal2);
|
|
dist2 = DotProduct(normal2, w2->p[j]);
|
|
//
|
|
diff = dist1 - dist2;
|
|
if (diff < -0.1 || diff > 0.1)
|
|
{
|
|
dist2 = -dist2;
|
|
VectorNegate(normal2, normal2);
|
|
diff = dist1 - dist2;
|
|
if (diff < -0.1 || diff > 0.1) continue;
|
|
} //end if
|
|
//check if the normal vectors are equal
|
|
for (n = 0; n < 3; n++)
|
|
{
|
|
diff = normal1[n] - normal2[n];
|
|
if (diff < -0.0001 || diff > 0.0001) break;
|
|
} //end for
|
|
if (n != 3) continue;
|
|
//check on which side of the seperating plane the points of
|
|
//the first winding are
|
|
sides1[0] = sides1[1] = sides1[2] = 0;
|
|
for (n = 0; n < w1->numpoints; n++)
|
|
{
|
|
dot = DotProduct(w1->p[n], normal1) - dist1;
|
|
if (dot > 0.1) sides1[0]++;
|
|
else if (dot < -0.1) sides1[1]++;
|
|
else sides1[2]++;
|
|
} //end for
|
|
//check on which side of the seperating plane the points of
|
|
//the second winding are
|
|
sides2[0] = sides2[1] = sides2[2] = 0;
|
|
for (n = 0; n < w2->numpoints; n++)
|
|
{
|
|
//used normal1 and dist1 (they are equal to normal2 and dist2)
|
|
dot = DotProduct(w2->p[n], normal1) - dist1;
|
|
if (dot > 0.1) sides2[0]++;
|
|
else if (dot < -0.1) sides2[1]++;
|
|
else sides2[2]++;
|
|
} //end for
|
|
//if the first winding has points at both sides
|
|
if (sides1[0] && sides1[1])
|
|
{
|
|
Log_Write("FindPlaneSeperatingWindings: winding1 non-convex\r\n");
|
|
continue;
|
|
} //end if
|
|
//if the second winding has points at both sides
|
|
if (sides2[0] && sides2[1])
|
|
{
|
|
Log_Write("FindPlaneSeperatingWindings: winding2 non-convex\r\n");
|
|
continue;
|
|
} //end if
|
|
//
|
|
if ((!sides1[0] && !sides1[1]) || (!sides2[0] && !sides2[1]))
|
|
{
|
|
//don't use one of the winding planes as the seperating plane
|
|
continue;
|
|
} //end if
|
|
//the windings must be at different sides of the seperating plane
|
|
if ((!sides1[0] && !sides2[1]) || (!sides1[1] && !sides2[0]))
|
|
{
|
|
VectorCopy(normal1, normal);
|
|
*dist = dist1;
|
|
return true;
|
|
} //end if
|
|
} //end for
|
|
} //end for
|
|
return false;
|
|
} //end of the function FindPlaneSeperatingWindings
|
|
//===========================================================================
|
|
//
|
|
// Parameter: -
|
|
// Returns: -
|
|
// Changes Globals: -
|
|
//===========================================================================
|
|
#define WCONVEX_EPSILON 0.2
|
|
|
|
int WindingsNonConvex(winding_t *w1, winding_t *w2,
|
|
vec3_t normal1, vec3_t normal2,
|
|
float dist1, float dist2)
|
|
{
|
|
int i;
|
|
|
|
if (!w1 || !w2) return false;
|
|
|
|
//check if one of the points of face1 is at the back of the plane of face2
|
|
for (i = 0; i < w1->numpoints; i++)
|
|
{
|
|
if (DotProduct(normal2, w1->p[i]) - dist2 > WCONVEX_EPSILON) return true;
|
|
} //end for
|
|
//check if one of the points of face2 is at the back of the plane of face1
|
|
for (i = 0; i < w2->numpoints; i++)
|
|
{
|
|
if (DotProduct(normal1, w2->p[i]) - dist1 > WCONVEX_EPSILON) return true;
|
|
} //end for
|
|
|
|
return false;
|
|
} //end of the function WindingsNonConvex
|
|
//===========================================================================
|
|
//
|
|
// Parameter: -
|
|
// Returns: -
|
|
// Changes Globals: -
|
|
//===========================================================================
|
|
/*
|
|
#define VERTEX_EPSILON 0.5
|
|
|
|
qboolean EqualVertexes(vec3_t v1, vec3_t v2)
|
|
{
|
|
float diff;
|
|
|
|
diff = v1[0] - v2[0];
|
|
if (diff > -VERTEX_EPSILON && diff < VERTEX_EPSILON)
|
|
{
|
|
diff = v1[1] - v2[1];
|
|
if (diff > -VERTEX_EPSILON && diff < VERTEX_EPSILON)
|
|
{
|
|
diff = v1[2] - v2[2];
|
|
if (diff > -VERTEX_EPSILON && diff < VERTEX_EPSILON)
|
|
{
|
|
return true;
|
|
} //end if
|
|
} //end if
|
|
} //end if
|
|
return false;
|
|
} //end of the function EqualVertexes
|
|
|
|
#define CONTINUOUS_EPSILON 0.001
|
|
|
|
winding_t *AAS_MergeWindings(winding_t *w1, winding_t *w2, vec3_t windingnormal)
|
|
{
|
|
int n, i, k;
|
|
vec3_t normal, delta;
|
|
winding_t *winding, *neww;
|
|
float dist, dot;
|
|
int p1, p2;
|
|
int points[2][64];
|
|
int numpoints[2] = {0, 0};
|
|
int newnumpoints;
|
|
int keep[2];
|
|
|
|
if (!FindPlaneSeperatingWindings(w1, w2, windingnormal, normal, &dist)) return NULL;
|
|
|
|
//for both windings
|
|
for (n = 0; n < 2; n++)
|
|
{
|
|
if (n == 0) winding = w1;
|
|
else winding = w2;
|
|
//get the points of the winding which are on the seperating plane
|
|
for (i = 0; i < winding->numpoints; i++)
|
|
{
|
|
dot = DotProduct(winding->p[i], normal) - dist;
|
|
if (dot > -ON_EPSILON && dot < ON_EPSILON)
|
|
{
|
|
//don't allow more than 64 points on the seperating plane
|
|
if (numpoints[n] >= 64) Error("AAS_MergeWindings: more than 64 points on seperating plane\n");
|
|
points[n][numpoints[n]++] = i;
|
|
} //end if
|
|
} //end for
|
|
//there must be at least two points of each winding on the seperating plane
|
|
if (numpoints[n] < 2) return NULL;
|
|
} //end for
|
|
|
|
//if the first point of winding1 (which is on the seperating plane) is unequal
|
|
//to the last point of winding2 (which is on the seperating plane)
|
|
if (!EqualVertexes(w1->p[points[0][0]], w2->p[points[1][numpoints[1]-1]]))
|
|
{
|
|
return NULL;
|
|
} //end if
|
|
//if the last point of winding1 (which is on the seperating plane) is unequal
|
|
//to the first point of winding2 (which is on the seperating plane)
|
|
if (!EqualVertexes(w1->p[points[0][numpoints[0]-1]], w2->p[points[1][0]]))
|
|
{
|
|
return NULL;
|
|
} //end if
|
|
//
|
|
// check slope of connected lines
|
|
// if the slopes are colinear, the point can be removed
|
|
//
|
|
//first point of winding1 which is on the seperating plane
|
|
p1 = points[0][0];
|
|
//point before p1
|
|
p2 = (p1 + w1->numpoints - 1) % w1->numpoints;
|
|
VectorSubtract(w1->p[p1], w1->p[p2], delta);
|
|
CrossProduct(windingnormal, delta, normal);
|
|
VectorNormalize(normal, normal);
|
|
|
|
//last point of winding2 which is on the seperating plane
|
|
p1 = points[1][numpoints[1]-1];
|
|
//point after p1
|
|
p2 = (p1 + 1) % w2->numpoints;
|
|
VectorSubtract(w2->p[p2], w2->p[p1], delta);
|
|
dot = DotProduct(delta, normal);
|
|
if (dot > CONTINUOUS_EPSILON) return NULL; //merging would create a non-convex polygon
|
|
keep[0] = (qboolean)(dot < -CONTINUOUS_EPSILON);
|
|
|
|
//first point of winding2 which is on the seperating plane
|
|
p1 = points[1][0];
|
|
//point before p1
|
|
p2 = (p1 + w2->numpoints - 1) % w2->numpoints;
|
|
VectorSubtract(w2->p[p1], w2->p[p2], delta);
|
|
CrossProduct(windingnormal, delta, normal);
|
|
VectorNormalize(normal, normal);
|
|
|
|
//last point of winding1 which is on the seperating plane
|
|
p1 = points[0][numpoints[0]-1];
|
|
//point after p1
|
|
p2 = (p1 + 1) % w1->numpoints;
|
|
VectorSubtract(w1->p[p2], w1->p[p1], delta);
|
|
dot = DotProduct(delta, normal);
|
|
if (dot > CONTINUOUS_EPSILON) return NULL; //merging would create a non-convex polygon
|
|
keep[1] = (qboolean)(dot < -CONTINUOUS_EPSILON);
|
|
|
|
//number of points on the new winding
|
|
newnumpoints = w1->numpoints - numpoints[0] + w2->numpoints - numpoints[1] + 2;
|
|
//allocate the winding
|
|
neww = AllocWinding(newnumpoints);
|
|
neww->numpoints = newnumpoints;
|
|
//copy all the points
|
|
k = 0;
|
|
//for both windings
|
|
for (n = 0; n < 2; n++)
|
|
{
|
|
if (n == 0) winding = w1;
|
|
else winding = w2;
|
|
//copy the points of the winding starting with the last point on the
|
|
//seperating plane and ending before the first point on the seperating plane
|
|
for (i = points[n][numpoints[n]-1]; i != points[n][0]; i = (i+1)%winding->numpoints)
|
|
{
|
|
if (k >= newnumpoints)
|
|
{
|
|
Log_Print("numpoints[0] = %d\n", numpoints[0]);
|
|
Log_Print("numpoints[1] = %d\n", numpoints[1]);
|
|
Error("AAS_MergeWindings: k = %d >= newnumpoints = %d\n", k, newnumpoints);
|
|
} //end if
|
|
VectorCopy(winding->p[i], neww->p[k]);
|
|
k++;
|
|
} //end for
|
|
} //end for
|
|
RemoveEqualPoints(neww);
|
|
if (!WindingIsOk(neww, 1))
|
|
{
|
|
Log_Print("AAS_MergeWindings: winding not ok after merging\n");
|
|
FreeWinding(neww);
|
|
return NULL;
|
|
} //end if
|
|
return neww;
|
|
} //end of the function AAS_MergeWindings*/
|
|
//#endif //ME
|