Adapt to DART 3.0
Fix dynamics for soft body.
Fix dynamics for soft body.
Merge branch 'dart_3.0'