作者zxcvb7700 (西北麻糬烧)
看板MATLAB
标题[运算] 优化函数
时间Fri Oct 5 14:57:05 2012
global K L thetamax alpha
K=1226
L=2600
thetamax=30 %输入外转向最大转角(单位度)
x0(1)=200 %输入初始点第一个分量(臂长mm)
x0(2)=70 %输入初始点第二个分量(底角、度)
thetamax=thetamax*pi/180 %转换为弧度单位
x0(2)=x0(2)*pi/180;
lb(1)=0.1*K;
lb(2)=acot(K/(1.2*L));
ub(1)=0.17*K;
ub(2)=pi/2;
alpha=linspace(0,thetamax,61)+pi/180;%将转角划分为60等分区隔
options=optimset('TolFun',1e-10,'TolCon',1e-6);
[y,resnorm]=lsqnonlin('fun',x0,lb,ub,options); %调用lsqnonlin函数求解
for i=1:61
betae(i)=acot(cot(alpha(i))-K/L); %计算转角期望值
A(i)=2*x0(1).^2*sin(x0(2)+ alpha(i)); %计算实际转角
B(i)=2*K*x0(1)-2*x0(1).^2*cos(x0(2)+alpha(i));
C(i)=2*x0(1).^2-4*x0(1).^2*(cos(x0(2))).^2+4*K*x0(1)*cos(x0(2))-2*K*x0(1)*cos(x0(2)+alpha(i));
theta3(i)=2*acot((A(i)+sqrt(A(i).^2+B(i).^2-C(i).^2))/(B(i)+C(i)));
beta(i)=x0(2)+theta3(i)-pi;
end
plot(alpha,betae,'r');hold on %绘制转角期望值曲线
plot(alpha,beta,'b') %在同张图上画实际转角曲线
hold off
副程式
function f=fun(x)
global K L thetamax alpha
f=0; %函数值初始化
for i=1:61
betae(i)=acot(cot(alpha(i))-K/L); %计算转角期望值
A(i)=2*x(1).^2*sin(x(2)+ alpha(i)); %计算实际转角
B(i)=2*K*x(1)-2*x(1).^2*cos(x(2)+alpha(i));
C(i)=2*x(1).^2-4*x(1).^2*(cos(x(2))).^2+4*K*x(1)*cos(x(2))-2*K*x(1)*cos(x(2)+alpha(i));
theta3(i)=2*acot((A(i)+sqrt(A(i).^2+B(i).^2-C(i).^2))/(B(i)+C(i)));
beta(i)=x(2)+theta3(i)-pi;
if alpha(i)<=pi/18 %计算目标函数值
f(i)=1.5*abs(beta(i)-betae(i));
elseif alpha(i)<=pi/9
f(i)=abs(beta(i)-betae(i));
else
f(i)=0.5*abs(beta(i)-betae(i));
end
end
下面是我的边界
0.1K<x1<0.17k
cot^-1(K/1.2L)<=x2<=90度
我的疑问是因为我要优化的是x1的臂长的长度，
但是跑出来的结果臂长都没有改变，想请问一下是哪边出了问题呢?
--
※ 发信站: 批踢踢实业坊(ptt.cc)
◆ From: 140.127.33.235