Solve equilibrium problems (#641)

Solve equilibrium problems (#641)

Set vector sum of forces and moments to zero.