add support for BVH acceleration for concave trianglemesh collision against convex hulls
bugfix/improvement in batching
This commit is contained in:
erwin coumans
@@ -941,11 +941,7 @@ static const char* satKernelsCL= \
|
||||
" __global btAabbCL* aabbs,\n"
|
||||
" __global volatile float4* separatingNormals,\n"
|
||||
" __global volatile int* hasSeparatingAxis,\n"
|
||||
" __global int4* concavePairsOut,\n"
|
||||
" __global float4* concaveSeparatingNormalsOut,\n"
|
||||
" __global volatile int* numConcavePairsOut,\n"
|
||||
" int numPairs,\n"
|
||||
" int maxNumConcavePairsCapacity\n"
|
||||
" int numPairs\n"
|
||||
" )\n"
|
||||
"{\n"
|
||||
"\n"
|
||||
@@ -972,230 +968,6 @@ static const char* satKernelsCL= \
|
||||
" return;\n"
|
||||
" }\n"
|
||||
" \n"
|
||||
" if ((collidables[collidableIndexA].m_shapeType==SHAPE_CONCAVE_TRIMESH))// && (collidables[collidableIndexB].m_shapeType==SHAPE_CONVEX_HULL))\n"
|
||||
" {\n"
|
||||
" \n"
|
||||
" int numFacesA = convexShapes[shapeIndexA].m_numFaces;\n"
|
||||
" int numActualConcaveConvexTests = 0;\n"
|
||||
" \n"
|
||||
" for (int f=0;f<numFacesA;f++)\n"
|
||||
" {\n"
|
||||
" \n"
|
||||
" bool overlap = false;\n"
|
||||
" \n"
|
||||
" ConvexPolyhedronCL convexPolyhedronA;\n"
|
||||
"\n"
|
||||
" //add 3 vertices of the triangle\n"
|
||||
" convexPolyhedronA.m_numVertices = 3;\n"
|
||||
" convexPolyhedronA.m_vertexOffset = 0;\n"
|
||||
" float4 localCenter = make_float4(0.f,0.f,0.f,0.f);\n"
|
||||
"\n"
|
||||
" btGpuFace face = faces[convexShapes[shapeIndexA].m_faceOffset+f];\n"
|
||||
" float4 triMinAabb, triMaxAabb;\n"
|
||||
" btAabbCL triAabb;\n"
|
||||
" triAabb.m_min = make_float4(1e30f,1e30f,1e30f,0.f);\n"
|
||||
" triAabb.m_max = make_float4(-1e30f,-1e30f,-1e30f,0.f);\n"
|
||||
" \n"
|
||||
" float4 verticesA[3];\n"
|
||||
" for (int i=0;i<3;i++)\n"
|
||||
" {\n"
|
||||
" int index = indices[face.m_indexOffset+i];\n"
|
||||
" float4 vert = vertices[convexShapes[shapeIndexA].m_vertexOffset+index];\n"
|
||||
" verticesA[i] = vert;\n"
|
||||
" localCenter += vert;\n"
|
||||
"#if 0\n"
|
||||
"//just in case some implementation doesn't support component-wise min and max for float4\n"
|
||||
" if (triAabb.m_min.x > vert.x)\n"
|
||||
" triAabb.m_min.x = vert.x;\n"
|
||||
" if (triAabb.m_min.y > vert.y)\n"
|
||||
" triAabb.m_min.y = vert.y;\n"
|
||||
" if (triAabb.m_min.z > vert.z)\n"
|
||||
" triAabb.m_min.z = vert.z;\n"
|
||||
"\n"
|
||||
" if (triAabb.m_max.x < vert.x)\n"
|
||||
" triAabb.m_max.x = vert.x;\n"
|
||||
" if (triAabb.m_max.y < vert.y)\n"
|
||||
" triAabb.m_max.y = vert.y;\n"
|
||||
" if (triAabb.m_max.z < vert.z)\n"
|
||||
" triAabb.m_max.z = vert.z;\n"
|
||||
"#else \n"
|
||||
" triAabb.m_min = min(triAabb.m_min,vert); \n"
|
||||
" triAabb.m_max = max(triAabb.m_max,vert); \n"
|
||||
"#endif \n"
|
||||
" }\n"
|
||||
"\n"
|
||||
" overlap = true;\n"
|
||||
" overlap = (triAabb.m_min.x > aabbs[bodyIndexB].m_max.x || triAabb.m_max.x < aabbs[bodyIndexB].m_min.x) ? false : overlap;\n"
|
||||
" overlap = (triAabb.m_min.z > aabbs[bodyIndexB].m_max.z || triAabb.m_max.z < aabbs[bodyIndexB].m_min.z) ? false : overlap;\n"
|
||||
" overlap = (triAabb.m_min.y > aabbs[bodyIndexB].m_max.y || triAabb.m_max.y < aabbs[bodyIndexB].m_min.y) ? false : overlap;\n"
|
||||
" \n"
|
||||
" if (overlap)\n"
|
||||
" {\n"
|
||||
" float dmin = FLT_MAX;\n"
|
||||
" int hasSeparatingAxis=5;\n"
|
||||
" float4 sepAxis=make_float4(1,2,3,4);\n"
|
||||
"\n"
|
||||
"#if 1\n"
|
||||
" \n"
|
||||
" int localCC=0;\n"
|
||||
" numActualConcaveConvexTests++;\n"
|
||||
"\n"
|
||||
" //a triangle has 3 unique edges\n"
|
||||
" convexPolyhedronA.m_numUniqueEdges = 3;\n"
|
||||
" convexPolyhedronA.m_uniqueEdgesOffset = 0;\n"
|
||||
" float4 uniqueEdgesA[3];\n"
|
||||
" \n"
|
||||
" uniqueEdgesA[0] = (verticesA[1]-verticesA[0]);\n"
|
||||
" uniqueEdgesA[1] = (verticesA[2]-verticesA[1]);\n"
|
||||
" uniqueEdgesA[2] = (verticesA[0]-verticesA[2]);\n"
|
||||
"\n"
|
||||
"\n"
|
||||
" convexPolyhedronA.m_faceOffset = 0;\n"
|
||||
" \n"
|
||||
" float4 normal = make_float4(face.m_plane.x,face.m_plane.y,face.m_plane.z,0.f);\n"
|
||||
" \n"
|
||||
" btGpuFace facesA[TRIANGLE_NUM_CONVEX_FACES];\n"
|
||||
" int indicesA[3+3+2+2+2];\n"
|
||||
" int curUsedIndices=0;\n"
|
||||
" int fidx=0;\n"
|
||||
"\n"
|
||||
" //front size of triangle\n"
|
||||
" {\n"
|
||||
" facesA[fidx].m_indexOffset=curUsedIndices;\n"
|
||||
" indicesA[0] = 0;\n"
|
||||
" indicesA[1] = 1;\n"
|
||||
" indicesA[2] = 2;\n"
|
||||
" curUsedIndices+=3;\n"
|
||||
" float c = face.m_plane.w;\n"
|
||||
" facesA[fidx].m_plane.x = normal.x;\n"
|
||||
" facesA[fidx].m_plane.y = normal.y;\n"
|
||||
" facesA[fidx].m_plane.z = normal.z;\n"
|
||||
" facesA[fidx].m_plane.w = c;\n"
|
||||
" facesA[fidx].m_numIndices=3;\n"
|
||||
" }\n"
|
||||
" fidx++;\n"
|
||||
" //back size of triangle\n"
|
||||
" {\n"
|
||||
" facesA[fidx].m_indexOffset=curUsedIndices;\n"
|
||||
" indicesA[3]=2;\n"
|
||||
" indicesA[4]=1;\n"
|
||||
" indicesA[5]=0;\n"
|
||||
" curUsedIndices+=3;\n"
|
||||
" float c = dot(normal,verticesA[0]);\n"
|
||||
" float c1 = -face.m_plane.w;\n"
|
||||
" facesA[fidx].m_plane.x = -normal.x;\n"
|
||||
" facesA[fidx].m_plane.y = -normal.y;\n"
|
||||
" facesA[fidx].m_plane.z = -normal.z;\n"
|
||||
" facesA[fidx].m_plane.w = c;\n"
|
||||
" facesA[fidx].m_numIndices=3;\n"
|
||||
" }\n"
|
||||
" fidx++;\n"
|
||||
"\n"
|
||||
" bool addEdgePlanes = true;\n"
|
||||
" if (addEdgePlanes)\n"
|
||||
" {\n"
|
||||
" int numVertices=3;\n"
|
||||
" int prevVertex = numVertices-1;\n"
|
||||
" for (int i=0;i<numVertices;i++)\n"
|
||||
" {\n"
|
||||
" float4 v0 = verticesA[i];\n"
|
||||
" float4 v1 = verticesA[prevVertex];\n"
|
||||
" \n"
|
||||
" float4 edgeNormal = normalize(cross(normal,v1-v0));\n"
|
||||
" float c = -dot(edgeNormal,v0);\n"
|
||||
" \n"
|
||||
" facesA[fidx].m_numIndices = 2;\n"
|
||||
" facesA[fidx].m_indexOffset=curUsedIndices;\n"
|
||||
" indicesA[curUsedIndices++]=i;\n"
|
||||
" indicesA[curUsedIndices++]=prevVertex;\n"
|
||||
" \n"
|
||||
" facesA[fidx].m_plane.x = edgeNormal.x;\n"
|
||||
" facesA[fidx].m_plane.y = edgeNormal.y;\n"
|
||||
" facesA[fidx].m_plane.z = edgeNormal.z;\n"
|
||||
" facesA[fidx].m_plane.w = c;\n"
|
||||
" fidx++;\n"
|
||||
" prevVertex = i;\n"
|
||||
" }\n"
|
||||
" }\n"
|
||||
" convexPolyhedronA.m_numFaces = TRIANGLE_NUM_CONVEX_FACES;\n"
|
||||
" convexPolyhedronA.m_localCenter = localCenter*(1.f/3.f);\n"
|
||||
" \n"
|
||||
"\n"
|
||||
" float4 posA = rigidBodies[bodyIndexA].m_pos;\n"
|
||||
" posA.w = 0.f;\n"
|
||||
" float4 posB = rigidBodies[bodyIndexB].m_pos;\n"
|
||||
" posB.w = 0.f;\n"
|
||||
" float4 c0local = convexPolyhedronA.m_localCenter;\n"
|
||||
" float4 ornA = rigidBodies[bodyIndexA].m_quat;\n"
|
||||
" float4 c0 = transform(&c0local, &posA, &ornA);\n"
|
||||
" float4 c1local = convexShapes[shapeIndexB].m_localCenter;\n"
|
||||
" float4 ornB =rigidBodies[bodyIndexB].m_quat;\n"
|
||||
" float4 c1 = transform(&c1local,&posB,&ornB);\n"
|
||||
" const float4 DeltaC2 = c0 - c1;\n"
|
||||
" \n"
|
||||
" bool sepA = findSeparatingAxisLocalA( &convexPolyhedronA, &convexShapes[shapeIndexB],rigidBodies[bodyIndexA].m_pos,rigidBodies[bodyIndexA].m_quat,\n"
|
||||
" rigidBodies[bodyIndexB].m_pos,rigidBodies[bodyIndexB].m_quat,\n"
|
||||
" DeltaC2,\n"
|
||||
" verticesA,uniqueEdgesA,facesA,indicesA,\n"
|
||||
" vertices,uniqueEdges,faces,indices,\n"
|
||||
" &sepAxis,&dmin);\n"
|
||||
" hasSeparatingAxis = 4;\n"
|
||||
" if (!sepA)\n"
|
||||
" {\n"
|
||||
" hasSeparatingAxis = 0;\n"
|
||||
" } else\n"
|
||||
" {\n"
|
||||
" bool sepB = findSeparatingAxisLocalB( &convexShapes[shapeIndexB],&convexPolyhedronA,rigidBodies[bodyIndexB].m_pos,rigidBodies[bodyIndexB].m_quat,\n"
|
||||
" rigidBodies[bodyIndexA].m_pos,rigidBodies[bodyIndexA].m_quat,\n"
|
||||
" DeltaC2,\n"
|
||||
" vertices,uniqueEdges,faces,indices,\n"
|
||||
" verticesA,uniqueEdgesA,facesA,indicesA,\n"
|
||||
" &sepAxis,&dmin);\n"
|
||||
" \n"
|
||||
" if (!sepB)\n"
|
||||
" {\n"
|
||||
" hasSeparatingAxis = 0;\n"
|
||||
" } else\n"
|
||||
" {\n"
|
||||
" bool sepEE = findSeparatingAxisEdgeEdgeLocalA( &convexPolyhedronA, &convexShapes[shapeIndexB],rigidBodies[bodyIndexA].m_pos,rigidBodies[bodyIndexA].m_quat,\n"
|
||||
" rigidBodies[bodyIndexB].m_pos,rigidBodies[bodyIndexB].m_quat,\n"
|
||||
" DeltaC2,\n"
|
||||
" verticesA,uniqueEdgesA,facesA,indicesA,\n"
|
||||
" vertices,uniqueEdges,faces,indices,\n"
|
||||
" &sepAxis,&dmin);\n"
|
||||
" \n"
|
||||
" if (!sepEE)\n"
|
||||
" {\n"
|
||||
" hasSeparatingAxis = 0;\n"
|
||||
" } else\n"
|
||||
" {\n"
|
||||
" hasSeparatingAxis = 1;\n"
|
||||
" }\n"
|
||||
" }\n"
|
||||
" } \n"
|
||||
"#endif\n"
|
||||
" \n"
|
||||
" if (hasSeparatingAxis)\n"
|
||||
" {\n"
|
||||
" int pairIdx = atomic_inc(numConcavePairsOut);\n"
|
||||
" if (pairIdx<maxNumConcavePairsCapacity)\n"
|
||||
" {\n"
|
||||
" concavePairsOut[pairIdx].x = bodyIndexA;\n"
|
||||
" concavePairsOut[pairIdx].y = bodyIndexB;\n"
|
||||
" concavePairsOut[pairIdx].z = f;\n"
|
||||
" concavePairsOut[pairIdx].w = 3;\n"
|
||||
" sepAxis.w = dmin;\n"
|
||||
" concaveSeparatingNormalsOut[pairIdx]=sepAxis;\n"
|
||||
" }\n"
|
||||
" }\n"
|
||||
" }\n"
|
||||
" }\n"
|
||||
" //todo//??\n"
|
||||
" hasSeparatingAxis[i] = 0;\n"
|
||||
" return;\n"
|
||||
" } \n"
|
||||
"\n"
|
||||
" \n"
|
||||
"\n"
|
||||
" if ((collidables[collidableIndexA].m_shapeType!=SHAPE_CONVEX_HULL) ||(collidables[collidableIndexB].m_shapeType!=SHAPE_CONVEX_HULL))\n"
|
||||
" {\n"
|
||||
@@ -1203,10 +975,12 @@ static const char* satKernelsCL= \
|
||||
" return;\n"
|
||||
" }\n"
|
||||
" \n"
|
||||
" if ((collidables[collidableIndexA].m_shapeType==SHAPE_CONCAVE_TRIMESH))\n"
|
||||
" {\n"
|
||||
" hasSeparatingAxis[i] = 0;\n"
|
||||
" return;\n"
|
||||
" }\n"
|
||||
"\n"
|
||||
"\n"
|
||||
"\n"
|
||||
" \n"
|
||||
" int numFacesA = convexShapes[shapeIndexA].m_numFaces;\n"
|
||||
"\n"
|
||||
" float dmin = FLT_MAX;\n"
|
||||
@@ -1265,4 +1039,238 @@ static const char* satKernelsCL= \
|
||||
" }\n"
|
||||
"\n"
|
||||
"}\n"
|
||||
"\n"
|
||||
"\n"
|
||||
"\n"
|
||||
"\n"
|
||||
"// work-in-progress\n"
|
||||
"__kernel void findConcaveSeparatingAxisKernel( __global int4* concavePairs,\n"
|
||||
" __global const BodyData* rigidBodies,\n"
|
||||
" __global const btCollidableGpu* collidables,\n"
|
||||
" __global const ConvexPolyhedronCL* convexShapes, \n"
|
||||
" __global const float4* vertices,\n"
|
||||
" __global const float4* uniqueEdges,\n"
|
||||
" __global const btGpuFace* faces,\n"
|
||||
" __global const int* indices,\n"
|
||||
" __global btAabbCL* aabbs,\n"
|
||||
" __global volatile float4* separatingNormals,\n"
|
||||
" __global volatile int* hasSeparatingAxis,\n"
|
||||
" __global float4* concaveSeparatingNormalsOut,\n"
|
||||
" int numConcavePairs\n"
|
||||
" )\n"
|
||||
"{\n"
|
||||
"\n"
|
||||
" int i = get_global_id(0);\n"
|
||||
" if (i>=numConcavePairs)\n"
|
||||
" return;\n"
|
||||
" int pairIdx = i;\n"
|
||||
"\n"
|
||||
" int bodyIndexA = concavePairs[i].x;\n"
|
||||
" int bodyIndexB = concavePairs[i].y;\n"
|
||||
"\n"
|
||||
" int collidableIndexA = rigidBodies[bodyIndexA].m_collidableIdx;\n"
|
||||
" int collidableIndexB = rigidBodies[bodyIndexB].m_collidableIdx;\n"
|
||||
"\n"
|
||||
" int shapeIndexA = collidables[collidableIndexA].m_shapeIndex;\n"
|
||||
" int shapeIndexB = collidables[collidableIndexB].m_shapeIndex;\n"
|
||||
"\n"
|
||||
"\n"
|
||||
" int numFacesA = convexShapes[shapeIndexA].m_numFaces;\n"
|
||||
" int numActualConcaveConvexTests = 0;\n"
|
||||
" \n"
|
||||
" int f = concavePairs[i].z;\n"
|
||||
" \n"
|
||||
" bool overlap = false;\n"
|
||||
" \n"
|
||||
" ConvexPolyhedronCL convexPolyhedronA;\n"
|
||||
"\n"
|
||||
" //add 3 vertices of the triangle\n"
|
||||
" convexPolyhedronA.m_numVertices = 3;\n"
|
||||
" convexPolyhedronA.m_vertexOffset = 0;\n"
|
||||
" float4 localCenter = make_float4(0.f,0.f,0.f,0.f);\n"
|
||||
"\n"
|
||||
" btGpuFace face = faces[convexShapes[shapeIndexA].m_faceOffset+f];\n"
|
||||
" float4 triMinAabb, triMaxAabb;\n"
|
||||
" btAabbCL triAabb;\n"
|
||||
" triAabb.m_min = make_float4(1e30f,1e30f,1e30f,0.f);\n"
|
||||
" triAabb.m_max = make_float4(-1e30f,-1e30f,-1e30f,0.f);\n"
|
||||
" \n"
|
||||
" float4 verticesA[3];\n"
|
||||
" for (int i=0;i<3;i++)\n"
|
||||
" {\n"
|
||||
" int index = indices[face.m_indexOffset+i];\n"
|
||||
" float4 vert = vertices[convexShapes[shapeIndexA].m_vertexOffset+index];\n"
|
||||
" verticesA[i] = vert;\n"
|
||||
" localCenter += vert;\n"
|
||||
" \n"
|
||||
" triAabb.m_min = min(triAabb.m_min,vert); \n"
|
||||
" triAabb.m_max = max(triAabb.m_max,vert); \n"
|
||||
"\n"
|
||||
" }\n"
|
||||
"\n"
|
||||
" overlap = true;\n"
|
||||
" overlap = (triAabb.m_min.x > aabbs[bodyIndexB].m_max.x || triAabb.m_max.x < aabbs[bodyIndexB].m_min.x) ? false : overlap;\n"
|
||||
" overlap = (triAabb.m_min.z > aabbs[bodyIndexB].m_max.z || triAabb.m_max.z < aabbs[bodyIndexB].m_min.z) ? false : overlap;\n"
|
||||
" overlap = (triAabb.m_min.y > aabbs[bodyIndexB].m_max.y || triAabb.m_max.y < aabbs[bodyIndexB].m_min.y) ? false : overlap;\n"
|
||||
" \n"
|
||||
" if (overlap)\n"
|
||||
" {\n"
|
||||
" float dmin = FLT_MAX;\n"
|
||||
" int hasSeparatingAxis=5;\n"
|
||||
" float4 sepAxis=make_float4(1,2,3,4);\n"
|
||||
"\n"
|
||||
" int localCC=0;\n"
|
||||
" numActualConcaveConvexTests++;\n"
|
||||
"\n"
|
||||
" //a triangle has 3 unique edges\n"
|
||||
" convexPolyhedronA.m_numUniqueEdges = 3;\n"
|
||||
" convexPolyhedronA.m_uniqueEdgesOffset = 0;\n"
|
||||
" float4 uniqueEdgesA[3];\n"
|
||||
" \n"
|
||||
" uniqueEdgesA[0] = (verticesA[1]-verticesA[0]);\n"
|
||||
" uniqueEdgesA[1] = (verticesA[2]-verticesA[1]);\n"
|
||||
" uniqueEdgesA[2] = (verticesA[0]-verticesA[2]);\n"
|
||||
"\n"
|
||||
"\n"
|
||||
" convexPolyhedronA.m_faceOffset = 0;\n"
|
||||
" \n"
|
||||
" float4 normal = make_float4(face.m_plane.x,face.m_plane.y,face.m_plane.z,0.f);\n"
|
||||
" \n"
|
||||
" btGpuFace facesA[TRIANGLE_NUM_CONVEX_FACES];\n"
|
||||
" int indicesA[3+3+2+2+2];\n"
|
||||
" int curUsedIndices=0;\n"
|
||||
" int fidx=0;\n"
|
||||
"\n"
|
||||
" //front size of triangle\n"
|
||||
" {\n"
|
||||
" facesA[fidx].m_indexOffset=curUsedIndices;\n"
|
||||
" indicesA[0] = 0;\n"
|
||||
" indicesA[1] = 1;\n"
|
||||
" indicesA[2] = 2;\n"
|
||||
" curUsedIndices+=3;\n"
|
||||
" float c = face.m_plane.w;\n"
|
||||
" facesA[fidx].m_plane.x = normal.x;\n"
|
||||
" facesA[fidx].m_plane.y = normal.y;\n"
|
||||
" facesA[fidx].m_plane.z = normal.z;\n"
|
||||
" facesA[fidx].m_plane.w = c;\n"
|
||||
" facesA[fidx].m_numIndices=3;\n"
|
||||
" }\n"
|
||||
" fidx++;\n"
|
||||
" //back size of triangle\n"
|
||||
" {\n"
|
||||
" facesA[fidx].m_indexOffset=curUsedIndices;\n"
|
||||
" indicesA[3]=2;\n"
|
||||
" indicesA[4]=1;\n"
|
||||
" indicesA[5]=0;\n"
|
||||
" curUsedIndices+=3;\n"
|
||||
" float c = dot(normal,verticesA[0]);\n"
|
||||
" float c1 = -face.m_plane.w;\n"
|
||||
" facesA[fidx].m_plane.x = -normal.x;\n"
|
||||
" facesA[fidx].m_plane.y = -normal.y;\n"
|
||||
" facesA[fidx].m_plane.z = -normal.z;\n"
|
||||
" facesA[fidx].m_plane.w = c;\n"
|
||||
" facesA[fidx].m_numIndices=3;\n"
|
||||
" }\n"
|
||||
" fidx++;\n"
|
||||
"\n"
|
||||
" bool addEdgePlanes = true;\n"
|
||||
" if (addEdgePlanes)\n"
|
||||
" {\n"
|
||||
" int numVertices=3;\n"
|
||||
" int prevVertex = numVertices-1;\n"
|
||||
" for (int i=0;i<numVertices;i++)\n"
|
||||
" {\n"
|
||||
" float4 v0 = verticesA[i];\n"
|
||||
" float4 v1 = verticesA[prevVertex];\n"
|
||||
" \n"
|
||||
" float4 edgeNormal = normalize(cross(normal,v1-v0));\n"
|
||||
" float c = -dot(edgeNormal,v0);\n"
|
||||
"\n"
|
||||
" facesA[fidx].m_numIndices = 2;\n"
|
||||
" facesA[fidx].m_indexOffset=curUsedIndices;\n"
|
||||
" indicesA[curUsedIndices++]=i;\n"
|
||||
" indicesA[curUsedIndices++]=prevVertex;\n"
|
||||
" \n"
|
||||
" facesA[fidx].m_plane.x = edgeNormal.x;\n"
|
||||
" facesA[fidx].m_plane.y = edgeNormal.y;\n"
|
||||
" facesA[fidx].m_plane.z = edgeNormal.z;\n"
|
||||
" facesA[fidx].m_plane.w = c;\n"
|
||||
" fidx++;\n"
|
||||
" prevVertex = i;\n"
|
||||
" }\n"
|
||||
" }\n"
|
||||
" convexPolyhedronA.m_numFaces = TRIANGLE_NUM_CONVEX_FACES;\n"
|
||||
" convexPolyhedronA.m_localCenter = localCenter*(1.f/3.f);\n"
|
||||
"\n"
|
||||
"\n"
|
||||
" float4 posA = rigidBodies[bodyIndexA].m_pos;\n"
|
||||
" posA.w = 0.f;\n"
|
||||
" float4 posB = rigidBodies[bodyIndexB].m_pos;\n"
|
||||
" posB.w = 0.f;\n"
|
||||
" float4 c0local = convexPolyhedronA.m_localCenter;\n"
|
||||
" float4 ornA = rigidBodies[bodyIndexA].m_quat;\n"
|
||||
" float4 c0 = transform(&c0local, &posA, &ornA);\n"
|
||||
" float4 c1local = convexShapes[shapeIndexB].m_localCenter;\n"
|
||||
" float4 ornB =rigidBodies[bodyIndexB].m_quat;\n"
|
||||
" float4 c1 = transform(&c1local,&posB,&ornB);\n"
|
||||
" const float4 DeltaC2 = c0 - c1;\n"
|
||||
" \n"
|
||||
" bool sepA = findSeparatingAxisLocalA( &convexPolyhedronA, &convexShapes[shapeIndexB],rigidBodies[bodyIndexA].m_pos,rigidBodies[bodyIndexA].m_quat,\n"
|
||||
" rigidBodies[bodyIndexB].m_pos,rigidBodies[bodyIndexB].m_quat,\n"
|
||||
" DeltaC2,\n"
|
||||
" verticesA,uniqueEdgesA,facesA,indicesA,\n"
|
||||
" vertices,uniqueEdges,faces,indices,\n"
|
||||
" &sepAxis,&dmin);\n"
|
||||
" hasSeparatingAxis = 4;\n"
|
||||
" if (!sepA)\n"
|
||||
" {\n"
|
||||
" hasSeparatingAxis = 0;\n"
|
||||
" } else\n"
|
||||
" {\n"
|
||||
" bool sepB = findSeparatingAxisLocalB( &convexShapes[shapeIndexB],&convexPolyhedronA,rigidBodies[bodyIndexB].m_pos,rigidBodies[bodyIndexB].m_quat,\n"
|
||||
" rigidBodies[bodyIndexA].m_pos,rigidBodies[bodyIndexA].m_quat,\n"
|
||||
" DeltaC2,\n"
|
||||
" vertices,uniqueEdges,faces,indices,\n"
|
||||
" verticesA,uniqueEdgesA,facesA,indicesA,\n"
|
||||
" &sepAxis,&dmin);\n"
|
||||
"\n"
|
||||
" if (!sepB)\n"
|
||||
" {\n"
|
||||
" hasSeparatingAxis = 0;\n"
|
||||
" } else\n"
|
||||
" {\n"
|
||||
" bool sepEE = findSeparatingAxisEdgeEdgeLocalA( &convexPolyhedronA, &convexShapes[shapeIndexB],rigidBodies[bodyIndexA].m_pos,rigidBodies[bodyIndexA].m_quat,\n"
|
||||
" rigidBodies[bodyIndexB].m_pos,rigidBodies[bodyIndexB].m_quat,\n"
|
||||
" DeltaC2,\n"
|
||||
" verticesA,uniqueEdgesA,facesA,indicesA,\n"
|
||||
" vertices,uniqueEdges,faces,indices,\n"
|
||||
" &sepAxis,&dmin);\n"
|
||||
" \n"
|
||||
" if (!sepEE)\n"
|
||||
" {\n"
|
||||
" hasSeparatingAxis = 0;\n"
|
||||
" } else\n"
|
||||
" {\n"
|
||||
" hasSeparatingAxis = 1;\n"
|
||||
" }\n"
|
||||
" }\n"
|
||||
" } \n"
|
||||
" \n"
|
||||
" if (hasSeparatingAxis)\n"
|
||||
" {\n"
|
||||
" sepAxis.w = dmin;\n"
|
||||
" concaveSeparatingNormalsOut[pairIdx]=sepAxis;\n"
|
||||
" } else\n"
|
||||
" { \n"
|
||||
" //mark this pair as in-active\n"
|
||||
" concavePairs[pairIdx].w = 0;\n"
|
||||
" }\n"
|
||||
" }\n"
|
||||
" else\n"
|
||||
" { \n"
|
||||
" //mark this pair as in-active\n"
|
||||
" concavePairs[pairIdx].w = 0;\n"
|
||||
" }\n"
|
||||
"}\n"
|
||||
"\n"
|
||||
;
|
||||
|
||||
Reference in New Issue
Block a user