基本信息
源码名称：自动驾驶离散优化路径规划算法
源码大小：5.95KB
文件格式：.m
开发语言：MATLAB
更新时间：2021-11-22
友情提示：（无需注册或充值，赞助后即可获取资源下载链接）
嘿，亲！知识可是无价之宝呢，但咱这精心整理的资料也耗费了不少心血呀。小小地破费一下，绝对物超所值哦！如有下载和支付问题，请联系我们QQ(微信同号)：813200300
本次赞助数额为： 2 元×
微信扫码支付：2 元
×
请留下您的邮箱，我们将在2小时内将文件发到您的邮箱
源码介绍
自动驾驶离散优化路径规划算法程序
d_end=linspace(y_lim_min(1),y_lim_max(1),31);
sita_end=0;
s=linspace(s_start,s_end,100);
% 求解样条曲线候选路径参数
for i=1:length(d_end)
syms a b c d
epns=[
a*(s_end-s_start)^3 b*(s_end-s_start)^2 c*(s_end-s_start) d==d_end(i)
3*a*(s_end-s_start)^2 2*b*(s_end-s_start) c==sita_end
d==d_start
c==sita_start
];
S=solve(epns,[a b c d]);
aa=double(S.a);
bb=double(S.b);
cc=double(S.c);
dd=double(S.d);
% 生成候选路径
ds(i,:)=aa*(s-s_start).^3 bb*(s-s_start).^2 cc*(s-s_start) dd;
end
自动驾驶离散优化路径规划算法程序
% 更新状态
s_end=s_start 20;d_end=linspace(y_lim_min(1),y_lim_max(1),31);
sita_end=0;
s=linspace(s_start,s_end,100);
% 求解样条曲线候选路径参数
for i=1:length(d_end)
syms a b c d
epns=[
a*(s_end-s_start)^3 b*(s_end-s_start)^2 c*(s_end-s_start) d==d_end(i)
3*a*(s_end-s_start)^2 2*b*(s_end-s_start) c==sita_end
d==d_start
c==sita_start
];
S=solve(epns,[a b c d]);
aa=double(S.a);
bb=double(S.b);
cc=double(S.c);
dd=double(S.d);
% 生成候选路径
ds(i,:)=aa*(s-s_start).^3 bb*(s-s_start).^2 cc*(s-s_start) dd;
end