基于激光测量技术的掘进机航向角精度研究

为实现悬臂式掘进机位姿的高精度自主测量,建立了基于激光测量技术的掘进机位姿检测系统,并对掘进机航向角精度进行研究。介绍了测量系统的组成和工作原理;由误差传递理论及掘进机航向角解算数学模型,推导出航向角误差传递方程;并应用MATLAB进行仿真分析研究。结果表明:实验仿真与实际理论分别得出的航向角在多因素条件下测量误差变化规律基本相同,此测量系统在目前的各类掘进机定位定向方法中测量精度是最高的。完全满足目前煤矿综掘工作面对悬臂式掘进机航向角测量精度的要求。     

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

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

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

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

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

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

面向掘进机的超宽带位姿协同检测方法

为符合安全高效生产对掘进机作业的要求,提出了一种面向掘进机的超宽带位姿协同检测方法。依据TDOA(波达时间差)定位原理及P440模块的测距信息建立定位模型,利用协同定位算法得到定位点坐标的最终估计值。对比Chan算法与协同算法的定位点仿真分布,并分析协同算法的三轴定位精度。建立了空间全断面定位误差场,得出协同算法的空间定位精度变化规律。对机身定位点进行布局设计,解算得到掘进机的姿态角。结果表明:在90 m范围内,协同算法的Y轴定位误差基本上可以保持2 mm,而X轴、Z轴定位误差由0. 4至4 cm呈线性增加。随测量距离的增大,在巷道X-Y断面上,定位误差呈线性增加;在巷道X-Z断面上,定位误差的随机性增加。姿态角误差均由0. 2°至1. 5°呈线性增加,满足掘进机位姿检测精度的需求。     

基于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轴误差随测量距离增大而增大。为实现综掘装备的自主导控提供了理论基础。     

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

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

基于机器视觉掘进机位姿检测应用现状与趋势

机器视觉技术依靠非接触、获取信息丰富的特点,在煤矿智能化的进程中得到了广泛应用,同时在煤炭开采中,掘进机的位姿检测有利于掘进机的自动化以及智能化操作进而有利于煤矿智能化进程的推进,不仅能缓解采掘失衡的矛盾,同时能降低工人的劳动强度,本文分析了近几年来机器视觉技术在掘进机位姿检测中的应用现状与趋势,研究了各种掘进机位姿检测方法中所涉及的图像预处理以及位姿检测模型的关键共性问题,并就关键共性问题,提出了机器视觉技术在掘进机位姿检测的应用中,应在图像采集硬件、位姿检测的冗余性以及特征提取的精确性方面做出突破。     

基于Chan算法的掘进机超宽带位姿检测基站布局分析

针对综掘工作面的矿工面临一系列危险这一突出问题,结合工程实际与计算机仿真技术,提出了一种基于Chan算法的掘进机超宽带位姿检测方法。设计了5种基本的基站布局方式并进行定位精度仿真分析,最后选取环形布局方式分析了基站布局间距对定位精度的影响。     

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

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

基于机器视觉的悬臂式掘进机机身位姿检测系统

针对矿井巷道自动掘进的需求,为矿用悬臂式掘进机构建了一套机身位姿实时检测系统。该系统以十字激光器与激光标靶为信息来源,通过对标靶上十字光线成像特征的分析,建立了掘进机机身位姿空间解算模型。该模型利用机身与十字激光面的空间关系,使用空间矩阵变换方法,得到机身相对于巷道的三轴倾角以及在巷道断面上的偏离位移,实现了掘进机机身位姿的自动实时检测。最终,在实验室条件下,搭建了机身位姿自动检测试验平台,模拟掘进机在巷道内的姿态,试验结果表明:测量范围在2~100 m时,系统的角度测量误差在0.5°范围内,位移的检测误差小于20 mm,能够满足巷道施工过程中掘进机机身位姿自动、精确、实时测量的要求。     

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

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

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

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

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

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

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

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

基于机器视觉的掘进机截割头姿态检测系统

对掘进机截割机构模型进行简化,采用俯仰角和旋转角作为描述截割头姿态的参数,设计了基于机器视觉的掘进机截割头位姿检测系统,并介绍了双目视觉检测方法的原理。为了验证检测系统的检测效果,通过实验将采用本系统得到的截割头姿态参数与采用传感器测得的数据进行对比,结果显示截割头姿态参数相差不到1°,误差基本都在10%以内,由此证明采用机器视觉对掘进机截割头进行姿态检测得到的数据是有效的。     

煤矿掘进机机身位姿感知及定向方法研究

本文对煤矿掘进机机身位姿感知及定向技术和方法进行了详细研究，通过对比，采用惯性导航法对掘进机位姿进行测量，并对惯性导航原理及掘进机行走智能控制进行了分析与设计，建立了掘进机行走机构、行走过程及行走轨迹模型。     

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

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

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

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

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

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