clear
clc
%% <Variable statememt>
x = sdpvar (3, 1);
y = sdpvar (2, 1);
z = sdpvar (2, 1);
%% <constraint statememt>
constraint = [ ];
constraint = [constraint, x(1,1)==12.66^2/sqrt(2)];
constraint = [constraint, x(2,1)>=0];
constraint = [constraint, x(3,1)>=0];
constraint = [constraint, y(1,1)>=0];
constraint = [constraint, y(2,1)>=0];
%------------------------------------The Rotated Quadratic Constraint---------
constraint = [ constraint, rcone( [y(1,1) ; z(1,1)], x(1,1), x(2,1) ) ];
constraint = [ constraint, rcone( [y(2,1) ; z(2,1)], x(2,1), x(3,1) ) ];
%%----------------------------------The Linear Constraint------------------
constraint = [constraint, sqrt(2)*10.2195*x(2,1)-10.2195*(y(1,1)+y(2,1))+5.2088*(-z(1,1)+z(2,1)) == -0.10];
constraint = [constraint, sqrt(2)*5.2088*x(2,1)-5.2088*(y(1,1)+y(2,1))-10.2195*(-z(1,1)+z(2,1)) == -0.06];
constraint = [constraint, sqrt(2)*1.6106*x(3,1)-1.6106*y(2,1)+0.8203*(-z(2,1)) == -0.09];
constraint = [constraint, sqrt(2)*0.8203*x(3,1)-0.8203*y(2,1)-1.6106*(-z(2,1)) == -0.04];
%%----------------------------------Objective------------------
Objective = y(1,1) +y(2,1) ;
%%----------------------------------Solve------------------------
constraint
ops = sdpsettings('solver','mosek','verbose',1,'debug',1);
sol = optimize(constraint,-Objective,ops);
if sol.problem == 0
% Extract and display value
solution_u = value(x)
solution_R = value(y)
solution_T = value(z)
else
display('Hmm, something went wrong!');
sol.info
yalmiperror(sol.problem)
end