Fix bug in ConstraintDynamics::updateConstraintTerms()
- Add missing force, joint daming force, to calculate mTauHat