AnotherFoxGuy/bounce
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

assert

Browse Source
This commit is contained in:
Irlan 2018-04-19 20:23:43 -03:00
parent a4f861a93a
commit 0e0438e0a9
1 changed files with 15 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

27
src/bounce/collision/shapes/qhull.cpp
View File

@ -205,24 +205,17 @@ void b3QHull::Set(const b3Vec3* points, u32 count)
face = faceList.head;
while (face)
{
B3_ASSERT(faceCount < F);
u8 iface = faceCount;
b3Face* f = faces + faceCount;
b3Plane* plane = planes + faceCount;
++faceCount;
*plane = face->plane;
// Collected face half-edges
b3StackArray<u8, 32> faceEdges;
qhHalfEdge* edge = face->edge;
do
{
qhHalfEdge* twin = edge->twin;
qhVertex* v1 = edge->tail;
qhVertex* v2 = twin->tail;
b3PointerIndex* mte = edgeMap.Find(edge);
b3PointerIndex* mv1 = vertexMap.Find(v1);
b3PointerIndex* mv2 = vertexMap.Find(v2);
@ -253,13 +246,15 @@ void b3QHull::Set(const b3Vec3* points, u32 count)
vertexMap.Add({ v2, iv2 });
++vertexCount;
}
b3PointerIndex* mte = edgeMap.Find(edge);
if (mte)
{
u8 ie2 = mte->value;
b3HalfEdge* e2 = edges + ie2;
B3_ASSERT(e2->face == B3_NULL_HULL_FEATURE);
e2->face = iface;
e2->face = u8(faceCount);
faceEdges.PushBack(ie2);
}
else
@ -274,7 +269,7 @@ void b3QHull::Set(const b3Vec3* points, u32 count)
b3HalfEdge* e2 = edges + edgeCount;
++edgeCount;
e1->face = iface;
e1->face = u8(faceCount);
e1->origin = iv1;
e1->twin = ie2;
@ -291,6 +286,9 @@ void b3QHull::Set(const b3Vec3* points, u32 count)
edge = edge->next;
} while (edge != face->edge);
B3_ASSERT(faceEdges.Count() > 0);
b3Face* f = faces + faceCount;
f->edge = faceEdges[0];
for (u32 i = 0; i < faceEdges.Count(); ++i)
{
@ -298,6 +296,11 @@ void b3QHull::Set(const b3Vec3* points, u32 count)
edges[faceEdges[i]].next = faceEdges[j];
}
planes[faceCount] = face->plane;
B3_ASSERT(faceCount < F);
++faceCount;
face = face->next;
}