【技术实现步骤摘要】
履带式车辆的行驶方向确定及控制方法、装置、电子设备
[0001]本申请实施例涉及车辆控制
,特别涉及一种履带式车辆的行驶方向确定及控制方法、装置、电子设备及存储介质。
技术介绍
[0002]履带式拖拉机是农业机械应用中的一个重要部分,可以用于水田地、旱田地、潮湿地的深耕作业。与轮式拖拉机相比,其具有牵引力大,抗颠簸性能好等特点。
[0003]履带式拖拉机的转向控制方式为差速转向,即通过方向盘的转动产生行进间两侧履带的不同转速,从而改变车辆的行驶方向。与轮式拖拉机相比,由于履带车不存在可供测量的前轮转角,因此,目前针对轮式车辆的控制方法无法直接应用于履带式车辆的控制。
[0004]当前记载的文献中,对于履带式机器人的控制大多是通过控制履带式机器人的线速度和角速度来实现。通过在机器人的左右履带轮上安装电机来控制履带轮的转速,进而控制履带式机器人的前进方向。然而,由于农业机械中的履带车拖拉机是通过差速转向的方式控制行驶方向,拖拉机的左右轮上并没有安装电机,因此,文献中记载的履带式机器人的控制方法,也无法直接应用于履带式车辆(例如履带式拖拉机)的控制。
[0005]有鉴于此,需要一种适用于履带式车辆的行驶方向的控制方案。
技术实现思路
[0006]鉴于上述问题,本申请提供一种履带式车辆的行驶方向确定及控制方法、装置、电子设备,可至少部分地解决现有技术存在问题。
[0007]根据本申请实施例的第一方面,提供一种履带式车辆的行使方向确定方法,根据履带式车辆对应于所述当前时刻的 ...
【技术保护点】
【技术特征摘要】
1.一种履带式车辆的行驶方向确定方法,包括:根据履带式车辆对应于所述当前时刻的行驶速度和角速度、所述履带式车辆的车辆尺寸,获得所述履带式车辆对应于所述当前时刻的车轮转速;根据所述履带式车辆对应于所述当前时刻的车轮转速、所述履带式车辆的车辆尺寸,确定所述履带式车辆对应于所述当前时刻的行驶方向。2.根据权利要求1所述的方法,其中,所述履带式车辆的车辆尺寸包括履带轮间距,所述履带轮间距表征位于所述履带式车辆的相对两侧的两个履带轮之间的间隔距离;所述履带式车辆对应于所述当前时刻的车轮转速包括左轮转速和右轮转速;所述履带式车辆对应于所述当前时刻的角速度是利用所述履带式车辆上的惯性测量单元得到的。3.根据权利要求1所述的方法,其中,所述履带式车辆的车辆尺寸包括履带轮间距和履带接地长度,所述履带轮间距表征所述履带式车辆的两个履带轮之间的间隔距离;所述车辆速度包括行驶速度和角速度,所述履带接地长度表征所述履带式车辆的履带与地面的接触长度;所述根据所述履带式车辆对应于所述当前时刻的车轮转速、所述履带式车辆的车辆尺寸,确定所述履带式车辆对应于所述当前时刻的行驶方向,包括:根据所述履带式车辆对应于所述当前时刻的车轮转速、所述履带轮间距、所述履带接地长度,获得所述履带式车辆对应于所述当前时刻的虚拟前轮转角观测值;根据所述履带式车辆对应于所述当前时刻的虚拟前轮转角观测值、所述履带式车辆对应于所述前续时刻的虚拟前轮转角估算值,获得所述履带式车辆对应于所述当前时刻的虚拟前轮转角估算值;根据所述履带式车辆对应于所述当前时刻的虚拟前轮转角估算值,确定所述履带式车辆对应于所述当前时刻的行驶方向;其中,所述前续时刻与所述当前时刻为所述履带式车辆的各检测时刻中连续的任意两个检测时刻,且所述前续时刻为所述当前时刻的前一个检测时刻。4.根据权利要求3所述的方法,其中,所述根据所述履带式车辆对应于所述当前时刻的虚拟前轮转角观测值、所述履带式车辆对应于所述前续时刻的虚拟前轮转角估算值,获得所述履带式车辆对应于所述当前时刻的虚拟前轮转角估算值,包括:根据所述履带式车辆对应于所述前续时刻的虚拟前轮转角估算值、所述当前时刻与所述前续时刻之间的时间间隔、所述履带式车辆对应于所述当前时刻的方向盘转动角速度、预设单位状态矩阵,获得所述履带式车辆对应于所述当前时刻的虚拟前轮转角预测值;根据所述履带式车辆的状态协方差矩阵估算结果、所述预设单位状态矩阵、预设单位测算矩阵、所述履带式车辆对应于所述当前时刻的噪声状态矩阵和噪声测量矩阵,获得所述履带式车辆对应于所述当前时刻的增益值;根据所述履带式车辆对应于所述当前时刻的虚拟前轮转角预测值、所述履带式车辆对应于所述当前时刻的增益值、所述履带式车辆对应于所述当前时刻的虚拟前轮转角观测值、所述预设单位测算矩阵,获得所述履带式车辆对应于所述当前时刻的虚拟前轮转角估算值。
5.根据权利要求4所述的方法,其中,所述根据所述履带式车辆的状态协方差矩阵估算结果、所述预设单位状态矩阵、预设单位测算矩阵、所述履带式车辆对应于所述当前时刻的噪声状态矩阵和噪声测量矩阵,获得所述履带式车辆对应于所述当前时刻的增益值,包括:根据所述履带式车辆的状态协方差矩阵估算结果、所述预设单位状态矩阵、所...
【专利技术属性】
技术研发人员:李晓宇,具大源,王锐,李奕成,
申请(专利权)人:上海联适导航技术股份有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。