【技术实现步骤摘要】
一种车速控制方法及装置
[0001]本申请属于自动驾驶
,尤其涉及一种车速控制方法及装置。
技术介绍
[0002]目前,自动驾驶车辆多采用全球定位系统(Global Positioning System,GPS)、惯性测量单元(Inertial measurement unit,IMU)和辅助修正相结合的多传感器融合定位方案进行定位。若受到周围环境影响导致部分GPS信号接收不佳及辅助修正信息不充足时,则会主要借助航迹推算(dead reckoning,DR)来进行定位。
[0003]但是,受到DR航迹推算模型的精度及惯性元件的测量精度的影响,主要借助DR航迹推算来进行定位会存在误差,且随着车辆的持续行驶,误差会不断累积,而DR航迹推算输出的定位结果偏差过大会导致车辆行驶轨迹偏离,极易发生危险。
技术实现思路
[0004]本申请实施例提供一种车速控制方法及装置,能够提高目标车辆的安全性,降低发生危险的概率。
[0005]第一方面,本申请实施例提供一种车速控制方法,该方法包括:
[0006]在目标车辆的GPS信号和辅助修正信息异常的情况下,获取目标车辆的目标速度信息,
[0007]根据目标速度信息和预设误差数据,确定目标车辆在当前采样周期内的目标位移误差,预设误差数据包括目标车辆的速度信息与位移误差之间的对应关系,
[0008]根据目标位移误差和目标车辆的历史位移误差,确定累积误差,历史位移误差包括目标车辆在多个历史采样周期内的位移误差,
[0009] ...
【技术保护点】
【技术特征摘要】
1.一种车速控制方法,其特征在于,所述方法包括:在目标车辆的全球定位系统GPS信号和辅助修正信息异常的情况下,获取所述目标车辆的目标速度信息,根据所述目标速度信息和预设误差数据,确定所述目标车辆在当前采样周期内的目标位移误差,所述预设误差数据包括所述目标车辆的速度信息与位移误差之间的对应关系,根据所述目标位移误差和所述目标车辆的历史位移误差,确定累积误差,所述历史位移误差包括所述目标车辆在多个历史采样周期内的位移误差,在所述累积误差大于目标误差阈值的情况下,控制所述目标车辆的车速为目标预设车速。2.根据权利要求1所述的方法,其特征在于,所述目标速度信息包括目标车速和目标横摆角速度,所述预设误差数据包括直行误差数据和转弯误差数据,所述根据所述目标速度信息和预设误差数据,确定所述目标车辆在当前采样周期内的目标位移误差,包括:根据所述目标横摆角速度确定所述目标车辆所处的目标场景,在所述目标场景为直行场景的情况下,根据所述目标车速和所述直行误差数据,确定所述目标位移误差,所述直行误差数据包括所述目标车辆在处于所述直行场景的情况下,车速与位移误差之间的对应关系,在所述目标场景为转弯场景的情况下,根据所述目标车速和所述转弯误差数据,确定所述目标位移误差,所述转弯误差数据包括所述目标车辆在处于所述转弯场景的情况下,车速与位移误差之间的对应关系。3.根据权利要求2所述的方法,其特征在于,所述位移误差为所述目标车辆的位移每增加预设距离所形成的误差值,在所述目标场景为直行场景的情况下,根据所述目标车速和所述直行误差数据,确定所述目标位移误差,包括:在所述目标场景为直行场景的情况下,根据所述目标车速确定所述目标车辆在所述当前采样周期内的目标位移增量,并根据所述直行误差数据确定所述目标车速对应的第一位移误差,根据所述目标位移增量和所述第一位移误差,确定所述目标位移误差,在所述目标场景为转弯场景的情况下,根据所述目标车速和所述转弯误差数据,确定所述目标位移误差,包括:在所述目标场景为转弯场景的情况下,根据所述目标车速确定所述目标车辆在所述当前采样周期内的目标位移增量,根据所述转弯误差数据确定所述目标车速对应的第二位移误差,并根据所述目标横摆角速度,确定所述目标车辆在所述当前采样周期内的目标横摆角增量,根据所述目标位移增量、所述第二位移误差、所述目标横摆角增量和所述目标车辆在前一采样周期内的第一历史位移误差,确定所述目标位移误差。4.根据权利要求3所述的方法,其特征在于,所述目标位移误差包括目标纵向误差和目标横向误差,所述第一位移误差包括第一纵向误差和第一横向误差,所述根据所述目标车速确定所述目标车辆在所述当前采样周期内的目标位移增量,包括:通过如下公式确定所述目标位移增量:DisInc=VehSpd
×
ΔT
其中,DisInc为所述目标位移增量,VehSpd为所述目标车速,ΔT为所述当前采样周期,所述根据所述目标位移增量和所述第一位移误差,确定所述目标位移误差,包括:通过如下公式确定所述目标纵向误差和所述目标横向误差:其中,ErrLong2为所述目标纵向误差,ErrLat2为所述目标横向误差,ErrLong3为所述第一纵向误差,ErrLat3为所述第一横向误差,DisInc为所述目标位移增量,S为所述预设距离。5.根据权利要求3所述的方法,其特征在于,所述第一历史位移误差包括第一历史纵向误差和第一历史横向误差,所述第二位移误差包括第二纵向误差和第二横向误差,所述根据所述目标横摆角速度,确定所述目标车辆在所述当前采样周期内的目标横摆角增量,包括:通过如下公式确定所述目标横摆角增量:ΔHA=Yawrate
×
ΔT其中,ΔHA为所述目标横摆角增量,Yawrate为所述目标横摆角速度,ΔT为所述当前采样周期,所述根据所述目标位移增量、所述第二位移误差、所述目标横摆角增量和所述目标车辆在前一采样周期内的第一历史位移误差,确定所述目标位移误差,包括:通过如下公式确定目标纵向误差和目标横向误差:其中,ErrLong
new
...
【专利技术属性】
技术研发人员:陆嘉伟,刘祺,万国强,范成建,
申请(专利权)人:北京经纬恒润科技股份有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。