CN110887472B - 一种偏振-地磁信息深度融合全自主姿态解算方法 - Google Patents

Abstract

本发明涉及一种偏振‑地磁信息深度融合全自主姿态解算方法。首先利用偏振传感器获取天空偏振场信息，根据信息传递关系解算机体系下的太阳矢量，通过运动体的位置、时间信息，参考天文年历解算导航系下的太阳矢量；其次，利用三轴磁力计获取机体系下地磁矢量，并且从世界地磁模型中解算出导航系下地磁矢量；再次，结合已有信息分别构建机体系下的二阶方位张量和导航系下的二阶方位张量；最终，通过两坐标系下二阶方位张量的姿态转换关系即可解得姿态转换矩阵和运动体任一时刻的航向角和姿态角。使用天然物理矢量场作为信息源，具有稳定性、自主性、隐蔽性和误差不累积的优点。同时，本方法计算量小，传感器成本低，易实现应用。

Description

一种偏振-地磁信息深度融合全自主姿态解算方法

技术领域

本发明涉及一种偏振-地磁信息深度融合全自主姿态解算方法，该方法通过结合大气偏振矢量场信息和地磁矢量场信息，实现了运动体在GNSS拒止或失效条件下，全自主的解算航向角和姿态角。属于运动体导航中的定姿定向领域。

背景技术

目前，全球导航卫星系统GNSS是多领域普遍使用的导航方式，但其通信信号易被干扰、遮挡，甚至篡改，可靠性差，惯性导航及惯导作为主体的组合导航是最常用的全自主导航方式，存在误差累积的原理性不足，因此，GNSS拒止或失效条件下，全自主地准确获取运动体的航向角和姿态角成为一个关键问题。偏振导航启发于沙蚁、帝王蝶等生物眼睛的巧妙结构，太阳光经过大气散射形成含有丰富方位信息的偏振分布场，运动体通过获取天空偏振光信息，可实现姿态和航向的精确解算。地磁导航作为最常用的地球物理场导航方式，利用地磁场固有的地磁矢量场分布信息，可为运动体提供姿态和航向的可靠参考。现有研究中对二者信息的利用，都是简单的作为量测量来补偿惯导误差，在运动体长时间运行时，导航解算效果不佳。

现有研究中，例如，卢鸿谦等发表的论文“偏振光/地磁/GPS/SINS组合导航方法”和范之国等发表的论文“利用偏振光，地磁，GPS进行多信息源融合导航方法的研究与实现”，导航解算中对GPS有很大的依赖性，无法实现运动体的自主导航解算。现有专利中，例如，申请中的中国专利(201510312112.5)“一种双模式仿生偏振/地磁辅助组合导航系统”和中国授权专利(ZL201410628075.4)“一种基于偏振光传感器的航姿测定方法”，进行全自主导航信息解算时，只是简单地将偏振信息、地磁信息作为量测信息，通过与惯导输出量的差值从而修正惯导误差，这种松组合模式下，没有实现对偏振和地磁信息的深度融合与利用，只是基于量测信息的统计意义对惯导信息修正，修正量有限，不能达到很好的解算精度和导航效果，机动条件下加速度计被影响，导航系统极可能失效。申请中的中国专利(201811336222.5)“一种基于偏振-地磁矢量紧组合的导航方法”，以姿态角误差为状态量，通过对偏振量测方程与地磁量测方程进行叉乘实现偏振和地磁的深融合，再将融合信息与惯导信息联合解算姿态角和航向角，其在融合过程中为简化舍去了高阶小角度量，这样使得精度有所损失，并且，该融合方法不可直接由偏振/地磁融合信息解算得到姿态角和航向角。由此可分析，在GNSS拒止或失效条件下，全自主导航解算主要还是依赖惯导为主体的组合导航方法，现有方法对偏振和地磁信息没有实现充分利用。

发明内容

