Revert "Disable joint/cart stiffness/damping setting when in CMD mode"

This reverts commit 14ce05e156c4ff27a0b95744a487f3863584c6f6.