Add contactLambdaPosition that compute contact position in lambda vector.
Add some helper function in UnilateralContact and BilateralContact to compute the total force on a contact.