/// <summary>
/// Returns a shape handle into the pool.
/// </summary>
public void ReturnShape(INTERACTION_SHAPE_DESCRIPTION_HANDLE handle) {
ShapeInfo info;
if (!_allHandles.TryGetValue(handle, out info)) {
throw new InvalidOperationException("Tried to return a handle that was not allocated.");
}
if (!info.isCached) {
_allHandles.Remove(handle);
InteractionC.RemoveShapeDescription(ref _scene, ref handle);
}
}
protected virtual void createInteractionShape(IInteractionBehaviour interactionBehaviour)
{
INTERACTION_SHAPE_DESCRIPTION_HANDLE descriptionHandle = interactionBehaviour.ShapeDescriptionHandle;
INTERACTION_SHAPE_INSTANCE_HANDLE instanceHandle = new INTERACTION_SHAPE_INSTANCE_HANDLE();
INTERACTION_CREATE_SHAPE_INFO createInfo;
INTERACTION_TRANSFORM createTransform;
interactionBehaviour.GetInteractionShapeCreationInfo(out createInfo, out createTransform);
InteractionC.CreateShapeInstance(ref _scene, ref descriptionHandle, ref createTransform, ref createInfo, out instanceHandle);
_instanceHandleToBehaviour[instanceHandle] = interactionBehaviour;
interactionBehaviour.NotifyInteractionShapeCreated(instanceHandle);
}
public override sealed void NotifyUnregistered()
{
_isRegisteredWithManager = false;
if (isActiveAndEnabled)
{
enabled = false;
}
if (_hasShapeDescriptionBeenCreated)
{
_manager.ShapePool.ReturnShape(_shapeDescriptionHandle);
_shapeDescriptionHandle = new INTERACTION_SHAPE_DESCRIPTION_HANDLE();
_hasShapeDescriptionBeenCreated = false;
}
_baseCallGuard.Begin("OnUnregistered");
OnUnregistered();
_baseCallGuard.AssertBaseCalled();
}
private bool getCollisionSingleInternal(GameObject parentObject, ref INTERACTION_SHAPE_DESCRIPTION_HANDLE shape) {
Collider collider = _tempColliderList[0];
if (collider.gameObject != parentObject) {
return false; // Potential for optimization. See GetCollision().
}
Vector3 scale3 = parentObject.transform.lossyScale;
if (collider is SphereCollider) {
SphereCollider sphereCollider = collider as SphereCollider;
if (sphereCollider.center != Vector3.zero) {
return false;
}
float aproximateScale = Mathf.Max(scale3.x, Mathf.Max(scale3.y, scale3.z));
shape = GetSphere(sphereCollider.radius * aproximateScale);
return true;
} else if (collider is BoxCollider) {
BoxCollider boxCollider = collider as BoxCollider;
if (boxCollider.center != Vector3.zero) {
return false;
}
Vector3 extents = boxCollider.size * 0.5f;
extents.Scale(scale3);
shape = GetOBB(extents);
return true;
} else if (collider is MeshCollider) {
MeshCollider meshCollider = collider as MeshCollider;
// Create a new mesh scaled as needed. Scale is not dynamic and must be baked in.
shape = GetConvexPolyhedron(meshCollider, Matrix4x4.TRS(Vector3.zero, Quaternion.identity, scale3));
return true;
}
return false; // Compound
}
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;
}
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);
}
