Force calculation and equilibrium