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

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