wholeBodyDynamicsTree running without crashes