24小时热门版块排行榜    

Znn3bq.jpeg
查看: 953  |  回复: 0

jjliu2012

新虫 (小有名气)

[求助] 【求助 一个关于最优控制的matlab问题(新手,请大家多多帮助)

Sample Text
最速下降法求最优控制u的matlab算法,各位大侠能否把这个主循环补充一下,不知道怎么回事,运行不了 。是附件里文献的例子2,在第7页,多谢
%%%%%%%%%%%%%%%%%%%%%%
for i = 1:max_iteration
% 1) start with assumed control u and move forward
[Tx,X] = ode45(@(t,x) stateEq(t,x,u,Tu), [t0 tf], ...
initx, options);
% 2) Move backward to get the trajectory of costates
x1 = X(:,1); x2 = X(:,2);
[Tp,P] = ode45(@(t,p) costateEq(t,p,u,Tu,x1,x2,Tx), ...
[tf t0], initp, options);
p1 = P(:,1);
% Important: costate is stored in reverse order. The dimension of
% costates may also different from dimension of states
% Use interploate to make sure x and p is aligned along the time axis
p1 = interp1(Tp,p1,Tx);
% Calculate deltaH with x1(t), x2(t), p1(t), p2(t)
dH = pH(x1,p1,Tx,u,Tu);
H_Norm = dH'*dH;

