一种防倾覆控制方法、装置及开带机与流程

摘要: 本发明涉及一种防倾覆控制方法、装置及开带机,属于森林消防工程机械电气控制。背景技术:1、在森林火灾应急处置中,及时开辟应急救援通道是防控重特大森林火灾、提升扑救...
一种防倾覆控制方法、装置及开带机与流程

本发明涉及一种防倾覆控制方法、装置及开带机,属于森林消防工程机械电气控制。

背景技术:

1、在森林火灾应急处置中,及时开辟应急救援通道是防控重特大森林火灾、提升扑救效率的关键环节。在隔离带开辟的典型作业条件下,开带机需兼具地表腐殖质清除、乔灌木粉碎、土石挖掘等多种功能,作业环境常涉及沟塘、滩涂、山坡等复杂地形,部分作业区域视野受限,安全隐患突出。尤其在临界作业状态下,复杂地形显著增加了整备倾覆风险,使得作业过程面临较高安全威胁。

2、目前开带机在防倾覆能力方面已有一定技术积累,但存在以下问题:

3、1、被动响应式控制:现有方案均依赖倾角传感器检测车体已经发生的倾斜后再触发控制动作,这种控制方式在高速行走或突然遭遇障碍时,因液压系统响应惯性易造成补偿滞后,在陡坡或松软地面工况下难以有效防止惯性倾覆;

4、2、调姿(即驾驶室调姿)控制与行走控制相互独立:现有驾驶室的调平依赖人工操作液压油缸,或基于当前倾角进行反馈调节,无法与底盘行驶速度、前方地形特征进行控制联动,调姿与行走驱动分属不同控制回路,在连续起伏地形中易产生姿态震荡,导致整机稳定性下降。

技术实现思路

1、本发明提供了一种防倾覆控制方法、装置及开带机,解决了背景技术中披露的问题。

2、根据本技术的一个方面,提供一种防倾覆控制方法,包括:

3、根据车辆前方的点云数据和双目视觉图像,获取车辆前方的地形特征序列和地形类别;

4、根据地形特征序列、地形类别、车体姿态数据和当前车速,采用模型预测控制算法,预测未来横向载荷转移率轨迹、以及使车辆平稳通过前方地形所需的调姿油缸的目标位移和目标预支撑力、支撑油缸的目标预支撑力;其中,模型预测控制算法的子模型包括侧倾动力学模型、俯仰动力学模型、纵向垂向动力学模型、驾驶室运动学模型、横向载荷转移率计算方程、调姿油缸和支撑油缸的状态转移方程;纵向为车辆行走方向;垂向为垂直于地面的方向;

5、根据未来横向载荷转移率轨迹、目标位移和目标预支撑力,进行支撑油缸的动态载荷分配控制、调姿油缸的力位混合协调控制和行走驱动的协同扭矩分配;

6、根据支撑油缸的动态载荷分配控制结果、调姿油缸的力位混合协调控制结果和行走驱动的协同扭矩分配结果,分别进行支撑油缸、调姿油缸和行走驱动控制。

7、进一步地,根据车辆前方的点云数据和双目视觉图像,获取车辆前方的地形特征序列和地形类别,包括:

8、将点云数据和通过双目视觉图像获得的视觉深度图映射至同一二维栅格平面,采用基于坡度的渐进式形态学滤波算法,进行地面点云分割;

9、对分割获得的地面点云进行网格划分,计算每个网格内的平均高度,生成数字高程模型;

10、通过最小二乘法在数字高程模型上沿纵向和横向分别拟合二维栅格平面,计算每个网格的前向坡度角和侧向坡度角,根据所有网格的坡度角构建地形特征序列;其中,横向为车辆宽度方向;

11、将地形特征序列作为输入,采用支持向量机分类器,获得地形类别。

12、进一步地,车体姿态数据包括车体的俯仰角和横滚角;获取车体姿态数据的过程包括:

13、获取底盘的俯仰角和横滚角,获取车辆的三轴加速度和三轴角速度,对获取的数据进行卡尔曼滤波融合,获得车体姿态数据。

14、进一步地,模型预测控制算法的预测结果为预测时域内的结果,预测时域内的时步数根据预瞄距离和所述方法的控制周期确定,公式为:

15、n=max(nmin,min(nmax,|d/vts|));

16、式中,n为预测时域内的时步数,nmin和 nmax分别为n的下限和上限,d为预瞄距离,v为当前车辆速度,ts为控制周期。

17、进一步地,模型预测控制算法的目标函数为:

18、;

