Пример #1
0
        public int CalculatePositionKinematics(bool fixedBase, float[] q)
        {
            int baseDofs;

            if (fixedBase)
            {
                baseDofs = 0;
            }
            else
            {
                baseDofs = 6;
            }

            int numDof = q.Length - baseDofs;

            return(UnsafeNativeMethodsInverseDynamics.MultiBodyTree_calculatePositionKinematics(Native, numDof, baseDofs, q));
        }