modified Yalmip code