//Helper Functions for Resting Contact
void ComputeAMatrix(ref NMatrix aMatrix)
{
for (int i = 0; i < restingContact.Count; i++)
{
for (int j = 0; j < restingContact.Count; j++)
{
aMatrix.SetPosition(i, j, ComputeAij(i, j));
}
}
}