clc;clear all;close all;

m=1000;teta=pi/4;
r=0.95;k=500;n=4;
I=eye(n);
S=eye(n);
for i=1:m
x1(i)=1+rand*98; x2(i)=1+rand*98; x3(i)= 10+rand*(100); x4(i)= 200rand*(40);
end;
p= round(x1(1))*0.0625;
q= round(x2(1))*0.0625;
fminimum=(0.62248*p*x3(1)*x4(1)+1.7781*q*x3(1)^2+3.1661*p^2*x4(1)+19.84*p^2*x3
(1)+10^15*(max(-p+0.0193*x3(1),0))^2+10^15*(max(q(1)+0.00954*x3(1),0))^2+10^15*(max(-pi*x3(1)^2*x4(1)4/3*pi*x3(1)^3+1296000,0))^2+10^15*(max(x4(1)-240,0))^2);
xstar=[p;q;x3(1);x4(1)];
for i=1:n-1
for j=1:i
A(n-i,n-i)=cos(teta);
A(n-i,n+1-j)=-sin(teta);
A(n+1-j,n-i)=sin(teta);
A(n+1-j,n+1-j)=cos(teta);
A;
S=S*A;
A=eye(n);
end
end
S;
S=r*S;
for i=1:k
for i=1:m
p= round(x1(i))*0.0625;
q= round(x2(i))*0.0625;
fm=(0.6224*p*x3(i)*x4(i)+1.7781*q*x3(i)^2+3.1661*p^2*x4(i)
+19.84*p^2*x3(i)+10^15*(max(-p+0.0193*x3(i),0))^2+10^15*(max(q+0.00954*x3(i),0))^2+10^15*(max(-pi*x3(i)^2*x4(i)4/3*pi*x3(i)^3+1296000,0))^2+10^15*(max(x4(i)-240,0))^2);
if fm<fminimum
fminimum=fm;
xstar=[p;q;x3(i);x4(i)];
end;
end;
for i=1:m
p= round(x1(i))*0.0625;
q= round(x2(i))*0.0625;
x=[p;q;x3(i);x4(i)];
y=S*x-(S-I)*xstar;
p=y(1); q=y(2);x3(i)=y(3);x4(i)=y(4);
end;
end;

for i=1:m
fm=(0.62248*x1(i)*x3(i)*x4(i)+1.7781*x2(i)*x3(i)^2+3.1661*x1(i)^2*x4(i)
+19.84*x1(i)^2*x3(i)+10^15*(max(-p+0.0193*x3(i),0))^2+10^15*(max(-x2(i)
+0.00954*x3(i),0))^2+10^15*(max(-pi*x3(i)^2*x4(i)4/3*pi*x3(i)^3+1296000,0))^2+10^15*(max(x4(i)-240,0))^2);
if fm<fminimum
fminimum=fm;
xstar=[p;q;x3(i);x4(i)];
end;
end;
g1=-x1(i)+0.0193*x3(i);
g2=-x2(i)+0.00954*x3(i);
g3=-pi*x3(i)^2*x4(i)-4/3*pi*x3(i)^3+1296000;
g4=x4(i)-240;

xstar,fminimum,g1,g2,g3,g4