Position Based Rigid Body Equilibrium