function fcost=cuptpc(x)
L = 22.5e-6;
A1 = 40;
A2 = 40;
A3 = 40;
n=1;
f=20e3;
M = 1.0; / ????
A = 1.0;
k11 = (16*A1*A1)/(n^3*(pi)^2*(2*pi*f)*M)
k22 = (16*A2*A2)/(n^3*(pi)^2*(2*pi*f)*M)
k33 = (16*A3*A3)/(n^3*(pi)^2*(2*pi*f)*M)
k12 = (8*A1*A2)/(n^3*(pi)^2*(2*pi*f)*M)
k13 = (8*A1*A3)/(n^3*(pi)^2*(2*pi*f)*M)
k23 = (8*A2*A3)/(n^3*(pi)^2*(2*pi*f)*A)
P1a = 400; P2a = -200;P3a = -200;Q1a = 193;Q2a = 96.86;Q3a = -96.86;
P1d = (k12.*cos(x(1)*pi/360).*cos(x(2)*pi/360).*sin(x(4)*pi/180))+(k13.*cos(x(1)*pi/360).*cos(x(3)*pi/360).*sin(x(5)*pi/180))
P2d = -(k12.*cos(x(1)*pi/360).*cos(x(2)*pi/360).*sin(x(4)*pi/180))+(k23.*cos(x(2)*pi/360).*cos(x(3)*pi/360).*sin((x(5)-x(4))*pi/180))
P3d = -(k13.*cos(x(1)*pi/360).*cos(x(3)*pi/360).*sin(x(5)*pi/180))+(k23.*cos(x(2)*pi/360).*cos(x(3)*pi/360).*sin((x(4)-x(5))*pi/180))
Q1d = (k11.*cos(x(1)*pi/360).*cos(x(1)*pi/360))-(k12.*cos(x(1)*pi/360).*cos(x(2)*pi/360).*cos(x(4)*pi/180))-(k13.*cos(x(1)*pi/360).*cos(x(3)*pi/360).*cos(x(5)*pi/180))
Q2d = -(k12.*cos(x(1)*pi/360).*cos(x(2)*pi/360).*cos(x(4)*pi/180))+(k22.*cos(x(2)*pi/360).*cos(x(2)*pi/360))-(k23.*cos(x(2)*pi/360).*cos(x(3)*pi/360).*cos((x(5)-x(4))*pi/180))
Q3d = -(k13.*cos(x(1)*pi/360).*cos(x(3)*pi/360).*cos(x(5)*pi/180))-(k23.*cos(x(2)*pi/360).*cos(x(3)*pi/360).*cos((x(5)-x(4))*pi/180))+(k33.*cos(x(3)*pi/360).*cos(x(3)*pi/360))
delP1 = (P1d - P1a);
delP2 = (P2d - P2a);
delP3 = (P3d - P3a);
delQ1 = (Q1d - Q1a);
delQ2 = (Q2d - Q2a);
delQ3 = (Q3d - Q3a);
fcost = [delP1 delP2 delP3 delQ1 delQ2 delQ3];
end
and the main program is
lb = [90 90 90 90 90];
ub = [180 180 180 180 180];
x0 = [30 40 35 50 50];
x=lsqnonlin(@cuptpc,x0,lb,ub)
Best Answer