本发明提出了一种偏振-地磁信息深度融合全自主姿态解算方法。通过构建二阶方位张量，用一种全新的融合方式对偏振信息和地磁信息进行深度融合，算法简单，并且可直接从二者融合信息中解算求取绝对姿态角和航向角，实现了在GNSS拒止或失效条件下，运动体的全自主的航向和姿态解算。由于二者的矢量分布规律均不受运动体的运动状态改变的影响，具有很好的稳定性、可靠性、隐蔽性和误差不累积的优势，对于运动体机动条件下的全自主航向和姿态的解算也有很好的适用性。

本发明解决上述技术问题采用的技术方案为：一种偏振-地磁信息深度融合全自主姿态解算方法，包括如下步骤：

步骤(1)、利用运动体上安装的偏振传感器获取天空偏振场信息，通过偏振矢量p与太阳矢量s^*b的信息传递关系，解算机体系下的太阳矢量s^*b并进行单位化得s^b，结合运动体当地位置及时间，确定导航系下的太阳矢量sⁿ；所述机体系是指以运动体为参考建立的坐标系；

步骤(2)、通过三轴磁力计测量并解算，得到机体系下的地磁矢量m^b，参考世界地磁模型WMM求解导航系下地磁矢量mⁿ，对m^b和mⁿ进行单位化得到

和

提取两坐标系下的地磁矢量的角度信息；

步骤(3)、结合前两步骤得到的矢量，通过符号公式：

消除步骤(1)中机体系下太阳矢量s^b的二义性得到

步骤(4)、根据矢量叉乘运算法则，联合机体系下单位化的地磁矢量

和太阳矢量

建立机体系下的二阶方位张量F^b；在导航系下，基于太阳矢量sⁿ和单位化的地磁矢量

融合，构建导航系下的二阶方位张量Fⁿ；

步骤(5)、通过姿态转换关系建立F^b与Fⁿ的信息传递关系：

结合步骤(3)和(4)得到的F^b及Fⁿ，反演解算姿态转换矩阵

得到运动体的航向角ψ和姿态角θ,γ。

进一步的，所述步骤(1)的利用偏振传感器获取天空偏振场信息，通过偏振矢量p与太阳矢量s^*b的信息传递关系，解算机体系下的太阳矢量s^*b并进行单位化得s^b，结合运动体当地位置及时间，确定导航系下的太阳矢量sⁿ，具体要求如下：

通过偏振传感器获取两个不同方向d_i,d_j的偏振角α_i,α_j，方向矢量d_i,d_j在传感器坐标系中表示为(μ_iν_i)和(μ_jν_j)，其中，μ_i,μ_j为传感器坐标系中的天顶角，ν_i,ν_j为传感器坐标系中的方位角，即与x轴顺时针夹角，那么d_i,d_j两方向上的偏振矢量p_i,p_j表示为：

p_i＝[sinμ_icosν_i-sinμ_isinν_i cosμ_i]^T

p_j＝[sinμ_jcosν_j-sinμ_jsinν_j cosμ_j]^T

根据瑞利散射理论，建立偏振矢量与太阳位置矢量之间的信息传递关系，得到传感器坐标系下的太阳矢量s^s，表示为：

s^s＝p_i×p_j

将传感系坐标系下的太阳矢量s^s，通过安装矩阵转换关系：

并进行单位化得到机体系下的太阳矢量s^b：

根据运动体的位置信息和时间信息，通过查询天文年历得到太阳相对于地理坐标系的天顶角σ和方位角δ，则对应的导航系下的太阳矢量为：

sⁿ＝[sinσcosδ -sinσsinδ cosσ]^T。

进一步的，所述步骤(2)的通过三轴磁力计测量并解算，得到机体系下的地磁矢量m^b，参考世界地磁模型(World Magnetic Model，WMM)求解导航系下地磁矢量mⁿ，对m^b和mⁿ进行单位化得到

和

