3d static rigid body equilibrium problem