折叠前倾机构、抛秧机及抛秧机动态配重协同控制方法

摘要: 本发明涉及农业机械,尤其涉及一种折叠前倾机构、抛秧机及动态配重协同控制方法。背景技术:1、抛秧机是现代农业中用于水稻等作物移栽的重要机械装备。为了跨越田埂或适应...
折叠前倾机构、抛秧机及抛秧机动态配重协同控制方法

本发明涉及农业机械,尤其涉及一种折叠前倾机构、抛秧机及动态配重协同控制方法。

背景技术:

1、抛秧机是现代农业中用于水稻等作物移栽的重要机械装备。为了跨越田埂或适应深泥脚水田作业,抛秧机的底盘通常设计得较高,这也不可避免地导致了整机重心偏高。

2、在我国广大的丘陵山区,抛秧机经常需要在有一定坡度的旱地或机耕道上行驶。现有的抛秧机前后重量分布往往固定(例如前部车头与底盘较重,后部抛秧台相对较轻)。在平地行驶时,这种配重能够维持机身平衡;然而,当机器在丘陵坡道上坡行驶时,由于整机重心偏高,重心的垂直投影点会迅速向后轴方向偏移。一旦坡度过大,极易发生“翘头”甚至向后翻覆的严重安全事故。

3、为了解决上坡“翘头”问题,传统的做法是在抛秧机车头部位增加固定的铸铁配重块34,以强行将重心前移。但是,这种“静态死配重”方案引入了新的缺陷:当抛秧机翻过坡道驶入软基底的水田进行作业时,车头额外增加的死重会导致前轮的接地比压急剧增大,造成前轮在水田中严重下陷,不仅增加了行驶阻力、破坏了水田犁底层,甚至会导致机器托底趴窝,丧失作业能力。现有的抛秧机在实际应用中,陷入了“增加前配重防翘头”与“减轻前配重防水田下陷”的工程矛盾之中。

4、因此,有必要提供一种新的折叠前倾机构、抛秧机及动态配重协同控制方法来解决上述技术问题。

技术实现思路

1、本发明的主要目的是提供一种折叠前倾机构、抛秧机及动态配重协同控制方法,旨在解决现有设备在作业过程中无法兼顾防翘头和防下陷的双层需求的问题。

2、为实现上述目的,本发明提出的一种折叠前倾机构,设置于作业设备上,作业设备上设有第一铰接位,包括承载主体、支撑铰接组件和至少两个驱动组件,所述承载主体通过所述支撑铰接组件铰接设置于所述作业设备上,且所述承载主体用于支撑作业机构;所述承载主体的沿长度方向的两侧均设有一所述驱动组件,所述驱动组件包括折叠驱动件和上托臂,所述折叠驱动件的两端分别与所述第一铰接位和所述承载主体的底部铰接,所述上托臂的两端分别与所述第一铰接位和所述承载主体的顶部铰接,且所述上托臂与所述承载主体的铰接点能够相对所述承载主体滑动。

3、可选地,所述承载主体包括相连接的横向承托段和竖向支撑段,所述横向承托段上设有与所述上托臂对应设置的铰接座,所述上托臂与对应的所述铰接座铰接,所述铰接座沿所述承载主体的长度方向滑动设置于所述承载主体上;所述竖向支撑段与所述折叠驱动件的输出端铰接。

4、可选地,所述作业设备上还设有第二铰接位,所述第二铰接位低于所述第一铰接位;所述支撑铰接组件包括下摆臂、铰接臂和支撑座,所述下摆臂铰接于所述第二铰接位与所述竖向支撑段之间,所述铰接臂的一端与所述作业设备铰接,另一端与所述横向承托段与所述竖向支撑段的连接处铰接;所述支撑座设置于所述作业设备上,且与所述第一铰接位处于同一水平面,所述支撑座与所述竖向支撑段的中部铰接。

5、另外,本发明还提供了一种抛秧机,包括:

6、底盘总成,能够沿地面行走;

