基于空间交汇测量技术的悬臂式掘进机位姿自主测量方法

根据深部危险煤层无人化开采的需求,要实现无人环境下对悬臂式掘进机位姿的高精度测量。提出一种基于空间交汇测量技术的悬臂式掘进机自主位姿测量方法,由悬臂式掘进机搭载激光发射器并发射旋转激光平面,在其后方安装位置固定的激光接收器并通过激光平面获取激光发射器相对于其自身的方位,从而得到悬臂式掘进机相对于由激光接收器确定的巷道坐标系的位姿状态。构建悬臂式掘进机位姿测量的数学模型,运用仿真软件对该模型进行仿真并分析位姿测量精度。仿真表明：在激光发射器与激光接收器相距25 m时悬臂式掘进机定位点的最大测量误差在X轴,测量误差为0.082 3 m;姿态角的最大测量误差为横滚角,测量误差为2.018 4°。基本满足目前煤矿综掘工作面对悬臂式掘进机位姿测量精度的要求。     

基于掘进机位姿测量系统的自主标定方法误差分析

围绕在狭长综掘巷道中掘进机位姿激光测量系统位姿参数高精度自动测量的问题,首先系统介绍了位姿测量系统,研究了位姿测量系统测站移站后高精度自动全站仪自主标定原理。依据激光测量原理及掘进机工作特点,构建了全站仪移站后全站仪设站点坐标与定位棱镜坐标测量误差数学平差模型,并通过Matlab进行了不同标定距离、不同测量距离对悬臂式掘进机位姿参数测量误差影响规律的仿真分析。分析结果表明:掘进方向的位姿误差比较大,掘进机姿态角误差均随测量距离和标定距离的增加而增加,且测量距离对姿态角误差影响更明显;姿态角的最大测量误差为航向角,测量误差为0. 015 7°。从而验证了激光导向系统自主标定的可行性,并由此提出了一种相对最优的自主标定策略。完全满足目前煤矿综掘工作面对悬臂式掘进机位姿测量精度的要求。     

悬臂式掘进机视觉导航与定向掘进控制技术

煤矿巷道掘进装备位姿测量是国内外目前研究的热点,不同的巷道快速掘进系统均面临定向导航难题。为解决煤矿井下悬臂式掘进机自动定向掘进控制难题,提出一种基于视觉导航的悬臂式掘进机自动定向掘进控制方法,利用单目视觉测量技术,以巷道中激光指向仪的激光点和激光束为特征构建基于门形结构的掘进机机身位姿视觉测量模型,通过空间矩阵变换解算巷道中机身位姿。根据悬臂式掘进机运动特点确定掘进机纠偏控制策略,基于悬臂式掘进机运动学建立掘进机定向掘进运动控制模型,采用backstepping方法,选取合适的Lyapunov函数设计掘进机轨迹跟踪控制器,有效解决掘进机轨迹跟踪控制问题。实验结果表明:悬臂式掘进机机身位姿视觉测量方法可有效实现井下工作环境中悬臂式掘进机机身的位姿测量,得到掘进机机身位置测量误差在±40 mm以内,姿态角角度测量误差在±0.3°以内;轨迹跟踪控制器可实现悬臂式掘进机的自动定向掘进功能,其运动控制精度在±20 mm以内,满足巷道施工的精度要求。该方法中工业相机固定安装于掘进装备机身,且利用激光指向仪点-线特征构建门型三线模型作为位姿测量基准,与相关研究对比,具有不易脱靶、标靶移动少等优点。     

悬臂式掘进机行走轨迹及偏差感知方法

