【CN109597308A】基于动力学模型的无人驾驶汽车模型预测控制器设计方法【专利】
基于模型预测控制的无人驾驶汽车的轨迹跟踪
基于模型预测控制的无人驾驶汽车的轨迹跟踪李金良;郝亮;曹植【摘要】为了更好地实现线性时变模型预测控制算法的低速直线轨迹跟踪控制效果验证,该文采用MATLAB/Simulink软件搭建基于运动学模型的线性时变模型预测控制算法,通过实际曲线与理想曲线的仿真对比分析,从而有效证明该控制算法能够保证无人驾驶汽车在一定工况下具有良好的稳定性和安全性,为无人驾驶汽车轨迹跟踪控制算法的研究奠定了一定的基础.【期刊名称】《汽车工程师》【年(卷),期】2017(000)010【总页数】3页(P33-35)【关键词】无人驾驶汽车;线性时变;模型预测控制算法;低速直线轨迹跟踪;运动学模型【作者】李金良;郝亮;曹植【作者单位】辽宁工业大学;辽宁工业大学;辽宁工业大学【正文语种】中文随着计算机信息处理技术、传感器技术和汽车控制技术的进步,基于高效环境感知的辅助驾驶技术或全自动驾驶技术迅速发展,以主动控制为核心的先进汽车安全技术必将是现代交通系统和未来高度智能化交通系统的核心技术之一[1-2]。
实现对全自主无人驾驶汽车在高速和冰雪等复杂路面安全稳定的轨迹跟踪控制具有十分重要的意义。
由于线性时变模型预测控制算法相比于非线性模型预测控制算法具有计算简单和实时性好等优点[3],因此,文章通过MATLAB/Simulink软件搭建基于运动学模型的线性时变模型预测控制算法,研究在给定工况下的轨迹跟踪特性。
1 线性时变模型预测控制原理以线性状态控制模型为基础,依次推导模型预测控制的预测方程、优化求解及反馈机制[4]。
1.1 预测方程首先考虑离散线性化模型:式中:x(k)——n维状态变量;u(k)——m维控制输入变量;Ak,t——状态变量系数矩阵;Bk,t——控制变量系数矩阵。
为了使整个离散化模型的关系更加明确,将系统未来时刻的输出以矩阵的形式表达:式中:η(t)——预测时域Np内的变形后系统输出变量;ξ(t)——预测时域Np内的变形后系统状态变量;Ct——输出系数矩阵;ΔU(t)——控制时域Nc内的系统输入增量;ψt——变形后的系统输入变量状态矩阵;θt——变形后的系统输入增量状态矩阵。
基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法研究
基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法研究随着社会的不断发展和科技的日新月异,无人驾驶技术逐渐受到人们的关注和重视。
无人驾驶车辆具有自主性、准确性和高效性的特点,可以大大提高驾驶的安全性和舒适度。
而无人驾驶车辆的轨迹跟踪控制是实现其精准导航和安全行驶的关键。
模型预测控制(Model Predictive Control,MPC)是一种优秀的控制方法,被广泛应用于轨迹跟踪控制领域。
该方法以系统模型为基础,通过对未来一段时间内系统行为的预测,生成最优控制输入,以实现对系统的轨迹跟踪。
无人驾驶车辆的轨迹跟踪控制通常由三个主要部分组成:车辆动力学建模、轨迹规划和控制器设计。
车辆动力学建模是通过建立车辆的运动模型,描述车辆在力的作用下的运动规律。
轨迹规划是根据实际情况和需求,确定车辆需要跟踪的目标轨迹。
控制器设计是根据车辆的动力学模型和目标轨迹,生成最优的控制指令,以确保车辆能够按照目标轨迹进行行驶。
在无人驾驶车辆的轨迹跟踪控制中,模型预测控制方法可以帮助解决以下几个问题。
首先,由于无人驾驶车辆的运动模型和环境的不确定性,传统的PID控制方法无法满足精确的跟踪要求。
而模型预测控制方法可以根据实时的传感器数据和车辆模型,预测车辆未来的运动轨迹,并生成相应的控制指令。
其次,模型预测控制方法可以在考虑系统约束的同时,优化控制性能。
例如,通过最小化误差平方和最大化控制输入变化率,可以实现更加平滑和稳定的控制效果。
最后,模型预测控制方法具有较强的鲁棒性和适应性,可以应对车辆模型变化、外部扰动和不可测的环境情况。
主要包括以下几个方面。
首先是车辆动力学建模。
根据车辆的实际情况和运动特点,建立准确的车辆动力学模型。
其次是轨迹规划。
根据实际需求和路况信息,确定车辆需要跟踪的目标轨迹,可采用优化算法和路径规划算法进行求解。
最后是控制器设计。
根据车辆的动力学模型和目标轨迹,设计合适的控制器,采用模型预测控制方法进行跟踪控制。
基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法研究
基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法研究摘要:无人驾驶技术的发展为汽车领域带来了重大的革新,使得自动驾驶汽车逐渐成为现实。
在无人驾驶领域,轨迹跟踪是关键技术之一,它是无人驾驶车辆实现准确而安全的驾驶的基础。
本文旨在研究基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法,通过分析和比较不同控制策略,提出一种高效且可靠的控制算法,为无人驾驶车辆的轨迹跟踪提供理论支持。
一、引言随着计算机技术的不断发展和智能交通系统的广泛应用,无人驾驶技术逐渐走入人们的视野。
无人驾驶车辆是一种不需要人工干预就能自主行驶的汽车,其核心是通过自动感知、决策和控制系统来实现道路行驶。
轨迹跟踪控制是无人驾驶车辆实现高精度、稳定和安全行驶的关键技术之一。
二、基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法模型预测控制(MPC)是一种优化控制方法,通过对动力学模型进行离散化来预测未来一段时间内的系统行为,并以此为依据进行最优控制策略的选择。
在无人驾驶车辆的轨迹跟踪控制中,采用MPC算法可以实现对车辆动态特性的精确建模,进而进行轨迹跟踪控制。
1. 车辆动力学模型的建立为了实现精确的轨迹跟踪,需要准确建立车辆的动力学模型。
一般来说,车辆可以看作是一个多输入多输出的非线性系统,其运动方程可以用状态空间模型表示。
通过分析车辆的动力学特性和运动学特性,可以建立相应的状态空间模型。
2. MPC控制器设计在利用MPC控制算法进行无人驾驶车辆轨迹跟踪时,首先需要确定控制目标,即期望的车辆轨迹。
然后,根据车辆动力学模型,预测未来一段时间内的车辆行驶情况,并以此为基础进行控制策略的选择。
最后,通过对控制信号的优化求解,得到最优的控制策略。
3. 控制策略的实时求解为了实现实时的轨迹跟踪控制,需要对控制策略进行实时求解。
在实际应用中,可以使用数值优化算法,如线性规划或二次规划,来求解MPC控制器中涉及的优化问题。
通过合适的算法选择和参数调节,可以实现控制策略的快速求解和实时实施。
基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法研究
基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法研究随着无人驾驶车辆的快速发展和广泛应用,轨迹跟踪控制成为了无人驾驶技术中一个重要的问题。
在实际应用中,无人驾驶车辆需要以高精度和高鲁棒性实现给定的轨迹跟踪任务。
本文将重点研究基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法。
模型预测控制(Model Predictive Control, MPC)是一种先进的控制方法,其基本思想是通过构建系统动态模型和优化器来预测系统的未来轨迹,从而进行控制决策。
在无人驾驶车辆轨迹跟踪中,模型预测控制方法可以通过优化车辆的控制输入,使其在一段未来时间内按照给定的轨迹进行运动,从而实现轨迹跟踪的任务。
首先,本文将介绍无人驾驶车辆的轨迹跟踪问题。
这个问题可以描述为,给定一个期望轨迹,如何设计控制器使得无人驾驶车辆沿着这个期望轨迹行驶。
同时,由于无人驾驶车辆的动力学和外部环境的不确定性,我们还需要考虑控制器的鲁棒性和鲁棒性。
随后,本文将介绍模型预测控制方法在轨迹跟踪问题中的应用。
首先,我们需要建立无人驾驶车辆的动态模型,这可以通过系统辨识的方法来获取。
然后,我们需要定义一个性能指标,来衡量车辆当前轨迹与期望轨迹之间的差距。
这个性能指标可以是车辆位置的误差和速度的误差等。
接下来,我们可以通过优化器来求解一个最优控制输入序列,使得性能指标最小化。
最后,根据得到的最优控制输入序列,我们可以控制车辆按照给定的轨迹进行运动。
在实际应用中,我们还需要考虑到模型误差和外部扰动等因素。
为了提高轨迹跟踪的鲁棒性,我们可以引入不确定性模型和鲁棒优化方法,从而在预测控制优化中考虑到不确定性。
此外,本文还将介绍一些基于模型预测控制的轨迹跟踪算法的改进和扩展。
例如,可以将模型预测控制与其他控制方法相结合,如模糊控制、自适应控制等,以进一步提高轨迹跟踪的性能和鲁棒性。
最后,本文将通过实验仿真和比较分析来验证基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法的有效性和优越性。
基于学习的无人驾驶车辆模型预测路径跟踪控制研究
基于学习的无人驾驶车辆模型预测路径跟踪控制研究1. 内容概览本研究旨在解决基于学习的无人驾驶车辆模型预测路径跟踪控制问题。
我们对现有的无人驾驶车辆技术进行了深入的研究和分析,总结了其主要特点和发展趋势。
我们提出了一种基于学习的无人驾驶车辆模型预测路径跟踪控制方法,该方法通过训练一个深度学习模型来实现对车辆行驶路径的预测。
我们在实际环境中对该方法进行了验证和实验,结果表明该方法具有较高的准确性和稳定性,为无人驾驶车辆的发展提供了有力的支持。
1.1 背景与意义随着科技的不断发展,无人驾驶车辆技术已经成为了当今汽车工业研究的热点领域。
无人驾驶车辆具有许多优势,如提高道路安全性、减少交通拥堵、降低能源消耗等。
要实现真正的无人驾驶,还需要解决一系列关键技术问题,其中之一就是路径规划和跟踪控制。
路径规划是指在给定的环境中,为车辆找到一条从起点到终点的最佳行驶路径。
这需要对环境进行建模,包括道路、车道线、交通信号灯等元素。
路径规划算法的选择直接影响到车辆的行驶性能和行驶时间,目前常用的路径规划算法有Dijkstra算法、A算法、RRT(Rapidlyexploring Random Tree)算法等。
跟踪控制是指在无人驾驶车辆行驶过程中,实时地跟踪目标物体(如其他车辆、行人等),并根据这些目标物体的运动状态调整自己的行驶轨迹。
跟踪控制算法的选择直接影响到车辆的安全性和舒适性,目前常用的跟踪控制算法有卡尔曼滤波器、粒子滤波器等。
基于学习的无人驾驶车辆模型预测路径跟踪控制研究旨在通过深度学习技术,实现对环境的高效建模和对目标物体的精确跟踪。
这种方法可以有效地提高无人驾驶车辆的路径规划和跟踪控制性能,为实现真正的无人驾驶奠定基础。
该研究还将为其他相关领域的研究提供新的思路和技术手段,具有较高的理论价值和实际应用价值。
1.2 国内外研究现状随着科技的不断发展,无人驾驶车辆技术逐渐成为研究热点。
基于学习的无人驾驶车辆模型预测路径跟踪控制研究取得了显著的进展。
《2024年基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法研究》范文
《基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法研究》篇一一、引言随着科技的飞速发展,无人驾驶车辆已成为现代交通领域的研究热点。
无人驾驶车辆的核心技术之一是轨迹跟踪控制算法,其性能直接影响到车辆的行驶安全与稳定性。
模型预测控制(MPC)作为一种先进的控制策略,在无人驾驶车辆的轨迹跟踪控制中具有广泛的应用前景。
本文旨在研究基于模型预测控制的无人驾驶车辆轨迹跟踪控制算法,以提高无人驾驶车辆的行驶性能和安全性。
二、模型预测控制概述模型预测控制(MPC)是一种基于模型的优化控制策略,通过建立车辆动力学模型,预测未来时刻的车辆状态,并优化控制输入以实现预定目标。
MPC具有处理约束、处理多目标优化问题、对模型不确定性具有较好的鲁棒性等优点,因此在无人驾驶车辆的轨迹跟踪控制中具有显著的优势。
三、无人驾驶车辆轨迹跟踪控制算法研究1. 车辆动力学模型建立为了实现精确的轨迹跟踪控制,首先需要建立准确的车辆动力学模型。
本文采用非线性车辆动力学模型,考虑车辆的纵向、横向以及横摆运动,以更真实地反映车辆的动态特性。
2. 控制器设计基于建立的车辆动力学模型,设计MPC控制器。
MPC控制器以当前车辆状态和目标轨迹为输入,通过优化算法计算出一系列控制输入,使车辆能够跟踪目标轨迹。
在控制器设计中,考虑了约束条件,如车轮转向角度、发动机油门等物理限制,以保证车辆行驶的安全性。
3. 算法实现与优化将MPC控制器应用于无人驾驶车辆的轨迹跟踪控制中,通过实时采集车辆状态信息和目标轨迹信息,进行在线优化计算。
为了进一步提高算法的性能,采用滚动时域的方法,将优化问题分解为一系列较小的子问题,降低计算复杂度。
同时,通过引入鲁棒性设计,提高算法对模型不确定性和外界干扰的抵抗能力。
四、实验与分析为了验证基于MPC的无人驾驶车辆轨迹跟踪控制算法的有效性,进行了实际道路实验。
实验结果表明,该算法能够使无人驾驶车辆准确地跟踪目标轨迹,具有较高的跟踪精度和稳定性。
【CN109808707A】一种基于随机模型预测的汽车转向控制方法及控制器【专利】
(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号 (43)申请公布日 (21)申请号 201910122104.2(22)申请日 2019.02.19(71)申请人 武汉理工大学地址 430070 湖北省武汉市洪山区珞狮路122号(72)发明人 褚端峰 高蒙 吴超仲 邓泽健 刘世东 (74)专利代理机构 湖北武汉永嘉专利代理有限公司 42102代理人 王丹(51)Int.Cl.B60W 50/00(2006.01)G05D 1/02(2006.01)(54)发明名称一种基于随机模型预测的汽车转向控制方法及控制器(57)摘要本发明提供一种基于随机模型预测的汽车转向控制方法,根据获得的信息进行车辆动力学建模,构建线性的车辆系统;对线性的车辆系统离散化处理;使用双移线作为测试工况,设计轨迹方程;将能够体现驾驶风格的参数量化,并假设保守型和激进型驾驶员的参数服从对应的正态分布,采用随机模型预测控制算法建立考虑驾驶风格的转向模型,并通过最小化目标函数条件期望的方法获得驾驶员的最优控制序列,对汽车进行转向控制。
本发明使得车辆可以准确的跟踪参考轨迹,实现精确的车辆控制,提高车辆转弯安全性。
权利要求书4页 说明书8页 附图1页CN 109808707 A 2019.05.28C N 109808707A1.一种基于随机模型预测的汽车转向控制方法,其特征在于:它包括以下步骤:S1、获取车辆结构参数信息和车辆运行状态信息;S2、根据获得的信息进行车辆动力学建模,构建线性的车辆系统;S3、对线性的车辆系统离散化处理;S4、使用双移线作为测试工况,设计轨迹方程;将能够体现驾驶风格的参数量化,并假设保守型和激进型驾驶员的参数服从对应的正态分布,采用随机模型预测控制算法建立考虑驾驶风格的转向模型,并通过最小化目标函数条件期望的方法获得驾驶员的最优控制序列,对汽车进行转向控制;所述的保守型和激进型驾驶员的参数通过实车实验获得。
基于模型预测和自抗扰的无人驾驶汽车控制系统及方法[发明专利]
(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号 (43)申请公布日 (21)申请号 201910592104.9(22)申请日 2019.07.02(71)申请人 天津大学地址 300072 天津市南开区卫津路92号(72)发明人 左志强 王浩宇 杨孟佳 王一晶 (74)专利代理机构 中科专利商标代理有限责任公司 11021代理人 汤宝平(51)Int.Cl.G05D 1/02(2006.01)G05B 13/04(2006.01)(54)发明名称基于模型预测和自抗扰的无人驾驶汽车控制系统及方法(57)摘要本公开提供了一种基于模型预测和自抗扰的无人驾驶汽车控制系统及方法,其控制方法包括:建立当前模型,根据当前模型和参考模型得到无人驾驶汽车的状态误差模型;分别预测参考模型在预测时域内的输出,以及当前模型与参考模型间的输出误差;得到在预测时域内当前模型的输出;进行线性优化,得到最优控制序列;将状态误差模型转化为积分链的形式,得到扩张状态量;通过状态反馈得到自抗扰控制量;模型预测控制量与自抗扰控制量相加得到总控制量,对无人汽车模型进行横向控制。
本公开将模型预测控制与自抗扰控制相结合,用扩张状态观测器跟踪作用于无人驾驶汽车的总扰动,并通过非线性反馈对扰动进行补偿,能够有效抑制各种扰动。
权利要求书6页 说明书14页 附图4页CN 110209177 A 2019.09.06C N 110209177A1.一种基于模型预测和自抗扰的无人驾驶汽车控制方法,包括:步骤1:建立当前模型,根据当前模型和参考模型得到无人驾驶汽车的状态误差模型;步骤2:分别预测参考模型在预测时域内的输出,以及当前模型与参考模型间的输出误差;得到在预测时域内当前模型的输出;进行线性优化,得到模型预测控制量;步骤3:将状态误差模型转化为积分链的形式,得到扩张状态量;通过状态反馈得到自抗扰控制量;步骤4:模型预测控制量与自抗扰控制量相加得到总控制量,对无人汽车模型进行横向控制。
无人驾驶技术应用(上)——基于改进模型预测控制算法的无人物流车辆控制系统的设计
50-CHINA ·October栏目编辑:刘玺 *****************新车新技术程增木 (本刊编委会委员)高级工程师,天津大学博士研究生,中国自动化标准委员会委员,中国工程科技专家库专家,机械工业出版社特约编者及审稿专家,S A E International中国汽车智能网联行业优秀技术专家,青岛市交通运输局项目顾问专家,上海控安汽车安全专家,华南理工大学、合肥工业大学客座讲师,中国自动化学会自动化与人工智能科普百人团专家,2021焉知汽车年度人物奖获得者。
◆文/天津 程增木一、概述无人驾驶技术近几年发展较为快速,目前正逐渐应用于Robotaxi、Robobus等应用场景。
车辆在接收到规划、感知、决策及定位模块的数据后,需要根据相关数据对车辆进行横向和纵向控制,目前主流的控制算法包括比例-积分-微分(PID)控制算法、Stanley控制算法、线性二次型调节器算法、模糊控制等算法。
由于目前法规限制且测试条件有限,mpc算法对参数调教和执行器延时请求较为严格,使用无人物流车进行算法测试。
本文针对无人物流车中存在转向不足、转向过度及跟踪超时等问题,提出一种基于改进模型预测控制算法的无人物流车辆控制系统,将车辆横摆角速度作为模型预测控制的输入,通过模型预测控制算法对输入量进行状态解算及跟踪后输出车辆转向角,并进行了实车试验。
二、模型预测控制器的设计1.预测控制的基本原理模型预测控制是上世纪70年代由Richalet等人提出的一种控制算法,该算法设计之初主要应用于工业过程控制,随着近几年的发展,模型预测控制广泛应用于汽车、航天、过程控制等领域。
模型预测控制的算法模型图如图1所示。
模型预测控制包括多种输入变量,包括车辆的参考轨迹、车辆动力学模型、代价函数模型、变量历史值。
模型预测控制综合考虑了系统输入状态变量、系统输出量、系统约束等条件,可以应用于线性系统和非线性系统,具有较好的控制效果。
基于模型预测的无人车辆最优控制
作为评价控制性能的指标,如公式(17)所示。
¦ 1 N
Bias N i1
2
2
xi xref ,i yi yref ,i
(17)
式中 :xi、yi 分别为车辆在第 i 个时间步的位置 ;xref、yref 分 别为目标轨迹的对应点 ;N 为跟踪样本点个数。
仿真环境下的 MPC 控制效果见表 1。
dy dx
=
y x
tanθ=sinθ/cosθ
(2) (3)
式中 :x、y 分别为车辆在 x 轴、y 轴移动的距离 ;θ 为车辆
转角。
一定约束下的单车模型速度运动学模型如公式(4)、公
式(5)所示。
ªº
ª x º
« «
y
» »
«cosT »
s
« «
sin T
» »
¬«T¼»
« tanI » «»
¬L¼
(4)
v =a
(5)
式中 :v 为车辆速度 ;L 为前后轮间距 ;ϕ 为车辆转向角 ;a
为车辆加速度。
基于上述模型,可以估算车辆在下一时刻的状态信息,
随后引入车辆的动力学特征。考虑车辆发动机的动力、轮胎
和路面之间的相互作用以及真实汽车的转向能力,提高自动
驾驶车辆建模的准确性,从而提升车辆运行的控制性能。由
4 试验设计与结果验证
本文在 Ubuntu 系统中的 CARLA 无人驾驶车辆仿真平台 上进行仿真试验,以验证本文设计的基于模型预测的无人车 辆控制方法的效果。在仿真平台中为车辆速度设定一个目标 轨迹,该轨迹由一系列离散点组成,车辆的任务是跟踪这个 轨迹,并尽量避免碰撞。车辆物理模型使用该仿真系统的默 认值,对车辆轨迹跟踪算法进行替换,针对不同道路轨迹平 均曲率下的轨迹跟踪效果,验证本文采用的 MPC 控制器的
【CN109597308A】基于动力学模型的无人驾驶汽车模型预测控制器设计方法【专利】
[0013]
[0014] 其中,m表示汽车的质量,x为汽车重心在车载坐标系下的横坐标,y为汽车重心在 车载坐标系下的纵坐标, 为汽车的航向角,为汽车在车载坐标系下的纵向速度, 为汽车 在车载坐标系下的横向速度, 为航向角的一阶导数,即汽车在竖直方向上的角速度, 为 汽车在车载坐标系下的纵向加速度, 为汽车在车载坐标系下的横向加速度, 为汽车在竖 直方向上的 角加速度 ,Fxf为前轮在x轴方向所受的 力 ,Fxr为后轮在x轴方向所受的 力 ,Fyf为 前轮在y轴方向所受的力,δ代表汽车的前轮偏角,Fyr为后轮在y轴方向所受的力,I为汽车的 转动惯量,a为汽车重心与前轴之间的距离,b为汽车重心与后轴之间的距离; [0015] Fxf、Fxr、Fyf和Fyr通过以下公式使用轮胎的纵向力和侧向力计算得到:
本发明公开了一种基于动力学模型的无人 驾驶汽车模型预测控制器设计方法 :建立新型车 辆动力学模型;设计基于新型车辆动力学模型的 无人驾驶汽车模型预测控制器;①利用在当前工 作点线性化得到的新型车辆动力学模型对系统 在预测时域内的输出状态进行预测;②利用得到 的系统预测输出和给定的参考输出构建优化问 题;③求解优化问题,将U( k )的第一个分量作为 当前时刻的最优控制量作用到系统上。本发明增 加车辆速度作为控制量,同时引入误差补偿项以 弥补模型精度、线性化和离散化在预测过程中带 来的累积误差,从而使无人驾驶车辆具有更好的 轨迹追踪效果。
状态进行预测:
Y(k)=Ψkξ(k|k)+ΘkU(k)+Γkγ(k) (5)
其中,
为系统在未来Np个采样时刻的输出,Np表示预测时域,“k+n|
k”,n = 0 ,1 ,… ,N p 表 示 在 第 k 个 采 样 时 刻 预 测 得 到 的 第 k + n 个 采 样 时 刻 的 变 量 ,
基于模型预测控制的智能车辆路径跟踪控制器设计
基于模型预测控制的智能车辆路径跟踪控制器设计王艺;蔡英凤;陈龙;王海;李健;储小军【摘要】为提高智能车辆路径跟踪的鲁棒性,基于模型预测控制原理提出了一种路径跟踪控制方法.该方法对车辆的3自由度非线性动力学模型进行线性化,得到线性时变模型和预测方程,并将包括控制量、控制增量等约束纳入二次规划的求解过程,同时考虑质心侧偏角、路面附着系数等影响操稳特性的约束条件.在CarSim和MATLAB/Simulink平台上以不同车速进行了双移线工况下的联合仿真,结果显示,该控制器可较好地实现路径跟踪,并保持较好的稳定性.%In order to improve the robustness of intelligent vehicle path tracking, this paper proposed a path tracking control method for intelligent vehicle based on model predictive control principle. By linearizing 3-degree-of-freedom nonlinear dynamic model of the vehicle, this method obtained a linear time-varying model and the prediction equation. Next, constraints including the control quantity and the control increment, etc., were included in the quadratic programming solution process, considering the side slip angle and the road adhesion coefficient which had impact on vehicle handling stability. Finally, co-simulation with different vehicle speeds was carried out under the conditions of double lane change on the CarSim and MATLAB/Simulink platforms. The results show that the controller can realize the path tracking accurately with good stability.【期刊名称】《汽车技术》【年(卷),期】2017(000)010【总页数】5页(P44-48)【关键词】自动转向;路径跟踪;模型预测控制;智能车辆【作者】王艺;蔡英凤;陈龙;王海;李健;储小军【作者单位】江苏大学,镇江 212013;江苏大学,镇江 212013;江苏大学,镇江212013;江苏大学,镇江 212013;江苏大学,镇江 212013;江苏大学,镇江 212013【正文语种】中文【中图分类】TP242.6自动转向控制作为智能车辆自动化驾驶控制的关键技术[1],通过控制转向角操控车辆侧向运动以实现路径跟踪。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
其中 ,Fl为轮胎纵向 力 ,Cl为轮胎的纵向刚度 ,s表示滑移率 ,Fc为轮胎侧向 力 ,Cc为轮胎 的侧向刚度,α表示侧偏角;
忽略汽车在竖直方向的运动,汽车的结构和受力用单轨模型描述,根据牛顿第二定律, 得到以下三个方向上的受力平衡方程:
其中 ,m表示汽车的 质量 ,x为汽车重心在车载坐标 系下的 横坐标 ,y为汽车重心在车载 坐标系下的纵坐标, 为汽车的航向角, 为汽车在车载坐标系下的纵向速度, 为汽车在 车载坐标系下的横向速度, 为航向角的一阶导数,即汽车在竖直方向上的角速度, 为汽 车在车载坐标系下的纵向加速度, 为汽车在车载坐标系下的横向加速度, 为汽车在竖直 方向上的 角加速度 ,Fxf为前轮在x轴方向所受的 力 ,Fxr为后轮在x轴方向所受的 力 ,Fyf为前 轮在y轴方向所受的力,δ代表汽车的前轮偏角,Fyr为后轮在y轴方向所受的力,I为汽车的转 动惯量,a为汽车重心与前轴之间的距离,b为汽车重心与后轴之间的距离;
( 19 )中华人民 共和国国家知识产权局
( 12 )发明专利申请
(21)申请号 201910034419 .1
(22)申请日 2019 .01 .15
(71)申请人 天津大学 地址 300072 天津市南开区卫津路92号
(72)发明人 左志强 杨孟佳 王一晶
(74)专利代理机构 天津市北洋有限责任专利代 理事务所 12201
Fxf、Fxr、Fyf和Fyr通过以下公式使用轮胎的纵向力和侧向力计算得到:
其中 ,Flf为前轮受到的纵向 力 ,Fcf为前轮受到的 侧向 力 ,Flr为后轮受到的纵向 力 ,Fcr为 后轮受到的侧向力;这几种力通过公式(1)计算得到,其中滑移率s和侧偏角α利用车速和轮 速计算得到;
联立公式(1)、(2)、(3) ,并经过线性化和Euler离散化处理之后得到新型车辆动力学模 型:
2/3 页
刻的系统状态,u(k)=[v ,δ]T为当前时刻的控制输入,v表示车辆速度,
为当
前时刻的 系统输出 ,Ak为系统的状态转移矩阵 ,Bk为系统的输入矩阵 ,C为系统的输出矩阵 ; 第二步:设计基于新型车辆动力学模型的无人驾驶汽车模型预测控制器
①利用在当前工作点线性化得到的新型车辆动力学模型对系统在预测时域内的输出
满足:ξ(k+1)=Akξ(k)+Bku(k) η(k)=Cξ(k) u(k-1|k)=u(k-1) αmin≤α(k+i|k)≤αmax ,i=0 ,… ,Np Δu(k+i|k)=u(k+i|k)-u(k+i-1|k) ,i=0 ,… ,Np Δumin≤Δu(k+i|k)≤Δumax ,i=0 ,… ,Nc-1 Δu(k+i|k)=0 ,i=Nc ,… ,Np 其中 ,ηr为给出的参考输出 ,“||*||2”表示矩阵的欧几里得范数 ,Q为输出误差的权重矩 阵 ,R为控制增量的权重矩阵。侧偏角α被限 制在αmin和αmax之间 ,为了满足无人驾驶汽车对于 稳定性 和舒适性的 要求 ,控 制增量Δu被严格限 制在Δumin 和Δuma x之间 。此外 ,在时间 段
权利要求书3页 说明书8页 附图6页
CN 109597308 A
CN 109597308 A
权 利 要 求 书
1/3 页
1 .一种基于动力学模型的无人驾驶汽车模型预测控制器设计方法,其特征在于,包括 以下步骤:
第一步:建立新型车辆动力学模型 使用由Pacejka提出的轮胎侧向力和牵引力模型,描述纵向力、翻转力矩、回正力矩、阻 力矩、侧偏角和滑移率之间的数值关系;轮胎力表示为如下形式:
②利用由式(5)得到的系统预测输出和给定的参考输出构建优化问题:
其中,J(ξ(k) ,U(k))为代价函数; ③求解优化问题,最优解U(k)满足各种物理约束、舒适度和控制精度的需求,将U(k)的 第一个分量u(k|k)作为当前时刻的最优控制量作用到系统上。 2 .根据权利要求1所述的基于动力学模型的无人驾驶汽车模型预测控制器设计方法, 其特征在于,第一步中侧偏角α和滑移率s由以下公式得到::
状态进行预测:
Y(k)=Ψkξ(k|k)+ΘkU(k)+Γkγ(k) (5)
其中 ,
为系统在未来Np个采样时刻的输出,Np表示预测时域,“k+n|
k”,n = 0 ,1 ,… ,N p 表 示 在 第 k 个 采 样 时 刻 预 测 得 到 的 第 k + n 个 采 样 时 刻 的 变 量 ,
ξe(k)=f(ξ(k) ,u(k))-Akξ(k)-Bku(k)为线性化所引起的状态误差,Nc表示控制时域,ξ (k+1)=f(ξ(k) ,u(k))为离散的非线性车辆动力学模型;
其中 ,vc=vycosδ-vxsinδ为轮胎的 侧向速度 ,vx为汽车在车载坐标系下沿x轴方向的速 度,vy为汽车在车载坐标系下沿y轴方向的速度,vl=vysinδ+vxcosδ为轮胎的纵向速度,r为 轮胎的半径,w为轮胎的角速度。
3
CN 109597308 A
权 利 要 求 书
3/3 页
3 .根据权利要求1所述的基于动力学模型的无人驾驶汽车模型预测控制器设计方法, 其特征在于,第二步中构建的优化问题具体为:
代理人 吴学颖
(51)Int .Cl . G05B 13/04(2006 .01) G05D 1/02(2006 .01)
(10)申请公布号 CN 109597308 A (43)申请公布日 2019.04.09
( 54 )发明 名称 基于动力学模型的无人驾驶汽车模型预测
控制器设计方法 ( 57 )摘要
其中,k表示当前采样时刻,“k+n”,n=1 ,2 ,3…表示当前采样时刻之后的第n个采样时
刻,
表示当前时 刻的 系统 状态 ,Y为汽车 在惯性坐标 系下的 纵
坐标,X为汽车在惯性坐标系下的横坐标,上角标“T”表示矩阵的转置,ξ(k+1)为下一采样时
2
CN 109597308 A
权 利 要 求 书