[发明专利]一种采煤机机身与摇臂协同定位装置及定位方法

说明书

一种采煤机机身与摇臂协同定位装置及定位方法，包括在采煤机机身上安装的机身捷联惯导装置和无线传感锚节点；以及在采煤机割煤一侧的摇臂上安装的摇臂捷联惯导装置和无线传感移动节点；其中无线传感移动节点发射无线信号，无线传感锚节点接收无线信号；工作中，机身沿轨道移动，摇臂进行截割煤壁运动，摇臂捷联惯导装置测量采煤机摇臂的角速度和加速度信息，机身捷联惯导装置实时测量采煤机机身的角速度和加速度信息，利用捷联导航算法进行定位定姿；本发明具有定位、定姿精度高、综采工作效率高及远程自动控制的优点。

技术领域

本发明属于采煤机定位技术领域，具体涉及一种采煤机机身与摇臂协同定位装置及定位方法。

背景技术

采煤机、液压支架和刮板输送机是井下综采工作面最重要的三种设备，相互配合完成割煤、运煤和支护工作。其中采煤机为主导设备，是综采工作面割煤和装煤的主要设备，是一种高集成度综采设备。采煤机在工作时沿刮板输送机的轨道进行往复式割煤，液压支架支护顶板并推进工作面。为了实现综采工作面自动化、远程自动控制，需要对采煤机精确动态定位，而且，针对自动化采煤需求，需要同时对采煤机的机身和摇臂进行定位，所以采煤机机身和摇臂的定位技术是煤矿生产装备自动化的关键技术。

煤矿综采工作面工况复杂，同时空间封闭，因此采煤机机身与摇臂定位是一个典型的复杂封闭环境下室内定位问题。在采煤机的采煤作业中，采煤机机身沿轨道移动；而摇臂进行割煤工作，其相对于采煤机机身存在相对运动。为了实现自动化采煤，必须同时测量采煤机机身和摇臂的位置和姿态。

目前采煤机所用的定位方法主要包括捷联惯导定位法、红外定位法、超声波定位法、齿轮计数定位法、无线传感器网络定位法等。

红外定位法由安装在采煤机上红外发射装置发射信号，液压支架上安装的接收装置接收信号，利用红外测距定位采煤机的位置，但其红外信号易受粉尘影响，且存在固有定位盲区，定位精度不高，因此使用有局限性。

超声波定位法将超声波发射装置安装在工作面巷道中，当采煤机经过时，机身发射超声波，根据各位置超声波接收装置接收信号，利用超声波测距定位采煤机的位置，超声波的优点是可以穿透粉尘，但由于工作面较长，信号失信严重，其定位精度不高，因此使用有局限性。

齿轮计数定位法是对采煤机行走齿轮的转动圈数进行计数，根据转动圈数和齿轮圆周长计算采煤机沿输送机轨道方向上的位移；但该方法只能用于定位采煤机沿轨道方向的一维位置，且受到齿轮计数误差影响，不能满足三维定位需要。

无线传感器网络定位法是在液压支架上布置多个位置已知的无线传感器(称为锚节点)，在采煤机上布置待定位节点(称为移动节点)，移动节点发射无线信号，锚节点接收无线信号监测采煤机与液压支架间的位置关系，解算出采煤机的位置；但由于工作面环境复杂，无线定位数据不稳定，且锚节点随液压支架移动后会导致自身位置变化，需要更新锚节点位置信息，同时不能进行采煤机定姿，不能满足实时定位定姿需求。

捷联惯导定位方法是一种全自主导航定位方法，无需借助外部信息，利用捷联惯导装置的三轴陀螺和三轴加速度计实时测量采煤机的角速度和线加速度，结合初始装订信息，通过姿态更新算法先解算出采煤机的运动姿态，然后将加速度根据姿态信息投影到导航坐标系，通过积分和二次积分获得采煤机的速度和位置等信息；高精度惯导虽然满足精度要求，但由于体积、重量等原因，一般只安装在采煤机的机身，无法用于采煤机摇臂的定位和定姿，或采煤机摇臂只能安装小型低精度惯导，其定位、定姿精度不能满足要求。

发明内容

为了克服上述现有技术存在的问题，本发明提供了一种采煤机机身与摇臂协同定位装置及定位方法，能够利用采煤机机身和摇臂上的捷联惯导装置和无线测距传感器，同时实现采煤机机身与摇臂的定位定姿，具有定位定姿精度高、综采工作效率高及远程自动控制的优点。

为了实现上述目的，本发明采用如下的技术方案：