CN114516342B - 一种车辆控制方法、装置及车辆 - Google Patents
一种车辆控制方法、装置及车辆 Download PDFInfo
- Publication number
- CN114516342B CN114516342B CN202011301654.XA CN202011301654A CN114516342B CN 114516342 B CN114516342 B CN 114516342B CN 202011301654 A CN202011301654 A CN 202011301654A CN 114516342 B CN114516342 B CN 114516342B
- Authority
- CN
- China
- Prior art keywords
- control
- vehicle
- control input
- optimal
- period
- 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 39
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 34
- 230000001133 acceleration Effects 0.000 claims description 11
- 230000008859 change Effects 0.000 abstract description 7
- 238000005265 energy consumption Methods 0.000 abstract description 6
- 230000006870 function Effects 0.000 description 15
- 238000005457 optimization Methods 0.000 description 7
- 239000000243 solution Substances 0.000 description 7
- 238000012545 processing Methods 0.000 description 6
- 238000005096 rolling process Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 230000001934 delay Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 239000000470 constituent Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 230000015654 memory Effects 0.000 description 1
- 239000010705 motor oil Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
- 238000012549 training Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0013—Planning or execution of driving tasks specially adapted for occupant comfort
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
-
- 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
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/80—Technologies aiming to reduce greenhouse gasses emissions common to all road transportation technologies
- Y02T10/84—Data processing systems or methods, management, administration
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本申请提供了一种车辆控制方法。该方法通过模型预估控制算法预测车辆在未来N个控制周期的状态,求解该车辆在当前控制周期内控制输入约束的最小值,然后确定最优控制序列,其中控制序列包括当前控制周期内满足最优控制输入约束的最优控制输入值,从而向执行器发送最优值,以指示执行器按照控制输入的最优值执行操作。从而,减小控制输入的约束条件范围,减少自动驾驶车辆能量消耗,减小对自动驾驶车辆的状态改变范围,提高自动驾驶的舒适性。
Description
技术领域
本申请涉及汽车电子领域,尤其涉及一种车辆控制方法、装置以及车辆。
背景技术
随着自动驾驶技术日趋成熟,对车辆的动态控制要求越来越高,如果控制算法不能有效体现车辆动力学以及车辆运动学约束,则不能取得很好的控制效果。传统的比例积分微分控制(proportional-integral-derivative control,PID)既不能很好的处理控制延时,也无法处理约束条件在控制中的使用。
在实际的自动驾驶车辆控制中,模型预估控制(model predictive control,MPC)理论被越来越多的使用。它拥有处理约束条件的优势,将长时间跨度的最优化控制问题分解为有限时间跨度的最优化控制问题,是自动驾驶控制中体现约束条件的理想方法。
在传统的模型预估控制中,控制输入的约束条件是固定的范围。例如加速度在[-1g,1g]范围内,方向盘扭矩在[-3Nm,3Nm]范围内。然而,这种控制方法存在能量消耗较高的问题。
而且在每个控制周期内,减小控制输入的约束条件范围,可以减小对自动驾驶车辆的状态改变范围,提高自动驾驶的舒适性。同时,减少控制输入的约束条件范围可以减少自动驾驶车辆能量消耗。
发明内容
本申请提供了一种车辆控制方法。该方法通过模型预估控制算法预测车辆在未来N个控制周期的状态,求解该车辆在当前控制周期内控制输入约束的最小值,然后确定最优控制序列,其中控制序列包括当前控制周期内满足最优控制输入约束的最优控制输入值,从而向执行器发送最优值,以指示执行器按照控制输入的最优值执行操作。从而,减小控制输入的约束条件范围,减少自动驾驶车辆能量消耗,减小对自动驾驶车辆的状态改变范围,提高自动驾驶的舒适性。
第一方面,本申请提供了一种车辆控制方法。该方法包括:
通过模型预估控制算法预测车辆在未来N个控制周期的状态,N为正整数;
根据车辆在未来N个控制周期的状态,求解车辆在当前控制周期内控制输入约束的最小值;
根据车辆在当前控制周期内控制输入约束的最小值,利用模型预估控制算法,确定最优控制序列,控制序列包括当前控制周期内满足最优控制输入约束的最优控制输入值;
向执行器发送当前控制周期内控制输入的最优值,以指示执行器按照控制输入的最优值执行。
在一些可能的实现方式中,方法还包括:
当到达下一控制周期时,再次执行通过模型预估控制算法预测车辆在未来N个控制周期的状态,根据车辆在未来N个控制周期的状态,求解车辆在当前控制周期内控制输入约束的最小值,根据车辆在当前控制周期内控制输入约束的最小值,利用模型预估控制算法,确定最优控制序列,以及向执行器发送当前控制周期内控制输入的最优值的步骤。
在一些可能的实现方式中,根据车辆在未来N个控制周期的状态,求解车辆在当前控制周期内控制输入约束的最小值,包括:
根据车辆在未来N个控制周期的状态,通过线性规划求解车辆在当前控制周期内控制输入约束的最小值。
在一些可能的实现方式中,状态包括车辆到车道中心线的距离和/或航向角。
在一些可能的实现方式中,控制输入约束包括加速度约束、方向盘转角约束中的至少一种。
第二方面,本申请提供了一种车辆控制装置,该装置包括:
预测模块,用于通过模型预估控制算法预测车辆在未来N个控制周期的状态,N为正整数;
求解模块,用于根据车辆在未来N个控制周期的状态,求解车辆在当前控制周期内控制输入约束的最小值;
确定模块,用于根据车辆在当前控制周期内控制输入约束的最小值,利用模型预估控制算法,确定最优控制序列,控制序列包括当前控制周期内满足最优控制输入约束的最优控制输入值;
发送模块,用于向执行器发送当前控制周期内控制输入的最优值,以指示执行器按照控制输入的最优值执行。
在一些可能的实现方式中,装置还用于:
当到达下一控制周期时,再次执行通过模型预估控制算法预测车辆在未来N个控制周期的状态,根据车辆在未来N个控制周期的状态,求解车辆在当前控制周期内控制输入约束的最小值,根据车辆在当前控制周期内控制输入约束的最小值,利用模型预估控制算法,确定最优控制序列,以及向执行器发送当前控制周期内控制输入的最优值的步骤。
在一些可能的实现方式中,预测模块,具体用于:
根据车辆在未来N个控制周期的状态,通过线性规划求解车辆在当前控制周期内控制输入约束的最小值。
在一些可能的实现方式中,状态包括车辆到车道中心线的距离和/或航向角。
在一些可能的实现方式中,控制输入约束包括加速度约束、方向盘转角约束中的至少一种。
本申请在上述各方面提供的实现方式的基础上,还可以进行进一步组合以提供更多实现方式。
从以上技术方案可以看出,本申请实施例具有以下优点:
本申请实施例提供了一种车辆控制方法,该方法首先通过模型预估控制算法预测车辆在未来N个控制周期的状态,求解车辆在当前控制周期内控制输入约束的最小值,然后确定最优控制序列,其中控制序列包括当前控制周期内满足最优控制输入约束的最优控制输入值,从而向执行器发送最优值,以指示执行器按照控制输入的最优值执行操作。
如此,减小控制输入的约束条件范围,从而避免自动驾驶车辆的状态在较大范围内变动,例如减少加速度变动,从而减少自动驾驶车辆能量消耗,减小对自动驾驶车辆的状态改变范围,提高自动驾驶的舒适性。
附图说明
为了更清楚地说明本申请实施例的技术方法,下面将对实施例中所需使用的附图作以简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请实施例提供的一种车辆控制方法的流程示意图;
图2为本申请实施例提供的一种模型预估控制算法预测tk时刻示意图;
图3为本申请实施例提供的一种车辆控制装置的结构示意图。
具体实施方式
下面将结合本申请中的附图,对本申请提供的实施例中的方案进行描述。
本申请实施例中的术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个该特征。
首先对本申请实施例中所涉及到的一些技术术语进行介绍。
传统的PID控制适用于基本线性,且动态特性不随时间变化的系统,而随着自动驾驶技术的日趋成熟,对于车辆的动态控制要求越来越高,传统的PID控制既不能很好的处理控制延时,也无法处理约束条件在控制中的使用。因此,在实际的自动驾驶车辆控制中,模型预估控制理论被越来越多的使用。它拥有处理约束条件的优势,将长时间跨度的最优化控制问题分解为有限时间跨度的最优化控制问题,是自动驾驶控制中体现约束条件的理想方法。
模型预估控制主要包括三种元素:预测模型、在线滚动优化和反馈校正。其中,预测模型用于根据车辆的模型、车辆的历史信息以及未来输入,预测系统的未来状态,车辆模型可以是状态方程、传递函数或者响应模型等。在线滚动优化是指模型预估控制通过设计性能指标,即代价函数,按照某种优化算法,例如二次型优化,来进行反复在线最优化控制设计,计算出满足约束条件的最优控制序列。反馈矫正是指在每次新的采样时刻,使用模型预估控制计算的最优控制序列,检测自动驾驶车辆的实际状态,对预测结果进行修正,进行新一轮的最优化控制。
如此,经过滚动优化过程,模型预估控制可以产生满足控制输入约束条件的控制指令,用于自动驾驶车辆的动态控制。
但是,在传统的模型预估控制中,控制输入的约束条件是固定的范围。例如加速度在[-1g,1g]范围内,方向盘扭矩在[-3Nm,3Nm]范围内。然而,这样的固定范围的约束条件,无法体现出不同车辆的特性。而且如果在每个控制周期内,能够减小控制输入的约束条件范围,那么可以减小对自动驾驶车辆的状态改变范围,提高自动驾驶的舒适性。同时,减少控制输入的约束条件范围可以减少自动驾驶车辆能量消耗。
具体地,因为车辆中的控制输入通常为方向盘转矩、油门踏板、制动踏板,因此,减少控制输入的约束条件范围,即让模型预估控制器确定的方向盘转矩、油门踏板深度、制动踏板深度较小,依然也可以满足控制指标的要求。而较小的方向盘转矩、油门踏板、制动踏板意味着控制器需求的EPS电流小、发动机喷油量小、ESP制动电流小,进而导致控制器对执行器的能量需求变小。
因此,本申请提供了一种车辆控制方法,该方法可以应用于控制器,通过控制器对车辆进行控制。可选的,其中控制器可以为电子控制单元。
电子控制单元(Electronic Control Unit,ECU)是指由集成电路组成的用于实现对数据的分析处理发送等一系列功能的控制装置。电子控制单元通常包括输入电路、A/D(模/数)转换器、微型计算器和输出电路等多个组成部分。
电子控制单元的主要功能包括:接收传感器或其他装置的输入信号,并将输入信号处理成计算机能够接收的信号;为传感器提供参考电压;存储、计算、分析处理信息,存储运行信息和故障信息,分析输入信息,分析输入信息并进行相应的计算处理;输出执行命令,把信号变为强信号的执行命令;输出故障信息;完成多种控制功能等。
具体地,在本申请中,控制器通过模型预估控制算法预测车辆在未来N个控制周期的状态,根据车辆在未来N个控制周期的状态,求解在当前控制周期内控制输入约束的最小值,根据在当前控制周期内控制输入约束的最小值,利用模型预估控制算法,确定最优控制序列,其中控制序列包括当前控制周期内满足最优控制输入约束的最优控制输入值,最后向执行器发送当前控制周期内控制输入的最优值,以指示执行器按照控制输入的最优值执行。
该方法通过控制器计算当前控制周期内控制输入约束的最小值,利用该模型预估控制算法确定最优控制序列,其中控制序列包括当前控制周期内满足最优控制输入约束的最优控制输入值,指示执行器按照控制输入的最优值执行控制。从而在每个控制周期内,减小控制输入的约束条件范围,减少自动驾驶车辆能量消耗,同时提高自动驾驶的舒适性。
为了便于理解,下面结合附图对本申请实施例提供的车辆的控制方法进行介绍。
参见图1所示的车辆的控制方法的流程图,该方法包括:
S102:模型预估控制器通过模型预估控制算法预测车辆在未来N个控制周期的状态。
其中,控制周期的状态包括车辆到车道中心线的距离和/或航向角。
在自动驾驶车辆的控制中,例如横纵向控制中,由于信号传输速度、执行器响应速度等会造成延时,会对系统的性能产生较大影响,故通常使用模型预估控制。具体地,在模型预估控制中,采用车辆运动学或动力学模型,其中模型预估控制的设计目标为确定自动驾驶车辆的加速度和方向盘转角,使系统状态的稳态趋近于目标参考值,这样可保证自动驾驶车辆的横纵向位置、速度以及航向角跟踪上目标参考值。
更具体地,在带有约束条件的模型预估控制中,首先对自动驾驶车辆的状态空间模型进行离散化,得到系统在离散状态下的空间表达如式(1)所示,其中对于不同车辆动力学或者运动学模型的选择均不影响本方法的有效性。
x(k+1)=Ax(k)+Bu(k), x(0)=x0 (1)
其中,x∈Rn×1,A∈Rn×n,B∈Rn×m,u∈Rm×1。
如图2所示,其中N为模型预估控制的预测时域,则在任意tk时刻,可以通过设计控制输入量uk,uk+1,…,uk+1-N,来最小化tk到tk+N之间代价函数的总和,那么对于未来每一个tk+j时刻,该时刻的子代价函数可以写为:
其中,Q=Q'≥0,Q∈Rn×n,Q为半正定矩阵;R=R'>0,R∈Rm×m,R为正定矩阵;表示tk+j时刻,自动驾驶车辆状态期望值;/>表示tk+j时刻,自动驾驶车辆控制输入期望值;uk+j表示tk+j时刻,自动驾驶车辆实际的控制输入值,即模型预估控制求解变量;xk+j|k表示基于当前系统状态xk和未来控制输入uk,…,uk+j-1,计算得到的tk+j时刻系统状态的预测值。
在一些可能的实现方式中,系统的状态可以选取为车辆距车道中心线的横向距离/误差、航向角/误差等,因此系统的状态期望值为上述状态的期望值,例如系统的状态期望值为横向距离车道中心线0.02cm,航向角为15°。系统的控制输入一般选取为方向盘转角、油门踏板开度、制动减速度等,这些量表征对车辆的控制输入,因此控制输入期望值为上述控制量的期望值,例如系统的控制输入期望值为方向盘转角8°,油门踏板深度15%。
因此,在预测时域N内,将tk时刻总代价函数定义为全部子代价函数之和,则有:
J=jk+1(xk+1|k,uk+1)+…+jk+1(xk+N-1|k,uk+N-1)+jk+N(xk+N|k) (3)
其中,将定义为:
并将子代价函数带入总代价函数,经过整理可得:
其中:和/>为对角矩阵,即:
根据系统在离散状态下的空间表达式(1),以及已知的系统状态xk,预测在tk到tk+N之间的系统状态xk+j|k,如图2所示,则有:
xk+j|k=Ajxk+Aj-1Buk+Aj-2Buk+1+…+Buk+j-1 (5)
根据总代价函数的定义(3)以及对于tk到tk+N之间的系统状态xk+j|k的预测(5),则可以得到系统预测时域内的状态预测值
其中
将系统的状态预测值带入总代价函数Jk,经过整理后,可以得到
其中
由此,控制器可以通过模型预估控制算法预测车辆在未来N个控制周期的状态。
S104:控制器根据车辆在未来N个控制周期的状态,求解车辆在当前控制周期内控制输入约束的最小值。
具体地,根据车辆在未来N个控制周期的状态,通过线性规划求解车辆在当前控制周期内控制输入约束的最小值。
其中,上述控制输入约束包括加速度约束、方向盘转角约束中的至少一种。
通常系统的控制输入不会允许随意选择,会有幅值限值,即需要满足:在tk时刻,约束条件均成立。对这个约束条件进行等价改写可得:
且/>即:Θuk≤θ。
其中
因此,在tk时刻,预测时域N内,将系统未来每个采样时刻的输入uk,uk+1,…,uk+1-N综合到一起后,模型预估控制的约束条件可以写为:
其中,
而在本申请提供的方案中,可以将模型预估控制的约束条件改写为:其中,
即:
如果系统的状态变量选择为误差,则在模型预估控制中预测周期终值应该为0,即:xk+N|k=0。系统的状态一般可选取为车辆距车道中心线的横向距离/误差、航向角/误差。如果系统的状态变量选择为距车道中心线的横向误差以及航向角误差,那么希望车辆控制的最终状态为居于车道中心线且航向角与道路相通,因此最终控制目标,即模型预估控制中的预测终值的物理含义可表述为要求车辆距离中心线的误差为0,与道路的航向角误差为0。
考虑到线性系统具有线性平移特性,即使状态选择不为误差(例如车辆横向距离,航向角),也可以通过线性变换,转换为系统状态为误差量的等效线性模型,故xk+N|k=0具有广泛的实用性,预测周期终值也可以选择为其他任意值,不影响本方法的有效性.
根据离散状态空间的解(5),可以确定预测周期终值xk+N|k:
xk+N|k=ANxk+AN-1Buk+AN-2Buk+1+…+Buk+N-1 (10)
即:
这样,求解最小的控制约束条件问题转化为寻找控制周期内控制输入约束的最小的
使同时满足式(9)(11)的约束,即:
其中,Eeq=(AN-1 … AB B 02m×1),eeq=-ANx,f'=(0N×11 0(2m-1)×1)。
对于上述线性规划问题,在一些可能的实现方式中,可以通过成熟的数学工具,例如内点法,LPSolve等来对线性规划求解,因此可以确定在tk时刻,控制输入约束的最小值
S206:控制器根据车辆在当前控制周期内控制输入约束的最小值,利用模型预估控制算法,确定最优控制序列,控制序列包括当前控制周期内满足最优控制输入约束的最优控制输入值。
在一些可能的实现方式中,带有控制变量约束条件的模型预估控制中的最优控制序列可以确定为:
其中,αk与待优化的控制输入量不相关,因此可以将其在最优控制序列中省去,不会影响/>的优化求解。所以可以继续将最优控制序列改写为:
其中,在一些可能的实现方式中,对式(8)的求解方法可以选取成熟的数学工具,例如qpOASES,因此可以确定解从而获得当前控制周期内满足最优输入约束的最优控制输入值/>
S108:控制器向执行器发送当前控制周期内满足最优控制输入约束的最优控制输入值,以指示执行器按照控制输入的最优值执行。
当确定最优控制输入后,模型预估控制器使用/>作为无人驾驶车辆在tk时刻的控制输入,传递给执行器,控制无人驾驶车辆(例如加速度、方向盘转角)。
当到达下一控制周期时,再次执行通过模型预估控制算法预测车辆在未来N个控制周期的状态,根据车辆在未来N个控制周期的状态,求解车辆在当前控制周期内控制输入约束的最小值,根据车辆在当前控制周期内控制输入约束的最小值,利用模型预估控制算法,确定最优控制序列,以及向执行器发送当前控制周期内控制输入的最优值的步骤。此过程体现了模型预估控制中的滚动优化特性。
与上述方法实施例相对应的,本申请还提供了一种车辆控制装置,参见图3,该装置300包括:预测模块302、求解模块304、确定模块306或发送模块308。其中,
预测模块302,用于通过模型预估控制算法预测车辆在未来N个控制周期的状态,N为正整数;
求解模块304,用于根据车辆在未来N个控制周期的状态,求解车辆在当前控制周期内控制输入约束的最小值;
确定模块306,用于根据车辆在当前控制周期内控制输入约束的最小值,利用模型预估控制算法,确定最优控制序列,控制序列包括当前控制周期内满足最优控制输入约束的最优控制输入值;
发送模块308,用于向执行器发送当前控制周期内控制输入的最优值,以指示执行器按照控制输入的最优值执行。
在一些可能的实现方式中,装置还用于:
当到达下一控制周期时,再次执行通过模型预估控制算法预测车辆在未来N个控制周期的状态,根据车辆在未来N个控制周期的状态,求解车辆在当前控制周期内控制输入约束的最小值,根据车辆在当前控制周期内控制输入约束的最小值,利用模型预估控制算法,确定最优控制序列,以及向执行器发送当前控制周期内控制输入的最优值的步骤。
在一些可能的实现方式中,预测模块302,具体用于:
根据车辆在未来N个控制周期的状态,通过线性规划求解车辆在当前控制周期内控制输入约束的最小值。
在一些可能的实现方式中,状态包括车辆到车道中心线的距离和/或航向角。
在一些可能的实现方式中,控制输入约束包括加速度约束、方向盘转角约束中的至少一种。
另外需说明的是,以上所描述的装置实施例仅仅是示意性的,其中作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。另外,本申请提供的装置实施例附图中,模块之间的连接关系表示它们之间具有通信连接,具体可以实现为一条或多条通信总线或信号线。
通过以上的实施方式的描述,所属领域的技术人员可以清楚地了解到本申请可借助软件加必需的通用硬件的方式来实现,当然也可以通过专用硬件包括专用集成电路、专用CPU、专用存储器、专用元器件等来实现。一般情况下,凡由计算机程序完成的功能都可以很容易地用相应的硬件来实现,而且,用来实现同一功能的具体硬件结构也可以是多种多样的,例如模拟电路、数字电路或专用电路等。但是,对本申请而言更多情况下软件程序实现是更佳的实施方式。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品存储在可读取的存储介质中,如计算机的软盘、U盘、移动硬盘、ROM、RAM、磁碟或者光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,训练设备,或者网络设备等)执行本申请各个实施例的方法。
Claims (8)
1.一种车辆控制方法,其特征在于,所述方法包括:
通过模型预估控制算法预测车辆在未来N个控制周期的状态,所述N为正整数;
根据所述车辆在未来N个控制周期的状态,求解所述车辆在当前控制周期内控制输入约束的最小值;
根据所述车辆在当前控制周期内控制输入约束的最小值,利用所述模型预估控制算法,确定最优控制序列,所述控制序列包括当前控制周期内满足最优控制输入约束的最优控制输入值;
向执行器发送当前控制周期内满足最优控制输入约束的最优控制输入值,以指示所述执行器按照所述控制输入的最优值执行;
当到达下一控制周期时,再次执行所述通过模型预估控制算法预测车辆在未来N个控制周期的状态,根据所述车辆在未来N个控制周期的状态,求解所述车辆在当前控制周期内控制输入约束的最小值,根据所述车辆在当前控制周期内控制输入约束的最小值,利用所述模型预估控制算法,确定最优控制序列,以及向执行器发送当前控制周期内控制输入的最优值的步骤。
2.根据权利要求1所述的方法,其特征在于,所述根据所述车辆在未来N个控制周期的状态,求解所述车辆在当前控制周期内控制输入约束的最小值,包括:
根据所述车辆在未来N个控制周期的状态,通过线性规划求解所述车辆在当前控制周期内控制输入约束的最小值。
3.根据权利要求1至2任一项所述的方法,其特征在于,所述状态包括所述车辆到车道中心线的距离和/或航向角。
4.根据权利要求1至2任一项所述的方法,其特征在于,所述控制输入约束包括加速度约束、方向盘转角约束中的至少一种。
5.一种车辆控制装置,其特征在于,所述装置包括:
预测模块,用于通过模型预估控制算法预测车辆在未来N个控制周期的状态,所述N为正整数;
求解模块,用于根据所述车辆在未来N个控制周期的状态,求解所述车辆在当前控制周期内控制输入约束的最小值;
确定模块,用于根据所述车辆在当前控制周期内控制输入约束的最小值,利用所述模型预估控制算法,确定最优控制序列,所述控制序列包括当前控制周期内满足最优控制输入约束的最优控制输入值;
发送模块,用于向执行器发送当前控制周期内满足最优控制输入约束的最优控制输入值,以指示所述执行器按照所述控制输入的最优值执行;
当到达下一控制周期时,再次执行所述通过模型预估控制算法预测车辆在未来N个控制周期的状态,根据所述车辆在未来N个控制周期的状态,求解所述车辆在当前控制周期内控制输入约束的最小值,根据所述车辆在当前控制周期内控制输入约束的最小值,利用所述模型预估控制算法,确定最优控制序列,以及向执行器发送当前控制周期内控制输入的最优值的步骤。
6.根据权利要求5所述的装置,其特征在于,所述预测模块,具体用于:
根据所述车辆在未来N个控制周期的状态,通过线性规划求解所述车辆在当前控制周期内控制输入约束的最小值。
7.根据权利要求5至6任一项所述的装置,其特征在于,所述状态包括所述车辆到车道中心线的距离和/或航向角。
8.根据权利要求5至6任一项所述的装置,其特征在于,所述控制输入约束包括加速度约束、方向盘转角约束中的至少一种。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011301654.XA CN114516342B (zh) | 2020-11-19 | 2020-11-19 | 一种车辆控制方法、装置及车辆 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011301654.XA CN114516342B (zh) | 2020-11-19 | 2020-11-19 | 一种车辆控制方法、装置及车辆 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114516342A CN114516342A (zh) | 2022-05-20 |
CN114516342B true CN114516342B (zh) | 2024-05-03 |
Family
ID=81594418
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011301654.XA Active CN114516342B (zh) | 2020-11-19 | 2020-11-19 | 一种车辆控制方法、装置及车辆 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114516342B (zh) |
Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103754224A (zh) * | 2014-01-24 | 2014-04-30 | 清华大学 | 一种车辆多目标协调换道辅助自适应巡航控制方法 |
WO2015190205A1 (ja) * | 2014-06-10 | 2015-12-17 | トヨタ自動車株式会社 | 制御装置 |
CN107738644A (zh) * | 2017-09-30 | 2018-02-27 | 长安大学 | 一种车辆避碰控制方法 |
CN108045373A (zh) * | 2017-09-11 | 2018-05-18 | 同济大学 | 一种自动驾驶纵向统一规划方法及系统 |
CN108248605A (zh) * | 2018-01-23 | 2018-07-06 | 重庆邮电大学 | 一种智能车辆轨迹跟随的横纵向协调控制方法 |
CN108583576A (zh) * | 2018-03-02 | 2018-09-28 | 南京航空航天大学 | 一种车辆经济学车速前瞻优化方法 |
CN108725585A (zh) * | 2017-04-14 | 2018-11-02 | 上海汽车集团股份有限公司 | 车辆自主泊车的轨迹跟踪控制方法及装置 |
CN109978025A (zh) * | 2019-03-11 | 2019-07-05 | 浙江工业大学 | 一种基于高斯过程回归的智能网联车辆前车加速度预测方法 |
DE102019201124A1 (de) * | 2018-02-07 | 2019-08-14 | Jaguar Land Rover Limited | Ein System für ein Fahrzeug |
CN110386145A (zh) * | 2019-06-28 | 2019-10-29 | 北京理工大学 | 一种目标驾驶员驾驶行为实时预测系统 |
WO2020008785A1 (ja) * | 2018-07-02 | 2020-01-09 | 日立オートモティブシステムズ株式会社 | 予測制御装置 |
CN110816528A (zh) * | 2018-08-08 | 2020-02-21 | 丰田自动车工程及制造北美公司 | 用于自主系统中嵌入式实时受约束最优控制问题的求解器 |
CN111338346A (zh) * | 2020-03-05 | 2020-06-26 | 中国第一汽车股份有限公司 | 一种自动驾驶控制方法、装置、车辆及存储介质 |
CN111413966A (zh) * | 2020-03-12 | 2020-07-14 | 天津大学 | 一种递进式模型预测无人驾驶规划跟踪协同控制方法 |
CN111717282A (zh) * | 2020-07-07 | 2020-09-29 | 中国人民解放军国防科技大学 | 一种基于模型预测控制的人机共享驾驶辅助转向方法 |
CN111891116A (zh) * | 2020-08-07 | 2020-11-06 | 苏州挚途科技有限公司 | 一种提升自动驾驶横向控制稳定性的方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11794757B2 (en) * | 2018-06-11 | 2023-10-24 | Colorado State University Research Foundation | Systems and methods for prediction windows for optimal powertrain control |
US10860023B2 (en) * | 2018-06-25 | 2020-12-08 | Mitsubishi Electric Research Laboratories, Inc. | Systems and methods for safe decision making of autonomous vehicles |
KR102138979B1 (ko) * | 2018-11-29 | 2020-07-29 | 한국과학기술원 | 차선 기반의 확률론적 주변 차량 거동 예측 및 이를 이용한 종방향 제어 방법 |
US11834058B2 (en) * | 2019-01-04 | 2023-12-05 | Toyota Research Institute, Inc. | Systems and methods for controlling a vehicle based on vehicle states and constraints of the vehicle |
US10996639B2 (en) * | 2019-03-11 | 2021-05-04 | Mitsubishi Electric Research Laboratories, Inc. | Model predictive control of systems with continuous and discrete elements of operations |
-
2020
- 2020-11-19 CN CN202011301654.XA patent/CN114516342B/zh active Active
Patent Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103754224A (zh) * | 2014-01-24 | 2014-04-30 | 清华大学 | 一种车辆多目标协调换道辅助自适应巡航控制方法 |
WO2015190205A1 (ja) * | 2014-06-10 | 2015-12-17 | トヨタ自動車株式会社 | 制御装置 |
CN108725585A (zh) * | 2017-04-14 | 2018-11-02 | 上海汽车集团股份有限公司 | 车辆自主泊车的轨迹跟踪控制方法及装置 |
CN108045373A (zh) * | 2017-09-11 | 2018-05-18 | 同济大学 | 一种自动驾驶纵向统一规划方法及系统 |
CN107738644A (zh) * | 2017-09-30 | 2018-02-27 | 长安大学 | 一种车辆避碰控制方法 |
CN108248605A (zh) * | 2018-01-23 | 2018-07-06 | 重庆邮电大学 | 一种智能车辆轨迹跟随的横纵向协调控制方法 |
DE102019201124A1 (de) * | 2018-02-07 | 2019-08-14 | Jaguar Land Rover Limited | Ein System für ein Fahrzeug |
CN108583576A (zh) * | 2018-03-02 | 2018-09-28 | 南京航空航天大学 | 一种车辆经济学车速前瞻优化方法 |
WO2020008785A1 (ja) * | 2018-07-02 | 2020-01-09 | 日立オートモティブシステムズ株式会社 | 予測制御装置 |
CN110816528A (zh) * | 2018-08-08 | 2020-02-21 | 丰田自动车工程及制造北美公司 | 用于自主系统中嵌入式实时受约束最优控制问题的求解器 |
CN109978025A (zh) * | 2019-03-11 | 2019-07-05 | 浙江工业大学 | 一种基于高斯过程回归的智能网联车辆前车加速度预测方法 |
CN110386145A (zh) * | 2019-06-28 | 2019-10-29 | 北京理工大学 | 一种目标驾驶员驾驶行为实时预测系统 |
CN111338346A (zh) * | 2020-03-05 | 2020-06-26 | 中国第一汽车股份有限公司 | 一种自动驾驶控制方法、装置、车辆及存储介质 |
CN111413966A (zh) * | 2020-03-12 | 2020-07-14 | 天津大学 | 一种递进式模型预测无人驾驶规划跟踪协同控制方法 |
CN111717282A (zh) * | 2020-07-07 | 2020-09-29 | 中国人民解放军国防科技大学 | 一种基于模型预测控制的人机共享驾驶辅助转向方法 |
CN111891116A (zh) * | 2020-08-07 | 2020-11-06 | 苏州挚途科技有限公司 | 一种提升自动驾驶横向控制稳定性的方法 |
Non-Patent Citations (2)
Title |
---|
基于串级MPC和EPS的集成驾驶员转向车道线保持;房泽平;段建民;;北京工业大学学报(01);第125-133页 * |
基于模型预测控制的车辆轨迹跟踪稳定性研究;宋晓华;邵毅明;屈治华;束海波;;重庆理工大学学报(自然科学)(08);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114516342A (zh) | 2022-05-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Feng et al. | Robust platoon control in mixed traffic flow based on tube model predictive control | |
JP6808093B2 (ja) | システムを制御する予測コントローラ、車両及び方法 | |
CN110775154B (zh) | 一种电动卡车线控转向系统及其网络不确定控制方法 | |
CN107139923B (zh) | 一种acc决策方法及系统 | |
WO2021240905A1 (en) | Nonlinear optimization method for stochastic predictive control | |
Al-Gabalawy et al. | Model predictive control for a basic adaptive cruise control | |
Chu et al. | Optimal car-following control for intelligent vehicles using online road-slope approximation method | |
CN115598983B (zh) | 一种考虑时变时延的无人车横纵向协同控制方法及装置 | |
Liu et al. | Scalable computation of controlled invariant sets for discrete-time linear systems with input delays | |
Zheng et al. | Varying zonotopic tube RMPC with switching logic for lateral path tracking of autonomous vehicle | |
CN114516342B (zh) | 一种车辆控制方法、装置及车辆 | |
Bai et al. | AutoE2E: End-to-end real-time middleware for autonomous driving control | |
Wang et al. | Path Tracking Method Based on Model Predictive Control and Genetic Algorithm for Autonomous Vehicle | |
Chang et al. | Quantized Fuzzy Feedback Control for Electric Vehicle Lateral Dynamics | |
CN116366685A (zh) | 车辆的通信计算系统确定方法 | |
Hu et al. | A model predictive control based path tracker in mixed-domain | |
CN113561976B (zh) | 基于反馈优化的车辆节能预测自适应巡航控制方法和装置 | |
Malikopoulos et al. | A real-time computational learning model for sequential decision-making problems under uncertainty | |
Zhenhai et al. | A headway control algorithm for ACC vehicles with the compensation of the preceding vehicle acceleration | |
CN117341721A (zh) | 车辆自动循迹控制方法、装置及电子设备 | |
Boyle et al. | Multi Time-Scale Engine and Powertrain Control for Autonomous Vehicles Via Lagrange Multipliers | |
Cai et al. | Trajectory tracking control for autonomous parking based on adaptive reduced-horizon model predictive control | |
Korus et al. | Robust design of a complex, perturbed lateral control system for automated driving | |
Zhang et al. | Self-tuning Speed Tracking for Autonomous Vehicles Based on Cascaded GRU Predictive Control | |
Chen et al. | LSTM-based trajectory tracking control for autonomous vehicles |
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 |