Fix bug in order of the initialization. Configuration set for the robot before putting the value to zero. Result in sporadic nan.
Fix bug in order of the initialization.
Configuration set for the robot before putting the value
to zero. Result in sporadic nan.

jrl-umi3218/jrl-dynamics,jrl-umi3218/jrl-dynamics