一种基于偏振光与地磁组合导航姿态测量方法技术

本发明专利技术公开了一种基于偏振光与地磁组合导航姿态测量方法，包括S1：建立载体坐标系ObXbYbZb，S2：测量太阳在所述载体坐标系下的太阳方向矢量

A Polarized Light and Geomagnetic Integrated Navigation Attitude Measurement Method

The invention discloses a method for attitude measurement based on polarized light and geomagnetic integrated navigation, including S1: establishing carrier coordinate system ObXbYbZb, S2: measuring solar direction vector under the carrier coordinate system.

【技术实现步骤摘要】
一种基于偏振光与地磁组合导航姿态测量方法
本专利技术涉及的是一种姿态测量方法，具体地说是一种基于偏振光与地磁组合导航姿态测量方法。
技术介绍
目前，偏振光、地磁等天然基本物理场均携带方位信息。利用天然的地磁场进行导航的方法具有无源自主，抗干扰能力强，无长期误差积累的特点，但是常见的磁场测量工具受周围环境中磁场的影响较大，并且在地球两极地区地球磁场几乎垂直于地面，因此在很多情况采用此种方法并不可靠。利用大气自然偏振特性携带的方位信息进行导航的方法,有着无线电导航和卫星导航等非自主导航方式所无法具有的隐蔽性、抗干扰性和稳定性,并能够补充天文导航和地磁导航等常规自主导航方式的不足。
技术实现思路
根据上述提出的技术问题，而提供一种基于偏振光与地磁组合导航姿态测量方法。本专利技术主要利用将地磁矢量测量与偏振光测量技术结合的方法。本专利技术采用的技术手段如下：一种基于偏振光与地磁组合导航姿态测量方法，包括下述步骤：S1：在载体上建立载体坐标系ObXbYbZb；S2：测量所述载体所在处太阳在所述载体坐标系下的太阳方向矢量所述载体所在处太阳在所述载体坐标系下的太阳方向矢量可以由载体坐标系下，天空中任意两个观测点的偏振方向矢量和计算得到，使用偏振光传感器测量所述载体所在位置天空中观测点的太阳散射光的偏振角度θm，且每个观测点对应一个偏振光传感器，每个所述偏振光传感器均建立局部坐标系OmXmYmZm(m＝1，2)，其Ym轴方向与所述偏振光传感器的0°方向一致，根据所述偏振光传感器测量的偏振角度θm得到局部坐标系下每个所述偏振光传感器所对应的观测点的偏振方向矢量载体坐标系下所述载体所在位置天空中任意两个观测点的偏振方向矢量分别为其中为局部坐标系与所述载体坐标系之间的坐标转换矩阵。坐标转换矩阵为常规数学手段，本专利技术不做过多描述。S3：测量所述载体所在处磁场在所述载体坐标系下的磁场强度矢量使用磁力计测量所述载体所在处磁场，且所述磁力计的两个轴向和载体坐标系的任意两个坐标轴方向上重合，所述磁力计测量得到所述载体所在处磁场在所述载体坐标系下的磁场强度矢量中在所述载体坐标系中任意两个坐标轴方向上的分量Mbi，Mbj(i，j＝x，y，z且i≠j)。S4：根据所述载体所在位置和实时时间查询载体所在处太阳在地平坐标系下的太阳方向矢量和所述载体所在处磁场在地平坐标系下的磁场强度矢量可根据定位模块、太阳矢量查询模块和磁场强度矢量查询模块，实时获得地平坐标系下的太阳方向矢量和磁场强度矢量S5：利用载体坐标系和地平坐标系之间的姿态转换矩阵分别建立矢量方程以及其中α，β，γ为所述载体三维姿态角；S6：对步骤S5中的方程进行求解，得到所述载体在所述载体坐标系下的姿态角α，β，γ。在所述在步骤S5中提供的矢量方程中可以建立四个独立的方程，但因只需要载体在所述载体坐标系下的姿态角α，β，γ三个未知量，方程是冗余的。为了使定姿的方法更加简单，步骤S3中磁场强度矢量中只需测量两个坐标轴上的分量(i，j＝x，y，z且i≠j)，剩下一个坐标轴上的分量可以不做测量。本专利技术具有以下优点：本文提出将地磁矢量测量与偏振光测量技术结合的方法，不仅可以提供完整的姿态信息，而且在应用场合上与目前存在的航姿参考系统相比，具有不随时间积累发散的特点。基于上述理由本专利技术可在导航领域广泛推广。附图说明为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图做以简单地介绍，显而易见地，下面描述中的附图是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。图1是本专利技术具体实施方式中一种基于偏振光与地磁组合导航姿态测量方法流程图。图2是本专利技术具体实施方式中载体上搭建的三棱柱示意图。图3是本专利技术具体实施方式中从Z1轴正方向向B面看去的示意图。图4是本专利技术具体实施方式中是从Z2轴正方向向C面看去的示意图。具体实施方式为使本专利技术实施例的目的、技术方案和优点更加清楚，下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。如图1-图4所示，本实施例所提供的一种基于偏振光与地磁组合导航姿态测量方法中使用了设置在载体上的偏振光传感器Ⅰ、偏振光传感器Ⅱ、磁力计和定位系统，还使用了可以查询太阳矢量的太阳矢量查询模块和可以查询地磁矢量的地磁矢量查询模块，其中太阳矢量查询模块和地磁矢量查询模块可设置在上位计算机中。一种基于偏振光与地磁组合导航姿态测量方法，包括下述步骤：S1：在载体上搭建如图2所示三棱柱结构，且所述三棱柱的截面为等要直角三角形，三棱柱的三个侧面A、B、C分别代表：A面表示载体初始状态下的平面，B面和C面分别用以安装偏振光传感器Ⅰ和偏振光传感器Ⅱ，B、C面通过A面与载体固定连接，在A面建立载体坐标系ObXbYbZb(左手系)，Zb轴垂直于A面且正方向与A面的内法线方向一致；Xb在A平面内，垂直于A面与B面的交线且Xb轴正方向与B面的法线方向在A面上的正投影方向相同，Yb轴在A面内，Yb轴垂直于Xb轴，且正方向由左手系确定；S2：测量所述载体所在处太阳方向在所述载体坐标系下的太阳方向矢量所述偏振光传感器Ⅰ在B面建立局部坐标系O1X1Y1Z1(左手系)，Y1轴设置在所述B面内垂直于A面和B面的交线，且Y1轴的正方向与Xb轴在B面正投影的方向一致，Z1轴垂直于B面且正方向与B面的外法线方向一致，X1轴在B面内，正方向由左手系确定；所述偏振光传感器Ⅱ在C面建立局部坐标系O2X2Y2Z2(左手系),Y2轴设置在所述C面内垂直于A面和C面的交线，且Y2轴的正方向与Xb轴在C面正投影的方向相反，Z2轴垂直于C面且正方向与C面的外法线方向一致，X2轴在C面内，正方向由左手系确定；偏振光传感器Ⅰ和偏振光传感器Ⅱ的0°方向分别与所述Y1轴和Y2轴的正方向相一致。所述载体所在处太阳在所述载体坐标系下的太阳方向矢量可以由载体坐标系下，载体所在位置天空中所述偏振光传感器Ⅰ所对应的观测点1和所述偏振光传感器Ⅱ所对应的观测点2的偏振方向矢量和计算得到，使用偏振光传感器Ⅰ测量所述载体所在位置所述偏振光传感器Ⅰ所对应的观测点1的太阳散射光的偏振角度θ1(偏振光传感器Ⅰ的0°方向与观测点1的最大偏振方向的夹角)；使用偏振光传感器Ⅱ测量所述载体所在位置所述偏振光传感器Ⅱ所对应的观测点2的太阳散射光的偏振角度θ2(偏振光传感器Ⅱ的0°方向与观测点2的最大偏振方向的夹角)；如图3所示，偏振光传感器Ⅰ可测得观测点1在所述局部坐标系O1X1Y1Z1中的偏振方向矢量如图4所示，偏振光传感器Ⅱ可测得观测点2在所述局部坐标系O2X2Y2Z2中的偏振方向矢量通过局部坐标系O1X1Y1Z1与载体坐标系ObXbYbZb的坐标转换矩阵将观测点1在所述局部坐标系O1X1Y1Z1中的偏振方向矢量转换到载体坐标系ObXbYbZb中得到其中通过局部坐标系O2X2Y2Z2与载体坐标系ObXbYbZb的坐标转换矩阵将观测点2在所述局部坐标系O2X2Y2Z2中的偏振方向矢本文档来自技高网...

