基于加速度计和磁强计的随钻姿态测量观测模型

摘要： 水平定向钻进中钻具姿态的实时测量是实现导向的关键因素。推导了钻具姿态角的测量方法,给出了姿态转换矩阵的解算公式。针对姿态测量的非线性问题和已有算法的不足,建立了姿态测量系统的线性观测方程,该观测方程利用加速度计和磁强计分别测得的地球重力场分量和地磁场分量来构造新的观测向量,并以姿态四元数的误差向量作为观测模型的输入。给出了线性观测模型的求解方法,最小二乘递推法。仿真结果表明:该算法收敛速度快,能够得到钻具准确的姿态信息,即使起始姿态的估计值与真实值之间的偏差很大,该算法仍能很好地收敛到真实值。 （共5页）