基于非完整测量向量的航姿解算方法

技术领域

本发明涉及航姿解算技术领域，尤其涉及基于非完整测量向量的航姿解算方法。

背景技术

在石油定向钻井过程中需要检测井眼轨迹，以确保按预定轨迹向预定目标点钻进。检测井眼轨迹需要在多点进行航姿解算，航姿参数包括坐标变换矩阵、欧拉角、四元数等，它描述了物体坐标系在某一参考坐标系中的角位置。检测井眼轨迹时的航姿解算是指利用装载于钻柱测量单元的加速度计以及磁传感器测量重力加速度向量以及地磁向量，并利用向量测量值解算得到一组欧拉角。

向量法是一种基本航姿解算方法。它利用空间向量在参考坐标系与物体坐标系中坐标值计算航姿参数。空间向量在参考坐标系中坐标值是已知的，因此向量在物体坐标系中的测量效果是影响向量法应用的关键。在一些应用中，环境对测量造成的干扰以及传感器故障会导致向量测量值的一个或多个分量严重失真，不能用于航姿解算，造成测量向量不完整，从而使传统向量法无法使用。因此，解决非完整测量向量条件下航姿解算问题具有重要的实际意义。针对这一问题，文献1（范光第，蒲文学，赵国山.磁力随钻测斜仪轴向磁干扰校正方法[J]. 石油钻探技术,2017,45(4):121-126.）利用模值约束估计缺失分量进而完成航姿解算，这种方法不能确定航姿参数唯一解，且只能用于缺失一个分量的情况。文献2（SOO Y B, SUNG H M, HYUNWOOK W. Sensor-fault tolerant attitude determinationusing two-stage estimator[J]. Advances in Space Research, 2019, 63, 3632-3645.）利用陀螺测量信息复原向量测量缺失信息，这种方法需要使用陀螺传感器，一方面增加了应用成本，另一方面陀螺测得的角速度信息仅含有相对航姿信息且存在累积误差，不宜长时间使用。

为解决上述问题，本发明提出基于非完整测量向量的航姿解算方法；本发明提供了一种仅使用加速度计及磁传感器测量信息，在重力加速度向量或地磁向量测量分量缺失条件下实现航姿解算的方法， 该方法可用于测量向量缺失一个或两个分量的情况，且具有成本低、计算简单、实用性强的优点。

发明内容

为解决上述问题，本发明提供了基于非完整测量向量的航姿解算方法，包括以下方法步骤：设重力加速度向量a在参考坐标系中的坐标值为：a

计算物体坐标系中对应的单位正交基向量b

最后计算坐标变换矩阵

将

式中

当传感器故障或干扰造成a

其中，符号

所述重力加速度向量与地磁向量在航姿解算过程中具有对等的计算关系，且同一向量的不同分量也具有对等的计算关系。

假设m

将m

将m

设

式（16）无法唯一确定

上式中sign为符号函数，其功能是取得自变量的符号；

首先判断式（18）中根号下取值是否为负，若为负数说明干扰或测量误差影响较大，不能求解；

若能求解则将a

当m

由式（14）、（15）构成方程组，m

式中

注意式（22）中出现未知量，不能求解计算但可用于理论分析；

由式(22)可知判别式的理论值为非负数，采取以下两项措施构建缺失分量的实用解算方法：第一，设置一负数阈值T

优选的，当a

优选的，当地磁向量测量估计值处于由a

优选的，所述重力加速度向量和所述地磁向量任意一个或两个分量缺失的情况下，均适用于航姿解算方法进行计算。

本发明的上述技术方案具有如下有益的技术效果：

1、本发明不仅可以在缺失一个分量情况下使用，还可处理缺失两个分量的情况，且在多数应用条件下可将解的数量限定为至多两组，特别是在一些情况下可求得唯一解;

2、本发明对航姿解算存在唯一解、两组解、无法求解及干扰或误差过大造成不能求解的情况进行区分可以给出全面的求解分析，有效提升解算方法的实用性，并便于与其它方法结合使用;

3、本发明航姿解算仅使用向量传感器数据不需要陀螺仪等其它传感器，且计算过程不包含迭代运算，这使得解算方法的实施成本低且计算过程耗时短。

附图说明

图1为m

图2为m

具体实施方式

为使本发明的目的、技术方案和优点更加清楚明了，下面结合具体实施方式并参照附图，对本发明进一步详细说明。应该理解，这些描述只是示例性的，而并非要限制本发明的范围。此外，在以下说明中，省略了对公知结构和技术的描述，以避免不必要地混淆本发明的概念。

如图1-2所示，本发明提出的基于非完整测量向量的航姿解算方法，设重力加速度向量a在参考坐标系中的坐标值为：a

首先计算参考坐标系中的一组单位正交基向量r

然后计算物体坐标系中对应的单位正交基向量b

最后计算坐标变换矩阵

将

式中

当传感器故障或干扰造成a

其中，符号

本发明给出了缺失一个及两个分量情况下的航姿解算方法，在下文中将针对m

1、缺失一个分量的情况

假设m

将m

将m

设

式（16）无法唯一确定

上式中sign为符号函数，其功能是取得自变量的符号。在应用中上述做法仍存在缺陷。首先，由于受到干扰或测量误差影响，式（18）中根号下取值可能为负；其次，理论上当a

由上述方法可知，当a

2、缺失两个分量的情况

假设m

由式（14）、（15）构成方程组，m

式中△为二次方程根的判别式，为进一步分析解的情况，将向量分量代入式（21）可得：

注意式（22）中出现未知量，不能求解计算但可用于理论分析。

由式(22)可知判别式的理论值为非负数，但在应用中受到干扰或测量误差影响，判别式的计算值可能为负值。此外，由式（19）至式（22）可知：在理论上，当a

图2中，

为验证上述航姿解算方法的效果，给出计算实例，基本过程是：首先应用完整向量测量数据进行航姿解算，得到欧拉角参考值，然后去除磁传感器测量数据中的相关分量，采用本发明方法进行航姿解算，得到欧拉角的解算值，最后对欧拉角参考值与解算值进行对比。实验中参考坐标系为东北天坐标系，物体坐标系为传感器坐标系，设置阈值

实施例1

在参考坐标系下a

去除m

（1）m

（2）由式（18）可得

（3）a

（4）由式（1）至式（10）可得航向角解算值为：65.93度，俯仰角解算值为：29.64度，横滚角解算值为：-11.61度。

对比参考值与解算值可知，航向角误差为0.08度，俯仰角与横滚角误差为0度。

实施例2

在参考坐标系下a

去除m

（1）m

（2）由式（18）可得

（3）abz=0.12，因为|abz|

（4）由式（1）至式（10）并分别使用以上两个地磁测量向量的估计值可得第一组解航向角解算值为：54.58度，俯仰角解算值为：-15.53度，横滚角解算值为：-89.27度；第二组解航向角解算值为：137.03度，俯仰角解算值为：-15.53度，横滚角解算值为：-89.27度。

对比参考值与解算值可知，第一组解与参考值对应，其航向角误差为0.11度，俯仰角与横滚角误差为0度。

实施例3

在参考坐标系下a

去除m

（1）由式（21）可得△=1.1446×10

（2）a

（3）对△取绝对值

（4）由式（19）、（20）可得

（5）构建地磁测量向量的估计值 [-34476,40263,2496]

（6）由式（1）至式（10）并分别使用以上两个地磁测量向量的估计值可得第一组解航向角解算值为：121.11度，俯仰角解算值为：-73.39度，横滚角解算值为：-110.96度；第二组解航向角解算值为：72.98度，俯仰角解算值为：-73.39度，横滚角解算值为：-110.96度

对比参考值与解算值可知，第二组解与参考值对应，其航向角误差为1.32度，俯仰角与横滚角误差为0度。

本发明具有以下技术效果：

1、同时采用模值约束与点积约束条件估计缺失分量值，提供了一种在非完整测量向量条件下进行航姿解算的新技术方案。该方案不仅可以在缺失一个分量情况下使用，还可处理缺失两个分量的情况，且在多数应用条件下可将解的数量限定为至多两组，特别是在一些情况下可求得唯一解;

2、对航姿解算存在唯一解、两组解、无法求解及干扰或误差过大造成不能求解的情况进行区分可以给出全面的求解分析，有效提升解算方法的实用性，并便于与其它方法结合使用;

3、航姿解算仅使用向量传感器数据不需要陀螺仪等其它传感器，且计算过程不包含迭代运算。这使得解算方法的实施成本低且计算过程耗时短。

以上显示和描述了本发明的基本原理、主要特征和本发明的优点。本行业的技术人员应该了解，本发明不受上述实施例的限制，上述实施例和说明书中描述的仅为本发明的优选例，并不用来限制本发明，在不脱离本发明精神和范围的前提下，本发明还会有各种变化和改进，这些变化和改进都落入要求保护的本发明范围内。