CN110888319B - 用于自动驾驶车辆的纵向控制系统和纵向控制方法 - Google Patents
用于自动驾驶车辆的纵向控制系统和纵向控制方法 Download PDFInfo
- Publication number
- CN110888319B CN110888319B CN201911226268.6A CN201911226268A CN110888319B CN 110888319 B CN110888319 B CN 110888319B CN 201911226268 A CN201911226268 A CN 201911226268A CN 110888319 B CN110888319 B CN 110888319B
- Authority
- CN
- China
- Prior art keywords
- output control
- control quantity
- reference model
- pid
- vehicle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 230000004927 fusion Effects 0.000 claims description 26
- 230000003044 adaptive effect Effects 0.000 claims description 21
- 238000010586 diagram Methods 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 4
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 208000012661 Dyskinesia Diseases 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提供一种用于自动驾驶车辆的纵向控制方法和系统,该方法包括根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差;根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;根据车辆的速度获得PID输出控制量;融合调整后的参考模型的输出控制量和PID输出控制量以获得系统的最终控制量。本发明的系统的鲁棒性好,能够很好地处理重型卡车的线控平台的参数的扰动及控制过程中的动态偏差。
Description
技术领域
本发明属于自动驾驶技术领域,具体涉及一种用于自动驾驶车辆的纵向控制系统和纵向控制方法。
背景技术
自动驾驶技术在最近十年得到突飞猛进的发展,将自动驾驶技术应用到重型卡车上,也在最近几年得到了广泛的关注。
由于重型卡车质量较大,相对于乘用车重型卡车的线控平台的执行性能较差,另外重型卡车后面还有非刚性连接的挂车,所以相较于乘用车,重型卡车的自动驾驶的控制问题更具有挑战性。
现有的自动驾驶车辆的控制系统中,不能很好地处理自动驾驶卡车所面临的技术挑战,尤其是非线性和不稳定的线控性能以及换挡所带来的顿挫等问题。
目前的一种主流技术方案是基于速度的PID(proportional-integral-derivative,比例-积分-微分控制器)的方法来进行纵向控制的,参见图1,该方法的优点是实现简单,但缺点是鲁棒性比较差,并且不能很好地处理重型卡车的线控平台的参数的扰动及换挡所带来的顿挫问题。
因此,综上所述,现有技术中存在以下几个问题:鲁棒性比较差、不能很好地处理重型卡车的线控平台的参数的扰动及控制过程中的动态偏差。
发明内容
本发明提供一种用于自动驾驶车辆的纵向控制系统和纵向控制系统方法,通过引入参考自适应模型,以解决现有技术中的至少一个技术问题。
本发明的一个方面提供一种用于自动驾驶车辆的纵向控制系统,该纵向控制系统包括模型参考自适应模块和线控模块,所述模型参考自适应模块包括参考模型、第一融合子模块和自适应律子模块;所述系统还包括PID模块和第二融合模块;其中,
所述参考模型根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
所述第一融合子模块融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差;
所述自适应律子模块根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
所述PID模块根据车辆的速度获得PID输出控制量;
所述第二融合模块融合调整后的参考模型的输出控制量和PID输出控制量以获得系统的最终控制量。
进一步的,所述自适应律子模块通过以下公式获得调整后的参考模型的输出控制量:
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma是自适应律;e是第一误差。
进一步的,所述第二融合模块通过以下公式获得系统的最终控制量:
CMDfinal=WMRAC*u1+WPID*u2
其中,CMDfinal是系统的最终控制量;WMRAC是调整后的参考模型的输出控制量的权重;u1是调整后的参考模型的输出控制量;WPID是PID输出控制量的权重;u2是PID输出控制量。
进一步的,所述PID输出控制量u2通过以下公式获得:
KP是P项的参数,Ki是I项的参数,Kd是D项的参数,e(k)是控制量和观测量的误差。
进一步的,所述纵向控制系统还包括前馈模块和第三融合模块;
所述前馈模块根据车辆的输入值和输出值获得前馈输出控制量;
所述第三融合模块融合调整后的参考模型的输出控制量、PID输出控制量和前馈输出控制量获得所述系统的最终控制量。
本发明的一个方面提供一种用于自动驾驶车辆的纵向控制方法,该纵向控制方法包括以下步骤:
根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差;
根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
根据车辆的速度获得PID输出控制量;
融合调整后的参考模型的输出控制量和PID输出控制量以获得系统的最终控制量。
进一步的,所述调整后的参考模型的输出控制量通过以下公式获得:
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma是自适应律;e是第一误差。
进一步的,通过以下公式获得所述系统的最终控制量:
CMDfinal=WMRAC*u1+WPID*u2
其中,CMDfinal是系统的最终控制量;WMRAC是调整后的参考模型的输出控制量的权重;u1是调整后的参考模型的输出控制量;WPID是PID输出控制量的权重;u2是PID输出控制量。
进一步的,所述PID输出控制量u2通过以下公式获得:
KP是P项的参数,Ki是I项的参数,Kd是D项的参数,e(k)是控制量和观测量的误差。
进一步的,该纵向控制方法还包括以下步骤;
根据车辆的输入值和输出值获得前馈输出控制量;
融合调整后的参考模型的输出控制量、PID输出控制量和前馈输出控制量获得所述系统的最终控制量。
本发明通过本发明通过引入模型参考自适应模块,在车辆的自动驾驶系统中,尤其是在重型卡车的自动驾驶控制过程中,可以很好的解决线控平台的参数扰动以及控制过程中的动态偏差的技术问题,从而极大的提升自动驾驶车辆的纵向控制的精度,带来了更高的安全性和更平稳的驾驶体验。
附图说明
图1为现有技术中利用PID算法的一种自动驾驶车辆的控制系统的结构示意图;
图2为本发明一个实施例提供的一种用于自动驾驶车辆的纵向控制系统的结构示意图;
图3为本发明实施例提供的一种用于自动驾驶车辆的纵向控制方法的流程示意图;
图4为本发明另一实施例提供的一种用于自动驾驶车辆的纵向控制系统的结构示意图;
图5为本发明另一实施例提供的一种用于自动驾驶车辆的纵向控制方法的流程示意图;
图6为本发明实施例提供的一种电子设备的结构示意图。
具体实施方式
下面结合附图所示的各实施方式对本发明进行详细说明,但应当说明的是,这些实施方式并非对本发明的限制,本领域普通技术人员根据这些实施方式所作的功能、方法、或者结构上的等效变换或替代,均属于本发明的保护范围之内。
实施例一
图2为本发明实施例提供的一种用于自动驾驶车辆的纵向控制系统的结构示意图;参见图2,该纵向控制系统包括模型参考自适应模块、线控模块,所述模型参考自适应模块包括参考模型、第一融合子模块和自适应律子模块;所述系统还包括PID模块和第二融合模块;其中,
所述参考模型根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;本实施例中的车辆模型一般可以通过系统辨识方法或者大数据建模的方式获得;
所述第一融合子模块融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差,所述第一误差为参考模型的输出控制量和当前系统的实时状态量之间的误差;本实施例中的当前系统的实时状态量可来自于线控模块反馈的信号,例如包括当前油门踏板的百分比等数据;
所述自适应律子模块根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
所述PID模块根据车辆的速度获得PID输出控制量;
所述第二融合模块融合调整后的参考模型的输出控制量和PID输出控制量以获得系统的最终控制量。
进一步的,所述参考模型为;其中,Gm(S)是参考模型的频域动力学模型;Ta是一阶惯性环节时间常数,该常数依赖于车辆的动态性能,一般参考取值范围为[0.15-0.4];S是频域自变量。
进一步的,所述第一误差是通过以下公式实现的,例如可以利用参考模型的输出的控制量与当前系统的实时状态量的差值来获得所述误差,具体可参见下述公式:
e=CMDr-CMDs;
其中,CMDr是参考模型的输出控制量;CMDs是当前系统的实时状态量;e是第一误差。
进一步的,所述自适应律子模块利用以下表达式获得所述调整后的参考模型的输出控制量:
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma表示自适应律,其参考取值范围为[1.0-2.3];e是第一误差。
进一步的,所述第二融合模块通过以下公式获得所述系统的最终控制量:
CMDfinal=WMRAC*u1+WPID*u2
其中,CMDfinal是系统的最终控制量;WMRAC是调整后的参考模型的输出控制量的权重,优选的,WMRAC取值参考范围为[0.6-1.0];u1是调整后的参考模型的输出控制量;WPID是PID输出控制量的权重,优选的,WPID的取值参考范围为[0.3-1.0];u2是PID输出控制量;
优选的,所述PID输出控制量u2是通过如下公式获得的:
其中,KP是P项的参数,Ki是I项的参数,Kd是D项的参数,e(k)是控制量和观测量的误差。
可选的,所述第二融合模块根据车辆的不同的线控性能指标对模型参考自适应模块和PID模块分配相应的权重。
本实施例通过第二融合模块融合调整后的参考模型的输出控制量和PID输出控制量获得系统的最终控制量,可以降低系统控制的动态偏差,并可以及时地进行检测和反馈,从而极大地提高了该系统的纵向控制的精确度。
实施例二
图3为本发明实施例提供的一种用于自动驾驶车辆的纵向控制方法的流程示意图,参见图3,该纵向控制方法包括以下步骤:
根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差;
根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
根据车辆的速度获得PID输出控制量;
融合调整后的参考模型的输出控制量和PID输出控制量以获得系统的最终控制量。
进一步的,通过以下公式获得所述调整后的参考模型的输出控制量:
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma是自适应律;e是第一误差。
进一步的,通过以下公式获得所述系统的最终控制量:
CMDfinal=WMRAC*u1+WPID*u2
其中,CMDfinal是系统的最终控制量;WMRAC是调整后的参考模型的输出控制量的权重;u1是调整后的参考模型的输出控制量;WPID是PID输出控制量的权重;u2是PID输出控制量。
进一步的,所述PID输出控制量u2通过以下公式获得:
KP是P项的参数,Ki是I项的参数,Kd是D项的参数,e(k)是控制量和观测量的误差。
进一步的,该纵向控制方法还包括以下步骤;
根据车辆的输入值和输出值获得前馈输出控制量;
融合调整后的参考模型的输出控制量、PID输出控制量和前馈输出控制量获得所述系统的最终控制量。
进一步的,根据车辆的不同的线控性能指标对调整后的参考模型的输出控制量的权重、PID输出控制量分配相应的权重。
本实施例中的用于自动驾驶车辆的纵向控制方法的过程及工作原理与实施例一的纵向控制系统的过程及工作原理基本一致,在此不再赘述。
实施例三
参见图4,图4为本发明的另一实施例提供的一种用于自动驾驶车辆的纵向控制系统的结构示意图;该纵向控制系统包括模型参考自适应模块、线控模块、PID模块、前馈模块和第三融合模块;其中,所述模型参考自适应模块包括参考模型、第一融合子模块和自适应律子模块;
所述参考模型根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
所述第一融合子模块融合所述参考模型的输出控制量和当前系统的实时状态量,以获得第一误差,所述第一误差为参考模型的输出控制量和当前系统的实时状态量之间的误差;
所述自适应律子模块根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
所述PID模块根据车辆的速度获得PID输出控制量;
所述前馈模块根据车辆的输入值和输出值获得前馈输出控制量;
所述第三融合模块融合调整后的参考模型的输出控制量、PID输出控制量和前馈输出控制量获得系统的最终控制量。
需要说明的是,在本实施例中,所述参考模型、获得第一误差、调整后的参考模型的输出控制量以及PID输出控制量等的实现方法与实施例一中的基本一致,在此不再具体赘述。
进一步的,所述第三融合模块通过以下公式获得所述系统的最终控制量:
CMDfinal=WMRAC*u1+WPID*u2+WFF*u3
其中,CMDfinal是系统的最终控制量;WMRAC是调整后的参考模型的输出控制量的权重,优选的,取值参考范围为[0.6-1.0];u1是调整后的参考模型的输出控制量;WFF是前馈输出控制量的权重;优选的,WFF的取值参考范围为[0.5-1.0];u3是前馈输出控制量;WPID是PID输出控制量的权重;优选的,WPID的取值参考范围为[0.3-1.0];u2是PID输出控制量。
进一步的,所述前馈输出控制量u3是可通过如下公式获得:
u3=k1(v)+k2(w)+k3(a)
其中,v是车辆的速度,w是车辆的载重,a是车辆的加速度,k1是车辆的速度的系数,k2是车辆的载重的系数,k3是车辆的加速度的系数。
优选的,所述第三融合模块根据车辆的不同的线控性能指标对模型参考自适应模块、PID模块和前馈模块分配相应的权重。
本实施例利用第三融合模块融合调整后的参考模型的输出控制量、PID输出控制量和前馈输出控制量获得系统的最终控制量,不仅能够降低系统控制的动态偏差,并可以及时地进行检测和反馈,从而极大地提高了该系统的纵向控制的精确度;而且能够很好地解决换挡所带来的顿挫问题,并对系统进行迅速的反馈调节,从而带来了更加平顺的系统体验,因此本实施例可以极大的提升自动驾驶车辆的纵向控制的精度和鲁棒性,从而为车辆带来更高的安全性和更平稳的驾驶体验。
实施例四
图5为本发明另一实施例提供的一种用于自动驾驶车辆的纵向控制方法的流程示意图;参见图5,该纵向控制方法包括以下步骤:
根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
融合所述参考模型的输出控制量和当前系统的实时状态量,以获得第一误差,所述第一误差为参考模型的输出控制量和当前系统的实时状态量之间的误差;
根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
根据车辆的速度获得PID输出控制量;
根据车辆的输入值和输出值获得前馈输出控制量;
融合调整后的参考模型的输出控制量、PID输出控制量和前馈输出控制量获得系统的最终控制量。
需要说明的是,在本实施例中,所述参考模型、获得第一误差、调整后的参考模型的输出控制量以及PID输出控制量等的实现方法也与实施例一中的基本一致,在此不再具体赘述。
进一步的,通过以下公式获得所述系统的最终控制量:
CMDfinal=WMRAC*u1+WPID*u2+WFF*u3
其中,CMDfinal是系统的最终控制量;WMRAC是调整后的参考模型的输出控制量的权重,优选的,取值参考范围为[0.6-1.0];u1是调整后的参考模型的输出控制量;WFF是前馈输出控制量的权重;优选的,WFF的取值参考范围为[0.5-1.0];u3是前馈输出控制量;WPID是PID输出控制量的权重;优选的,WPID的取值参考范围为[0.3-1.0];u2是PID输出控制量。
进一步的,所述前馈输出控制量u3是可通过如下公式获得:
u3=k1(v)+k2(w)+k3(a)
其中,v是车辆的速度,w是车辆的载重,a是车辆的加速度,k1是车辆的速度的系数,k2是车辆的载重的系数,k3是车辆的加速度的系数。
优选的,根据车辆的不同的线控性能指标获得调整后的参考模型的输出控制量的权重、前馈输出控制量的权重以及PID输出控制量的权重。
本实施例中的用于自动驾驶车辆的纵向控制方法的过程及工作原理与实施例三的纵向控制系统的过程及工作原理基本一致,在此不再赘述。
实施例五
图6为本发明的一种电子设备的一个实施例的结构示意图,参见图6,在本实施例中,提供一种电子设备,包括但不限于智能手机、固定电话、平板电脑、笔记本电脑、穿戴式设备等电子设备,所述电子设备包括:处理器和存储器,所述存储器存储有计算机可读指令,所述计算机可读指令在被所述处理器执行时实现上述本发明的方法。
实施例六
在本实施例中,提供一种计算机可读存储介质,可以为ROM(例如只读存储器、FLASH存储器、转移装置等)、光学存储介质(例如,CD-ROM、DVD-ROM、纸卡等)、磁存储介质(例如,磁带、磁盘驱动器等)或其他类型的程序存储器;所述计算机可读存储介质上存储有计算机程序,所述计算机程序在被处理器或计算机运行时执行上述本发明的方法。
本发明具有以下优点:
本发明通过引入模型参考自适应模块,在车辆的自动驾驶系统中,尤其是在重型卡车的自动驾驶控制过程中,可以很好的解决线控平台的参数扰动以及控制过程中的动态偏差的技术问题,从而极大的提升自动驾驶车辆的纵向控制的精度,带来了更高的安全性和更平稳的驾驶体验。
本领域普通技术人员可以意识到,结合本发明实施例中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、或者计算机软件和电子硬件的结合来实现。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
在本申请所提供的实施例中,应该理解到,所揭露的装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。
所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。
Claims (4)
1.一种用于自动驾驶车辆的纵向控制系统,其特征在于,该纵向控制系统包括模型参考自适应模块和线控模块,所述模型参考自适应模块包括参考模型、第一融合子模块和自适应律子模块;所述系统还包括PID模块、前馈模块和第三融合模块;其中,
所述参考模型根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
所述第一融合子模块融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差;
所述自适应律子模块根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
所述PID模块根据车辆的速度获得PID输出控制量;
所述前馈模块根据车辆的输入值和输出值获得前馈输出控制量;
所述第三融合模块融合调整后的参考模型的输出控制量、PID输出控制量和前馈输出控制量获得所述系统的最终控制量;
其中,所述PID输出控制量通过以下公式获得:
u2是PID输出控制量,KP是P项的参数,Ki是I项的参数,Kd是D项的参数,e(k)是控制量和观测量的误差;
所述第三融合模块通过以下公式获得所述系统的最终控制量:
CMDfinal=WMRAC*u1+WPID*u2+WFF*u3
其中,CMDfinal是系统的最终控制量;WMRAC是调整后的参考模型的输出控制量的权重;u1是调整后的参考模型的输出控制量;WFF是前馈输出控制量的权重;u3是前馈输出控制量;WPID是PID输出控制量的权重;u2是PID输出控制量。
2.根据权利要求1所述的纵向控制系统,其特征在于,所述自适应律子模块通过以下公式获得调整后的参考模型的输出控制量:
u1=r·∫(gamma*e*r)
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma是自适应律;e是第一误差。
3.一种用于自动驾驶车辆的纵向控制方法,其特征在于,该纵向控制方法包括以下步骤:
根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差;
根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
根据车辆的速度获得PID输出控制量;
根据车辆的输入值和输出值获得前馈输出控制量;
融合调整后的参考模型的输出控制量、PID输出控制量和前馈输出控制量获得所述系统的最终控制量;
所述PID输出控制量通过以下公式获得:
u2是PID输出控制量,KP是P项的参数,Ki是I项的参数,Kd是D项的参数,e(k)是控制量和观测量的误差;
所述系统的最终控制量通过以下公式获得:
CMDfinal=WMRAC*u1+WPID*u2+WFF*u3
其中,CMDfinal是系统的最终控制量;WMRAC是调整后的参考模型的输出控制量的权重;u1是调整后的参考模型的输出控制量;WFF是前馈输出控制量的权重;u3是前馈输出控制量;WPID是PID输出控制量的权重;u2是PID输出控制量。
4.根据权利要求3所述的纵向控制方法,其特征在于:所述调整后的参考模型的输出控制量通过以下公式获得:
u1=r·∫(gamma*e*r)
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma是自适应律;e是第一误差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911226268.6A CN110888319B (zh) | 2019-12-04 | 2019-12-04 | 用于自动驾驶车辆的纵向控制系统和纵向控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911226268.6A CN110888319B (zh) | 2019-12-04 | 2019-12-04 | 用于自动驾驶车辆的纵向控制系统和纵向控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110888319A CN110888319A (zh) | 2020-03-17 |
CN110888319B true CN110888319B (zh) | 2023-08-01 |
Family
ID=69750352
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911226268.6A Active CN110888319B (zh) | 2019-12-04 | 2019-12-04 | 用于自动驾驶车辆的纵向控制系统和纵向控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110888319B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110843793B (zh) * | 2019-12-04 | 2021-11-23 | 苏州智加科技有限公司 | 基于前馈控制的自动驾驶车辆的纵向控制系统和方法 |
CN112947047B (zh) * | 2021-01-26 | 2022-08-09 | 重庆长安汽车股份有限公司 | 一种基于自适应pid算法的自动驾驶加速度控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7805207B2 (en) * | 2008-03-28 | 2010-09-28 | Mitsubishi Electric Research Laboratories, Inc. | Method and apparatus for adaptive parallel proportional-integral-derivative controller |
CN102060009B (zh) * | 2010-12-10 | 2013-04-17 | 清华大学 | 一种具有电子辅助制动功能的制动系统 |
-
2019
- 2019-12-04 CN CN201911226268.6A patent/CN110888319B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110888319A (zh) | 2020-03-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110888319B (zh) | 用于自动驾驶车辆的纵向控制系统和纵向控制方法 | |
Ding et al. | An adaptive integrated algorithm for active front steering and direct yaw moment control based on direct Lyapunov method | |
CN108136935B (zh) | 车速控制装置 | |
EP3053794B1 (en) | Vehicle travel control device | |
CN113759707A (zh) | 用于自动驾驶车辆的预测控制优化方法和装置 | |
CN110843793B (zh) | 基于前馈控制的自动驾驶车辆的纵向控制系统和方法 | |
CN107635630A (zh) | 用于模型车辆的使用自动参数下载的转向稳定系统 | |
Lie et al. | Advanced emergency braking controller design for pedestrian protection oriented automotive collision avoidance system | |
Yamakado et al. | A yaw-moment control method based on a vehicle's lateral jerk information | |
CN113320529A (zh) | 基于自车标定和模糊控制的自适应巡航控制方法和系统 | |
Zhao et al. | H∞ control of anti-rollover strategy based on predictive vertical tire force | |
WO2023241050A1 (zh) | 车辆横向控制方法、系统及车辆 | |
Dawei et al. | Coordination strategy between AFS and ASB with fault-tolerant mechanism for ground vehicle | |
CN114834529B (zh) | 一种车辆控制方法、装置、设备和介质 | |
Qin et al. | H∞ Control of Four‐Wheel‐Independent‐Drive Electric Vehicles with Random Time‐Varying Delays | |
CN114537419A (zh) | 一种考虑驾驶员活跃度及驾驶能力的辅助控制器设计方法 | |
CN115534930A (zh) | 车辆横向控制方法、装置和电子设备 | |
CN114889651A (zh) | 一种自动驾驶车辆的控制方法、装置、设备及存储介质 | |
Dong et al. | Gain-scheduled steering and braking coordinated control in path tracking of intelligent heavy vehicles | |
CN113715820A (zh) | 一种基于速度补偿pid的车辆速度控制方法及装置 | |
CN106394654A (zh) | 用于改进的eps系统稳定性的惯性补偿频率整形 | |
Asperti et al. | On Torque Vectoring Control: Review and Comparison of State-of-the-Art Approaches | |
KR101952153B1 (ko) | 후륜 조향 제어 장치 및 방법 | |
Liao et al. | Direct yaw moment control of eight-wheeled distributed drive electric vehicles based on super-twisting sliding mode control | |
WO2022188716A1 (zh) | 车辆控制方法、装置、设备及计算机存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |