CN112406890A - 基于动力学的车辆预测控制方法及处理器 - Google Patents
基于动力学的车辆预测控制方法及处理器 Download PDFInfo
- Publication number
- CN112406890A CN112406890A CN201910780958.XA CN201910780958A CN112406890A CN 112406890 A CN112406890 A CN 112406890A CN 201910780958 A CN201910780958 A CN 201910780958A CN 112406890 A CN112406890 A CN 112406890A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- state quantity
- parameters
- moment
- parameter
- 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.)
- Granted
Links
Images
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
- 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/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0004—In digital systems, e.g. discrete-time systems involving sampling
- B60W2050/0005—Processor details or data handling, e.g. memory registers or chip architecture
-
- 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
- B60W2050/0028—Mathematical models, e.g. for simulation
- B60W2050/0031—Mathematical model of the vehicle
Abstract
本发明实施例公开了一种基于动力学的车辆预测控制方法及处理器。该方法包括:获取第一时刻的车辆状态量,获取第二时刻的车辆状态量以及第二时刻的车辆控制量;将第一时刻的车辆状态量作为实际状态量,根据预测状态量与实际状态量之间的差异,对车辆参数进行修改,得到修改后车辆参数;当修改后车辆参数相对于该车辆参数满足收敛条件时,根据修改后车辆参数更新该车辆参数;基于MPC模块中包含更新后车辆参数的车辆动力学预测模型和第一时刻的车辆状态量,确定第一时刻的车辆控制量。应用本发明实施例提供的方案,能够确定出更精确的车辆参数,提高模型预测的控制量的准确性。
Description
技术领域
本发明涉及智能驾驶技术领域,具体而言,涉及一种基于动力学的车辆预测控制方法及处理器。
背景技术
在智能驾驶的底层控制方法中,模型预测控制(Model Predictive Control,MPC)作为一种致力于解决对未来有限时间内最优的控制策略被提出。它可以通过预测未来一段时间的状态量,加上对控制量的约束,从而达到较快的动态响应和较好的控制平滑性。
按照车辆模型不同,MPC可分为基于车辆运动学预测模型和基于车辆动力学预测模型的控制。在路面情况未知或者车辆高速行驶时,倾向于采用基于动力学预测模型的MPC控制器来考虑车辆的动力学约束。
在以往基于车辆动力学预测模型的MPC控制方案中,车辆动力学预测模型含有很多车辆参数,例如轮胎的纵向刚度Cl、横向刚度Cc、与路面情况有关的纵向滑移率s、车辆的质量m和车辆绕z轴的转动惯量Iz等。上述车辆参数的不确定性会造成模型预测的控制量不准确,从而造成对车辆控制时的性能下降。
发明内容
本发明提供了一种基于动力学的车辆预测控制方法及处理器,以确定出更精确的车辆参数,提高模型预测的控制量的准确性。具体的技术方案如下。
第一方面,本发明实施例公开了一种基于动力学的车辆预测控制方法,包括:
获取第一时刻的车辆状态量,获取第二时刻的车辆状态量以及第二时刻的车辆控制量;其中,所述第二时刻为所述第一时刻的前一时刻,所述第二时刻的车辆控制量为:基于模型预测控制MPC模块中包含车辆参数的车辆动力学预测模型和所述第二时刻的车辆状态量确定;
根据预测状态量与实际状态量之间的差异,对所述车辆参数进行修改,得到修改后车辆参数;其中,所述实际状态量为所述第一时刻的车辆状态量,所述预测状态量为:根据所述第二时刻的车辆状态量、第二时刻的车辆控制量以及包含所述车辆参数的车辆动力学预测模型确定的车辆状态量;
当所述修改后车辆参数相对于所述车辆参数满足收敛条件时,根据所述修改后车辆参数更新所述车辆参数;
基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量。
可选的,所述根据预测状态量与实际状态量之间的差异,对所述车辆参数进行修改,得到修改后车辆参数的步骤,包括:
获取确定所述车辆参数时所述车辆参数的置信度;
根据所述预测状态量与实际状态量之间的差异,以及所述车辆参数的置信度,采用最小二乘参数辨识算法对所述车辆参数进行修改,得到修改后车辆参数。
可选的,所述根据所述预测状态量与实际状态量之间的差异,以及所述车辆参数的置信度,采用最小二乘参数辨识算法对所述车辆参数进行修改,得到修改后车辆参数的步骤,包括:
根据以下公式,对所述车辆参数进行修改,得到修改后车辆参数:
所述第二时刻的车辆状态量包括车辆位置[x(k-1),y(k-1)]以及车辆朝向角所述第一时刻的车辆状态量包括车辆位置[x(k),y(k)]以及车辆朝向角为所述第二时刻的车辆控制量包括前轮偏转角δf(k-1),所述a和b分别为车辆质心到车辆前轴和后轴的距离,所述Ts为所述第一时刻与第二时刻之间的时间间隔,所述T为矩阵转置符号,所述φ(k)、和Y(k)为从预测模型公式中得到。
所述Cc和Cl分别为车辆轮胎的横向刚度和纵向刚度,所述s为所述车辆与路面之间的纵向滑移率,所述w和h分别为车辆宽度和车辆长度,所述m为车辆质量。
获取车辆动力学预测模型的原理公式:
可选的,采用以下方式确定所述修改后车辆参数相对于所述车辆参数是否满足收敛条件:
当所述修改后车辆参数与所述车辆参数的差值绝对值小于预设阈值时,确定所述修改后车辆参数相对于所述车辆参数满足收敛条件。
可选的,所述基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量的步骤,包括:
基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定包含待优化控制量的待优化预测状态量;
获取所述车辆的行驶状态参考量,确定所述状态量偏差与所述待优化控制量之间的和值,对所述待优化控制量和所述待优化预测状态量进行修改,当所述和值取最小值时,将修改后的待优化控制量确定为第一时刻的车辆控制量;其中,所述状态量偏差为所述待优化预测状态量与所述行驶状态参考量之间的偏差。
可选的,当所述修改后车辆参数相对于所述车辆参数不满足收敛条件时,所述方法还包括:
基于所述MPC模块中包含所述车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量;
所述方法还包括:
当确定所述第一时刻的车辆控制量之后,基于所述第一时刻的车辆控制量对所述车辆进行控制。
第二方面,本发明实施例公开了一种车载终端中的处理器,所述处理器包括:
获取模块,用于获取第一时刻的车辆状态量,获取第二时刻的车辆状态量以及第二时刻的车辆控制量;其中,所述第二时刻为所述第一时刻的前一时刻,所述第二时刻的车辆控制量为:基于模型预测控制MPC模块中包含车辆参数的车辆动力学预测模型和所述第二时刻的车辆状态量确定;
修改模块,用于根据预测状态量与实际状态量之间的差异,对所述车辆参数进行修改,得到修改后车辆参数;其中,所述实际状态量为所述第一时刻的车辆状态量,所述预测状态量为:根据所述第二时刻的车辆状态量、第二时刻的车辆控制量以及包含所述车辆参数的车辆动力学预测模型确定的车辆状态量;
更新模块,用于当所述修改后车辆参数相对于所述车辆参数满足收敛条件时,根据所述修改后车辆参数更新所述车辆参数;
确定模块,用于基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量。
可选的,所述修改模块,具体用于:
获取确定所述车辆参数时所述车辆参数的置信度;
根据所述预测状态量与实际状态量之间的差异,以及所述车辆参数的置信度,采用最小二乘参数辨识算法对所述车辆参数进行修改,得到修改后车辆参数。
可选的,所述修改模块,根据所述预测状态量与实际状态量之间的差异,以及所述车辆参数的置信度,采用最小二乘参数辨识算法对所述车辆参数进行修改,得到修改后车辆参数时,包括:
根据以下公式,对所述车辆参数进行修改,得到修改后车辆参数:
所述第二时刻的车辆状态量包括车辆位置[x(k-1),y(k-1)]以及车辆朝向角所述第一时刻的车辆状态量包括车辆位置[x(k),y(k)]以及车辆朝向角为所述第二时刻的车辆控制量包括前轮偏转角δf(k-1),所述a和b分别为车辆质心到车辆前轴和后轴的距离,所述Ts为所述第一时刻与第二时刻之间的时间间隔,所述T为矩阵转置符号,所述φ(k)、和Y(k)为从预测模型公式中得到。
所述Cc和Cl分别为车辆轮胎的横向刚度和纵向刚度,所述s为所述车辆与路面之间的纵向滑移率,所述w和h分别为车辆宽度和车辆长度,所述m为车辆质量。
获取车辆动力学预测模型的原理公式:
可选的,所述处理器还包括:判断模块,用于采用以下操作确定所述修改后车辆参数相对于所述车辆参数是否满足收敛条件:
当所述修改后车辆参数与所述车辆参数的差值绝对值小于预设阈值时,确定所述修改后车辆参数相对于所述车辆参数满足收敛条件。
可选的,所述确定模块,具体用于:
基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定包含待优化控制量的待优化预测状态量;
获取所述车辆的行驶状态参考量,确定所述状态量偏差与所述待优化控制量之间的和值,对所述待优化控制量和所述待优化预测状态量进行修改,当所述和值取最小值时,将修改后的待优化控制量确定为第一时刻的车辆控制量;其中,所述状态量偏差为所述待优化预测状态量与所述行驶状态参考量之间的偏差。
可选的,所述确定模块还用于:
当所述修改后车辆参数相对于所述车辆参数不满足收敛条件时,基于所述MPC模块中包含所述车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量;
所述处理器还包括:
发送模块,用于当确定所述第一时刻的车辆控制量之后,将所述第一时刻的车辆控制量发送至车载终端中的控制模块,以使控制模块基于所述第一时刻的车辆控制量对所述车辆进行控制。
由上述内容可知,本发明实施例提供的基于动力学的车辆预测控制方法及处理器中,由于预测状态量为根据前一时刻的车辆状态量、前一时刻的车辆控制量以及包含车辆参数的车辆动力学预测模型确定,因此可以根据预测状态量与实际状态量之间的差异对车辆参数进行修改,得到更精确的车辆参数,基于更精确的车辆参数能够确定更准确的车辆控制量。因此本发明实施例能够确定出更精确的车辆参数,提高模型预测的控制量的准确性。当然,实施本发明的任一产品或方法并不一定需要同时达到以上所述的所有优点。
本发明实施例的创新点包括:
1、根据车辆状态量,MPC模块能够预测下一时刻的车辆控制量,利用下一时刻车辆实际的状态量与MPC在预测车辆控制量时的预测状态量之间的差异,能够对MPC中的车辆参数进行修改,确定更精确的车辆参数,进而确定更准确的车辆控制量。
2、采用最小二乘参数辨识算法,对车辆动力学预测模型的车辆参数进行修改,能够得到更精确的车辆参数,为修改车辆参数提供了可实施的方式。
3、提供了采用最小二乘参数辨识的具体公式,为对车辆参数进行修改,提供了可实施的方式。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单介绍。显而易见地,下面描述中的附图仅仅是本发明的一些实施例。对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的基于动力学的车辆预测控制方法的一种流程示意图;
图2为本发明实施例提供的MPC的一种内部结构示意图;
图3为全局坐标系XOY与车体坐标系xy的一种关系示意图;
图4为本发明实施例提供的车载终端中的处理器的一种结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整的描述。显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有付出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明的是,本发明实施例及附图中的术语“包括”和“具有”以及它们的任何变形,意图在于覆盖不排他的包含。例如包含的一系列步骤或单元的过程、方法、系统、产品或设备没有限定于已列出的步骤或单元,而是可选地还包括没有列出的步骤或单元,或可选地还包括对于这些过程、方法、产品或设备固有的其他步骤或单元。
本发明实施例公开了一种基于动力学的车辆预测控制方法及处理器,能够确定出更精确的车辆参数,提高模型预测的控制量的准确性。下面对本发明实施例进行详细说明。
图1为本发明实施例提供的基于动力学的车辆预测控制方法的一种流程示意图。该方法应用于电子设备。该电子设备可以为普通计算机、服务器或者智能终端设备等,也可以为车载电脑或车载工业控制计算机(Industrial Personal Computer,IPC)等车载终端,模型预测控制(Model Predictive Control,MPC)模块也可以设置于该车载终端中。MPC模块可以位于执行主体电子设备内,也可以位于除该电子设备之外的其他电子设备中。该方法具体包括以下步骤。
S110:获取第一时刻的车辆状态量,获取第二时刻的车辆状态量以及第二时刻的车辆控制量。
其中,第二时刻为第一时刻的前一时刻。第一时刻可以理解为当前时刻,第二时刻可以理解为前一时刻。车辆预测控制是周期性执行的,第二时刻和第一时刻分别可以为连续的两次车辆预测控制时刻。
第二时刻的车辆控制量为:基于MPC模块中包含车辆参数的车辆动力学预测模型和第二时刻的车辆状态量确定。由于将第二时刻的车辆状态量输入MPC模块后,MPC模块能够基于包含车辆参数的车辆动力学预测模型确定车辆的预测状态量和车辆的控制量,该控制量即为第二时刻的车辆控制量。
获取第一时刻的车辆状态量时,可以为直接从车载终端中的车辆状态检测模块得到,也可以为从保存的各个时刻的车辆状态量中获取。获取第二时刻的车辆状态量时,可以从保存的各个时刻的车辆状态量中获取。获取第二时刻的车辆控制量时,可以从保存的各个时刻的车辆控制量中获取。
其中,上述车辆状态量包括但不限于:车辆位姿、车辆速度和车辆加速度等中的一种或多种。车辆位姿可以包括车辆位置和车辆姿态。
车辆参数可以理解为车辆动力学预测模型的模型参数。车辆控制量为用于对车辆的行驶进行控制的参量,可以包括方向盘控制量、油门控制量和刹车控制量等中的一种或多种。本实施例中的车辆参数可以包括以下参数中的至少一种:轮胎的纵向刚度Cl、横向刚度Cc、与路面情况有关的纵向滑移率s、车辆的质量m和车辆绕z轴的转动惯量Iz等。车辆控制量可以包括车辆的前轮偏转角δ。
参见图3,为全局坐标系XOY与车体坐标系xy的关系示意图。其中车体坐标系以车辆中的固定点和固定方向作为车体坐标系的原点和坐标轴,例如以车头方向为x轴,竖直向上为z轴方向。车体坐标系x轴与全局坐标系X轴之间的夹角为车辆的朝向角车辆的前轮相对于车体坐标系x轴的偏转角δ为前轮偏转角。
S120:根据预测状态量与实际状态量之间的差异,对上述车辆参数进行修改,得到修改后车辆参数。
其中,实际状态量为第一时刻的车辆状态量,预测状态量为:根据第二时刻的车辆状态量、第二时刻的车辆控制量以及包含车辆参数的车辆动力学预测模型确定的车辆状态量。
车辆状态量为车辆实际行驶过程中检测到的车辆状态。当车辆参数为理想值时,以第二时刻的车辆控制量对车辆进行控制,车辆行驶过程中检测到的车辆状态量应为预测的第一时刻的车辆状态量,该预测的第一时刻的车辆状态量即为上述预测状态量。当车辆参数不为理想值时,可以根据预测状态量与实际状态量之间的差异对车辆参数进行修改。
车辆参数会因为外界地面状况、轮胎状况和车辆质量等参数的变化而变化。在非常短的时间内车辆参数可能会发生很小的变化,并且,在车辆行驶的过程中,采用实时检测准确的车辆参数的方式并不可行。本实施例中,根据预测状态量与实际状态量之间的差异对车辆参数进行修改,能够得到更精确的车辆参数,为快速确定精确的车辆参数提供了较好的实施方式。
S130:当修改后车辆参数相对于车辆参数满足收敛条件时,根据修改后车辆参数更新上述车辆参数。
当修改后车辆参数相对于上述车辆参数满足收敛条件时,认为修改后得到的车辆参数是准确的车辆参数,可以将修改后车辆参数替换至车辆动力学预测模型中,代替原来的车辆参数。
具体的,可以采用以下方式确定修改后车辆参数相对于上述车辆参数是否满足收敛条件:
当修改后车辆参数与上述车辆参数的差值绝对值小于预设阈值时,确定修改后车辆参数相对于车辆参数满足收敛条件。
当修改后车辆参数与上述车辆参数的差值绝对值不小于预设阈值时,确定修改后车辆参数相对于上述车辆参数不满足收敛条件。
由于车辆参数是较缓慢变化的,在较短时间间隔内,车辆参数的变化比较小,可以据此来对修改后车辆参数的准确性进行更准确的判定。
S140:基于MPC模块中包含更新后车辆参数的车辆动力学预测模型和第一时刻的车辆状态量,确定第一时刻的车辆控制量。
在第一时刻,当修改后车辆参数相比于上述车辆参数更精确时,采用包含更新后车辆参数的车辆动力学预测模型确定的车辆控制量,比采用包含原来车辆参数的车辆动力学预测模型确定的车辆控制量,会更准确。
由上述内容可知,本实施例中,由于预测状态量为根据前一时刻的车辆状态量、前一时刻的车辆控制量以及包含车辆参数的车辆动力学预测模型确定,因此可以根据预测状态量与实际状态量之间的差异对车辆参数进行修改,得到更精确的车辆参数,基于更精确的车辆参数能够确定更准确的车辆控制量。因此本实施例能够确定出更精确的车辆参数,提高模型预测的控制量的准确性。
在本发明的另一实施例中,基于图1所示实施例,步骤S120,根据预测状态量与实际状态量之间的差异,对车辆参数进行修改,得到修改后车辆参数的步骤,可以包括以下步骤1a和2a。
步骤1a:获取确定车辆参数时上述车辆参数的置信度。
在一种实施方式中,修改车辆参数的操作可以周期性执行。上述车辆参数可以为确定该车辆参数时确定的置信度。
步骤2a:根据预测状态量与实际状态量之间的差异,以及上述车辆参数的置信度,采用最小二乘参数辨识算法对上述车辆参数进行修改,得到修改后车辆参数。
本实施例中,采用最小二乘参数辨识算法,对车辆动力学预测模型的车辆参数进行修改,能够得到更精确的车辆参数,为修改车辆参数提供了可实施的方式。
在本发明的另一实施例中,步骤2a,根据预测状态量与实际状态量之间的差异,以及上述车辆参数的置信度,采用最小二乘参数辨识算法对上述车辆参数进行修改,得到修改后车辆参数的步骤,具体可以包括:
根据以下公式(1),对上述车辆参数进行辨识,得到修改后车辆参数:
第二时刻的车辆状态量包括车辆位置[x(k-1),y(k-1)]以及车辆朝向角第一时刻的车辆状态量包括车辆位置[x(k),y(k)]以及车辆朝向角为第二时刻的车辆控制量包括前轮偏转角δf(k-1)。a和b分别为车辆质心到车辆前轴和后轴的距离,Ts为第一时刻与第二时刻之间的时间间隔,T为矩阵转置符号,φ(k)、和Y(k)为从预测模型公式中得到,为理想的车辆参数。P(k)为修改后车辆参数的置信度。
上述k代表本次车辆预测控制,对应于第一时刻;k-1代表上一次车辆预测控制,对应于第二时刻。上述a和b可以认为是预先测量得到的值。预测模型公式为车辆动力学预测模型对车辆控制量进行预测时依据的公式。
综上,本实施例采用最小二乘参数辨识公式,对车辆参数进行辨识,在原来的车辆参数基础上得到了修改后的车辆参数,为确定出更精确的车辆参数提供了可实施方式。
上述参量具体可以包括:
其中,Cc和Cl分别为车辆轮胎的横向刚度和纵向刚度,s为车辆与路面之间的纵向滑移率,w和h分别为车辆宽度和车辆长度,m为车辆质量。
步骤1b:获取车辆动力学预测模型的原理公式,即公式(2):
其中,公式(2)的推导过程如下:
参见图3所示坐标系,XOY为全局坐标系,xoy为车体坐标系,车体坐标系与全局坐标系的关系为
在x轴方向上,有
其中,Fxf和Fxr分别为车辆的前、后轮受到的x方向的力。在y轴方向上,有
其中,Fyf和Fyr分别为车辆的前、后轮受到的y方向的力。在绕z轴方向上,有
其中,a和b分别为车辆质心到车辆前轴和后轴的距离。在车体坐标系x、y方向上的力可以被分解为轮胎的纵向力和侧向力
其中,Flf和Fcf分别为前轮受的纵向力和横向力,Flr和Fcr分别为后轮受的纵向力和横向力,δr为后轮偏转角。在轮胎的侧偏角α和纵向滑移率s较小时,前后轮的纵向力和侧向力分别为
其中,Cc和Cl分别为车辆轮胎的横向刚度和纵向刚度。上述侧偏角α,可以采用以下公式计算
将轮胎坐标系下的vc和vl在车体坐标系下表示
上述轮胎的速度vx和vy很难直接获取,可以通过车辆速度来得到:
联立上述公式(9)~(11),得到前后轮的侧偏角为
将公式(12)代入公式(8)中,得到前、后轮的侧向力为
其中,δf为车辆的前轮偏转角,Ccf和Ccr分别为前、后轮的横向刚度。前、后轮纵向力分别为
Flf=Clfsf,Flr=Clrsr 公式(14)
将公式(13)和(14)代入公式(7)和(4)~(6),最终得到公式(2)。
对车辆动力学预测模型的原理公式执行离散化处理,即将dt采用时间周期Ts表示,并将上一次预测k-1的数据和当前本次预测k的数据代入可得到。
综上,本实施例提供了从车辆动力学预测模型的原理公式推导得到进行最小二乘辨识所需要的预测模型公式的过程。
在本发明的另一实施例中,基于图1所示实施例,步骤S140,基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量的步骤,包括以下步骤1c和2c。
步骤1c:基于MPC模块中包含更新后车辆参数的车辆动力学预测模型和第一时刻的车辆状态量,确定包含待优化控制量的待优化预测状态量。
在上述实施例中,迭代求解得到之后,可以根据上述实施例中步骤2b~3b的逆过程,得到和的准确值,并代入公式(2)中,即得到包含更新后车辆参数的车辆动力学预测模型的原理公式,根据该原理公式,经过递推,可以得到在未来Np时刻内的状态空间方程,该状态空间方程即为包含待优化控制量的待优化预测状态量。
步骤2c:获取车辆的行驶状态参考量,确定状态量偏差和待优化控制量之间的和值,对待优化控制量和待优化预测状态量进行修改,当和值取最小值时,将修改后的待优化控制量确定为第一时刻的车辆控制量。
其中,状态量偏差为待优化预测状态量与行驶状态参考量之间的偏差。车辆的行驶状态参考量可以理解为针对车辆而期望的行驶状态。状态量偏差可以理解为预测状态量与理想状态量之间的差异。
本步骤中,可以通过多次修改待优化控制量和待优化预测状态量,并更新上述和值,直至确定最小和值,将确定最小和值时对应的修改后的待优化控制量确定为第一时刻的车辆控制量。
在一种实施方式中,上述步骤1c可以由MPC中的车辆动力学预测模型模块处理,步骤2c可以由MPC中的滚动优化模块处理。
在一种实施方式中,基于模型预测控制MPC模块中包含车辆参数的车辆动力学预测模型和第二时刻的车辆状态量确定第二时刻的车辆控制量时,具体实施方式可以参照上述步骤1c和2c进行,可以包括:基于MPC模块中包含车辆参数的车辆动力学预测模型和第二时刻的车辆状态量,确定包含待优化控制量的待优化预测状态量;获取车辆的行驶状态参考量,确定状态量偏差和待优化控制量之间的和值,对待优化控制量和待优化预测状态量进行修改,当和值取最小值时,将修改后的待优化控制量确定为第一时刻的车辆控制量。
在一个实施方式中,参见图2所示的MPC的内部结构示意图,将从车辆中获取的第一时刻的车辆状态量输入MPC模块中的反馈矫正模块,反馈矫正模块对车辆状态量做预设处理后,将处理后的车辆状态量输入最小二乘参数修改模块,最小二乘参数修改模块根据实际状态量和预测状态量之间的差异对车辆参数进行修改,当确定参数收敛时,将修改后车辆参数更新至车辆动力学预测模型中。车辆动力学预测模型根据更新后车辆参数和第一时刻的车辆状态量确定待优化控制量,并通过滚动优化模块对待优化控制量进行优化后得到第一时刻的车辆控制量。滚动优化模块将第一时刻的车辆控制量输入车辆。
在本发明的另一实施例中,图1所示实施例中,当修改后车辆参数相对于车辆参数不满足收敛条件时,还可以基于MPC模块中包含车辆参数的车辆动力学预测模型和第一时刻的车辆状态量,确定第一时刻的车辆控制量。
在本实施例中,当确定第一时刻的车辆控制量之后,基于第一时刻的车辆控制量对车辆进行控制。上述第一时刻的车辆控制量可以为上述方式确定的,也可以为根据步骤S140确定的。
当车辆控制量为车辆的前轮偏转角时,可以根据该前轮偏转角对车辆的方向盘进行控制,使得车辆的前轮偏转达到上述前轮偏转角。
综上,本实施例中,当辨识的车辆参数收敛时,基于辨识后得到的第二车辆控制量对车辆进行控制;当辨识的车辆参数不收敛时,基于辨识前的第一车辆控制量对车辆进行控制,能够从整体上优化对车辆的控制。
图4为本发明实施例提供的车载终端中的处理器的一种结构示意图。本实施例与图1所示方法实施例相对应。该处理器包括:
获取模块410,用于获取第一时刻的车辆状态量,获取第二时刻的车辆状态量以及第二时刻的车辆控制量;其中,所述第二时刻为所述第一时刻的前一时刻,所述第二时刻的车辆控制量为:基于模型预测控制MPC模块中包含车辆参数的车辆动力学预测模型和所述第二时刻的车辆状态量确定;
修改模块420,用于根据预测状态量与实际状态量之间的差异,对所述车辆参数进行修改,得到修改后车辆参数;其中,所述实际状态量为所述第一时刻的车辆状态量,所述预测状态量为:根据所述第二时刻的车辆状态量、第二时刻的车辆控制量以及包含所述车辆参数的车辆动力学预测模型确定的车辆状态量;
更新模块430,用于当所述修改后车辆参数相对于所述车辆参数满足收敛条件时,根据所述修改后车辆参数更新所述车辆参数;
确定模块440,用于基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量。
可选的,所述修改模块420,具体用于:
获取确定所述车辆参数时所述车辆参数的置信度;
根据所述预测状态量与实际状态量之间的差异,以及所述车辆参数的置信度,采用最小二乘参数辨识算法对所述车辆参数进行修改,得到修改后车辆参数。
可选的,所述修改模块420,根据所述预测状态量与实际状态量之间的差异,以及所述车辆参数的置信度,采用最小二乘参数辨识算法对所述车辆参数进行修改,得到修改后车辆参数时,包括:
根据以下公式,对所述车辆参数进行修改,得到修改后车辆参数:
所述第二时刻的车辆状态量包括车辆位置[x(k-1),y(k-1)]以及车辆朝向角所述第一时刻的车辆状态量包括车辆位置[x(k),y(k)]以及车辆朝向角为所述第二时刻的车辆控制量包括前轮偏转角δf(k-1),所述a和b分别为车辆质心到车辆前轴和后轴的距离,所述Ts为所述第一时刻与第二时刻之间的时间间隔,所述T为矩阵转置符号,所述φ(k)、和Y(k)为从预测模型公式中得到。
所述Cc和Cl分别为车辆轮胎的横向刚度和纵向刚度,所述s为所述车辆与路面之间的纵向滑移率,所述w和h分别为车辆宽度和车辆长度,所述m为车辆质量。
获取车辆动力学预测模型的原理公式:
可选的,所述处理器还包括:判断模块(图中未示出),用于采用以下操作确定所述修改后车辆参数相对于所述车辆参数是否满足收敛条件:
当所述修改后车辆参数与所述车辆参数的差值绝对值小于预设阈值时,确定所述修改后车辆参数相对于所述车辆参数满足收敛条件。
可选的,所述确定模块440,具体用于:
基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定包含待优化控制量的待优化预测状态量;
获取所述车辆的行驶状态参考量,确定所述状态量偏差与所述待优化控制量之间的和值,对所述待优化控制量和所述待优化预测状态量进行修改,当所述和值取最小值时,将修改后的待优化控制量确定为第一时刻的车辆控制量;其中,所述状态量偏差为所述待优化预测状态量与所述行驶状态参考量之间的偏差。
可选的,所述确定模块440还用于:
当所述修改后车辆参数相对于所述车辆参数不满足收敛条件时,基于所述MPC模块中包含所述车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量;
所述处理器还包括:
发送模块(图中未示出),用于当确定所述第一时刻的车辆控制量之后,将所述第一时刻的车辆控制量发送至车载终端中的控制模块,以使控制模块基于所述第一时刻的车辆控制量对所述车辆进行控制。
上述处理器实施例与方法实施例相对应,与该方法实施例具有同样的技术效果,具体说明参见方法实施例。处理器实施例是基于方法实施例得到的,具体的说明可以参见方法实施例部分,此处不再赘述。
本领域普通技术人员可以理解:附图只是一个实施例的示意图,附图中的模块或流程并不一定是实施本发明所必须的。
本领域普通技术人员可以理解:实施例中的装置中的模块可以按照实施例描述分布于实施例的装置中,也可以进行相应变化位于不同于本实施例的一个或多个装置中。上述实施例的模块可以合并为一个模块,也可以进一步拆分成多个子模块。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明实施例技术方案的精神和范围。
Claims (10)
1.一种基于动力学的车辆预测控制方法,其特征在于,包括:
获取第一时刻的车辆状态量,获取第二时刻的车辆状态量以及第二时刻的车辆控制量;其中,所述第二时刻为所述第一时刻的前一时刻,所述第二时刻的车辆控制量为:基于模型预测控制MPC模块中包含车辆参数的车辆动力学预测模型和所述第二时刻的车辆状态量确定;
根据预测状态量与实际状态量之间的差异,对所述车辆参数进行修改,得到修改后车辆参数;其中,所述实际状态量为所述第一时刻的车辆状态量,所述预测状态量为:根据所述第二时刻的车辆状态量、第二时刻的车辆控制量以及包含所述车辆参数的车辆动力学预测模型确定的车辆状态量;
当所述修改后车辆参数相对于所述车辆参数满足收敛条件时,根据所述修改后车辆参数更新所述车辆参数;
基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量。
2.如权利要求1所述的方法,其特征在于,所述根据预测状态量与实际状态量之间的差异,对所述车辆参数进行修改,得到修改后车辆参数的步骤,包括:
获取确定所述车辆参数时所述车辆参数的置信度;
根据所述预测状态量与实际状态量之间的差异,以及所述车辆参数的置信度,采用最小二乘参数辨识算法对所述车辆参数进行修改,得到修改后车辆参数。
3.如权利要求2所述的方法,其特征在于,所述根据所述预测状态量与实际状态量之间的差异,以及所述车辆参数的置信度,采用最小二乘参数辨识算法对所述车辆参数进行修改,得到修改后车辆参数的步骤,包括:
根据以下公式,对所述车辆参数进行修改,得到修改后车辆参数:
6.如权利要求1所述的方法,其特征在于,采用以下方式确定所述修改后车辆参数相对于所述车辆参数是否满足收敛条件:
当所述修改后车辆参数与所述车辆参数的差值绝对值小于预设阈值时,确定所述修改后车辆参数相对于所述车辆参数满足收敛条件。
7.如权利要求1所述的方法,其特征在于,所述基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量的步骤,包括:
基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定包含待优化控制量的待优化预测状态量;
获取所述车辆的行驶状态参考量,确定所述状态量偏差与所述待优化控制量之间的和值,对所述待优化控制量和所述待优化预测状态量进行修改,当所述和值取最小值时,将修改后的待优化控制量确定为第一时刻的车辆控制量;其中,所述状态量偏差为所述待优化预测状态量与所述行驶状态参考量之间的偏差。
8.如权利要求1所述的方法,其特征在于,当所述修改后车辆参数相对于所述车辆参数不满足收敛条件时,所述方法还包括:
基于所述MPC模块中包含所述车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量;
所述方法还包括:
当确定所述第一时刻的车辆控制量之后,基于所述第一时刻的车辆控制量对所述车辆进行控制。
9.一种车载终端中的处理器,其特征在于,所述处理器包括:
获取模块,用于获取第一时刻的车辆状态量,获取第二时刻的车辆状态量以及第二时刻的车辆控制量;其中,所述第二时刻为所述第一时刻的前一时刻,所述第二时刻的车辆控制量为:基于模型预测控制MPC模块中包含车辆参数的车辆动力学预测模型和所述第二时刻的车辆状态量确定;
修改模块,用于根据预测状态量与实际状态量之间的差异,对所述车辆参数进行修改,得到修改后车辆参数;其中,所述实际状态量为所述第一时刻的车辆状态量,所述预测状态量为:根据所述第二时刻的车辆状态量、第二时刻的车辆控制量以及包含所述车辆参数的车辆动力学预测模型确定的车辆状态量;
更新模块,用于当所述修改后车辆参数相对于所述车辆参数满足收敛条件时,根据所述修改后车辆参数更新所述车辆参数;
确定模块,用于基于所述MPC模块中包含更新后车辆参数的车辆动力学预测模型和所述第一时刻的车辆状态量,确定第一时刻的车辆控制量。
10.如权利要求9所述的处理器,其特征在于,所述修改模块,具体用于:
获取确定所述车辆参数时所述车辆参数的置信度;
根据所述预测状态量与实际状态量之间的差异,以及所述车辆参数的置信度,采用最小二乘参数辨识算法对所述车辆参数进行修改,得到修改后车辆参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910780958.XA CN112406890B (zh) | 2019-08-22 | 2019-08-22 | 基于动力学的车辆预测控制方法及处理器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910780958.XA CN112406890B (zh) | 2019-08-22 | 2019-08-22 | 基于动力学的车辆预测控制方法及处理器 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112406890A true CN112406890A (zh) | 2021-02-26 |
CN112406890B CN112406890B (zh) | 2022-04-01 |
Family
ID=74780297
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910780958.XA Active CN112406890B (zh) | 2019-08-22 | 2019-08-22 | 基于动力学的车辆预测控制方法及处理器 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112406890B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117163050A (zh) * | 2023-10-11 | 2023-12-05 | 成都睿芯行科技有限公司 | 一种基于运动模型的预测控制算法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101002151A (zh) * | 2004-06-09 | 2007-07-18 | 通用汽车公司 | 实时车辆动力学性能估计系统 |
CN101005981A (zh) * | 2004-08-06 | 2007-07-25 | 本田技研工业株式会社 | 车辆的控制装置 |
CN101171163A (zh) * | 2005-08-05 | 2008-04-30 | 本田技研工业株式会社 | 车辆的控制装置 |
CN106945670A (zh) * | 2017-02-16 | 2017-07-14 | 南京航空航天大学 | 基于驾驶员输入预测的汽车防侧翻系统及控制策略 |
WO2018104850A1 (en) * | 2016-12-08 | 2018-06-14 | Kpit Technologies Limited | Model predictive based control for automobiles |
CN108248605A (zh) * | 2018-01-23 | 2018-07-06 | 重庆邮电大学 | 一种智能车辆轨迹跟随的横纵向协调控制方法 |
CN109017808A (zh) * | 2018-08-16 | 2018-12-18 | 天津大学 | 一种无人驾驶汽车模型预测控制器设计方法 |
CN109597308A (zh) * | 2019-01-15 | 2019-04-09 | 天津大学 | 基于动力学模型的无人驾驶汽车模型预测控制器设计方法 |
US20190155229A1 (en) * | 2017-11-21 | 2019-05-23 | Jaguar Land Rover Limited | Apparatus and method for controlling a process |
-
2019
- 2019-08-22 CN CN201910780958.XA patent/CN112406890B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101002151A (zh) * | 2004-06-09 | 2007-07-18 | 通用汽车公司 | 实时车辆动力学性能估计系统 |
CN101005981A (zh) * | 2004-08-06 | 2007-07-25 | 本田技研工业株式会社 | 车辆的控制装置 |
CN101171163A (zh) * | 2005-08-05 | 2008-04-30 | 本田技研工业株式会社 | 车辆的控制装置 |
WO2018104850A1 (en) * | 2016-12-08 | 2018-06-14 | Kpit Technologies Limited | Model predictive based control for automobiles |
CN106945670A (zh) * | 2017-02-16 | 2017-07-14 | 南京航空航天大学 | 基于驾驶员输入预测的汽车防侧翻系统及控制策略 |
US20190155229A1 (en) * | 2017-11-21 | 2019-05-23 | Jaguar Land Rover Limited | Apparatus and method for controlling a process |
CN108248605A (zh) * | 2018-01-23 | 2018-07-06 | 重庆邮电大学 | 一种智能车辆轨迹跟随的横纵向协调控制方法 |
CN109017808A (zh) * | 2018-08-16 | 2018-12-18 | 天津大学 | 一种无人驾驶汽车模型预测控制器设计方法 |
CN109597308A (zh) * | 2019-01-15 | 2019-04-09 | 天津大学 | 基于动力学模型的无人驾驶汽车模型预测控制器设计方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117163050A (zh) * | 2023-10-11 | 2023-12-05 | 成都睿芯行科技有限公司 | 一种基于运动模型的预测控制算法 |
CN117163050B (zh) * | 2023-10-11 | 2024-03-22 | 成都睿芯行科技有限公司 | 一种基于运动模型的预测控制算法 |
Also Published As
Publication number | Publication date |
---|---|
CN112406890B (zh) | 2022-04-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Zhang et al. | A novel observer design for simultaneous estimation of vehicle steering angle and sideslip angle | |
KR100939039B1 (ko) | 차량의 제어장치 | |
CN112733270B (zh) | 车辆行驶轨迹预测和轨迹偏离危险度评估的系统与方法 | |
Gao et al. | Robust lateral trajectory following control of unmanned vehicle based on model predictive control | |
JP6161697B2 (ja) | ハンドルを有する自律車両の進路を制御する方法 | |
Ding et al. | Event-triggered vehicle sideslip angle estimation based on low-cost sensors | |
Kapania et al. | Path tracking of highly dynamic autonomous vehicle trajectories via iterative learning control | |
CN111879957B (zh) | 基于模糊逻辑和增强机器学习的车辆动力学测定 | |
US11254315B2 (en) | Friction adaptive vehicle control | |
JP2003191774A (ja) | 統合型車両運動制御装置 | |
Yang et al. | Quasi-linear optimal path controller applied to post impact vehicle dynamics | |
CN110525436A (zh) | 车辆换道控制方法、装置、车辆和存储介质 | |
US20180037234A1 (en) | Method and device for estimating the friction values of a wheel of a vehicle against a substrate | |
Németh et al. | Nonlinear analysis of vehicle control actuations based on controlled invariant sets | |
CN113682282A (zh) | 一种车辆稳定性控制方法、系统、车辆和存储介质 | |
CN112406890B (zh) | 基于动力学的车辆预测控制方法及处理器 | |
Boada et al. | A robust observer based on energy-to-peak filtering in combination with neural networks for parameter varying systems and its application to vehicle roll angle estimation | |
Yu et al. | Automatic vehicle trajectory tracking control with self-calibration of nonlinear tire force function | |
CN112406889B (zh) | 基于运动学的车辆预测控制方法及处理器 | |
US20230001940A1 (en) | Method and Device for Optimum Parameterization of a Driving Dynamics Control System for Vehicles | |
CN115431975A (zh) | 一种智能网联拖挂货车编队控制方法 | |
JP7234617B2 (ja) | 車体姿勢角推定装置 | |
CN113788022A (zh) | 车辆控制方法、装置、计算机可读存储介质及电子设备 | |
CN117734668A (zh) | 考虑预瞄转角和时滞补偿的智能车辆稳定性控制方法 | |
CN116811864A (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 | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20211125 Address after: 215100 floor 23, Tiancheng Times Business Plaza, No. 58, qinglonggang Road, high speed rail new town, Xiangcheng District, Suzhou, Jiangsu Province Applicant after: MOMENTA (SUZHOU) TECHNOLOGY Co.,Ltd. Address before: Room 601-a32, Tiancheng information building, No. 88, South Tiancheng Road, high speed rail new town, Xiangcheng District, Suzhou City, Jiangsu Province Applicant before: MOMENTA (SUZHOU) TECHNOLOGY Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |