一种基于互补滤波的钻具重力加速度提取方法
摘要:
本发明提供一种基于互补滤波的钻具重力加速度提取方法,首先通过余弦矩阵微分方程得到基于陀螺仪的重力加速度的递推方程,然后利用陀螺仪和加速度计在频率上互补的特性,在互补滤波框架下融合得到钻具重力加速度;同时,为了提高系统鲁棒性,利用非重力加速度和钻具旋转速度作为模糊算法输入,通过模糊算法动态调整互补滤波参数。该重力加速度提取方法,解决了旋转导向钻井过程中,由于钻具的高速旋转、剧烈振动和冲击给随钻姿态测量带来巨大干扰的问题。
公开/授权文献
0/0