[发明专利]工作装置位置参数数据获取方法和装载机

说明书

本发明涉及装载机，为解决现有装载机工作装置位置参数数据获取方法相对繁杂的问题；提供一种工作装置位置参数数据获取方法和装载机，其中方法包括步骤：获取预存的基础数据；通过控制程序自动控制装载机工作装置完成特定动作组并检测各特定动作终了时的标定角度；计算各标定角度与对应角度数组中动臂提升极限位所对应的角度的角度偏差；对基础数据中各角度数组中的各角度元素与对应的角度偏差求和计算并存储获得装载机工作装置位置参数数据。该方法所执行的标定动作少，能够简单、高效地获取工作装置位置数据。

技术领域

本发明涉及一种装载机，更具体地说，涉及一种装载机工作装置位置参数数据获取方法和装载机。

背景技术

随着装载机技术的发展，人们在对装载机操作功能需求不断增加的同时,对操控舒适性要求也越来越高，为实现这些目的，装载机通常配备一些自动控制操作，例如自动铲装，或者在铲装过程中某个位置进行自动限位缓冲等。要进行这些自动控制操作，需要设定装载机工作装置的姿态位置，例如铲装卸料之后的铲斗自动贴地放平动作，需要设定动臂在不同位置铲斗相对动臂的角度，以便在动臂在某位置时将铲斗相对动臂的角度调整到相应的角度，以便在动臂下降到铲斗贴地位置时，铲斗刚好贴地放平。又比如动臂在不同位置时铲斗收斗至极限位置时相对动臂的收斗极限角度和铲斗放斗至极限时相对动臂的放斗极限角度，以便在装载机动臂在不同位置时，用于进行收斗或放斗至极限时进行缓冲。

中国专利CN110258713A公开了一种装载机工作装置位置参数数据获取方法，其方法是通过控制装载机自动完成多组特定动作时采集相关位置参数数据。这种数据获取方法，需要控制装载机进行多组特定数据，标定动作多，标定过程需要花费较多的时间，不利于产线上提高生产效率。

发明内容

本发明要解决的技术问题是针对现有装载机工作装置位置参数数据获取方法相对繁杂的问题，而提供一种工作装置位置参数数据获取方法和装载机，简化相关参数获取步骤。

本发明为实现其目的的技术方案是这样的：提供一种工作装置位置参数数据获取方法，其特征在于以下步骤：

S1：获取预存的基础数据；所述基础数据包括：

动臂角度数组BoomArr[]，是动臂自铲斗贴地放平状态提升至极限位置之间各动臂转动角度位置的动臂角度组合；

平举铲斗角度数组BucketArr[]，是动臂平举铲斗升降过程中动臂处于动臂角度数组中各动臂角度位置时铲斗相对动臂的平举铲斗角度组合；

收斗极限位铲斗角度数组BucketTiltArr[]，是铲斗处于收斗极限状态下动臂升降过程中动臂处于动臂角度数组中各动臂角度位置时铲斗相对动臂的收斗极限位铲斗角度组合；

S2：通过控制程序自动控制装载机工作装置完成特定动作组并检测各特定动作终了时的标定角度；

所述特定动作组包括将铲斗处于贴地放平状态开始将动臂提升至动臂提升极限位置的平举铲斗动作、在动臂提升极限位置将铲斗收斗至收斗极限位置的收斗动作；

所述标定角度包括：平举铲斗动作终了时的动臂极限位标定角度和平举铲斗标定角度、收斗动作终了时的收斗极限位铲斗标定角度；

S3：计算各标定角度与对应角度数组中动臂提升极限位所对应的角度的角度偏差；

S4：对基础数据中各角度数组中的各角度元素与对应的角度偏差求和计算并存储获得装载机工作装置位置参数数据。

在本发明中，通过执行一组特定动作组获取对应角度参数对预存的装载机工作装置位置参数的基础数据进行修正标定，从而获取工作装置位置参数数据。该方法所执行的标定动作少，能够简单、高效地获取工作装置位置数据。

上述工作装置位置参数数据获取方法中，所述基础数据还包括：