more work towards hybrid of GPU grid and sap broadphase, separating small, large (moving) and static objects

re-enable 'useNewBatchingKernel', it is slower but more robust
This commit is contained in:
erwincoumans
2013-11-11 02:19:04 -08:00
parent d13de109a5
commit ef6be5370d
5 changed files with 244 additions and 103 deletions

View File

@@ -45,11 +45,11 @@ void GpuConvexScene::setupScene(const ConstructionInfo& ci)
m_data->m_rigidBodyPipeline->writeAllInstancesToGpu(); m_data->m_rigidBodyPipeline->writeAllInstancesToGpu();
float camPos[4]={ci.arraySizeX,ci.arraySizeY/2,ci.arraySizeZ,0}; float camPos[4]={0,0,0,0};//ci.arraySizeX,ci.arraySizeY/2,ci.arraySizeZ,0};
//float camPos[4]={1,12.5,1.5,0}; //float camPos[4]={1,12.5,1.5,0};
m_instancingRenderer->setCameraTargetPosition(camPos); m_instancingRenderer->setCameraTargetPosition(camPos);
m_instancingRenderer->setCameraDistance(114); m_instancingRenderer->setCameraDistance(150);
//m_instancingRenderer->setCameraYaw(85); //m_instancingRenderer->setCameraYaw(85);
m_instancingRenderer->setCameraYaw(30); m_instancingRenderer->setCameraYaw(30);
m_instancingRenderer->setCameraPitch(225); m_instancingRenderer->setCameraPitch(225);
@@ -158,7 +158,7 @@ int GpuConvexScene::createDynamicsObjects2(const ConstructionInfo& ci, const flo
//mass=0.f; //mass=0.f;
} }
b3Vector3 position = b3MakeVector3(((j+1)&1)+i*2.2,1+j*2.,((j+1)&1)+k*2.2); b3Vector3 position = b3MakeVector3(((j+1)&1)+i*2.2,1+j*2.,((j+1)&1)+k*2.2);
//b3Vector3 position(i*2.2,10+j*1.9,k*2.2); //b3Vector3 position = b3MakeVector3(i*2,1+j*2,k*2);
//b3Vector3 position=b3MakeVector3(1,0.9,1); //b3Vector3 position=b3MakeVector3(1,0.9,1);
b3Quaternion orn(0,0,0,1); b3Quaternion orn(0,0,0,1);

View File