悬臂式掘进机机身位姿参数的实时精准感知是煤矿巷道定向掘进,乃至综掘工作面智能化、无人化建设的关键环节,在综掘工作面复杂工况下目前还不能真正实现掘进机机身位姿实时、自主、精准感知。提出了一种悬臂式掘进机行走轨迹及偏差感知方法,旨在实时确定掘进机机身的方位偏差,为掘进机定向掘进提供纠偏基准参数。在以往研究的基础上,搭建了基于激光偏距感知、捷联惯导、二维里程计的掘进机行走轨迹及偏差感知系统,分析了掘进机机身方位偏差与巷道定向掘进的关系,制定了基于此系统的掘进机自主定向掘进策略;基于捷联式惯性导航系统在综掘工作面的适用改进推导了其初始粗对准和姿态更新算法,确立了掘进机航向角与偏角的联系;研制的二维里程计可同时测量掘进机横向和纵向里程增量,推导了基于二维里程和偏角的航位推算算法,得到了掘进机实时位置坐标。研发了掘进机位姿参数可视化交互式远程显示系统,搭建了包括掘进机井下、井上可视化远程控制平台、全站仪在内的掘进机行走轨迹及偏差感知精度验证实验系统。工业性实验结果表明所提方法实现了掘进机机身偏角、偏距(横坐标)、纵坐标的精准感知,验证了所提方法的可行性及优越性,满足巷道掘进对于掘进机机身定位定向要求。     

悬臂式掘进机视觉伺服截割控制系统研究

悬臂式掘进机的自动化、智能化程度低严重制约着煤矿巷道施工技术的发展,智能掘进技术成为目前国内外研究的热点.针对煤矿悬臂式掘进机自动截割控制问题,将视觉测量传感器应用于悬臂式掘进机截割头的控制系统中,提出了悬臂式掘进机视觉伺服截割控制系统.根据悬臂式掘进机的运动学,利用视觉测量系统有效实时反馈截割头位姿,融合惯性导航系统...     

基于iGPS的悬臂式掘进机位姿测定系统研究

煤矿掘进作业中,常常会出现巷道基准轴线与掘进机位姿测量不一致的情况。为了解决掘进作业中掘进机的位姿自动测定的问题,文章结合悬臂式掘进机的结构和工作方式,提出一种iGPS的悬臂式掘进机位姿测定系统,计算出了系统产生的误差:机身位姿误差约为0.01745m,控制系统误差小于0.15m。最后,在系统造价、环境适用性和安全性能3个方面论述了系统的可行性。     

悬臂式掘进机空间位姿的运动学模型与仿真

为实现掘进断面自动截割成形控制,达到无人采掘装备自主巡航目标,研究了悬臂式掘进机空间位姿运动学模型并进行了仿真。将悬臂式掘进机的机械机构简化为一系列平移或旋转关节串联而成的运动链,建立了掘进机空间位姿坐标体系;利用齐次坐标变换和机器人运动学相关理论建立了掘进机机身位姿和截割头相对于大地坐标系的空间位姿矩阵。采用D-H法求解了正向运动学问题即截割头空间位姿精确定位;采用代数法分析研究了逆向运动学问题即截割头轨迹规划及控制的数学模型。以EBZ200机型为例,实验仿真了类S形自下而上矩形截割断面工艺路径,并进行了现场多组试验。试验结果表明：设定巷道断面4 500 mm×4 000 mm,两帮综合最大误差为65 mm,相对控制最大误差为1.4%,达到煤巷断面质量精度要求,且重复精度高、无累计偏差。     

基于Chan算法的掘进机超宽带位姿检测方法

为实现综掘工作面的无人化,提出了一种基于Chan定位算法的掘进机超宽带位姿检测方法。开展了超宽带模块的测距精度实验,仿真分析了位姿检测精度。结果表明,该检测方法在90 m范围内的航向角、俯仰角、横滚角误差均可达到3°以下,满足巷道成形过程中掘进机位姿检测精度的要求。     

基于激光靶向跟踪的掘进机位姿测量方法

