Missing functions (#21)

- add some missing functions
- added config.h for users that vendor Box3D
- joint unit tests
- improve joint limit consistency
- extend build matrix
This commit is contained in:
Erin Catto 2026-06-30 10:57:46 -07:00 • committed by GitHub
commit 8441b4a06d
No known key found for this signature in database
GPG key ID: B5690EEEBB952194
31 changed files with 918 additions and 410 deletions

View file

@ -2,58 +2,77 @@
name: CI Build
on:
push:
branches: [ main ]
pull_request:
branches: [ main ]
workflow_dispatch:
env:
BUILD_TYPE: Debug
BUILD_TYPE: Debug
jobs:
build-ubuntu-gcc:
name: ubuntu-gcc
runs-on: ubuntu-latest
if: github.event_name == 'push' || github.event.pull_request.draft == false
timeout-minutes: 4
test:
name: ${{ matrix.name }}
runs-on: ${{ matrix.os }}
timeout-minutes: ${{ matrix.timeout || 4 }}
if: github.event_name != 'pull_request' || github.event.pull_request.draft == false
strategy:
fail-fast: false
matrix:
include:
- name: ubuntu-gcc
os: ubuntu-latest
test: ./bin/test
- name: ubuntu-clang
os: ubuntu-latest
args: '-DCMAKE_CXX_COMPILER=clang++-18 -DCMAKE_C_COMPILER=clang-18 -DCMAKE_C_FLAGS="-fsanitize=thread -fno-omit-frame-pointer" -DCMAKE_CXX_FLAGS="-fsanitize=thread -fno-omit-frame-pointer" -DCMAKE_EXE_LINKER_FLAGS="-fsanitize=thread"'
test: ./bin/test
- name: ubuntu-clang-msan
os: ubuntu-latest
timeout: 10
args: '-DCMAKE_CXX_COMPILER=clang++-18 -DCMAKE_C_COMPILER=clang-18 -DCMAKE_C_FLAGS="-fsanitize=memory -fsanitize-memory-track-origins=1 -fno-omit-frame-pointer" -DCMAKE_CXX_FLAGS="-fsanitize=memory -fsanitize-memory-track-origins=1 -fno-omit-frame-pointer" -DCMAKE_EXE_LINKER_FLAGS="-fsanitize=memory"'
test: ./bin/test
msan-options: abort_on_error=1:halt_on_error=1
- name: macos
os: macos-latest
args: -DBOX3D_SANITIZE=ON
test: ./bin/test
- name: windows
os: windows-latest
msvc: true
args: -DBOX3D_SANITIZE=ON
test: ./bin/Debug/test
# Box3D is width-4 SIMD only, so this covers the clang-cl toolchain, not AVX2.
- name: windows-clang-cl
os: windows-latest
msvc: true
args: -T ClangCL
test: ./bin/Debug/test
- name: windows-arm64
os: windows-11-arm
args: -A arm64 -DBOX3D_DISABLE_SIMD=TRUE -DBOX3D_SANITIZE=ON
test: ./bin/Debug/test
- name: ubuntu-gcc-double
os: ubuntu-latest
args: -DBOX3D_DOUBLE_PRECISION=ON
test: ./bin/test
- name: windows-double
os: windows-latest
msvc: true
args: -DBOX3D_DOUBLE_PRECISION=ON -DBOX3D_SANITIZE=ON
test: ./bin/Debug/test
steps:
- uses: actions/checkout@v6
- name: Configure CMake
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=${{env.BUILD_TYPE}} -DBOX3D_SAMPLES=OFF -DBUILD_SHARED_LIBS=OFF -DBOX3D_VALIDATE=ON -DCMAKE_COMPILE_WARNING_AS_ERROR=ON
- name: Build
run: cmake --build ${{github.workspace}}/build --config ${{env.BUILD_TYPE}}
- name: Test
working-directory: ${{github.workspace}}/build
run: ./bin/test
build-ubuntu-clang:
name: ubuntu-clang
runs-on: ubuntu-latest
if: github.event_name == 'push' || github.event.pull_request.draft == false
timeout-minutes: 4
steps:
- uses: actions/checkout@v6
- name: Setup MSVC dev command prompt
if: ${{ matrix.msvc }}
uses: TheMrMilchmann/setup-msvc-dev@v4
with:
arch: x64
- name: Configure CMake
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=${{env.BUILD_TYPE}} -DCMAKE_CXX_COMPILER=clang++-18 -DCMAKE_C_COMPILER=clang-18 -DCMAKE_C_FLAGS="-fsanitize=thread -fno-omit-frame-pointer" -DCMAKE_CXX_FLAGS="-fsanitize=thread -fno-omit-frame-pointer" -DCMAKE_EXE_LINKER_FLAGS="-fsanitize=thread" -DBOX3D_SAMPLES=OFF -DBUILD_SHARED_LIBS=OFF -DBOX3D_VALIDATE=ON -DCMAKE_COMPILE_WARNING_AS_ERROR=ON
- name: Build
run: cmake --build ${{github.workspace}}/build --config ${{env.BUILD_TYPE}}
- name: Test
working-directory: ${{github.workspace}}/build
run: ./bin/test
build-ubuntu-clang-msan:
name: ubuntu-clang-msan
runs-on: ubuntu-latest
if: false # todo re-enable once repo is public
timeout-minutes: 10
steps:
- uses: actions/checkout@v6
- name: Configure CMake
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=${{env.BUILD_TYPE}} -DCMAKE_CXX_COMPILER=clang++-18 -DCMAKE_C_COMPILER=clang-18 -DCMAKE_C_FLAGS="-fsanitize=memory -fsanitize-memory-track-origins=1 -fno-omit-frame-pointer" -DCMAKE_CXX_FLAGS="-fsanitize=memory -fsanitize-memory-track-origins=1 -fno-omit-frame-pointer" -DCMAKE_EXE_LINKER_FLAGS="-fsanitize=memory" -DBOX3D_SAMPLES=OFF -DBUILD_SHARED_LIBS=OFF -DBOX3D_VALIDATE=ON -DCMAKE_COMPILE_WARNING_AS_ERROR=ON
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=${{env.BUILD_TYPE}} -DBOX3D_SAMPLES=OFF -DBUILD_SHARED_LIBS=OFF -DBOX3D_VALIDATE=ON -DCMAKE_COMPILE_WARNING_AS_ERROR=ON ${{ matrix.args }}
- name: Build
run: cmake --build ${{github.workspace}}/build --config ${{env.BUILD_TYPE}}
@ -61,132 +80,88 @@ jobs:
- name: Test
working-directory: ${{github.workspace}}/build
env:
MSAN_OPTIONS: abort_on_error=1:halt_on_error=1
MSAN_OPTIONS: ${{ matrix['msan-options'] || '' }}
run: ${{ matrix.test }}
# mingw needs some extra setup so keeping it separate from the matrix.
build-windows-mingw:
name: windows-mingw
runs-on: windows-latest
timeout-minutes: 4
if: github.event_name != 'pull_request' || github.event.pull_request.draft == false
defaults:
run:
shell: msys2 {0}
steps:
- uses: actions/checkout@v6
- name: Setup MSYS2 UCRT64
uses: msys2/setup-msys2@v2
with:
msystem: UCRT64
update: true
install: >-
mingw-w64-ucrt-x86_64-gcc
mingw-w64-ucrt-x86_64-cmake
mingw-w64-ucrt-x86_64-ninja
- name: Configure CMake
run: cmake -B build -G Ninja -DCMAKE_BUILD_TYPE=${{env.BUILD_TYPE}} -DBOX3D_SAMPLES=OFF -DBUILD_SHARED_LIBS=OFF -DBOX3D_VALIDATE=ON -DCMAKE_COMPILE_WARNING_AS_ERROR=ON
- name: Build
run: cmake --build build --config ${{env.BUILD_TYPE}}
- name: Test
working-directory: build
run: ./bin/test
build-macos:
name: macos
runs-on: macos-latest
if: github.event_name == 'push' || github.event.pull_request.draft == false
timeout-minutes: 4
samples:
name: ${{ matrix.name }}
runs-on: ${{ matrix.os }}
timeout-minutes: 8
if: github.event_name != 'pull_request' || github.event.pull_request.draft == false
strategy:
fail-fast: false
matrix:
include:
- name: samples-ubuntu-gcc-static
os: ubuntu-latest
linux-deps: true
args: -DBUILD_SHARED_LIBS=OFF
- name: samples-macos-static
os: macos-latest
args: -DBUILD_SHARED_LIBS=OFF
- name: samples-macos-dynamic
os: macos-latest
args: -DBUILD_SHARED_LIBS=ON
- name: samples-windows-static
os: windows-latest
msvc: true
args: -DBUILD_SHARED_LIBS=OFF
- name: samples-windows-double
os: windows-latest
msvc: true
args: -DBOX3D_DOUBLE_PRECISION=ON -DBUILD_SHARED_LIBS=OFF
- name: samples-windows-dynamic
os: windows-latest
msvc: true
args: -DBUILD_SHARED_LIBS=ON
steps:
- uses: actions/checkout@v6
- name: Configure CMake
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=${{env.BUILD_TYPE}} -DBOX3D_SAMPLES=OFF -DBOX3D_SANITIZE=ON -DBUILD_SHARED_LIBS=OFF -DBOX3D_VALIDATE=ON -DCMAKE_COMPILE_WARNING_AS_ERROR=ON
- name: Build
run: cmake --build ${{github.workspace}}/build --config ${{env.BUILD_TYPE}}
- name: Test
working-directory: ${{github.workspace}}/build
run: ./bin/test
build-windows:
name: windows
runs-on: windows-latest
if: github.event_name == 'push' || github.event.pull_request.draft == false
timeout-minutes: 4
steps:
- uses: actions/checkout@v6
- name: Configure CMake
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=${{env.BUILD_TYPE}} -DBOX3D_SAMPLES=OFF -DBOX3D_VALIDATE=ON -DCMAKE_COMPILE_WARNING_AS_ERROR=ON
- name: Build
run: cmake --build ${{github.workspace}}/build --config ${{env.BUILD_TYPE}}
- name: Test
working-directory: ${{github.workspace}}/build
run: ./bin/${{env.BUILD_TYPE}}/test
build-ubuntu-double:
name: ubuntu-double-precision
runs-on: ubuntu-latest
if: github.event_name == 'push' || github.event.pull_request.draft == false
timeout-minutes: 4
steps:
- uses: actions/checkout@v6
- name: Configure CMake
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=${{env.BUILD_TYPE}} -DBOX3D_DOUBLE_PRECISION=ON -DBOX3D_SAMPLES=OFF -DBUILD_SHARED_LIBS=OFF -DBOX3D_VALIDATE=ON -DCMAKE_COMPILE_WARNING_AS_ERROR=ON
- name: Build
run: cmake --build ${{github.workspace}}/build --config ${{env.BUILD_TYPE}}
- name: Test
working-directory: ${{github.workspace}}/build
run: ./bin/test
build-windows-double:
name: windows-double-precision
runs-on: windows-latest
if: github.event_name == 'push' || github.event.pull_request.draft == false
timeout-minutes: 4
steps:
- uses: actions/checkout@v6
- name: Configure CMake
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=${{env.BUILD_TYPE}} -DBOX3D_DOUBLE_PRECISION=ON -DBOX3D_SAMPLES=OFF -DBOX3D_VALIDATE=ON -DCMAKE_COMPILE_WARNING_AS_ERROR=ON
- name: Build
run: cmake --build ${{github.workspace}}/build --config ${{env.BUILD_TYPE}}
- name: Test
working-directory: ${{github.workspace}}/build
run: ./bin/${{env.BUILD_TYPE}}/test
samples-windows:
name: samples-windows
runs-on: windows-latest
if: github.event_name == 'push' || github.event.pull_request.draft == false
timeout-minutes: 6
steps:
- uses: actions/checkout@v6
- name: Setup MSVC dev command prompt
if: ${{ matrix.msvc }}
uses: TheMrMilchmann/setup-msvc-dev@v4
with:
arch: x64
- name: Configure CMake
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=Release -DBOX3D_SAMPLES=ON -DBUILD_SHARED_LIBS=OFF -DBOX3D_UNIT_TESTS=OFF
- name: Build
run: cmake --build ${{github.workspace}}/build --config Release
samples-macos:
name: samples-macos
runs-on: macos-latest
if: github.event_name == 'push' || github.event.pull_request.draft == false
timeout-minutes: 6
steps:
- uses: actions/checkout@v6
# sokol_app needs X11/Xi/Xcursor + GL, the file dialog needs GTK3.
- name: Install Linux sample dependencies
if: ${{ matrix['linux-deps'] }}
run: sudo apt-get update && sudo apt-get install -y libgl1-mesa-dev libx11-dev libxi-dev libxcursor-dev libgtk-3-dev
- name: Configure CMake
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=Release -DBOX3D_SAMPLES=ON -DBUILD_SHARED_LIBS=OFF -DBOX3D_UNIT_TESTS=OFF
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=Release -DBOX3D_SAMPLES=ON -DBOX3D_UNIT_TESTS=OFF ${{ matrix.args }}
- name: Build
run: cmake --build ${{github.workspace}}/build --config Release
samples-windows-double:
name: samples-windows-double-precision
runs-on: windows-latest
if: github.event_name == 'push' || github.event.pull_request.draft == false
timeout-minutes: 6
steps:
- uses: actions/checkout@v6
- name: Setup MSVC dev command prompt
uses: TheMrMilchmann/setup-msvc-dev@v4
with:
arch: x64
- name: Configure CMake
run: cmake -B ${{github.workspace}}/build -DCMAKE_BUILD_TYPE=Release -DBOX3D_DOUBLE_PRECISION=ON -DBOX3D_SAMPLES=ON -DBUILD_SHARED_LIBS=OFF -DBOX3D_UNIT_TESTS=OFF
- name: Build
run: cmake --build ${{github.workspace}}/build --config Release

View file

@ -175,6 +175,15 @@ void MyFinishTask(void* userTask, void* userContext)
}
```
`MyFinishTask` must block until the task has completed. Because the step blocks here on the tasks it
spawned, `b3World_Step` holds its stack across every fork and join inside the step. This has a
consequence for how you drive it. Run `b3World_Step` from a thread you can dedicate to the step, or
from a fiber that `MyFinishTask` can park so the underlying thread is freed to run the queued tasks.
In a job system that cannot park a job's stack, do not call `b3World_Step` from inside a job: a job
that blocks on the sub-jobs it spawned without yielding its thread starves the workers it is waiting
on and can deadlock. The alternative is help-while-wait, where the waiting thread runs other pending
tasks itself. This is what the in-tree scheduler does, which is why it needs no fiber.
Box3D ships an in-tree scheduler (`src/scheduler.h`) used by the test suite and samples.
You can adapt it or use it directly:

View file

@ -6,9 +6,19 @@
#include <stdbool.h>
#include <stdint.h>
// Compile-time options. Edit box3d/config.h, or define BOX3D_USER_CONFIG to
// point at your own copy.
#ifdef BOX3D_USER_CONFIG
#include BOX3D_USER_CONFIG
#endif
#include "config.h"
// clang-format off
//
// Shared library macros
// Predefine BOX3D_EXPORT to reuse an existing export/import scheme, for example
// when compiling Box3D into another shared library.
#ifndef BOX3D_EXPORT
#if defined(_WIN32) && defined(box3d_EXPORTS)
// build the Windows DLL
#define BOX3D_EXPORT __declspec(dllexport)
@ -22,6 +32,7 @@
// static library
#define BOX3D_EXPORT
#endif
#endif
// C++ macros
#ifdef __cplusplus

View file

@ -500,7 +500,7 @@ B3_API b3BodyType b3Body_GetType( b3BodyId bodyId );
/// properties regardless of the automatic mass setting.
B3_API void b3Body_SetType( b3BodyId bodyId, b3BodyType type );
/// Set the body name. Up to B3_NAME_LENGTH characters including null termination.
/// Set the body name. Up to B3_BODY_NAME_LENGTH characters including null termination.
B3_API void b3Body_SetName( b3BodyId bodyId, const char* name );
/// Get the body name.
@ -1382,7 +1382,6 @@ B3_API float b3PrismaticJoint_GetSpeed( b3JointId jointId );
* @defgroup revolute_joint Revolute Joint
* @brief A revolute joint allows for relative rotation about a single axis with no relative translation.
*
* The revolute joint is probably the most common joint. It can be used for ragdolls and chains.
* Also called a *hinge* or *pin* joint.
* @{
*/

31
include/box3d/config.h Normal file
View file

@ -0,0 +1,31 @@
// SPDX-FileCopyrightText: 2026 Erin Catto
// SPDX-License-Identifier: MIT
#pragma once
// Box3D compile-time options.
//
// Normally set by the CMake BOX3D_* options. If you build Box3D without its
// CMake (dropping the sources into another project), set them here so the
// library and your code agree. Edit this file, or keep your settings elsewhere
// and point Box3D at them from your build:
//
// #define BOX3D_USER_CONFIG "my_box3d_config.h"
//
// A define passed on the compiler command line still wins over this file.
// Large world mode. Stores world positions in double precision. Affects ABI.
//#define BOX3D_DOUBLE_PRECISION
// Build the scalar fallback instead of SSE2/NEON.
//#define BOX3D_DISABLE_SIMD
// Enable internal validation in debug builds.
//#define BOX3D_VALIDATE
// Decorate the public API with your own export macro instead of Box3D's
// box3d_EXPORTS/BOX3D_DLL scheme, for example when compiling Box3D into another
// shared library. A single value cannot switch between dllexport and dllimport,
// so this suits embedding more than shipping Box3D as its own DLL.
//#define BOX3D_EXPORT MYENGINE_API

View file

@ -98,8 +98,16 @@ B3_API float b3GetStallThreshold( void );
#define B3_TIME_TO_SLEEP 0.5f
/// Maximum length of the body name. Can be 0 if you don't need names.
#ifndef B3_NAME_LENGTH
#define B3_NAME_LENGTH 18
/// Note: this gates recording capability.
#ifndef B3_BODY_NAME_LENGTH
#define B3_BODY_NAME_LENGTH 18
#endif
/// Maximum length of the shape name. Can be 0 if you don't need names.
/// Note: this gates recording capability.
/// todo waiting on this because it breaks existing recordings
#ifndef B3_SHAPE_NAME_LENGTH
#define B3_SHAPE_NAME_LENGTH 18
#endif
/// The maximum number of contact points between two touching shapes.

View file

@ -30,7 +30,12 @@ typedef void b3TaskCallback( void* taskContext );
/// @ingroup world
typedef void* b3EnqueueTaskCallback( b3TaskCallback* task, void* taskContext, void* userContext, const char* taskName );
/// Finishes a user task object that wraps a Box3D task.
/// Finishes a user task object that wraps a Box3D task. This must block until the task has completed.
/// The step blocks here on the tasks it spawned, so b3World_Step holds its stack across every
/// fork/join. Drive it from a thread you can dedicate to the step, or from a fiber this callback can
/// park to free the underlying thread. In a job system that cannot park a job's stack, do not call
/// b3World_Step from inside a job: a job that blocks on its own sub-jobs without yielding its thread
/// can deadlock. The in-tree scheduler instead runs other pending tasks on the waiting thread.
/// @ingroup world
typedef void b3FinishTaskCallback( void* userTask, void* userContext );
@ -175,10 +180,9 @@ typedef struct b3WorldDef
/// Number of workers to use with the provided task system. Box3D performs best when using only
/// performance cores and accessing a single L2 cache. Efficiency cores and hyper-threading provide
/// little benefit and may even harm performance.
/// @note Box3D does not create threads. This is the number of threads your applications has created
/// that you are allocating to b3World_Step.
/// @warning Do not modify the default value unless you are also providing a task system and providing
/// task callbacks (enqueueTask and finishTask).
/// This is clamped to the range [1, B3_MAX_WORKERS]. Using a value above 1 will turn on multithreading.
/// If task callbacks are provided then Box3D will use the user provided task system. Otherwise Box3D
/// will create threads and use an internal scheduler.
uint32_t workerCount;
/// function to spawn task
@ -298,7 +302,7 @@ typedef struct b3BodyDef
/// Sleep speed threshold, default is 0.05 meters per second
float sleepThreshold;
/// Optional body name for debugging. Up to B3_NAME_LENGTH characters (including null termination)
/// Optional body name for debugging. Up to B3_BODY_NAME_LENGTH characters (including null termination)
const char* name;
/// Use this to store application specific body data.
@ -833,10 +837,10 @@ typedef struct b3RevoluteJointDef
/// A flag to enable joint limits.
bool enableLimit;
/// The lower angle for the joint limit in radians.
/// The lower angle for the joint limit in radians. Minimum of -0.99*pi radians.
float lowerAngle;
/// The upper angle for the joint limit in radians.
/// The upper angle for the joint limit in radians. Maximum of 0.99*pi radians.
float upperAngle;
/// A flag to enable the joint motor.
@ -883,10 +887,10 @@ typedef struct b3SphericalJointDef
/// A flag to enable the twist limit. The twist is centered on the frameB z-axis.
bool enableTwistLimit;
/// The angle for the lower twist limit in radians. Valid range is [-pi, pi].
/// The angle for the lower twist limit in radians. Minimum of -0.99*pi radians.
float lowerTwistAngle;
/// The angle for the upper twist limit in radians. Valid range is [-pi, pi].
/// The angle for the upper twist limit in radians. Maximum of 0.99*pi radians.
float upperTwistAngle;
/// A flag to enable the joint motor

View file

@ -240,199 +240,6 @@ public:
static int sampleOverlapRecovery = RegisterSample( "Robustness", "Overlap Recovery", OverlapRecovery::Create );
class Cart : public Sample
{
public:
explicit Cart( SampleContext* context )
: Sample( context )
{
if ( context->restart == false )
{
m_camera->SetView( 45.0f, 30.0f, 15.0f, { 0.0f, 2.0f, 0.0f } );
//context->settings.subStepCount = 12;
}
AddGroundBox( 20.0f );
b3World_SetGravity( m_worldId, { 0, -22, 0 } );
m_contactHertz = 240.0f;
m_contactDampingRatio = 10.0f;
m_contactSpeed = 0.5f;
b3World_SetContactTuning( m_worldId, m_contactHertz, m_contactDampingRatio, m_contactSpeed );
m_constraintHertz = 240.0f;
m_constraintDampingRatio = 0.0f;
m_chassisId = {};
m_wheelId1 = {};
m_wheelId2 = {};
m_wheelId3 = {};
m_wheelId4 = {};
m_jointId1 = {};
m_jointId2 = {};
m_jointId3 = {};
m_jointId4 = {};
CreateScene();
}
void CreateScene()
{
if ( B3_IS_NON_NULL( m_chassisId ) )
{
b3DestroyBody( m_chassisId );
}
if ( B3_IS_NON_NULL( m_wheelId1 ) )
{
b3DestroyBody( m_wheelId1 );
}
if ( B3_IS_NON_NULL( m_wheelId2 ) )
{
b3DestroyBody( m_wheelId2 );
}
if ( B3_IS_NON_NULL( m_wheelId3 ) )
{
b3DestroyBody( m_wheelId3 );
}
if ( B3_IS_NON_NULL( m_wheelId4 ) )
{
b3DestroyBody( m_wheelId4 );
}
float yBase = 1.0f;
b3BodyDef bodyDef = b3DefaultBodyDef();
bodyDef.type = b3_dynamicBody;
bodyDef.position = { 0.0f, yBase, 0.0f };
m_chassisId = b3CreateBody( m_worldId, &bodyDef );
b3ShapeDef shapeDef = b3DefaultShapeDef();
shapeDef.density = 1000.0f;
b3BoxHull box = b3MakeTransformedBoxHull( 1.0f, 0.25f, 0.5f, { { 0.0f, 0.25f, 0.0f }, b3Quat_identity } );
b3CreateHullShape( m_chassisId, &shapeDef, &box.base );
shapeDef = b3DefaultShapeDef();
shapeDef.baseMaterial.rollingResistance = 0.02f;
shapeDef.density = 200.0f;
b3Sphere sphere = { b3Vec3_zero, 0.1f };
bodyDef.position = { -0.9f, yBase - 0.15f, 0.4f };
m_wheelId1 = b3CreateBody( m_worldId, &bodyDef );
b3CreateSphereShape( m_wheelId1, &shapeDef, &sphere );
bodyDef.position = { 0.9f, yBase - 0.15f, 0.4f };
m_wheelId2 = b3CreateBody( m_worldId, &bodyDef );
b3CreateSphereShape( m_wheelId2, &shapeDef, &sphere );
bodyDef.position = { 0.9f, yBase - 0.15f, -0.4f };
m_wheelId3 = b3CreateBody( m_worldId, &bodyDef );
b3CreateSphereShape( m_wheelId3, &shapeDef, &sphere );
bodyDef.position = { -0.9f, yBase - 0.15f, -0.4f };
m_wheelId4 = b3CreateBody( m_worldId, &bodyDef );
b3CreateSphereShape( m_wheelId4, &shapeDef, &sphere );
b3SphericalJointDef jointDef = b3DefaultSphericalJointDef();
jointDef.base.constraintHertz = m_constraintHertz;
jointDef.base.constraintDampingRatio = m_constraintDampingRatio;
jointDef.base.drawScale = 0.5f;
jointDef.base.bodyIdA = m_chassisId;
jointDef.base.bodyIdB = m_wheelId1;
jointDef.base.localFrameA.p = { -0.9f, -0.15f, 0.4f };
jointDef.base.localFrameB.p = { 0.0f, 0.0f, 0.0f };
m_jointId1 = b3CreateSphericalJoint( m_worldId, &jointDef );
jointDef.base.bodyIdA = m_chassisId;
jointDef.base.bodyIdB = m_wheelId2;
jointDef.base.localFrameA.p = { 0.9f, -0.15f, 0.4f };
jointDef.base.localFrameB.p = { 0.0f, 0.0f, 0.0f };
m_jointId2 = b3CreateSphericalJoint( m_worldId, &jointDef );
jointDef.base.bodyIdA = m_chassisId;
jointDef.base.bodyIdB = m_wheelId3;
jointDef.base.localFrameA.p = { 0.9f, -0.15f, -0.4f };
jointDef.base.localFrameB.p = { 0.0f, 0.0f, 0.0f };
m_jointId3 = b3CreateSphericalJoint( m_worldId, &jointDef );
jointDef.base.bodyIdA = m_chassisId;
jointDef.base.bodyIdB = m_wheelId4;
jointDef.base.localFrameA.p = { -0.9f, -0.15f, -0.4f };
jointDef.base.localFrameB.p = { 0.0f, 0.0f, 0.0f };
m_jointId4 = b3CreateSphericalJoint( m_worldId, &jointDef );
}
bool DrawControls() override
{
ImGui::PushItemWidth( 6.0f * ImGui::GetFontSize() );
bool changed = false;
ImGui::Text( "Contact" );
changed = changed || ImGui::SliderFloat( "Hertz##contact", &m_contactHertz, 0.0f, 240.0f, "%.f" );
changed = changed || ImGui::SliderFloat( "Damping Ratio##contact", &m_contactDampingRatio, 0.0f, 100.0f, "%.f" );
changed = changed || ImGui::SliderFloat( "Speed", &m_contactSpeed, 0.0f, 5.0f, "%.1f" );
if ( changed )
{
b3World_SetContactTuning( m_worldId, m_contactHertz, m_contactDampingRatio, m_contactSpeed );
CreateScene();
}
ImGui::Separator();
changed = false;
ImGui::Text( "Joint" );
changed = changed || ImGui::SliderFloat( "Hertz##joint", &m_constraintHertz, 0.0f, 240.0f, "%.f" );
changed = changed || ImGui::SliderFloat( "Damping Ratio##joint", &m_constraintDampingRatio, 0.0f, 20.0f, "%.f" );
ImGui::Separator();
changed = changed || ImGui::Button( "Reset Scene" );
if ( changed )
{
b3Joint_SetConstraintTuning( m_jointId1, m_constraintHertz, m_constraintDampingRatio );
b3Joint_SetConstraintTuning( m_jointId2, m_constraintHertz, m_constraintDampingRatio );
b3Joint_SetConstraintTuning( m_jointId3, m_constraintHertz, m_constraintDampingRatio );
b3Joint_SetConstraintTuning( m_jointId4, m_constraintHertz, m_constraintDampingRatio );
CreateScene();
}
ImGui::PopItemWidth();
return true;
}
static Sample* Create( SampleContext* context )
{
return new Cart( context );
}
b3BodyId m_chassisId;
b3BodyId m_wheelId1;
b3BodyId m_wheelId2;
b3BodyId m_wheelId3;
b3BodyId m_wheelId4;
b3JointId m_jointId1;
b3JointId m_jointId2;
b3JointId m_jointId3;
b3JointId m_jointId4;
float m_contactHertz;
float m_contactDampingRatio;
float m_contactSpeed;
float m_constraintHertz;
float m_constraintDampingRatio;
};
static int sampleCart = RegisterSample( "Robustness", "Cart", Cart::Create );
// This forces a constraint graph color overflow
class OverflowColorPile : public Sample
{

View file

@ -15,7 +15,7 @@ set(BOX3D_SHARED_FILES
utils.h
)
add_library(shared ${BOX3D_SHARED_FILES})
add_library(shared STATIC ${BOX3D_SHARED_FILES})
set_target_properties(shared PROPERTIES
C_STANDARD 17

View file

@ -93,6 +93,7 @@ set(BOX3D_INCLUDE_FILES
../include/box3d/base.h
../include/box3d/box3d.h
../include/box3d/collision.h
../include/box3d/config.h
../include/box3d/constants.h
../include/box3d/id.h
../include/box3d/math_functions.h
@ -104,7 +105,7 @@ set(BOX3D_INCLUDE_FILES
set(CMAKE_C_VISIBILITY_PRESET hidden)
set(CMAKE_VISIBILITY_INLINES_HIDDEN 1)
add_library(box3d STATIC ${BOX3D_SOURCE_FILES} ${BOX3D_INCLUDE_FILES})
add_library(box3d ${BOX3D_SOURCE_FILES} ${BOX3D_INCLUDE_FILES})
# target_link_libraries(box3d PRIVATE eastl)

View file

@ -22,7 +22,7 @@
#include <stddef.h>
#include <string.h>
_Static_assert( B3_NAME_LENGTH >= 0, "minimum name length" );
_Static_assert( B3_BODY_NAME_LENGTH >= 0, "minimum name length" );
// Get a validated body from a world using an id.
b3Body* b3GetBodyFullId( b3World* world, b3BodyId bodyId )
@ -274,10 +274,10 @@ b3BodyId b3CreateBody( b3WorldId worldId, const b3BodyDef* def )
if ( def->name )
{
#if defined( _MSC_VER )
strncpy_s( body->name, B3_NAME_LENGTH + 1, def->name, B3_NAME_LENGTH );
strncpy_s( body->name, B3_BODY_NAME_LENGTH + 1, def->name, B3_BODY_NAME_LENGTH );
#else
strncpy( body->name, def->name, B3_NAME_LENGTH );
body->name[B3_NAME_LENGTH] = 0;
strncpy( body->name, def->name, B3_BODY_NAME_LENGTH );
body->name[B3_BODY_NAME_LENGTH] = 0;
#endif
}
else
@ -1733,10 +1733,10 @@ void b3Body_SetName( b3BodyId bodyId, const char* name )
if ( name )
{
#if defined( _MSC_VER )
strncpy_s( body->name, B3_NAME_LENGTH + 1, name, B3_NAME_LENGTH );
strncpy_s( body->name, B3_BODY_NAME_LENGTH + 1, name, B3_BODY_NAME_LENGTH );
#else
strncpy( body->name, name, B3_NAME_LENGTH );
body->name[B3_NAME_LENGTH] = 0;
strncpy( body->name, name, B3_BODY_NAME_LENGTH );
body->name[B3_BODY_NAME_LENGTH] = 0;
#endif
}
else

View file

@ -123,7 +123,7 @@ typedef struct b3Body
// Used to check for invalid b3BodyId
uint16_t generation;
char name[B3_NAME_LENGTH + 1];
char name[B3_BODY_NAME_LENGTH + 1];
} b3Body;
// Body State

View file

@ -24,7 +24,7 @@ static inline uint32_t b3CTZ32( uint32_t block )
// This function doesn't need to be fast, so using the Ivy Bridge fallback.
static inline uint32_t b3CLZ32( uint32_t value )
{
#if 0
#if 1
// Use BSR (Bit Scan Reverse) which is available on Ivy Bridge
unsigned long index;

View file

@ -581,9 +581,6 @@ b3JointId b3CreatePrismaticJoint( b3WorldId worldId, const b3PrismaticJointDef*
b3JointId b3CreateRevoluteJoint( b3WorldId worldId, const b3RevoluteJointDef* def )
{
B3_CHECK_JOINT_DEF( def );
B3_ASSERT( def->lowerAngle <= def->upperAngle );
B3_ASSERT( def->lowerAngle >= -0.99f * B3_PI );
B3_ASSERT( def->upperAngle <= 0.99f * B3_PI );
b3World* world = b3GetUnlockedWorldFromId( worldId );
if (world == NULL)
@ -599,10 +596,12 @@ b3JointId b3CreateRevoluteJoint( b3WorldId worldId, const b3RevoluteJointDef* de
joint->revoluteJoint.hertz = def->hertz;
joint->revoluteJoint.dampingRatio = def->dampingRatio;
joint->revoluteJoint.targetAngle = b3ClampFloat( def->targetAngle, -B3_PI, B3_PI );
joint->revoluteJoint.lowerAngle = b3MinFloat( def->lowerAngle, def->upperAngle );
joint->revoluteJoint.upperAngle = b3MaxFloat( def->lowerAngle, def->upperAngle );
joint->revoluteJoint.lowerAngle = b3ClampFloat( joint->revoluteJoint.lowerAngle, -B3_PI, B3_PI );
joint->revoluteJoint.upperAngle = b3ClampFloat( joint->revoluteJoint.upperAngle, -B3_PI, B3_PI );
float lowerAngle = b3MinFloat( def->lowerAngle, def->upperAngle );
float upperAngle = b3MaxFloat( def->lowerAngle, def->upperAngle );
joint->revoluteJoint.lowerAngle = b3ClampFloat( lowerAngle, -0.99f * B3_PI, 0.99f * B3_PI );
joint->revoluteJoint.upperAngle = b3ClampFloat( upperAngle, -0.99f * B3_PI, 0.99f * B3_PI );
joint->revoluteJoint.maxMotorTorque = def->maxMotorTorque;
joint->revoluteJoint.motorSpeed = def->motorSpeed;
joint->revoluteJoint.enableSpring = def->enableSpring;
@ -617,9 +616,6 @@ b3JointId b3CreateRevoluteJoint( b3WorldId worldId, const b3RevoluteJointDef* de
b3JointId b3CreateSphericalJoint( b3WorldId worldId, const b3SphericalJointDef* def )
{
B3_CHECK_JOINT_DEF( def );
B3_ASSERT( def->lowerTwistAngle <= def->upperTwistAngle );
B3_ASSERT( def->lowerTwistAngle >= -0.99f * B3_PI );
B3_ASSERT( def->upperTwistAngle <= 0.99f * B3_PI );
B3_ASSERT( 0.0f <= def->coneAngle && def->coneAngle <= 0.99f * B3_PI );
B3_ASSERT( b3IsValidQuat( def->targetRotation ) );
@ -638,10 +634,12 @@ b3JointId b3CreateSphericalJoint( b3WorldId worldId, const b3SphericalJointDef*
joint->sphericalJoint.dampingRatio = def->dampingRatio;
joint->sphericalJoint.targetRotation = def->targetRotation;
joint->sphericalJoint.coneAngle = b3ClampFloat( def->coneAngle, 0.0f, 0.5f * B3_PI );
joint->sphericalJoint.lowerTwistAngle = b3MinFloat( def->lowerTwistAngle, def->upperTwistAngle );
joint->sphericalJoint.upperTwistAngle = b3MaxFloat( def->lowerTwistAngle, def->upperTwistAngle );
joint->sphericalJoint.lowerTwistAngle = b3ClampFloat( joint->sphericalJoint.lowerTwistAngle, -B3_PI, B3_PI );
joint->sphericalJoint.upperTwistAngle = b3ClampFloat( joint->sphericalJoint.upperTwistAngle, -B3_PI, B3_PI );
float lowerAngle = b3MinFloat( def->lowerTwistAngle, def->upperTwistAngle );
float upperAngle = b3MaxFloat( def->lowerTwistAngle, def->upperTwistAngle );
joint->sphericalJoint.lowerTwistAngle = b3ClampFloat( lowerAngle, -0.99f * B3_PI, 0.99f * B3_PI );
joint->sphericalJoint.upperTwistAngle = b3ClampFloat( upperAngle, -0.99f * B3_PI, 0.99f * B3_PI );
joint->sphericalJoint.maxMotorTorque = def->maxMotorTorque;
joint->sphericalJoint.motorVelocity = def->motorVelocity;
joint->sphericalJoint.enableSpring = def->enableSpring;
@ -1156,6 +1154,9 @@ static b3Vec3 b3GetJointConstraintTorque( b3World* world, b3Joint* joint )
switch ( joint->type )
{
case b3_parallelJoint:
return b3GetParallelJointTorque( world, base );
case b3_distanceJoint:
return b3Vec3_zero;

View file

@ -5,7 +5,7 @@
typedef struct b3World b3World;
// Callback invoked by b2ParallelFor to process a range of items. May be called
// Callback invoked by b3ParallelFor to process a range of items. May be called
// multiple times per worker: work is divided into blocks that workers claim
// atomically, so a worker that finishes early picks up the next unclaimed
// block instead of sitting idle. workerIndex is the worker identity and is

View file

@ -2203,6 +2203,28 @@ void* b3World_GetUserData( b3WorldId worldId )
return world->userData;
}
void b3World_SetFrictionCallback( b3WorldId worldId, b3FrictionCallback* callback )
{
b3World* world = b3GetUnlockedWorldFromId( worldId );
if ( world == NULL )
{
return;
}
world->frictionCallback = callback != NULL ? callback : b3DefaultFrictionCallback;
}
void b3World_SetRestitutionCallback( b3WorldId worldId, b3RestitutionCallback* callback )
{
b3World* world = b3GetUnlockedWorldFromId( worldId );
if ( world == NULL )
{
return;
}
world->restitutionCallback = callback != NULL ? callback : b3DefaultRestitutionCallback;
}
void b3World_SetWorkerCount( b3WorldId worldId, int count )
{
b3World* world = b3GetUnlockedWorldFromId( worldId );

View file

@ -8,12 +8,16 @@
#include <stdbool.h>
#include <stdint.h>
// Software prefetch hint. _MM_HINT_T0 brings the line into all cache levels.
// MSVC exposes _mm_prefetch via <intrin.h>; clang/gcc accept it via <xmmintrin.h>
// on x86 and provide __builtin_prefetch elsewhere.
// Software prefetch hint. T0 brings the line into all cache levels.
// On x86 MSVC exposes _mm_prefetch, ARM MSVC uses __prefetch instead.
// clang/gcc provide __builtin_prefetch on every target.
#if defined( B3_COMPILER_MSVC )
#include <intrin.h>
#if defined( B3_CPU_X86_X64 )
#define b3Prefetch( addr ) _mm_prefetch( (const char*)( addr ), _MM_HINT_T0 )
#else
#define b3Prefetch( addr ) __prefetch( (const void*)( addr ) )
#endif
#elif defined( B3_COMPILER_CLANG ) || defined( B3_COMPILER_GCC )
#define b3Prefetch( addr ) __builtin_prefetch( (const void*)( addr ), 0, 3 )
#else

View file

@ -223,6 +223,47 @@ float b3PrismaticJoint_GetMaxMotorForce( b3JointId jointId )
return base->prismaticJoint.maxMotorForce;
}
float b3PrismaticJoint_GetMotorForce( b3JointId jointId )
{
b3World* world = b3GetWorld( jointId.world0 );
b3JointSim* base = b3GetJointSimCheckType( jointId, b3_prismaticJoint );
return world->inv_h * base->prismaticJoint.motorImpulse;
}
float b3PrismaticJoint_GetSpeed( b3JointId jointId )
{
b3World* world = b3GetWorld( jointId.world0 );
b3JointSim* base = b3GetJointSimCheckType( jointId, b3_prismaticJoint );
b3Body* bodyA = b3Array_Get( world->bodies, base->bodyIdA );
b3Body* bodyB = b3Array_Get( world->bodies, base->bodyIdB );
b3BodySim* bodySimA = b3GetBodySim( world, bodyA );
b3BodySim* bodySimB = b3GetBodySim( world, bodyB );
b3BodyState* stateA = b3GetBodyState( world, bodyA );
b3BodyState* stateB = b3GetBodyState( world, bodyB );
b3Quat qA = bodySimA->transform.q;
b3Quat qB = bodySimB->transform.q;
b3Vec3 axisA = b3RotateVector( qA, b3RotateVector( base->localFrameA.q, b3Vec3_axisX ) );
b3Vec3 rA = b3RotateVector( qA, b3Sub( base->localFrameA.p, bodySimA->localCenter ) );
b3Vec3 rB = b3RotateVector( qB, b3Sub( base->localFrameB.p, bodySimB->localCenter ) );
// Difference the centers in double so the speed stays exact far from the origin.
b3Vec3 d = b3Add( b3SubPos( bodySimB->center, bodySimA->center ), b3Sub( rB, rA ) );
b3Vec3 vA = stateA ? stateA->linearVelocity : b3Vec3_zero;
b3Vec3 vB = stateB ? stateB->linearVelocity : b3Vec3_zero;
b3Vec3 wA = stateA ? stateA->angularVelocity : b3Vec3_zero;
b3Vec3 wB = stateB ? stateB->angularVelocity : b3Vec3_zero;
b3Vec3 vRel = b3Sub( b3Add( vB, b3Cross( wB, rB ) ), b3Add( vA, b3Cross( wA, rA ) ) );
// The axis moves with body A, so account for its rotation.
float speed = b3Dot( d, b3Cross( wA, axisA ) ) + b3Dot( axisA, vRel );
return speed;
}
b3Vec3 b3GetPrismaticJointForce( b3World* world, b3JointSim* base )
{
b3WorldTransform transformA = b3GetBodyTransform( world, base->bodyIdA );

View file

@ -938,7 +938,7 @@ void b3RecInternTag( b3Recording* rec, uint64_t key, uint64_t id, const char* na
tag->key = key;
tag->id = id;
int n = 0;
while ( name != NULL && name[n] != '\0' && n < B3_NAME_LENGTH )
while ( name != NULL && name[n] != '\0' && n < B3_BODY_NAME_LENGTH )
{
tag->name[n] = name[n];
n++;

View file

@ -120,7 +120,7 @@ typedef struct b3RecTag
{
uint64_t key; // hash of (id, name)
uint64_t id; // entity/actor id
char name[B3_NAME_LENGTH + 1]; // query label
char name[B3_BODY_NAME_LENGTH + 1]; // query label
} b3RecTag;
// User-owned recording buffer. The world appends into it while active; the host saves and
@ -356,7 +356,7 @@ void b3RecWriteRegistry( b3Recording* rec );
uint64_t b3HashQueryTag( uint64_t id, const char* name );
// Record a key->(id, name) mapping once, deduped by key (a repeated key keeps its first id/name).
// The name is clamped to B3_NAME_LENGTH.
// The name is clamped to B3_BODY_NAME_LENGTH.
void b3RecInternTag( b3Recording* rec, uint64_t key, uint64_t id, const char* name );
// Intern each large geometry kind and return a stable u32 id for use in create ops.

View file

@ -385,9 +385,9 @@ const char* b3RecR_STR( b3RecReader* rdr )
}
int n = (int)len;
if ( n > B3_NAME_LENGTH )
if ( n > B3_BODY_NAME_LENGTH )
{
n = B3_NAME_LENGTH;
n = B3_BODY_NAME_LENGTH;
}
b3RecRdrCheck( rdr, (int)len );
if ( rdr->ok && n > 0 )
@ -2332,7 +2332,7 @@ static void b3RecLoadTags( b3RecReader* rdr, const uint8_t* rp, const uint8_t* d
{
break;
}
int n = len > B3_NAME_LENGTH ? B3_NAME_LENGTH : (int)len;
int n = len > B3_BODY_NAME_LENGTH ? B3_BODY_NAME_LENGTH : (int)len;
tags[loaded].key = key;
tags[loaded].id = id;
if ( n > 0 )

View file

@ -91,7 +91,7 @@ typedef struct b3RecReader
int matScratchCap;
// Scratch for string reads: rotating slots, valid until the next 4 STR reads
char strBufs[4][B3_NAME_LENGTH + 1];
char strBufs[4][B3_BODY_NAME_LENGTH + 1];
int strNext;
// Preloaded geometry registry

View file

@ -73,18 +73,16 @@ float b3RevoluteJoint_GetUpperLimit( b3JointId jointId )
void b3RevoluteJoint_SetLimits( b3JointId jointId, float lowerLimitRadians, float upperLimitRadians )
{
B3_ASSERT( lowerLimitRadians <= upperLimitRadians );
B3_ASSERT( b3IsValidFloat( lowerLimitRadians ) && b3IsValidFloat( upperLimitRadians ) );
b3World* world = b3GetWorld( jointId.world0 );
B3_REC( world, RevoluteJointSetLimits, jointId, lowerLimitRadians, upperLimitRadians );
float lowerAngle = b3ClampFloat( lowerLimitRadians, -B3_PI, B3_PI );
float upperAngle = b3ClampFloat( upperLimitRadians, -B3_PI, B3_PI );
float lowerAngle = b3MinFloat( lowerLimitRadians, upperLimitRadians );
float upperAngle = b3MaxFloat( lowerLimitRadians, upperLimitRadians );
b3JointSim* base = b3GetJointSimCheckType( jointId, b3_revoluteJoint );
base->revoluteJoint.lowerAngle = lowerAngle;
base->revoluteJoint.upperAngle = upperAngle;
base->revoluteJoint.lowerImpulse = 0.0f;
base->revoluteJoint.upperImpulse = 0.0f;
base->revoluteJoint.lowerAngle = b3ClampFloat( lowerAngle, -0.99f * B3_PI, 0.99f * B3_PI );
base->revoluteJoint.upperAngle = b3ClampFloat( upperAngle, -0.99f * B3_PI, 0.99f * B3_PI );
}
float b3RevoluteJoint_GetAngle( b3JointId jointId )
@ -219,6 +217,13 @@ float b3RevoluteJoint_GetMaxMotorTorque( b3JointId jointId )
return base->revoluteJoint.maxMotorTorque;
}
float b3RevoluteJoint_GetMotorTorque( b3JointId jointId )
{
b3World* world = b3GetWorld( jointId.world0 );
b3JointSim* base = b3GetJointSimCheckType( jointId, b3_revoluteJoint );
return world->inv_h * base->revoluteJoint.motorImpulse;
}
b3Vec3 b3GetRevoluteJointForce( b3World* world, b3JointSim* base )
{
b3Vec3 force = b3MulSV( world->inv_h, base->revoluteJoint.linearImpulse );

View file

@ -1821,7 +1821,7 @@ void b3Solve( b3World* world, b3StepContext* stepContext )
}
}
// The calling thread of b2World_Step also enters b2SolverTask as worker 0 and races for the
// The calling thread of b3World_Step also enters b3SolverTask as worker 0 and races for the
// orchestrator slot via the CAS inside. This guarantees progress even when the user's task
// system can't run the queued worker 0 promptly: it might schedule out of order, have fewer
// threads than workerCount, or invert priority by parking the calling thread in finishTaskFcn.

View file

@ -249,7 +249,7 @@ typedef struct b3StepContext
char padding2[64];
// Race flag claimed by whichever runner reaches b3SolverTask with workerIndex 0 first.
// The calling thread of b2World_Step also races for this slot so the orchestrator can
// The calling thread of b3World_Step also races for this slot so the orchestrator can
// always make progress, regardless of how the user's task system schedules tasks (out
// of order, fewer threads than workers, or synchronously inside enqueueTaskFcn). The
// loser of the race no-ops as workerIndex 0.

View file

@ -103,14 +103,13 @@ void b3SphericalJoint_SetTwistLimits( b3JointId jointId, float lowerLimitRadians
B3_ASSERT( b3IsValidFloat( lowerLimitRadians ) && b3IsValidFloat( upperLimitRadians ) );
b3World* world = b3GetWorld( jointId.world0 );
B3_REC( world, SphericalJointSetTwistLimits, jointId, lowerLimitRadians, upperLimitRadians );
float lowerTwistAngle = b3MinFloat( lowerLimitRadians, upperLimitRadians );
float upperTwistAngle = b3MaxFloat( lowerLimitRadians, upperLimitRadians );
lowerTwistAngle = b3ClampFloat( lowerTwistAngle, -B3_PI, B3_PI );
upperTwistAngle = b3ClampFloat( upperTwistAngle, -B3_PI, B3_PI );
float lowerAngle = b3MinFloat( lowerLimitRadians, upperLimitRadians );
float upperAngle = b3MaxFloat( lowerLimitRadians, upperLimitRadians );
b3JointSim* base = b3GetJointSimCheckType( jointId, b3_sphericalJoint );
base->sphericalJoint.lowerTwistAngle = lowerTwistAngle;
base->sphericalJoint.upperTwistAngle = upperTwistAngle;
base->sphericalJoint.lowerTwistAngle = b3ClampFloat( lowerAngle, -0.99f * B3_PI, 0.99f * B3_PI );
base->sphericalJoint.upperTwistAngle = b3ClampFloat( upperAngle, -0.99f * B3_PI, 0.99f * B3_PI );
}
float b3SphericalJoint_GetTwistAngle( b3JointId jointId )
@ -245,6 +244,13 @@ float b3SphericalJoint_GetMaxMotorTorque( b3JointId jointId )
return base->sphericalJoint.maxMotorTorque;
}
b3Vec3 b3SphericalJoint_GetMotorTorque( b3JointId jointId )
{
b3World* world = b3GetWorld( jointId.world0 );
b3JointSim* base = b3GetJointSimCheckType( jointId, b3_sphericalJoint );
return b3MulSV( world->inv_h, base->sphericalJoint.motorImpulse );
}
b3Vec3 b3GetSphericalJointForce( b3World* world, b3JointSim* base )
{
b3Vec3 force = b3MulSV( world->inv_h, base->sphericalJoint.linearImpulse );

View file

@ -140,6 +140,13 @@ b3DebugDraw b3DefaultDebugDraw( void )
draw.DrawBoxFcn = b3EmptyDrawBox;
draw.DrawStringFcn = b3EmptyDrawString;
// Not too small, not too big.
float h = 100.0f * b3GetLengthUnitsPerMeter();
draw.drawingBounds = (b3AABB){
.lowerBound = { -h, -h, -h },
.upperBound = { h, h, h },
};
draw.jointScale = 1.0f;
draw.forceScale = 1.0f;

View file

@ -14,6 +14,7 @@ set(BOX3D_TEST_FILES
test_height_field.c
test_hull.c
test_id.c
test_joint.c
test_large_world.c
test_macros.h
test_math.c

View file

@ -37,6 +37,7 @@ extern int DistanceTest( void );
extern int HeightFieldTest( void );
extern int HullTest( void );
extern int IdTest( void );
extern int JointTest( void );
extern int LargeWorldTest( void );
extern int MathTest( void );
extern int MoverTest( void );
@ -106,6 +107,7 @@ int main( int argc, char** argv )
MAYBE_RUN_TEST( HeightFieldTest );
MAYBE_RUN_TEST( HullTest );
MAYBE_RUN_TEST( IdTest );
MAYBE_RUN_TEST( JointTest );
MAYBE_RUN_TEST( LargeWorldTest );
MAYBE_RUN_TEST( MathTest );
MAYBE_RUN_TEST( MoverTest );

581
test/test_joint.c Normal file
View file

@ -0,0 +1,581 @@
// SPDX-FileCopyrightText: 2026 Erin Catto
// SPDX-License-Identifier: MIT
#include "test_macros.h"
#include "box3d/box3d.h"
#include "box3d/math_functions.h"
// One sub-test per joint type. Each creates the joint, exercises the shared
// b3Joint_* API plus every type-specific accessor, then steps to make sure the
// joint solves without tripping a validation assert.
typedef struct JointFixture
{
b3WorldId worldId;
b3BodyId groundId;
b3BodyId bodyId;
} JointFixture;
// Static ground plus a dynamic box, anchored so a point-coincident joint starts
// satisfied. Gravity is off so the body stays put across the handful of steps
// each sub-test takes.
static JointFixture CreateJointFixture( void )
{
b3WorldDef worldDef = b3DefaultWorldDef();
worldDef.gravity = b3Vec3_zero;
JointFixture f;
f.worldId = b3CreateWorld( &worldDef );
b3BodyDef groundDef = b3DefaultBodyDef();
f.groundId = b3CreateBody( f.worldId, &groundDef );
b3BodyDef bodyDef = b3DefaultBodyDef();
bodyDef.type = b3_dynamicBody;
bodyDef.position = (b3Pos){ 0.0f, 4.0f, 0.0f };
f.bodyId = b3CreateBody( f.worldId, &bodyDef );
b3ShapeDef shapeDef = b3DefaultShapeDef();
shapeDef.density = 1.0f;
b3BoxHull box = b3MakeCubeHull( 0.5f );
b3CreateHullShape( f.bodyId, &shapeDef, &box.base );
return f;
}
// Place the joint anchor at the dynamic body so both local frames map to the
// same world point.
static void SetCommonFrames( b3JointDef* base, const JointFixture* f )
{
base->bodyIdA = f->groundId;
base->bodyIdB = f->bodyId;
base->localFrameA.p = (b3Vec3){ 0.0f, 4.0f, 0.0f };
base->localFrameB.p = (b3Vec3){ 0.0f, 0.0f, 0.0f };
}
// Step a few times, destroy the joint, then the world. Destroying the joint
// explicitly also covers b3DestroyJoint and stale-handle detection.
static int FinishJoint( b3JointId jointId, b3WorldId worldId )
{
for ( int i = 0; i < 8; ++i )
{
b3World_Step( worldId, 1.0f / 60.0f, 4 );
}
b3DestroyJoint( jointId, true );
ENSURE( b3Joint_IsValid( jointId ) == false );
b3DestroyWorld( worldId );
return 0;
}
// Exercise the API shared by every joint type. Frames are saved and restored so
// the caller's setup survives.
static int ExerciseJointBase( b3JointId jointId, b3WorldId worldId, b3BodyId bodyIdA, b3BodyId bodyIdB, b3JointType expectedType )
{
ENSURE( b3Joint_IsValid( jointId ) );
ENSURE( b3Joint_GetType( jointId ) == expectedType );
ENSURE( B3_ID_EQUALS( b3Joint_GetBodyA( jointId ), bodyIdA ) );
ENSURE( B3_ID_EQUALS( b3Joint_GetBodyB( jointId ), bodyIdB ) );
// B3_ID_EQUALS does not work for world ids
b3WorldId gotWorld = b3Joint_GetWorld( jointId );
ENSURE( gotWorld.index1 == worldId.index1 && gotWorld.generation == worldId.generation );
b3Transform originalA = b3Joint_GetLocalFrameA( jointId );
b3Transform originalB = b3Joint_GetLocalFrameB( jointId );
b3Transform frameA = { { 0.1f, 0.2f, 0.3f }, b3Quat_identity };
b3Joint_SetLocalFrameA( jointId, frameA );
b3Transform gotA = b3Joint_GetLocalFrameA( jointId );
ENSURE( gotA.p.x == frameA.p.x && gotA.p.y == frameA.p.y && gotA.p.z == frameA.p.z );
b3Transform frameB = { { -0.4f, 0.5f, -0.6f }, b3Quat_identity };
b3Joint_SetLocalFrameB( jointId, frameB );
b3Transform gotB = b3Joint_GetLocalFrameB( jointId );
ENSURE( gotB.p.x == frameB.p.x && gotB.p.y == frameB.p.y && gotB.p.z == frameB.p.z );
b3Joint_SetCollideConnected( jointId, true );
ENSURE( b3Joint_GetCollideConnected( jointId ) == true );
b3Joint_SetCollideConnected( jointId, false );
ENSURE( b3Joint_GetCollideConnected( jointId ) == false );
int userData = 0;
b3Joint_SetUserData( jointId, &userData );
ENSURE( b3Joint_GetUserData( jointId ) == &userData );
b3Joint_SetConstraintTuning( jointId, 90.0f, 3.0f );
float hertz = 0.0f;
float dampingRatio = 0.0f;
b3Joint_GetConstraintTuning( jointId, &hertz, &dampingRatio );
ENSURE( hertz == 90.0f );
ENSURE( dampingRatio == 3.0f );
b3Joint_SetForceThreshold( jointId, 100.0f );
ENSURE( b3Joint_GetForceThreshold( jointId ) == 100.0f );
b3Joint_SetTorqueThreshold( jointId, 200.0f );
ENSURE( b3Joint_GetTorqueThreshold( jointId ) == 200.0f );
b3Joint_WakeBodies( jointId );
// No stable value to assert before the first step, call for coverage
b3Vec3 force = b3Joint_GetConstraintForce( jointId );
b3Vec3 torque = b3Joint_GetConstraintTorque( jointId );
float linearSeparation = b3Joint_GetLinearSeparation( jointId );
MAYBE_UNUSED( force );
MAYBE_UNUSED( torque );
MAYBE_UNUSED( linearSeparation );
// Wheel joint angular separation is an unimplemented todo in joint.c that
// asserts. Every other type computes it.
if ( expectedType != b3_wheelJoint )
{
float angularSeparation = b3Joint_GetAngularSeparation( jointId );
MAYBE_UNUSED( angularSeparation );
}
b3Joint_SetLocalFrameA( jointId, originalA );
b3Joint_SetLocalFrameB( jointId, originalB );
return 0;
}
static int TestParallelJoint( void )
{
JointFixture f = CreateJointFixture();
b3ParallelJointDef def = b3DefaultParallelJointDef();
SetCommonFrames( &def.base, &f );
def.hertz = 2.0f;
def.dampingRatio = 0.5f;
def.maxTorque = 100.0f;
b3JointId jointId = b3CreateParallelJoint( f.worldId, &def );
if ( ExerciseJointBase( jointId, f.worldId, f.groundId, f.bodyId, b3_parallelJoint ) != 0 )
{
return 1;
}
b3ParallelJoint_SetSpringHertz( jointId, 5.0f );
ENSURE( b3ParallelJoint_GetSpringHertz( jointId ) == 5.0f );
b3ParallelJoint_SetSpringDampingRatio( jointId, 0.7f );
ENSURE( b3ParallelJoint_GetSpringDampingRatio( jointId ) == 0.7f );
b3ParallelJoint_SetMaxTorque( jointId, 250.0f );
ENSURE( b3ParallelJoint_GetMaxTorque( jointId ) == 250.0f );
return FinishJoint( jointId, f.worldId );
}
static int TestDistanceJoint( void )
{
JointFixture f = CreateJointFixture();
b3DistanceJointDef def = b3DefaultDistanceJointDef();
SetCommonFrames( &def.base, &f );
def.length = 2.0f;
b3JointId jointId = b3CreateDistanceJoint( f.worldId, &def );
if ( ExerciseJointBase( jointId, f.worldId, f.groundId, f.bodyId, b3_distanceJoint ) != 0 )
{
return 1;
}
b3DistanceJoint_SetLength( jointId, 3.0f );
ENSURE( b3DistanceJoint_GetLength( jointId ) == 3.0f );
b3DistanceJoint_EnableSpring( jointId, true );
ENSURE( b3DistanceJoint_IsSpringEnabled( jointId ) == true );
b3DistanceJoint_SetSpringForceRange( jointId, -50.0f, 75.0f );
float lowerForce = 0.0f;
float upperForce = 0.0f;
b3DistanceJoint_GetSpringForceRange( jointId, &lowerForce, &upperForce );
ENSURE( lowerForce == -50.0f && upperForce == 75.0f );
b3DistanceJoint_SetSpringHertz( jointId, 4.0f );
ENSURE( b3DistanceJoint_GetSpringHertz( jointId ) == 4.0f );
b3DistanceJoint_SetSpringDampingRatio( jointId, 0.6f );
ENSURE( b3DistanceJoint_GetSpringDampingRatio( jointId ) == 0.6f );
b3DistanceJoint_EnableLimit( jointId, true );
ENSURE( b3DistanceJoint_IsLimitEnabled( jointId ) == true );
b3DistanceJoint_SetLengthRange( jointId, 1.0f, 5.0f );
ENSURE( b3DistanceJoint_GetMinLength( jointId ) == 1.0f );
ENSURE( b3DistanceJoint_GetMaxLength( jointId ) == 5.0f );
float currentLength = b3DistanceJoint_GetCurrentLength( jointId );
MAYBE_UNUSED( currentLength );
b3DistanceJoint_EnableMotor( jointId, true );
ENSURE( b3DistanceJoint_IsMotorEnabled( jointId ) == true );
b3DistanceJoint_SetMotorSpeed( jointId, 1.5f );
ENSURE( b3DistanceJoint_GetMotorSpeed( jointId ) == 1.5f );
b3DistanceJoint_SetMaxMotorForce( jointId, 25.0f );
ENSURE( b3DistanceJoint_GetMaxMotorForce( jointId ) == 25.0f );
float motorForce = b3DistanceJoint_GetMotorForce( jointId );
MAYBE_UNUSED( motorForce );
return FinishJoint( jointId, f.worldId );
}
static int TestFilterJoint( void )
{
JointFixture f = CreateJointFixture();
// The filter joint has no type-specific API. It only disables collision and
// keeps both bodies in the same island.
b3FilterJointDef def = b3DefaultFilterJointDef();
def.base.bodyIdA = f.groundId;
def.base.bodyIdB = f.bodyId;
b3JointId jointId = b3CreateFilterJoint( f.worldId, &def );
if ( ExerciseJointBase( jointId, f.worldId, f.groundId, f.bodyId, b3_filterJoint ) != 0 )
{
return 1;
}
return FinishJoint( jointId, f.worldId );
}
static int TestMotorJoint( void )
{
JointFixture f = CreateJointFixture();
b3MotorJointDef def = b3DefaultMotorJointDef();
SetCommonFrames( &def.base, &f );
b3JointId jointId = b3CreateMotorJoint( f.worldId, &def );
if ( ExerciseJointBase( jointId, f.worldId, f.groundId, f.bodyId, b3_motorJoint ) != 0 )
{
return 1;
}
b3Vec3 linearVelocity = { 1.0f, 2.0f, 3.0f };
b3MotorJoint_SetLinearVelocity( jointId, linearVelocity );
b3Vec3 gotLinear = b3MotorJoint_GetLinearVelocity( jointId );
ENSURE( gotLinear.x == 1.0f && gotLinear.y == 2.0f && gotLinear.z == 3.0f );
b3Vec3 angularVelocity = { 0.1f, 0.2f, 0.3f };
b3MotorJoint_SetAngularVelocity( jointId, angularVelocity );
b3Vec3 gotAngular = b3MotorJoint_GetAngularVelocity( jointId );
ENSURE( gotAngular.x == 0.1f && gotAngular.y == 0.2f && gotAngular.z == 0.3f );
b3MotorJoint_SetMaxVelocityForce( jointId, 500.0f );
ENSURE( b3MotorJoint_GetMaxVelocityForce( jointId ) == 500.0f );
b3MotorJoint_SetMaxVelocityTorque( jointId, 600.0f );
ENSURE( b3MotorJoint_GetMaxVelocityTorque( jointId ) == 600.0f );
b3MotorJoint_SetLinearHertz( jointId, 3.0f );
ENSURE( b3MotorJoint_GetLinearHertz( jointId ) == 3.0f );
b3MotorJoint_SetLinearDampingRatio( jointId, 0.8f );
ENSURE( b3MotorJoint_GetLinearDampingRatio( jointId ) == 0.8f );
b3MotorJoint_SetAngularHertz( jointId, 4.0f );
ENSURE( b3MotorJoint_GetAngularHertz( jointId ) == 4.0f );
b3MotorJoint_SetAngularDampingRatio( jointId, 0.9f );
ENSURE( b3MotorJoint_GetAngularDampingRatio( jointId ) == 0.9f );
b3MotorJoint_SetMaxSpringForce( jointId, 700.0f );
ENSURE( b3MotorJoint_GetMaxSpringForce( jointId ) == 700.0f );
b3MotorJoint_SetMaxSpringTorque( jointId, 800.0f );
ENSURE( b3MotorJoint_GetMaxSpringTorque( jointId ) == 800.0f );
return FinishJoint( jointId, f.worldId );
}
static int TestPrismaticJoint( void )
{
JointFixture f = CreateJointFixture();
b3PrismaticJointDef def = b3DefaultPrismaticJointDef();
SetCommonFrames( &def.base, &f );
b3JointId jointId = b3CreatePrismaticJoint( f.worldId, &def );
if ( ExerciseJointBase( jointId, f.worldId, f.groundId, f.bodyId, b3_prismaticJoint ) != 0 )
{
return 1;
}
b3PrismaticJoint_EnableSpring( jointId, true );
ENSURE( b3PrismaticJoint_IsSpringEnabled( jointId ) == true );
b3PrismaticJoint_SetSpringHertz( jointId, 5.0f );
ENSURE( b3PrismaticJoint_GetSpringHertz( jointId ) == 5.0f );
b3PrismaticJoint_SetSpringDampingRatio( jointId, 0.5f );
ENSURE( b3PrismaticJoint_GetSpringDampingRatio( jointId ) == 0.5f );
b3PrismaticJoint_SetTargetTranslation( jointId, 1.0f );
ENSURE( b3PrismaticJoint_GetTargetTranslation( jointId ) == 1.0f );
b3PrismaticJoint_EnableLimit( jointId, true );
ENSURE( b3PrismaticJoint_IsLimitEnabled( jointId ) == true );
b3PrismaticJoint_SetLimits( jointId, -2.0f, 2.0f );
ENSURE( b3PrismaticJoint_GetLowerLimit( jointId ) == -2.0f );
ENSURE( b3PrismaticJoint_GetUpperLimit( jointId ) == 2.0f );
b3PrismaticJoint_EnableMotor( jointId, true );
ENSURE( b3PrismaticJoint_IsMotorEnabled( jointId ) == true );
b3PrismaticJoint_SetMotorSpeed( jointId, 1.5f );
ENSURE( b3PrismaticJoint_GetMotorSpeed( jointId ) == 1.5f );
b3PrismaticJoint_SetMaxMotorForce( jointId, 30.0f );
ENSURE( b3PrismaticJoint_GetMaxMotorForce( jointId ) == 30.0f );
float motorForce = b3PrismaticJoint_GetMotorForce( jointId );
float translation = b3PrismaticJoint_GetTranslation( jointId );
float speed = b3PrismaticJoint_GetSpeed( jointId );
MAYBE_UNUSED( motorForce );
MAYBE_UNUSED( translation );
MAYBE_UNUSED( speed );
return FinishJoint( jointId, f.worldId );
}
static int TestRevoluteJoint( void )
{
JointFixture f = CreateJointFixture();
b3RevoluteJointDef def = b3DefaultRevoluteJointDef();
SetCommonFrames( &def.base, &f );
b3JointId jointId = b3CreateRevoluteJoint( f.worldId, &def );
if ( ExerciseJointBase( jointId, f.worldId, f.groundId, f.bodyId, b3_revoluteJoint ) != 0 )
{
return 1;
}
b3RevoluteJoint_EnableSpring( jointId, true );
ENSURE( b3RevoluteJoint_IsSpringEnabled( jointId ) == true );
b3RevoluteJoint_SetSpringHertz( jointId, 5.0f );
ENSURE( b3RevoluteJoint_GetSpringHertz( jointId ) == 5.0f );
b3RevoluteJoint_SetSpringDampingRatio( jointId, 0.5f );
ENSURE( b3RevoluteJoint_GetSpringDampingRatio( jointId ) == 0.5f );
b3RevoluteJoint_SetTargetAngle( jointId, 0.5f );
ENSURE( b3RevoluteJoint_GetTargetAngle( jointId ) == 0.5f );
float angle = b3RevoluteJoint_GetAngle( jointId );
MAYBE_UNUSED( angle );
b3RevoluteJoint_EnableLimit( jointId, true );
ENSURE( b3RevoluteJoint_IsLimitEnabled( jointId ) == true );
b3RevoluteJoint_SetLimits( jointId, -1.0f, 1.0f );
ENSURE( b3RevoluteJoint_GetLowerLimit( jointId ) == -1.0f );
ENSURE( b3RevoluteJoint_GetUpperLimit( jointId ) == 1.0f );
b3RevoluteJoint_EnableMotor( jointId, true );
ENSURE( b3RevoluteJoint_IsMotorEnabled( jointId ) == true );
b3RevoluteJoint_SetMotorSpeed( jointId, 2.0f );
ENSURE( b3RevoluteJoint_GetMotorSpeed( jointId ) == 2.0f );
b3RevoluteJoint_SetMaxMotorTorque( jointId, 40.0f );
ENSURE( b3RevoluteJoint_GetMaxMotorTorque( jointId ) == 40.0f );
float motorTorque = b3RevoluteJoint_GetMotorTorque( jointId );
MAYBE_UNUSED( motorTorque );
return FinishJoint( jointId, f.worldId );
}
static int TestSphericalJoint( void )
{
JointFixture f = CreateJointFixture();
b3SphericalJointDef def = b3DefaultSphericalJointDef();
SetCommonFrames( &def.base, &f );
b3JointId jointId = b3CreateSphericalJoint( f.worldId, &def );
if ( ExerciseJointBase( jointId, f.worldId, f.groundId, f.bodyId, b3_sphericalJoint ) != 0 )
{
return 1;
}
b3SphericalJoint_EnableConeLimit( jointId, true );
ENSURE( b3SphericalJoint_IsConeLimitEnabled( jointId ) == true );
b3SphericalJoint_SetConeLimit( jointId, 0.5f );
ENSURE( b3SphericalJoint_GetConeLimit( jointId ) == 0.5f );
float coneAngle = b3SphericalJoint_GetConeAngle( jointId );
MAYBE_UNUSED( coneAngle );
b3SphericalJoint_EnableTwistLimit( jointId, true );
ENSURE( b3SphericalJoint_IsTwistLimitEnabled( jointId ) == true );
b3SphericalJoint_SetTwistLimits( jointId, -0.5f, 0.5f );
ENSURE( b3SphericalJoint_GetLowerTwistLimit( jointId ) == -0.5f );
ENSURE( b3SphericalJoint_GetUpperTwistLimit( jointId ) == 0.5f );
float twistAngle = b3SphericalJoint_GetTwistAngle( jointId );
MAYBE_UNUSED( twistAngle );
b3SphericalJoint_EnableSpring( jointId, true );
ENSURE( b3SphericalJoint_IsSpringEnabled( jointId ) == true );
b3SphericalJoint_SetSpringHertz( jointId, 5.0f );
ENSURE( b3SphericalJoint_GetSpringHertz( jointId ) == 5.0f );
b3SphericalJoint_SetSpringDampingRatio( jointId, 0.5f );
ENSURE( b3SphericalJoint_GetSpringDampingRatio( jointId ) == 0.5f );
// 90 degrees about z, a unit quaternion that round-trips through storage
b3Quat targetRotation = { { 0.0f, 0.0f, 0.7071068f }, 0.7071068f };
b3SphericalJoint_SetTargetRotation( jointId, targetRotation );
b3Quat gotRotation = b3SphericalJoint_GetTargetRotation( jointId );
ENSURE_SMALL( gotRotation.v.x - targetRotation.v.x, 1.0e-5f );
ENSURE_SMALL( gotRotation.v.y - targetRotation.v.y, 1.0e-5f );
ENSURE_SMALL( gotRotation.v.z - targetRotation.v.z, 1.0e-5f );
ENSURE_SMALL( gotRotation.s - targetRotation.s, 1.0e-5f );
b3SphericalJoint_EnableMotor( jointId, true );
ENSURE( b3SphericalJoint_IsMotorEnabled( jointId ) == true );
b3Vec3 motorVelocity = { 0.1f, 0.2f, 0.3f };
b3SphericalJoint_SetMotorVelocity( jointId, motorVelocity );
b3Vec3 gotMotorVelocity = b3SphericalJoint_GetMotorVelocity( jointId );
ENSURE( gotMotorVelocity.x == 0.1f && gotMotorVelocity.y == 0.2f && gotMotorVelocity.z == 0.3f );
b3SphericalJoint_SetMaxMotorTorque( jointId, 50.0f );
ENSURE( b3SphericalJoint_GetMaxMotorTorque( jointId ) == 50.0f );
b3Vec3 motorTorque = b3SphericalJoint_GetMotorTorque( jointId );
MAYBE_UNUSED( motorTorque );
return FinishJoint( jointId, f.worldId );
}
static int TestWeldJoint( void )
{
JointFixture f = CreateJointFixture();
b3WeldJointDef def = b3DefaultWeldJointDef();
SetCommonFrames( &def.base, &f );
b3JointId jointId = b3CreateWeldJoint( f.worldId, &def );
if ( ExerciseJointBase( jointId, f.worldId, f.groundId, f.bodyId, b3_weldJoint ) != 0 )
{
return 1;
}
b3WeldJoint_SetLinearHertz( jointId, 3.0f );
ENSURE( b3WeldJoint_GetLinearHertz( jointId ) == 3.0f );
b3WeldJoint_SetLinearDampingRatio( jointId, 0.5f );
ENSURE( b3WeldJoint_GetLinearDampingRatio( jointId ) == 0.5f );
b3WeldJoint_SetAngularHertz( jointId, 4.0f );
ENSURE( b3WeldJoint_GetAngularHertz( jointId ) == 4.0f );
b3WeldJoint_SetAngularDampingRatio( jointId, 0.7f );
ENSURE( b3WeldJoint_GetAngularDampingRatio( jointId ) == 0.7f );
return FinishJoint( jointId, f.worldId );
}
static int TestWheelJoint( void )
{
JointFixture f = CreateJointFixture();
b3WheelJointDef def = b3DefaultWheelJointDef();
SetCommonFrames( &def.base, &f );
b3JointId jointId = b3CreateWheelJoint( f.worldId, &def );
if ( ExerciseJointBase( jointId, f.worldId, f.groundId, f.bodyId, b3_wheelJoint ) != 0 )
{
return 1;
}
b3WheelJoint_EnableSuspension( jointId, true );
ENSURE( b3WheelJoint_IsSuspensionEnabled( jointId ) == true );
b3WheelJoint_SetSuspensionHertz( jointId, 5.0f );
ENSURE( b3WheelJoint_GetSuspensionHertz( jointId ) == 5.0f );
b3WheelJoint_SetSuspensionDampingRatio( jointId, 0.5f );
ENSURE( b3WheelJoint_GetSuspensionDampingRatio( jointId ) == 0.5f );
b3WheelJoint_EnableSuspensionLimit( jointId, true );
ENSURE( b3WheelJoint_IsSuspensionLimitEnabled( jointId ) == true );
b3WheelJoint_SetSuspensionLimits( jointId, -1.0f, 1.0f );
ENSURE( b3WheelJoint_GetLowerSuspensionLimit( jointId ) == -1.0f );
ENSURE( b3WheelJoint_GetUpperSuspensionLimit( jointId ) == 1.0f );
b3WheelJoint_EnableSpinMotor( jointId, true );
ENSURE( b3WheelJoint_IsSpinMotorEnabled( jointId ) == true );
b3WheelJoint_SetSpinMotorSpeed( jointId, 6.0f );
ENSURE( b3WheelJoint_GetSpinMotorSpeed( jointId ) == 6.0f );
b3WheelJoint_SetMaxSpinTorque( jointId, 35.0f );
ENSURE( b3WheelJoint_GetMaxSpinTorque( jointId ) == 35.0f );
float spinSpeed = b3WheelJoint_GetSpinSpeed( jointId );
float spinTorque = b3WheelJoint_GetSpinTorque( jointId );
MAYBE_UNUSED( spinSpeed );
MAYBE_UNUSED( spinTorque );
b3WheelJoint_EnableSteering( jointId, true );
ENSURE( b3WheelJoint_IsSteeringEnabled( jointId ) == true );
b3WheelJoint_SetSteeringHertz( jointId, 7.0f );
ENSURE( b3WheelJoint_GetSteeringHertz( jointId ) == 7.0f );
b3WheelJoint_SetSteeringDampingRatio( jointId, 0.8f );
ENSURE( b3WheelJoint_GetSteeringDampingRatio( jointId ) == 0.8f );
b3WheelJoint_SetMaxSteeringTorque( jointId, 45.0f );
ENSURE( b3WheelJoint_GetMaxSteeringTorque( jointId ) == 45.0f );
b3WheelJoint_EnableSteeringLimit( jointId, true );
ENSURE( b3WheelJoint_IsSteeringLimitEnabled( jointId ) == true );
b3WheelJoint_SetSteeringLimits( jointId, -0.6f, 0.6f );
ENSURE( b3WheelJoint_GetLowerSteeringLimit( jointId ) == -0.6f );
ENSURE( b3WheelJoint_GetUpperSteeringLimit( jointId ) == 0.6f );
b3WheelJoint_SetTargetSteeringAngle( jointId, 0.25f );
ENSURE( b3WheelJoint_GetTargetSteeringAngle( jointId ) == 0.25f );
float steeringAngle = b3WheelJoint_GetSteeringAngle( jointId );
float steeringTorque = b3WheelJoint_GetSteeringTorque( jointId );
MAYBE_UNUSED( steeringAngle );
MAYBE_UNUSED( steeringTorque );
return FinishJoint( jointId, f.worldId );
}
int JointTest( void )
{
RUN_SUBTEST( TestParallelJoint );
RUN_SUBTEST( TestDistanceJoint );
RUN_SUBTEST( TestFilterJoint );
RUN_SUBTEST( TestMotorJoint );
RUN_SUBTEST( TestPrismaticJoint );
RUN_SUBTEST( TestRevoluteJoint );
RUN_SUBTEST( TestSphericalJoint );
RUN_SUBTEST( TestWeldJoint );
RUN_SUBTEST( TestWheelJoint );
return 0;
}

View file

@ -1020,13 +1020,6 @@ static int EmptyWorldRoundTrip( void )
// Exercise every recorded op in a single session, then validate replay at two worker
// counts, round-trip through a file, and drive the incremental player. Mirrors the
// comprehensive RecordingTest in Box2D's test suite (box2d/test/test_recording.c).
static int RecTestAssertDbg( const char* cond, const char* file, int line )
{
fprintf( stderr, "BOX3D ASSERTION: %s, %s:%d\n", cond, file, line );
fflush( stderr );
return 1;
}
static int AllOps( void )
{
b3Recording* rec = b3CreateRecording( 0 );
@ -1049,7 +1042,7 @@ static int AllOps( void )
b3ShapeId groundShapeId = b3CreateHullShape( groundId, &groundShapeDef, &groundBox.base );
ENSURE( b3Shape_IsValid( groundShapeId ) );
// Dynamic body with a sphere shape. The name is intentionally longer than B3_NAME_LENGTH so
// Dynamic body with a sphere shape. The name is intentionally longer than B3_BODY_NAME_LENGTH so
// replay exercises the over-length name path in the body def reader.
b3BodyDef bodyDef = b3DefaultBodyDef();
bodyDef.type = b3_dynamicBody;