提取两坐标系下的地磁矢量的角度信息，具体实现如下：

标定后的三轴地磁传感器测量值通过矫正补偿后得到传感器坐标系下地磁矢量：

进一步通过安装矩阵

转换为机体系下的地磁矢量m^b，

通过世界地磁模型WMM，参考运动体的位置信息和时间信息，求得导航系下的地磁场三维方向的分量m_x,m_y,m_z，将其定义为导航系下地磁矢量mⁿ：

mⁿ＝[m_x m_y m_z]^T

将m^b和mⁿ通过二范数进行单位化，提取地磁矢量中的角度信息：

进一步的，所述步骤(3)中的结合前两步骤得到的矢量，通过符号公式：

消除步骤(1)中机体系下太阳矢量s^b的二义性得到

具体实现如下：

由于步骤(1)中解算得到的机体下太阳矢量s^b存在±180o的二义性，用下式消除其二义性，

进一步的，所述步骤(4)中的根据矢量叉乘运算法则，联合机体系下单位化的地磁矢量

和太阳矢量

建立机体系下的二阶方位张量F^b；在导航系下，基于太阳矢量sⁿ和单位化的地磁矢量

融合，构建导航系下的二阶方位张量Fⁿ，具体方法如下：

联合单位化的地磁矢量

和太阳矢量

构建机体系下的二阶方位张量F^b：

基于太阳矢量sⁿ和单位化的地磁矢量

构建导航系下的二阶方位张量Fⁿ：

进一步的，所述步骤(5)中的通过姿态转换关系建立F^b与Fⁿ的信息传递关系：

结合步骤(3)和(4)得到的F^b及Fⁿ，反演解算姿态转换矩阵

得到运动体的航向角ψ和姿态角θ,γ，具体实现如下：

通过姿态转换关系建立F^b与Fⁿ的信息传递关系，满足：

则结合步骤(3)和步骤(4)中解得的矢量F^b与Fⁿ，求得姿态转换矩阵

在此令：

则有：

再进一步进行角度的象限判断和矫正，

对于俯仰角θ：θ＝θ；

对于横滚角γ：若c₃₃＞0，则γ＝γ；若c₃₃＜0,γ＞0，则γ＝γ-180；若c₃₃＜0,γ＜0，则γ＝γ+180；

对于航向角ψ：若c₂₂＞0，则ψ＝ψ；若c₂₂＜0,c₁₂＞0，则ψ＝ψ+180；若c₂₂＜0,c₁₂＜0，则ψ＝ψ-180；

因此，得到运动体在任意时刻的航向角和姿态角信息。

与现有的技术相比，本发明具有以下的优点：

现有利用偏振与地磁信息进行姿态解算的导航方式大都对卫星导航有很强的依赖性，在GPS等信号受到干扰时，这些方法无法完成运动体自主导航，在GNSS拒止或失效条件下，目前的全自主导航解算方法，主要还是依赖惯导为主体的组合导航方法，对偏振和地磁信息没有实现充分融合，导航算法和精度仍有些缺陷。本发明将偏振信息和地磁信息进行了深度融合，实现了在GNSS拒止或失效条件下，全自主解算运动体的航向和姿态信息。两种矢量分布场均不受运动体的运动状态改变的影响，具有很好的稳定性、可靠性、隐蔽性和误差不累积的优势，对于运动体机动条件下的全自主航向和姿态的解算也有很好的适用性。同时，解算方法计算量小，器件成本低，易实现应用。

附图说明

图1为本发明一种偏振-地磁信息深度融合全自主姿态解算方法的流程图；

图2为根据矢量叉乘法则构造机体系下二阶方位张量F^b的说明图。

具体实施方式

下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整的描述，显然，所描述的实施例仅为本发明的一部分实施例，而不是全部的实施例，基于本发明中的实施例，本领域的普通技术人员在不付出创造性劳动的前提下所获得的所有其他实施例，都属于本发明的保护范围。

