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.IsValid());
Debug.Assert(currentVelocity.IsValid());
Debug.Assert(targetValue.IsValid());
Debug.Assert(dampening.IsValid());
Debug.Assert(dampening > 0 && dampening < 1);
Debug.Assert(attractionFator.IsValid());
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;
}
}
/// <summary>
/// Rotates the camera about the specified axis and center point by the specified angle in degrees.
/// </summary>
public void Rotate(Vector3D axis, double angle, Point3D center)
{
if (!center.IsValid())
center = Math3D.Origin;
Position = Position.Subtract(center);
Rotate(axis, angle);
Position = Position.Add(center);
}