% Calculate the cost function
J(i,1) = tf*(((x1')*x1 + (x2')*x2)/length(Tx) + ...
0.1*(u*u')/length(Tu));
% if dH/du < epslon, exit
if H_Norm < eps
% Display final cost
J(i,1)
break;
else
% adjust control for next iteration
u_old = u;
u = AdjControl(dH,Tx,u_old,Tu,step);
end;
end
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% State equations
function dx = stateEq(t,x,u,Tu)
dx = zeros(2,1);
u = interp1(Tu,u,t); % Interploate the control at time t
dx(1) = -2*(x(1) + 0.25) + (x(2) + 0.5)*exp(25*x(1)/(x(1)+2)) ...
- (x(1) + 0.25).*u;
dx(2) = 0.5 - x(2) -(x(2) + 0.5)*exp(25*x(1)/(x(1)+2));
%%%%%%%%%%%%%%%%%%%%%%%
% Costate equations
function dp = costateEq(t,p,u,Tu,x1,x2,xt)
dp = zeros(2,1);
x1 = interp1(xt,x1,t); % Interploate the state varialbes
x2 = interp1(xt,x2,t);
u = interp1(Tu,u,t); % Interploate the control
dp(1) = p(1).*(u + exp((25*x1)/(x1 + 2)).*((25*x1)/(x1 + 2)^2 - ...
25/(x1 + 2))*(x2 + 1/2) + 2) - ...
2*x1 - p(2).*exp((25*x1)/(x1 + 2))*((25*x1)/(x1 + 2)^2 - ...
25/(x1 + 2))*(x2 + 1/2);
dp(2) = p(2).*(exp((25*x1)/(x1 + 2)) + 1) - ...
p(1).*exp((25*x1)/(x1 + 2)) - 2*x2;
%%%%%%%%%%%%%%%%%%%%%%%%%%%
% Partial derivative of H with respect to u
function dH = pH(x1,p1,tx,u,Tu)
% interploate the control
u = interp1(Tu,u,tx);
R = 0.1;
dH = 2*R*u - p1.*(x1 + 0.25);
%%%%%%%%%%%%%%%%%%%%%%%%%
% Adjust the control
function u_new = AdjControl(pH,tx,u,tu,step)
% interploate dH/du
pH = interp1(tx,pH,tu);
u_new = u - step*pH;
%%%%%%%%%%%%%%%%
回复此楼

» 本帖附件资源列表

  • 欢迎监督和反馈:小木虫仅提供交流平台,不对该内容负责。
    本内容由用户自主发布,如果其内容涉及到知识产权问题,其责任在于用户本人,如对版权有异议,请联系邮箱:xiaomuchong@tal.com
  • 附件 1 : SolvingoptimalcontrolproblemswithMATLAB.pdf
  • 2013-09-01 16:16:28, 1.95 M

» 猜你喜欢

已阅   回复此楼   关注TA 给TA发消息 送TA红花 TA的回帖

智能机器人

Robot (super robot)

我们都爱小木虫

找到一些相关的精华帖子,希望有用哦~

科研从小木虫开始,人人为我,我为人人
相关版块跳转 我要订阅楼主 jjliu2012 的主题更新
最具人气热帖推荐 [查看全部] 作者 回/看 最后发表
[基金申请] 青C资助名额大幅增加! +9 西葫芦炒鸡蛋 2026-05-13 13/650 2026-05-15 00:18 by jackeychen7922
[文学芳草园] 风把牡丹吹跑了 +4 myrtle 2026-05-12 7/350 2026-05-14 23:58 by myrtle
[教师之家] 教学课件你会给同学吗 +8 硕士研究生吗 2026-05-13 8/400 2026-05-14 22:23 by 常规沥青
[考博] 26应届毕业生考博求助 +3 wo一定上岸 2026-05-13 3/150 2026-05-14 21:47 by 明海天涯
[基金申请] 重磅!青年科学基金项目(C类)资助增幅预计超过50% +5 水和泥不是水泥 2026-05-13 7/350 2026-05-14 20:57 by 水和泥不是水泥
[有机交流] 求助2,4-二氯-5-嘧啶甲醛的合成方法 20+3 光吃不拉 2026-05-14 5/250 2026-05-14 20:15 by 一切都是空工
[高分子] 本人最近太闲了,谁有问题可以提,每天会统一回复 +8 一切都是空工 2026-05-12 19/950 2026-05-14 20:03 by 一切都是空工
[考博] 申博自荐 +4 食品的橙子 2026-05-09 6/300 2026-05-14 16:05 by great1919
[基金申请] 这年头没有找到涵评专家,还有中面上的可能吗 +7 dd921ww 2026-05-12 8/400 2026-05-14 14:22 by dd921ww
[考博] 材料类只有一篇综述能申博么 +4 乐逍遥谷 2026-05-13 4/200 2026-05-14 12:05 by zhyzzh
[基金申请] 请问大佬b0816评完了吗 +3 市民华南虎 2026-05-12 7/350 2026-05-14 07:41 by 市民华南虎
[基金申请] 精华III评审感受-评审感受-评审感受 +12 ferrarichen 2026-05-11 16/800 2026-05-14 07:33 by 2000zf36392
[论文投稿] 有带发论文的吗 +3 山楂之术 2026-05-09 3/150 2026-05-13 17:56 by Cyhcl2629
[硕博家园] 导师各种操作恶心咋办 +11 苍白的小青天 2026-05-09 13/650 2026-05-13 17:11 by 六两废铜
[论文投稿] 护理论文 晋升 +5 Taylor1990, 2026-05-08 5/250 2026-05-13 14:40 by tegsgjy20
[论文投稿] 求助大佬sci投稿哪个好中 +3 江沅188 2026-05-12 4/200 2026-05-13 14:35 by 江沅188
[考博] 西南大学考核制博士 +3 lijunjie84 2026-05-11 6/300 2026-05-12 18:09 by lijunjie84
[文学芳草园] 窗边初夏的小雨 +7 阿美_Lml888 2026-05-09 10/500 2026-05-12 15:27 by 阿美_Lml888
[考博] 现在不知道怎么办,感觉很痛苦 +4 qweww 2026-05-11 5/250 2026-05-11 20:23 by Oversize
[考博] 生物学博士 +3 17749024330 2026-05-08 6/300 2026-05-11 14:29 by 17749024330
信息提示
请填处理意见