#include <stddef.h>
#include <assert.h>
#include "mesh.h"
#include "geom.h"
#include "bucketalloc.h"
#define TRUE 1
#define FALSE 0
typedef struct { TESShalfEdge e, eSym; } EdgePair;
static TESShalfEdge *MakeEdge( TESSmesh* mesh, TESShalfEdge *eNext )
{
TESShalfEdge *e;
TESShalfEdge *eSym;
TESShalfEdge *ePrev;
EdgePair *pair = (EdgePair *)bucketAlloc( mesh->edgeBucket );
if (pair == NULL) return NULL;
e = &pair->e;
eSym = &pair->eSym;
if( eNext->Sym < eNext ) { eNext = eNext->Sym; }
ePrev = eNext->Sym->next;
eSym->next = ePrev;
ePrev->Sym->next = e;
e->next = eNext;
eNext->Sym->next = eSym;
e->Sym = eSym;
e->Onext = e;
e->Lnext = eSym;
e->Org = NULL;
e->Lface = NULL;
e->winding = 0;
e->activeRegion = NULL;
e->mark = 0;
eSym->Sym = e;
eSym->Onext = eSym;
eSym->Lnext = e;
eSym->Org = NULL;
eSym->Lface = NULL;
eSym->winding = 0;
eSym->activeRegion = NULL;
eSym->mark = 0;
return e;
}
static void Splice( TESShalfEdge *a, TESShalfEdge *b )
{
TESShalfEdge *aOnext = a->Onext;
TESShalfEdge *bOnext = b->Onext;
aOnext->Sym->Lnext = b;
bOnext->Sym->Lnext = a;
a->Onext = bOnext;
b->Onext = aOnext;
}
static void MakeVertex( TESSvertex *newVertex,
TESShalfEdge *eOrig, TESSvertex *vNext )
{
TESShalfEdge *e;
TESSvertex *vPrev;
TESSvertex *vNew = newVertex;
assert(vNew != NULL);
vPrev = vNext->prev;
vNew->prev = vPrev;
vPrev->next = vNew;
vNew->next = vNext;
vNext->prev = vNew;
vNew->anEdge = eOrig;
e = eOrig;
do {
e->Org = vNew;
e = e->Onext;
} while( e != eOrig );
}
static void MakeFace( TESSface *newFace, TESShalfEdge *eOrig, TESSface *fNext )
{
TESShalfEdge *e;
TESSface *fPrev;
TESSface *fNew = newFace;
assert(fNew != NULL);
fPrev = fNext->prev;
fNew->prev = fPrev;
fPrev->next = fNew;
fNew->next = fNext;
fNext->prev = fNew;
fNew->anEdge = eOrig;
fNew->trail = NULL;
fNew->marked = FALSE;
fNew->inside = fNext->inside;
e = eOrig;
do {
e->Lface = fNew;
e = e->Lnext;
} while( e != eOrig );
}
static void KillEdge( TESSmesh *mesh, TESShalfEdge *eDel )
{
TESShalfEdge *ePrev, *eNext;
if( eDel->Sym < eDel ) { eDel = eDel->Sym; }
eNext = eDel->next;
ePrev = eDel->Sym->next;
eNext->Sym->next = ePrev;
ePrev->Sym->next = eNext;
bucketFree( mesh->edgeBucket, eDel );
}
static void KillVertex( TESSmesh *mesh, TESSvertex *vDel, TESSvertex *newOrg )
{
TESShalfEdge *e, *eStart = vDel->anEdge;
TESSvertex *vPrev, *vNext;
e = eStart;
do {
e->Org = newOrg;
e = e->Onext;
} while( e != eStart );
vPrev = vDel->prev;
vNext = vDel->next;
vNext->prev = vPrev;
vPrev->next = vNext;
bucketFree( mesh->vertexBucket, vDel );
}
static void KillFace( TESSmesh *mesh, TESSface *fDel, TESSface *newLface )
{
TESShalfEdge *e, *eStart = fDel->anEdge;
TESSface *fPrev, *fNext;
e = eStart;
do {
e->Lface = newLface;
e = e->Lnext;
} while( e != eStart );
fPrev = fDel->prev;
fNext = fDel->next;
fNext->prev = fPrev;
fPrev->next = fNext;
bucketFree( mesh->faceBucket, fDel );
}
TESShalfEdge *tessMeshMakeEdge( TESSmesh *mesh )
{
TESSvertex *newVertex1 = (TESSvertex*)bucketAlloc(mesh->vertexBucket);
TESSvertex *newVertex2 = (TESSvertex*)bucketAlloc(mesh->vertexBucket);
TESSface *newFace = (TESSface*)bucketAlloc(mesh->faceBucket);
TESShalfEdge *e;
if (newVertex1 == NULL || newVertex2 == NULL || newFace == NULL) {
if (newVertex1 != NULL) bucketFree( mesh->vertexBucket, newVertex1 );
if (newVertex2 != NULL) bucketFree( mesh->vertexBucket, newVertex2 );
if (newFace != NULL) bucketFree( mesh->faceBucket, newFace );
return NULL;
}
e = MakeEdge( mesh, &mesh->eHead );
if (e == NULL) return NULL;
MakeVertex( newVertex1, e, &mesh->vHead );
MakeVertex( newVertex2, e->Sym, &mesh->vHead );
MakeFace( newFace, e, &mesh->fHead );
return e;
}
int tessMeshSplice( TESSmesh* mesh, TESShalfEdge *eOrg, TESShalfEdge *eDst )
{
int joiningLoops = FALSE;
int joiningVertices = FALSE;
if( eOrg == eDst ) return 1;
if( eDst->Org != eOrg->Org ) {
joiningVertices = TRUE;
KillVertex( mesh, eDst->Org, eOrg->Org );
}
if( eDst->Lface != eOrg->Lface ) {
joiningLoops = TRUE;
KillFace( mesh, eDst->Lface, eOrg->Lface );
}
Splice( eDst, eOrg );
if( ! joiningVertices ) {
TESSvertex *newVertex = (TESSvertex*)bucketAlloc( mesh->vertexBucket );
if (newVertex == NULL) return 0;
MakeVertex( newVertex, eDst, eOrg->Org );
eOrg->Org->anEdge = eOrg;
}
if( ! joiningLoops ) {
TESSface *newFace = (TESSface*)bucketAlloc( mesh->faceBucket );
if (newFace == NULL) return 0;
MakeFace( newFace, eDst, eOrg->Lface );
eOrg->Lface->anEdge = eOrg;
}
return 1;
}
int tessMeshDelete( TESSmesh *mesh, TESShalfEdge *eDel )
{
TESShalfEdge *eDelSym = eDel->Sym;
int joiningLoops = FALSE;
if( eDel->Lface != eDel->Rface ) {
joiningLoops = TRUE;
KillFace( mesh, eDel->Lface, eDel->Rface );
}
if( eDel->Onext == eDel ) {
KillVertex( mesh, eDel->Org, NULL );
} else {
eDel->Rface->anEdge = eDel->Oprev;
eDel->Org->anEdge = eDel->Onext;
Splice( eDel, eDel->Oprev );
if( ! joiningLoops ) {
TESSface *newFace= (TESSface*)bucketAlloc( mesh->faceBucket );
if (newFace == NULL) return 0;
MakeFace( newFace, eDel, eDel->Lface );
}
}
if( eDelSym->Onext == eDelSym ) {
KillVertex( mesh, eDelSym->Org, NULL );
KillFace( mesh, eDelSym->Lface, NULL );
} else {
eDel->Lface->anEdge = eDelSym->Oprev;
eDelSym->Org->anEdge = eDelSym->Onext;
Splice( eDelSym, eDelSym->Oprev );
}
KillEdge( mesh, eDel );
return 1;
}
TESShalfEdge *tessMeshAddEdgeVertex( TESSmesh *mesh, TESShalfEdge *eOrg )
{
TESShalfEdge *eNewSym;
TESShalfEdge *eNew = MakeEdge( mesh, eOrg );
if (eNew == NULL) return NULL;
eNewSym = eNew->Sym;
Splice( eNew, eOrg->Lnext );
eNew->Org = eOrg->Dst;
{
TESSvertex *newVertex= (TESSvertex*)bucketAlloc( mesh->vertexBucket );
if (newVertex == NULL) return NULL;
MakeVertex( newVertex, eNewSym, eNew->Org );
}
eNew->Lface = eNewSym->Lface = eOrg->Lface;
return eNew;
}
TESShalfEdge *tessMeshSplitEdge( TESSmesh *mesh, TESShalfEdge *eOrg )
{
TESShalfEdge *eNew;
TESShalfEdge *tempHalfEdge= tessMeshAddEdgeVertex( mesh, eOrg );
if (tempHalfEdge == NULL) return NULL;
eNew = tempHalfEdge->Sym;
Splice( eOrg->Sym, eOrg->Sym->Oprev );
Splice( eOrg->Sym, eNew );
eOrg->Dst = eNew->Org;
eNew->Dst->anEdge = eNew->Sym;
eNew->Rface = eOrg->Rface;
eNew->winding = eOrg->winding;
eNew->Sym->winding = eOrg->Sym->winding;
return eNew;
}
TESShalfEdge *tessMeshConnect( TESSmesh *mesh, TESShalfEdge *eOrg, TESShalfEdge *eDst )
{
TESShalfEdge *eNewSym;
int joiningLoops = FALSE;
TESShalfEdge *eNew = MakeEdge( mesh, eOrg );
if (eNew == NULL) return NULL;
eNewSym = eNew->Sym;
if( eDst->Lface != eOrg->Lface ) {
joiningLoops = TRUE;
KillFace( mesh, eDst->Lface, eOrg->Lface );
}
Splice( eNew, eOrg->Lnext );
Splice( eNewSym, eDst );
eNew->Org = eOrg->Dst;
eNewSym->Org = eDst->Org;
eNew->Lface = eNewSym->Lface = eOrg->Lface;
eOrg->Lface->anEdge = eNewSym;
if( ! joiningLoops ) {
TESSface *newFace= (TESSface*)bucketAlloc( mesh->faceBucket );
if (newFace == NULL) return NULL;
MakeFace( newFace, eNew, eOrg->Lface );
}
return eNew;
}
void tessMeshZapFace( TESSmesh *mesh, TESSface *fZap )
{
TESShalfEdge *eStart = fZap->anEdge;
TESShalfEdge *e, *eNext, *eSym;
TESSface *fPrev, *fNext;
eNext = eStart->Lnext;
do {
e = eNext;
eNext = e->Lnext;
e->Lface = NULL;
if( e->Rface == NULL ) {
if( e->Onext == e ) {
KillVertex( mesh, e->Org, NULL );
} else {
e->Org->anEdge = e->Onext;
Splice( e, e->Oprev );
}
eSym = e->Sym;
if( eSym->Onext == eSym ) {
KillVertex( mesh, eSym->Org, NULL );
} else {
eSym->Org->anEdge = eSym->Onext;
Splice( eSym, eSym->Oprev );
}
KillEdge( mesh, e );
}
} while( e != eStart );
fPrev = fZap->prev;
fNext = fZap->next;
fNext->prev = fPrev;
fPrev->next = fNext;
bucketFree( mesh->faceBucket, fZap );
}
TESSmesh *tessMeshNewMesh( TESSalloc* alloc )
{
TESSvertex *v;
TESSface *f;
TESShalfEdge *e;
TESShalfEdge *eSym;
TESSmesh *mesh = (TESSmesh *)alloc->memalloc( alloc->userData, sizeof( TESSmesh ));
if (mesh == NULL) {
return NULL;
}
if (alloc->meshEdgeBucketSize < 16)
alloc->meshEdgeBucketSize = 16;
if (alloc->meshEdgeBucketSize > 4096)
alloc->meshEdgeBucketSize = 4096;
if (alloc->meshVertexBucketSize < 16)
alloc->meshVertexBucketSize = 16;
if (alloc->meshVertexBucketSize > 4096)
alloc->meshVertexBucketSize = 4096;
if (alloc->meshFaceBucketSize < 16)
alloc->meshFaceBucketSize = 16;
if (alloc->meshFaceBucketSize > 4096)
alloc->meshFaceBucketSize = 4096;
mesh->edgeBucket = createBucketAlloc( alloc, "Mesh Edges", sizeof(EdgePair), alloc->meshEdgeBucketSize );
mesh->vertexBucket = createBucketAlloc( alloc, "Mesh Vertices", sizeof(TESSvertex), alloc->meshVertexBucketSize );
mesh->faceBucket = createBucketAlloc( alloc, "Mesh Faces", sizeof(TESSface), alloc->meshFaceBucketSize );
v = &mesh->vHead;
f = &mesh->fHead;
e = &mesh->eHead;
eSym = &mesh->eHeadSym;
v->next = v->prev = v;
v->anEdge = NULL;
f->next = f->prev = f;
f->anEdge = NULL;
f->trail = NULL;
f->marked = FALSE;
f->inside = FALSE;
e->next = e;
e->Sym = eSym;
e->Onext = NULL;
e->Lnext = NULL;
e->Org = NULL;
e->Lface = NULL;
e->winding = 0;
e->activeRegion = NULL;
eSym->next = eSym;
eSym->Sym = e;
eSym->Onext = NULL;
eSym->Lnext = NULL;
eSym->Org = NULL;
eSym->Lface = NULL;
eSym->winding = 0;
eSym->activeRegion = NULL;
return mesh;
}
TESSmesh *tessMeshUnion( TESSalloc* alloc, TESSmesh *mesh1, TESSmesh *mesh2 )
{
TESSface *f1 = &mesh1->fHead;
TESSvertex *v1 = &mesh1->vHead;
TESShalfEdge *e1 = &mesh1->eHead;
TESSface *f2 = &mesh2->fHead;
TESSvertex *v2 = &mesh2->vHead;
TESShalfEdge *e2 = &mesh2->eHead;
if( f2->next != f2 ) {
f1->prev->next = f2->next;
f2->next->prev = f1->prev;
f2->prev->next = f1;
f1->prev = f2->prev;
}
if( v2->next != v2 ) {
v1->prev->next = v2->next;
v2->next->prev = v1->prev;
v2->prev->next = v1;
v1->prev = v2->prev;
}
if( e2->next != e2 ) {
e1->Sym->next->Sym->next = e2->next;
e2->next->Sym->next = e1->Sym->next;
e2->Sym->next->Sym->next = e1;
e1->Sym->next = e2->Sym->next;
}
alloc->memfree( alloc->userData, mesh2 );
return mesh1;
}
static int CountFaceVerts( TESSface *f )
{
TESShalfEdge *eCur = f->anEdge;
int n = 0;
do
{
n++;
eCur = eCur->Lnext;
}
while (eCur != f->anEdge);
return n;
}
int tessMeshMergeConvexFaces( TESSmesh *mesh, int maxVertsPerFace )
{
TESShalfEdge *e, *eNext, *eSym;
TESShalfEdge *eHead = &mesh->eHead;
TESSvertex *va, *vb, *vc, *vd, *ve, *vf;
int leftNv, rightNv;
for( e = eHead->next; e != eHead; e = eNext )
{
eNext = e->next;
eSym = e->Sym;
if( !eSym )
continue;
if( !e->Lface || !e->Lface->inside )
continue;
if( !eSym->Lface || !eSym->Lface->inside )
continue;
leftNv = CountFaceVerts( e->Lface );
rightNv = CountFaceVerts( eSym->Lface );
if( (leftNv+rightNv-2) > maxVertsPerFace )
continue;
va = e->Lprev->Org;
vb = e->Org;
vc = e->Sym->Lnext->Dst;
vd = e->Sym->Lprev->Org;
ve = e->Sym->Org;
vf = e->Lnext->Dst;
if( VertCCW( va, vb, vc ) && VertCCW( vd, ve, vf ) ) {
if( e == eNext || e == eNext->Sym ) { eNext = eNext->next; }
if( !tessMeshDelete( mesh, e ) )
return 0;
}
}
return 1;
}
void tessMeshFlipEdge( TESSmesh *mesh, TESShalfEdge *edge )
{
TESShalfEdge *a0 = edge;
TESShalfEdge *a1 = a0->Lnext;
TESShalfEdge *a2 = a1->Lnext;
TESShalfEdge *b0 = edge->Sym;
TESShalfEdge *b1 = b0->Lnext;
TESShalfEdge *b2 = b1->Lnext;
TESSvertex *aOrg = a0->Org;
TESSvertex *aOpp = a2->Org;
TESSvertex *bOrg = b0->Org;
TESSvertex *bOpp = b2->Org;
TESSface *fa = a0->Lface;
TESSface *fb = b0->Lface;
assert(EdgeIsInternal(edge));
assert(a2->Lnext == a0);
assert(b2->Lnext == b0);
a0->Org = bOpp;
a0->Onext = b1->Sym;
b0->Org = aOpp;
b0->Onext = a1->Sym;
a2->Onext = b0;
b2->Onext = a0;
b1->Onext = a2->Sym;
a1->Onext = b2->Sym;
a0->Lnext = a2;
a2->Lnext = b1;
b1->Lnext = a0;
b0->Lnext = b2;
b2->Lnext = a1;
a1->Lnext = b0;
a1->Lface = fb;
b1->Lface = fa;
fa->anEdge = a0;
fb->anEdge = b0;
if (aOrg->anEdge == a0) aOrg->anEdge = b1;
if (bOrg->anEdge == b0) bOrg->anEdge = a1;
assert( a0->Lnext->Onext->Sym == a0 );
assert( a0->Onext->Sym->Lnext == a0 );
assert( a0->Org->anEdge->Org == a0->Org );
assert( a1->Lnext->Onext->Sym == a1 );
assert( a1->Onext->Sym->Lnext == a1 );
assert( a1->Org->anEdge->Org == a1->Org );
assert( a2->Lnext->Onext->Sym == a2 );
assert( a2->Onext->Sym->Lnext == a2 );
assert( a2->Org->anEdge->Org == a2->Org );
assert( b0->Lnext->Onext->Sym == b0 );
assert( b0->Onext->Sym->Lnext == b0 );
assert( b0->Org->anEdge->Org == b0->Org );
assert( b1->Lnext->Onext->Sym == b1 );
assert( b1->Onext->Sym->Lnext == b1 );
assert( b1->Org->anEdge->Org == b1->Org );
assert( b2->Lnext->Onext->Sym == b2 );
assert( b2->Onext->Sym->Lnext == b2 );
assert( b2->Org->anEdge->Org == b2->Org );
assert(aOrg->anEdge->Org == aOrg);
assert(bOrg->anEdge->Org == bOrg);
assert(a0->Oprev->Onext->Org == a0->Org);
}
#ifdef DELETE_BY_ZAPPING
void tessMeshDeleteMesh( TESSalloc* alloc, TESSmesh *mesh )
{
TESSface *fHead = &mesh->fHead;
while( fHead->next != fHead ) {
tessMeshZapFace( fHead->next );
}
assert( mesh->vHead.next == &mesh->vHead );
alloc->memfree( alloc->userData, mesh );
}
#else
void tessMeshDeleteMesh( TESSalloc* alloc, TESSmesh *mesh )
{
deleteBucketAlloc(mesh->edgeBucket);
deleteBucketAlloc(mesh->vertexBucket);
deleteBucketAlloc(mesh->faceBucket);
alloc->memfree( alloc->userData, mesh );
}
#endif
#ifndef NDEBUG
void tessMeshCheckMesh( TESSmesh *mesh )
{
TESSface *fHead = &mesh->fHead;
TESSvertex *vHead = &mesh->vHead;
TESShalfEdge *eHead = &mesh->eHead;
TESSface *f, *fPrev;
TESSvertex *v, *vPrev;
TESShalfEdge *e, *ePrev;
for( fPrev = fHead ; (f = fPrev->next) != fHead; fPrev = f) {
assert( f->prev == fPrev );
e = f->anEdge;
do {
assert( e->Sym != e );
assert( e->Sym->Sym == e );
assert( e->Lnext->Onext->Sym == e );
assert( e->Onext->Sym->Lnext == e );
assert( e->Lface == f );
e = e->Lnext;
} while( e != f->anEdge );
}
assert( f->prev == fPrev && f->anEdge == NULL );
for( vPrev = vHead ; (v = vPrev->next) != vHead; vPrev = v) {
assert( v->prev == vPrev );
e = v->anEdge;
do {
assert( e->Sym != e );
assert( e->Sym->Sym == e );
assert( e->Lnext->Onext->Sym == e );
assert( e->Onext->Sym->Lnext == e );
assert( e->Org == v );
e = e->Onext;
} while( e != v->anEdge );
}
assert( v->prev == vPrev && v->anEdge == NULL );
for( ePrev = eHead ; (e = ePrev->next) != eHead; ePrev = e) {
assert( e->Sym->next == ePrev->Sym );
assert( e->Sym != e );
assert( e->Sym->Sym == e );
assert( e->Org != NULL );
assert( e->Dst != NULL );
assert( e->Lnext->Onext->Sym == e );
assert( e->Onext->Sym->Lnext == e );
}
assert( e->Sym->next == ePrev->Sym
&& e->Sym == &mesh->eHeadSym
&& e->Sym->Sym == e
&& e->Org == NULL && e->Dst == NULL
&& e->Lface == NULL && e->Rface == NULL );
}
#endif