public float CalculatePositionCost(BoneData bone)
        {
            float cost = math.lengthsq(bone.localPosition - localPosition);

            return(cost);
        }
        public float CalculateVelocityCost(BoneData bone)
        {
            float cost = math.lengthsq(bone.velocity - velocity);

            return(cost);
        }
 public void Set(BoneData bone)
 {
     this.localPosition = bone.localPosition;
     this.velocity      = bone.velocity;
 }