protected internal override void GetContactInformation(int index, out ContactInformation info)
{
info.Contact = ContactManifold.contacts.Elements[index];
//Find the contact's force.
info.FrictionImpulse = 0;
info.NormalImpulse = 0;
for (int i = 0; i < contactConstraint.frictionConstraints.Count; i++)
{
if (contactConstraint.frictionConstraints.Elements[i].PenetrationConstraint.contact == info.Contact)
{
info.FrictionImpulse = contactConstraint.frictionConstraints.Elements[i].accumulatedImpulse;
info.NormalImpulse = contactConstraint.frictionConstraints.Elements[i].PenetrationConstraint.accumulatedImpulse;
break;
}
}
//Compute relative velocity
Vector3 velocity;
if (EntityA != null)
{
Vector3.Subtract(ref info.Contact.Position, ref EntityA.position, out velocity);
Vector3.Cross(ref EntityA.angularVelocity, ref velocity, out velocity);
Vector3.Add(ref velocity, ref EntityA.linearVelocity, out info.RelativeVelocity);
}
else
info.RelativeVelocity = new Vector3();
if (EntityB != null)
{
Vector3.Subtract(ref info.Contact.Position, ref EntityB.position, out velocity);
Vector3.Cross(ref EntityB.angularVelocity, ref velocity, out velocity);
Vector3.Add(ref velocity, ref EntityB.linearVelocity, out velocity);
Vector3.Subtract(ref info.RelativeVelocity, ref velocity, out info.RelativeVelocity);
}
info.Pair = this;
}
}