Implement utCircleVsPolygon() function in tests/src/collision.c

c-krit · Nov 12, 2024 · ffdd71e · ffdd71e
1 parent 1f7ea88
commit ffdd71e
Show file tree

Hide file tree

Showing 2 changed files with 88 additions and 10 deletions.
diff --git a/tests/src/collision.c b/tests/src/collision.c
@@ -108,14 +108,94 @@ TEST utCircleVsCircle(void) {
         ASSERT_IN_RANGE(1.0f, collision.contacts[0].point.y, FLT_EPSILON);
     }
 
-    frReleaseBody(b1), frReleaseBody(b2);
     frReleaseShape(s1), frReleaseShape(s2);
+    frReleaseBody(b1), frReleaseBody(b2);
 
     PASS();
 }
 
 TEST utCircleVsPolygon(void) {
-    /* TODO: ... */
+    frShape *s1 = frCreateCircle(frStructZero(frMaterial), 1.0f);
+    frShape *s2 = frCreateRectangle(frStructZero(frMaterial), 2.0f, 2.0f);
+
+    frBody *b1 = frCreateBodyFromShape(FR_BODY_KINEMATIC,
+                                       frStructZero(frVector2),
+                                       s1);
+
+    frBody *b2 = frCreateBodyFromShape(FR_BODY_KINEMATIC,
+                                       frStructZero(frVector2),
+                                       s2);
+
+    frCollision collision = { .count = 0 };
+
+    {
+        frSetBodyPosition(b1, (frVector2) { .x = -1.5f });
+        frSetBodyPosition(b2, (frVector2) { .x = 1.5f });
+
+        (void) frComputeCollision(b1, b2, &collision);
+
+        ASSERT_EQ(0, collision.count);
+    }
+
+    {
+        frSetBodyPosition(b1, (frVector2) { .x = -1.0f });
+        frSetBodyPosition(b2, (frVector2) { .x = 1.0f });
+
+        (void) frComputeCollision(b1, b2, &collision);
+
+        ASSERT_EQ(1, collision.count);
+
+        ASSERT_IN_RANGE(1.0f, collision.direction.x, FLT_EPSILON);
+        ASSERT_IN_RANGE(0.0f, collision.direction.y, FLT_EPSILON);
+
+        ASSERT_IN_RANGE(0.0f, collision.contacts[0].depth, FLT_EPSILON);
+
+        ASSERT_IN_RANGE(0.0f, collision.contacts[0].point.x, FLT_EPSILON);
+        ASSERT_IN_RANGE(0.0f, collision.contacts[0].point.y, FLT_EPSILON);
+    }
+
+    {
+        frSetBodyPosition(b1, (frVector2) { .x = -0.5f });
+        frSetBodyPosition(b2, (frVector2) { .x = 0.5f });
+
+        (void) frComputeCollision(b1, b2, &collision);
+
+        ASSERT_EQ(1, collision.count);
+
+        ASSERT_IN_RANGE(1.0f, collision.direction.x, FLT_EPSILON);
+        ASSERT_IN_RANGE(0.0f, collision.direction.y, FLT_EPSILON);
+
+        ASSERT_IN_RANGE(1.0f, collision.contacts[0].depth, FLT_EPSILON);
+
+        ASSERT_IN_RANGE(0.5f, collision.contacts[0].point.x, FLT_EPSILON);
+        ASSERT_IN_RANGE(0.0f, collision.contacts[0].point.y, FLT_EPSILON);
+    }
+
+    {
+        float offsetX = 0.01f, offsetY = 0.01f;
+
+        frSetBodyPosition(b1, frStructZero(frVector2));
+        frSetBodyPosition(b2,
+                          (frVector2) { .x = 1.0f + offsetX,
+                                        .y = 1.0f + offsetY });
+
+        (void) frComputeCollision(b1, b2, &collision);
+
+        ASSERT_EQ(1, collision.count);
+
+        frVector2 direction = frVector2Normalize(
+            frVector2Subtract(frGetBodyPosition(b2), frGetBodyPosition(b1)));
+
+        ASSERT_IN_RANGE(direction.x, collision.direction.x, FLT_EPSILON);
+        ASSERT_IN_RANGE(direction.y, collision.direction.y, FLT_EPSILON);
+
+        float depth = 1.0f - sqrtf((offsetX * offsetX) + (offsetY * offsetY));
+
+        ASSERT_IN_RANGE(depth, collision.contacts[0].depth, FLT_EPSILON);
+    }
+
+    frReleaseShape(s1), frReleaseShape(s2);
+    frReleaseBody(b1), frReleaseBody(b2);
 
     PASS();
 }

diff --git a/tests/src/utils.c b/tests/src/utils.c
@@ -29,9 +29,9 @@
 
 /* Macros =================================================================> */
 
-#define BIT_ARRAY_LENGTH    ((1 << 6) + 1)
-#define DYN_ARRAY_CAPACITY  ((1 << 5) + 1)
-#define RING_BUFFER_LENGTH  ((1 << 4) + 1)
+#define BIT_ARRAY_LENGTH   ((1 << 6) + 1)
+#define DYN_ARRAY_CAPACITY ((1 << 5) + 1)
+#define RING_BUFFER_LENGTH ((1 << 4) + 1)
 
 /* Private Function Prototypes ============================================> */
 
@@ -60,7 +60,7 @@ TEST utBitArrayOps(void) {
 
         int numberCount = 0;
 
-        for (int i = 0; i < BIT_ARRAY_LENGTH; i++) 
+        for (int i = 0; i < BIT_ARRAY_LENGTH; i++)
             if (frBitArrayGet(ba, i)) numberCount++;
 
         ASSERT_EQ(6, numberCount);
@@ -86,10 +86,8 @@ TEST utDynArrayOps(void) {
 
         ASSERT_LT(DYN_ARRAY_CAPACITY, frGetDynArrayCapacity(values));
 
-        ASSERT_EQ(
-            (DYN_ARRAY_CAPACITY << 1), 
-            frGetDynArrayValue(values, DYN_ARRAY_CAPACITY)
-        );
+        ASSERT_EQ((DYN_ARRAY_CAPACITY << 1),
+                  frGetDynArrayValue(values, DYN_ARRAY_CAPACITY));
 
         frSetDynArrayCapacity(values, (DYN_ARRAY_CAPACITY >> 1));