void RigidBody::addForce(Vector2f _force, Vector2f point) { Vector2f dir = (point - position); forces += _force; aTorque += dir.length() * _force.scalarProjectAt(dir.rightNormal()); }