[发明专利]一种臂架前端垂直方向定位系统及定位方法

说明书

一种臂架前端垂直方向定位系统及定位方法，包括检测臂架俯仰铰点与臂架拉杆铰点之间臂架段与水平面夹角的第一角度传感器；检测臂架拉杆铰点与臂架前端点之间臂架段与水平面夹角的第二角度传感器；具备采集角度传感器数据、数据滤波和数据计算功能的数据处理单元；自动控制系统；角度传感器检测的角度数据均输出至数据处理单元；数据处理单元对接收的数据进行滤波和解算后，得出的臂架垂直方向定位数据，通过工业总线输出至自动控制系统；自动控制系统按定位数据控制臂架的作业。

技术领域

本发明涉及工程机械技术领域，尤其是涉及一种臂架前端垂直方向定位系统及定位方法。

背景技术

堆取料机在自动作业时，在已知料堆的分布和表面空间坐标时，堆取料机可自动控制堆取料作业，控制精度和作业效率很大程度上取决于臂架前端的定位精度。堆料时物料从臂架前端卸到料场，取料时由臂架前端的斗轮机构接触料堆进行取料，当臂架前端定位精度不高时，在取料时极易发生取料层高过大或过小，无法保证取料流量的稳定，同时造成残余料层高度不可控；在堆料时容易造成堆高不足，导致料场利用率低，或堆高过高，使臂架在运动时料堆与臂架发生干涉碰撞。因此在作业过程中需要对堆取料机的臂架前端进行准确定位，来保证堆取料机控制的精度和效率。

现有技术中臂架前端的定位有以下两种方案：

方案1：臂架前端定位采用编码器检测走行位置、回转角度和臂架俯仰角度，最后再用走行位置、回转角度、俯仰角度等参数通过三角函数计算臂架前端在空间坐标系中的(x，y，z)值。

方案2：随着GPS技术的发展，近年来，出现了利用RTK-GPS(实时差分GPS系统)定位系统来对臂架前端进行直接定位，该方案定位精度较高。

针对方案1：随着技术发展，目前堆取料机的走行位置和回转角度定位均可以做到高精度的定位，但是臂架俯仰角度采用编码器时，编码器安装在臂架俯仰的中心铰点处，计算过程中将臂架当做刚性的直线，用铰点处的角度来代替臂架前端的角度。但臂架前端因为自重和负载，常导致臂架钢结构发生变形，其变形在臂架前端的位移量可达300～500mm。因此，现有技术中，该方案无法解决因臂架变形带来的臂架前端定位系统的误差，因此臂架前端在垂直方向上的定位精度较低。此外采用机械接触式测量，使用过程中容易损坏，维护量较大。

针对方案2：RTK-GPS定位系统针对露天使用的设备能做到高精度定位。随着环保要求的日益严苛，许多堆取料机作业的堆场转为封闭料场，封闭料场使用钢制大棚进行了封闭，使GPS系统无法接收卫星信号，RTK-GPS定位系统不适用在封闭料场中采用。因此用于室内设备的臂架前端垂直方向定位系统尚存在技术问题需克服。

发明内容

针对现有技术存在的缺陷，本发明解决的技术问题在于：提供一种能够准确检测出臂架前端垂直方向的定位值，提高定位精度和设备运行的可靠性的臂架前端垂直方向定位系统及定位方法。

为了解决上述技术问题，一方面，本发明提供一种臂架前端垂直方向定位方法，包括以下步骤：

检测臂架俯仰铰点与臂架拉杆铰点之间臂架段与水平面夹角的第一角度传感器，以及检测臂架拉杆铰点与臂架前端点之间臂架段与水平面夹角的第二角度传感器检测的角度数据分别输出至数据处理单元；所述数据处理单元对接收的数据进行滤波和解算后，得出的臂架垂直方向定位数据，通过工业总线输出至能控制臂架作业的自动控制系统；自动控制系统按定位数据控制臂架的作业。

作为进一步改进技术方案，本发明提供的臂架前端垂直方向定位方法，所述数据处理单元对接收的数据滤波包括：对第一角度传感器检测的角度φ和第二角度传感器检测的角度θ均至少采样5次后，按取算术平均值的方法进行滤波计算；臂架前端垂直方向定位包括以下步骤：

所述数据处理单元按以下公式计算臂架俯仰铰点与臂架前端点之间连线的长度L₃：