前言
使用GPOPSII求解无人驾驶中的过弯最优路径规划问题_gpops 工具箱-CSDN博客
在这篇文章中,介绍了通过GPOPSII进行过弯轨迹规划,在使用中,可能会遇到求解控制量振荡剧烈的情况,本文内容将对问题提供一个解决办法,通过对控制量变化的约束,可以优化求解得到更平滑的控制量曲线,更符合真实控制约束
一、对控制量变化率约束
在前文中,状态量为车辆的侧滑角、纵向速度、航向角速度等,控制量为前轮转向角和后轮驱动力,但求解时会出现转向角或者驱动力剧烈振荡的情况,因此要对控制量进行限幅。
所以,一个办法是将转向角和驱动力也作为状态量,将转向角和驱动力的一阶导作为控制量,从而在控制量约束里对转向角和驱动力的变化率进行约束。
部分代码如下:
设置约束:
% 设置控制量 [u1 u2]=[delta fRx]
u1Min=-pi/6;
u1Max=pi/6;
u2Min=-1.02;%kN
u2Max=1.02;
% 设置控制量变化率 [d_u1 d_u2]=[d_delta d_fRx]
d_u1Min=-pi;
6441




被折叠的 条评论
为什么被折叠?



