CN110109464A - 一种无人驾驶车辆的转向速度控制方法及控制端 - Google Patents
一种无人驾驶车辆的转向速度控制方法及控制端 Download PDFInfo
- Publication number
- CN110109464A CN110109464A CN201910454340.4A CN201910454340A CN110109464A CN 110109464 A CN110109464 A CN 110109464A CN 201910454340 A CN201910454340 A CN 201910454340A CN 110109464 A CN110109464 A CN 110109464A
- Authority
- CN
- China
- Prior art keywords
- data
- max
- angle
- angular velocity
- difference data
- 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
- 238000000034 method Methods 0.000 title claims abstract description 18
- 239000000654 additive Substances 0.000 claims abstract description 26
- 230000000996 additive effect Effects 0.000 claims abstract description 26
- 230000004044 response Effects 0.000 claims abstract description 26
- 238000004590 computer program Methods 0.000 claims description 9
- 230000001186 cumulative effect Effects 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 claims 1
- 230000009286 beneficial effect Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000009191 jumping Effects 0.000 description 3
- 230000004913 activation Effects 0.000 description 2
- 235000013399 edible fruits Nutrition 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了一种无人驾驶车辆的转向速度控制方法及控制端,接收当前角度数据和目标角度数据,得到角度差数据以及角速度差数据;判断角度差数据是否大于快速响应判定阈值,若是,则根据角速度差数据以及转向最大角速度生成第一输出驱动数据,否则判断是否大于或等于N*转向最大滑行距离,若是,则根据角度差数据以及角速度差数据生成第二输出驱动数据,若角度差数据小于N*转向最大滑行距离,则根据角度差数据、角速度差数据以及角度变化量累加因子生成第三输出驱动数据;本发明通过上述方式,使得转向速度控制具有快速性、稳定性以及精确性,更适合于无人车的高机动性要求,又具有抵抗外加干扰能力且稳定性好,从而提高转向控制的精度。
Description
技术领域
本发明涉及无人驾驶车辆领域,特别涉及一种无人驾驶车辆的转向速度控制方法及控制端。
背景技术
无人驾驶是驾驶技术的一个发展趋势,目前无人驾驶技术主要偏向于辅助人工驾驶。其中,现有的线控转向技术,主要考虑因素是乘车人的安全性和舒适性,对于机动性和精确性要求不足,并不适用于部分需求机动性强的无人乘坐远程操控车,因为没有人在无人驾驶车辆上进行判断,便无需考虑乘车人的安全性和舒适性,而缺少了人为的判断,则对无人驾驶车辆的转向控制精度要求更高,更需要一种有效的转向控制方法。
发明内容
本发明所要解决的技术问题是:提供一种无人驾驶车辆的转向速度控制方法及控制端,能够提高转向控制的精度。
为了解决上述技术问题,本发明采用的技术方案为:
一种无人驾驶车辆的转向速度控制方法,包括步骤:
S1、接收当前角度数据和目标角度数据,得到角度差数据以及角速度差数据;
S2、判断所述角度差数据是否大于快速响应判定阈值,若是,则根据角速度差数据以及转向最大角速度生成第一输出驱动数据,否则判断是否大于或等于N*转向最大滑行距离,若是,则根据所述角度差数据以及角速度差数据生成第二输出驱动数据,若所述角度差数据小于N*转向最大滑行距离,则根据所述角度差数据、所述角速度差数据以及角度变化量累加因子生成第三输出驱动数据,所述N的取值范围为[0.1,0.5]。
为了解决上述技术问题,本发明采用的另一种技术方案为:
一种转向速度控制端,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现以下步骤:
S1、接收当前角度数据和目标角度数据,得到角度差数据以及角速度差数据;
S2、判断所述角度差数据是否大于快速响应判定阈值,若是,则根据角速度差数据以及转向最大角速度生成第一输出驱动数据,否则判断是否大于或等于N*转向最大滑行距离,若是,则根据所述角度差数据以及角速度差数据生成第二输出驱动数据,若所述角度差数据小于N*转向最大滑行距离,则根据所述角度差数据、所述角速度差数据以及角度变化量累加因子生成第三输出驱动数据,所述N的取值范围为[0.1,0.5]。
本发明的有益效果在于:一种无人驾驶车辆的转向速度控制方法及控制端,通过引入方向盘的转向角速度参数,根据角度差数据与快速响应判定阈值、转向最大滑行距离的关系,判断其与目标距离的不同,从而根据不同的参数生成不同的驱动输出,即提供了一种快速寻优控制方式,使得转向速度控制具有快速性、稳定性以及精确性,更适合于无人车的高机动性要求,又具有抵抗外加干扰能力且稳定性好,从而提高转向控制的精度。
附图说明
图1为本发明实施例的一种无人驾驶车辆的转向速度控制方法的流程示意图;
图2为本发明实施例涉及的不同控制阶段理想的目标速度曲线示意图;
图3为本发明实施例涉及的精确稳定阶段时驱动输出大于理论输出的曲线示意图;
图4为本发明实施例涉及的精确稳定阶段时驱动输出小于理论输出的曲线示意图;
图5为本发明实施例的一种转向速度控制端的结构示意图。
标号说明:
1、一种转向速度控制端;2、处理器;3、存储器。
具体实施方式
为详细说明本发明的技术内容、所实现目的及效果,以下结合实施方式并配合附图予以说明。
请参照图1至图4,一种无人驾驶车辆的转向速度控制方法,包括步骤:
S1、接收当前角度数据和目标角度数据,得到角度差数据以及角速度差数据;
S2、判断所述角度差数据是否大于快速响应判定阈值,若是,则根据角速度差数据以及转向最大角速度生成第一输出驱动数据,否则判断是否大于或等于N*转向最大滑行距离,若是,则根据所述角度差数据以及角速度差数据生成第二输出驱动数据,若所述角度差数据小于N*转向最大滑行距离,则根据所述角度差数据、所述角速度差数据以及角度变化量累加因子生成第三输出驱动数据,所述N的取值范围为[0.1,0.5]。
其中,角度差数据大于快速响应判定阈值,则为快速控制阶段;角度差数据小于快速响应判定阈值且大于转向最大滑行距离时为稳定控制阶段;角度差数据小于转向最大滑行距离时为稳定控制阶段。
从上述描述可知,本发明的有益效果在于:通过引入方向盘的转向角速度参数,根据角度差数据与快速响应判定阈值、转向最大滑行距离的关系,判断其与目标距离的不同,从而根据不同的参数生成不同的驱动输出,即提供了一种快速寻优控制方式,使得转向速度控制具有快速性、稳定性以及精确性,更适合于无人车的高机动性要求,又具有抵抗外加干扰能力且稳定性好,从而提高转向控制的精度。
进一步地,所述步骤S2中快速响应判定阈值具体为:
FV=2*SMAX+ɑ12*a,所述FV为快速响应判定阈值,所述SMAX为转向最大滑行距离,所述转向最大滑行距离为在当前角速度数据到达所述转向最大角速度时撤除驱动后的滑行距离,所述ɑ12为角度差数据,所述角度差数据为所述当前角度数据ɑ1与所述目标角度数据ɑ2的差值,所述a为比例系数。
从上述描述可知,根据转向最大滑行距离来确定快速响应判定阈值,以此来作为不同驱动输出的条件,充分的考虑了转向机构整体惯性量,从而实现快速且稳定的转向速度控制。
进一步地,所述步骤S2中所述第一输出驱动数据的理想目标角速度为:
ωK=ωMAX,所述ωK为第一输出驱动数据的理想目标角速度;
所述步骤S2中所述第二输出驱动数据的理想目标速度为:
ωW=ωMAX*[ɑ1/(2*SMAX)],所述ωW为第二输出驱动数据的理想目标角速度,所述ωMAX为转向最大角速度,所述ɑ1为当前角度数据,所述SMAX为转向最大滑行距离,所述转向最大滑行距离为在当前角速度数据到达所述转向最大角速度时撤除驱动后的滑行距离;
所述步骤S2中所述第三输出驱动数据的理想目标速度与所述第二输出驱动数据的理想目标角速度一致。
从上述描述可知,在目标控制距离较大时,使得角速度数据尽可能的达到转向最大角速度,在目标控制距离较近时,由于转向控制无法实现快速跳变控制,通过上述公式进行加速减速控制,即保证了从而实现快速且精确的转向速度控制。
进一步地,所述步骤S2中第一输出驱动数据具体为:
P1=n1*PMAX=[1-(ω12/ωMAX)]*PMAX,所述P1为第一输出驱动数据,所述ω12为角速度差数据,所述角速度差数据为当前角速度数据ω1与目标角速度数据ω2的差值,所述ωMAX为转向最大角速度,所述PMAX为转向电机最大输出数据;
所述步骤S2中第二输出驱动数据具体为:
P2={[|ɑ12|/(2*SMAX)]-(ω12/ωMAX)}*PMAX;所述P2为第二输出驱动数据,所述ɑ12为角度差数据,所述角度差数据为所述当前角度数据ɑ1与所述目标角度数据ɑ2的差值;
所述步骤S3中第三输出驱动数据具体为:
P3={[|ɑ12|/(2*SMAX)]-b*(ω12/ωMAX)}*PMAX;所述P3为第三输出驱动数据,所述b为角度变化量累加因子。
其中,ω12为当前角速度数据ω1与目标角速度数据ω2的差值,故而存在正负值,若当前角速度数据ω1大于目标角速度数据ω2,则ω12为正值,驱动结果减小,若当前角速度数据ω1小于目标角速度数据ω2,则ω12为负值,驱动结果增加。
从上述描述可知,实际驱动输出还根据当前角速度数据与目标角速度数据进行驱动输出修正。在目标控制距离较大时,若当前角速度数据小于目标角速度数据,驱动计算结果大于100%,按100%驱动输出,若当前角速度数据小于目标角速度数据,驱动计算结果小于100%,按计算值输出;在目标控制距离较近时,使得越接近目标角度数据时,驱动输出越小,若当前角速度数据小于目标角速度数据,则驱动负向修正,否则驱动正向修正;当靠近目标控制距离时,设置加入角度变化量累加因子,来更好的带动转向,以达到目标。
进一步地,还包括步骤:
获取角速度差数据,判断所述角速度差数据连续为正数的次数是否大于预设次数或者所述角速度差数据连续为负数的次数是否大于预设次数,若是,则在当前的所述角度变化量累加因子的基础上以每毫秒0.005进行累加,并判断累加后的所述角度变化量累加因子是否到达4,若是,则停止累加;
若所述角速度差数据连续为正数的次数不大于预设次数,则当前的所述角度变化量累加因子回到角度变化量初始因子,所述角度变化量初始因子为1。
从上述描述可知,由于在靠近目标控制距离时,目标角速度数据小,若驱动输出小,则角度的变化会较小,容易出现无法驱动转向的异常,故而此时角度变化量初始因子进行增大,以增加驱动,带动转向,达到目标值。
请参照图5,一种转向速度控制端,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现以下步骤:
S1、接收当前角度数据和目标角度数据,得到角度差数据以及角速度差数据;
S2、判断所述角度差数据是否大于快速响应判定阈值,若是,则根据角速度差数据以及转向最大角速度生成第一输出驱动数据,否则判断是否大于或等于N*转向最大滑行距离,若是,则根据所述角度差数据以及角速度差数据生成第二输出驱动数据,若所述角度差数据小于N*转向最大滑行距离,则根据所述角度差数据、所述角速度差数据以及角度变化量累加因子生成第三输出驱动数据,所述N的取值范围为[0.1,0.5]。
从上述描述可知,本发明的有益效果在于:通过引入方向盘的转向角速度参数,根据角度差数据与快速响应判定阈值、转向最大滑行距离的关系,判断其与目标距离的不同,从而根据不同的参数生成不同的驱动输出,即提供了一种快速寻优控制方式,使得转向速度控制具有快速性、稳定性以及精确性,更适合于无人车的高机动性要求,又具有抵抗外加干扰能力且稳定性好,从而提高转向控制的精度。
进一步地,所述步骤S2中快速响应判定阈值具体为:
FV=2*SMAX+ɑ12*a,所述FV为快速响应判定阈值,所述SMAX为转向最大滑行距离,所述转向最大滑行距离为在当前角速度数据到达所述转向最大角速度时撤除驱动后的滑行距离,所述ɑ12为角度差数据,所述角度差数据为所述当前角度数据ɑ1与所述目标角度数据ɑ2的差值,所述a为比例系数。
从上述描述可知,根据转向最大滑行距离来确定快速响应判定阈值,以此来作为不同驱动输出的条件,充分的考虑了转向机构整体惯性量,从而实现快速且稳定的控制。
进一步地,所述步骤S2中所述第一输出驱动数据的理想目标角速度为:
ωK=ωMAX,所述ωK为第一输出驱动数据的理想目标角速度;
所述步骤S2中所述第二输出驱动数据的理想目标速度为:
ωW=ωMAX*[ɑ1/(2*SMAX)],所述ωW为第二输出驱动数据的理想目标角速度,所述ωMAX为转向最大角速度,所述ɑ1为当前角度数据,所述SMAX为转向最大滑行距离,所述转向最大滑行距离为在当前角速度数据到达所述转向最大角速度时撤除驱动后的滑行距离;
所述步骤S2中所述第三输出驱动数据的理想目标速度与所述第二输出驱动数据的理想目标角速度一致。
从上述描述可知,在目标控制距离较大时,使得角速度数据尽可能的达到转向最大角速度,在目标控制距离较近时,由于转向控制无法实现快速跳变控制,通过上述公式进行加速减速控制,即保证了从而实现快速且精确的转向速度控制。
进一步地,所述步骤S2中第一输出驱动数据具体为:
P1=n1*PMAX=[1-(ω12/ωMAX)]*PMAX,所述P1为第一输出驱动数据,所述ω12为角速度差数据,所述角速度差数据为当前角速度数据ω1与目标角速度数据ω2的差值,所述ωMAX为转向最大角速度,所述PMAX为转向电机最大输出数据;
所述步骤S2中第二输出驱动数据具体为:
P2={[|ɑ12|/(2*SMAX)]-(ω12/ωMAX)}*PMAX;所述P2为第二输出驱动数据,所述ɑ12为角度差数据,所述角度差数据为所述当前角度数据ɑ1与所述目标角度数据ɑ2的差值;
所述步骤S3中第三输出驱动数据具体为:
P3={[|ɑ12|/(2*SMAX)]-b*(ω12/ωMAX)}*PMAX;所述P3为第三输出驱动数据,所述b为角度变化量累加因子。
从上述描述可知,实际驱动输出还根据当前角速度数据与目标角速度数据进行驱动输出修正。在目标控制距离较大时,若当前角速度数据小于目标角速度数据,驱动计算结果大于100%,按100%驱动输出,若当前角速度数据小于目标角速度数据,驱动计算结果小于100%,按计算值输出;在目标控制距离较近时,使得越接近目标角度数据时,驱动输出越小,若当前角速度数据小于目标角速度数据,则驱动负向修正,否则驱动正向修正;当靠近目标控制距离时,设置加入角度变化量累加因子,来更好的带动转向,以达到目标。
进一步地,所述处理器执行所述计算机程序时还实现以下步骤:
获取角速度差数据,判断所述角速度差数据连续为正数的次数是否大于预设次数或者所述角速度差数据连续为负数的次数是否大于预设次数,若是,则在当前的所述角度变化量累加因子的基础上以每毫秒0.005进行累加,并判断累加后的所述角度变化量累加因子是否到达4,若是,则停止累加;
若所述角速度差数据连续为正数的次数不大于预设次数,则当前的所述角度变化量累加因子回到角度变化量初始因子,所述角度变化量初始因子为1。
从上述描述可知,由于在靠近目标控制距离时,目标角速度数据小,若驱动输出小,则角度的变化会较小,容易出现无法驱动转向的异常,故而此时角度变化量初始因子进行增大,以增加驱动,带动转向,达到目标值。
请参照图1至图4,本发明的实施例一为:
一种无人驾驶车辆的转向速度控制方法,包括步骤:
S1、接收当前角度数据和目标角度数据,得到角度差数据以及角速度差数据;
S2、判断角度差数据是否大于快速响应判定阈值,若是,则根据角速度差数据以及转向最大角速度生成第一输出驱动数据,否则判断是否大于或等于N*转向最大滑行距离,若是,则根据角度差数据以及角速度差数据生成第二输出驱动数据,若角度差数据小于N*转向最大滑行距离,则根据角度差数据、角速度差数据以及角度变化量累加因子生成第三输出驱动数据,所述N的取值范围为[0.1,0.5],在本实施例中N为2。
其中,步骤S2中快速响应判定阈值具体为:
FV=2*SMAX+ɑ12*a,FV为快速响应判定阈值,SMAX为转向最大滑行距离,转向最大滑行距离为在当前角速度数据到达转向最大角速度时撤除驱动后的滑行距离,ɑ12为角度差数据,角度差数据为当前角度数据ɑ1与目标角度数据ɑ2的差值,a为比例系数,其中,比例系数a由实际控制效果进行修正,控制超调明显,则比例系数减。
如图2所示,步骤S2中第一输出驱动数据的理想目标角速度为:
ωK=ωMAX,ωK为第一输出驱动数据的理想目标角速度;
步骤S2中第二输出驱动数据的理想目标速度为:
ωW=ωMAX*[ɑ1/(2*SMAX)],ωW为第二输出驱动数据的理想目标角速度,ωMAX为转向最大角速度,ɑ1为当前角度数据,SMAX为转向最大滑行距离,转向最大滑行距离为在当前角速度数据到达转向最大角速度时撤除驱动后的滑行距离;
步骤S2中第三输出驱动数据的理想目标速度与第二输出驱动数据的理想目标角速度一致。
其中,步骤S2中第一输出驱动数据具体为:
P1=n1*PMAX=[1-(ω12/ωMAX)]*PMAX,P1为第一输出驱动数据,ω12为角速度差数据,角速度差数据为当前角速度数据ω1与目标角速度数据ω2的差值,ωMAX为转向最大角速度,PMAX为转向电机最大输出数据;
步骤S2中第二输出驱动数据具体为:
P2={[|ɑ12|/(2*SMAX)]-(ω12/ωMAX)}*PMAX;P2为第二输出驱动数据,ɑ12为角度差数据,角度差数据为当前角度数据ɑ1与目标角度数据ɑ2的差值;
步骤S3中第三输出驱动数据具体为:
P3={[|ɑ12|/(2*SMAX)]-b*(ω12/ωMAX)}*PMAX;P3为第三输出驱动数据,b为角度变化量累加因子。
其中,角度变化量累加因子的变化步骤如下:
获取角速度差数据,判断角速度差数据连续为正数的次数是否大于预设次数或者角速度差数据连续为负数的次数是否大于预设次数,若是,则在当前的角度变化量累加因子的基础上以每毫秒0.005进行累加,并判断累加后的角度变化量累加因子是否到达4,若是,则停止累加;
若角速度差数据连续为正数的次数不大于预设次数,则当前的角度变化量累加因子回到角度变化量初始因子,角度变化量初始因子为1。
如图3所示,在精确稳定阶段,遇到外力干扰,阻碍方向盘接近目标,则驱动输出大于理论输出;如图4所示,在精确稳定阶段,遇到外力干扰,推进方向盘接近目标,则驱动输出小于理论输出。
请参照图5,本发明的实施例二为:
一种转向速度控制端1,包括存储器3、处理器2及存储在存储器3上并可在处理器2上运行的计算机程序,处理器2执行计算机程序时实现上述实施例的步骤。
其中,本发明的转向速度控制端1分别连接方向盘的角度传感器以及转向机构,转向机构又与方向盘的角度传感器连接,从实际来说,本发明的转向速度控制端1相当于主控制器与转向驱动器。
综上所述,本发明提供的一种无人驾驶车辆的转向速度控制方法及控制端,提供了一种快速寻优控制方式,使得转向速度控制具有快速性、稳定性以及精确性,更适合于无人车的高机动性要求,又具有抵抗外加干扰能力且稳定性好,从而提高转向控制的精度;根据转向最大滑行距离来确定快速响应判定阈值,以此来作为不同驱动输出的条件,充分的考虑了转向机构整体惯性量,并在目标控制距离较大时,使得角速度数据尽可能的达到转向最大角速度,在目标控制距离较近时,由于转向控制无法实现快速跳变控制,通过上述公式进行加速减速控制,从而实现快速、稳定且精确的转向速度控制;实际驱动输出还根据当前角速度数据与目标角速度数据进行驱动输出修正。在目标控制距离较大时,若当前角速度数据小于目标角速度数据,驱动计算结果大于100%,按100%驱动输出,若当前角速度数据小于目标角速度数据,驱动计算结果小于100%,按计算值输出;在目标控制距离较近时,使得越接近目标角度数据时,驱动输出越小,若当前角速度数据小于目标角速度数据,则驱动负向修正,否则驱动正向修正;当靠近目标控制距离时,设置加入角度变化量累加因子,目标角速度数据小,若驱动输出小,则角度的变化会较小,容易出现无法驱动转向的异常,故而此时角度变化量初始因子进行增大,以增加驱动,带动转向,达到目标值。
以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等同变换,或直接或间接运用在相关的技术领域,均同理包括在本发明的专利保护范围内。
Claims (10)
1.一种无人驾驶车辆的转向速度控制方法,其特征在于,包括步骤:
S1、接收当前角度数据和目标角度数据,得到角度差数据以及角速度差数据;
S2、判断所述角度差数据是否大于快速响应判定阈值,若是,则根据角速度差数据以及转向最大角速度生成第一输出驱动数据,否则判断是否大于或等于N*转向最大滑行距离,若是,则根据所述角度差数据以及角速度差数据生成第二输出驱动数据,若所述角度差数据小于N*转向最大滑行距离,则根据所述角度差数据、所述角速度差数据以及角度变化量累加因子生成第三输出驱动数据,所述N的取值范围为[0.1,0.5]。
2.根据权利要求1所述的一种无人驾驶车辆的转向速度控制方法,其特征在于,所述步骤S2中快速响应判定阈值具体为:
FV=2*SMAX+ɑ12*a,所述FV为快速响应判定阈值,所述SMAX为转向最大滑行距离,所述转向最大滑行距离为在当前角速度数据到达所述转向最大角速度时撤除驱动后的滑行距离,所述ɑ12为角度差数据,所述角度差数据为所述当前角度数据ɑ1与所述目标角度数据ɑ2的差值,所述a为比例系数。
3.根据权利要求1所述的一种无人驾驶车辆的转向速度控制方法,其特征在于,所述步骤S2中所述第一输出驱动数据的理想目标角速度为:
ωK=ωMAX,所述ωK为第一输出驱动数据的理想目标角速度;
所述步骤S2中所述第二输出驱动数据的理想目标速度为:
ωW=ωMAX*[ɑ1/(2*SMAX)],所述ωW为第二输出驱动数据的理想目标角速度,所述ωMAX为转向最大角速度,所述ɑ1为当前角度数据,所述SMAX为转向最大滑行距离,所述转向最大滑行距离为在当前角速度数据到达所述转向最大角速度时撤除驱动后的滑行距离;
所述步骤S2中所述第三输出驱动数据的理想目标速度与所述第二输出驱动数据的理想目标角速度一致。
4.根据权利要求3所述的一种无人驾驶车辆的转向速度控制方法,其特征在于,所述步骤S2中第一输出驱动数据具体为:
P1=n1*PMAX=[1-(ω12/ωMAX)]*PMAX,所述P1为第一输出驱动数据,所述ω12为角速度差数据,所述角速度差数据为当前角速度数据ω1与目标角速度数据ω2的差值,所述ωMAX为转向最大角速度,所述PMAX为转向电机最大输出数据;
所述步骤S2中第二输出驱动数据具体为:
P2={[|ɑ12|/(2*SMAX)]-(ω12/ωMAX)}*PMAX;所述P2为第二输出驱动数据,所述ɑ12为角度差数据,所述角度差数据为所述当前角度数据ɑ1与所述目标角度数据ɑ2的差值;
所述步骤S3中第三输出驱动数据具体为:
P3={[|ɑ12|/(2*SMAX)]-b*(ω12/ωMAX)}*PMAX;所述P3为第三输出驱动数据,所述b为角度变化量累加因子。
5.根据权利要求4所述的一种无人驾驶车辆的转向速度控制方法,其特征在于,还包括步骤:
获取角速度差数据,判断所述角速度差数据连续为正数的次数是否大于预设次数或者所述角速度差数据连续为负数的次数是否大于预设次数,若是,则在当前的所述角度变化量累加因子的基础上以每毫秒0.005进行累加,并判断累加后的所述角度变化量累加因子是否到达4,若是,则停止累加;
若所述角速度差数据连续为正数的次数不大于预设次数,则当前的所述角度变化量累加因子回到角度变化量初始因子,所述角度变化量初始因子为1。
6.一种转向速度控制端,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现以下步骤:
S1、接收当前角度数据和目标角度数据,得到角度差数据以及角速度差数据;
S2、判断所述角度差数据是否大于快速响应判定阈值,若是,则根据角速度差数据以及转向最大角速度生成第一输出驱动数据,否则判断是否大于或等于N*转向最大滑行距离,若是,则根据所述角度差数据以及角速度差数据生成第二输出驱动数据,若所述角度差数据小于N*转向最大滑行距离,则根据所述角度差数据、所述角速度差数据以及角度变化量累加因子生成第三输出驱动数据,所述N的取值范围为[0.1,0.5]。
7.根据权利要求6所述的一种转向速度控制端,其特征在于,所述步骤S2中快速响应判定阈值具体为:
FV=2*SMAX+ɑ12*a,所述FV为快速响应判定阈值,所述SMAX为转向最大滑行距离,所述转向最大滑行距离为在当前角速度数据到达所述转向最大角速度时撤除驱动后的滑行距离,所述ɑ12为角度差数据,所述角度差数据为所述当前角度数据ɑ1与所述目标角度数据ɑ2的差值,所述a为比例系数。
8.根据权利要求6所述的一种转向速度控制端,其特征在于,所述步骤S2中所述第一输出驱动数据的理想目标角速度为:
ωK=ωMAX,所述ωK为第一输出驱动数据的理想目标角速度;
所述步骤S2中所述第二输出驱动数据的理想目标速度为:
ωW=ωMAX*[ɑ1/(2*SMAX)],所述ωW为第二输出驱动数据的理想目标角速度,所述ωMAX为转向最大角速度,所述ɑ1为当前角度数据,所述SMAX为转向最大滑行距离,所述转向最大滑行距离为在当前角速度数据到达所述转向最大角速度时撤除驱动后的滑行距离;
所述步骤S2中所述第三输出驱动数据的理想目标速度与所述第二输出驱动数据的理想目标角速度一致。
9.根据权利要求6所述的一种转向速度控制端,其特征在于,所述步骤S2中第一输出驱动数据具体为:
P1=n1*PMAX=[1-(ω12/ωMAX)]*PMAX,所述P1为第一输出驱动数据,所述ω12为角速度差数据,所述角速度差数据为当前角速度数据ω1与目标角速度数据ω2的差值,所述ωMAX为转向最大角速度,所述PMAX为转向电机最大输出数据;
所述步骤S2中第二输出驱动数据具体为:
P2={[|ɑ12|/(2*SMAX)]-(ω12/ωMAX)}*PMAX;所述P2为第二输出驱动数据,所述ɑ12为角度差数据,所述角度差数据为所述当前角度数据ɑ1与所述目标角度数据ɑ2的差值;
所述步骤S3中第三输出驱动数据具体为:
P3={[|ɑ12|/(2*SMAX)]-b*(ω12/ωMAX)}*PMAX;所述P3为第三输出驱动数据,所述b为角度变化量累加因子。
10.根据权利要求9所述的一种转向速度控制端,其特征在于,所述处理器执行所述计算机程序时还实现以下步骤:
获取角速度差数据,判断所述角速度差数据连续为正数的次数是否大于预设次数或者所述角速度差数据连续为负数的次数是否大于预设次数,若是,则在当前的所述角度变化量累加因子的基础上以每毫秒0.005进行累加,并判断累加后的所述角度变化量累加因子是否到达4,若是,则停止累加;
若所述角速度差数据连续为正数的次数不大于预设次数,则当前的所述角度变化量累加因子回到角度变化量初始因子,所述角度变化量初始因子为1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910454340.4A CN110109464B (zh) | 2019-05-29 | 2019-05-29 | 一种无人驾驶车辆的转向速度控制方法及控制端 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910454340.4A CN110109464B (zh) | 2019-05-29 | 2019-05-29 | 一种无人驾驶车辆的转向速度控制方法及控制端 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110109464A true CN110109464A (zh) | 2019-08-09 |
CN110109464B CN110109464B (zh) | 2022-10-04 |
Family
ID=67492798
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910454340.4A Active CN110109464B (zh) | 2019-05-29 | 2019-05-29 | 一种无人驾驶车辆的转向速度控制方法及控制端 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110109464B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110632611A (zh) * | 2019-08-30 | 2019-12-31 | 中国南方电网有限责任公司超高压输电公司贵阳局 | 一种固定翼无人机载激光雷达系统转弯滤波方法 |
CN110794830A (zh) * | 2019-10-14 | 2020-02-14 | 广东工业大学 | 一种自动驾驶汽车的运动目标跟踪方法 |
CN114616973A (zh) * | 2020-12-11 | 2022-06-14 | 苏州宝时得电动工具有限公司 | 割草机和割草机的控制方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104176114A (zh) * | 2013-05-27 | 2014-12-03 | 三菱电机株式会社 | 转向控制装置及转向速度检测方法 |
CN105102302A (zh) * | 2013-04-08 | 2015-11-25 | 三菱电机株式会社 | 转向控制装置及转向控制方法 |
CN108790940A (zh) * | 2018-05-24 | 2018-11-13 | 北京新能源汽车股份有限公司 | 轮边驱动转向差速控制方法、控制装置、设备及汽车 |
CN108860293A (zh) * | 2018-06-05 | 2018-11-23 | 北京智行者科技有限公司 | 一种转向控制方法及转向控制装置 |
CN109032140A (zh) * | 2018-07-27 | 2018-12-18 | 江苏盛海智能科技有限公司 | 一种无人车循迹驾驶方法及终端 |
CN109017979A (zh) * | 2018-08-09 | 2018-12-18 | 北京智行者科技有限公司 | 转向控制方法及系统 |
CN109131539A (zh) * | 2018-07-25 | 2019-01-04 | 北京汽车股份有限公司 | 转向操纵系统控制方法、装置及汽车 |
CN109546922A (zh) * | 2018-12-05 | 2019-03-29 | 张洋 | 伺服电机控制方法和系统 |
CN109649488A (zh) * | 2018-10-23 | 2019-04-19 | 北京经纬恒润科技有限公司 | 一种转向行为的识别方法及装置 |
CN109703616A (zh) * | 2019-01-16 | 2019-05-03 | 东风汽车有限公司 | 自动驾驶转角控制方法、电子设备及存储介质 |
-
2019
- 2019-05-29 CN CN201910454340.4A patent/CN110109464B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105102302A (zh) * | 2013-04-08 | 2015-11-25 | 三菱电机株式会社 | 转向控制装置及转向控制方法 |
CN104176114A (zh) * | 2013-05-27 | 2014-12-03 | 三菱电机株式会社 | 转向控制装置及转向速度检测方法 |
CN108790940A (zh) * | 2018-05-24 | 2018-11-13 | 北京新能源汽车股份有限公司 | 轮边驱动转向差速控制方法、控制装置、设备及汽车 |
CN108860293A (zh) * | 2018-06-05 | 2018-11-23 | 北京智行者科技有限公司 | 一种转向控制方法及转向控制装置 |
CN109131539A (zh) * | 2018-07-25 | 2019-01-04 | 北京汽车股份有限公司 | 转向操纵系统控制方法、装置及汽车 |
CN109032140A (zh) * | 2018-07-27 | 2018-12-18 | 江苏盛海智能科技有限公司 | 一种无人车循迹驾驶方法及终端 |
CN109017979A (zh) * | 2018-08-09 | 2018-12-18 | 北京智行者科技有限公司 | 转向控制方法及系统 |
CN109649488A (zh) * | 2018-10-23 | 2019-04-19 | 北京经纬恒润科技有限公司 | 一种转向行为的识别方法及装置 |
CN109546922A (zh) * | 2018-12-05 | 2019-03-29 | 张洋 | 伺服电机控制方法和系统 |
CN109703616A (zh) * | 2019-01-16 | 2019-05-03 | 东风汽车有限公司 | 自动驾驶转角控制方法、电子设备及存储介质 |
Non-Patent Citations (3)
Title |
---|
凌锐: "仿优秀驾驶员行为的无人驾驶车辆转向控制研究", 《CNKI》 * |
孔伟亮: "场内无人驾驶车辆测控系统研究", 《CNKI》 * |
江鸿怀: "面向智能仓储的AGV小车运动学研究", 《CNKI》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110632611A (zh) * | 2019-08-30 | 2019-12-31 | 中国南方电网有限责任公司超高压输电公司贵阳局 | 一种固定翼无人机载激光雷达系统转弯滤波方法 |
CN110632611B (zh) * | 2019-08-30 | 2021-12-14 | 中国南方电网有限责任公司超高压输电公司贵阳局 | 一种固定翼无人机载激光雷达系统转弯滤波方法 |
CN110794830A (zh) * | 2019-10-14 | 2020-02-14 | 广东工业大学 | 一种自动驾驶汽车的运动目标跟踪方法 |
CN114616973A (zh) * | 2020-12-11 | 2022-06-14 | 苏州宝时得电动工具有限公司 | 割草机和割草机的控制方法 |
CN114616973B (zh) * | 2020-12-11 | 2023-10-10 | 苏州宝时得电动工具有限公司 | 割草机和割草机的控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110109464B (zh) | 2022-10-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110109464A (zh) | 一种无人驾驶车辆的转向速度控制方法及控制端 | |
US11169524B2 (en) | Heading control device and heading control method for ship | |
CN112519882B (zh) | 一种车辆参考轨迹跟踪方法及系统 | |
CN109870648A (zh) | 舵机堵转检测方法、装置及舵机 | |
CN109204447B (zh) | 具有用于多种操作模式的统一架构的电动助力转向系统 | |
RU2267020C2 (ru) | Устройство и способ регулирования мощности силовой установки приведения в движение несущего винта вертолета | |
CN102198032B (zh) | 用于机动车辆的控制器和控制方法 | |
US11738798B2 (en) | Turning control system | |
US10620642B2 (en) | Aircraft and roll method thereof | |
CN109960290A (zh) | 舵机输出控制方法、系统及装置 | |
CN104590253A (zh) | 一种四轮独立驱动电动汽车的横摆角速度控制方法 | |
CN114987607B (zh) | 一种车辆的转向控制方法、装置、设备及存储介质 | |
CN109367620A (zh) | 一种半挂汽车列车直线倒车的诱导控制方法 | |
CN106740261A (zh) | 一种电动车的控制方法及装置 | |
CN104898664A (zh) | 一种农用全地形车转向跟踪复合控制方法 | |
IL102971A (en) | Increasing the speed of a helicopter engine while loading the rotor worked and maneuvering a fast downward pace | |
CN113147410B (zh) | 一种小型电动交通工具的e-abs控制方法 | |
CN109696825B (zh) | 舵机的控制响应方法、装置及舵机 | |
JP2002252997A (ja) | 電動モータの制御装置 | |
TWI421178B (zh) | 智慧型多輪獨立動力輪之差速控制方法及其裝置 | |
CN117485319A (zh) | 混合动力车辆发动机扭矩修正方法、装置、车辆及介质 | |
CN104270046A (zh) | 一种基于转速-电流二维模糊模型自学习的电机控制方法 | |
CN108068938B (zh) | 一种双轮车速度控制方法及系统 | |
Sun et al. | The design of the DC servo motor controller based on fuzzy immune PID algorithm | |
CN108445875A (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 |