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); }