i = 1;j = 1;M1=[G1{:,i}'+G1{:,i}-P1i{:,j}, zeros(3),G1{:,i}*Aa1{:,i}-F1{:,i}*C,G1{:,i}; zeros(3), eye(3), eye(3), zeros(3); Aa1{:,i}'*G1{:,i}'-C'*F1{:,i}', eye(3), P1i{:,i}, zeros(3); G1{:,i}', zeros(3), zeros(3),sig1*eye(3)];constraints11= [constraints11, M1>0]; globalConstraints=[globalConstraints, -P1i{:,i}<0];globalConstraints=[globalConstraints , sig1>=1];%%%%%%%%%%%%%%%%%%%%%%constraints1%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%constraints1=[constraints11,globalConstraints];optimize(constraints1)