Bugfix in MlcpPhysicsProblem, add (not assign) to sparse H matrix.
Bugfix in MlcpPhysicsProblem, add (not assign) to sparse H matrix.

simquest/opensurgsim,simquest/opensurgsim,simquest/opensurgsim,simquest/opensurgsim