private IntPtr allocateConvex(MeshCollider meshCollider, Matrix4x4 localToParentRelative)
{
if (meshCollider.sharedMesh == null)
{
throw new NotImplementedException("MeshCollider missing sharedMesh.");
}
if (meshCollider.convex == false)
{
throw new NotImplementedException("MeshCollider must be convex.");
}
Mesh mesh = meshCollider.sharedMesh;
INTERACTION_CONVEX_POLYHEDRON_DESCRIPTION meshDesc = new INTERACTION_CONVEX_POLYHEDRON_DESCRIPTION();
meshDesc.shape.type = ShapeType.Convex;
meshDesc.radius = 0.0f;
meshDesc.nVerticies = (uint)mesh.vertexCount;
meshDesc.pVertices = new LEAP_VECTOR[mesh.vertexCount];
for (int i = 0; i < mesh.vertexCount; i++)
{
LEAP_VECTOR v = localToParentRelative.MultiplyPoint(mesh.vertices[i]).ToCVector();
meshDesc.pVertices[i] = v;
}
IntPtr meshPtr = StructAllocator.AllocateStruct(ref meshDesc);
return(meshPtr);
}
private IntPtr allocateSphere(float radius)
{
INTERACTION_SPHERE_DESCRIPTION sphereDesc = new INTERACTION_SPHERE_DESCRIPTION();
sphereDesc.shape.type = ShapeType.Sphere;
sphereDesc.radius = radius;
IntPtr spherePtr = StructAllocator.AllocateStruct(ref sphereDesc);
return(spherePtr);
}
private IntPtr allocateObb(Vector3 extents)
{
INTERACTION_OBB_DESCRIPTION obbDesc = new INTERACTION_OBB_DESCRIPTION();
obbDesc.shape.type = ShapeType.OBB;
obbDesc.extents = extents.ToCVector();
IntPtr obbPtr = StructAllocator.AllocateStruct(ref obbDesc);
return(obbPtr);
}
private IntPtr allocateCapsule(Vector3 p0, Vector3 p1, float radius)
{
INTERACTION_CONVEX_POLYHEDRON_DESCRIPTION meshDesc = new INTERACTION_CONVEX_POLYHEDRON_DESCRIPTION();
meshDesc.shape.type = ShapeType.Convex;
meshDesc.radius = radius;
meshDesc.nVerticies = 2;
meshDesc.pVertices = new LEAP_VECTOR[2];
meshDesc.pVertices[0] = p0.ToCVector();
meshDesc.pVertices[1] = p1.ToCVector();
IntPtr capsulePtr = StructAllocator.AllocateStruct(ref meshDesc);
return(capsulePtr);
}
public INTERACTION_SHAPE_DESCRIPTION_HANDLE GetCollision(GameObject parentObject)
{
parentObject.GetComponentsInChildren <Collider>(_tempColliderList);
// Remove Colliders that are children of other IInteractionBehaviour.
Transform parentTransform = parentObject.transform;
for (int i = _tempColliderList.Count; i-- > 0;)
{
Transform it = _tempColliderList[i].transform;
while (it != parentTransform)
{
if (it.GetComponent <IInteractionBehaviour>() != null)
{
_tempColliderList.RemoveAt(i);
break;
}
it = it.parent;
}
}
if (_tempColliderList.Count == 0)
{
throw new InvalidOperationException("The GameObject " + parentObject + " did not have any colliders.");
}
INTERACTION_SHAPE_DESCRIPTION_HANDLE handle = new INTERACTION_SHAPE_DESCRIPTION_HANDLE();
// Try optimized encodings for a single collider. Everything else is a compound.
if (_tempColliderList.Count == 1)
{
if (getCollisionSingleInternal(parentObject, ref handle))
{
return(handle);
}
}
INTERACTION_COMPOUND_DESCRIPTION compoundDesc = new INTERACTION_COMPOUND_DESCRIPTION();
compoundDesc.shape.type = ShapeType.Compound;
compoundDesc.nShapes = (uint)_tempColliderList.Count;
compoundDesc.pShapes = StructAllocator.AllocateArray <IntPtr>(_tempColliderList.Count);
compoundDesc.pTransforms = new INTERACTION_TRANSFORM[_tempColliderList.Count];
// The parent's relative pose is a components of the parents transform that
// child transforms are considered to be relative two. In this case scale
// and shear are not considered a property of the parents relative pose and
// therefore these calcualtions will allow the child to inherit the parents
// scale.
Matrix4x4 parentRelativePose = Matrix4x4.TRS(parentObject.transform.position, parentObject.transform.rotation, Vector3.one);
Matrix4x4 inverseParentRelativePose = parentRelativePose.inverse;
for (int i = 0; i < _tempColliderList.Count; i++)
{
Collider collider = _tempColliderList[i];
// Transform to apply to collision shape.
Matrix4x4 localToParentRelative = inverseParentRelativePose * collider.transform.localToWorldMatrix;
// Values used to construct INTERACTION_TRANSFORM.
Vector3 parentRelativePos = Vector3.zero;
Quaternion parentRelativeRot = Quaternion.identity;
IntPtr shapePtr;
if (collider is MeshCollider)
{
// Mesh always has an identity associated transform that can be baked into the verts.
MeshCollider meshCollider = collider as MeshCollider;
shapePtr = allocateConvex(meshCollider, localToParentRelative);
}
else
{
// Rotation and scale are lossy when shear is involved.
parentRelativeRot = Quaternion.Inverse(parentObject.transform.rotation) * collider.transform.rotation;
Vector3 scaleAlongLocalToParentAxes = new Vector3(localToParentRelative.GetColumn(0).magnitude,
localToParentRelative.GetColumn(1).magnitude,
localToParentRelative.GetColumn(2).magnitude);
if (collider is SphereCollider)
{
SphereCollider sphereCollider = collider as SphereCollider;
parentRelativePos = localToParentRelative.MultiplyPoint(sphereCollider.center);
float aproximateScale = Mathf.Max(scaleAlongLocalToParentAxes.x, Mathf.Max(scaleAlongLocalToParentAxes.y, scaleAlongLocalToParentAxes.z));
shapePtr = allocateSphere(sphereCollider.radius * aproximateScale);
}
else if (collider is BoxCollider)
{
BoxCollider boxCollider = collider as BoxCollider;
parentRelativePos = localToParentRelative.MultiplyPoint(boxCollider.center);
Vector3 extents = boxCollider.size * 0.5f;
extents.Scale(scaleAlongLocalToParentAxes);
shapePtr = allocateObb(extents);
}
else if (collider is CapsuleCollider)
{
CapsuleCollider capsuleCollider = collider as CapsuleCollider;
if ((uint)capsuleCollider.direction >= 3u)
{
throw new InvalidOperationException("Unexpected capsule direction " + capsuleCollider.direction);
}
parentRelativePos = localToParentRelative.MultiplyPoint(capsuleCollider.center);
Vector3 primaryAxis = new Vector3((capsuleCollider.direction == 0) ? 1 : 0, (capsuleCollider.direction == 1) ? 1 : 0, (capsuleCollider.direction == 2) ? 1 : 0);
float primaryAxisScale = scaleAlongLocalToParentAxes[capsuleCollider.direction];
float perpendicularScale = Mathf.Max(scaleAlongLocalToParentAxes[(capsuleCollider.direction + 1) % 3], scaleAlongLocalToParentAxes[(capsuleCollider.direction + 2) % 3]);
float scaledHeight = capsuleCollider.height * primaryAxisScale;
float scaledRadius = capsuleCollider.radius * perpendicularScale;
float interiorExtent = (scaledHeight * 0.5f) - scaledRadius;
Vector3 p0 = primaryAxis * interiorExtent;
shapePtr = allocateCapsule(p0, -p0, scaledRadius);
}
else
{
throw new InvalidOperationException("Unsupported collider type " + collider.GetType());
}
}
StructMarshal <IntPtr> .CopyIntoArray(compoundDesc.pShapes, ref shapePtr, i);
INTERACTION_TRANSFORM ieTransform = new INTERACTION_TRANSFORM();
ieTransform.position = parentRelativePos.ToCVector();
ieTransform.rotation = parentRelativeRot.ToCQuaternion();
compoundDesc.pTransforms[i] = ieTransform;
}
IntPtr compoundPtr = StructAllocator.AllocateStruct(ref compoundDesc);
InteractionC.AddShapeDescription(ref _scene, compoundPtr, out handle);
StructAllocator.CleanupAllocations();
_tempColliderList.Clear();
_allHandles[handle] = new ShapeInfo(isCached: false);
return(handle);
}