自动驾驶控制装置、工程机械、自动驾驶控制系统、自动驾驶控制方法及自动驾驶控制程序与流程

摘要: 本公开涉及用于工程机械的自动驾驶的技术。背景技术:1、专利文献1公开了由液压挖掘机和自动驾驶控制器构成的自动驾驶挖掘机,该自动驾驶控制器被设置于所述液压挖掘机,...
自动驾驶控制装置、工程机械、自动驾驶控制系统、自动驾驶控制方法及自动驾驶控制程序与流程

本公开涉及用于工程机械的自动驾驶的技术。

背景技术:

1、专利文献1公开了由液压挖掘机和自动驾驶控制器构成的自动驾驶挖掘机,该自动驾驶控制器被设置于所述液压挖掘机,令所述液压挖掘机重现被指导的从挖掘循环到卸土的动作。在该自动驾驶挖掘机中,所述自动驾驶控制器在判定为所述液压挖掘机已到达规定的定位范围内时,输出下一个指导位置作为目标位置。所述自动驾驶控制器的伺服控制部基于由当前位置运算部运算出的当前位置数据、和从伺服预处理部输出的角度目标值,进行一般的反馈控制,输出用于驱动比例电磁阀的驱动电流。由此,控制阀受到控制而对致动器供应规定的压油,自动驾驶挖掘机主体的各关节被驱动。如专利文献1的图5所示,在指导位置储存部中,分别针对指导位置p1~pn,储存有回转体、动臂、斗杆及铲斗的姿势的目标值即回转体角、动臂角、斗杆角及铲斗角。

2、当在如上所述的自动驾驶中进行一般的反馈控制时,会产生如下所述的问题。亦即,若铲斗的尖端靠近指导位置,则动臂等可动部的实际角度与该可动部的目标角度之差会减小,因此,在反馈控制中被输入至比例电磁阀等控制对象的操作量也会减小,工程机械的动作速度(回转体、动臂、斗杆、铲斗等的动作速度)也会减小。另一方面,若目标位置切换为下一个指导位置,则所述可动部的实际角度与目标角度之差会增大,因此,在反馈控制中被输入至控制对象的操作量也会增大,工程机械的动作速度也会增大。在此情况下,工程机械的动作速度容易在切换指导位置(目标位置)的前后变动。

3、现有技术文献

4、专利文献

5、专利文献1:日本专利公开公报特开平11-264155号。

技术实现思路

1、本公开的目的在于提供一种能够在工程机械的自动驾驶中减少切换目标位置前后的工程机械的动作速度的变动的技术。

2、所提供的自动驾驶控制装置包括控制器,该控制器基于为了工程机械的自动驾驶而被设定的多个目标位置,控制所述工程机械的多个可动部的动作,所述控制器设定所述多个可动部各自的基本速度,取得与所述多个可动部各自的实际姿势相关的实际姿势值,使用所述基本速度,运算与所述多个可动部各自的理想姿势相关的理想姿势值,使用所述理想姿势值与所述实际姿势值之差,运算用于修正所述多个可动部各自的所述基本速度的修正值,并将与利用所述修正值对所述多个可动部各自的所述基本速度进行修正所得的值对应的操作量输出至所述自动驾驶中的控制对象。

1.一种自动驾驶控制装置,包括控制器,所述控制器基于为了工程机械的自动驾驶而被设定的多个目标位置,控制所述工程机械的多个可动部的动作,所述自动驾驶控制装置的特征在于,

2.根据权利要求1所述自动驾驶控制装置,其特征在于,

3.根据权利要求1或2所述自动驾驶控制装置,其特征在于,

4.根据权利要求1至3中任一项所述自动驾驶控制装置,其特征在于,

5.根据权利要求1至4中任一项所述自动驾驶控制装置,其特征在于,

6.根据权利要求5所述自动驾驶控制装置,其特征在于,

7.根据权利要求1至6中任一项所述自动驾驶控制装置,其特征在于,

8.根据权利要求1至7中任一项所述自动驾驶控制装置,其特征在于,

9.根据权利要求1至8中任一项所述自动驾驶控制装置,其特征在于,

10.一种工程机械,其特征在于包括:

11. 一种自动驾驶控制系统,其特征在于包括:

12.根据权利要求11所述的自动驾驶控制系统,其特征在于,

13.根据权利要求11或12所述的自动驾驶控制系统,其特征在于,

14.一种自动驾驶控制方法,基于为了工程机械的自动驾驶而被设定的多个目标位置,控制所述工程机械的多个可动部的动作,其特征在于包括如下步骤:

15.一种自动驾驶控制程序,基于为了工程机械的自动驾驶而被设定的多个目标位置,控制所述工程机械的多个可动部的动作,其特征在于,令计算机执行如下处理: