/// <summary>
/// Initializes a new instance of the <see cref="CapsuleColliderShape"/> class.
/// </summary>
/// <param name="is2D">if set to <c>true</c> [is2 d].</param>
/// <param name="radius">The radius.</param>
/// <param name="length">The length of the capsule.</param>
/// <param name="orientation">Up axis.</param>
public CapsuleColliderShape(bool is2D, float radius, float length, ShapeOrientation orientation)
{
Type = ColliderShapeTypes.Capsule;
Is2D = is2D;
capsuleLength = length;
capsuleRadius = radius;
Matrix rotation;
CapsuleShape shape;
switch (orientation)
{
case ShapeOrientation.UpX:
shape = new CapsuleShapeZ(radius, length);
rotation = Matrix.RotationX((float)Math.PI / 2.0f);
break;
case ShapeOrientation.UpY:
shape = new CapsuleShape(radius, length);
rotation = Matrix.Identity;
break;
case ShapeOrientation.UpZ:
shape = new CapsuleShapeX(radius, length);
rotation = Matrix.RotationZ((float)Math.PI / 2.0f);
break;
default:
throw new ArgumentOutOfRangeException("orientation");
}
InternalShape = Is2D ? (CollisionShape)new Convex2DShape(shape) { LocalScaling = new Vector3(1, 1, 0) }: shape;
DebugPrimitiveMatrix = Matrix.Scaling(new Vector3(1.01f)) * rotation;
}
public override CollisionShape GetCollisionShape()
{
if (collisionShapePtr == null) {
CapsuleShape cs = null;
if (upAxis == CapsuleAxis.x)
{
cs = new CapsuleShapeX(radius, height);
} else if (upAxis == CapsuleAxis.y)
{
cs = new CapsuleShape(radius, height);
} else if (upAxis == CapsuleAxis.z)
{
cs = new CapsuleShapeZ(radius, height);
} else
{
Debug.LogError("invalid axis value");
}
cs.LocalScaling = m_localScaling.ToBullet();
collisionShapePtr = cs;
}
return collisionShapePtr;
}
public CollisionShape CreateCapsuleShapeZ(float radius, float height)
{
CapsuleShapeZ shape = new CapsuleShapeZ(radius, height);
_allocatedCollisionShapes.Add(shape);
return shape;
}