Bugfixes, Unit Tests
#FIX: Fixed issue #124
#FIX: Fixed broken unit test related to the new RigidBody joint behavior
#ADD: Added unit test for the bug from issue #124