CN110843793B - 基于前馈控制的自动驾驶车辆的纵向控制系统和方法 - Google Patents
基于前馈控制的自动驾驶车辆的纵向控制系统和方法 Download PDFInfo
- Publication number
- CN110843793B CN110843793B CN201911226293.4A CN201911226293A CN110843793B CN 110843793 B CN110843793 B CN 110843793B CN 201911226293 A CN201911226293 A CN 201911226293A CN 110843793 B CN110843793 B CN 110843793B
- Authority
- CN
- China
- Prior art keywords
- output control
- control quantity
- reference model
- vehicle
- feedforward
- 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 38
- 230000004927 fusion Effects 0.000 claims abstract description 34
- 230000001133 acceleration Effects 0.000 claims description 13
- 230000003044 adaptive effect Effects 0.000 claims description 10
- 230000006978 adaptation Effects 0.000 claims description 7
- 230000008569 process Effects 0.000 abstract description 7
- 238000010586 diagram Methods 0.000 description 7
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 238000006467 substitution reaction Methods 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000004590 computer program Methods 0.000 description 1
- 230000036461 convulsion Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000008713 feedback mechanism Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 238000011144 upstream manufacturing Methods 0.000 description 1
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/0008—Feedback, closed loop systems or details of feedback error signal
- B60W2050/0011—Proportional Integral Differential [PID] controller
-
- 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/0012—Feedforward or open loop systems
-
- 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
-
- 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/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
-
- 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/0062—Adapting control system settings
- B60W2050/0075—Automatic parameter input, automatic initialising or calibrating means
- B60W2050/0083—Setting, resetting, calibration
- B60W2050/0088—Adaptive recalibration
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提供一种基于前馈控制的自动驾驶车辆的纵向控制系统和方法,该系统包括参考模型、第一融合子模块、自适应律子模块、前馈模块和第二融合模块;参考模型根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;第一融合子模块融合参考模型的输出控制量和当前系统的实时状态量获得第一误差;自适应律子模块根据车辆的类型和第一误差获得调整后的参考模型的输出控制量;前馈模块根据车辆的输入值和输出值获得前馈输出控制量;第二融合模块融合调整后的参考模型的输出控制量和前馈输出控制量获得系统的最终控制量。本发明的纵向控制系统的鲁棒性好,能够很好地处理重型卡车换挡所带来的顿挫问题及控制过程中的动态偏差。
Description
技术领域
本发明属于自动驾驶技术领域,具体涉及一种基于前馈控制的自动驾驶车辆的纵向控制系统和方法。
背景技术
自动驾驶技术在最近十年得到突飞猛进的发展,将自动驾驶技术应用到重型卡车上,也在最近几年得到了广泛的关注。
由于重型卡车质量较大,相对于乘用车重型卡车的线控平台的执行性能较差,另外重型卡车后面还有非刚性连接的挂车,所以相较于乘用车,重型卡车的自动驾驶的控制问题更具有挑战性。
现有的自动驾驶车辆的控制系统中,不能很好地处理自动驾驶卡车所面临的技术挑战,尤其是非线性和不稳定的线控性能以及换挡所带来的顿挫等问题。
目前的一种基于FF(Feed Forward,前馈控制算法)对车辆进行纵向控制方法,参见图1,这种方法首先采集输入数据(速度,加速度,载重)和输出数据(油门和刹车的力矩控制百分比);然后,建立对应的查找表格;在控制模块接受到上游规划模块发过来的轨迹指令之后,根据需要的控制量,直接在查找表格中进行查表以获取相应的输出;这种方法的优点是设计简单,执行速度快,能够比较好的覆盖线控的非线性的性能表现;但该方法由于没有反馈机制,所以不能很好地处理线控平台参数的扰动以及控制过程中的动态偏差。
因此,综上所述,现有技术中存在以下几个问题:鲁棒性比较差、换挡所带来的顿挫问题及控制过程中的存在的动态偏差。
发明内容
本发明提供一种基于前馈控制的自动驾驶车辆的纵向控制系统和方法,通过引入参考自适应模型,以解决现有技术中的至少一个技术问题。
本发明的一个方面提供一种基于前馈控制的自动驾驶车辆的纵向控制系统,该纵向控制系统包括模型参考自适应模块和线控模块,所述模型参考自适应模块包括参考模型、第一融合子模块和自适应律子模块;所述系统还包括前馈模块和第二融合模块;
所述参考模型根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
所述第一融合子模块融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差;
所述自适应律子模块根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
所述前馈模块根据车辆的输入值和输出值获得前馈输出控制量;
所述第二融合模块融合调整后的参考模型的输出控制量和前馈输出控制量获得系统的最终控制量。
进一步的,所述自适应律子模块通过以下公式获得调整后的参考模型的输出控制量:
u1=∫(gamma*e*r)
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma是自适应律;e是第一误差。
进一步的,所述第二融合模块通过以下公式获得系统的最终控制量:
CMDfinal=WMRAC*u1+WFF*u2;
其中,CMDfinal是系统的最终控制量;u1是调整后的参考模型的输出控制量的权重;CMDMRAC是调整后的参考模型的输出控制量;WFF是前馈输出控制量的权重;u2是前馈输出控制量。
进一步的,所述前馈输出控制量u2是通过如下公式获得的:
u2=k1(v)+k2(w)+k3(a)
其中,v是车辆的速度,w是车辆的载重,a是车辆的加速度,k1是车辆的速度的系数,k2是车辆的载重的系数,k3是车辆的加速度的系数。
进一步的,所述纵向控制系统还包括PID模块和第三融合模块;
所述PID模块根据车辆的速度获得PID输出控制量;
所述第三融合模块融合调整后的参考模型的输出控制量、前馈输出控制量和PID输出控制量获得所述系统的最终控制量。
本发明的一个方面提供一种基于前馈控制的自动驾驶车辆的纵向控制方法,该纵向控制方法包括以下子步骤:
根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差;
根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
根据车辆的输入值和输出值获得前馈输出控制量;
融合调整后的参考模型的输出控制量和前馈输出控制量获得系统的最终控制量。
进一步的,所述调整后的参考模型的输出控制量通过以下公式获得:
u1=∫(gamma*e*r)
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma是自适应律;e是第一误差。.
进一步的,所述系统的最终控制量通过以下公式获得:
CMDfinal=WMRAC*u1+WFF*u2;
其中,CMDfinal是系统的最终控制量;u1是调整后的参考模型的输出控制量的权重;CMDMRAC是调整后的参考模型的输出控制量;WFF是前馈输出控制量的权重;u2是前馈输出控制量。
进一步的,所述前馈输出控制量u2是通过以下公式获得的:
u2=k1(v)+k2(w)+k3(a)
其中,v是车辆的速度,w是车辆的载重,a是车辆的加速度,k1是车辆的速度的系数,k2是车辆的载重的系数,k3是车辆的加速度的系数。
进一步的,所述纵向控制方法还包括以下步骤:
根据车辆的速度获得PID输出控制量;
融合调整后的参考模型的输出控制量、前馈输出控制量和PID输出控制量获得所述系统的最终控制量。
本发明通过本发明通过引入模型参考自适应模块,在车辆的自动驾驶系统中,尤其是在重型卡车的自动驾驶控制过程中,可以很好的解决换挡所带来的顿挫,以及控制过程中的动态偏差的技术问题,从而极大的提升自动驾驶车辆的纵向控制的精度,带来了更高的安全性和更平稳的驾驶体验。
附图说明
图1为现有技术中利用FF算法的一种自动驾驶车辆的控制系统的结构示意图;
图2为本发明一个实施例提供的一种基于前馈控制的自动驾驶车辆的纵向控制系统的结构示意图;
图3为本发明一个实施例提供的一种基于前馈控制的自动驾驶车辆的纵向控制方法的流程示意图;
图4为本发明另一实施例提供的一种基于前馈控制的自动驾驶车辆的纵向控制系统的结构示意图;
图5为本发明另一实施例提供的一种基于前馈控制的自动驾驶车辆的纵向控制方法的流程示意图;
图6为本发明实施例提供的一种电子设备的结构示意图。
具体实施方式
下面结合附图所示的各实施方式对本发明进行详细说明,但应当说明的是,这些实施方式并非对本发明的限制,本领域普通技术人员根据这些实施方式所作的功能、方法、或者结构上的等效变换或替代,均属于本发明的保护范围之内。
实施例一
图2为本发明实施例提供的一种基于前馈控制的自动驾驶车辆的纵向控制系统的结构示意图;参见图2,该纵向控制系统包括模型参考自适应模块、线控模块,所述模型参考自适应模块包括参考模型、第一融合子模块和自适应律子模块;所述系统还包括前馈模块和第二融合模块;其中,
所述参考模型根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;本实施例中的车辆模型一般可以通过系统辨识方法或者大数据建模的方式获得;
所述第一融合子模块融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差,所述第一误差为参考模型的输出控制量和当前系统的实时状态量之间的误差;本实施例中的当前系统的实时状态量可来自于线控模块反馈的信号,例如包括当前油门踏板的百分比等数据;
所述自适应律子模块根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
所述前馈模块根据车辆的输入值和输出值获得前馈输出控制量;
所述第二融合模块融合调整后的参考模型的输出控制量和前馈输出控制量以获得系统的最终控制量。
进一步的,所述第一误差是通过以下公式实现的,例如可以利用参考模型的输出的控制量与当前系统的实时状态量的差值来获得所述误差,具体可参见下述公式:
e=CMDr-CMDs;
其中,CMDr是参考模型的输出控制量;CMDs是当前系统的实时状态量;e是第一误差。
进一步的,所述自适应律子模块利用以下表达式获得所述调整后的参考模型的输出控制量:
u1=∫(gamma*e*r)
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma表示自适应律,其参考取值范围为[1.0-2.3];e是第一误差。
进一步的,所述第二融合模块通过以下公式获得所述系统的最终控制量:
CMDfinal=WMRAC*u1++WFF*u2
其中,CMDfinal是系统的最终控制量;WMRAC是调整后的参考模型的输出控制量的权重,优选的,WMRAC取值参考范围为[0.6-1.0];u1是调整后的参考模型的输出控制量;WFF是前馈输出控制量的权重,优选的,WFF的取值参考范围为[0.5-1.0];u2是前馈输出控制量;;
优选的,所述前馈输出控制量u2是通过如下公式获得的:
u2=k1(v)+k2(w)+k3(a)
其中,v是车辆的速度,w是车辆的载重,a是车辆的加速度,k1是车辆的速度的系数,k2是车辆的载重的系数,k3是车辆的加速度的系数。
优选的,所述第二融合模块根据车辆的不同的线控性能指标对模型参考自适应模块和前馈模块分配相应的权重。
本实施例通过第二融合模块融合调整后的参考模型的输出控制量和前馈输出控制量获得系统的最终控制量,能够很好地解决换挡所带来的顿挫问题,并对系统进行迅速的反馈调节,从而带来了更加平顺的系统体验。
实施例二
图3为本发明一个实施例提供的一种基于前馈控制的自动驾驶车辆的纵向控制方法的流程示意图;参见图3,该纵向控制方法包括以下步骤:
根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差;
根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
根据车辆的输入值和输出值获得前馈输出控制量;
融合调整后的参考模型的输出控制量和前馈输出控制量获得系统的最终控制量。
进一步的,所述参考模型为:
其中,Gm(S)是参考模型的频域动力学模型;Ta是一阶惯性环节时间常数;S是频域自变量。
进一步的,通过以下公式获得所述调整后的参考模型的输出控制量:
u1=∫(gamma*e*r)
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma是自适应律;e是第一误差。.
进一步的,通过以下公式获得所述系统的最终控制量:
CMDfinal=WMRAC*u1+WFF*u2;
其中,CMDfinal是系统的最终控制量;u1是调整后的参考模型的输出控制量的权重;CMDMRAC是调整后的参考模型的输出控制量;WFF是前馈输出控制量的权重;u2是前馈输出控制量。
进一步的,所述前馈输出控制量u2是通过如下公式获得的:
u2=k1(v)+k2(w)+k3(a)
其中,v是车辆的速度,w是车辆的载重,a是车辆的加速度,k1是车辆的速度的系数,k2是车辆的载重的系数,k3是车辆的加速度的系数。
本实施例中的基于前馈控制的自动驾驶车辆的纵向控制方法与实施例一的纵向控制系统的工作原理基本一致,在此不再赘述。
实施例三
参见图4,图4为本发明的另一实施例提供的一种基于前馈控制的自动驾驶车辆的纵向控制系统的结构示意图;该系统包括模型参考自适应模块、线控模块、前馈模块、PID模块和第三融合模块;其中,所述模型参考自适应模块包括参考模型、第一融合子模块和自适应律子模块;
所述参考模型根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
所述第一融合子模块融合所述参考模型的输出控制量和当前系统的实时状态量,以获得第一误差,所述第一误差为参考模型的输出控制量和当前系统的实时状态量之间的误差;
所述自适应律子模块根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
所述前馈模块根据车辆的输入值和输出值获得前馈输出控制量;
所述PID模块根据车辆的速度获得PID输出控制量;
所述第三融合模块融合调整后的参考模型的输出控制量、前馈输出控制量和PID输出控制量获得系统的最终控制量。
需要说明的是,在本实施例中,所述参考模型、获得第一误差、调整后的参考模型的输出控制量以及前馈输出控制量等的实现方法与实施例一中的基本一致,在此不再具体赘述。
进一步的,所述第三融合模块通过以下公式获得所述系统的最终控制量:
CMDfinal=WMRAC*u1+WFF*u2+WPID*u3
其中,CMDfinal是系统的最终控制量;WMRAC是调整后的参考模型的输出控制量的权重,优选的,取值参考范围为[0.6-1.0];u1是调整后的参考模型的输出控制量;WFF是前馈输出控制量的权重;优选的,WFF的取值参考范围为[0.5-1.0];u2是前馈输出控制量;WPID是PID输出控制量的权重;优选的,WPID的取值参考范围为[0.3-1.0];u3是PID输出控制量。
进一步的,所述PID输出控制量u3通过以下公式获得:
KP是P项的参数,Ki是I项的参数,Kd是D项的参数,e(k)是控制量和观测量的误差。
优选的,所述第三融合模块根据车辆的不同的线控性能指标对模型参考自适应模块、前馈模块和PID模块分配相应的权重。
本实施例利用第三融合模块融合调整后的参考模型的输出控制量、前馈输出控制量和PID输出控制量获得系统的最终控制量,不仅能够降低系统控制的动态偏差,并可以及时地进行检测和反馈,从而极大地提高了该系统的纵向控制的精确度;而且能够很好地解决换挡所带来的顿挫问题,并对系统进行迅速的反馈调节,从而带来了更加平顺的系统体验,因此本实施例可以极大的提升自动驾驶车辆的纵向控制的精度和鲁棒性,从而为车辆带来更高的安全性和更平稳的驾驶体验。
实施例四
图5为本发明另一实施例提供的一种基于前馈控制的自动驾驶车辆的纵向控制方法的流程示意图;参见图5,该纵向控制方法包括以下步骤:
根据预先设定的车辆模型和参考输入量生成参考模型的输出控制量;
融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差,所述第一误差为参考模型的输出控制量和当前系统的实时状态量之间的误差;
根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
根据车辆的输入值和输出值获得前馈输出控制量;
根据车辆的速度获得PID输出控制量;
融合调整后的参考模型的输出控制量、前馈输出控制量和PID输出控制量获得系统的最终控制量。
进一步的,通过以下公式获得所述系统的最终控制量:
CMDfinal=WMRAC*u1+WFF*u2+WPID*u3
其中,CMDfinal是系统的最终控制量;WMRAC是调整后的参考模型的输出控制量的权重,优选的,取值参考范围为[0.6-1.0];u1是调整后的参考模型的输出控制量;WFF是前馈输出控制量的权重;优选的,WFF的取值参考范围为[0.5-1.0];u2是前馈输出控制量;WPID是PID输出控制量的权重;优选的,WPID的取值参考范围为[0.3-1.0];u3是PID输出控制量。
进一步的,所述PID输出控制量u3通过以下公式获得:
KP是P项的参数,Ki是I项的参数,Kd是D项的参数,e(k)是控制量和观测量的误差。
优选的,根据车辆的不同的线控性能指标对调整后的参考模型的输出控制量的权重、前馈输出控制量的权重和PID输出控制量分配相应的权重。
本实施例中的基于前馈控制的自动驾驶车辆的纵向控制方法与实施例三的纵向控制系统的工作原理基本一致,在此不再赘述。
实施例五
图6为本发明的一种电子设备的一个实施例的结构示意图,参见图6,在本实施例中,提供一种电子设备,包括但不限于智能手机、固定电话、平板电脑、笔记本电脑、穿戴式设备等电子设备,所述电子设备包括:处理器和存储器,所述存储器存储有计算机可读指令,所述计算机可读指令在被所述处理器执行时实现上述本发明的方法。
实施例六
在本实施例中,提供一种计算机可读存储介质,可以为ROM(例如只读存储器、FLASH存储器、转移装置等)、光学存储介质(例如,CD-ROM、DVD-ROM、纸卡等)、磁存储介质(例如,磁带、磁盘驱动器等)或其他类型的程序存储器;所述计算机可读存储介质上存储有计算机程序,所述计算机程序在被处理器或计算机运行时执行上述本发明的方法。
本发明具有以下优点:
本发明通过引入模型参考自适应模块,在车辆的自动驾驶系统中,尤其是在重型卡车的自动驾驶控制过程中,可以很好的解决换挡所带来的顿挫,以及控制过程中的动态偏差的技术问题,从而极大的提升自动驾驶车辆的纵向控制的精度,带来了更高的安全性和更平稳的驾驶体验。
本领域普通技术人员可以意识到,结合本发明实施例中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、或者计算机软件和电子硬件的结合来实现。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
在本申请所提供的实施例中,应该理解到,所揭露的装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。
所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。
Claims (8)
1.一种基于前馈控制的自动驾驶车辆的纵向控制系统,其特征在于,该纵向控制系统包括模型参考自适应模块和线控模块,所述模型参考自适应模块包括参考模型、第一融合子模块和自适应律子模块;所述系统还包括前馈模块和第二融合模块;
所述参考模型根据预先设定的车辆模型和参考模型的输入量生成参考模型的输出控制量;
所述第一融合子模块融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差;
所述自适应律子模块根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
所述前馈模块根据参考模型的输入量和输出值获得前馈输出控制量;
所述第二融合模块融合调整后的参考模型的输出控制量和前馈输出控制量获得系统的最终控制量;
其中,所述前馈输出控制量是通过如下公式获得的:
u2=k1(v)+k2(w)+k3(a)
其中,v是车辆的速度,w是车辆的载重,a是车辆的加速度,k1是车辆的速度的系数,k2是车辆的载重的系数,k3是车辆的加速度的系数。
2.根据权利要求1所述的纵向控制系统,其特征在于,所述自适应律子模块通过以下公式获得调整后的参考模型的输出控制量:
u1=∫(gamma*e*r)
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma是自适应律;e是第一误差。
3.根据权利要求2所述的纵向控制系统,其特征在于,所述第二融合模块通过以下公式获得系统的最终控制量:
CMDfinal=WMRAC*u1+WFF*u2;
其中,CMDfinal是系统的最终控制量;u1是调整后的参考模型的输出控制量;WMRAC是调整后的参考模型的输出控制量的权重;WFF是前馈输出控制量的权重;u2是前馈输出控制量。
4.根据权利要求1-3任一项所述的纵向控制系统,其特征在于,所述纵向控制系统还包括PID模块和第三融合模块;所述第三融合模块替换所述第二融合模块;
所述PID模块根据车辆的速度获得PID输出控制量;
所述第三融合模块融合调整后的参考模型的输出控制量、前馈输出控制量和PID输出控制量获得所述系统的最终控制量。
5.一种基于前馈控制的自动驾驶车辆的纵向控制方法,其特征在于,该纵向控制方法包括以下子步骤:
根据预先设定的车辆模型和参考模型的输入量生成参考模型的输出控制量;
融合所述参考模型的输出控制量和当前系统的实时状态量以获得第一误差;
根据车辆的类型和第一误差对所述参考模型的输出控制量进行调整,获得调整后的参考模型的输出控制量;
根据参考模型的输入量和输出值获得前馈输出控制量;
融合调整后的参考模型的输出控制量和前馈输出控制量获得系统的最终控制量;
其中,所述前馈输出控制量是通过以下公式获得的:
u2=k1(v)+k2(w)+k3(a)
其中,v是车辆的速度,w是车辆的载重,a是车辆的加速度,k1是车辆的速度的系数,k2是车辆的载重的系数,k3是车辆的加速度的系数。
6.根据权利要求5所述的纵向控制方法,其特征在于,所述调整后的参考模型的输出控制量通过以下公式获得:
u1=∫(gamma*e*r)
其中,u1是调整后的参考模型的输出控制量;r是参考模型的输入量;gamma是自适应律;e是第一误差。
7.根据权利要求6所述的纵向控制方法,其特征在于,所述系统的最终控制量通过以下公式获得:
CMDfinal=WMRAC*u1+WFF*u2;
其中,CMDfinal是系统的最终控制量;u1是调整后的参考模型的输出控制量;
WMRAC是调整后的参考模型的输出控制量的权重;WFF是前馈输出控制量的权重;u2是前馈输出控制量。
8.根据权利要求5-7任一项所述的纵向控制方法,其特征在于,所述纵向控制方法还包括以下步骤:
根据车辆的速度获得PID输出控制量;
融合调整后的参考模型的输出控制量、前馈输出控制量和PID输出控制量获得所述系统的最终控制量。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911226293.4A CN110843793B (zh) | 2019-12-04 | 2019-12-04 | 基于前馈控制的自动驾驶车辆的纵向控制系统和方法 |
PCT/CN2020/098223 WO2021109554A1 (en) | 2019-12-04 | 2020-06-24 | Longitudinal control system and method for autonomous vehicle based on feed forward control |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911226293.4A CN110843793B (zh) | 2019-12-04 | 2019-12-04 | 基于前馈控制的自动驾驶车辆的纵向控制系统和方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110843793A CN110843793A (zh) | 2020-02-28 |
CN110843793B true CN110843793B (zh) | 2021-11-23 |
Family
ID=69607744
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911226293.4A Active CN110843793B (zh) | 2019-12-04 | 2019-12-04 | 基于前馈控制的自动驾驶车辆的纵向控制系统和方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN110843793B (zh) |
WO (1) | WO2021109554A1 (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110843793B (zh) * | 2019-12-04 | 2021-11-23 | 苏州智加科技有限公司 | 基于前馈控制的自动驾驶车辆的纵向控制系统和方法 |
CN115257808A (zh) * | 2022-07-27 | 2022-11-01 | 驭势科技(北京)有限公司 | 车辆纵向控制方法、装置、电子设备和存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19508168A1 (de) * | 1995-03-08 | 1996-09-12 | Puschner Peter | Verfahren und Vorrichtung zur Erzeugung unterschiedlichen Betriebsverhaltens von Antriebsmotoren, insbesondere Fahrzeugmotoren |
CN102060009A (zh) * | 2010-12-10 | 2011-05-18 | 清华大学 | 一种具有电子辅助制动功能的制动系统 |
DE102010052583A1 (de) * | 2010-11-25 | 2012-05-31 | Audi Ag | Verfahren zum Festlegen des Wertes einer Stellgröße, die einen fahrdynamischen Zustand eines Kraftfahrzeugs bestimmt |
CN104199432A (zh) * | 2014-09-24 | 2014-12-10 | 奇瑞汽车股份有限公司 | 一种无人车的纵向智能控制系统 |
CN108628163A (zh) * | 2017-03-21 | 2018-10-09 | 波音公司 | 用于执行交通工具的基于观察器的控制的方法和装置 |
CN108928261A (zh) * | 2017-05-26 | 2018-12-04 | 华为技术有限公司 | 一种驱动防滑控制方法及车辆 |
CN110161854A (zh) * | 2019-05-21 | 2019-08-23 | 吉林大学 | 一种高速公路重型卡车编队纵向行驶控制方法 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5979581A (en) * | 1996-11-07 | 1999-11-09 | The Regents Of The University Of California | Lateral vehicle control apparatus and method for automated highway systems and intelligent cruise control |
CN106707765A (zh) * | 2017-02-27 | 2017-05-24 | 华东交通大学 | 高速动车组跟踪运行实时优化控制方法 |
CN106877746B (zh) * | 2017-03-21 | 2019-01-01 | 北京京东尚科信息技术有限公司 | 速度控制方法和速度控制装置 |
JP2018203017A (ja) * | 2017-06-02 | 2018-12-27 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、およびプログラム |
US11024178B2 (en) * | 2017-09-25 | 2021-06-01 | Continental Automotive Systems, Inc. | System and method for autonomously steering a vehicle |
US11203353B2 (en) * | 2018-03-09 | 2021-12-21 | Mitsubishi Heavy Industries, Ltd. | Steering control system, steering system, car, steering control method and recording medium |
CN110008600A (zh) * | 2019-04-09 | 2019-07-12 | 上海理工大学 | 车辆稳定性控制器性能保守性的设计方法 |
CN110281912B (zh) * | 2019-07-08 | 2020-10-16 | 江苏开放大学(江苏城市职业学院) | 一种智能车辆横向纵向综合控制系统及控制方法 |
CN110509930A (zh) * | 2019-08-16 | 2019-11-29 | 上海智驾汽车科技有限公司 | 人机共驾控制方法以及装置、电子设备、存储介质 |
CN110617152A (zh) * | 2019-10-18 | 2019-12-27 | 上海格陆博实业有限公司 | 一种基于模糊pid控制的油门控制系统 |
CN110888319B (zh) * | 2019-12-04 | 2023-08-01 | 苏州智加科技有限公司 | 用于自动驾驶车辆的纵向控制系统和纵向控制方法 |
CN110843793B (zh) * | 2019-12-04 | 2021-11-23 | 苏州智加科技有限公司 | 基于前馈控制的自动驾驶车辆的纵向控制系统和方法 |
CN110908284A (zh) * | 2019-12-06 | 2020-03-24 | 苏州智加科技有限公司 | 一种自动驾驶卡车的横向控制方法及系统 |
CN111114535B (zh) * | 2020-01-02 | 2021-08-17 | 联创汽车电子有限公司 | 智能驾驶车辆横向控制方法及控制系统 |
-
2019
- 2019-12-04 CN CN201911226293.4A patent/CN110843793B/zh active Active
-
2020
- 2020-06-24 WO PCT/CN2020/098223 patent/WO2021109554A1/en active Application Filing
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19508168A1 (de) * | 1995-03-08 | 1996-09-12 | Puschner Peter | Verfahren und Vorrichtung zur Erzeugung unterschiedlichen Betriebsverhaltens von Antriebsmotoren, insbesondere Fahrzeugmotoren |
DE102010052583A1 (de) * | 2010-11-25 | 2012-05-31 | Audi Ag | Verfahren zum Festlegen des Wertes einer Stellgröße, die einen fahrdynamischen Zustand eines Kraftfahrzeugs bestimmt |
CN102060009A (zh) * | 2010-12-10 | 2011-05-18 | 清华大学 | 一种具有电子辅助制动功能的制动系统 |
CN104199432A (zh) * | 2014-09-24 | 2014-12-10 | 奇瑞汽车股份有限公司 | 一种无人车的纵向智能控制系统 |
CN108628163A (zh) * | 2017-03-21 | 2018-10-09 | 波音公司 | 用于执行交通工具的基于观察器的控制的方法和装置 |
CN108928261A (zh) * | 2017-05-26 | 2018-12-04 | 华为技术有限公司 | 一种驱动防滑控制方法及车辆 |
CN110161854A (zh) * | 2019-05-21 | 2019-08-23 | 吉林大学 | 一种高速公路重型卡车编队纵向行驶控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110843793A (zh) | 2020-02-28 |
WO2021109554A1 (en) | 2021-06-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3750781A1 (en) | Control method and apparatus for autonomous vehicle, computer device, and storage medium | |
CN111857152B (zh) | 用于生成车辆控制信息的方法和装置 | |
CN110843793B (zh) | 基于前馈控制的自动驾驶车辆的纵向控制系统和方法 | |
CN110888319A (zh) | 用于自动驾驶车辆的纵向控制系统和纵向控制方法 | |
Čorić et al. | Optimisation of active suspension control inputs for improved vehicle handling performance | |
Menhour et al. | A new model-free design for vehicle control and its validation through an advanced simulation platform | |
CN114148320A (zh) | 一种路径跟踪控制方法及设备 | |
CN107635630A (zh) | 用于模型车辆的使用自动参数下载的转向稳定系统 | |
Mischinger et al. | Towards comfort-optimal trajectory planning and control | |
Hu et al. | Cooperative-game-theoretic optimal robust path tracking control for autonomous vehicles | |
US11225260B2 (en) | Control method and device for automated guided vehicle, and automated guided vehicle | |
Asperti et al. | On Torque Vectoring Control: Review and Comparison of State-of-the-Art Approaches | |
Tan et al. | A novel control approach for path tracking of a force-controlled two-wheel-steer four-wheel-drive vehicle | |
CN116118822B (zh) | 一种列车编组运行时的主动避碰控制方法、系统及介质 | |
CN115476881B (zh) | 车辆轨迹跟踪控制方法、装置、设备及介质 | |
Qin et al. | H∞ Control of Four‐Wheel‐Independent‐Drive Electric Vehicles with Random Time‐Varying Delays | |
CN109839964B (zh) | 舵机控制方法及终端设备 | |
CN114834529A (zh) | 一种车辆控制方法、装置、设备和介质 | |
Zhou et al. | Individualizable vehicle lane keeping assistance system design: A linear-programming-based model predictive control approach | |
Tagesson et al. | Combining coordination of motion actuators with driver steering interaction | |
CN114655277B (zh) | 重载列车智能驾驶超速防护曲线计算方法及相关设备 | |
CN114475575B (zh) | 一种汽车控制系统和方法以及汽车 | |
WO2022188716A1 (zh) | 车辆控制方法、装置、设备及计算机存储介质 | |
CN114475590B (zh) | 一种电动汽车力矩控制方法和系统以及可读存储介质 | |
CN110262536B (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 |