单春艳, 杨维, 耿翠博. 面向井下无人机自主飞行的人工路标辅助位姿估计方法[J]. 煤炭学报, 2019, 44(S1): 387-398. DOI: 10.13225/j.cnki.jccs.2018.1479
引用本文: 单春艳, 杨维, 耿翠博. 面向井下无人机自主飞行的人工路标辅助位姿估计方法[J]. 煤炭学报, 2019, 44(S1): 387-398. DOI: 10.13225/j.cnki.jccs.2018.1479
SHAN Chunyan, YANG Wei, GENG Cuibo. Pose estimation method based on artificial landmarks for the autonomous flight of underground UAVs[J]. Journal of China Coal Society, 2019, 44(S1): 387-398. DOI: 10.13225/j.cnki.jccs.2018.1479
Citation: SHAN Chunyan, YANG Wei, GENG Cuibo. Pose estimation method based on artificial landmarks for the autonomous flight of underground UAVs[J]. Journal of China Coal Society, 2019, 44(S1): 387-398. DOI: 10.13225/j.cnki.jccs.2018.1479

面向井下无人机自主飞行的人工路标辅助位姿估计方法

Pose estimation method based on artificial landmarks for the autonomous flight of underground UAVs

  • 摘要: 具有体积小、重量轻、机动性能好等优点的无人机将在未来少人或无人采矿中发挥重要作用,而位姿估计则是井下无人机实现自主飞行的关键。面向井下无人机自主飞行的位姿估计,针对空直或弯曲度较小的巷道环境,提出采用相同形制沿矿井巷道壁两侧成对平行部置的反光标识牌作为人工路标,辅助井下无人机进行位姿估计。为了实现无人机在无GPS的矿井环境下自主飞行,针对井下作业环境昏暗的特点,提出巷道中的单目摄像机采用视觉注意机制提取反光标识牌的轮廓。为减少计算量,用几何的方法代替常规的代数方法,可避免传统特征点法求解位置和姿态参数对每帧图像都要进行复杂的非线性解算过程。根据巷道中的单目摄像机中心点与4个相邻反光标识牌及其投影点之间的几何关系,以反光标识牌的世界坐标和像素坐标作为输入,利用单目摄像机中心点与任意3个反光标识牌所围四面体的体积,采用几何方法推导出4个反光标识牌在相机坐标系下的坐标。根据反光标识牌已知的世界坐标与求得的反光标识牌相机坐标之间的转换关系,利用奇异值分解的方法进一步求出两坐标系之间的转换参数即旋转矩阵与平移矩阵,从而实现空直或弯曲度较小巷道中无人机的位姿估计。在走廊中模拟矿井空直或弯曲度较小巷道的实验结果表明,采用所提出的面向井下无人机位姿估计方法,对巷道中的单目摄像机的位置估计平均误差为0.076 m,角度估计平均误差为1.74°,且单帧算法的解算速度仅为0.013 s,可以提高无人机位姿估计的实时性。

     

    Abstract: UAVs (Unmanned Aerial Vehicles) with small size, light weight and good maneuverability will play a significant role on the unmanned coal mining in the future, and the pose estimation is the key to the au-tonomous flight of underground UAVs.Aiming at the pose estimation of underground UAVs autonomous flight along straight or lower curved tunnel, the reflective tags with the same shape, which are deployed in pairs along both sides of the underground roadway wall in parallel, are proposed as the artificial landmarks to assist underground UAVs in pose estimation.In order to realize the autonomous flight of UAVs in the mine environment without GPS, considering the somber characteristics in underground coal mine, it is proposed that the monocular camera in the mine roadway adopts visual attention mechanism to extract the outline of the reflective tags.In order to reduce the amount of calculation, the conventional algebraic method is replaced with geometric methods.It will avoid a complicated nonlinear solution for every frame of image in the calculation process of solving the position and attitude parameters by the traditional feature point method.According to the geometrical relationship between the lens center of the monocular camera and four adjacent reflective tags as well as their projection points, taking the world coordinates and pixel coordinates of the reflective tags as input, based on the volume measurement of tetrahedral composed of any three of the four adjacent reflective tags and the lens center of the monocular camera, the coordinates of four reflective tags in the camera coordinate system are derived with a geometrical method.According to the transformation relation between the known world coordinates and the obtained camera coordinates of the reflective tags, the transformation parameters between two coordinate systems, i.e.rotation matrix and translation matrix, are obtained with the singular value decomposition (SVD) method, which provides the pose estimation of UAVs in straight or lower curved mine roadway.The experiment results along corridor to simulate straight or lower curved mine roadway show that the average location error is around 0.076 m, and the average angle error is about 1.74° with the proposed estimation algorithms for underground UAVs, and the single-frame computing time is only 0.013 s which will improve the instantaneity of pose estimation of underground UAVs.

     

/

返回文章
返回