本发明的方法适用于全球导航卫星系统GNSS拒止或失效、无人机、导弹等运动体。

根据本发明的一个实施例，选取至少有三个通道的偏振传感器，在获取得到三通道的偏振信息时，采用偏振度较高的两组进行解算；选取精度同偏振传感器同量级的三轴地磁计；将两传感器坐标系对应三轴分别同向平行进行集成。

偏振传感器安装在运动体上时，应同机体系对应三轴分别同向平行安装，此时安装矩阵为单位阵I_3×3，若以其他方式安装，则解算过程中应考虑安装旋转矩阵的转换关系。所述机体系是指以运动体为参考建立的坐标系；

如图1所示，本发明的一种偏振-地磁信息深度融合全自主姿态解算方法，具体实现步骤为：

步骤1.利用偏振传感器获取天空偏振场信息，通过偏振矢量p与太阳矢量s^*b的信息传递关系，解算机体系下的太阳矢量s^*b并进行单位化得s^b，结合运动体当地位置及时间，确定导航系下的太阳矢量sⁿ，具体实现为：

通过偏振传感器获取两个不同方向d_i,d_j的偏振角α_i,α_j，方向矢量d_i,d_j在传感器坐标系中可表示为(μ_iν_i)和(μ_jν_j)，其中，μ_i,μ_j为传感器坐标系中的天顶角，ν_i,ν_j为传感器坐标系中的方位角(即与x轴顺时针夹角)，那么两方向上的偏振矢量p_i,p_j可表示为：

p_i＝[sinμ_icosν_i-sinμ_isinν_i cosμ_i]^T

p_j＝[sinμ_jcosν_j-sinμ_jsinν_j cosμ_j]^T

根据瑞利散射理论，建立偏振矢量与太阳位置矢量之间的信息传递关系，则可以得到传感器坐标系下的太阳矢量s^s，表示为：

s^s＝p_i×p_j

将传感系坐标系下的太阳矢量s^s，通过安装矩阵转换关系：

则进行单位化得到机体系下的太阳矢量s^b：

根据运动体的位置信息和时间信息，通过查询天文年历可以得到太阳相对于地理坐标系的天顶角σ和方位角δ，则对应的导航系下的太阳矢量为：

sⁿ＝[sinσcosδ -sinσsinδ cosσ]^T

步骤2.通过三轴磁力计测量并解算，得到机体系下的地磁矢量m^b，参考世界地磁模型(World Magnetic Model，WMM)求解导航系下地磁矢量mⁿ，对m^b和mⁿ进行单位化得到

和

提取两坐标系下的地磁矢量的角度信息，具体实现为：

标定后的三轴地磁传感器测量值通过矫正补偿后得到传感器坐标系下地磁矢量：

进一步通过安装矩阵

转换为机体系下的地磁矢量m^b，

通过世界地磁模型WMM，参考运动体的位置信息和时间信息，可求得导航系下的地磁场三维方向的分量m_x,m_y,m_z，将其定义为导航系下地磁矢量mⁿ：

mⁿ＝[m_x m_y m_z]^T

将m^b和mⁿ通过二范数进行单位化，提取地磁矢量中的角度信息：

步骤3.结合前两步骤得到的矢量，通过符号公式：

消除步骤(1)中机体系下太阳矢量s^b的二义性得到

具体实现如下：

由于步骤(1)中解算得到的机体下太阳矢量s^b存在±180o的二义性，用下式消除其二义性，

步骤4.根据矢量叉乘运算法则，如图2，联合机体系下单位化的地磁矢量

和太阳矢量

建立机体系下的二阶方位张量F^b。在导航系下，基于太阳矢量sⁿ和单位化的地磁矢量

融合，采用同样的方法，构建导航系下的二阶方位张量Fⁿ，具体方法如下：

联合单位化的地磁矢量

和太阳矢量

构建机体系下的二阶方位张量F^b：

