box3d/test/test_distance.c
Erin Catto 09c65b08ea
Doubles (#14)
Added a compile time option to use double precision body positions. Most
math remains single precision with minimal performance loss.

`BOX3D_DOUBLE_PRECISION`

Improved accuracy of body inertia computation when shapes are far from
the body origin.

WARNING: several APIs changed but migration should be straight forward
if doubles are not enabled.
2026-06-18 20:51:16 -07:00

114 lines
3 KiB
C

// SPDX-FileCopyrightText: 2026 Erin Catto
// SPDX-License-Identifier: MIT
#include "math_internal.h"
#include "test_macros.h"
#include "box3d/collision.h"
#include "box3d/math_functions.h"
#include <float.h>
static int SegmentDistanceTest( void )
{
b3Vec3 p1 = { -1.0f, -1.0f };
b3Vec3 q1 = { -1.0f, 1.0f };
b3Vec3 p2 = { 2.0f, 0.0f };
b3Vec3 q2 = { 1.0f, 0.0f };
b3SegmentDistanceResult result = b3SegmentDistance( p1, q1, p2, q2 );
ENSURE_SMALL( result.fraction1 - 0.5f, FLT_EPSILON );
ENSURE_SMALL( result.fraction2 - 1.0f, FLT_EPSILON );
ENSURE_SMALL( result.point1.x + 1.0f, FLT_EPSILON );
ENSURE_SMALL( result.point1.y, FLT_EPSILON );
ENSURE_SMALL( result.point1.z, FLT_EPSILON );
ENSURE_SMALL( result.point2.x - 1.0f, FLT_EPSILON );
ENSURE_SMALL( result.point2.y, FLT_EPSILON );
ENSURE_SMALL( result.point2.z, FLT_EPSILON );
return 0;
}
static int ShapeDistanceTest( void )
{
b3Vec3 vas[] = { (b3Vec3){ -1.0f, -1.0f }, (b3Vec3){ 1.0f, -1.0f }, (b3Vec3){ 1.0f, 1.0f }, (b3Vec3){ -1.0f, 1.0f } };
b3Vec3 vbs[] = {
(b3Vec3){ 2.0f, -1.0f },
(b3Vec3){ 2.0f, 1.0f },
};
b3DistanceInput input;
input.proxyA = (b3ShapeProxy){ vas, ARRAY_COUNT( vas ), 0.0f };
input.proxyB = (b3ShapeProxy){ vbs, ARRAY_COUNT( vbs ), 0.0f };
input.transform = b3Transform_identity;
input.useRadii = false;
b3SimplexCache cache = { 0 };
b3DistanceOutput output = b3ShapeDistance( &input, &cache, NULL, 0 );
ENSURE_SMALL( output.distance - 1.0f, FLT_EPSILON );
return 0;
}
static int ShapeCastTest( void )
{
b3Vec3 vas[] = { (b3Vec3){ -1.0f, -1.0f, 0.0f }, (b3Vec3){ 1.0f, -1.0f, 0.0f }, (b3Vec3){ 1.0f, 1.0f, 0.0f },
(b3Vec3){ -1.0f, 1.0f } };
b3Vec3 vbs[] = {
(b3Vec3){ 2.0f, -1.0f, 0.0f },
(b3Vec3){ 2.0f, 1.0f, 0.0f },
};
b3ShapeCastPairInput input;
input.proxyA = (b3ShapeProxy){ vas, ARRAY_COUNT( vas ), 0.0f };
input.proxyB = (b3ShapeProxy){ vbs, ARRAY_COUNT( vbs ), 0.0f };
input.transform = b3Transform_identity;
input.translationB = (b3Vec3){ -2.0f, 0.0f };
input.maxFraction = 1.0f;
input.canEncroach = false;
b3CastOutput output = b3ShapeCast( &input );
ENSURE( output.hit );
ENSURE_SMALL( output.fraction - 0.5f, 0.005f );
return 0;
}
static int TimeOfImpactTest( void )
{
b3Vec3 vas[] = { { -1.0f, -1.0f }, { 1.0f, -1.0f }, { 1.0f, 1.0f }, { -1.0f, 1.0f } };
b3Vec3 vbs[] = {
{ 2.0f, -1.0f },
{ 2.0f, 1.0f },
};
b3TOIInput input;
input.proxyA = (b3ShapeProxy){ vas, ARRAY_COUNT( vas ), 0.0f };
input.proxyB = (b3ShapeProxy){ vbs, ARRAY_COUNT( vbs ), 0.0f };
input.sweepA = (b3Sweep){ b3Vec3_zero, b3Vec3_zero, b3Vec3_zero, b3Quat_identity, b3Quat_identity };
input.sweepB = (b3Sweep){ b3Vec3_zero, b3Vec3_zero, (b3Vec3){ -2.0f, 0.0f, 0.0f }, b3Quat_identity, b3Quat_identity };
input.maxFraction = 1.0f;
b3TOIOutput output = b3TimeOfImpact( &input );
ENSURE( output.state == b3_toiStateHit );
ENSURE_SMALL( output.fraction - 0.5f, 0.005f );
return 0;
}
int DistanceTest( void )
{
RUN_SUBTEST( SegmentDistanceTest );
RUN_SUBTEST( ShapeDistanceTest );
RUN_SUBTEST( ShapeCastTest );
RUN_SUBTEST( TimeOfImpactTest );
return 0;
}