public static bool Animate(
Point3D currentValue, Vector3D currentVelocity, Point3D targetValue,
double attractionFator, double dampening,
double terminalVelocity, double minValueDelta, double minVelocityDelta,
out Point3D newValue, out Vector3D newVelocity)
{
Debug.Assert(currentValue.IsRational());
Debug.Assert(currentVelocity.IsRational());
Debug.Assert(targetValue.IsRational());
Debug.Assert(dampening.IsRational());
Debug.Assert(dampening > 0 && dampening < 1);
Debug.Assert(attractionFator.IsRational());
Debug.Assert(attractionFator > 0);
Debug.Assert(terminalVelocity > 0);
Debug.Assert(minValueDelta > 0);
Debug.Assert(minVelocityDelta > 0);
Vector3D diff = targetValue - currentValue;
if (diff.Length > minValueDelta || currentVelocity.Length > minVelocityDelta)
{
newVelocity = currentVelocity * (1 - dampening);
newVelocity += diff * attractionFator;
newVelocity *= (currentVelocity.Length > terminalVelocity) ? terminalVelocity / currentVelocity.Length : 1;
newValue = currentValue + newVelocity;
return true;
}
else
{
newValue = targetValue;
newVelocity = new Vector3D();
return false;
}
}