Equilibrium of rigid bodies (#142)

Equilibrium of rigid bodies (#142)