【技术保护点】
1.一种基于偏振光与地磁组合导航姿态测量方法，其特征在于，包括下述步骤：S1：在载体上建立载体坐标系ObXbYbZb；S2：测量所述载体所在处太阳在所述载体坐标系下的太阳方向矢量

【技术特征摘要】
1.一种基于偏振光与地磁组合导航姿态测量方法，其特征在于，包括下述步骤：S1：在载体上建立载体坐标系ObXbYbZb；S2：测量所述载体所在处太阳在所述载体坐标系下的太阳方向矢量S3：测量所述载体所在处磁场在所述载体坐标系下的磁场强度矢量S4：根据所述载体所在位置和实时时间查询载体所在处太阳在地平坐标系下的太阳方向矢量和所述载体所在处磁场在地平坐标系下的磁场强度矢量S5：利用载体坐标系和地平坐标系之间的姿态转换矩阵分别建立矢量方程以及其中α，β，γ为所述载体三维姿态角；S6：对步骤S5中的方程进行求解，得到所述载体在所述载体坐标系下的姿态角α，β，γ。2.根据权利要求1所述的一种基于偏振光与地磁组合导航姿态测量方法，其特征在于：所述步骤S2中，所述载体所在处太阳在所述载体坐标系下的太阳方向矢量可以由载体坐标系下，天空中任意两个观测点的偏振方向矢量和计算得到，3.根据权利要求2所述的一种基于偏振光与地磁组合导航姿...

【专利技术属性】
技术研发人员：褚金奎，郭晓庆，王寅龙，张然，关乐，李金山，
申请(专利权)人：大连理工大学，
类型：发明
国别省市：辽宁,21