The issue was in the handling of transformations ( sXp ) in the CRBA algorithm steps, while computing the Inertias and the F paramaters. More precisely, issue occured in a couple of methods used by specialization of class TransformT:
TransformT<FloatType, RotationMatrixAboutXTpl >
The issue was in the handling of transformations ( sXp ) in the CRBA algorithm steps, while computing the Inertias and the F paramaters. More precisely, issue occured in a couple of methods used by specialization of class TransformT: TransformT<FloatType, RotationMatrixAboutXTpl >