基于太阳矢量sⁿ和单位化的地磁矢量

构建导航系下的二阶方位张量Fⁿ：

步骤5.通过姿态转换关系建立F^b与Fⁿ的信息传递关系：

结合步骤(3)和(4)得到的F^b及Fⁿ，反演解算姿态转换矩阵

进一步可得运动体的航向角ψ和姿态角θ,γ，具体实现如下：

通过姿态转换关系建立F^b与Fⁿ的信息传递关系，满足：

则结合步骤(3)和步骤(4)中解得的矢量F^b与Fⁿ，可求得姿态转换矩阵

在此令：

则有：

再进一步进行角度的象限判断和矫正，

对于俯仰角θ：θ＝θ；

对于横滚角γ：若c₃₃＞0，则γ＝γ；若c₃₃＜0,γ＞0，则γ＝γ-180；若c₃₃＜0,γ＜0，则γ＝γ+180；

对于航向角ψ：若c₂₂＞0，则ψ＝ψ；若c₂₂＜0,c₁₂＞0，则ψ＝ψ+180；若c₂₂＜0,c₁₂＜0，则ψ＝ψ-180；

因此，得到运动体在任意时刻的航向角和姿态角信息。

尽管上面对本发明说明性的具体实施方式进行了描述，以便于本技术领域的技术人员理解本发明，且应该清楚，本发明不限于具体实施方式的范围，对本技术领域的普通技术人员来讲，只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内，这些变化是显而易见的，一切利用本发明构思的发明创造均在保护之列。

Claims (5)

1.一种偏振-地磁信息深度融合全自主姿态解算方法，其特征在于，包括如下步骤：

步骤(1)、利用运动体上安装的偏振传感器获取天空偏振场信息，通过偏振矢量p与太阳矢量s^*b的信息传递关系，解算机体系下的太阳矢量s^*b并进行单位化得s^b，结合运动体当地位置及时间，确定导航系下的太阳矢量sⁿ；所述机体系是指以运动体为参考建立的坐标系；

步骤(2)、通过三轴磁力计测量并解算，得到机体系下的地磁矢量m^b，参考世界地磁模型WMM求解导航系下地磁矢量mⁿ，对m^b和mⁿ进行单位化得到

和

提取两坐标系下的地磁矢量的角度信息；

步骤(3)、结合前两步骤得到的矢量，通过符号公式：

消除步骤(1)中机体系下太阳矢量s^b的二义性得到

步骤(4)、根据矢量叉乘运算法则，联合机体系下单位化的地磁矢量

和太阳矢量

建立机体系下的二阶方位张量F^b；在导航系下，基于太阳矢量sⁿ和单位化的地磁矢量

融合，构建导航系下的二阶方位张量Fⁿ；

所述步骤(4)中的根据矢量叉乘运算法则，联合机体系下单位化的地磁矢量

和太阳矢量

建立机体系下的二阶方位张量F^b；在导航系下，基于太阳矢量sⁿ和单位化的地磁矢量

融合，构建导航系下的二阶方位张量Fⁿ，具体方法如下：

联合单位化的地磁矢量

和太阳矢量

构建机体系下的二阶方位张量F^b：

基于太阳矢量sⁿ和单位化的地磁矢量

构建导航系下的二阶方位张量Fⁿ：

步骤(5)、通过姿态转换关系建立F^b与Fⁿ的信息传递关系：

结合步骤(3)和(4)得到的F^b及Fⁿ，反演解算姿态转换矩阵

得到运动体的航向角ψ和姿态角θ,γ。

2.根据权利要求1所述的一种偏振-地磁信息深度融合全自主姿态解算方法，其特征在于：

所述步骤(1)的利用偏振传感器获取天空偏振场信息，通过偏振矢量p与太阳矢量s^*b的信息传递关系，解算机体系下的太阳矢量s^*b并进行单位化得s^b，结合运动体当地位置及时间，确定导航系下的太阳矢量sⁿ，具体要求如下：

