论文部分内容阅读
煤炭是我国的主体能源,而深部煤层的瓦斯爆炸、岩层垮塌、突水等地质灾害发生率高、偶然性强,对采掘矿工的生命安全威胁极大。因此,深部危险煤层安全高效开采是煤炭工业发展中的更高需求,迫切需要自主设计和制造适合深部开采的无人机械化综掘设备。在深部危险煤层的无人化掘进作业中,悬臂式掘进机的自主导控是实现综掘工作面无人化的核心,而悬臂式掘进机的位姿检测是掘进机自主导控的基础和关键。长期以来,利用点激光指向仪人工定向掘进是完成悬臂式掘进机定向作业的主要手段,这种手段不仅定向精度低,而且无法提供掘进机自主导控所需的所有位姿参数。因此,在国家能源科技“十二五”规划中明确提出要重点研究“基于三维定位的远程控制技术”,从而实现综采综掘工作面自动化与无人化。本文基于超宽带(Ultra Wide-Band,UWB)信号在局域范围内的高精度时间分辨率,提出一种基于UWB信号双向飞行时间测距(Two Way-Time Of Flight,TW-TOF)的悬臂式掘进机位姿检测系统(Ultra wide-band Pose Detection System,UPDS)及其检测方法,可实现悬臂式掘进机在狭长封闭巷道空间中的位姿参数连续测量,为实现悬臂式掘进机的自主导控及综掘工作面的无人化开采提供了可靠的理论基础。具体研究工作如下:(1)构建了UPDS系统结构,提出了UPDS检测方法及自主标定方法。基于悬臂式掘进机的工作特性,分析了悬臂式掘进机的定位原理及位姿检测原理,确定了悬臂式掘进机自主导控所需的完整位姿参数;基于悬臂式掘进机的工况条件及UWB信号在介质中的传播特性,对比了基于UWB信号的多种定位模型。基于优选的UWB信号测距参量定位模型,构建了UPDS系统结构并设计了UPDS位姿检测方法,可以实现悬臂式掘进机的位姿参数的远程、非接触式连续测量;推导了UPDS坐标解算及姿态角解算模型;为提高UPDS系统有效测量距离,减少井下工作人员对基站标定次数,提出了一种基于多部定位基站机器人步进式协同标定的UPDS自主标定方法,完成对UPDS系统的连续自主标定;构建了UPDS定位基站机器人的结构模型并且设计了UPDS自主标定策略。(2)推导了基于UWB距离参量定位模型的UPDS定位算法。基于UPDS系统特点,构建了三种基于UWB测距参量的UPDS定位解算模型:信号到达时间(Time Of Arrival,TOA)定位模型、信号到达时间之差(Time Difference of Arrival,TDOA)定位模型以及信号到达时间之和(Time Summation Of Arrival,TSOA)定位模型;基于TOA、TDOA以及TSOA三种定位解算模型,推导了8种面向UPDS的定位算法,包括:基于TOA定位模型的Caffery定位法(Caffery定位法)、基于Caffery与Taylor级数展开的融合定位法(CT定位法);基于TDOA定位模型的间接法(TDOA间接法)、基于Taylor级数展开的TDOA定位法(Taylor-D定位法)、基于TDOA定位模型的Chan定位法(Chan-D定位法);基于TSOA定位模型的间接法(TSOA间接法)、基于Taylor级数展开的TSOA定位法(Taylor-S定位法)、基于TSOA定位模型的Chan定位法(Chan-S定位法);此外,根据UPDS系统的定位原理,分析了TOA、TDOA以及TSOA三种定位模型的误差影响因素。(3)分析了UPDS定位算法在狭长封闭巷道中定位精度及误差分布规律。在10m-95m狭长空间中开展了UWB测距实验,选用了美国Time domain公司研制的P440模块进行多次测距获得完整实测数据,基于UWB实测测距数据,对UPDS的8种定位算法进行了仿真定位分析;仿真模拟了8种定位算法在95m范围内的定位节点分布、各轴误差分布以及定位均方根误差随测量距离变化曲线;对比了各定位算法的特点、精度、误差变化规律,基于仿真分析结果,优选了四种定位算法:Caffery定位法、CT定位法、TDOA间接法以及TSOA间接法。为了探究不同算法在狭长封闭巷道空间中的定位精度变化规律,提出一种面向狭长封闭巷道空间的全断面定位误差场,利用该方法可以直观体现不同算法在狭长封闭巷道中的精度及误差分布规律。通过对比四种定位算法在狭长巷道空间中的全断面定位误差场,确定了CT定位法在10m-95m的狭长巷道空间中具有更高的定位精密度,因此将CT定位法作为UPDS现场实验的核心算法。(4)开展了UPDS现场位姿检测实验,验证了系统的有效性。探究了基站几何布局对UPDS定位精度的影响以及机身定位节点几何布局对UPDS姿态角解算精度的影响;基于优选的基站几何布局,在悬臂式掘进机自主导控实验室中的模拟巷道开展了UPDS现场实验,验证了UPDS系统有效以及UPDS在狭长巷道中的定位精度及姿态角解算精度;在模拟巷道中10m-78m的范围内选取了10个掘进机位置节点进行标定及测量,通过对UPDS的实测数据分析可得UPDS在X轴、Y轴方向可以达到厘米级定位精度,对掘进机偏向角可以达到5°的检测精度,满足综掘工作面开采要求,为实现悬臂式掘进机的自主导控提供了可靠的理论基础及实践基础。