一种液压履带底盘运动控制方法与流程

摘要: 本发明涉及工程机械履带底盘行走控制,涉及一种液压履带底盘运动控制方法。背景技术:1、液压履带底盘广泛应用于挖掘机、推土机、摊铺机等工程机械中,依靠左右比例阀驱动...
一种液压履带底盘运动控制方法与流程

本发明涉及工程机械履带底盘行走控制,涉及一种液压履带底盘运动控制方法。

背景技术:

1、液压履带底盘广泛应用于挖掘机、推土机、摊铺机等工程机械中,依靠左右比例阀驱动行走马达实现差动转向与自主路径跟踪。液压履带底盘设备在作业过程中,因左右比例阀的驱动电流死区、马达的流量效率难以保持完全一致,即使左右比例阀获得相同的驱动电流,也会使液压履带底盘在行驶的过程中持续向一侧偏移。同时左右履带对地面的附着条件会随着地面的硬度、坡度发生变化,仅根据左右马达转速差进行驱动电流调节,可能会导致履带空转加剧或路径偏差进一步扩大。此外,比例阀驱动电流差改变方向后,受马达惯性影响,转速差或者车体横摆响应仍可能短时间保持原方向,容易造成纠偏过冲、反复摆动的情况。

2、现有工程车辆路径跟踪控制方案,如专利文献cn103197675b(地下铲运机自主行驶和避障运动控制及目标路径规划方法),公开了采集车辆位姿信息,解算得到横向位置偏差、航向角偏差、航向角偏差变化率,将多偏差信息融合后,通过pid/pd控制输出电液比例控制系统的控制指令,实现车辆对目标路径的跟踪控制。该方案依靠位姿偏差的线性反馈实现路径跟随,可完成常规工况下的轨迹跟踪。但是,现有方法难以区分底盘跑偏是由左右液压驱动系统或左右履带附着能力不一致所引起,均采用增加一侧驱动电流并减小另一侧驱动电流的统一方式进行处理,可能出现纠偏方向正确但纠偏幅度不适当的状况;该方案仅基于位姿偏差做统一反馈控制,未区分底盘不同偏离运动状态,不能针对不同偏离态势采用差异化纠偏逻辑,当存在液压残余响应、两侧履带附着不一致、液压驱动固有偏置时,固定参数的pid反馈控制容易出现纠偏超调、来回振荡、回正滞后、跟踪精度下降等问题,难以适配液压履带底盘复杂非线性执行特性与多变地面附着工况。

3、另外,专利文献cn122402639a(一种乘用车用智能车轮转向模式自适应切换控制方法)公开了面向乘用车智能车轮的多转向模式识别、模式切换以及失效近似控制思路,能够根据车辆运行工况切换蟹行、斜行、原地转向等工作模式,并对转向失效工况做容错处理。但该方案面向乘用车轮边独立电机转向系统,其模式划分针对车轮转向行驶模态与电气执行机构失效,并不针对液压履带底盘特有的液压残余效应、履带打滑失配、液压驱动偏置这类扰动机理,也没有结合横向/航向偏离状态进行差动驱动电流的针对性调节,无法直接迁移应用到液压履带底盘的路径纠偏场景。

4、综上所述,现有技术要么采用通用pid类反馈控制,对液压履带底盘的非线性扰动缺乏辨识与针对性补偿;要么模式识别控制对象为轮式独立转向车辆,不能适配液压履带差动驱动底盘的路径跟踪需求。

技术实现思路

1、针对上述问题,本发明提供了一种根据横向偏差与横向偏差变化率的符号关系、航向偏差及相邻采样时刻横向偏差的符号变化确定底盘的偏离状态,区分背离、收敛、越线和平行偏移状态,并进一步判别扰动偏离模式,针对不同模式采用不同的比例阀驱动电流调整方式,合理确定纠偏驱动电流,从而降低纠偏超调和反复越线现象,提升复杂工况下路径纠偏的稳定性与跟踪精度的一种液压履带底盘运动控制方法。

