代码拉取完成,页面将自动刷新
同步操作将从 王浩赟/使用kinodynamic RRTStar算法规划轨迹 强制同步,此操作会覆盖自 Fork 仓库以来所做的任何修改,且无法恢复!!!
确定后同步将在后台操作,完成时将刷新页面,请耐心等待。
% RUNGEKUTTA4 4阶龙格库塔法
% 作 者:hyowinner(MATALB中文论坛用户)
% 创建日期:未 知
% 修 改 人:鲁 鹏,
% 修改日期:2018年7月11日
% 参考网站:http://www.ilovematlab.cn/thread-42808-1-1.html
% 版 本:2.1
% version 2.1 更新日志:添加输出变量的意义和输出形式
% version 2.0 更新日志:将输出结果y转置后输出,输出列向量(同ode45)
function [ x, y ] = rungeKutta4( ufunc, a, b, y0, h )
% 输出:
% x 时间,列向量
% y 求解的状态,每一列为一种状态随不同时间的值
% 参数表顺序依次是微分方程组的函数名称ufunc,时间起点a,
% 时间终点b,初始值向量y0,步长h(参数形式参考了ode45函数)
n = floor((b - a) / h);%求步数
x = ones(n,1);
x(1) = a;%时间起点
y(:,1) = y0;%赋初值,可以是向量,但是要注意维数
for ii = 1:n
x(ii + 1) = x(ii) + h;
k1 = ufunc(x(ii), y(:,ii));
k2 = ufunc(x(ii) + h / 2, y(:,ii) + h * k1 / 2);
k3 = ufunc(x(ii) + h / 2, y(:,ii) + h * k2 / 2);
k4 = ufunc(x(ii) + h, y(:,ii) + h * k3);
y(:,ii+1) = y(:,ii) + h * (k1 + 2 * k2 + 2 * k3 + k4) / 6;
end
y = y';
end
此处可能存在不合适展示的内容,页面不予展示。您可通过相关编辑功能自查并修改。
如您确认内容无涉及 不当用语 / 纯广告导流 / 暴力 / 低俗色情 / 侵权 / 盗版 / 虚假 / 无价值内容或违法国家有关法律法规的内容,可点击提交进行申诉,我们将尽快为您处理。