基于模型预测控制的无人驾驶主动避障策略.pdf
《基于模型预测控制的无人驾驶主动避障策略.pdf》由会员分享,可在线阅读,更多相关《基于模型预测控制的无人驾驶主动避障策略.pdf(6页珍藏版)》请在咨信网上搜索。
1、第 61 卷 第 8 期Vol.61 No.82023 年 8 月August 2023农业装备与车辆工程AGRICULTURAL EQUIPMENT&VEHICLE ENGINEERING0 引言无人驾驶是汽车技术发展的重要趋势之一,可以降低交通事故的发生率,减少拥堵现象,同时能提高资源的利用率。其中主动避障技术作为无人驾驶的关键受到广泛的研究。主动避障技术主要涵盖了局部路径规划和轨迹跟踪。局部路径规划主要的控制目标是在已知环境模型中,从当前位置到目标点间寻找一条可行的无碰撞路径1。目前常用的算法有人工势场法、基于搜索的轨迹优化算法和图窗搜索法等2。人工势场法是一种虚拟力法,由 Khatib
2、3最早提出并应用于路径规划,规划出的路径相对平滑,算法简单可靠,实时性较好。但传统人工势场法也存在容易陷入局部最优和目标不可达的问题。安林芳等4通过在斥力场中加入虚拟目标点,避免了目标点不可达问题的发生。修彩靖等5改变了传统的引力场目标函数构建方式,建立高斯组合隶属函数,并在其中加入了调节因子,消除了传统人工势场法容易出现局部最优的问题。在轨迹跟踪控制方面,Tagne 等6采用滑模控制算法,以实际轨迹与参考轨迹的侧向偏差为基础设计滑动面,实现对目标轨迹的跟踪。虽然该方法鲁棒性较好,但会引起严重的系统抖振,系统稳定性较差。Fan 等7利用LQR控制算法对线性化后的车辆系统进行闭环控制,最终设计的
3、控制系统具有稳定性高和实时性好的优点,但跟踪过程中出现了较大的偏差且 LQR 算法无法对状态量和控制量加以限制处理约束问题。基于模型预测控制(MPC)设计了分层式主动doi:10.3969/j.issn.1673-3142.2023.08.018基于模型预测控制的无人驾驶主动避障策略崔玉定,熊豪杰,贺满川,薛仁强(430065湖北省武汉市武汉科技大学汽车与交通工程学院)摘要 为实现无人驾驶车辆的主动避障,提出了分层结构的模型预测控制器。在上层局部路径规划层中考虑车辆附着条件约束,引入避障惩罚函数,规划最优局部期望路径。在下层轨迹跟踪层中,搭建整车模型并利用状态轨迹线性化得到线性时变模型,以二次
4、规划形式建立优化问题的逼近求解。其次为确保车辆跟踪过程中的稳定,将车辆安全行驶包络线约束结合到下层控制器内。通过 MATLAB/Simullink 和 CarSim 联合仿真证明了提出的主动避障策略可以有效避开障碍物,同时保证了车辆行驶的安全稳定性。关键词 无人驾驶车辆;主动避障;模型预测控制;局部路径规划;轨迹跟踪;安全稳定性 中图分类号 TP273;U463.6 文献标志码 A 文章编号 1673-3142(2023)08-0088-06引用格式:崔玉定,熊豪杰,贺满川,等.基于模型预测控制的无人驾驶主动避障策略 J.农业装备与车辆工程,2023,61(8):88-93.Autonomou
5、s active obstacle avoidance strategy based on model predictive controlCUIYuding,XIONGHaojie,HEManchuan,XUERenqiang(SchoolofAutomotiveandTrafficEngineering,WuhanUniversityofScienceandTechnology,Wuhan430065,Hubei,China)AbstractTorealizetheactiveobstacleavoidanceofdriverlessvehicles,amodelpredictivecon
6、trollerwithahierarchicalstructurewasproposed.Intheupperlocalpathplanninglayer,thevehicleattachmentconstraintwasconsidered,andtheimprovedobstacleavoidancepenaltyfunctionwasintroducedtoplanalocaldesiredpaththatmetthekinematicconstraintsandwascollision-free.Inthelowertrajectorytrackinglayer,thelinearti
7、me-varyingvehiclemodelwasobtainedbythelinearizingthestatetrajectory,andtheapproximatesolutionoftheoptimizationproblemwasestablishedintheformofquadraticprogramming.Secondly,toensurethestabilityofthevehicleduringobstacleavoidanceandtracking,thevehiclesafetydrivingenvelopeconstraintwascombinedwithinthe
8、lowerlevelcontroller.ThejointsimulationbyMATLAB/SimullinkandCarSimprovedthattheproposedactiveobstacleavoidancestrategycaneffectivelyavoidobstacles,whileensuringthesafetyandstabilityofthevehicledriving.Key wordsdriverlessvehicles;activeobstacleavoidance;modelpredictivecontrol;localpathplanning;trajec
9、torytracking;safetyandstability收稿日期:2022-06-0889第 61 卷第 8 期转向避障控制器。在上层避障轨迹规划层,接收传感器传入的障碍物信息和全局期望路径信息,为避开障碍物引入了避障惩罚函数并在目标函数中考虑了车辆运动学约束,规划出一条无碰撞的局部路径。下层轨迹跟踪控制层接收上层规划器传来的局部参考轨迹信息,将车辆安全行驶包络线约束与模型预测控制算法相结合,求解出前轮转向角的最优解8。1 局部路径规划控制器1.1 车辆点质量模型 为减小计算量、提高计算速度同时兼顾控制性能,选用车辆点质量模型,该模型将车辆看作一个质量点,忽略车身尺寸、轮胎受力和载荷变化
10、9,如图 1 所示。图 1 中:O车辆质心;x 车辆纵向位移;x车辆纵向速度;y 车辆侧向位移;y 车辆侧向速度;车辆横摆角。在大地参考坐标系下,车辆点质量模型表示为sinsincossinxayaxaYxyXxyxyy=+=-ppooooooo(1)1.2 规划层预测模型路径重规划层的实时性要求较低,且采用的点质量模型也有一定程度的简化。采用非线性模型预测控制算法(NMPC)在满足轨迹重规划的要求外具有更高的求解精度,对于后续的二次规划求解函数的设计也带来了便利。采用欧拉法对点质量模型进行离散化,得到车辆点质量模型的差分方程()cossinsincosx kx kTay ky kTakkTx
11、aX kX kT x kky kkY kY kT x kky kk11111xyy+=+=+=+=+-+=+ooooooooo_iihhiihhhhhhhiihhhhii88BB(2)式中:k 当前采样时刻;T离散时间;y(k),x(k)车辆在 k 时刻横、纵向位移;y(k),x(k)车辆在 k 时刻的横、纵向速度;(k)车辆在 k 时刻的横摆角。为简化计算,假设车辆纵向速度为一恒定常数,即纵向加速度 ax=0,以汽车横向加速度为控制变量即 u=ay,以=x;y;X;Y 为状态变量,将式(2)整理为,ki tfk t u j1pp+=ihhh(3)式中:i=1,2,Np,j=1,2,Nc;f(
12、)点质量模型的差分方程函数表达式;Np预测时域;Nc控制时域;t 采样时间。根据式(3)可得 NMPC 控制时域内的预测表达式为,ktktktkN tkN tfk t ufk t uufk t uuufk t uuuu Nfk t uuuu N12311212312311231cpNccNp123Phhhghgpppppppppp+=-_aa_jjjjjiihhiihhihhhhhhjhjhjjjkkRTSSSSSSSSSSSSSSSSSSSSSSSSSRTSSSSSSSSSSSSSSSSSSSSSSSSSSVXWWWWWWWWWWWWWWWWWWWWWWWWWVXWWWWWWWWWWWWWW
13、WWWWWWWWWWWW(4)定义车辆航向角和大地坐标系下车辆横向位移为系统输出量:;Yh=6,则0 0 1 0 00 0 0 0 1#hp=G。令 C0 0 1 0 00 0 0 0 1=G,由式(4)可以得出在预测时域内系统预测方程为,ktktktkN tkN tCfk t uCfk t uuCfk t uuuCfk t uuuu NCfk t uuuu N12311212312311231cPNccNpp123#hhhghghhhhhppppp+=-_iiiiihhgghhgghgggggghghghhhiiRTSSSSSSSSSSSSSSSSSSSSSSS SRTSSSSSSSSSSS
14、SSSSSSSSSSSSVXWWWWWWWWWWWWWWWWWWWWWWW WVXWWWWWWWWWWWWWWWWWWWWWWW(5)1.3 优化问题构建与求解1.3.1 避障惩罚函数设计为躲避行驶路径上的障碍物,需要在上层控制器的目标函数中加入避障惩罚函数。龚建伟等10提出根据障碍物点与目标点之间的距离偏差和车辆行驶速度设置障碍物惩罚系数,当车辆与障碍物越近、车速越高,惩罚值越大。具体惩罚功能函数为图 1 车辆点质量模型Fig.1 Point mass model of autonomous vehicle崔玉定等:基于模型预测控制的无人驾驶主动避障策略90农业装备与车辆工程 2023 年J
15、xxyyS v,obs iioioobsi22l=-+-+_hi(6)式中:Jobs具体的惩罚函数值;Sobs 权重系数;(xi,yi)障碍物第 i 个端点在大地坐标系下的位置坐标;(xo,yo)车辆质心坐标;一个极小的非 0 正数,目的是防止惩罚函数的分母为 0。1.3.2 轨迹重规划层目标函数设计重规划后的轨迹应满足:(1)能避开障碍物,满足安全避障要求;(2)车辆的运动学及性能约束;(3)与全局参考路径之间的偏差足够小。因此设计的轨迹重规划层的目标函数为,().,minmins tJk U kkiYkiu jJUU jUjN1 2minmaxrefjNobsiNcQR2211cPgGGh
16、h=+-+=dgghhhhgn/(7)式中:Yref 预先给定的全局参考轨迹;Q上层控制器中的输出权重系数矩阵;R控制输入的权重系数矩阵;Jobs避障惩罚函数值。1.4 重规划轨迹拟合在轨迹重规划算法中,重规划后的轨迹是离散点的形式。如果直接以离散点的形式传输给下层控制器,会占用太多的控制器输出与输入接口,控制器的设计会变得更加复杂11。此外由于多个控制周期的轨迹可以包含在规划控制器的一次求解范围内,因此上层规划周期与下层控制周期并不相同。为了确保上层局部规划控制器与下层跟踪控制器之间的顺利对接,采用 5 次多项式拟合重规划后的离散轨迹点,形式为Ya ta ta tta ta tab tb t
17、b tb tb tb0 51 42 33 2450 51 42 33 245=+=+(8)式中:ai,bi(i=0,1,2,3,4,5)待求轨迹拟合和航向角拟合参数。2 轨迹跟踪控制器2.1 车辆动力学模型为使智能车辆准确高效跟踪上层控制器规划的局部轨迹,需考虑车辆纵向、侧向和横摆 3 个维度的运动,建立更加精确的车辆动力学模型。如图2 所示,图 2 中:m整车质量;Iz车辆绕 Z轴转动惯量;Fxf,Fyr车辆前后轮胎所受到的侧偏力;Fxf,Fxr前后轮胎受到的纵向力。本文只涉及转向避障控制,车辆纵向速度被设定为常数,只考虑侧向和横摆 2 个维度的运动,根据车辆受力平衡和力矩平衡可以得到:m
18、xvFFFm yvFFFIl Fl F222yxfxffxrxxffyfyrZfyfryrdd-=-+=+=-popop_hihhh(9)基于小角度假设,选用线性化的魔术轮胎模型12。具体计算公式为tantanaavvl rvvlaavvl rvvlFCFC Sfxyffxyffrxyrxyryxs.dda=+-+-=-=aooeeooZ (10)式中:C车轮等效侧偏刚度;Cs车轮纵向刚度;轮胎侧偏角;S轮胎滑移率。将线性化后的 Pacejka 轮胎模型引入车辆动力学模型中得到sincoscossinmymvCvvlCvlvmxmvC sCvvlC sIl Cvvll CvlvYvvXvv22
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 模型 预测 控制 无人驾驶 主动 策略
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。