2、本发明采取的技术方案如下:

3、一种液压履带底盘运动控制方法,包括以下步骤:

4、步骤一,传感器采集数据并通过控制系统对原始传感数据进行解算处理,获得液压履带底盘的横向偏差、航向偏差、横向偏差变化率、实际横摆角速度以及左右比例阀实际驱动电流、压力与行走马达转速;

5、步骤二,通过横向偏差与横向偏差变化率的符号关系、航向偏差及相邻采样时刻横向偏差的符号变化确定偏离状态,所述偏离状态包括背离状态、收敛状态、越线状态和平行偏移状态;

6、其中越线状态的判定优先级高于背离状态、收敛状态和平行偏移状态;

7、步骤三,在背离状态和平行偏移状态下,根据预测的横向偏差确定目标靠拢角,并输出左右履带的第一方向差动驱动电流,使液压履带底盘向目标直线移动;

8、在收敛状态下,计算当前履带底盘的位置并得到反方向回正后的终点横向偏差;当终点横向偏差在设定的范围时,则切换至反方向回正阶段,并计算并输出左右履带的第二方向差动驱动电流,使航向偏差趋近于零;

9、在越线状态下,停止继续增大原方向差动驱动电流,优先进入残余响应模式或者反向回正阶段;

10、步骤四,当左右履带的第一方向差动驱动电流或第二方向差动驱动电流后,获取首个不为零的差动驱动电流增量所引起的压力增量、马达转速增量、实际横摆角速度增量及相应响应延迟,并根据左右行走马达转速计算预测的横摆角速度,由转速预测横摆角速度与实际横摆角速度得到横摆角速度响应残差;

11、步骤五,根据横摆角速度响应残差、横摆角速度计算公式以及差动驱动电流换向前后的响应方向,确定履带偏转所属的模式类型;

12、所述模式类型包括液压残余响应模式、履带附着失配模式和液压驱动偏置模式类形;

13、步骤六,在液压驱动偏置模式下,将路径回归驱动电流分量与直线保持偏置驱动电流分量叠加;

14、在履带附着失配模式下,限制低附着侧比例阀目标驱动电流增加;

15、在液压残余响应模式下,降低输出的差动驱动电流,当实际横摆角在设定的范围内,再建立反方向差动驱动电流,并根据左右马达转速响应延迟对左右目标驱动电流进行输出;

16、步骤七,根据目标驱动电流调节左右比例阀阀口开度,驱动左右行走马达完成路径纠偏;

17、步骤八,根据修正目标驱动电流后履带底盘的压力增量、马达转速增量和横摆角速度增量复核当前模式,并根据复核结果维持或者更新当前模式。

18、具体的,所述横向偏差、航向偏差和横向偏差变化率通过以下方式获得:

19、将液压履带底盘当前位置与目标直线参考点之间的位置差,投影到目标直线法向量方向上,得到横向偏差

20、根据当前采样时刻与上一采样时刻的横向偏差之差,除以控制器采样周期,得到横向偏差变化率;

21、根据液压履带底盘实际航向角与目标直线航向角之间的角度差,得到航向偏差。

22、具体的,根据偏离演化指标和越线状态指标相关参数确定车辆的偏离状态;其中:

23、为第k采样周期的横向偏差变化率;

24、为第k采样时刻的横向偏差;

25、为第k-1采样时刻的横向偏差;

26、当(k)>0时,横向偏差绝对值持续增加,车辆处于背离状态;

27、当0时,横向偏差绝对值持续减小,车辆处于收敛状态;

28、当(k)处于设定区间且横向偏差大于设定阈值时,判定为平行偏移状态;

29、当时,判定为越线状态。

30、具体的,预测横向偏差通过下式计算:

31、

32、其中,为预测横向偏差,为偏差预测时间;

33、根据预测横向偏差确定第一阶段目标靠拢角:

34、

35、其中,为目标靠拢角,车辆应达到的最大斜向偏转角;