为了通过单点布站实现掘进机所有位姿参数的自动测量,在分析现有掘进机位姿测量方法的基础上,提出基于激光跟踪云台与激光标靶组合测量的掘进机位姿测量方法。阐述了测量系统的组成、工作原理及激光标靶提取光斑坐标的方法,通过研究掘进机位姿、激光标靶位姿、激光跟踪云台位姿以及巷道坐标系之间的转换关系,建立掘进机位姿测量系统的数学模型,解算出掘进机相对于巷道坐标系的绝对位姿的数学表达式,并采用Matlab分析了掘进机各位置和姿态参数的测量误差。实验结果表明:测量距离为60 m时的翻滚角误差小于0.7°,俯仰角误差小于0.7°,方向角误差小于0.2°,X轴误差小于10 mm,Y轴误差小于40 mm,Z轴误差小于30 mm,满足掘进机位姿测量的精度要求。     

基于惯性导航技术的掘进机位姿测量系统研究

为实现掘进机位姿无人化、高精度的自主测量功能,提出了基于惯性导航技术的掘进机位姿测量系统并对其可行性进行分析研究。根据掘进机实际工况,提出了掘进机空间位姿参数,建立了位姿测量系统的数学模型,应用MATLAB进行仿真分析研究,得出了掘进机空间位姿参数在不同掘进进尺及掘进时间情况下的变化规律。     

基于捷联惯导的悬臂式掘进机位姿解算算法研究

针对煤矿井下高煤尘、光线暗的恶劣环境中掘进机无法实现动态位姿检测的问题，提出了基于捷联惯导的悬臂式掘进机位姿检测方法并对其解算算法做了对比研究。捷联惯导是通过三轴陀螺仪和三轴加速度计实时测得掘进机的角速度和加速度，根据位姿解算算法动态输出掘进机的姿态和位置信息。位姿解算算法很大程度决定着姿态和位置的精度，因此结合掘进机实际掘进工艺的特点，围绕位姿解算算法的适用性和优劣性，对比了四元数和等效旋转矢量两种位姿解算算法，分析了姿态解算误差的影响因素。在有噪声正弦运动和模拟掘进机行走运动两种情况下进行仿真并搭建了利用小车循迹代替掘进机掘进的实验平台进行实验，结果表明，两种算法均能满足掘进机姿态角的解算精度要求，四元数法的姿态解算精度高于等效旋转矢量法|位置的解算误差较大且呈发散状态，这有待于进一步研究。     

悬臂式掘进机姿态检测及记忆截割控制系统研究

为实现悬臂式掘进机定向截割和断面截割自动控制,进一步提高自动截割成形控制精度,提出了悬臂式掘进机机身的姿态检测技术和记忆自动截割技术。通过对悬臂式掘进机机身位姿进行自动检测,提高了截割精度,并结合可编程计算机控制器PCC设计了记忆自动截割控制系统,提高了掘进机的自动化控制精度。通过井下工业性试验结果表明,该系统运行稳定可靠,控制精度较高。     

悬臂式掘进机机身及截割头位姿视觉测量系统研究

针对煤矿井下悬臂式掘进机机身及截割头位姿测量难题,提出一种基于激光束和红外光斑特征的悬臂式掘进机机身及截割头位姿视觉测量系统。在掘进工作面的巷道顶部安装3个激光指向仪,通过固定安装在掘进机机身上的防爆相机对激光束图像进行采集,利用改进的随机Hough变换对激光束进行直线检测,通过建立的基于两点三线的掘进机位姿解算模型得到掘进机机身在巷道坐标下的位姿。同时,通过防爆相机对截割部所安装的红外标靶图像进行采集,利用高斯曲面拟合算法对光斑进行中心定位,通过建立的基于对偶四元数的掘进机截割头位姿解算模型得到截割头在机身坐标系下的位姿,结合得到的机身坐标系与巷道坐标系间的转换关系,得到巷道坐标系下的截割头中心点位姿。最终,在实验室搭建了掘进机机身及截割头位姿视觉测量平台,并在该平台上模拟掘进机的实际工况位姿,结果表明,该方法测得的掘进机截割头中心点在巷道坐标系下的姿态测量误差在0.5°范围以内,位置测量误差在40 mm以内,可以满足掘进机机身及截割头位姿自动、准确、实时测量的要求。     

