Added constraints on CoM/feet to formulation 18.