Move set is now a bitset to support large worlds (#5)
Added supporting benchmark
This commit is contained in:
parent
9b4aa025ef
commit
aedb0e34aa
8 changed files with 187 additions and 37 deletions
|
|
@ -19,7 +19,9 @@ void b3CreateBroadPhase( b3BroadPhase* bp, const b3Capacity* capacity )
|
|||
{
|
||||
_Static_assert( b3_bodyTypeCount == 3, "must be three body types" );
|
||||
|
||||
bp->moveSet = b3CreateSet( 2 * capacity->dynamicShapeCount );
|
||||
bp->movedProxies[b3_staticBody] = b3CreateBitSet( b3MaxInt( 16, capacity->staticShapeCount ) );
|
||||
bp->movedProxies[b3_kinematicBody] = b3CreateBitSet( 16 );
|
||||
bp->movedProxies[b3_dynamicBody] = b3CreateBitSet( b3MaxInt( 16, capacity->dynamicShapeCount ) );
|
||||
b3Array_Reserve( bp->moveArray, capacity->dynamicShapeCount );
|
||||
bp->moveResults = NULL;
|
||||
bp->movePairs = NULL;
|
||||
|
|
@ -44,7 +46,10 @@ void b3DestroyBroadPhase( b3BroadPhase* bp )
|
|||
b3DynamicTree_Destroy( bp->trees + i );
|
||||
}
|
||||
|
||||
b3DestroySet( &bp->moveSet );
|
||||
for ( int i = 0; i < b3_bodyTypeCount; ++i )
|
||||
{
|
||||
b3DestroyBitSet( &bp->movedProxies[i] );
|
||||
}
|
||||
b3Array_Destroy( bp->moveArray );
|
||||
b3DestroySet( &bp->pairSet );
|
||||
|
||||
|
|
@ -55,10 +60,14 @@ void b3DestroyBroadPhase( b3BroadPhase* bp )
|
|||
|
||||
static void b3UnBufferMove( b3BroadPhase* bp, int proxyKey )
|
||||
{
|
||||
bool found = b3RemoveKey( &bp->moveSet, proxyKey + 1 );
|
||||
b3BodyType proxyType = B3_PROXY_TYPE( proxyKey );
|
||||
int proxyId = B3_PROXY_ID( proxyKey );
|
||||
b3BitSet* set = &bp->movedProxies[proxyType];
|
||||
|
||||
if ( found )
|
||||
if ( b3GetBit( set, proxyId ) )
|
||||
{
|
||||
b3ClearBit( set, proxyId );
|
||||
|
||||
// Purge from move buffer. Linear search.
|
||||
// todo if I can iterate the move set then I don't need the moveArray
|
||||
int count = bp->moveArray.count;
|
||||
|
|
@ -88,7 +97,6 @@ int b3BroadPhase_CreateProxy( b3BroadPhase* bp, b3BodyType proxyType, b3AABB aab
|
|||
|
||||
void b3BroadPhase_DestroyProxy( b3BroadPhase* bp, int proxyKey )
|
||||
{
|
||||
B3_ASSERT( bp->moveArray.count == (int)bp->moveSet.count );
|
||||
b3UnBufferMove( bp, proxyKey );
|
||||
|
||||
b3BodyType proxyType = B3_PROXY_TYPE( proxyKey );
|
||||
|
|
@ -203,22 +211,16 @@ static bool b3PairQueryCallback( int proxyId, uint64_t userData, void* context )
|
|||
|
||||
// De-duplication
|
||||
// It is important to prevent duplicate contacts from being created. Ideally I can prevent duplicates
|
||||
// early and in the worker. Most of the time the moveSet contains dynamic and kinematic proxies, but
|
||||
// sometimes it has static proxies.
|
||||
|
||||
// I had an optimization here to skip checking the move set if this is a query into
|
||||
// the static tree. The assumption is that the static proxies are never in the move set
|
||||
// so there is no risk of duplication. However, this is not true with
|
||||
// b3ShapeDef::invokeContactCreation or when a static shape is modified.
|
||||
// There can easily be scenarios where the static proxy is in the moveSet but the dynamic proxy is not.
|
||||
// I could have some flag to indicate that there are any static bodies in the moveSet.
|
||||
// early and in the worker. Most of the time the movedProxies bit sets contain dynamic and kinematic
|
||||
// proxies, but sometimes static proxies are in there too (b3ShapeDef::invokeContactCreation or a
|
||||
// modified static shape), so we always have to check.
|
||||
|
||||
// Is this proxy also moving?
|
||||
if ( queryProxyType == b3_dynamicBody )
|
||||
{
|
||||
if ( treeType == b3_dynamicBody && proxyKey < queryProxyKey )
|
||||
{
|
||||
bool moved = b3ContainsKey( &broadPhase->moveSet, proxyKey + 1 );
|
||||
bool moved = b3GetBit( &broadPhase->movedProxies[treeType], proxyId );
|
||||
if ( moved )
|
||||
{
|
||||
// Both proxies are moving. Avoid duplicate pairs.
|
||||
|
|
@ -229,7 +231,7 @@ static bool b3PairQueryCallback( int proxyId, uint64_t userData, void* context )
|
|||
else
|
||||
{
|
||||
B3_ASSERT( treeType == b3_dynamicBody );
|
||||
bool moved = b3ContainsKey( &broadPhase->moveSet, proxyKey + 1 );
|
||||
bool moved = b3GetBit( &broadPhase->movedProxies[treeType], proxyId );
|
||||
if ( moved )
|
||||
{
|
||||
// Both proxies are moving. Avoid duplicate pairs.
|
||||
|
|
@ -340,12 +342,6 @@ static void b3FindPairsTask( int startIndex, int endIndex, int workerIndex, void
|
|||
queryContext.moveResult->pairList = NULL;
|
||||
|
||||
int proxyKey = bp->moveArray.data[i];
|
||||
if ( proxyKey == B3_NULL_INDEX )
|
||||
{
|
||||
// proxy was destroyed after it moved
|
||||
continue;
|
||||
}
|
||||
|
||||
b3BodyType proxyType = B3_PROXY_TYPE( proxyKey );
|
||||
|
||||
int proxyId = B3_PROXY_ID( proxyKey );
|
||||
|
|
@ -403,7 +399,6 @@ void b3UpdateBroadPhasePairs( b3World* world )
|
|||
b3BroadPhase* bp = &world->broadPhase;
|
||||
|
||||
int moveCount = bp->moveArray.count;
|
||||
B3_ASSERT( moveCount == (int)bp->moveSet.count );
|
||||
|
||||
if ( moveCount == 0 )
|
||||
{
|
||||
|
|
@ -476,9 +471,14 @@ void b3UpdateBroadPhasePairs( b3World* world )
|
|||
}
|
||||
}
|
||||
|
||||
// Reset move buffer
|
||||
// Reset move buffer: clear only the bits that were set this step.
|
||||
// Invariant: bit set in movedProxies[type] iff proxyKey is present in moveArray.
|
||||
for ( int i = 0; i < bp->moveArray.count; ++i )
|
||||
{
|
||||
int proxyKey = bp->moveArray.data[i];
|
||||
b3ClearBit( &bp->movedProxies[B3_PROXY_TYPE( proxyKey )], B3_PROXY_ID( proxyKey ) );
|
||||
}
|
||||
b3Array_Clear( bp->moveArray );
|
||||
b3ClearSet( &bp->moveSet );
|
||||
|
||||
b3StackFree( alloc, bp->movePairs );
|
||||
bp->movePairs = NULL;
|
||||
|
|
|
|||
|
|
@ -3,6 +3,7 @@
|
|||
|
||||
#pragma once
|
||||
|
||||
#include "bitset.h"
|
||||
#include "container.h"
|
||||
#include "table.h"
|
||||
|
||||
|
|
@ -27,12 +28,9 @@ typedef struct b3BroadPhase
|
|||
{
|
||||
b3DynamicTree trees[b3_bodyTypeCount];
|
||||
|
||||
// The move set and array are used to track shapes that have moved significantly
|
||||
// and need a pair query for new contacts. The array has a deterministic order.
|
||||
// todo perhaps just a move set?
|
||||
// todo implement a 32bit hash set for faster lookup
|
||||
// todo moveSet can grow quite large on the first time step and remain large
|
||||
b3HashSet moveSet;
|
||||
// Per body-type bit sets indexed by proxyId, marking proxies moved this step.
|
||||
// Paired with moveArray which preserves deterministic insertion order for pair queries.
|
||||
b3BitSet movedProxies[b3_bodyTypeCount];
|
||||
b3ArrayC( int ) moveArray;
|
||||
|
||||
// These are the results from the pair query and are used to create new contacts
|
||||
|
|
@ -70,10 +68,12 @@ void b3ValidateNoEnlarged( const b3BroadPhase* bp );
|
|||
// Warning: this must be called in deterministic order
|
||||
static inline void b3BufferMove( b3BroadPhase* bp, int queryProxy )
|
||||
{
|
||||
// Adding 1 because 0 is the sentinel
|
||||
bool alreadyAdded = b3AddKey( &bp->moveSet, queryProxy + 1 );
|
||||
if ( alreadyAdded == false )
|
||||
b3BodyType proxyType = B3_PROXY_TYPE( queryProxy );
|
||||
int proxyId = B3_PROXY_ID( queryProxy );
|
||||
b3BitSet* set = &bp->movedProxies[proxyType];
|
||||
if ( b3GetBit( set, proxyId ) == false )
|
||||
{
|
||||
b3SetBitGrow( set, proxyId );
|
||||
b3Array_Push( bp->moveArray, queryProxy );
|
||||
}
|
||||
}
|
||||
|
|
|
|||
|
|
@ -2115,8 +2115,12 @@ void b3World_DumpMemoryStats( b3WorldId worldId )
|
|||
fprintf( file, "static tree: %d\n", b3DynamicTree_GetByteCount( world->broadPhase.trees + b3_staticBody ) );
|
||||
fprintf( file, "kinematic tree: %d\n", b3DynamicTree_GetByteCount( world->broadPhase.trees + b3_kinematicBody ) );
|
||||
fprintf( file, "dynamic tree: %d\n", b3DynamicTree_GetByteCount( world->broadPhase.trees + b3_dynamicBody ) );
|
||||
b3HashSet* moveSet = &world->broadPhase.moveSet;
|
||||
fprintf( file, "moveSet: %d (%d, %d)\n", b3GetHashSetBytes( moveSet ), moveSet->count, moveSet->capacity );
|
||||
int movedBytes = 0;
|
||||
for ( int i = 0; i < b3_bodyTypeCount; ++i )
|
||||
{
|
||||
movedBytes += b3GetBitSetBytes( &world->broadPhase.movedProxies[i] );
|
||||
}
|
||||
fprintf( file, "movedProxies: %d\n", movedBytes );
|
||||
fprintf( file, "moveArray: %d\n", b3Array_ByteCount( world->broadPhase.moveArray ) );
|
||||
b3HashSet* pairSet = &world->broadPhase.pairSet;
|
||||
fprintf( file, "pairSet: %d (%d, %d)\n", b3GetHashSetBytes( pairSet ), pairSet->count, pairSet->capacity );
|
||||
|
|
|
|||
|
|
@ -2181,7 +2181,7 @@ void b3Solve( b3World* world, b3StepContext* stepContext )
|
|||
B3_ASSERT( B3_PROXY_TYPE( proxyKey ) == b3_dynamicBody );
|
||||
|
||||
// all fast bullet shapes should already be in the move buffer
|
||||
B3_ASSERT( b3ContainsKey( &broadPhase->moveSet, proxyKey + 1 ) );
|
||||
B3_ASSERT( b3GetBit( &broadPhase->movedProxies[b3_dynamicBody], proxyId ) );
|
||||
|
||||
b3DynamicTree_EnlargeProxy( dynamicTree, proxyId, shape->fatAABB );
|
||||
|
||||
|
|
|
|||
Loading…
Reference in a new issue