36、为预定纠偏纵向距离,即计划在多长距离内完成纠偏;

37、在收敛状态下,根据当前履带底盘位置、航向偏差和第二方向差动驱动电流作用下的横摆角速度响应,计算反方向回正后的终点横向偏差:

38、

39、为预测行驶速度,为差动驱动电流换向后的等效响应延迟,为第二阶段的预测横摆角速度;当前航向偏差;

40、具体的,步骤四中预测横摆角速度和横摆角速度响应残差通过以下方式获得:

41、根据左右行走马达转速分别换算得到左右履带的理论线速度,由左右履带理论线速度之差与左右履带中心距的比值计算预测横摆角速度;

42、将所述预测横摆角速度与实际横摆角速度作差,得到横摆角速度响应残值;

43、首个不为零的差动驱动电流增量为差动驱动电流由零首次变为非零时刻或者差动驱动电流发生阶跃变化时刻对应的驱动电流增量。

44、具体的,步骤五中三种模式类型的判定条件为:

45、液压残余响应模式判据:

46、当计算的目标差动驱动电流已经改变符号,但左右马达转速差或者实际横摆响应仍保持换向前的方向时,判定为液压残余响应模式;

47、履带附着失配模式判据:

48、当一侧马达转速增量相对于该侧压力增量异常增大,横摆角速度响应残差持续超过允许范围,且预测横摆角速度与实际横摆角速度方向不一致时,判定为履带附着失配模式;将马达转速响应异常增大、且对应履带车辆的横摆未同步响应的一侧确定为低附着侧;

49、液压驱动偏置模式判据:

50、当左右履带的驱动电流增量相同,但马达转速增量或响应延迟持续存在稳定差异,同时预测横摆角速度与实际横摆角速度方向一致且处于允许范围时,判定为液压驱动偏置模式。

51、具体的,步骤六中各模式对应的驱动电流调节策略为:

52、在液压驱动偏置模式下,路径回归驱动电流分量用于消除横向偏差,直线保持偏置驱动电流分量用于补偿左右驱动回路的固有驱动电流偏置,二者叠加后作为左右比例阀目标驱动电流;

53、在履带附着失配模式下,对判定得到的低附着侧,限制该侧比例阀目标驱动电流的增加量,若分配后的驱动电流无法在有效期间完成路径回归,则延长路径回归距离,不再继续增大低附着侧的比例阀目标驱动电流;

54、在液压残余响应模式下,降低输出的差动驱动电流,当实际横摆角进入设定范围内时,建立与当前差动驱动电流方向相反的反方向差动驱动电流,并根据左右马达转速响应延迟分别对左右目标驱动电流施加延迟补偿后输出。

55、具体的,在液压驱动偏置模式下,将目标差动驱动电流分解为路径回归驱动电流分量与直线保持偏置驱动电流分量,满足;路径回归过程中将直线保持偏置驱动电流分量置为零,当横向偏差或航向偏差超出范围时,调整路径回归驱动电流分量;当横向偏差、航向偏差和实际横摆角速度均处于允许范围后,将路径回归驱动电流分量置零,直线保持偏置驱动电流分量分量持续有效输出流量差;

56、在履带附着失配模式下,禁止增大低附着侧比例阀目标驱动电流,满足低附着侧目标驱动电流;若分配后的驱动电流不能够在有效期间完成路径回归,则延长路径回归距离,不继续增大低附着侧的比例阀目标驱动电流;

57、在液压残余响应模式下,降低输出的差动驱动电流,获取马达转速差与实际横摆响应数据;当实际横摆角在设定的范围内,再建立反方向差动驱动电流,并根据左右马达转速响应延迟对左右目标驱动电流进行错时输出。

58、具体的,根据目标横摆角速度、左右侧压力、液压油温度、左右比例阀阀芯滞环状态以及当前模式,通过目标横摆响应—差动驱动电流逆映射获得路径回归驱动电流分量;左右比例阀目标驱动电流为:

59、

60、

61、其中,为共同驱动电流。

