CN108860146B - 一种双驱车辆的速度控制方法、系统及相关装置 - Google Patents
一种双驱车辆的速度控制方法、系统及相关装置 Download PDFInfo
- Publication number
- CN108860146B CN108860146B CN201810594961.8A CN201810594961A CN108860146B CN 108860146 B CN108860146 B CN 108860146B CN 201810594961 A CN201810594961 A CN 201810594961A CN 108860146 B CN108860146 B CN 108860146B
- Authority
- CN
- China
- Prior art keywords
- speed
- tracking rate
- wheel set
- actual
- actual speed
- 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 41
- 238000004364 calculation method Methods 0.000 claims description 11
- 230000009977 dual effect Effects 0.000 claims description 11
- 238000004590 computer program Methods 0.000 claims description 10
- 238000011156 evaluation Methods 0.000 claims description 6
- 230000001360 synchronised effect Effects 0.000 claims description 6
- 230000009286 beneficial effect Effects 0.000 abstract description 2
- 230000008859 change Effects 0.000 description 10
- 230000008569 process Effects 0.000 description 10
- 230000000694 effects Effects 0.000 description 5
- 230000009471 action Effects 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 3
- 230000006872 improvement Effects 0.000 description 3
- 230000009347 mechanical transmission Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000003556 assay Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 230000009467 reduction Effects 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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/10—Path keeping
-
- 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/12—Conjoint control of vehicle sub-units of different type or different function including control of differentials
- B60W10/16—Axle differentials, e.g. for dividing torque between left and right wheels
-
- 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/28—Wheel speed
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
Abstract
本申请公开了一种双驱车辆的速度控制方法,所述速度控制方法包括确定标准跟踪率差值,并向驱动器下发控制指令;根据第一目标速度和第一实际速度计算第一速度跟踪率,并根据第一速度跟踪率和标准跟踪率差值计算标准跟踪率区间;根据第二轮组的第二速度跟踪率和标准跟踪率区间的关系调整第一轮组的实际速度或第二轮组的实际速度,以使调整后的第一轮组的速度跟踪率与第二轮组的速度跟踪率之差小于或等于标准跟踪率差值。本方法能够缩小第一轮组和第二轮组达到控制指令中的目标速度的时间差,减小车辆偏离预设路径的程度。本申请还公开了一种双驱车辆的速度控制系统、一种计算机可读存储介质及一种双驱车辆的控制器,具有以上有益效果。
Description
技术领域
本发明涉及车辆控制领域,特别涉及一种双驱车辆的速度控制方法、系统、一种计算机可读存储介质及一种双驱车辆的控制器。
背景技术
双驱车辆是一种通过前轮或后轮提供动力的车辆,具有较好的灵活性。双驱车辆的实质在于采用了双驱底盘,双驱底盘是由左右轮及左右轮驱动器组成的运动结构,由于存在两个驱动器,并且存在其他机械结构,故无法避免出现一边驱动器速度跟踪无法跟上另一边驱动器的情况,若在行驶的过程中左右两轮的速度变化情况不一致,造成车辆偏航或驱动器报错的问题。
在车辆驱动领域常常将控制器向车轮所下发的速度称为目标速度,将车轮在当前时刻的速度称为实际速度,可以根据目标速度与实际速度的关系得到该轮子的速度跟踪率,正常情况下左右两轮同时达到目标速度使得车辆按照预设路线行进。但是当出现机械传动故障或环境因素影响导致左右两轮的速度跟踪率相差较大时,就会出现上面描述的一边驱动器速度跟踪无法跟上另一边驱动器无法使得左右轮同时达到目标速度的情况,使得车辆偏离预设路线。在针对上述问题,现有技术只能通过人工的控制恢复车辆的正常行走路线,尚未存在从根本上解决双驱车辆左右两轮速度曲率不一致的技术方案。
因此,如何缩小第一轮组和第二轮组达到控制指令中的目标速度的时间差,减小车辆偏离预设路径的程度是本领域技术人员目前需要解决的技术问题。
发明内容
本申请的目的是提供一种双驱车辆的速度控制方法、系统、一种计算机可读存储介质及一种双驱车辆的控制器,能够缩小第一轮组和第二轮组达到控制指令中的目标速度的时间差,减小车辆偏离预设路径的程度。
为解决上述技术问题,本申请提供一种双驱车辆的速度控制方法,该速度控制方法包括:
确定标准跟踪率差值,并向驱动器下发控制指令,以使驱动器驱动所述第一轮组和所述第二轮组转动;其中,所述控制指令包括所述第一轮组转动所要达到的第一目标速度和所述第二轮组转动所要达到的第二目标速度;
接收当前时刻所述驱动器上传的第一实际速度和第二实际速度;其中,所述第一实际速度为当前时刻所述第一轮组的实际速度,所述第二实际速度为当前时刻所述第二轮组的实际速度;
根据所述第一目标速度和所述第一实际速度计算第一速度跟踪率,并根据所述第一速度跟踪率和所述标准跟踪率差值计算标准跟踪率区间;
根据所述第二目标速度和所述第二实际速度计算第二速度跟踪率,并判断所述第二速度跟踪率是否在所述标准跟踪率区间内;
若否,则调整所述第一轮组的实际速度或所述第二轮组的实际速度,以使调整后的所述第一轮组的速度跟踪率与所述第二轮组的速度跟踪率之差小于或等于所述标准跟踪率差值。
可选的,根据所述第一实际速度和所述第一目标速度计算第一速度跟踪率包括:
计算所述第一实际速度与所述第一目标速度的第一比值,并将所述第一比值作为所述第一速度跟踪率;
相应的,根据所述第二实际速度和所述第二目标速度计算第二速度跟踪率包括:
计算所述第二实际速度与所述第二目标速度的第二比值,并将所述第二比值作为所述第二速度跟踪率。
可选的,调整所述第一轮组的实际速度或所述第二轮组的实际速度包括:
判断所述第一速度跟踪率是否大于所述第二速度跟踪率;
若是,则调整所述第一轮组的实际速度,以使调整后的第一速度跟踪率与所述第二速度跟踪率相等;其中,所述第一实际速度为所述第一目标速度与所述第二速度跟踪率之积;
若否,则调整所述第二轮组的实际速度,以使调整后的第二速度跟踪率与所述第一速度跟踪率相等;其中,所述第二实际速度为所述第二目标速度与所述第一速度跟踪率之积。
可选的,在接收当前时刻所述驱动器上传的第一实际速度和第二实际速度之前,还包括:
所述驱动器将所述当前时刻所在周期内所述第一轮组的平均速度作为所述第一实际速度;
所述驱动器将所述当前时刻所在周期内所述第二轮组的平均速度作为所述第二实际速度。
本申请还提供了一种双驱车辆的速度控制系统,该系统包括:
指令发送模块,用于确定标准跟踪率差值,并向驱动器下发控制指令,以使驱动器驱动所述第一轮组和所述第二轮组转动;其中,所述控制指令包括所述第一轮组转动所要达到的第一目标速度和所述第二轮组转动所要达到的第二目标速度;
速度信息获取模块,用于接收当前时刻所述驱动器上传的第一实际速度和第二实际速度;其中,所述第一实际速度为当前时刻所述第一轮组的实际速度,所述第二实际速度为当前时刻所述第二轮组的实际速度;
标准区间确定模块,用于根据所述第一目标速度和所述第一实际速度计算第一速度跟踪率,并根据所述第一速度跟踪率和所述标准跟踪率差值计算标准跟踪率区间内;
同步评价模块,用于根据所述第二目标速度和所述第二实际速度计算第二速度跟踪率,并判断所述第二速度跟踪率是否在所述标准跟踪率区间;
调整模块,用于当所述第二速度跟踪率不在所述标准跟踪率区间时,则调整所述第一轮组的实际速度或所述第二轮组的实际速度,以使调整后的所述第一轮组的速度跟踪率与所述第二轮组的速度跟踪率之差小于或等于所述标准跟踪率差值。
可选的,所述标准区间确定模块包括:
第一速度跟踪率计算单元,用于计算所述第一实际速度与所述第一目标速度的第一比值,并将所述第一比值作为所述第一速度跟踪率;
区间计算单元,用于根据所述第一速度跟踪率和所述标准跟踪率差值计算标准跟踪率区间
相应的,所述同步评价模块包括:
第二速度跟踪率计算单元,用于计算所述第二实际速度与所述第二目标速度的第二比值,并将所述第二比值作为所述第二速度跟踪率;
判断单元,用于判断所述第二速度跟踪率是否在所述标准跟踪率区间
可选的,所述调整模块包括:
轮组确定单元,用于判断所述第一速度跟踪率是否大于所述第二速度跟踪率;
第一调整单元,用于当所述第一速度跟踪率大于所述第二速度跟踪率时,调整所述第一轮组的实际速度,以使调整后的第一速度跟踪率与所述第二速度跟踪率相等;其中,所述第一实际速度为所述第一目标速度与所述第二速度跟踪率之积;
第二调整单元,用于当所述第二速度跟踪率大于所述第一速度跟踪率时,则调整所述第二轮组的实际速度,以使调整后的第二速度跟踪率与所述第一速度跟踪率相等;其中,所述第二实际速度为所述第二目标速度与所述第一速度跟踪率之积。
可选的,还包括:
第一实际速度获取模块,用于将所述当前时刻所在周期内所述第一轮组的平均速度作为所述第一实际速度;
第二实际速度获取模块,用于将所述当前时刻所在周期内所述第二轮组的平均速度作为所述第二实际速度。
本申请还提供了一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序执行时实现上述双驱车辆的速度控制方法执行的步骤。
本申请还提供了一种双驱车辆的控制器,包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器调用所述存储器中的计算机程序时实现上述双驱车辆的速度控制方法执行的步骤。
本发明提供了一种双驱车辆的速度控制方法,包括确定标准跟踪率差值,并向驱动器下发控制指令,以使驱动器驱动所述第一轮组和所述第二轮组转动;其中,所述控制指令包括所述第一轮组转动所要达到的第一目标速度和所述第二轮组转动所要达到的第二目标速度;接收当前时刻所述驱动器上传的第一实际速度和第二实际速度;其中,所述第一实际速度为当前时刻所述第一轮组的实际速度,所述第二实际速度为当前时刻所述第二轮组的实际速度;根据所述第一目标速度和所述第一实际速度计算第一速度跟踪率,并根据所述第一速度跟踪率和所述标准跟踪率差值计算标准跟踪率区间;根据所述第二目标速度和所述第二实际速度计算第二速度跟踪率,并判断所述第二速度跟踪率是否在所述标准跟踪率区间内;若否,则调整所述第一轮组的实际速度或所述第二轮组的实际速度,以使调整后的所述第一轮组的速度跟踪率与所述第二轮组的速度跟踪率之差小于或等于所述标准跟踪率差值。
由于双驱底盘存在许多其他结构,因此第一轮组和第二轮组的实际速度无法立刻且同时达到目标速度,因此机械卡顿、驱动器跟踪性能不好等原因是现有技术中无法使第一轮组和第二轮组能够同时达到控制指令中的目标速度的根本原因。当第一轮组和第二轮组无法达到目标速度时,就会导致第一轮组和第二轮组的跟踪率就会存在不一致的情况。基于此本发明首先确定标准跟踪率差值这一关于评价第一轮组和第二轮组速度跟踪率相差程度的标准。进一步的,本发明通过获取第一目标速度和第一实际速度计算得到第一轮组的第一速度跟踪率,再根据第一速度跟踪率和标准跟踪率差值计算关于第二轮组的速度跟踪率的标准范围——标准跟踪率区间。进一步的,本发明通过获取第二目标速度和第二实际速度计算得到第二轮组的第二速度跟踪率,判断第二速度跟踪率是否在标准跟踪率区间内,如果在标准跟踪率区间内则说明第一轮组和第二轮组的速度变化情况良好,即第一轮组和第二轮组的速度都能够跟得上对方,如果不在标准跟踪率区间内,则说明第一轮组和第二轮组之中存在一个轮组跟不上另一轮组的情况。进一步的,本发明通过改变向第一轮组或第二轮组下发的目标速度,控制第一轮组或第二轮组的速度跟踪率,使得两个轮组之间的速度跟踪率差值恢复至允许的范围内,进而缩小第一轮组和第二轮组达到控制指令中的目标速度的时间差,减小车辆偏离预设路径的程度的目的。本申请同时还提供了一种双驱车辆的速度变化曲率同步系统、一种计算机可读存储介质和一种双驱车辆的控制器,具有上述有益效果,在此不再赘述。
附图说明
为了更清楚地说明本申请实施例,下面将对实施例中所需要使用的附图做简单的介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请实施例所提供的一种双驱车辆的速度控制方法的流程图;
图2为本申请实施例所提供的另一种双驱车辆的速度控制方法的流程图;
图3为正常跟踪时速度与时间的关系图;
图4为发生异常跟踪时速度与时间的关系图;
图5为本申请实施例所提供的一种双驱车辆的速度控制系统的结构示意图。
具体实施方式
为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
下面请参见图1,图1为本申请实施例所提供的一种双驱车辆的速度控制方法的流程图。
具体步骤可以包括:
S101:确定标准跟踪率差值,并向驱动器下发控制指令,以使驱动器驱动所述第一轮组和所述第二轮组转动;其中,所述控制指令包括所述第一轮组转动所要达到的第一目标速度和所述第二轮组转动所要达到的第二目标速度;
其中,由于第一轮组和第二轮组的速度跟踪率不一致是现有技术中,第一轮组和第二轮组无法同时达到目标速度的根本原因,本步骤确定的标准跟踪率差值是指关于评价速度跟踪率情况的标准。当第一轮组和第二轮组的速度跟踪率差值大于标准跟踪率差值则认为存在一侧轮组的速度执行效果明显小于另一侧轮组(即速度变化较慢的一侧轮组无法跟上速度变化较快的一侧轮组),此时将会导致车辆严重偏航,影响正常的车辆导航。需要补充的是,标准跟踪率差值是本领域技术人员综合考虑车辆性能以及车辆行驶的环境设置的数值,可以根据方案的具体实施环境灵活设定。
值得注意的是,本实施例的实施主体为控制器,即在控制器层面进行的改进,本实施例可以适用于控制任意一种驱动器实现缩小第一轮组和第二轮组达到控制指令中的目标速度的时间差,减小车辆偏离预设路径的程度的目的。
可以理解的是,标准跟踪率差值是由关于控制精度设置的值,向驱动器下发的控制指令是指根据双驱车辆的行走路线和所要达到的速度设置的。控制器向驱动器下发控制指令,驱动器根据控制指令改变第一轮组和第二轮组的速度进而实现双驱车辆按照预设的行走路线运动。值得一提的是,驱动器并不能够立刻驱动第一轮组达到第一执行速度,而是需要一定的时间让第一轮组逐渐变速最终达到第一目标速度。需要说明的是,实际上驱动器改变第一轮组的转速,由于第一轮组是具有固定直径和减速比等固定传动系数的,故转速可以换算为实际速度,因此可以理解为驱动器改变第一轮组的速度。上述说明也适用于第二轮组,此处不再赘述。当然,本实施例中可以存在多个驱动器用于控制第一轮组和第二轮组,即第一轮组有与其唯一对应的第一驱动器,第二轮组有与其唯一对应的第二驱动器,本实施例中并不对驱动器的数量和具体控制关系进行限定。
可以理解的是,本实施例中提到的第一轮组和第二轮组是指双驱车辆提供动力的两类轮,此处不对第一轮组和第二轮组具体包括多少车轮进行限定,一般情况下,第一轮组为一个车轮,第二轮组为与第一轮组不同侧的一个车轮。
S102:接收当前时刻所述驱动器上传的第一实际速度和第二实际速度;其中,所述第一实际速度为当前时刻所述第一轮组的实际速度,所述第二实际速度为当前时刻所述第二轮组的实际速度;
其中,本步骤的目的在于获取驱动器驱动第一轮组和第二轮组转动的情况。在驱动器控制第一轮组和第二轮组转动的整个过程的中,第一轮组和第二轮组是经过一定的加速度操作实现的,在不同的时刻第一轮组和第二轮组都有不同的速度,当然随着驱动器根据速度命令控制电机驱动的时间越长,第一轮组和第二轮组的速度就越接近速度命令中的第一目标速度和第二目标速度。由于在第一轮组和第二轮组未达到第一目标速度和第二目标速度之前,第一轮组的速度和第二轮组的速度都是不断改变的,因此获取当前时刻第一轮组的实际速度和第二轮组的实际速度能够准确分析第一轮组和第二轮组在驱动器驱动下达到相应执行速度的进度,即速度跟踪率。
可以理解的是,由于某一时刻的第一轮组和第二轮组的实际速度会存在一定的误差的情况,因此可以获取当前时刻对应的周期内的第一轮组的平均速度作为实际速度,将第二轮组的平均速度作为实际速度。
S103:根据所述第一目标速度和所述第一实际速度计算第一速度跟踪率,并根据所述第一速度跟踪率和所述标准跟踪率差值计算标准跟踪率区间;
其中,在获得第一目标速度和第一实际速度的前提下,可以分析第一轮组关于控制指令的完成程度——第一速度跟踪率。速度跟踪率的计算方法可以是第一执行速度与第一轮组的实际速度的比值,也可以是第一轮组的实际速度和第一执行速度的比值,此处不进行具体的限定,只要得到的第一速度跟踪率能够体现第一轮组已经达到的速度和第一轮组所要达到的速度的关系即可。
进一步的,本步骤在获得了第一速度跟踪率的基础上可以确定标准跟踪率区间,即当第二速度跟踪率在标准跟踪率区间内时,说明第二速度跟踪率与第一速度跟踪率之间的差值小于标准跟踪率差值,此时双驱车辆的速度变化曲率的差距在误差允许的范围内,不会出现明显的自动导航偏航现象。
S104:根据所述第二目标速度和所述第二实际速度计算第二速度跟踪率,并判断所述第二速度跟踪率是否在所述标准跟踪率区间内;若是,则结束流程;若否,则进入S105;
其中,在不发生任何传动误差和环境误差的理想状态下,任意时刻的第一速度跟踪率和第二速度跟踪率是完全一致的,在这种情况下双驱车辆能够按照规定好的路线行驶,驱动器也不会发生因第一轮组或第二轮组跟不上对方而报错的现象。但是,由于在实际操作中,理想状态是基本不会发生的,第一轮组和第二轮组的速度跟踪率或多或少都会有一定的偏差,当然,或跟踪率的变差在误差允许的范围内时,并不会导致车辆的严重偏航,这是允许出现的。可是,当第一轮组和第二轮组的速度跟踪率相差过大时(如大于本步骤中所说的标准跟踪率差值)将会导致车辆严重偏航,影响正常的车辆导航。
本步骤是在S103的基础上对第二轮组当前时刻的第二速度跟踪率进行评价,若第二速度跟踪率在标准跟踪率范围内则说明当前时刻第一轮组和第二轮组的速度变化情况基本一致;反之则说明存在某一侧轮组因机械传动故障或环境因素导致驱动器执行控制指令的执行效果明显比另一侧差,需要进行S105中的调节操作。
S105:调整所述第一轮组的实际速度或所述第二轮组的实际速度,以使调整后的所述第一轮组的速度跟踪率与所述第二轮组的速度跟踪率之差小于或等于所述标准跟踪率差值。
其中,本步骤是建立在S104判断第二速度跟踪率不在所述标准跟踪率区间内的前提下,需要改变第一轮组和第二轮组的跟踪率差值。本步骤中调整第一执行速度或第二执行速度的操作是在控制器层面上执行的,可以理解的是,当出现跟踪率差值较大的情况是因为存在一侧的轮组因机械传动问题无法跟上另一侧轮组的速度,因此此时是不可能通过改变速度跟踪率较差的轮组的实际速度来缩小跟踪率差值,故应该改变速度跟踪率较好的轮组的执行速度。也就是说,S105中“调整所述第一轮组的实际速度或所述第二轮组的实际速度”实际上是指,改变第一轮组和第二轮组中速度跟踪率较好的轮组的执行速度。进一步的,评价速度跟踪率的良好和较差,可以通过比较轮组当前时刻的速度与其所要达到的实际速度的接近程度,当前时刻的速度越接近执行速度则速度跟踪率越好,当前时刻的速度越不接近执行速度则速度跟踪率越差。
可以理解的是,此处不对通过调整所述第一轮组的实际速度或第二轮组的实际速度的具体数值进行限定,只要调整后的速度跟踪率差值小于第二预设值即可。作为一种优选的实施方案,可以使调节后的速度跟踪率差值小于预设值,该预设值是根据本方案的实际应用情况设定的且该预设值小于标准速度跟踪离差值,此处设置的预设值的意义在于当速度跟踪率差值小于预设值时,即使第一轮组和第二轮组的速度存在一定的偏差,也不会对双驱车辆的正常行驶产生明显的影响,也不会使驱动器报错。当然作为一种更优选的实施方案,可以是调整后的第一速度跟踪率与第二速度跟踪率相等,即速度跟踪率差值为零。
值得注意的是,速度跟踪率仅仅与控制器下发的执行速度和轮组的实际速度相关,因此在控制器层面改变轮组的实际速度能够起到改变速度跟踪率的效果。进一步的,本实施例的目的在于使第一轮组和第二轮组的速度跟踪率一致,进而使得第一轮组和第二轮组能够同时达到控制指令中的目标速度,保证双驱车辆的运行过程中不偏离预设的路线。
由于双驱底盘存在许多其他结构,因此第一轮组和第二轮组的实际速度无法立刻且同时达到目标速度,故左右两轮的速度跟踪率不一致是现有技术中双驱车辆出现偏航的主要原因。基于此本实施例首先确定标准跟踪率差值这一关于评价第一轮组和第二轮组速度跟踪率相差程度的标准。进一步的,本实施例通过获取第一目标速度和第一实际速度计算得到第一轮组的第一速度跟踪率,再根据第一速度跟踪率和标准跟踪率差值计算关于第二轮组的速度跟踪率的标准范围——标准跟踪率区间。进一步的,本实施例通过获取第二目标速度和第二实际速度计算得到第二轮组的第二速度跟踪率,判断第二速度跟踪率是否在标准跟踪率区间内,如果在标准跟踪率区间内则说明第一轮组和第二轮组的速度变化情况良好,即第一轮组和第二轮组的速度都能够跟得上对方,如果不在标准跟踪率区间内,则说明第一轮组和第二轮组之中存在一个轮组跟不上另一轮组的情况。进一步的,本实施例通过改变向第一轮组或第二轮组的实际速度,使得两个轮组之间的速度跟踪率差值恢复至允许的范围内,进而实现了缩小第一轮组和第二轮组达到控制指令中的目标速度的时间差,减小车辆偏离预设路径的程度的目的。
下面请参见图2,图2为本申请实施例所提供的另一种双驱车辆的速度控制方法的流程图;
具体步骤可以包括:
S201:确定标准跟踪率差值,并向驱动器下发控制指令,以使驱动器驱动所述第一轮组和所述第二轮组转动;其中,所述控制指令包括所述第一轮组转动所要达到的第一目标速度和所述第二轮组转动所要达到的第二目标速度;
S202:接收当前时刻所述驱动器上传的第一实际速度和第二实际速度;其中,所述第一实际速度为当前时刻所述第一轮组的实际速度,所述第二实际速度为当前时刻所述第二轮组的实际速度;
其中,本步骤为了避免单次突变影响检测的稳定性,在当前时刻所在的周期内选取了多次轮组的速度计算平均值作为实际速度。本实施例将检测第一轮组和第二轮组的速度状况的过程划分为多个周期,周期的时长可以根据实施情况灵活设定,作为一种优选的实施方案,每个周期的时长是相同的。
上面的该过程可以具体为:所述驱动器将所述当前时刻所在周期内所述第一轮组的平均速度作为所述第一实际速度;所述驱动器将所述当前时刻所在周期内所述第二轮组的平均速度作为所述第二实际速度。
S203:计算所述第一实际速度与所述第一目标速度的第一比值,并将所述第一比值作为所述第一速度跟踪率,并根据所述第一速度跟踪率和所述标准跟踪率差值计算标准跟踪率区间;
S204:计算所述第二实际速度与所述第二目标速度的第二比值,并将所述第二比值作为所述第二速度跟踪率。
S205:判断所述第二速度跟踪率是否在所述标准跟踪率区间内;若是,则进入S202;若否,则进入S206;
S206:判断所述第一速度跟踪率是否大于所述第二速度跟踪率;若是,则进入S207;若否,则进入S208;
S207:调整所述第一轮组的实际速度,以使调整后的第一速度跟踪率与所述第二速度跟踪率相等;其中,所述第一实际速度为所述第一目标速度与所述第二速度跟踪率之积;
S208:调整所述第二轮组的实际速度,以使调整后的第二速度跟踪率与所述第一速度跟踪率相等;其中,所述第二实际速度为所述第二目标速度与所述第一速度跟踪率之积。
本实施例相对于上一实施例,将调整后第一轮组和第二轮组的速度跟踪率相等,能够保证使第一轮组和第二轮组同时达到控制指令中的目标速度,避免出现车辆偏航的现象。
下面结合图3和图4,通过一个具体的例子说明上述实施例的操作流程:
确定标准跟踪率差值为0.2,控制器向驱动器下发的控制指令为第一轮组的速度要达到100mm/s,第二轮组的速度要达到120mm/s。检测到当前时刻第一轮组的实际速度为50mm/s,第二轮组的实际速度为30mm/s,计算第一轮组的速度跟踪率为50÷100=0.5,计算标准跟踪率区间为(0.3,0.7)。计算第二轮组的速度跟踪率为0.25,此时间第二轮组的速度跟踪率不在标准跟踪率区间内,故可以确定第一轮组和第二轮组的速度执行差异较大且第一轮组的速度执行效果较好,因此此时需要改变第一轮组的执行速度。将第一轮组的实际速度调整为100*0.25=25mm/s,调整后第一轮组和第二轮组的速度跟踪率相等,即两轮的速度执行效果一致。
请参见图5,图5为本申请实施例所提供的一种双驱车辆的速度控制系统的结构示意图;
该系统可以包括:
指令发送模块100,用于确定标准跟踪率差值,并向驱动器下发控制指令,以使驱动器驱动所述第一轮组和所述第二轮组转动;其中,所述控制指令包括所述第一轮组转动所要达到的第一目标速度和所述第二轮组转动所要达到的第二目标速度;
速度信息获取模块200,用于接收当前时刻所述驱动器上传的第一实际速度和第二实际速度;其中,所述第一实际速度为当前时刻所述第一轮组的实际速度,所述第二实际速度为当前时刻所述第二轮组的实际速度;
标准区间确定模块300,用于根据所述第一目标速度和所述第一实际速度计算第一速度跟踪率,并根据所述第一速度跟踪率和所述标准跟踪率差值计算标准跟踪率区间内;
同步评价模块400,用于根据所述第二目标速度和所述第二实际速度计算第二速度跟踪率,并判断所述第二速度跟踪率是否在所述标准跟踪率区间;
调整模块500,用于当所述第二速度跟踪率不在所述标准跟踪率区间时,则调整所述第一轮组的实际速度或所述第二轮组的实际速度,以使调整后的所述第一轮组的速度跟踪率与所述第二轮组的速度跟踪率之差小于或等于所述标准跟踪率差值。
进一步的,所述标准区间确定模块300包括:
第一速度跟踪率计算单元,用于计算所述第一实际速度与所述第一目标速度的第一比值,并将所述第一比值作为所述第一速度跟踪率;
区间计算单元,用于根据所述第一速度跟踪率和所述标准跟踪率差值计算标准跟踪率区间
相应的,所述同步评价模块包括:
第二速度跟踪率计算单元,用于计算所述第二实际速度与所述第二目标速度的第二比值,并将所述第二比值作为所述第二速度跟踪率;
判断单元,用于判断所述第二速度跟踪率是否在所述标准跟踪率区间
进一步的,所述调整模块500包括:
轮组确定单元,用于判断所述第一速度跟踪率是否大于所述第二速度跟踪率;
第一调整单元,用于当所述第一速度跟踪率大于所述第二速度跟踪率时,调整所述第一轮组的实际速度,以使调整后的第一速度跟踪率与所述第二速度跟踪率相等;其中,所述第一实际速度为所述第一目标速度与所述第二速度跟踪率之积;
第二调整单元,用于当所述第二速度跟踪率大于所述第一速度跟踪率时,则调整所述第二轮组的实际速度,以使调整后的第二速度跟踪率与所述第一速度跟踪率相等;其中,所述第二实际速度为所述第二目标速度与所述第一速度跟踪率之积。
进一步的,还包括:
第一实际速度获取模块,用于将所述当前时刻所在周期内所述第一轮组的平均速度作为所述第一实际速度;
第二实际速度获取模块,用于将所述当前时刻所在周期内所述第二轮组的平均速度作为所述第二实际速度。
由于系统部分的实施例与方法部分的实施例相互对应,因此系统部分的实施例请参见方法部分的实施例的描述,这里暂不赘述。
本申请还提供了一种计算机可读存储介质,其上存有计算机程序,该计算机程序被执行时可以实现上述实施例所提供的步骤。该存储介质可以包括:U盘、移动硬盘、只读存储器(Read-Only Memory,ROM)、随机存取存储器(Random Access Memory,RAM)、磁碟或者光盘等各种可以存储程序代码的介质。
本申请还提供了一种双驱车辆的控制器,可以包括存储器和处理器,所述存储器中存有计算机程序,所述处理器调用所述存储器中的计算机程序时,可以实现上述实施例所提供的步骤。当然所述双驱车辆的控制器还可以包括各种网络接口,电源等组件。
说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。应当指出,对于本技术领域的普通技术人员来说,在不脱离本申请原理的前提下,还可以对本申请进行若干改进和修饰,这些改进和修饰也落入本申请权利要求的保护范围内。
还需要说明的是,在本说明书中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的状况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
Claims (10)
1.一种双驱车辆的速度控制方法,应用于控制器,其特征在于,包括:
确定标准跟踪率差值,并向驱动器下发控制指令,以使所述驱动器驱动第一轮组和第二轮组转动;其中,所述控制指令包括所述第一轮组转动所要达到的第一目标速度和所述第二轮组转动所要达到的第二目标速度;
接收当前时刻所述驱动器上传的第一实际速度和第二实际速度;其中,所述第一实际速度为当前时刻所述第一轮组的实际速度,所述第二实际速度为当前时刻所述第二轮组的实际速度;
根据所述第一目标速度和所述第一实际速度计算第一速度跟踪率,并根据所述第一速度跟踪率和所述标准跟踪率差值计算标准跟踪率区间;
根据所述第二目标速度和所述第二实际速度计算第二速度跟踪率,并判断所述第二速度跟踪率是否在所述标准跟踪率区间内;
若否,则调整所述第一轮组的实际速度或所述第二轮组的实际速度,以使调整后的所述第一轮组的速度跟踪率与所述第二轮组的速度跟踪率之差小于或等于所述标准跟踪率差值。
2.根据权利要求1所述速度控制方法,其特征在于,根据所述第一实际速度和所述第一目标速度计算第一速度跟踪率包括:
计算所述第一实际速度与所述第一目标速度的第一比值,并将所述第一比值作为所述第一速度跟踪率;
相应的,根据所述第二实际速度和所述第二目标速度计算第二速度跟踪率包括:
计算所述第二实际速度与所述第二目标速度的第二比值,并将所述第二比值作为所述第二速度跟踪率。
3.根据权利要求1所述速度控制方法,其特征在于,调整所述第一轮组的实际速度或所述第二轮组的实际速度包括:
判断所述第一速度跟踪率是否大于所述第二速度跟踪率;
若是,则调整所述第一轮组的实际速度,以使调整后的第一速度跟踪率与所述第二速度跟踪率相等;其中,所述第一实际速度为所述第一目标速度与所述第二速度跟踪率之积;
若否,则调整所述第二轮组的实际速度,以使调整后的第二速度跟踪率与所述第一速度跟踪率相等;其中,所述第二实际速度为所述第二目标速度与所述第一速度跟踪率之积。
4.根据权利要求1所述速度控制方法,其特征在于,在接收当前时刻所述驱动器上传的第一实际速度和第二实际速度之前,还包括:
所述驱动器将所述当前时刻所在周期内所述第一轮组的平均速度作为所述第一实际速度;
所述驱动器将所述当前时刻所在周期内所述第二轮组的平均速度作为所述第二实际速度。
5.一种双驱车辆的速度控制系统,应用于控制器,其特征在于,包括:
指令发送模块,用于确定标准跟踪率差值,并向驱动器下发控制指令,以使所述驱动器驱动第一轮组和第二轮组转动;其中,所述控制指令包括所述第一轮组转动所要达到的第一目标速度和所述第二轮组转动所要达到的第二目标速度;
速度信息获取模块,用于接收当前时刻所述驱动器上传的第一实际速度和第二实际速度;其中,所述第一实际速度为当前时刻所述第一轮组的实际速度,所述第二实际速度为当前时刻所述第二轮组的实际速度;
标准区间确定模块,用于根据所述第一目标速度和所述第一实际速度计算第一速度跟踪率,并根据所述第一速度跟踪率和所述标准跟踪率差值计算标准跟踪率区间内;
同步评价模块,用于根据所述第二目标速度和所述第二实际速度计算第二速度跟踪率,并判断所述第二速度跟踪率是否在所述标准跟踪率区间;
调整模块,用于当所述第二速度跟踪率不在所述标准跟踪率区间时,则调整所述第一轮组的实际速度或所述第二轮组的实际速度,以使调整后的所述第一轮组的速度跟踪率与所述第二轮组的速度跟踪率之差小于或等于所述标准跟踪率差值。
6.根据权利要求5所述速度控制系统,其特征在于,所述标准区间确定模块包括:
第一速度跟踪率计算单元,用于计算所述第一实际速度与所述第一目标速度的第一比值,并将所述第一比值作为所述第一速度跟踪率;
区间计算单元,用于根据所述第一速度跟踪率和所述标准跟踪率差值计算标准跟踪率区间;
相应的,所述同步评价模块包括:
第二速度跟踪率计算单元,用于计算所述第二实际速度与所述第二目标速度的第二比值,并将所述第二比值作为所述第二速度跟踪率;
判断单元,用于判断所述第二速度跟踪率是否在所述标准跟踪率区间。
7.根据权利要求5所述速度控制系统,其特征在于,所述调整模块包括:
轮组确定单元,用于判断所述第一速度跟踪率是否大于所述第二速度跟踪率;
第一调整单元,用于当所述第一速度跟踪率大于所述第二速度跟踪率时,调整所述第一轮组的实际速度,以使调整后的第一速度跟踪率与所述第二速度跟踪率相等;其中,所述第一实际速度为所述第一目标速度与所述第二速度跟踪率之积;
第二调整单元,用于当所述第二速度跟踪率大于所述第一速度跟踪率时,则调整所述第二轮组的实际速度,以使调整后的第二速度跟踪率与所述第一速度跟踪率相等;其中,所述第二实际速度为所述第二目标速度与所述第一速度跟踪率之积。
8.根据权利要求5所述速度控制系统,其特征在于,还包括:
第一实际速度获取模块,用于将所述当前时刻所在周期内所述第一轮组的平均速度作为所述第一实际速度;
第二实际速度获取模块,用于将所述当前时刻所在周期内所述第二轮组的平均速度作为所述第二实际速度。
9.一种双驱车辆的控制器,其特征在于,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序时执行如权利要求1至4任一项所述的双驱车辆的速度控制方法的步骤。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至4任一项所述的双驱车辆的速度控制方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810594961.8A CN108860146B (zh) | 2018-06-11 | 2018-06-11 | 一种双驱车辆的速度控制方法、系统及相关装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810594961.8A CN108860146B (zh) | 2018-06-11 | 2018-06-11 | 一种双驱车辆的速度控制方法、系统及相关装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108860146A CN108860146A (zh) | 2018-11-23 |
CN108860146B true CN108860146B (zh) | 2020-03-17 |
Family
ID=64337729
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810594961.8A Active CN108860146B (zh) | 2018-06-11 | 2018-06-11 | 一种双驱车辆的速度控制方法、系统及相关装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108860146B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111469856B (zh) * | 2020-04-17 | 2021-11-02 | 湖南三一电控科技有限公司 | 叉车和叉车的速度控制方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2514162B (en) * | 2013-05-16 | 2015-08-05 | Jaguar Land Rover Ltd | Vehicle speed control system |
GB2550160B (en) * | 2016-05-10 | 2018-11-14 | Jaguar Land Rover Ltd | Vehicle driveline disconnect method and apparatus |
CN108068938B (zh) * | 2016-11-11 | 2020-01-03 | 广东高标电子科技有限公司 | 一种双轮车速度控制方法及系统 |
CN107878448B (zh) * | 2016-12-30 | 2018-11-06 | 比亚迪股份有限公司 | 车辆控制方法和装置 |
CN107561933B (zh) * | 2017-08-21 | 2020-12-04 | 深圳市同川科技有限公司 | 速度调节方法、装置、计算机设备和存储介质 |
-
2018
- 2018-06-11 CN CN201810594961.8A patent/CN108860146B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108860146A (zh) | 2018-11-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10144445B2 (en) | Modified static tire model for providing assist without a torque sensor for zero to low vehicle speeds | |
US9409595B2 (en) | Providing assist torque without hand wheel torque sensor for zero to low vehicle speeds | |
CN107215334B (zh) | 车速控制方法、装置及无人驾驶汽车 | |
US20160121898A1 (en) | Method of controlling coasting operation of hybrid vehicle and apparatus for performing the same | |
JP5287736B2 (ja) | 車両制御装置 | |
US20130151066A1 (en) | Determination of steering angle for a motor vehicle | |
CN102310858B (zh) | 车道保持控制方法和装置、以及用于车道脱离警告的装置 | |
CN104512412A (zh) | 用于执行驾驶辅助的方法和装置 | |
CN105438178A (zh) | 一种车辆负载预估方法及系统 | |
CN113911204B (zh) | 一种转向系统失效备份的方法及系统 | |
CN112356828A (zh) | 一种车辆横向控制方法、装置、车辆和可读存储介质 | |
JP4475175B2 (ja) | 車線推定装置 | |
CN108860146B (zh) | 一种双驱车辆的速度控制方法、系统及相关装置 | |
KR20120069842A (ko) | 차량의 적응형 순항제어시스템의 제어방법 및 제어장치 | |
KR20150051680A (ko) | 도로의 경사를 고려한 차량 속도 제어 장치 및 방법 | |
CN113291316A (zh) | 一种车辆控制的方法和装置 | |
CN108776740B (zh) | 一种双驱车辆的速度变化曲率同步方法、系统及相关组件 | |
US20180297633A1 (en) | Methods and systems for vehicle lateral force control | |
CN110254248B (zh) | 由大于蠕行车速过渡至蠕行车速的扭矩控制方法及装置 | |
CN108791305B (zh) | 一种双驱车辆加速度变化曲率同步方法、系统及相关装置 | |
KR101930163B1 (ko) | 차로 유지 제어 장치 및 방법 | |
CN108791304B (zh) | 一种双驱车辆的加速度控制方法、系统及相关装置 | |
CN111824167A (zh) | 车辆的速度限制方法、装置、车辆及电子设备 | |
CN115320572A (zh) | 一种车辆控制方法及装置 | |
Lei et al. | Vehicle direct yaw moment control based on tire cornering stiffness estimation |
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 |