基于迭代最近点的井下无人机实时位姿估计

王岩; 马宏伟; 王星; 杨林

doi:10.13272/j.issn.1671-251x.17441

基于迭代最近点的井下无人机实时位姿估计

王岩^{1, 2},
马宏伟^{1, 2},
王星³,
杨林^{1, 2}

1.
西安科技大学机械工程学院，陕西西安710054
2.
陕西省矿山机电装备智能监测重点实验室，陕西西安710054
3.
中煤能源研究院有限责任公司，陕西西安710054

基金项目:

国家自然科学基金项目（50674075）

陕西省科技统筹创新工程计划项目（2013KJTCL01-02）

详细信息

中图分类号: TD67
计量
- 文章访问数: 86
- HTML全文浏览量: 14
- PDF下载量: 18
出版历程
- 刊出日期: 2019-09-19

Real-time pose estimation of underground unmanned aerial vehicle based on ICP method

WANG Yan^{1, 2},
MA Hongwei^{1, 2},
WANG Xing³,
YANG Lin^{1, 2}

1.
College of Mechanical Engineering, Xi''an University of Science and Technology, Xi''an 710054, China
2.
Shaanxi Key Laboratory of Mine Electromechanical Equipment Intelligent Monitoring, Xi''an 710054, China
3.
China Coal Energy Research Institute Co., Ltd., Xi''an 710054, China

摘要

摘要: 针对煤矿井下无GPS信号、低照度、结构化环境等特点，提出了一种基于迭代最近点（ICP）的井下无人机实时位姿估计方法。通过建立四旋翼无人机运动模型与机载激光雷达观测模型，将煤矿井下四旋翼无人机位姿估计问题转换为机载激光点云数据的扫描匹配问题。用三维激光雷达作为四旋翼无人机机载环境测量传感器，得到无人机当前位姿下的观测点云数据；以第1帧位置为初始位，通过ICP方法得到连续2帧点云数据之间的相对变换矩阵，迭代求解连续关键帧点云数据，得到煤矿井下四旋翼无人机实时位姿估计结果。采用滤波与下采样方法对点云数据进行优化，加速变换矩阵的求解，满足四旋翼无人机位姿估计实时性需求。实验结果表明，基于ICP的井下无人机实时位姿估计方法能够快速、有效地求解四旋翼无人机位姿，相比于正态分布变换方法，ICP方法更适用于煤矿井下四旋翼无人机的实时位姿估计。
- 井下四旋翼无人机 /
- 位姿估计 /
- 迭代最近点 /
- 三维激光雷达 /
- 点云数据 /
- 变换矩阵
Abstract: In view of characteristics of no GPS signal, low illumination and structured environment in coal mine, a real-time pose estimation method for underground unmanned aerial vehicle (UAV) based on iterative closest point (ICP) was proposed. By establishing quadrotor UAV motion model and airborne laser radar observation model, the problem of position estimation of underground quadrotor UAV is converted into scanning matching problem of airborne laser point cloud data. 3D laser radar is used as airborne environment measurement sensor of quadrotor UAV, and observation point cloud data in current position of the UAV is obtained. Taking the first frame position as initial position,relative transformation matrix between two consecutive points of point cloud data is obtained by ICP method, and the continuous key frame point cloud data is solved iteratively to obtain the real-time pose estimation result of quadrotor UAV in underground coal mine.Filtering and downsampling methods are used to optimize point cloud data, and the solution of transformation matrix is accelerated to meet the real-time requirements of position estimation of quadrotor UAV. The experimental results show that the ICP-based real-time pose estimation method for underground UAV can quickly and effectively solve the pose of quadrotor UAV, and compared with normal distribution transform method, the ICP method is more suitable for real-time pose estimation of quadrotor UAV in underground coal mine.
- underground quadrotor UAV /
- pose estimation /
- iterative nearest point /
- 3D laser radar /
- point cloud data /
- transformation matrix

HTML全文

参考文献(0)

施引文献(14)

期刊类型引用(8)

1.	蒋水华，余琦，黄河，常志璐，孟京京. 岩质高边坡结构面识别及产状统计信息采集方法. 工矿自动化. 2024(07): 156-164 . 本站查看
2.	赵清，杨维，张立亚，胡青松. 灾后煤矿物联网无人机辅助节能数据采集方法. 煤炭科学技术. 2023(08): 228-238 . 百度学术
3.	高海跃，王凯，王保兵，王丹丹. 基于全局点云地图的煤矿井下无人机定位方法. 工矿自动化. 2023(08): 81-87+133 . 本站查看
4.	郭爱军，王妙云，马宏伟，张旭辉，薛旭升，杜昱阳，张超. 煤矿井下多旋翼飞行器避障控制方法研究. 工矿自动化. 2022(12): 93-100 . 本站查看
5.	侯刚. 煤矿无人机智能系统设计与实现. 煤炭工程. 2021(02): 19-23 . 百度学术
6.	张力，马宏伟，梁艳，薛旭升. 煤矿四旋翼巡检机器人系统设计. 煤炭工程. 2021(02): 180-185 . 百度学术
7.	张瑞宾，郭应时，陈元华，刘晓刚，周扬. 基于激光雷达点法向量的车辆实时位姿估计. 汽车技术. 2021(05): 36-40 . 百度学术
8.	马宏伟，聂珍，王川伟，薛旭升，夏晶. 煤矿机器人关键共性技术与发展策略. 智能矿山. 2020(01): 63-70 . 百度学术

其他类型引用(6)

资源附件(0)

计量

文章访问数: 86
HTML全文浏览量: 14
PDF下载量: 18
被引次数: 14

基于迭代最近点的井下无人机实时位姿估计

计量

出版历程

Real-time pose estimation of underground unmanned aerial vehicle based on ICP method

期刊类型引用(8)

其他类型引用(6)

计量

出版历程

目录