预览加载中,请您耐心等待几秒...
1/10
2/10
3/10
4/10
5/10
6/10
7/10
8/10
9/10
10/10

亲,该文档总共25页,到这已经超出免费预览范围,如果喜欢就直接下载吧~

如果您无法下载资料,请参考说明:

1、部分资料下载需要金币,请确保您的账户上有足够的金币

2、已购买过的文档,再次下载不重复扣费

3、资料包下载后请先用软件解压,在使用对应软件打开

(19)国家知识产权局(12)发明专利申请(10)申请公布号CN115014331A(43)申请公布日2022.09.06(21)申请号202210724912.8(22)申请日2022.06.23(71)申请人驭势科技(北京)有限公司地址102403北京市房山区弘安路85号1号楼101室(72)发明人刘凯曹世卓周小成(74)专利代理机构北京开阳星知识产权代理有限公司11710专利代理师阮改燕(51)Int.Cl.G01C21/00(2006.01)G01C1/00(2006.01)B62D53/04(2006.01)权利要求书3页说明书15页附图6页(54)发明名称半挂汽车列车、拖斗位姿确定方法、装置、设备和介质(57)摘要本申请公开了一种半挂汽车列车、拖斗位姿确定方法、装置、设备和介质。该方法包括:获取各车体的初始位姿;针对每个半挂拖斗:基于第一相邻车体的目标位姿,确定第一相邻车体和半挂拖斗之间的第一联结点的第一坐标,并基于半挂拖斗的初始位姿,确定第一联结点的第二坐标;其中,第一相邻车体为靠近牵引车一端的、与半挂拖斗连接的车体;基于第一坐标和第二坐标,确定半挂拖斗的目标位姿。通过上述技术方案,无需每个车体均安装高精度传感器,便可获得各车体的高精度位姿,降低了半挂汽车列车中各车体的高精度位姿的获取成本,提高了各车体的高精度位姿的获取便捷性。CN115014331ACN115014331A权利要求书1/3页1.一种半挂汽车列车的拖斗位姿确定方法,所述半挂汽车列车由多个车体构成,各所述车体中处于一侧边缘的一个所述车体为牵引车,各所述车体中除了所述牵引车之外的所述车体均为半挂拖斗,其特征在于,包括:获取各所述车体的初始位姿;针对每个所述半挂拖斗:基于第一相邻车体的目标位姿,确定所述第一相邻车体和所述半挂拖斗之间的第一联结点的第一坐标,并基于所述半挂拖斗的所述初始位姿,确定所述第一联结点的第二坐标;其中,所述第一相邻车体为靠近所述牵引车一端的、与所述半挂拖斗连接的所述车体;在所述第一相邻车体为所述牵引车时,所述目标位姿为所述初始位姿;在所述第一相邻车体也为半挂拖斗时,所述目标位姿为校正后的所述初始位姿;基于所述第一坐标和所述第二坐标,确定所述半挂拖斗的所述目标位姿。2.根据权利要求1所述的方法,其特征在于,所述基于所述第一坐标和所述第二坐标,确定所述半挂拖斗的所述目标位姿包括:基于所述第一坐标和所述第二坐标,确定所述第一联结点对应的第一位置偏差;基于所述第一位置偏差与偏差阈值之间的比较结果、所述第一坐标和所述第二坐标,对所述半挂拖斗的所述初始位姿进行校正,确定所述半挂拖斗的所述目标位姿;其中,所述偏差阈值用于对相邻两个所述车体进行刚性连接约束。3.根据权利要求2所述的方法,其特征在于,所述基于所述第一位置偏差与偏差阈值之间的比较结果、所述第一坐标和所述第二坐标,对所述半挂拖斗的所述初始位姿进行校正,确定所述半挂拖斗的所述目标位姿包括:若所述比较结果为所述第一位置偏差大于所述偏差阈值,则将所述半挂拖斗的所述初始位姿中的初始航向角确定为目标航向角;利用所述第一坐标和所述第二坐标的坐标差值,对所述半挂拖斗的所述初始位姿中的初始坐标进行校正,确定所述半挂拖斗的目标坐标。4.根据权利要求2所述的方法,其特征在于,所述基于所述第一位置偏差与偏差阈值之间的比较结果、所述第一坐标和所述第二坐标,对所述半挂拖斗的所述初始位姿进行校正,确定所述半挂拖斗的所述目标位姿包括:若所述比较结果为所述第一位置偏差小于或等于所述偏差阈值,则基于所述第一坐标和所述半挂拖斗的所述初始位姿中的初始坐标,对所述半挂拖斗的所述初始位姿中的初始航向角进行校正,确定所述半挂拖斗的目标航向角;基于第一距离和第二距离的距离差值和所述目标航向角,对所述初始坐标进行校正,确定所述半挂拖斗的目标坐标;其中,所述第一距离为所述第一坐标和所述初始坐标之间的第二位置偏差,所述第二距离为所述第一联结点到所述半挂拖斗的后轴中心之间的距离。5.根据权利要求1所述的方法,其特征在于,所述获取各所述车体的初始位姿包括:获取所述牵引车的所述初始位姿、所述牵引车的后轴中心处的第一速度和前轮偏角;基于所述牵引车的所述初始位姿、所述第一速度和所述前轮偏角,以及各所述半挂拖斗的历史航向角,按照所述半挂汽车列车对应的运动学模型,确定各所述半挂拖斗的所述初始位姿;其中,所述历史航向角为当前位姿更新周期的前一相邻位姿更新周期中所得的2CN115014331A权利要求书2/3页航向角。6.根据权利要求5所述的方法,其特征在于,所述基于所述牵引车的所述初始位姿、所述第一速度和所述前轮偏角,以及各所述半挂拖斗的历史航向角,按照所述半挂汽车列车对应的运动学模型,确定各所述半挂拖斗的所述初始位姿包括:针对每个所述半挂拖斗:基于第