通过偏振传感器获取两个不同方向d_i,d_j的偏振角α_i,α_j，方向矢量d_i,d_j在传感器坐标系中表示为(μ_iν_i)和(μ_jν_j)，其中，μ_i,μ_j为传感器坐标系中的天顶角，ν_i,ν_j为传感器坐标系中的方位角，即与x轴顺时针夹角，那么d_i,d_j两方向上的偏振矢量p_i,p_j表示为：

p_i＝[sinμ_icosν_i -sinμ_isinν_i cosμ_i]^T

p_j＝[sinμ_jcosν_j -sinμ_jsinν_j cosμ_j]^T

根据瑞利散射理论，建立偏振矢量与太阳位置矢量之间的信息传递关系，得到传感器坐标系下的太阳矢量s^s，表示为：

s^s＝p_i×p_j

将传感系坐标系下的太阳矢量s^s，通过安装矩阵转换关系：

并进行单位化得到机体系下的太阳矢量s^b：

根据运动体的位置信息和时间信息，通过查询天文年历得到太阳相对于地理坐标系的天顶角σ和方位角δ，则对应的导航系下的太阳矢量为：

sⁿ＝[sinσcosδ -sinσsinδ cosσ]^T。

3.根据权利要求1所述的一种偏振-地磁信息深度融合全自主姿态解算方法，其特征在于：

所述步骤(2)的通过三轴磁力计测量并解算，得到机体系下的地磁矢量m^b，参考世界地磁模型求解导航系下地磁矢量mⁿ，对m^b和mⁿ进行单位化得到

和

提取两坐标系下的地磁矢量的角度信息，具体实现如下：

标定后的三轴地磁传感器测量值通过矫正补偿后得到传感器坐标系下地磁矢量：

进一步通过安装矩阵

转换为机体系下的地磁矢量m^b，

通过世界地磁模型WMM，参考运动体的位置信息和时间信息，求得导航系下的地磁场三维方向的分量m_x,m_y,m_z，将其定义为导航系下地磁矢量mⁿ：

mⁿ＝[m_x m_y m_z]^T

将m^b和mⁿ通过二范数进行单位化，提取地磁矢量中的角度信息：

4.根据权利要求1所述的一种偏振-地磁信息深度融合全自主姿态解算方法，其特征在于：

所述步骤(3)中的结合前两步骤得到的矢量，通过符号公式：

消除步骤(1)中机体系下太阳矢量s^b的二义性得到

具体实现如下：

由于步骤(1)中解算得到的机体下太阳矢量s^b存在±180°的二义性，用下式消除其二义性，

5.根据权利要求1所述的一种偏振-地磁信息深度融合全自主姿态解算方法，其特征在于：

所述步骤(5)中的通过姿态转换关系建立F^b与Fⁿ的信息传递关系：

结合步骤(3)和(4)得到的F^b及Fⁿ，反演解算姿态转换矩阵

得到运动体的航向角ψ和姿态角θ,γ，具体实现如下：

通过姿态转换关系建立F^b与Fⁿ的信息传递关系，满足：

则结合步骤(3)和步骤(4)中解得的矢量F^b与Fⁿ，求得姿态转换矩阵

在此令：

则有：

再进一步进行角度的象限判断和矫正，

对于俯仰角θ：θ＝θ；

对于横滚角γ：若c₃₃＞0，则γ＝γ；若c₃₃＜0,γ＞0，则γ＝γ-180；若c₃₃＜0,γ＜0，则γ＝γ+180；

对于航向角ψ：若c₂₂＞0，则ψ＝ψ；若c₂₂＜0,c₁₂＞0，则ψ＝ψ+180；若c₂₂＜0,c₁₂＜0，则ψ＝ψ-180；

因此，得到运动体在任意时刻的航向角和姿态角信息。

Images