private static Vector EdgeTorque(FDLEdge edge)
{
double force = 10.0 * edge.AngleDelta / K;
double angle = edge.Angle + Math.PI / 2.0;
return Vector.FromPolar(force, angle);
}
private static Vector EdgeForce(FDLEdge edge)
{
double force = 5.0 * edge.LengthDelta / K;
double angle = edge.Angle;
return Vector.FromPolar(force, angle);
}