7、折叠前倾机构,设置于所述底盘总成上;

8、抛秧台总成,设置于所述折叠前倾机构,所述折叠前倾机构能够展开或折叠以调整所述抛秧台总成的姿态,所述抛秧台总成能够进行抛秧作业;

9、动态配重调节机构,包括纵向驱动组件和配重块,所述纵向驱动组件设置于所述底盘总成上;所述配重块与所述纵向驱动组件的输出端连接,所述纵向驱动组件能够驱动所述配重块沿所述底盘总成的长度方向移动;

10、多源状态感知模块,设置于所述底盘总成上,用于实时检测底盘总成的纵向坡度信号、前桥载荷信号和后桥载荷信号;

11、控制器,分别与所述多源状态感知模块、所述动态配重调节机构及所述折叠前倾机构通信连接,所述控制器能够基于纵向坡度信号、前桥载荷信号和后桥载荷信号分别控制所述折叠前倾机构调整所述抛秧台总成的位置以及所述纵向驱动组件调整所述配重块的位置,以配合抛秧台总成进行抛秧作业。

12、可选地,所述底盘总成包括底盘主纵梁、安装座、前桥系统和后桥系统,所述安装座设置于所述底盘主纵梁上,且所述安装座上设有所述第一铰接位和所述第二铰接位;所述折叠前倾机构设置于所述底盘主纵梁上,所述前桥系统和所述后桥系统分设于所述底盘主纵梁的两端,用于沿地面行走;所述多源状态感知模块包括双轴倾角传感器和轴销式称重传感器,所述双轴倾角传感器设置于所述底盘主纵梁上,用于实时检测底盘总成的纵向坡度信号;所述前桥系统的前桥悬挂处和所述后桥系统的后桥悬挂处分别设有一所述轴销式称重传感器,所述轴销式称重传感器用于实时检测底盘总成的前桥载荷信号和后桥载荷信号。

13、另外,本发明还提供了一种抛秧机作业姿态控制方法,用于控制如上所述的抛秧机在抛秧作业过程中的作业姿态,包括如下步骤:

14、s1:利用控制器以设定频率实时读取所述双轴倾角传感器测量的纵向坡度信号以及轴销式称重传感器测量的前桥载荷信号和后桥载荷信号,并对采集到的纵向坡度信号、前桥载荷信号和后桥载荷信号进行低通滤波处理得到纵向坡度、前桥载荷和后桥载荷;

15、s2:控制器基于纵向坡度、前桥载荷和后桥载荷进行多源融合工况识别,并根据识别结果执行分级防后倾控制和软基底回退控制,,具体是:

16、当判断当前纵向坡度大于设定的第一安全阈值且前桥载荷相对于平地标定前桥载荷出现下降时触发一级响应,根据当前纵向坡度计算得到对应的目标前倾角,控制器输出指令至折叠前倾机构,以控制折叠前倾机构带动所述抛秧台总成从标准抛秧作业姿态向底盘总成方向收拢并前倾,直至达到当前纵向坡度对应的目标前倾角或机械允许的最大前倾角后折叠前倾机构停止动作;

17、在一级响应的基础上,若当前纵向坡度继续增大并超过第二安全阈值或者前桥载荷下降至设定的抓地力临界阈值时触发二级主动补偿,控制器基于当前纵向坡度、配重块当前位置、配重块质量、底盘总成质量、抛秧装置质量以及整车重心参数计算得到目标前移距离,并控制所述动态配重调节机构的配重块向所述底盘总成的前端移动目标前移距离;其中;

18、当判断当前纵向坡度小于平地阈值,且车辆驶入承载力下降的软基底水田时,保持配重块当前位置,或者分别将配重块的回退速度和折叠前倾机构的展开速度限制在对应的设定阈值以下;待纵向坡度、前桥载荷和后桥载荷的变化率均小于对应稳定阈值并持续预设稳定时间后执行软基底回退控制;其中:软基底回退控制为:控制器启动所述动态配重调节机构,使所述配重块回退至所述底盘总成的中心原点或预设平衡位置以均衡接地比压,并控制所述折叠前倾机构展开回复至标准抛秧作业姿态。