19、式中,分别为第k步调姿油缸控制量变化率和支撑油缸控制量变化率,分别为第k步调姿油缸控制量和支撑油缸控制量,ltr(k)为为第k步横向载荷转移率,ptotal(k) 为第k步的车辆总功率需求估计值,均为权重,j为目标值。

20、进一步地,进行支撑油缸的动态载荷分配控制,包括:

21、若未来横向载荷转移率大于第一转移率阈值且小于等于第二转移率阈值,根据当前底盘的横滚角确定迎坡侧,控制迎坡侧的支撑油缸进入预支撑模式;其中,在预支撑模式下,控制迎坡侧的支撑油缸以第一预设范围内的速度伸出,直至支撑油缸所连的支撑座处于虚触地状态;

22、若未来横向载荷转移率大于第二转移率阈值且小于等于第三转移率阈值且迎坡侧的支撑油缸进入了预支撑模式,控制迎坡侧的支撑油缸进入主动支撑模式;其中,在主动支撑模式下,以迎坡侧的支撑油缸的目标预支撑力为目标,采用力闭环pi控制方法,控制迎坡侧的支撑油缸;

23、若未来横向载荷转移率大于第三转移率阈值,控制所有支撑油缸进入紧急撑模式;其中,在紧急撑模式下,控制支撑油缸全速伸出;在支撑油缸全速伸出的同时降低高风险侧的行走驱动扭矩,增加低风险侧的行走驱动扭矩,行走驱动调整预设时间后,控制行走驱动减少至0。

24、进一步地,进行调姿油缸的力位混合协调控制,包括:

25、采用位置闭环pi控制方法,控制调姿油缸伸缩至目标位移对应的目标位置;

26、若驾驶室相对于水平面的偏差不大于偏差阈值,采用力闭环pi控制方法,控制调姿油缸的支撑力等于目标预支撑力。

27、进一步地,进行行走驱动的协同扭矩分配,包括:

28、在直线行走工况下,根据左履带和右履带的垂向载荷比值等比例分配行走驱动扭矩;

29、在转向行走工况下,根据转向角度计算内外侧履带的目标速度差,并结合垂向载荷比例分配内外侧行走驱动扭矩,使转向过程既满足运动学差速要求,又不超出附着力极限;

30、当当前的横向载荷转移率超过第四转移率阈值时,将低垂向载荷侧的部分行走驱动扭矩转移至高垂向载荷侧,转移幅度与侧倾程度正相关,并且若监测到一侧打滑率超过打滑阈值,将该侧的预设比例的当前行走驱动扭矩转移至对侧。

31、根据本技术的另一个方面,提供一种防倾覆控制装置,包括:

32、地形识别模块,根据车辆前方的点云数据和双目视觉图像,获取车辆前方的地形特征序列和地形类别;

33、预测模块,根据地形特征序列、地形类别、车体姿态数据和当前车速,采用模型预测控制算法,预测未来横向载荷转移率轨迹、以及使车辆平稳通过前方地形所需的调姿油缸的目标位移和目标预支撑力、支撑油缸的目标预支撑力;其中,模型预测控制算法的子模型包括侧倾动力学模型、俯仰动力学模型、纵向垂向动力学模型、驾驶室运动学模型、横向载荷转移率计算方程、调姿油缸和支撑油缸的状态转移方程;纵向为车辆行走方向;垂向为垂直于地面的方向;

34、分配模块,根据未来横向载荷转移率轨迹、目标位移和目标预支撑力,进行支撑油缸的动态载荷分配控制、调姿油缸的力位混合协调控制和行走驱动的协同扭矩分配;

35、控制模块,根据支撑油缸的动态载荷分配控制结果、调姿油缸的力位混合协调控制结果和行走驱动的协同扭矩分配结果,分别进行支撑油缸、调姿油缸和行走驱动控制。

36、根据本技术的另一个方面,提供一种开带机,采用上述防倾覆控制方法进行防倾覆控制。

37、本发明所达到的有益效果:本发明通过车辆前方的点云数据和双目视觉图像探测前方地形,采用模型预测控制算法预测未来横向载荷转移率轨迹、以及使车辆平稳通过前方地形所需的油缸的目标位移和目标预支撑力,从而实现前馈控制,不会出现被动响应式控制存在的问题;本发明根据预测结果进行支撑油缸的动态载荷分配控制、调姿油缸的力位混合协调控制和行走驱动的协同扭矩分配,将行走驱动、姿态调平和防倾覆支撑纳入同一控制,不会出现相互独立存在的问题。