基于ADAMS仿真的悬臂式掘进机截割过程机身位姿变化分析

基于ADAMS仿真对掘进机截割过程中机身位姿变化进行分析。利用Solid Works建立掘进机整机三维实体模型,然后导入ADAMS中建立虚拟样机模型,对截割头施加载荷进行仿真,得到掘进机截割过程中机身位姿变化规律。悬臂式掘进机截割过程机身位姿变化规律能够为掘进机机身位姿纠偏和自适应截割提供重要的理论依据。     

掘进机远程控制技术及监测系统研究与应用

综合应用自动化、智能化和信息化等高新技术研制开发了适合煤矿综掘工作面地质与环境条件的掘进机远程控制技术及监测系统,实现了掘进机工作过程的定向、定位和定形的自动化远程控制.实现了掘进机位姿参数在线自动检测、自动定向掘进、断面自动截割成形和截割臂摆速自适应控制,首次在我国井下煤巷掘进工况中实现悬臂式掘进机机身位姿误差的绝对法测量,避免了相对法测量过程中误差积累的问题,保证了高精度定向掘进;在井下实现了远程监控、无线遥控和视频监控,实现了在多尘、振动条件下掘进机工况多角度可视化一键式遥控;在井下环网或地面任何网络接入点,实现了掘进机运行状态参数包括位姿参数等信息的实时监测与显示,并具有远程故障诊断和报警等功能.     

基于iGPS的掘进机单站多点分时机身位姿测量方法

为实现掘进机机身位姿的高精度自主测量,提出了基于iGPS的掘进机单站多点分时机身位姿测量方法,并对其可行性进行分析,研究了其测量误差分布规律。分析了目前各种掘进机机身位姿测量方法及iGPS的应用方式,推导出掘进机的位姿计算参数。系统阐述了此测量方法的组成及工作原理,依据其工作原理及掘进机工作特点,建立接收器位置坐标的解算模型,通过Matlab进行仿真,得出了在不同测量距离下接收器各个轴向坐标测量误差的变化规律,结果表明：接收器各个轴向坐标测量误差随着测距的不断增大而增大,且y轴方向的测量误差增长速率大于x,z轴方向;随着测量次数的增多,测量误差有所减小,当测距为40 m,测量次数为200时,y轴方向的最大测量误差为0.070 m。将仿真结果与国家煤矿井巷工程验收标准值进行对比得出,应用此方法测量得出的最大测量误差值小于国家标准的规定值,能够满足掘进机的位姿测量要求。     

机器人化掘进机的运动分析及车体定位

为实现对悬臂式掘进机的截割断面实时监测和自动控制,对其机器人化模型进行简化.采用平行坐标系法建立掘进机连杆坐标系和工作坐标系,通过坐标变换矩阵描述掘进机悬臂的姿态以及掘进机车体相对巷道坐标系的位姿变换关系,并基于闭环尺寸链实现了掘进机车体以及截割头在作业空间的姿态定位.在分析掘进机悬臂运动学的基础上,讨论了掘进作业控制的正向和逆向问题,并进行了仿真验证.分析表明,掘进机作业控制正解是截割断面监测的基础,逆解可指导掘进操作和实现掘进自动控制.     

基于三激光束标靶的煤矿井下长距离视觉定位方法

煤矿井下掘进装备长距离动态定位是巷道掘进智能化发展面临的首要难题,准确、可靠的位姿测量与估计对提高掘进效率具有重要意义。由于煤矿环境中存在振动噪声、磁干扰、静电干扰等因素,传统测量方法的稳定性和准确性难以保证。与其他定位方法相比,视觉测量方法以其无接触、无累积误差的优点备受关注。针对井下视觉定位面临的精度和稳定性难题,提出基于多激光束的煤矿井下长距离视觉定位方法,采用矿用激光指向仪构建了三激光束标靶解决低照度、高粉尘和复杂背景的干扰问题。以悬臂式掘进机为应用对象,构建了基于三激光束标靶的掘进机机身位姿单目视觉测量系统,提出基于颜色分量的峰值聚类约束的激光束标靶图像分割方法,利用Hessian矩阵求解激光束粗略中心线像素点的法线方向,结合泰勒展开实现三激光束中心线的亚像素级特征提取和定位;构建了三点三线(3P3L)掘进机机身位姿测量模型,并建立了测量模型的最小二乘法损失函数,结合最小化重投影误差实现非迭代全局最优解估计,获得了掘进机机身位姿的最优解,并对测量模型主要参数的误差分布进行了数值仿真研究。最后,搭建基于三激光束标靶的掘进机机身定位系统平台并进行实验评估,结果表明,该方法可满足煤...     

