高级检索

基于视觉与惯导的掘进机组合定位方法

Combined localization method of roadheader based on vision and inertial navigation

  • 摘要: 针对煤矿井下掘进机单一位姿测量方法导致的掘进机位姿精度低、测量稳定性差的问题,提出了一种基于视觉和光纤惯导的掘进机组合定位方法。以固定在巷道顶板上的三激光指向仪作为特征目标,构建了基于三激光标靶的掘进机机身位姿视觉测量系统,采用机载防爆相机采集激光标靶,通过图像处理得到激光指向仪光斑中心位置,结合掘进机机身位姿视觉测量模型及空间坐标转化得到掘进机位姿数据。同时利用安装在掘进机机身上的光纤惯导实时获得掘进机的位置和姿态信息,采用拉格朗日三点插值法将视觉位姿数据和惯导位姿数据在时间上进行配准处理后,运用卡尔曼滤波融合算法对视觉测量数据和光纤惯导数据进行融合。采用两者融合后的位姿数据对惯导累积误差进行补偿校正,对测量系统传感器的输出有效性进行判断,消除了惯导长时间积分运算导致的累积误差及视觉标靶短时遮挡、数据丢失对融合结果的影响,从而获得掘进机实时精确位姿数据。在实验室搭建实验平台,对视觉定位方法及组合定位方法进行评估,在60 m测量距离内,视觉定位最大位置误差在35 mm以内,最大姿态角误差在0.5°以内,组合定位位置误差在30 mm以内,定位结果更接近真实位移。同时在煤矿井下工业现场对掘进机视觉与惯导融合定位进行了试验,结果表明:视觉与惯导融合定位方法能够克服井下复杂工况影响,弥补了单一测量方法的不足,且掘进机机身定位误差在30 mm以内,姿态角误差在0.5°以内,满足巷道施工精度要求。

     

    Abstract: Aiming at the problem of low pose accuracy and poor measurement stability of roadheader caused by single position measurement method of roadheader in coal mine, a combined positioning method of roadheader based on machine vision and optical fiber inertial navigation is proposed. Taking the three-laser pointer fixed on the roof of the roadway as the characteristic target, a visual measurement system of the body pose of the roadheader based on the three-laser target is constructed. The airborne explosion-proof camera is used to collect the laser target, and the spot center position of the laser pointer is obtained by image processing. Combined with the visual measurement model of the body pose of the roadheader and the spatial coordinate transformation, the pose data of the roadheader are obtained. At the same time, the position and attitude information of the roadheader are obtained in real time by using the fiber optic inertial navigation installed on the roadheader fuselage. The Lagrange three-point interpolation method is used to register the visual pose data and the inertial pose data in time. After processing, the Kalman filter fusion algorithm is used to fuse the visual measurement data and the fiber optic inertial navigation data. The pose data after the fusion of the two is used to compensate and correct the cumulative error of the inertial navigation, and the output validity of the sensor of the measurement system is judged, which eliminates the cumulative error caused by the long-term integration operation of the inertial navigation and the short-term occlusion of the visual target and the influence of data loss on the fusion result, so as to obtain the real-time accurate pose data of the roadheader. The visual measurement platform of roadheader pose is built in the laboratory to evaluate the visual positioning method. Within the measurement distance of 60 m, the maximum position error is within 35 mm, and the maximum attitude angle error is within 0.5°. At the same time, the fusion positioning of vision and inertial navigation of roadheader was tested in the industrial field of underground coal mine. The results show that the fusion positioning method of vision and inertial navigation can overcome the influence of complex working conditions in underground mine and make up for the deficiency of single measurement method. The positioning error of roadheader body is within 30 mm, and the attitude angle error is within 0.5°, which meets the requirements of roadway construction accuracy.

     

/

返回文章
返回