19、可选地,当满足以下任一条件时,控制器判定车辆进入承载力下降的软基底水田:

20、a、在预设判断时间窗口内,当前纵向坡度小于平地阈值,且前桥载荷与后桥载荷的总和满足:

21、;

22、其中:为硬质平地标定总载荷,为软基底载荷下降系数,的取值范围为0.80~0.90;

23、b、在预设判断时间窗口内,前桥载荷和后桥载荷的波动主频处于0.3hz~5hz范围内,且载荷波动幅值大于对应平地标定载荷的3%~15%;并在预设判断时间窗口内,前桥载荷的变化率呈现周期性衰减或低频阻尼振荡特征,且前桥载荷的平均值低于平地标定前桥载荷的80%~95%。

24、可选地,所述s2中,控制器控制所述折叠前倾机构进行收拢并前倾的具体过程如下:

25、①、基于当前纵向坡度和第一安全阈值确定目标前倾角,具体公式如下:

26、;

27、其中:为第一安全阈值,为机械允许的最大前倾角,为比例系数;

28、②、基于折叠驱动件的长度与下摆臂的俯仰角的几何关系,根据目标前倾角计算得到折叠驱动件的伸缩量;

29、折叠驱动件长度采用下式获得:

30、;

31、其中:为下摆臂与水平面的夹角,为第一铰接位至第二铰接位之间的距离;为下摆臂与承载主体的铰接点至第二铰接位之间的距离;为初始安装角,即时的矢量与的矢量的夹角;抛秧装置前倾角与满足线性关系,且令;

32、伸缩量的具体计算公式如下:

33、;

34、其中:,为当前油缸长度,=;

35、③、控制器将转换为折叠驱动件对应的比例电磁阀的控制指令,驱动折叠驱动件无级动作,同时实时采集折叠驱动件的位移反馈,形成闭环控制直至到达目标位置。

36、可选地,目标前移距离获取过程具体是:

37、基于当前纵向坡度进行静态目标位置解算,得到配重块34的理论安全位移,具体公式如下:

38、;

39、其中:为保持整车对后桥的力矩维持在设定的安全余量;为配重块的质量,为所述底盘总成的质量,底盘总成的重心坐标为;为抛秧台总成质量,抛秧台总成的重心坐标为;配重块位于最前端时的坐标为,为配重块在最前端时的纵向坐标,为配重块重心的高度坐标;

40、将理论安全位移引入pd控制闭环中,生成最终的目标驱动距离,具体公式如下:

41、;

42、式中,为比例增益系数,用于控制配重位移随超限坡度的线性增加量;为微分增益系数,用于抑制底盘俯仰角加速度突变造成的系统超调;为配重块当前位置的纵向坐标。

43、可选地,软基底回退控制过程中,还包括根据软基底下陷风险指数执行分级回退控制,具体是:

44、根据前桥载荷和后桥载荷计算得到软基底下陷风险指数;

45、当大于第一下陷风险阈值时,控制器限制配重块继续前移,或者控制配重块以设定低速回退;

46、当大于第二下陷风险阈值时,控制器控制配重块回退至底盘总成的中心原点或预设平衡位置,并控制折叠前倾机构展开至标准抛秧作业姿态;其中,大于。

47、本发明技术方案具备以下有益效果:

48、利用控制器基于纵向坡度信号、前桥载荷信号和后桥载荷信号分别控制所述折叠前倾机构调整所述抛秧台的位置以及所述纵向驱动组件调整所述配重块的位置,以配合抛秧台总成进行抛秧作业,使抛秧机能够根据实时解算的姿态偏差与轴荷分布定量调节整车重心,从而完美兼顾“丘陵上坡防翘头”与“入水田防下陷”的双重需求,提升装备在复杂农田环境下的本征安全性。