基于TSOA定位原理混合算法的掘进机位姿检测方法

为实现掘进机的位姿检测,提出了一种面向掘进机的混合算法的位姿检测方法。基于超宽带(Ultra-wideband)测距和(Time Summation of Arrival,TSOA)定位原理,系统地推导了混合算法的计算过程,将间接法得到的定位点初始坐标代入Taylor级数展开法,循环迭代,通过混合算法得到了掘进机的坐标值,将坐标值代入姿态角解算公式得到了掘进机的姿态角。实际实验中需要其他测量方式的标定才可验证真值,且任何测量方式均有误差,因此基于MATLAB进行仿真分析研究规律。绘制了混合算法程序流程图,仿真对比了间接法和混合算法在15 m和90 m的定位点空间分布状态、三轴误差,以及2种算法在10～100 m的测量范围内定位点均方根误差和三轴均方根误差变化情况,分析了混合算法在15 m和90 m的姿态角精度,仿真结果表明:混合算法的定位性能优于间接法,精度高于间接法,姿态角误差可控制在0. 008°以下。搭建了掘进机位姿检测系统实验平台,在模拟巷道中进行了实验验证,完整地采集了UWB测距的相关数据,在MATLAB中通过曲线拟合绘制了误差随距离变化的曲线图,得到了误差随测量距离变化的规律,实验结果表明:在3～94 m测量范围内,X轴误差可控制在4 cm以内,Y轴误差可达到毫米级,Z轴误差随测量距离增大而增大。为实现综掘装备的自主导控提供了理论基础。     

基于多频连续波相位差测距的掘进机位姿识别方法

随着矿山生产过程的日趋无人/少人化,采掘装备位姿识别技术对煤矿井下安全生产和机器协同工作具有重要意义。为了解决在空间受限的复杂掘进作业环境下,电磁波频繁反射和散射会造成密集多径和大相位误差问题,采用无源宽带谐波标签生成可利用的谐波信号,建立基于非线性二次谐波反向散射的抗干扰模型,通过上、下行链路的频率分集,抑制矿井密集多径干扰;通过基于距离的几何定位方法,提出连贯发射宽带多频连续波(Coherent Sending Broadband Multifrequency Continuous-Wave,CSMCW)相位差测距算法,来解决大相位误差条件下的测距、定位和识别的准确性难题;并以掘进机为例,研究了基于CSMCW相位差测距的无源掘进机位姿识别方法。为了验证上述理论和算法的可行性,设定了长×宽×高为105 m×4 m×3 m的掘进机仿真实验场景,分别对谐波标签抗干扰性能、CSMCW相位差测距和掘进机位姿识别效果进行了仿真测试。仿真结果表明:采用无源宽带谐波标签,与传统无源标签相比可以获得更大的信干比,具有较强的顽健性,能够有效抑制纳秒级密集多径干扰;与二次相差测距算法、参差频差测距算法相比,基于谐波反向散射抗干扰模型的CSMCW测距算法具有更强的鲁棒性,在低信噪比条件下定位测距可达到厘米级的分辨率,保证了掘进机位姿姿态角的识别;信噪比(SNR)=-5 dB、测量距离为100 m时,基于提出的多频连续波相位差测距的位姿识别方法得到掘进机航向角、俯仰角、横滚角最大误差精度约为2.3°,能够满足未来的应用要求。