- organized headers. - added comments to headers. - fixed a solver determinism bug. - removed some un-used math functions
198 lines
5.3 KiB
C
198 lines
5.3 KiB
C
// SPDX-FileCopyrightText: 2025 Erin Catto
|
|
// SPDX-License-Identifier: MIT
|
|
|
|
#include "aabb.h"
|
|
#include "test_macros.h"
|
|
|
|
#include "box3d/math_functions.h"
|
|
|
|
static int AABBTest( void )
|
|
{
|
|
b3AABB a;
|
|
a.lowerBound = (b3Vec3){ -1.0f, -1.0f, -1.0f };
|
|
a.upperBound = (b3Vec3){ -2.0f, -2.0f, -2.0f };
|
|
|
|
ENSURE( b3IsValidAABB( a ) == false );
|
|
|
|
a.upperBound = (b3Vec3){ 1.0f, 1.0f };
|
|
ENSURE( b3IsValidAABB( a ) == true );
|
|
|
|
b3AABB b = { { 2.0f, 2.0f }, { 4.0f, 4.0f } };
|
|
ENSURE( b3AABB_Overlaps( a, b ) == false );
|
|
ENSURE( b3AABB_Contains( a, b ) == false );
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int TestRayAABBIntersection( void )
|
|
{
|
|
// Test 1: Ray passing through center of AABB
|
|
{
|
|
b3AABB a = { { -1.0f, -1.0f, -1.0f }, { 1.0f, 1.0f, 1.0f } };
|
|
b3Vec3 p1 = { -2.0f, 0.0f, 0.0f };
|
|
b3Vec3 p2 = { 2.0f, 0.0f, 0.0f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == true );
|
|
ENSURE( b3AbsFloat( minFraction - 0.25f ) < 0.001f ); // Enters at 25% of ray
|
|
ENSURE( b3AbsFloat( maxFraction - 0.75f ) < 0.001f ); // Exits at 75% of ray
|
|
}
|
|
|
|
// Test 2: Ray starting inside AABB
|
|
{
|
|
b3AABB a = { { -1.0f, -1.0f, -1.0f }, { 1.0f, 1.0f, 1.0f } };
|
|
b3Vec3 p1 = { 0.0f, 0.0f, 0.0f };
|
|
b3Vec3 p2 = { 2.0f, 0.0f, 0.0f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == true );
|
|
ENSURE( minFraction == 0.0f ); // Starts inside
|
|
ENSURE( b3AbsFloat( maxFraction - 0.5f ) < 0.001f ); // Exits at 50% of ray
|
|
}
|
|
|
|
// Test 3: Ray ending inside AABB
|
|
{
|
|
b3AABB a = { { -1.0f, -1.0f, -1.0f }, { 1.0f, 1.0f, 1.0f } };
|
|
b3Vec3 p1 = { -2.0f, 0.0f, 0.0f };
|
|
b3Vec3 p2 = { 0.0f, 0.0f, 0.0f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == true );
|
|
ENSURE( b3AbsFloat( minFraction - 0.5f ) < 0.001f ); // Enters at 50% of ray
|
|
ENSURE( maxFraction == 1.0f ); // Ends inside
|
|
}
|
|
|
|
// Test 4: Ray completely inside AABB
|
|
{
|
|
b3AABB a = { { -2.0f, -2.0f, -2.0f }, { 2.0f, 2.0f, 2.0f } };
|
|
b3Vec3 p1 = { -1.0f, 0.0f, 0.0f };
|
|
b3Vec3 p2 = { 1.0f, 0.0f, 0.0f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == true );
|
|
ENSURE( minFraction == 0.0f );
|
|
ENSURE( maxFraction == 1.0f );
|
|
}
|
|
|
|
// Test 5: Ray missing AABB
|
|
{
|
|
b3AABB a = { { 0.0f, 0.0f, 0.0f }, { 1.0f, 1.0f, 1.0f } };
|
|
b3Vec3 p1 = { -1.0f, 2.0f, 0.5f };
|
|
b3Vec3 p2 = { 2.0f, 2.0f, 0.5f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == false );
|
|
}
|
|
|
|
// Test 6: Ray parallel to AABB face (no intersection)
|
|
{
|
|
b3AABB a = { { 0.0f, 0.0f, 0.0f }, { 1.0f, 1.0f, 1.0f } };
|
|
b3Vec3 p1 = { -1.0f, 2.0f, 0.5f };
|
|
b3Vec3 p2 = { 2.0f, 2.0f, 0.5f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == false );
|
|
}
|
|
|
|
// Test 7: Ray parallel to AABB face (within bounds)
|
|
{
|
|
b3AABB a = { { 0.0f, 0.0f, 0.0f }, { 1.0f, 1.0f, 1.0f } };
|
|
b3Vec3 p1 = { -1.0f, 0.5f, 0.5f };
|
|
b3Vec3 p2 = { 2.0f, 0.5f, 0.5f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == true );
|
|
ENSURE( b3AbsFloat( minFraction - 1.0f / 3.0f ) < 0.001f );
|
|
ENSURE( b3AbsFloat( maxFraction - 2.0f / 3.0f ) < 0.001f );
|
|
}
|
|
|
|
// Test 8: Degenerate ray (point) inside AABB
|
|
{
|
|
b3AABB a = { { 0.0f, 0.0f, 0.0f }, { 1.0f, 1.0f, 1.0f } };
|
|
b3Vec3 p1 = { 0.5f, 0.5f, 0.5f };
|
|
b3Vec3 p2 = { 0.5f, 0.5f, 0.5f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == true );
|
|
ENSURE( minFraction == 0.0f );
|
|
ENSURE( maxFraction == 0.0f );
|
|
}
|
|
|
|
// Test 9: Degenerate ray (point) outside AABB
|
|
{
|
|
b3AABB a = { { 0.0f, 0.0f, 0.0f }, { 1.0f, 1.0f, 1.0f } };
|
|
b3Vec3 p1 = { 2.0f, 2.0f, 2.0f };
|
|
b3Vec3 p2 = { 2.0f, 2.0f, 2.0f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == false );
|
|
}
|
|
|
|
// Test 10: Ray pointing away from AABB
|
|
{
|
|
b3AABB a = { { 0.0f, 0.0f, 0.0f }, { 1.0f, 1.0f, 1.0f } };
|
|
b3Vec3 p1 = { -1.0f, 0.5f, 0.5f };
|
|
b3Vec3 p2 = { -2.0f, 0.5f, 0.5f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == false );
|
|
}
|
|
|
|
// Test 11: Ray hitting corner of AABB
|
|
{
|
|
b3AABB a = { { 0.0f, 0.0f, 0.0f }, { 1.0f, 1.0f, 1.0f } };
|
|
b3Vec3 p1 = { -1.0f, -1.0f, -1.0f };
|
|
b3Vec3 p2 = { 2.0f, 2.0f, 2.0f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == true );
|
|
ENSURE( b3AbsFloat( minFraction - 1.0f / 3.0f ) < 0.001f );
|
|
ENSURE( b3AbsFloat( maxFraction - 2.0f / 3.0f ) < 0.001f );
|
|
}
|
|
|
|
// Test 12: Ray grazing edge of AABB
|
|
{
|
|
b3AABB a = { { 0.0f, 0.0f, 0.0f }, { 1.0f, 1.0f, 1.0f } };
|
|
b3Vec3 p1 = { -1.0f, 0.0f, 0.5f };
|
|
b3Vec3 p2 = { 2.0f, 0.0f, 0.5f };
|
|
float minFraction, maxFraction;
|
|
|
|
bool hit = b3RayCastAABB( a, p1, p2, &minFraction, &maxFraction );
|
|
|
|
ENSURE( hit == true );
|
|
ENSURE( b3AbsFloat( minFraction - 1.0f / 3.0f ) < 0.001f );
|
|
ENSURE( b3AbsFloat( maxFraction - 2.0f / 3.0f ) < 0.001f );
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int CollisionTest( void )
|
|
{
|
|
RUN_SUBTEST( AABBTest );
|
|
RUN_SUBTEST( TestRayAABBIntersection );
|
|
|
|
return 0;
|
|
}
|