[发明专利]适用于小角度井斜角测量的陀螺测斜仪姿态测量解算方法

说明书

技术领域

本发明涉及陀螺测斜仪姿态提取技术，具体是一种适用于小角度井斜角测量的陀螺测斜仪姿态测量解算方法。

背景技术

陀螺测斜仪主要用于油田生产、矿产勘探中的钻井轨迹测量，其通过加速度计测量钻孔俯仰角和横滚角，利用陀螺仪测量钻孔方位角，由此确定钻孔姿态，便于工程作业人员及时调整钻头，以避免因钻孔盲目性而造成事故，并为井下找孔、旧井及老井的二次开发带来了极大的便利。现有陀螺测斜仪在测量钻孔的大角度井斜角时（井斜角，定义为测斜仪纵轴线与井眼轴线之间的夹角, 井斜角与俯仰角是互为余角关系，它反映井眼的倾斜程度），测量精度通常比较高，但在测量小角度井斜角时，普遍存在方位角和横滚角测量精度差的问题。究其原因，除了有惯性器件本身精度，还有是姿态提取方法的存在的问题。如采用目前所用的姿态角提取方法，在小井斜角测井时，方位角和横滚角的提取计算公式中分子分母都将同时趋于零，使得方位角和横滚角的计算变得不确定，这种情况在测井越接近垂直状态时变得愈发严重，甚至无法正确分辨方位角和横滚角。基于此，有必要发明一种全新的陀螺测斜仪姿态提取方法，以解决现有陀螺测斜仪在小井斜角测量时因姿态提取方法导致方位角和横滚角测量精度差的问题。

发明内容

本发明为了解决现有陀螺测斜仪在小井斜角测量时因姿态提取方法导致方位角和横滚角测量精度差的问题，提供了一种适用于小角度井斜角测量的陀螺测斜仪姿态测量解算方法。

本发明是采用如下技术方案实现的：适用于小角度井斜角测量的陀螺测斜仪姿态测量解算方法，该方法是采用如下步骤实现的：1）采用三轴陀螺仪、三轴加速度计和相应的电子线路组成陀螺测斜仪，并确定陀螺测斜仪的载体坐标系和导航坐标系；2）选取陀螺测斜仪的工作方式，并根据陀螺测斜仪的工作方式选取相应的姿态变换矩阵求解方法，求取姿态变换矩阵；3）通过求取的姿态变换矩阵提取陀螺测斜仪的姿态所对应的俯仰角，根据俯仰角和井斜角之间的关系计算出井斜角，并判断井斜角是否为小角度井斜角；4）若井斜角是小角度井斜角，则利用安装在陀螺测斜仪纵轴方向的陀螺仪作为辅助测量解算出陀螺测斜仪的姿态所对应的横滚角，并利用陀螺测斜仪的姿态所对应的方位角和横滚角之间的关系提取方位角，以此完成陀螺测斜仪的三个姿态角的解算；若井斜角是大角度井斜角，则按大井斜状态完成陀螺测斜仪的三个姿态角的解算。

所述步骤1）中，陀螺测斜仪的三轴陀螺仪用来敏感各轴向角速率分量，三轴加速度计用来敏感各轴向加速度，通过三轴陀螺仪和三轴加速度计的输出值来解算陀螺测斜仪的姿态（即钻井的姿态）。在表示陀螺测斜仪的姿态时，陀螺测斜仪采用北东地                                                地理坐标系为导航坐标系，用表示。陀螺测斜仪载体坐标系三轴分别指向载体的前部、右部和下部，用表示。其中、、为三轴加速度计和三轴陀螺仪的敏感轴方向。导航坐标系到陀螺测斜仪载体坐标系的变换矩阵可通过如下坐标系三次旋转得到，即：

 ；

上式中：为导航坐标系，、为坐标系变换过程中间坐标系，为陀螺测斜仪载体坐标系，为方位角，为俯仰角，为横滚角，则导航坐标系到陀螺测斜仪载体坐标系的变换矩阵为：

  （1）。

所述步骤2）中，陀螺测斜仪的工作方式可选取静态测量方式或随钻测量方式；当陀螺测斜仪的工作方式选取静态测量方式时，姿态变换矩阵求解方法采用kalman滤波初始对准方法；当陀螺测斜仪的工作方式选取随钻测量方式时，姿态变换矩阵求解方法采用kalman滤波初始对准方法和四子样等效旋转矢量算法。陀螺测斜仪载体坐标系到导航坐标系的姿态变换矩阵定义为：

                                           （2）；

又因为，则：

 （3）；

比较式（2）和式（3）所表达的矩阵元素之间的关系可推导得到姿态角提取公式为：

                                              （4）；

式（1）-（4）中：为俯仰角，为方位角，为横滚角。

所述步骤3）中，根据式（4）提取俯仰角，井斜角与俯仰角互余。

所述步骤4）中，在小角度井斜角时，若利用式（4）提取陀螺测斜仪的姿态角，方位角和横滚角会出现较大的提取误差，方位角和横滚角的姿态提取公式中，、、和也将同时趋于0，使得方位角和横滚角的计算变得不确定，甚至根本无法正确分辨和。