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