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; }