缓慢或急促时的诊断 SMC_TRAFO_INVALID

它取决于运动学的参数化。在这种情况下，错误 SMC_TRAFO_INVALID