作业机械的制作方法

摘要: 本发明涉及一种具备多关节型的作业装置的作业机械。背景技术:1、伴随着对信息化施工的应对,开发了具有向操作员显示包括铲斗(作业工具)在内的多关节型的作业装置的位置...
作业机械的制作方法

本发明涉及一种具备多关节型的作业装置的作业机械。

背景技术:

1、伴随着对信息化施工的应对,开发了具有向操作员显示包括铲斗(作业工具)在内的多关节型的作业装置的位置以及姿势的机器引导、以使作业装置的位置沿着目标挖掘面移动的方式进行控制的机械控制(驾驶支援控制)的功能的液压挖掘机(作业机械)。

2、在专利文献1中公开了一种控制系统,其利用模型预测控制(mpc:modelpredictive control)来控制作业装置,以使液压挖掘机的铲斗沿着目标挖掘面动作。模型预测控制是以使到预定时间目标为止的评价函数的值最小化的方式算出控制输入的控制方法。模型预测控制是适合于具有多个关节的作业机械的控制的控制方法。若利用模型预测控制,则无需分别设计动臂、斗杆的缸驱动量,能够根据状况自动地计算适当的缸驱动量。另外,作为模型预测控制的优点,广泛已知能够明确地处理约束条件,即能够以较少的计算量迅速地进行计算。在专利文献1中示出了通过考虑与目标挖掘面(设计面)和铲斗的位置相关的约束条件来避免铲斗过度挖掘目标挖掘面那样的动作的方法。

3、现有技术文献

4、专利文献

5、专利文献1:日本特开2020-125594号公报

技术实现思路

1、发明所要解决的课题

2、在液压挖掘机的机械控制中,利用gnss(global navigation satellite system)来计算三维空间中的液压挖掘机的位置(本车位置),并基于目标挖掘面与本车位置的关系来计算铲斗的齿尖的坐标。然而,若利用gnss,则由于能够利用于定位的卫星数的变化、修正信息的中断,本车位置的运算结果可能大幅变动。例如,可能产生尽管实际的铲斗的齿尖位于目标挖掘面,但齿尖的坐标的计算结果位于目标挖掘面之下的状况。另外,在操作员手动设定目标挖掘面的情况下,也能够在比当前的铲斗的齿尖高的位置设定目标挖掘面。在该情况下,齿尖的坐标的计算结果位于目标挖掘面的下方。

3、在铲斗的齿尖的坐标的计算结果位于目标挖掘面之下的状况下,认为在模型预测控制中发生了约束条件的脱离。在发生了约束条件的脱离的情况下,为了尽早从约束条件的脱离恢复而执行模型预测控制,铲斗有可能进行急动作。另外,在将不满足约束条件的状态作为初始状态进行最优化运算的情况下,在最优化的反复运算中可能产生设想外的举动。即,若产生约束条件的脱离,则作业机械的动作有可能变得不稳定。

4、本发明的目的在于,在发生了约束条件的脱离的情况下,防止作业机械的不稳定的动作。

5、用于解决课题的方案

6、本发明的一个方案的作业机械具备:作业装置,其具有包括作业工具的多个被驱动部件和驱动所述多个被驱动部件的多个液压致动器;机体,其安装有所述作业装置;姿势检测装置,其检测所述作业装置的姿势;位置检测装置,其检测所述机体的位置;以及控制器,其控制所述作业装置的动作。所述控制器进行以下的模型预测控制:基于由所述姿势检测装置检测到的所述作业装置的姿势和由所述位置检测装置检测到的所述机体的位置,运算当前时间点的所述作业工具的坐标,基于所述作业工具的坐标和允许所述作业装置的动作的动作限定区域与防止所述作业装置的侵入的侵入防止区域的边界面,设定用于防止所述作业装置侵入所述侵入防止区域的所述模型预测控制中的约束条件,以满足所述约束条件且所述作业工具的坐标与所述作业工具的目标坐标的偏差变小的方式,运算从当前时间点起预定时间的期间的所述液压致动器的目标动作速度。所述控制器执行以下的动作禁止控制:基于由所述姿势检测装置检测出的所述作业装置的姿势,运算所述液压致动器的动作速度,以所述液压致动器的动作速度与所述目标动作速度一致的方式控制所述液压致动器,判断所述作业装置的控制点的位置是否脱离所述约束条件,在由于以所述作业工具的坐标位于所述侵入防止区域的方式设定所述边界面、或者由于所述位置检测装置的检测精度的变差而判断为所述作业装置的控制点的位置脱离所述约束条件的情况下,禁止或停止所述作业装置的动作。

7、发明效果

8、根据本发明,在发生了约束条件的脱离的情况下,能够防止作业机械的不稳定的动作。

1.一种作业机械,具备:

2.根据权利要求1所述的作业机械,其特征在于,

3.根据权利要求1所述的作业机械,其特征在于,

4.根据权利要求1所述的作业机械,其特征在于,具备:

5.根据权利要求1所述的作业机械,其特征在于,具备:

6.根据权利要求1所述的作业机械,其特征在于,

7.根据权利要求1所述的作业机械,其特征在于,具备: