本发明属于石油钻井工程技术领域，特别涉及基于多传感器数据融合的钻具姿态测量系统的测量方法。
背景技术：
随着石油工业的不断发展和开采形势的异常严峻，目前采用提高采收率、开采难采/难动用储量，开发石油剩余资源和低渗、超薄、稠油和超稠油等特殊经济边际油藏，以及页岩气、煤层气等稀缺资源；以深井/超深井垂直钻井开发深部地层和深水海域。导向钻井技术是解决上述问题的重要手段。
井下动态姿态参数(井斜角、方位角和工具面角)的实时测量是导向钻井工具能够实现实时导向控制的前提条件。因此，在钻井工程中，对井下姿态参数测量的实时性、精确性以及连续、动态测量的要求越来越高。然而井下钻具近钻头由于直接承受钻头破岩时所产生的强烈振动及钻柱旋转振动，使得传感器输出信号混杂大量的干扰和噪声，导致姿态参数测量不准。
国内外导向钻井工具姿态参数测量大多采用静态测量方法，即钻具不旋转、不振动情况下，进行姿态参数测量。目前主要是借鉴惯性测量技术和地磁场，采用三轴加速度计或三轴磁强计单独完成，或两者简单组合，三个加速度计测量地球的重力场分量，三个磁强计测量地球的地磁场分量。该方法虽然能够满足姿态测量精度的要求，但是以牺牲成本和钻井时效，换取姿态测量精度，或者借用惯性测量技术，基于地磁场或者陀螺仪，对传感器进行简单组合测量，受近钻头影响，传感器输出误差较大，导致测量不准确甚至不可测。
技术实现要素：
本发明的目的在于提供基于多传感器数据融合的钻具姿态测量系统的测量方法，以解决上述问题。
为实现上述目的，本发明采用以下技术方案：
基于多传感器数据融合的钻具姿态测量系统的测量方法，其中基于多传感器数据融合的钻具动态姿态测量系统包括钻具、三轴加速度计、三轴磁通门、角速率陀螺仪和局部滤波器；三轴加速度计、三轴磁通门和角速率陀螺仪均安装在钻具上，三轴加速度计、三轴磁通门和角速率陀螺仪分别安装有局部滤波器；基于多传感器数据融合的钻具动态姿态测量系统的测量方法包括以下步骤：
步骤一：在姿态测量系统中建立理想正交的地理坐标系，根据欧拉定理，井下钻进过程中，钻具在空间的任一姿态可以用相对于地理坐标系的一系列旋转来表示，旋转的角度为井斜角、方位角和工具面角；根据四元数的定义和欧拉定理，把三维空间和四维空间联系起来，用四维空间的四元数性质和运算规则研究三维空间中的刚体定点转动问题；
步骤二：针对钻具安装三轴加速度计、三轴磁通门和角速率陀螺仪，实现导向钻井工具姿态组合测量，联合建立多传感器、动态测量系统的非线性数学模型，得到非线性状态方程和量测方程；
步骤三：根据近钻头振动信号特性，判断钻具运动状态，分析钻具运动状态与振动加速度之间的关系以及钻具振动的主要干扰因素；根据模型及噪声特性，分别采用局部滤波器，利用无迹卡尔曼滤波算法对干扰信号进行滤除，消除近钻头强振动对姿态参数测量的影响，采用数据融合理论进行全局估计，进而得到最优姿态估计；
步骤四：利用最优姿态估计，将滤波后的传感器参数进行姿态动态解算，从而得到滤波后的导向钻井工具精确的姿态参数。
进一步的，步骤三中局部滤波消除近钻头强振动对动态姿态测量的影响包括以下步骤：
步骤1：对基于四元数的状态方程和量测方程进行离散化；
步骤2：在第一层中，三轴加速度信号、三轴磁通门信号和角速率陀螺信号分别通过三个局部滤波器，分别为第一局部滤波器、第二局部滤波器和第三局部滤波器，以并行的方式获得其局部最优状态估计值
步骤3：在第二层中，应用矩阵加权数据融合算法对得到的局部状态估计值进行融合，获得系统状态的全局最优估计；假设第一局部滤波器和第二局部滤波器得到的状态估值为
系统状态的全局最优状态估计为
局部状态估值
步骤4：根据融合局部状态估值，进而求取强振动旋转钻具系统全局最优状态估计的方法；设n个局部滤波器得到的状态估值分别为
其中，wi(i＝1,2,...,n)为最优权值矩阵，可通过下式计算
进一步的，姿态参数动态提取，在第三层中，根据地理坐标系到钻具坐标系进行坐标转换后，可得井斜角θ和工具面角φ：
根据式(5)，将滤波后得到的全局最优估计值通过钻具姿态解算，得到导向钻井工具动态姿态参数。
进一步的，所述地理坐标系为东北天坐标系，其旋转正方向由右手定则决定。
与现有技术相比，本发明有以下技术效果：
本发明基于多自由度姿态传感器的建模与矩阵加权多传感器数据融合技术，首次采用三轴加速度计、三轴磁通门和角速率陀螺仪三个传感器参数采用并行处理方式进行局部滤波，然后对多传感器测量参数采用数据融合，得到全局最优估计。近钻头强振动信号特征分析与姿态信息提取技术，通过判断导向钻井工具近钻头运动状态，针对近钻头对动态姿态测量的影响，消除干扰，实现姿态测量信息精确提取。
本发明提出的矩阵加权数据融合算法无需对局部状态估计进行处理，克服了标准ukf算法的缺陷，且无需通过全局状态估计对局部滤波器进行重置，因此具有较强的容错性。
附图说明
图1是本发明中基于矩阵加权多传感器数据融合的强振动旋转钻具动态测量系统结构图。
图2是地理坐标系和钻具坐标系下的姿态角。
附图2中：h为水平面，v为钻孔弯曲平面，p代表钻具横截面。ψ为方位角，θ为井斜角，φ为工具面角。“e-n-u”代表“东北天”。xyz为钻具坐标系。
具体实施方式
以下结合附图对本发明进一步说明：
请参阅图1和图2，基于多传感器数据融合的钻具姿态测量系统的测量方法，其中基于多传感器数据融合的钻具动态姿态测量系统包括钻具、三轴加速度计、三轴磁通门、角速率陀螺仪和局部滤波器；三轴加速度计、三轴磁通门和角速率陀螺仪均安装在钻具上，三轴加速度计、三轴磁通门和角速率陀螺仪分别安装有局部滤波器；基于多传感器数据融合的钻具动态姿态测量系统的测量方法包括以下步骤：
步骤一：在姿态测量系统中建立理想正交的地理坐标系，根据欧拉定理，井下钻进过程中，钻具在空间的任一姿态可以用相对于地理坐标系的一系列旋转来表示，旋转的角度为井斜角、方位角和工具面角；根据四元数的定义和欧拉定理，把三维空间和四维空间联系起来，用四维空间的四元数性质和运算规则研究三维空间中的刚体定点转动问题；
步骤二：针对钻具安装三轴加速度计、三轴磁通门和角速率陀螺仪，实现导向钻井工具姿态组合测量，联合建立多传感器、动态测量系统的非线性数学模型，得到非线性状态方程和量测方程；
步骤三：根据近钻头振动信号特性，判断钻具运动状态，分析钻具运动状态与振动加速度之间的关系以及钻具振动的主要干扰因素；根据模型及噪声特性，分别采用局部滤波器，利用无迹卡尔曼滤波算法对干扰信号进行滤除，消除近钻头强振动对姿态参数测量的影响，采用数据融合理论进行全局估计，进而得到最优姿态估计；
步骤四：利用最优姿态估计，将滤波后的传感器参数进行姿态动态解算，从而得到滤波后的导向钻井工具精确的姿态参数。
步骤三中局部滤波消除近钻头强振动对动态姿态测量的影响包括以下步骤：
步骤1：对基于四元数的状态方程和量测方程进行离散化；
步骤2：在第一层中，三轴加速度信号、三轴磁通门信号和角速率陀螺信号分别通过三个局部滤波器，分别为第一局部滤波器、第二局部滤波器和第三局部滤波器，以并行的方式获得其局部最优状态估计值
步骤3：在第二层中，应用矩阵加权数据融合算法对得到的局部状态估计值进行融合，获得系统状态的全局最优估计；假设第一局部滤波器和第二局部滤波器得到的状态估值为
系统状态的全局最优状态估计为
局部状态估值
步骤4：根据融合局部状态估值，进而求取强振动旋转钻具系统全局最优状态估计的方法；设n个局部滤波器得到的状态估值分别为
其中，wi(i＝1,2,...,n)为最优权值矩阵，可通过下式计算
姿态参数动态提取，在第三层中，根据地理坐标系到钻具坐标系进行坐标转换后，可得井斜角θ和工具面角φ：
根据式(5)，将滤波后得到的全局最优估计值通过钻具姿态解算，得到导向钻井工具动态姿态参数。
所述地理坐标系为东北天坐标系，其旋转正方向由右手定则决定。