@@ -2,7 +2,7 @@
#include "b3GpuGridBroadphase.h" #include "b3GpuGridBroadphase.h"
#include "Bullet3Geometry/b3AabbUtil.h" #include "Bullet3Geometry/b3AabbUtil.h"
#include "kernels/gridBroadphaseKernels.h" #include "kernels/gridBroadphaseKernels.h"
#include "kernels/sapKernels.h"
//#include "kernels/gridBroadphase.cl" //#include "kernels/gridBroadphase.cl"
@@ -11,29 +11,32 @@
#define B3_BROADPHASE_SAP_PATH "src/Bullet3OpenCL/BroadphaseCollision/kernels/sap.cl"
#define B3_GRID_BROADPHASE_PATH "src/Bullet3OpenCL/BroadphaseCollision/kernels/gridBroadphase.cl" #define B3_GRID_BROADPHASE_PATH "src/Bullet3OpenCL/BroadphaseCollision/kernels/gridBroadphase.cl"
cl_kernel kCalcHashAABB; cl_kernel kCalcHashAABB;
cl_kernel kClearCellStart; cl_kernel kClearCellStart;
cl_kernel kFindCellStart; cl_kernel kFindCellStart;
cl_kernel kFindOverlappingPairs; cl_kernel kFindOverlappingPairs;
cl_kernel m_copyAabbsKernel;
cl_kernel m_sap2Kernel;
cl_kernel kFindPairsLarge; cl_kernel kFindPairsLarge;
cl_kernel kComputePairCacheChanges; cl_kernel kComputePairCacheChanges;
cl_kernel kSqueezeOverlappingPairBuff; cl_kernel kSqueezeOverlappingPairBuff;
int maxPairsPerBody = 32; int maxPairsPerBody = 64;
int maxBodiesPerCell = 1024;//?? int maxBodiesPerCell = 256;//??
b3GpuGridBroadphase::b3GpuGridBroadphase(cl_context ctx,cl_device_id device, cl_command_queue q ) b3GpuGridBroadphase::b3GpuGridBroadphase(cl_context ctx,cl_device_id device, cl_command_queue q )
:m_context(ctx), :m_context(ctx),
m_device(device), m_device(device),
m_queue(q), m_queue(q),
m_allAabbsGPU(ctx,q), m_allAabbsGPU1(ctx,q),
m_largeAabbsGPU(ctx,q),
m_smallAabbsGPU(ctx,q),
m_gpuPairs(ctx,q), m_gpuPairs(ctx,q),
m_hashGpu(ctx,q), m_hashGpu(ctx,q),
m_paramsGPU(ctx,q), m_paramsGPU(ctx,q),
m_cellStartGpu(ctx,q) m_cellStartGpu(ctx,q)
@@ -55,6 +58,18 @@ m_cellStartGpu(ctx,q)
m_paramsGPU.push_back(m_paramsCPU); m_paramsGPU.push_back(m_paramsCPU);
cl_int errNum=0; cl_int errNum=0;
{
const char* sapSrc = sapCL;
cl_program sapProg = b3OpenCLUtils::compileCLProgramFromString(m_context,m_device,sapSrc,&errNum,"",B3_BROADPHASE_SAP_PATH);
b3Assert(errNum==CL_SUCCESS);
m_copyAabbsKernel= b3OpenCLUtils::compileCLKernelFromString(m_context, m_device,sapSrc, "copyAabbsKernel",&errNum,sapProg );
m_sap2Kernel = b3OpenCLUtils::compileCLKernelFromString(m_context, m_device,sapSrc, "computePairsKernelTwoArrays",&errNum,sapProg );
b3Assert(errNum==CL_SUCCESS);
}
{
cl_program gridProg = b3OpenCLUtils::compileCLProgramFromString(m_context,m_device,0,&errNum,"",B3_GRID_BROADPHASE_PATH,true); cl_program gridProg = b3OpenCLUtils::compileCLProgramFromString(m_context,m_device,0,&errNum,"",B3_GRID_BROADPHASE_PATH,true);
b3Assert(errNum==CL_SUCCESS); b3Assert(errNum==CL_SUCCESS);
@@ -79,6 +94,7 @@ m_cellStartGpu(ctx,q)
kSqueezeOverlappingPairBuff = b3OpenCLUtils::compileCLKernelFromString(m_context, m_device,gridBroadphaseCL, "kSqueezeOverlappingPairBuff",&errNum,gridProg); kSqueezeOverlappingPairBuff = b3OpenCLUtils::compileCLKernelFromString(m_context, m_device,gridBroadphaseCL, "kSqueezeOverlappingPairBuff",&errNum,gridProg);
b3Assert(errNum==CL_SUCCESS); b3Assert(errNum==CL_SUCCESS);
}
m_sorter = new b3RadixSort32CL(m_context,m_device,m_queue); m_sorter = new b3RadixSort32CL(m_context,m_device,m_queue);
@@ -89,7 +105,8 @@ b3GpuGridBroadphase::~b3GpuGridBroadphase()
clReleaseKernel( kClearCellStart); clReleaseKernel( kClearCellStart);
clReleaseKernel( kFindCellStart); clReleaseKernel( kFindCellStart);
clReleaseKernel( kFindOverlappingPairs); clReleaseKernel( kFindOverlappingPairs);
clReleaseKernel( m_sap2Kernel);
clReleaseKernel( m_copyAabbsKernel);
clReleaseKernel( kFindPairsLarge); clReleaseKernel( kFindPairsLarge);
clReleaseKernel( kComputePairCacheChanges); clReleaseKernel( kComputePairCacheChanges);
clReleaseKernel( kSqueezeOverlappingPairBuff); clReleaseKernel( kSqueezeOverlappingPairBuff);
@@ -105,20 +122,28 @@ void b3GpuGridBroadphase::createProxy(const b3Vector3& aabbMin, const b3Vector3
aabb.m_maxVec = aabbMax; aabb.m_maxVec = aabbMax;
aabb.m_minIndices[3] = userPtr; aabb.m_minIndices[3] = userPtr;
aabb.m_signedMaxIndices[3] = userPtr; aabb.m_signedMaxIndices[3] = userPtr;
m_allAabbsCPU.push_back(aabb); m_allAabbsCPU1.push_back(aabb);
m_smallAabbsCPU.push_back(aabb);
} }
void b3GpuGridBroadphase::createLargeProxy(const b3Vector3& aabbMin, const b3Vector3& aabbMax, int userPtr ,short int collisionFilterGroup,short int collisionFilterMask) void b3GpuGridBroadphase::createLargeProxy(const b3Vector3& aabbMin, const b3Vector3& aabbMax, int userPtr ,short int collisionFilterGroup,short int collisionFilterMask)
{ {
createProxy(aabbMin,aabbMax,userPtr,collisionFilterGroup,collisionFilterMask); b3SapAabb aabb;
aabb.m_minVec = aabbMin;
aabb.m_maxVec = aabbMax;
aabb.m_minIndices[3] = userPtr;
aabb.m_signedMaxIndices[3] = userPtr;
m_allAabbsCPU1.push_back(aabb);
m_largeAabbsCPU.push_back(aabb);
} }
void b3GpuGridBroadphase::calculateOverlappingPairs(int maxPairs) void b3GpuGridBroadphase::calculateOverlappingPairs(int maxPairs)
{ {
B3_PROFILE("b3GpuGridBroadphase::calculateOverlappingPairs"); B3_PROFILE("b3GpuGridBroadphase::calculateOverlappingPairs");
/*
calculateOverlappingPairsHost(maxPairs);
if (0)
{ {
calculateOverlappingPairsHost(maxPairs);
b3AlignedObjectArray<b3Int4> cpuPairs; b3AlignedObjectArray<b3Int4> cpuPairs;
m_gpuPairs.copyToHost(cpuPairs); m_gpuPairs.copyToHost(cpuPairs);
@@ -128,19 +153,98 @@ void b3GpuGridBroadphase::calculateOverlappingPairs(int maxPairs)
printf("host pair %d = %d,%d\n",i,cpuPairs[i].x,cpuPairs[i].y); printf("host pair %d = %d,%d\n",i,cpuPairs[i].x,cpuPairs[i].y);
} }
} }
*/
//return; //sync small AABBs
int numAabbs = m_allAabbsGPU.size();
if (numAabbs)
{ {
m_hashGpu.resize(numAabbs); int numSmallAabbs = m_smallAabbsGPU.size();
if (numSmallAabbs)
{ {
B3_PROFILE("copyAabbsKernelSmall");
b3BufferInfoCL bInfo[] = {
b3BufferInfoCL( m_allAabbsGPU1.getBufferCL(), true ),
b3BufferInfoCL( m_smallAabbsGPU.getBufferCL()),
};
b3LauncherCL launcher(m_queue, m_copyAabbsKernel );
launcher.setBuffers( bInfo, sizeof(bInfo)/sizeof(b3BufferInfoCL) );
launcher.setConst( numSmallAabbs );
int num = numSmallAabbs;
launcher.launch1D( num);
}
}
//sync large AABBs
{
int numLargeAabbs = m_largeAabbsGPU.size();
if (numLargeAabbs)
{
B3_PROFILE("copyAabbsKernelLarge");
b3BufferInfoCL bInfo[] = {
b3BufferInfoCL( m_allAabbsGPU1.getBufferCL(), true ),
b3BufferInfoCL( m_largeAabbsGPU.getBufferCL()),
};
b3LauncherCL launcher(m_queue, m_copyAabbsKernel );
launcher.setBuffers( bInfo, sizeof(bInfo)/sizeof(b3BufferInfoCL) );
launcher.setConst( numLargeAabbs );
int num = numLargeAabbs;
launcher.launch1D( num);
clFinish(m_queue);
}
}
int numSmallAabbs = m_smallAabbsGPU.size();
b3OpenCLArray<int> pairCount(m_context,m_queue);
pairCount.push_back(0);
m_gpuPairs.resize(numSmallAabbs*maxPairsPerBody);
{
int numLargeAabbs = m_largeAabbsGPU.size();
if (numLargeAabbs && numSmallAabbs)
{
B3_PROFILE("sap2Kernel");
b3BufferInfoCL bInfo[] = { b3BufferInfoCL( m_largeAabbsGPU.getBufferCL() ),
b3BufferInfoCL( m_smallAabbsGPU.getBufferCL() ),
b3BufferInfoCL( m_gpuPairs.getBufferCL() ),
b3BufferInfoCL(pairCount.getBufferCL())};
b3LauncherCL launcher(m_queue, m_sap2Kernel);
launcher.setBuffers( bInfo, sizeof(bInfo)/sizeof(b3BufferInfoCL) );
launcher.setConst( numLargeAabbs );
launcher.setConst( numSmallAabbs);
launcher.setConst( 0 );//axis is not used
launcher.setConst( maxPairs );
//@todo: use actual maximum work item sizes of the device instead of hardcoded values
launcher.launch2D( numLargeAabbs, numSmallAabbs,4,64);
int numPairs = pairCount.at(0);
if (numPairs >maxPairs)
{
b3Error("Error running out of pairs: numPairs = %d, maxPairs = %d.\n", numPairs, maxPairs);
numPairs =maxPairs;
}
}
}
if (numSmallAabbs)
{
B3_PROFILE("gridKernel");
m_hashGpu.resize(numSmallAabbs);
{
B3_PROFILE("kCalcHashAABB");
b3LauncherCL launch(m_queue,kCalcHashAABB); b3LauncherCL launch(m_queue,kCalcHashAABB);
launch.setConst(numAabbs); launch.setConst(numSmallAabbs);
launch.setBuffer(m_allAabbsGPU.getBufferCL()); launch.setBuffer(m_smallAabbsGPU.getBufferCL());
launch.setBuffer(m_hashGpu.getBufferCL()); launch.setBuffer(m_hashGpu.getBufferCL());
launch.setBuffer(this->m_paramsGPU.getBufferCL()); launch.setBuffer(this->m_paramsGPU.getBufferCL());
launch.launch1D(numAabbs); launch.launch1D(numSmallAabbs);
} }
m_sorter->execute(m_hashGpu); m_sorter->execute(m_hashGpu);
@@ -151,6 +255,7 @@ void b3GpuGridBroadphase::calculateOverlappingPairs(int maxPairs)
{ {
B3_PROFILE("kClearCellStart");
b3LauncherCL launch(m_queue,kClearCellStart); b3LauncherCL launch(m_queue,kClearCellStart);
launch.setConst(numCells); launch.setConst(numCells);
launch.setBuffer(m_cellStartGpu.getBufferCL()); launch.setBuffer(m_cellStartGpu.getBufferCL());
@@ -162,47 +267,45 @@ void b3GpuGridBroadphase::calculateOverlappingPairs(int maxPairs)
{ {
B3_PROFILE("kFindCellStart");
b3LauncherCL launch(m_queue,kFindCellStart); b3LauncherCL launch(m_queue,kFindCellStart);
launch.setConst(numAabbs); launch.setConst(numSmallAabbs);
launch.setBuffer(m_hashGpu.getBufferCL()); launch.setBuffer(m_hashGpu.getBufferCL());
launch.setBuffer(m_cellStartGpu.getBufferCL()); launch.setBuffer(m_cellStartGpu.getBufferCL());
launch.launch1D(numAabbs); launch.launch1D(numSmallAabbs);
//m_cellStartGpu.copyToHost(cellStartCpu); //m_cellStartGpu.copyToHost(cellStartCpu);
//printf("??\n"); //printf("??\n");
} }
{ {
B3_PROFILE("kFindOverlappingPairs");
b3OpenCLArray<b3Int2> pairsGpu2(m_context,m_queue); b3OpenCLArray<b3Int2> pairsGpu2(m_context,m_queue);
b3OpenCLArray<unsigned int> pairsGpu(m_context,m_queue); b3OpenCLArray<unsigned int> pairsGpu(m_context,m_queue);
b3OpenCLArray<unsigned int> pairStartCurGpu(m_context,m_queue); b3OpenCLArray<unsigned int> pairStartCurGpu(m_context,m_queue);
b3AlignedObjectArray<unsigned int> pairStartCpu; b3AlignedObjectArray<unsigned int> pairStartCpu;
m_gpuPairs.resize(numAabbs*maxPairsPerBody);
pairsGpu2.resize(numAabbs*maxPairsPerBody);
pairsGpu.resize(numAabbs*maxPairsPerBody);
pairStartCurGpu.resize(numAabbs*2+2);
pairStartCpu.resize(numAabbs*2+2); pairsGpu2.resize(numSmallAabbs*maxPairsPerBody);
pairsGpu.resize(numSmallAabbs*maxPairsPerBody);
pairStartCurGpu.resize(numSmallAabbs*2+2);
pairStartCpu.resize(numSmallAabbs*2+2);
pairStartCpu[0] = 0; pairStartCpu[0] = 0;
pairStartCpu[1] = 0; pairStartCpu[1] = 0;
for(int i = 1; i <= numAabbs; i++) for(int i = 1; i <= numSmallAabbs; i++)
{ {
pairStartCpu[i * 2] = pairStartCpu[(i-1) * 2] + maxPairsPerBody; pairStartCpu[i * 2] = pairStartCpu[(i-1) * 2] + maxPairsPerBody;
pairStartCpu[i * 2 + 1] = 0; pairStartCpu[i * 2 + 1] = 0;
} }
pairStartCurGpu.copyFromHost(pairStartCpu); pairStartCurGpu.copyFromHost(pairStartCpu);
b3OpenCLArray<int> pairCount(m_context,m_queue);
pairCount.push_back(0);
b3LauncherCL launch(m_queue,kFindOverlappingPairs); b3LauncherCL launch(m_queue,kFindOverlappingPairs);
launch.setConst(numAabbs); launch.setConst(numSmallAabbs);
launch.setBuffer(m_allAabbsGPU.getBufferCL()); launch.setBuffer(m_smallAabbsGPU.getBufferCL());
launch.setBuffer(m_hashGpu.getBufferCL()); launch.setBuffer(m_hashGpu.getBufferCL());
launch.setBuffer(m_cellStartGpu.getBufferCL()); launch.setBuffer(m_cellStartGpu.getBufferCL());
launch.setBuffer(pairsGpu.getBufferCL()); launch.setBuffer(pairsGpu.getBufferCL());
@@ -212,13 +315,15 @@ void b3GpuGridBroadphase::calculateOverlappingPairs(int maxPairs)
launch.setBuffer(pairCount.getBufferCL()); launch.setBuffer(pairCount.getBufferCL());
launch.setBuffer(m_gpuPairs.getBufferCL()); launch.setBuffer(m_gpuPairs.getBufferCL());
launch.launch1D(numAabbs); launch.launch1D(numSmallAabbs);
int actualCount = pairCount.at(0); int actualCount = pairCount.at(0);
m_gpuPairs.resize(actualCount); m_gpuPairs.resize(actualCount);
/*
if (0)
{
b3AlignedObjectArray<b3Int4> pairsCpu; b3AlignedObjectArray<b3Int4> pairsCpu;
m_gpuPairs.copyToHost(pairsCpu); m_gpuPairs.copyToHost(pairsCpu);
@@ -229,7 +334,8 @@ void b3GpuGridBroadphase::calculateOverlappingPairs(int maxPairs)
} }
printf("?!?\n"); printf("?!?\n");
*/ }
} }
@@ -243,8 +349,9 @@ void b3GpuGridBroadphase::calculateOverlappingPairs(int maxPairs)
} }
void b3GpuGridBroadphase::calculateOverlappingPairsHost(int maxPairs) void b3GpuGridBroadphase::calculateOverlappingPairsHost(int maxPairs)
{ {
#if 0
m_hostPairs.resize(0); m_hostPairs.resize(0);
m_allAabbsGPU1.copyToHost(m_allAabbsCPU1);
for (int i=0;i<m_allAabbsCPU.size();i++) for (int i=0;i<m_allAabbsCPU.size();i++)
{ {
for (int j=i+1;j<m_allAabbsCPU.size();j++) for (int j=i+1;j<m_allAabbsCPU.size();j++)
@@ -272,17 +379,22 @@ void b3GpuGridBroadphase::calculateOverlappingPairsHost(int maxPairs)
m_gpuPairs.copyFromHost(m_hostPairs); m_gpuPairs.copyFromHost(m_hostPairs);
#endif
} }
//call writeAabbsToGpu after done making all changes (createProxy etc) //call writeAabbsToGpu after done making all changes (createProxy etc)
void b3GpuGridBroadphase::writeAabbsToGpu() void b3GpuGridBroadphase::writeAabbsToGpu()
{ {
m_allAabbsGPU.copyFromHost(m_allAabbsCPU); m_allAabbsGPU1.copyFromHost(m_allAabbsCPU1);
m_largeAabbsGPU.copyFromHost(m_largeAabbsCPU);
m_smallAabbsGPU.copyFromHost(m_smallAabbsCPU);
} }
cl_mem b3GpuGridBroadphase::getAabbBufferWS() cl_mem b3GpuGridBroadphase::getAabbBufferWS()
{ {
return this->m_allAabbsGPU.getBufferCL(); return this->m_allAabbsGPU1.getBufferCL();
} }
int b3GpuGridBroadphase::getNumOverlap() int b3GpuGridBroadphase::getNumOverlap()
{ {
@@ -295,10 +407,10 @@ cl_mem b3GpuGridBroadphase::getOverlappingPairBuffer()
b3OpenCLArray<b3SapAabb>& b3GpuGridBroadphase::getAllAabbsGPU() b3OpenCLArray<b3SapAabb>& b3GpuGridBroadphase::getAllAabbsGPU()
{ {
return m_allAabbsGPU; return m_allAabbsGPU1;
} }
b3AlignedObjectArray<b3SapAabb>& b3GpuGridBroadphase::getAllAabbsCPU() b3AlignedObjectArray<b3SapAabb>& b3GpuGridBroadphase::getAllAabbsCPU()
{ {
return m_allAabbsCPU; return m_allAabbsCPU1;
} }

View File

@@ -29,8 +29,13 @@ protected:
cl_device_id m_device; cl_device_id m_device;
cl_command_queue m_queue; cl_command_queue m_queue;
b3OpenCLArray<b3SapAabb> m_allAabbsGPU; b3OpenCLArray<b3SapAabb> m_allAabbsGPU1;
b3AlignedObjectArray<b3SapAabb> m_allAabbsCPU; b3AlignedObjectArray<b3SapAabb> m_allAabbsCPU1;
b3OpenCLArray<b3SapAabb> m_smallAabbsGPU;
b3AlignedObjectArray<b3SapAabb> m_smallAabbsCPU;
b3OpenCLArray<b3SapAabb> m_largeAabbsGPU;
b3AlignedObjectArray<b3SapAabb> m_largeAabbsCPU;
b3AlignedObjectArray<b3Int4> m_hostPairs; b3AlignedObjectArray<b3Int4> m_hostPairs;
b3OpenCLArray<b3Int4> m_gpuPairs; b3OpenCLArray<b3Int4> m_gpuPairs;

View File

@@ -1,6 +1,5 @@
//this file is autogenerated using stringify.bat (premake --stringify) in the build folder of this project //this file is autogenerated using stringify.bat (premake --stringify) in the build folder of this project
static const char* gridBroadphaseCL= \ static const char* gridBroadphaseCL= \
"#pragma OPENCL EXTENSION cl_amd_printf : enable\n"
"int getPosHash(int4 gridPos, __global float4* pParams)\n" "int getPosHash(int4 gridPos, __global float4* pParams)\n"
"{\n" "{\n"
" int4 gridDim = *((__global int4*)(pParams + 1));\n" " int4 gridDim = *((__global int4*)(pParams + 1));\n"
@@ -47,7 +46,6 @@ static const char* gridBroadphaseCL= \
" __global int* pCellStart )\n" " __global int* pCellStart )\n"
"{\n" "{\n"
" int index = get_global_id(0);\n" " int index = get_global_id(0);\n"
" \n"
" if(index >= numCells)\n" " if(index >= numCells)\n"
" {\n" " {\n"
" return;\n" " return;\n"
@@ -68,7 +66,6 @@ static const char* gridBroadphaseCL= \
" sharedHash[get_local_id(0) + 1] = sortedData.x;\n" " sharedHash[get_local_id(0) + 1] = sortedData.x;\n"
" if((index > 0) && (get_local_id(0) == 0))\n" " if((index > 0) && (get_local_id(0) == 0))\n"
" {\n" " {\n"
" printf(\"%d sharedHash!\\n\", index);\n"
" // first thread in block must load neighbor body hash\n" " // first thread in block must load neighbor body hash\n"
" sharedHash[0] = pHash[index-1].x;\n" " sharedHash[0] = pHash[index-1].x;\n"
" }\n" " }\n"
@@ -78,7 +75,6 @@ static const char* gridBroadphaseCL= \
" {\n" " {\n"
" if((index == 0) || (sortedData.x != sharedHash[get_local_id(0)]))\n" " if((index == 0) || (sortedData.x != sharedHash[get_local_id(0)]))\n"
" {\n" " {\n"
" printf(\"%d cellStart!\\n\", index);\n"
" cellStart[sortedData.x] = index;\n" " cellStart[sortedData.x] = index;\n"
" }\n" " }\n"
" }\n" " }\n"
@@ -89,6 +85,7 @@ static const char* gridBroadphaseCL= \
" (min0.y <= max1.y)&& (min1.y <= max0.y) && \n" " (min0.y <= max1.y)&& (min1.y <= max0.y) && \n"
" (min0.z <= max1.z)&& (min1.z <= max0.z); \n" " (min0.z <= max1.z)&& (min1.z <= max0.z); \n"
"}\n" "}\n"
"//search for AABB 'index' against other AABBs' in this cell\n"
"void findPairsInCell( int numObjects,\n" "void findPairsInCell( int numObjects,\n"
" int4 gridPos,\n" " int4 gridPos,\n"
" int index,\n" " int index,\n"
@@ -97,7 +94,10 @@ static const char* gridBroadphaseCL= \
" __global float4* pAABB, \n" " __global float4* pAABB, \n"
" __global int* pPairBuff,\n" " __global int* pPairBuff,\n"
" __global int2* pPairBuffStartCurr,\n" " __global int2* pPairBuffStartCurr,\n"
" __global float4* pParams)\n" " __global float4* pParams,\n"
" volatile __global int* pairCount,\n"
" __global int4* pPairBuff2\n"
" )\n"
"{\n" "{\n"
" int4 pGridDim = *((__global int4*)(pParams + 1));\n" " int4 pGridDim = *((__global int4*)(pParams + 1));\n"
" int maxBodiesPerCell = pGridDim.w;\n" " int maxBodiesPerCell = pGridDim.w;\n"
@@ -129,12 +129,29 @@ static const char* gridBroadphaseCL= \
" break; // no longer in same bucket\n" " break; // no longer in same bucket\n"
" }\n" " }\n"
" int unsorted_indx2 = cellData.y;\n" " int unsorted_indx2 = cellData.y;\n"
" if (unsorted_indx2 < unsorted_indx) // check not colliding with self\n" " //if (unsorted_indx2 < unsorted_indx) // check not colliding with self\n"
" if (unsorted_indx2 != unsorted_indx) // check not colliding with self\n"
" { \n" " { \n"
" float4 min1 = pAABB[unsorted_indx2*2 + 0];\n" " float4 min1 = pAABB[unsorted_indx2*2 + 0];\n"
" float4 max1 = pAABB[unsorted_indx2*2 + 1];\n" " float4 max1 = pAABB[unsorted_indx2*2 + 1];\n"
" if(testAABBOverlap(min0, max0, min1, max1))\n" " if(testAABBOverlap(min0, max0, min1, max1))\n"
" {\n" " {\n"
" if (pairCount)\n"
" {\n"
" int handleIndex2 = as_int(min1.w);\n"
" if (handleIndex<handleIndex2)\n"
" {\n"
" int curPair = atomic_add(pairCount,1);\n"
" int4 newpair;\n"
" newpair.x = handleIndex;\n"
" newpair.y = handleIndex2;\n"
" newpair.z = -1;\n"
" newpair.w = -1;\n"
" pPairBuff2[curPair] = newpair;\n"
" }\n"
" \n"
" } else\n"
" {\n"
" int handleIndex2 = as_int(min1.w);\n" " int handleIndex2 = as_int(min1.w);\n"
" int k;\n" " int k;\n"
" for(k = 0; k < curr; k++)\n" " for(k = 0; k < curr; k++)\n"
@@ -158,11 +175,15 @@ static const char* gridBroadphaseCL= \
" }\n" " }\n"
" }\n" " }\n"
" }\n" " }\n"
" }\n"
" if (!pairCount)\n"
" {\n"
" int2 newStartCurr;\n" " int2 newStartCurr;\n"
" newStartCurr.x = start;\n" " newStartCurr.x = start;\n"
" newStartCurr.y = curr;\n" " newStartCurr.y = curr;\n"
" pPairBuffStartCurr[handleIndex] = newStartCurr;\n" " pPairBuffStartCurr[handleIndex] = newStartCurr;\n"
" return;\n" " }\n"
" \n"
"}\n" "}\n"
"__kernel void kFindOverlappingPairs( int numObjects,\n" "__kernel void kFindOverlappingPairs( int numObjects,\n"
" __global float4* pAABB, \n" " __global float4* pAABB, \n"
@@ -170,7 +191,10 @@ static const char* gridBroadphaseCL= \
" __global int* pCellStart, \n" " __global int* pCellStart, \n"
" __global int* pPairBuff, \n" " __global int* pPairBuff, \n"
" __global int2* pPairBuffStartCurr, \n" " __global int2* pPairBuffStartCurr, \n"
" __global float4* pParams )\n" " __global float4* pParams ,\n"
" volatile __global int* pairCount,\n"
" __global int4* pPairBuff2\n"
" )\n"
"{\n" "{\n"
" int index = get_global_id(0);\n" " int index = get_global_id(0);\n"
" if(index >= numObjects)\n" " if(index >= numObjects)\n"
@@ -198,7 +222,7 @@ static const char* gridBroadphaseCL= \
" for(int x=-1; x<=1; x++) \n" " for(int x=-1; x<=1; x++) \n"
" {\n" " {\n"
" gridPosB.x = gridPosA.x + x;\n" " gridPosB.x = gridPosA.x + x;\n"
" findPairsInCell(numObjects, gridPosB, index, pHash, pCellStart, pAABB, pPairBuff, pPairBuffStartCurr, pParams);\n" " findPairsInCell(numObjects, gridPosB, index, pHash, pCellStart, pAABB, pPairBuff, pPairBuffStartCurr, pParams, pairCount,pPairBuff2);\n"
" }\n" " }\n"
" }\n" " }\n"
" }\n" " }\n"

View File

@@ -17,7 +17,7 @@ subject to the following restrictions:
#include "b3Solver.h" #include "b3Solver.h"
///useNewBatchingKernel is a rewritten kernel using just a single thread of the warp, for experiments ///useNewBatchingKernel is a rewritten kernel using just a single thread of the warp, for experiments
bool useNewBatchingKernel = false; bool useNewBatchingKernel = true;
bool convertConstraintOnCpu = false; bool convertConstraintOnCpu = false;
#define B3_SOLVER_SETUP_KERNEL_PATH "src/Bullet3OpenCL/RigidBody/kernels/solverSetup.cl" #define B3_SOLVER_SETUP_KERNEL_PATH "src/Bullet3OpenCL/RigidBody/kernels/solverSetup.cl"