libphysics: funções de broadphase

1 files changed, 13 insertions, 53 deletions

diff --git a/libphysics/tick.c b/libphysics/tick.c
index 3ba60f8..dbc5f27 100644
--- a/libphysics/tick.c
+++ b/libphysics/tick.c
@@ -5,7 +5,8 @@
 #include "dat.h"
 
 #define TILE_SIZE 16
-#define TEST_BUFFER_SIZE 0x10000
+
+#define LENGTH(X) (sizeof (X) / sizeof (X)[0])
 
 static void tick(void);
 static void mapcollision(Body *);
@@ -14,10 +15,9 @@ static void bodycollision(Body *);
 static void bodycollisionmap(Body *);
 static void bodycollisionmapsub(Body *, BlockmapNode *);
 
-static void enqueuetest(TestCollision *t);
+static BodyID bids[0x10000];
+static int    bidsi;
 
-static TestCollision testcollision[TEST_BUFFER_SIZE];
-static int testcollisioncount;
 
 void
 phxtick(float delta)
@@ -59,13 +59,6 @@ phxfixtick(void)
 void
 tick(void)
 {
-	static int count = 0;
-
-	if(!count) {
-		phxmakeblkmap();
-	}
-	count = (count + 1) % 4;
-
 	for(int i = 0; i < phxbodypoolsize; i++) {
 		Body *b = phxbodypool + i;
 		if(!b->active)
@@ -74,21 +67,21 @@ tick(void)
 		vec2_add_scaled(b->vel, b->vel, b->accel, PHX_TICK_TIME);
 	}
 
+	__phxbroadphasereset();
+	bidsi = 0;
 	for(int i = 0; i < phxbodypoolsize; i++) {
 		Body *b = phxbodypool + i;
 		if(!b->active)
 			continue;
-		mapcollision(b);
-	}
 
-	testcollisioncount = 0;
-	for(int i = 0; i < phxbodypoolsize; i++) {
-		Body *b = phxbodypool + i;
-		if(!b->active)
-			continue;
-		bodycollisionmap(b);
+		mapcollision(b);
+		bids[bidsi++] = i;
+		if(bidsi >= LENGTH(bids)) {
+			__phxbroadphase(bidsi, bids);
+			bidsi = 0;
+		}
 	}
-	__phxnarrowphase(testcollisioncount, testcollision);
+	__phxbroadphase(bidsi, bids);
 
 	for(int i = 0; i < phxbodypoolsize; i++) {
 		Body *b = phxbodypool + i;
@@ -145,38 +138,5 @@ mapcollision(Body *a)
 		}
 }
 
-void
-bodycollisionmap(Body *a)
-{
-	for(int y = -1; y <= 1; y++)
-	for(int x = -1; x <= 1; x++) {
-		bodycollisionmapsub(a, phxnodelist(
-			a->pos[0] + x * BLOCK_SIZE, 
-			a->pos[1] + y * BLOCK_SIZE
-		));	
-	}
-}
-
-void
-bodycollisionmapsub(Body *a, BlockmapNode *n)
-{
-	while(n) {
-		Body *b = phxbodypool + n->id;
-		enqueuetest(&(TestCollision) {
-			.a = a - phxbodypool,
-			.b = b - phxbodypool
-		});
-		n = n->next;
-	}
-}
 
-void
-enqueuetest(TestCollision *t)
-{
-	testcollision[testcollisioncount++] = *t;
-	if(testcollisioncount >= TEST_BUFFER_SIZE) {
-		__phxnarrowphase(testcollisioncount, testcollision);
-		testcollisioncount = 0;
-	}
-}