62、具体的,所述步骤八中复核并更新当前模式的过程具体为:

63、在第一次输出左右比例阀目标驱动电流之后,获取马达转速增量以及横摆角速度增量;

64、若实际响应的方向、大小及先后顺序与当前模式的预期响应一致,则维持当前模式;

65、当马达转速响应相对于压力响应异常增大,且未形成相应横摆响应时,将当前模式更新为履带附着失配模式;

66、当差动驱动电流改变符号后,压力差、马达转速差或者实际横摆响应仍保持原方向时,将当前模式更新为液压残余响应模式;

67、当左右履带对应的预测横摆角速度与实际横摆角速度方向一致,且横摆角速度响应残差处于允许范围时,将当前模式更新为液压驱动偏置模式。

68、本发明通过识别底盘偏离状态、构建横摆角速度响应残差辨识不同扰动模式,并匹配对应比例阀驱动电流调节策略、结合反馈检验闭环复核模式,相较于现有pid统一反馈纠偏方案,具备如下有益效果:

69、区分底盘实际偏离态势,实现态势感知层面的差异化纠偏,降低超调与反复越线风险 本发明根据横向偏差、横向偏差变化率的符号关系、航向偏差以及相邻采样时刻横向偏差符号变化,将底盘运动划分为背离状态、收敛状态、越线状态、平行偏移状态。针对不同偏离态势执行差异化控制逻辑:背离和平行偏移状态通过预测横向偏差确定目标靠拢角输出第一方向差动驱动电流;收敛状态预判回正后的终点横向偏差,满足条件才切入反方向回正并输出第二方向差动驱动电流;越线状态优先停止增大原方向差动驱动电流,选择进入液压残余响应模式或反向回正阶段。 避免现有技术无论底盘处于何种偏离态势,均采用同一套驱动电流调节逻辑的缺陷,能够预判回正过程中是否会发生越线过冲,从纠偏源头上抑制底盘反复穿越目标路径、来回摆动的现象,提升路径回归过程的平稳性。

70、基于系统响应残差辨识扰动来源,可区分液压驱动偏置、履带附着失配、液压残余响应三类不同物理诱因。本发明在差动驱动电流输出之后,采集压力增量、马达转速增量、实际横摆角速度增量以及响应延迟,利用马达转速计算预测横摆角速度,构建横摆角速度响应残差;结合残差大小、差动驱动电流换向前后响应方向,自动判别底盘跑偏属于液压残余响应模式、履带附着失配模式还是液压驱动偏置模式。突破现有技术仅依靠位姿偏差做反馈、无法区分 “跑偏来自液压系统本身还是地面履带附着条件变化”的局限,不再笼统采用“一侧加驱动电流、一侧减驱动电流”的通用处理方式,能够识别不同物理扰动机理,为针对性驱动电流修正提供判断依据。

71、针对三类扰动模式配置专属驱动电流调节策略,适配液压履带多源非线性扰动工况,在液压驱动偏置模式下,将路径回归驱动电流分量与直线保持偏置驱动电流分量相叠加:路径回归阶段将偏置分量置零,偏差收敛后保留偏置分量补偿液压固有不对称,适配左右比例阀驱动电流死区、马达流量效率不一致带来的稳态持续侧偏问题;在履带附着失配模式下,禁止增大低附着侧比例阀目标驱动电流,当现有驱动电流无法按时完成路径回归时选择延长路径回归距离,避免继续增大该侧输出驱动电流造成履带空转打滑,防止路径偏差进一步恶化;在液压残余响应模式下,先降低差动驱动电流输出,待实际横摆角进入设定范围后再建立反方向差动驱动电流,并结合马达转速响应延迟对目标驱动电流做错时输出,抑制比例阀换向之后,受马达惯性、液压滞后造成的纠偏过冲。 通过分模式的驱动电流处理策略,同时兼顾路径回归能力与执行机构、地面约束条件,改善非铺装、坡度多变工况下的跟踪控制品质。