ISSN 1009-5624 CN 10-2021/TQ    主管:中国乐凯集团有限公司    主办:北京乐凯科技有限公司

中国知网全文收录期刊
万方数据库收录期刊
RCCSE中文学术期刊
维普资讯网/超星域出版 全文收录
中国核心期刊(遴选)数据库收录期刊
首页 > 刊期 > 2023 > 6期 > 综合:探索与发现
基于 QUKF 的随钻测斜仪姿态估计算法研究
王 波,吕勇杰,李相龙

【摘要】针对煤矿井下随钻测斜仪测量钻孔姿态角时,传感器容易受到外界干扰,引起解算姿态角误差的问题,本文采用一种基于四元数无迹卡尔曼滤波(quaternion unscented Kalman filter,QUKF)的姿态估计算法减小误差。首先通过四元数微分方程结合陀螺仪输出以及噪声误差,构建无迹卡尔曼滤波(unscented Kalman filter,UKF)状态方程;然后利用加速度计和磁强计的输出结合噪声误差作为观测值,构建量测方程;最后将迭代得到的四元数通过姿态旋转矩阵解算姿态角。通过 MATLAB 仿真以及双轴转台实验验证该估计算法,实验中经过该算法解算的俯仰角和方位角最大绝对误差均小于 0.7°。实验表明,该算法可以有效减小随钻测斜仪测量姿态角时受到外界干扰的影响,提高测量精度。


【关键字】随钻测斜仪;四元数;无迹卡尔曼滤波;姿态角