Fast algorithms to test robust static equilibrium for legged robots