Fix friction cône generation.
Add TwoArmDDynamicContactTest.