[wholeBodyDynamicsTree] more debug in calibration