public void Integrate(double dt)
{
if (immovable || freezed)
{
return;
}
// Integrate velocity
forceAccum.Scale(invMass);
v.AddScaled(forceAccum, dt);
// some damping
v.Scale(Math.Pow(0.7, dt));
// Integrate position
pos.AddScaled(v, dt);
Update();
}
public void ApplyGravity()
{
forceAccum.AddScaled(curGravity, mass);
}
