CN110341715A - 无人车坡道速度控制方法及装置 - Google Patents
无人车坡道速度控制方法及装置 Download PDFInfo
- Publication number
- CN110341715A CN110341715A CN201910673476.4A CN201910673476A CN110341715A CN 110341715 A CN110341715 A CN 110341715A CN 201910673476 A CN201910673476 A CN 201910673476A CN 110341715 A CN110341715 A CN 110341715A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- acceleration
- information
- speed
- expectation
- 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.)
- Pending
Links
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
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/04—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
- B60W10/06—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units including control of combustion engines
-
- 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
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/18—Conjoint control of vehicle sub-units of different type or different function including control of braking 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
- B60W40/076—Slope angle of the road
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/105—Speed
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/107—Longitudinal acceleration
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
- B60W2520/105—Longitudinal acceleration
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/16—Pitch
-
- 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
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/06—Combustion engines, Gas turbines
- B60W2710/0605—Throttle position
-
- 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
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/18—Braking system
- B60W2710/182—Brake pressure, e.g. of fluid or between pad and disc
Abstract
本发明提供了一种无人车坡道速度控制方法,包括:获取车辆的俯仰角信息,并结合车辆的实际加速度、预设的俯仰角扰动与车辆加速度的拟合系数,确定坡度信息,随后,确定重力加速度在坡道方向的分量;根据车辆的实际和规划车速,计算车辆的第一期望加速度,结合根据重力加速度在坡道方向的分量,计算第二期望加速度;根据车辆的实际车速、第二期望加速度,查询预设的节气门开度/制动压力表,确定节气门开度信息或制动压力信息,节气门开度信息用于控制车辆加速,制动压力信息用于控制车辆减速。由此,提升自动驾驶车辆在坡道行驶时的速度控制效果,有效解决自动驾驶车辆在上坡场景中不能起步的情况和下坡场景中刹车溜车的情况。
Description
技术领域
本发明涉及数据处理技术领域,尤其涉及一种无人车坡道速度控制方法及装置。
背景技术
近年来,随着无人驾驶技术的快速发展,无人驾驶技术越来越受到人们的关注。无人驾驶算法主要包括四个核心模块:感知模块、定位模块、决策模块和控制模块,控制模块又包括车辆的横向控制和纵向控制。横向控制控制方向盘使车辆跟踪目标轨迹,纵向控制控制车辆的节气门开度和制动压力使车辆较好的跟随决策模块规划好的道路速度。而对于坡道这一复杂场景,由于该场景的干扰会对加大控制模型的失配,从而导致车辆出现不能正常起步,速度跟随精度降低,停车时车辆溜车等现象。因此提高坡道场景下的速度控制效果,对于提高自动驾驶车辆的经济性、安全性和舒适性都具有重要的意义。
大多是通过引入积分环节的形式抵消由于坡道的干扰带来的模型的失配,在车辆下坡时,由于重力的分力在坡道的影响,导致实际车速会大于决策模块规划好的车速,积分模块使节气门开度逐渐减小或制动压力逐渐正大,直至实际车速与规划车速基本相等;在车辆上坡时,坡道的影响使实际车速小于决策模块规划好的车速,此时积分模块使制动压力逐渐减小或节气门开度逐渐增大,直至实际车速与规划车速积分相等。
这种在自动驾驶纵向控制算法中引入积分环节来抵消坡道对车辆运动模型的干扰的方式存在以下缺点:
1.由于积分环节存在滞后的现象,会导致车辆速度控制存在较大的超调。
2.由于积分的起作用的效果较慢,车辆起步时间会明显增长。
3.积分往往会设置积分上下限,导致较大坡道下即使引入积分,也会出现速度稳态误差较大、车辆不能正常起步、车辆刹车出现溜车的现象。
综上,采用积分补偿的方式解决自动驾驶车辆坡道场景的速度控制,在较大坡道场景中安全性、经济型和舒适性均较差。
发明内容
本发明实施例的目的是提供一种无人车坡道速度控制方法,以解决现有技术中采用积分补偿的方式解决自动驾驶车辆坡道场景的速度控制,在较大坡道场景中安全性、经济型和舒适性均较差的问题。
为解决上述问题,第一方面,本发明提供了一种无人车坡道速度控制方法,所述方法包括:
获取车辆的俯仰角信息;
根据所述俯仰角信息、车辆的实际加速度、预设的俯仰角扰动与车辆加速度的拟合系数,确定坡度信息;
根据所述坡度信息,确定重力加速度在坡道方向的分量;
根据所述车辆的实际车速和规划车速,计算车辆的第一期望加速度;
根据所述重力加速度在坡道方向的分量和所述第一期望加速度,计算第二期望加速度;
根据所述车辆的实际车速、所述第二期望加速度,查询预设的节气门开度/制动压力表,确定所述实际车速、所述第二期望加速度对应的节气门开度信息或制动压力信息,所述节气门开度信息用于控制车辆加速,所述制动压力信息用于控制车辆减速。
在一种可能的实现方式中,所述方法之前还包括:
获取车辆的原始俯仰角信息;
对所述原始俯仰角信息进行滤波处理,得到俯仰角信息。
在一种可能的实现方式中,所述根据所述俯仰角信息、车辆的实际加速度、预设的俯仰角扰动与车辆加速度的拟合系数,确定坡度信息,具体包括:
利用公式slope=pitch_after_filter-k*a_real计算坡度信息;
其中,slope为坡度信息,pitch_after_filter为俯仰角信息,k为预设的俯仰角扰动与车辆加速度的拟合系数,a_real为车辆的实际加速度。
在一种可能的实现方式中,所述根据所述坡度信息,确定重力加速度在坡道方向的分量,具体包括:
利用公式g_a=g*sin(slope*π/180)计算重力加速度在坡道方向的分量;
其中,g_a为重力加速度在坡道方向的分量,g为重力加速度,slope为坡度信息。
在一种可能的实现方式中,所述根据所述车辆的实际车速和规划车速,计算车辆的第一期望加速度,具体包括:
利用公式acc_command=p*(v_real-v_desired)计算车辆的第一期望加速度;
其中,acc_command为第一期望加速度,v_real为车辆的实际车速,v_desired为车辆的规划车速。
在一种可能的实现方式中,所述根据所述重力加速度在坡道方向的分量和所述第一期望加速度,计算第二期望加速度,具体包括:
利用公式acc_desired=acc_command-g_a计算第二期望加速度;
其中,acc_desired为第二期望加速度,acc_command为第一期望加速度,g_a为重力加速度在坡道方向的分量。
在一种可能的实现方式中,所述根据所述车辆的实际车速、所述第二期望加速度,查询预设的节气门开度/制动压力表,确定所述实际车速、所述第二期望加速度对应的节气门开度信息或制动压力信息,具体包括:
通过对所述车辆的实际车速、所述第二期望加速度进行二维线性插值,确定节气门开度信息或制动压力信息。
第二方面,本发明提供了一种无人车坡道速度控制装置,所述装置包括:
获取单元,所述获取单元用于获取车辆的俯仰角信息;
确定单元,所述确定单元用于根据所述俯仰角信息、车辆的实际加速度、预设的俯仰角扰动与车辆加速度的拟合系数,确定坡度信息;
所述确定单元还用于根据所述坡度信息,确定重力加速度在坡道方向的分量;
计算单元,所述计算单元用于根据所述车辆的实际车速和规划车速,计算车辆的第一期望加速度;
所述计算单元还用于根据所述重力加速度在坡道方向的分量和所述第一期望加速度,计算第二期望加速度;
所述确定单元还用于根据所述车辆的实际车速、所述第二期望加速度,查询预设的节气门开度/制动压力表,确定所述实际车速、所述第二期望加速度对应的节气门开度信息或制动压力信息,所述节气门开度信息用于控制车辆加速,所述制动压力信息用于控制车辆减速。
第三方面,本发明提供了一种设备,包括存储器和处理器,所述存储器用于存储程序,所述处理器用于执行第一方面任一所述的方法。
第四方面,本发明提供了一种包含指令的计算机程序产品,当所述计算机程序产品在计算机上运行时,使得所述计算机执行如第一方面任一所述的方法。
第五方面,本发明提供了一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如第一方面任一所述的方法。
通过应用本发明实施例一提供的无人车坡道速度控制方法及装置,实时获取车辆的俯仰角信息,并对俯仰角信息进行滤波、去干扰等处理,代替车辆行驶道路的坡度信息,通过该信息补偿车辆的第一期望加速度,从而实现通过坡度信息调整车辆的油门开度和制动压力,实现自动驾驶车辆在坡道环境下的车辆起步,精确速度跟随及刹车功能,可以显著提升自动驾驶车辆在坡道行驶时的速度控制效果,有效解决自动驾驶车辆在上坡场景中不能起步的情况和下坡场景中刹车溜车的情况。
附图说明
图1为本发明实施例一提供的无人车坡道速度控制方法流程示意图;
图2为本发明实施例二提供的无人车坡道速度控制装置结构示意图。
具体实施方式
下面结合附图和实施例对本申请作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释相关发明,而非对该发明的限定。另外还需要说明的是,为便于描述,附图中仅示出了与有关发明相关的部分。
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本申请。
图1为本发明实施例一提供的无人车坡道速度控制方法流程示意图,该方法应用在无人驾驶车辆中,该方法的执行主体为无人驾驶车辆的处理器。方法包括以下步骤:
步骤101,获取车辆的俯仰角信息。
其中,在步骤101之前,还包括:
获取车辆的原始俯仰角信息;
对原始俯仰角信息进行滤波处理,得到俯仰角信息。
具体的,车辆进入自动驾驶模式后,控制模块,即车辆的处理器实时从惯性测量单元(Inertial measurement unit,IMU)中读取车辆的原始俯仰角信息。由于从IMU获取的车辆的原始俯仰角信息存在噪声,因此首先需要对原始俯仰角信息进行低通滤波,以过滤掉原始俯仰角信号中的噪声,得到俯仰角信息,从而避免俯仰角发生跳变,影响控制效果。
步骤102,根据俯仰角信息、车辆的实际加速度、预设的俯仰角扰动与车辆加速度的拟合系数,确定坡度信息。
具体的,利用公式slope=pitch_after_filter-k*a_real计算坡度信息;
其中,slope为坡度信息,pitch_after_filter为俯仰角信息,k为预设的俯仰角扰动与车辆加速度的拟合系数,a_real为车辆的实际加速度。车辆的实际加速度可以通过车辆上的加速度传感器测量得到。
由于车辆的加速、减速等运动会对车辆的俯仰角信息造成影响,加速时车辆的俯仰角会增大,减速时车辆的俯仰角会减小。加速度越大该现象越明显。该现象会影响道路坡度信息数据获取的准确性,因此需要去除车辆加减速对车辆俯仰角的干扰。
由于不同车辆悬架的刚度和轴距不同,为了得到汽车加减速对车辆俯仰角变化的影响,需要进行实车测试。首先将自动驾驶车辆开到一条平直的道路上,此时道路的坡度基本为0,此时使车辆进行加减速运动即可使车辆的俯仰角信息发生变化。在车辆的加速度范围(例如[-5,3])内,每次以一定的间隔让车辆以不同的加速度加速和减速,并分别记录下车辆在不同加速度下加减速俯仰角的变化情况,最后得到俯仰角扰动与车辆加速度的拟合系数k。
步骤103,根据坡度信息,确定重力加速度在坡道方向的分量。
具体的,可以利用公式g_a=g*sin(slope*π/180)计算重力加速度在坡道方向的分量;
其中,g_a为重力加速度在坡道方向的分量,g为重力加速度,slope为坡度信息。
步骤104,根据车辆的实际车速和规划车速,计算车辆的第一期望加速度。
具体的,利用公式acc_command=p*(v_real-v_desired)计算车辆的第一期望加速度;
其中,acc_command为第一期望加速度,v_real为车辆的实际车速,v_desired为车辆的规划车速,p为经验值,单位为1/s,p的数值可以为0.8-1。
具体的,无人车在行驶过程中,会根据车辆当前的位置信息和环境感知数据,进行路径规划,得到全局规划路径,在全局规划路径上有多个路点,每个路点包括路点的x坐标、y坐标、航向角、车辆的规划车速。
车辆在行驶的过程中,会实时的获取到车辆的实际车速,比如,可以通过差分GPS得到车辆的实际车速,通过轮速计得到车辆的实际车速等,本申请对车辆的实际车速的获取方法,并不限定。
步骤105,根据重力加速度在坡道方向的分量和第一期望加速度,计算第二期望加速度。
具体的,利用公式acc_desired=acc_command-g_a计算第二期望加速度;
其中,acc_desired为第二期望加速度,acc_command为第一期望加速度,g_a为重力加速度在坡道方向的分量。
步骤106,根据车辆的实际车速、第二期望加速度,查询预设的节气门开度/制动压力表,确定实际车速、第二期望加速度对应的节气门开度信息或制动压力信息,节气门开度信息用于控制车辆加速,制动压力信息用于控制车辆减速。
其中,可以通过车速和补偿后的期望加速度查表输出油门开度信息或制动压力信息。
首先在一条平直的道路测试车辆的速度和加速度与油门开度或制动压力的MAP图。以固定步长的油门开度/制动压力下测试不同速度下汽车的加速度大小,完成由油门开度/制动压力,车速及加速度的二维表格绘制,如表1所示:
表1
使用matlab将表1的二维表转化为节气门开度/制动压力与速度和期望加速度的二维表,如表2所示:
表2
通过实时车速v和坡度补偿后期望加速度acc_desired进行二维线性插值,查找表2获取节气门开度信息或制动压力信息,从而实现车辆坡道下速度的控制。
二维线性插值可以采取双线性插值、一维插值等,本申请对此并不限定。
通过应用本发明实施例一提供的无人车坡道速度控制方法,实时获取车辆的俯仰角信息,并对俯仰角信息进行滤波、去干扰等处理,代替车辆行驶道路的坡度信息,通过该信息补偿车辆的第一期望加速度,从而实现通过坡度信息调整车辆的油门开度和制动压力,实现自动驾驶车辆在坡道环境下的车辆起步,精确速度跟随及刹车功能,可以显著提升自动驾驶车辆在坡道行驶时的速度控制效果,有效解决自动驾驶车辆在上坡场景中不能起步的情况和下坡场景中刹车溜车的情况。
图2为本发明实施例二提供的无人车坡道速度控制装置结构示意图。该无人车坡道速度控制装置应用在无人车坡道速度控制方法中,如图2所示,该无人车坡道速度控制装置包括:获取单元201,确定单元202和计算单元203。
获取单元201用于获取车辆的俯仰角信息;
确定单元202用于根据俯仰角信息、车辆的实际加速度、预设的俯仰角扰动与车辆加速度的拟合系数,确定坡度信息;
确定单元202还用于根据坡度信息,确定重力加速度在坡道方向的分量;
计算单元203用于根据车辆的实际车速和规划车速,计算车辆的第一期望加速度;
计算单元203还用于根据重力加速度在坡道方向的分量和第一期望加速度,计算第二期望加速度;
确定单元202还用于根据车辆的实际车速、第二期望加速度,查询预设的节气门开度/制动压力表,确定实际车速、第二期望加速度对应的节气门开度信息或制动压力信息,节气门开度信息用于控制车辆加速,制动压力信息用于控制车辆减速。
各个单元的具体作用于上述实施例一中的描述相同,此处不再赘述。
通过应用本发明实施例一提供的无人车坡道速度控制方法,实时获取车辆的俯仰角信息,并对俯仰角信息进行滤波、去干扰等处理,代替车辆行驶道路的坡度信息,通过该信息补偿车辆的第一期望加速度,从而实现通过坡度信息调整车辆的油门开度和制动压力,实现自动驾驶车辆在坡道环境下的车辆起步,精确速度跟随及刹车功能,可以显著提升自动驾驶车辆在坡道行驶时的速度控制效果,有效解决自动驾驶车辆在上坡场景中不能起步的情况和下坡场景中刹车溜车的情况。
本发明实施例三提供了一种设备,包括存储器和处理器,存储器用于存储程序,存储器可通过总线与处理器连接。存储器可以是非易失存储器,例如硬盘驱动器和闪存,存储器中存储有软件程序和设备驱动程序。软件程序能够执行本发明实施例提供的上述方法的各种功能;设备驱动程序可以是网络和接口驱动程序。处理器用于执行软件程序,该软件程序被执行时,能够实现本发明实施例一提供的方法。
本发明实施例四提供了一种包含指令的计算机程序产品,当计算机程序产品在计算机上运行时,使得计算机执行本发明实施例一提供的方法。
本发明实施例五提供了一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,计算机程序被处理器执行时实现本发明实施例一提供的方法。
专业人员应该还可以进一步意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
结合本文中所公开的实施例描述的方法或算法的步骤可以用硬件、处理器执行的软件模块,或者二者的结合来实施。软件模块可以置于随机存储器(RAM)、内存、只读存储器(ROM)、电可编程ROM、电可擦除可编程ROM、寄存器、硬盘、可移动磁盘、CD-ROM、或技术领域内所公知的任意其它形式的存储介质中。
以上的具体实施方式,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上仅为本发明的具体实施方式而已,并不用于限定本发明的保护范围,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种无人车坡道速度控制方法,其特征在于,所述方法包括:
获取车辆的俯仰角信息;
根据所述俯仰角信息、车辆的实际加速度、预设的俯仰角扰动与车辆加速度的拟合系数,确定坡度信息;
根据所述坡度信息,确定重力加速度在坡道方向的分量;
根据所述车辆的实际车速和规划车速,计算车辆的第一期望加速度;
根据所述重力加速度在坡道方向的分量和所述第一期望加速度,计算第二期望加速度;
根据所述车辆的实际车速、所述第二期望加速度,查询预设的节气门开度/制动压力表,确定所述实际车速、所述第二期望加速度对应的节气门开度信息或制动压力信息,所述节气门开度信息用于控制车辆加速,所述制动压力信息用于控制车辆减速。
2.根据权利要求1所述的方法,其特征在于,所述方法之前还包括:
获取车辆的原始俯仰角信息;
对所述原始俯仰角信息进行滤波处理,得到俯仰角信息。
3.根据权利要求1所述的方法,其特征在于,所述根据所述俯仰角信息、车辆的实际加速度、预设的俯仰角扰动与车辆加速度的拟合系数,确定坡度信息,具体包括:
利用公式slope=pitch_after_filter-k*a_real计算坡度信息;
其中,slope为坡度信息,pitch_after_filter为俯仰角信息,k为预设的俯仰角扰动与车辆加速度的拟合系数,a_real为车辆的实际加速度。
4.根据权利要求1所述的方法,其特征在于,所述根据所述坡度信息,确定重力加速度在坡道方向的分量,具体包括:
利用公式g_a=g*sin(slope*π/180)计算重力加速度在坡道方向的分量;
其中,g_a为重力加速度在坡道方向的分量,g为重力加速度,slope为坡度信息。
5.根据权利要求1所述的方法,其特征在于,所述根据所述车辆的实际车速和规划车速,计算车辆的第一期望加速度,具体包括:
利用公式acc_command=p*(v_real-v_desired)计算车辆的第一期望加速度;
其中,acc_command为第一期望加速度,v_real为车辆的实际车速,v_desired为车辆的规划车速。
6.根据权利要求1所述的方法,其特征在于,所述根据所述重力加速度在坡道方向的分量和所述第一期望加速度,计算第二期望加速度,具体包括:
利用公式acc_desired=acc_command-g_a计算第二期望加速度;
其中,acc_desired为第二期望加速度,acc_command为第一期望加速度,g_a为重力加速度在坡道方向的分量。
7.根据权利要求1所述的方法,其特征在于,所述根据所述车辆的实际车速、所述第二期望加速度,查询预设的节气门开度/制动压力表,确定所述实际车速、所述第二期望加速度对应的节气门开度信息或制动压力信息,具体包括:
通过对所述车辆的实际车速、所述第二期望加速度进行二维线性插值,确定节气门开度信息或制动压力信息。
8.一种无人车坡道速度控制装置,其特征在于,所述装置包括:
获取单元,所述获取单元用于获取车辆的俯仰角信息;
确定单元,所述确定单元用于根据所述俯仰角信息、车辆的实际加速度、预设的俯仰角扰动与车辆加速度的拟合系数,确定坡度信息;
所述确定单元还用于根据所述坡度信息,确定重力加速度在坡道方向的分量;
计算单元,所述计算单元用于根据所述车辆的实际车速和规划车速,计算车辆的第一期望加速度;
所述计算单元还用于根据所述重力加速度在坡道方向的分量和所述第一期望加速度,计算第二期望加速度;
所述确定单元还用于根据所述车辆的实际车速、所述第二期望加速度,查询预设的节气门开度/制动压力表,确定所述实际车速、所述第二期望加速度对应的节气门开度信息或制动压力信息,所述节气门开度信息用于控制车辆加速,所述制动压力信息用于控制车辆减速。
9.一种设备,其特征在于,所述设备包括存储器和处理器,所述存储器用于存储程序,所述处理器用于执行权利要求1-7任一所述的方法。
10.一种包含指令的计算机程序产品,其特征在于,当所述计算机程序产品在计算机上运行时,所述计算机执行如权利要求1-7任一所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910673476.4A CN110341715A (zh) | 2019-07-24 | 2019-07-24 | 无人车坡道速度控制方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910673476.4A CN110341715A (zh) | 2019-07-24 | 2019-07-24 | 无人车坡道速度控制方法及装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110341715A true CN110341715A (zh) | 2019-10-18 |
Family
ID=68178815
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910673476.4A Pending CN110341715A (zh) | 2019-07-24 | 2019-07-24 | 无人车坡道速度控制方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110341715A (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111959495A (zh) * | 2020-06-29 | 2020-11-20 | 北京百度网讯科技有限公司 | 车辆的控制方法、装置及车辆 |
CN112693457A (zh) * | 2020-12-31 | 2021-04-23 | 浙江合众新能源汽车有限公司 | 一种基于滑行阻力特性的自适应巡航方法及系统 |
CN112757914A (zh) * | 2021-02-03 | 2021-05-07 | 青岛慧拓智能机器有限公司 | 一种无人驾驶电驱动矿车的速度跟随控制方法 |
CN112802356A (zh) * | 2020-12-30 | 2021-05-14 | 深圳市微网力合信息技术有限公司 | 一种基于物联网的车辆自动驾驶方法及终端 |
CN113650507A (zh) * | 2021-08-25 | 2021-11-16 | 汤恩智能科技(常熟)有限公司 | 一种自动行走车辆的驻车方法及终端 |
CN113844415A (zh) * | 2021-10-11 | 2021-12-28 | 安徽江淮汽车集团股份有限公司 | 一种智能驾驶车辆的控制方法及控制系统 |
CN113895446A (zh) * | 2021-12-13 | 2022-01-07 | 智道网联科技(北京)有限公司 | 自动驾驶车辆速度确定方法、装置、设备及存储介质 |
CN114200825A (zh) * | 2021-10-29 | 2022-03-18 | 东风商用车有限公司 | 一种整车自适应控制系统 |
CN114312843A (zh) * | 2021-12-29 | 2022-04-12 | 北京百度网讯科技有限公司 | 用于确定信息的方法和装置 |
CN114439923A (zh) * | 2022-01-30 | 2022-05-06 | 中国第一汽车股份有限公司 | 应用于车辆中的变速方法、装置、电子设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140121856A1 (en) * | 2012-10-26 | 2014-05-01 | Kia Motors Corporation | Method and system for measuring tilt angle of vehicle |
CN103852064A (zh) * | 2014-03-28 | 2014-06-11 | 安徽农业大学 | 一种道路坡度车载实时测试系统及其测试方法 |
CN103963785A (zh) * | 2014-05-20 | 2014-08-06 | 武汉理工大学 | 一种用于汽车自适应巡航系统的双模式控制方法 |
CN107031635A (zh) * | 2017-04-14 | 2017-08-11 | 重庆长安汽车股份有限公司 | 低速自适应巡航控制系统及方法 |
CN108297872A (zh) * | 2018-03-08 | 2018-07-20 | 中国第汽车股份有限公司 | 全工况车载路面坡度估算装置和方法 |
-
2019
- 2019-07-24 CN CN201910673476.4A patent/CN110341715A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140121856A1 (en) * | 2012-10-26 | 2014-05-01 | Kia Motors Corporation | Method and system for measuring tilt angle of vehicle |
CN103852064A (zh) * | 2014-03-28 | 2014-06-11 | 安徽农业大学 | 一种道路坡度车载实时测试系统及其测试方法 |
CN103963785A (zh) * | 2014-05-20 | 2014-08-06 | 武汉理工大学 | 一种用于汽车自适应巡航系统的双模式控制方法 |
CN107031635A (zh) * | 2017-04-14 | 2017-08-11 | 重庆长安汽车股份有限公司 | 低速自适应巡航控制系统及方法 |
CN108297872A (zh) * | 2018-03-08 | 2018-07-20 | 中国第汽车股份有限公司 | 全工况车载路面坡度估算装置和方法 |
Non-Patent Citations (2)
Title |
---|
马国成等: "驾驶员辅助系统中自适应加速度跟随控制器的设计", 《汽车工程》 * |
马峰: "山区高速公路驾驶员速度控制模型研究", 《中国优秀硕士学位论文全文数据库,工程科技Ⅱ辑》 * |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111959495B (zh) * | 2020-06-29 | 2021-11-12 | 阿波罗智能技术(北京)有限公司 | 车辆的控制方法、装置及车辆 |
CN111959495A (zh) * | 2020-06-29 | 2020-11-20 | 北京百度网讯科技有限公司 | 车辆的控制方法、装置及车辆 |
CN112802356A (zh) * | 2020-12-30 | 2021-05-14 | 深圳市微网力合信息技术有限公司 | 一种基于物联网的车辆自动驾驶方法及终端 |
CN112802356B (zh) * | 2020-12-30 | 2022-01-04 | 深圳市微网力合信息技术有限公司 | 一种基于物联网的车辆自动驾驶方法及终端 |
CN112693457A (zh) * | 2020-12-31 | 2021-04-23 | 浙江合众新能源汽车有限公司 | 一种基于滑行阻力特性的自适应巡航方法及系统 |
CN112757914A (zh) * | 2021-02-03 | 2021-05-07 | 青岛慧拓智能机器有限公司 | 一种无人驾驶电驱动矿车的速度跟随控制方法 |
CN113650507B (zh) * | 2021-08-25 | 2023-08-18 | 汤恩智能科技(常熟)有限公司 | 一种自动行走车辆的驻车方法及终端 |
CN113650507A (zh) * | 2021-08-25 | 2021-11-16 | 汤恩智能科技(常熟)有限公司 | 一种自动行走车辆的驻车方法及终端 |
CN113844415A (zh) * | 2021-10-11 | 2021-12-28 | 安徽江淮汽车集团股份有限公司 | 一种智能驾驶车辆的控制方法及控制系统 |
CN114200825B (zh) * | 2021-10-29 | 2024-01-19 | 东风商用车有限公司 | 一种整车自适应控制系统 |
CN114200825A (zh) * | 2021-10-29 | 2022-03-18 | 东风商用车有限公司 | 一种整车自适应控制系统 |
CN113895446A (zh) * | 2021-12-13 | 2022-01-07 | 智道网联科技(北京)有限公司 | 自动驾驶车辆速度确定方法、装置、设备及存储介质 |
CN113895446B (zh) * | 2021-12-13 | 2022-02-22 | 智道网联科技(北京)有限公司 | 自动驾驶车辆速度确定方法、装置、设备及存储介质 |
CN114312843A (zh) * | 2021-12-29 | 2022-04-12 | 北京百度网讯科技有限公司 | 用于确定信息的方法和装置 |
CN114312843B (zh) * | 2021-12-29 | 2023-10-20 | 北京百度网讯科技有限公司 | 用于确定信息的方法和装置 |
CN114439923A (zh) * | 2022-01-30 | 2022-05-06 | 中国第一汽车股份有限公司 | 应用于车辆中的变速方法、装置、电子设备及存储介质 |
CN114439923B (zh) * | 2022-01-30 | 2023-08-08 | 中国第一汽车股份有限公司 | 应用于车辆中的变速方法、装置、电子设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110341715A (zh) | 无人车坡道速度控制方法及装置 | |
Sharp et al. | Optimal preview car steering control | |
JP4586795B2 (ja) | 車両用制御装置 | |
Kapania et al. | Path tracking of highly dynamic autonomous vehicle trajectories via iterative learning control | |
CN109407677A (zh) | 自动驾驶车辆的轨迹跟踪方法 | |
CN111532339B (zh) | 一种智能车辆个性化侧向辅助驾驶方法及其系统 | |
CN109080631A (zh) | 用于车辆的低速横向控制的系统和方法 | |
CN110967991A (zh) | 车辆控制参数的确定方法、装置、车载控制器和无人车 | |
US20130191002A1 (en) | Drive assist system and drive assist method | |
CN105480228B (zh) | 增强的车辆速度控制 | |
Kim et al. | Vehicle path prediction using yaw acceleration for adaptive cruise control | |
CN111731307B (zh) | 一种车辆转弯控制方法、装置、车辆及存储介质 | |
Lee et al. | Multirate active steering control for autonomous vehicle lateral maneuvering | |
CN112099378B (zh) | 考虑随机测量时滞的前车侧向运动状态实时估计方法 | |
CN110027547A (zh) | 车辆横向控制方法和装置 | |
CN114001739B (zh) | 一种路径规划方法、装置、车辆及存储介质 | |
CN112158196B (zh) | 自动泊车方法及装置 | |
Chen et al. | Nonlinear model predictive control of autonomous vehicles considering dynamic stability constraints | |
Hernandez et al. | Lateral control of higher order nonlinear vehicle model in emergency maneuvers using absolute positioning GPS and magnetic markers | |
WO2022203026A1 (ja) | 運転制御装置 | |
CN115123233A (zh) | 规划车辆轨迹的方法和装置 | |
CN115476881A (zh) | 车辆轨迹跟踪控制方法、装置、设备及介质 | |
CN115542899A (zh) | 车辆路径跟踪的方法、装置、车辆、电子设备及介质 | |
CN111857112B (zh) | 一种汽车局部路径规划方法及电子设备 | |
CN110654458B (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20191018 |