CN107727101A - 基于双偏振光矢量的三维姿态信息快速解算方法 - Google Patents

基于双偏振光矢量的三维姿态信息快速解算方法 Download PDF

Info

Publication number
CN107727101A
CN107727101A CN201711137596.XA CN201711137596A CN107727101A CN 107727101 A CN107727101 A CN 107727101A CN 201711137596 A CN201711137596 A CN 201711137596A CN 107727101 A CN107727101 A CN 107727101A
Authority
CN
China
Prior art keywords
msub
mrow
mtd
msubsup
mtr
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201711137596.XA
Other languages
English (en)
Other versions
CN107727101B (zh
Inventor
金仁成
谢林达
孙加亮
褚金奎
蔚彦昭
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Dalian University of Technology
Original Assignee
Dalian University of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Dalian University of Technology filed Critical Dalian University of Technology
Priority to CN201711137596.XA priority Critical patent/CN107727101B/zh
Publication of CN107727101A publication Critical patent/CN107727101A/zh
Application granted granted Critical
Publication of CN107727101B publication Critical patent/CN107727101B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft

Abstract

本发明属于无人机三维姿态信息的求解技术领域,提供了一种基于双偏振光矢量的三维姿态信息快速解算方法,是通过分析偏振光传感器的输出特性并结合瑞利散射理论,在利用测量输出的双偏振光E‑矢量确定机体坐标系下太阳空间位置的基础上,进一步结合当地时间和位置信息计算得到导航坐标系下的太阳特征点空间位置,实现直接求解当前时刻三维姿态角的目标,避免现有解算方法中存在的误差传递现象,保证无人机姿态求解过程的实时性与快速性要求。本发明提供一种快速解算导航机体三维姿态的方法,应用于偏振光三维航姿测量。

Description

基于双偏振光矢量的三维姿态信息快速解算方法
技术领域
本发明利用瑞利散射理论和偏振光传感器的量测输出特性,在搭建组合式偏振光传感器姿态测量平台的基础上,实现导航系统的仿生化、模块化与功能化。通过使用这种仿生光学传感器,以达到逐步摆脱对传统航姿参考系统的依赖并实现完全自主定姿的目的,主要用于无人机仿生导航领域。
背景技术
无人机是一种利用无线电传输装置进行遥控或使用自身装载的程序系统实现控制的无人驾驶飞机。与载人飞机不同的是,它不仅在体积上轻便、造价上低廉,而且对作战条件的要求更低、在实际恶劣战场环境中的生存能力更强。随着近年来相关技术的发展,自主性强的无人机越来越受到各国军方的关注。
尽管如此,但无人机在飞行任务时容易受到干扰和欺骗。因此,研究一种抗干扰性好,自主能力强的导航方法成为如今导航领域的研究热点之一。传统的航姿参考系统一般由多种类型的传感器组成,这些不同类型的传感器在抗干扰性与自主性方面都存在各自的弊端:磁强计极易受到周围软、硬磁场和机载电子设备的影响,特别是战时容易遭到破坏而使得航向误差显著增大。在零偏漂移、温度漂移、随机误差等因素的影响下,陀螺仪的积分解算结果会存在误差累积,导致求解精度变差。为了解决陀螺仪的这种误差累积问题,通常利用加速度计低频特性良好的特点,与陀螺仪进行互补滤波以实现信息融合。然而,加速度计对无人机无人机振动等高频干扰十分敏感,而且单独使用加速度计时无法区分运动加速度与重力加速度,如果无人机处于加速运动或者强机动飞行状态,就会出现姿态角度发散,互补滤波效果减弱的情况。
在现有的仿生偏振光导航理论中,针对三维姿态角获取研究主要集中在对大气偏振模式的重构方面,一般通过建立误差函数模型或者利用聚类分析等数据处理技术实现对太阳空间位置的求取。然而,这种数据处理方案不仅增加了时间和内存的开销,而且对采集到的偏振光信息也有较高要求,只有数据具有极好的对称性和偏振变化规律,才能重构出接近理想状态下的大气偏振模式,从而进一步使用统计聚类的方案求取太阳特征点位置。因此除了系统误差和环境因素干扰外,还会引入统计分析算法导致的解算误差,求解精度受到一定程度影响。与此同时,无人机在执行任务过程中会有较高的实时性要求,而且对于无人机姿态的控制更是要求快速且准确,而现有的方法中一般都是近似解算出三维姿态角的中间变化值,再通过与前一时刻姿态角度值叠加的方式得到当前时刻的无人机姿态,但是这样的姿态角计算方法无疑会存在误差传递现象。如果某一步求解的姿态角误差超出容许范围,就会造成整体求解结果的失效。
发明内容
本发明针对以上传统导航器件抗干扰性差,自主能力弱的弊端以及现有基于偏振光信息获取三维姿态算法中存在的解算精度受限和误差传递的问题。本发明提出一种基于双偏振光矢量直接求解无人机载体姿态的方案。偏振光传感器通过检测天空中的大气偏振模式为导航控制提供角度信息,具有不易受电磁干扰及测量误差不随时间累积等优势。本发明采用三个偏振光传感器组合测量大气偏振信息方案,利用其中实际量测输出结果最佳的提供航向信息,再通过其余两个偏振光传感器输出的双偏振光E-矢量确定太阳特征点的空间位置,并结合导航坐标系下的太阳方向矢量信息,直接解算出导航所需的三维姿态角度。
本发明的技术方案:
一种基于双偏振光矢量的三维姿态信息快速解算方法,该方法所用的设备,包括组合式偏振光传感器量测单元、GPS模块、天文年历查询模块和导航计算机;组合式偏振光传感器量测单元包括三个偏振光传感器,导航计算机用来处理各个传感器的数据信息;GPS模块提供的无人机所在位置实时经纬度信息、天文历查询模块提供的不同时刻太阳赤纬以及太阳时角信息,计算出当前时刻的太阳高度角与太阳方位角,实现对太阳位置的实时跟踪;根据瑞利散射原理确定的空间矢量几何关系,通过双偏振光E-矢量确定无人机坐标系下的太阳空间位置,一步解算出无人机实时的三维导航姿态角信息,形成一种自主性强、快速性好的航姿测量方法,实现对无人机飞行姿态的实时控制;
具体步骤如下:
步骤一:采集天文年历查询模块和GPS模块提供的数据,计算太阳方向矢量在导航坐标系下的投影
步骤二:根据每个偏振光传感器在相应表面的安装位置关系,分别计算出三个偏振光传感器模块坐标系到无人机坐标系的姿态变换矩阵
步骤三:将三个偏振光传感器测量输出的入射光最大偏振方向E-矢量pk从各自所在的模块坐标系转化为在无人机坐标系下的投影:
步骤四:从偏振光传感器的实际输出结果中,选取测量效果最佳的一个偏振光传感器用来估计得到无人机控制系统的航向角ψ0
步骤五:根据瑞利散射原理,计算最大偏振方向矢量在无人机坐标系下的表达形式:
根据几何学中的空间垂直定理,从三者中任选两个均能确定出并规范化有:
步骤六:随着无人机姿态的改变,太阳方向矢量在前后无人机坐标系下的投影是不同的,再结合导航坐标系下实时计算得到的太阳矢量投影,即求出当前时刻的姿态矩阵;太阳方向矢量的坐标变换关系如下式:
将已测出的航向角ψ0带入方向余弦矩阵
简化有:
与式(1)和式(9)一起带入式(8)有:
将上式(10)展开得到方程组如下:
通过求解上述方程组,解算出当前时刻的横滚角与俯仰角信息。
步骤七:重复步骤一至步骤六的过程,为无人机系统提供实时的姿态信息。
本发明的有益效果:
(1)使用了自主性强的偏振光传感器,摆脱了对传统陀螺仪、加速度计、磁力计等导航器件的依赖,避免了传统航姿参考系统易受外界干扰的缺陷。
(2)区别于国内外现有的通过误差函数建模以及聚类分析等数据统计手段获取太阳矢量投影的方法,本发明利用互成角度安装的偏振光传感器分别获取所测天空区域同一时刻的E-矢量信息,并通过双偏振光E-矢量求解太阳矢量在无人机坐标系下投影。该方案改善了现有方法中计算量大、数据处理繁杂的弊端,有效提高了姿态解算过程的实时性。
(3)不同于国内外现有方法中通过求解姿态角的中间变化值来解算当前时刻姿态角的方法。本发明利用太阳方向矢量在两个坐标系下各自投影间的映射关系,一步求解出导航所需当前时刻的姿态角信息,避免了在求取中间变化值过程中存在的误差传递现象,从而减小了姿态角的解算误差。
附图说明
图1是传感器与导航计算机之间的信息交互关系示意图。
图2是组合式实验平台的空间位置关系与主要坐标系图。
图3是本发明的执行流程原理图。
具体实施方式
下面结合说明书附图和技术方案对本发明的具体实施过程作进一步的阐述。
如图1所示,本发明里面的装置包括导航计算机、组合式偏振光传感器量测单元、天文历模块以及GPS模块。导航计算机通过接收天文历模块传送的不同时刻太阳赤纬以及太阳时角信息和GPS模块传送的实时经纬度信息,计算得到当前时刻的太阳高度角与太阳方位角,从而确定太阳矢量在导航坐标系下的投影。根据双偏振光E-矢量与太阳方向矢量的垂直关系确定太阳矢量在无人机坐标系下的投影,通过解算姿态矩阵得到当前时刻的三维姿态角信息。最终将这些实时解算数据发送到导航系统中完成对无人机姿态的控制任务。
本发明涉及的坐标系有:导航坐标系,无人机坐标系,偏振光传感器模块坐标系,如图2所示。设天球半径为1,天顶点为Z,以观测者为原点O,Sun是太阳在天球表面的投影点,SM是太阳子午线,ASM是逆太阳子午线。太阳空间位置表示为Sun(HS,AS),其中,HS表示太阳高度角,AS表示太阳方位角。以指向天顶点的反方向为Zn轴方向,以正北方向为Xn轴方向,以正东方向为Yn轴方向建立导航坐标系。以沿无人机纵轴向前为Xb轴方向,以沿无人机横轴向右为Yb轴方向,以沿无人机纵轴面向下为Zb轴方向建立无人机坐标系。在正四面体框架实体的外部三个面上分别布置偏振光传感器,并使相应传感器的中心与所在表面的几何中心重合;正四面体的底面与无人机坐标系的OXY平面重合,并使底面的一边与Yb轴重合,同时使Xb轴通过底面的形心,从而保证组合式偏振光传感器量测单元与无人机无人机之间具有确定的相对位置关系。根据右手定则依次建立偏振光传感器模块坐标系mk(OkXkYkZk)(k=1,2,3),设模块坐标系的Yk(k=1,2,3)轴为其各自体轴,体轴垂直于所在表面的底边并沿中心线指向四面体的顶点,则偏振光传感器测量的偏振方位角δpk(k=1,2,3)为入射光的最大偏振方向E‐矢量在各自模块坐标系的OXY平面的投影与Yk(k=1,2,3)轴的夹角。
如图3是本发明执行的操作流程,具体步骤如下:
步骤一:采集天文历模块提供的不同时刻太阳赤纬以及太阳时角数据和GPS模块提供的实时经纬度数据,计算出当前时刻的太阳高度角HS与太阳方位角AS,从而得到太阳方向矢量在导航坐标系下的投影
这里,向量参数中的下角标sun表示针对的是太阳方向矢量,上角标n表示是在导航坐标系下的投影,之后出现的向量参数均按照这种方式理解。
步骤二:在如图2所示的组合式实验平台基础上,依次建立相应的模块坐标系mk(OkXkYkZk)(k=1,2,3)。同时,根据每个偏振光传感器在相应表面的安装位置关系,分别计算出三个偏振光传感器模块坐标系到无人机坐标系的姿态变换矩阵
这里,α是正四面体中任意两个表面所成的二面角,根据正四面体的几何特征有α=70°32'。矩阵参数表示该矩阵是从偏振光模块坐标系mk(k=1,2,3)到无人机坐标系b的姿态变换矩阵,之后出现的矩阵参数均按照这种方式理解。
步骤三:将三个偏振光传感器测量输出的入射光最大偏振方向E-矢量pk(k=1,2,3)从各自所在的模块坐标系转化为在无人机坐标系下的投影:
这里,是入射光最大偏振方向E-矢量在各自偏振光传感器模块坐标系OXY平面的投影向量与Yk(k=1,2,3)轴的夹角。
步骤四:从偏振光传感器的实际输出结果中,选取测量效果最佳的一个偏振光传感器用来估计得到无人机控制系统的航向角ψ0
步骤五:根据瑞利散射原理,偏振光传感器所测天顶点处的最大偏振方向矢量垂直于观测方向矢量与太阳方向矢量所确定的平面。因此,在无人机坐标系下有:
根据几何学中的空间垂直定理,太阳方向矢量应垂直于观测到的两个最大偏振方向矢量所构成的平面,因此从三者中任选两个均能确定出并规范化有:
这里,的反对称矩阵。||·||2是对其中参量取欧几里得范数。
步骤六:由于导航求解的姿态矩阵是无人机无人机相对于地理空间位置的角度变化关系,因此随着无人机姿态的改变,太阳方向矢量在前后无人机坐标系下的投影是不同的,再结合导航坐标系下实时计算得到的太阳矢量投影,即可求出当前时刻的姿态矩阵。太阳方向矢量的坐标变换关系如下式:
将已测出的航向角ψ0带入方向余弦矩阵
简化有:
这里,θ是俯仰角,γ是横滚角,Cij(i,j=1,2,3)是方向余弦矩阵中的第i行第j列元素。
与式(1)和式(9)一起带入式(8)有:
将上式(10)展开得到方程组如下:
通过求解上述方程组,解算出当前时刻的横滚角与俯仰角信息。
步骤七:重复步骤一至步骤六的过程,为无人机系统提供实时的姿态信息。

Claims (1)

1.一种基于双偏振光矢量的三维姿态信息快速解算方法,其特征在于该方法所用的设备,包括组合式偏振光传感器量测单元、GPS模块、天文年历查询模块和导航计算机;组合式偏振光传感器量测单元包括三个偏振光传感器,导航计算机用来处理各个传感器的数据信息;GPS模块提供的无人机所在位置实时经纬度信息、天文历查询模块提供的不同时刻太阳赤纬以及太阳时角信息,计算出当前时刻的太阳高度角与太阳方位角,实现对太阳位置的实时跟踪;根据瑞利散射原理确定的空间矢量几何关系,通过双偏振光E-矢量确定无人机坐标系下的太阳空间位置,一步解算出无人机实时的三维导航姿态角信息,形成一种自主性强、快速性好的航姿测量方法,实现对无人机飞行姿态的实时控制;
具体步骤如下:
步骤一:采集天文历模块提供的不同时刻太阳赤纬以及太阳时角数据和GPS模块提供的实时经纬度数据,计算出当前时刻的太阳高度角HS与太阳方位角AS,从而得到太阳方向矢量在导航坐标系下的投影
<mrow> <msubsup> <mi>a</mi> <mrow> <mi>s</mi> <mi>u</mi> <mi>m</mi> </mrow> <mi>n</mi> </msubsup> <mo>=</mo> <msup> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>cos</mi> <mrow> <mo>(</mo> <msub> <mi>H</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> <mi>cos</mi> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <mi>sin</mi> <mrow> <mo>(</mo> <msub> <mi>H</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> <mi>sin</mi> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <mi>sin</mi> <mrow> <mo>(</mo> <msub> <mi>H</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mi>T</mi> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
其中,向量参数中的下角标sun表示针对的是太阳方向矢量,上角标n表示是在导航坐标系下的投影;
步骤二:在组合式实验平台基础上,依次建立相应的模块坐标系mk(OkXkYkZk),k=1,2,3;同时,根据每个偏振光传感器在相应表面的安装位置关系,分别计算出三个偏振光传感器模块坐标系到无人机坐标系的姿态变换矩阵
<mrow> <msubsup> <mi>C</mi> <msub> <mi>m</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mo>-</mo> <msqrt> <mn>3</mn> </msqrt> <mo>/</mo> <mn>2</mn> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;alpha;</mi> <mo>/</mo> <mn>2</mn> </mrow> </mtd> <mtd> <mrow> <mi>sin</mi> <mi>&amp;alpha;</mi> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mn>1</mn> <mo>/</mo> <mn>2</mn> </mrow> </mtd> <mtd> <mrow> <msqrt> <mn>3</mn> </msqrt> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;alpha;</mi> <mo>/</mo> <mn>2</mn> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <msqrt> <mn>3</mn> </msqrt> <mi>sin</mi> <mi>&amp;alpha;</mi> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;alpha;</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>cos</mi> <mi>&amp;alpha;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msubsup> <mi>C</mi> <msub> <mi>m</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msqrt> <mn>3</mn> </msqrt> <mo>/</mo> <mn>2</mn> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;alpha;</mi> <mo>/</mo> <mn>2</mn> </mrow> </mtd> <mtd> <mrow> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;alpha;</mi> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mn>1</mn> <mo>/</mo> <mn>2</mn> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <msqrt> <mn>3</mn> </msqrt> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;alpha;</mi> <mo>/</mo> <mn>2</mn> </mrow> </mtd> <mtd> <mrow> <msqrt> <mn>3</mn> </msqrt> <mi>sin</mi> <mi>&amp;alpha;</mi> <mo>/</mo> <mn>2</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;alpha;</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>cos</mi> <mi>&amp;alpha;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msubsup> <mi>C</mi> <msub> <mi>m</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&amp;alpha;</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;alpha;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&amp;alpha;</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>cos</mi> <mi>&amp;alpha;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>
其中,α是正四面体中任意两个表面所成的二面角,根据正四面体的几何特征有α=70°32';矩阵参数表示该矩阵是从偏振光模块坐标系mk到无人机坐标系b的姿态变换矩阵;
步骤三:将三个偏振光传感器测量输出的入射光最大偏振方向E-矢量pk从各自所在的模块坐标系转化为在无人机坐标系下的投影:
<mrow> <mtable> <mtr> <mtd> <mrow> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <mo>=</mo> <msubsup> <mi>C</mi> <msub> <mi>m</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>1</mn> </msub> <msub> <mi>m</mi> <mn>1</mn> </msub> </msubsup> <mo>=</mo> <msubsup> <mi>C</mi> <msub> <mi>m</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <msup> <mrow> <mo>&amp;lsqb;</mo> <msub> <mi>sin&amp;delta;</mi> <msub> <mi>p</mi> <mn>1</mn> </msub> </msub> <mo>,</mo> <msub> <mi>cos&amp;delta;</mi> <msub> <mi>p</mi> <mn>1</mn> </msub> </msub> <mo>,</mo> <mn>0</mn> <mo>&amp;rsqb;</mo> </mrow> <mi>T</mi> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <mo>=</mo> <msubsup> <mi>C</mi> <msub> <mi>m</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>2</mn> </msub> <msub> <mi>m</mi> <mn>2</mn> </msub> </msubsup> <mo>=</mo> <msubsup> <mi>C</mi> <msub> <mi>m</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <msup> <mrow> <mo>&amp;lsqb;</mo> <msub> <mi>sin&amp;delta;</mi> <msub> <mi>p</mi> <mn>2</mn> </msub> </msub> <mo>,</mo> <msub> <mi>cos&amp;delta;</mi> <msub> <mi>p</mi> <mn>2</mn> </msub> </msub> <mo>,</mo> <mn>0</mn> <mo>&amp;rsqb;</mo> </mrow> <mi>T</mi> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> <mo>=</mo> <msubsup> <mi>C</mi> <msub> <mi>m</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>3</mn> </msub> <msub> <mi>m</mi> <mn>3</mn> </msub> </msubsup> <mo>=</mo> <msubsup> <mi>C</mi> <msub> <mi>m</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> <msup> <mrow> <mo>&amp;lsqb;</mo> <msub> <mi>sin&amp;delta;</mi> <msub> <mi>p</mi> <mn>3</mn> </msub> </msub> <mo>,</mo> <msub> <mi>cos&amp;delta;</mi> <msub> <mi>p</mi> <mn>3</mn> </msub> </msub> <mo>,</mo> <mn>0</mn> <mo>&amp;rsqb;</mo> </mrow> <mi>T</mi> </msup> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>
其中,是入射光最大偏振方向E-矢量在各自偏振光传感器模块坐标系OXY平面的投影向量与Yk轴的夹角;
步骤四:从偏振光传感器的实际输出结果中,选取测量效果最佳的一个偏振光传感器用来估计得到无人机控制系统的航向角ψ0
步骤五:根据瑞利散射原理,偏振光传感器所测天顶点处的最大偏振方向矢量垂直于观测方向矢量与太阳方向矢量所确定的平面;因此,在无人机坐标系下有:
<mrow> <mtable> <mtr> <mtd> <mrow> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <mo>=</mo> <msub> <mi>O</mi> <mn>1</mn> </msub> <msub> <mi>Z</mi> <mn>1</mn> </msub> <mo>&amp;times;</mo> <msubsup> <mi>a</mi> <mrow> <mi>s</mi> <mi>u</mi> <mi>m</mi> </mrow> <mi>b</mi> </msubsup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <mo>=</mo> <msub> <mi>O</mi> <mn>2</mn> </msub> <msub> <mi>Z</mi> <mn>2</mn> </msub> <mo>&amp;times;</mo> <msubsup> <mi>a</mi> <mrow> <mi>s</mi> <mi>u</mi> <mi>m</mi> </mrow> <mi>b</mi> </msubsup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> <mo>=</mo> <msub> <mi>O</mi> <mn>3</mn> </msub> <msub> <mi>Z</mi> <mn>3</mn> </msub> <mo>&amp;times;</mo> <msubsup> <mi>a</mi> <mrow> <mi>s</mi> <mi>u</mi> <mi>m</mi> </mrow> <mi>b</mi> </msubsup> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
根据几何学中的空间垂直定理,太阳方向矢量应垂直于观测到的两个最大偏振方向矢量所构成的平面,因此从三者中任选两个均能确定出并规范化有:
<mrow> <mtable> <mtr> <mtd> <mrow> <msubsup> <mi>a</mi> <mrow> <mi>s</mi> <mi>u</mi> <mi>m</mi> </mrow> <mi>b</mi> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <msubsup> <mi>A</mi> <msub> <mi>p</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <mo>)</mo> </mrow> <mo>/</mo> <mo>|</mo> <mo>|</mo> <msubsup> <mi>A</mi> <msub> <mi>p</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <mo>|</mo> <msub> <mo>|</mo> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>a</mi> <mrow> <mi>s</mi> <mi>u</mi> <mi>m</mi> </mrow> <mi>b</mi> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <msubsup> <mi>A</mi> <msub> <mi>p</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> <mo>)</mo> </mrow> <mo>/</mo> <mo>|</mo> <mo>|</mo> <msubsup> <mi>A</mi> <msub> <mi>p</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> <mo>|</mo> <msub> <mo>|</mo> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msubsup> <mi>a</mi> <mrow> <mi>s</mi> <mi>u</mi> <mi>m</mi> </mrow> <mi>b</mi> </msubsup> <mo>=</mo> <mrow> <mo>(</mo> <msubsup> <mi>A</mi> <msub> <mi>p</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> <mo>)</mo> </mrow> <mo>/</mo> <mo>|</mo> <mo>|</mo> <msubsup> <mi>A</mi> <msub> <mi>p</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>p</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> <mo>|</mo> <msub> <mo>|</mo> <mn>2</mn> </msub> </mrow> </mtd> </mtr> </mtable> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>
其中,的反对称矩阵;||·||2是对其中参量取欧几里得范数;
步骤六:由于导航求解的姿态矩阵是无人机相对于地理空间位置的角度变化关系,因此随着无人机姿态的改变,太阳方向矢量在前后无人机坐标系下的投影是不同的,再结合导航坐标系下实时计算得到的太阳矢量投影,即求出当前时刻的姿态矩阵;太阳方向矢量的坐标变换关系如下式:
<mrow> <msubsup> <mi>a</mi> <mrow> <mi>s</mi> <mi>u</mi> <mi>n</mi> </mrow> <mi>b</mi> </msubsup> <mo>=</mo> <msubsup> <mi>C</mi> <mi>n</mi> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <mrow> <mi>s</mi> <mi>u</mi> <mi>n</mi> </mrow> <mi>n</mi> </msubsup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>
将已测出的航向角ψ0带入方向余弦矩阵
简化有:
其中,θ是俯仰角,γ是横滚角,Cij是方向余弦矩阵中的第i行第j列元素,i,j=1,2,3;
与式(1)和式(9)一起带入式(8)有:
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>cos</mi> <mrow> <mo>(</mo> <msub> <mi>H</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> <mi>cos</mi> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>cos</mi> <mrow> <mo>(</mo> <msub> <mi>H</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> <mi>sin</mi> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>sin</mi> <mrow> <mo>(</mo> <msub> <mi>H</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>C</mi> <mn>11</mn> </msub> </mtd> <mtd> <msub> <mi>C</mi> <mn>12</mn> </msub> </mtd> <mtd> <msub> <mi>C</mi> <mn>13</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>C</mi> <mn>21</mn> </msub> </mtd> <mtd> <msub> <mi>C</mi> <mn>22</mn> </msub> </mtd> <mtd> <msub> <mi>C</mi> <mn>23</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>C</mi> <mn>31</mn> </msub> </mtd> <mtd> <msub> <mi>C</mi> <mn>32</mn> </msub> </mtd> <mtd> <msub> <mi>C</mi> <mn>33</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>
将上式(10)展开得到方程组如下:
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mrow> <mo>(</mo> <msub> <mi>H</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msubsup> <mi>C</mi> <mn>11</mn> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <mo>+</mo> <msubsup> <mi>C</mi> <mn>12</mn> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <mo>+</mo> <msubsup> <mi>C</mi> <mn>13</mn> <mi>b</mi> </msubsup> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mrow> <mo>(</mo> <msub> <mi>H</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>C</mi> <mn>21</mn> </msub> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <mo>+</mo> <msub> <mi>C</mi> <mn>22</mn> </msub> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <mo>+</mo> <msub> <mi>C</mi> <mn>23</mn> </msub> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>H</mi> <mi>S</mi> </msub> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>C</mi> <mn>31</mn> </msub> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>1</mn> </msub> <mi>b</mi> </msubsup> <mo>+</mo> <msub> <mi>C</mi> <mn>32</mn> </msub> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>2</mn> </msub> <mi>b</mi> </msubsup> <mo>+</mo> <msub> <mi>C</mi> <mn>33</mn> </msub> <msubsup> <mi>a</mi> <msub> <mi>s</mi> <mn>3</mn> </msub> <mi>b</mi> </msubsup> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>
通过求解上述方程组,解算出当前时刻的横滚角与俯仰角信息;
步骤七:重复步骤一至步骤六的过程,为无人机系统提供实时的姿态信息。
CN201711137596.XA 2017-11-16 2017-11-16 基于双偏振光矢量的三维姿态信息快速解算方法 Active CN107727101B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711137596.XA CN107727101B (zh) 2017-11-16 2017-11-16 基于双偏振光矢量的三维姿态信息快速解算方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711137596.XA CN107727101B (zh) 2017-11-16 2017-11-16 基于双偏振光矢量的三维姿态信息快速解算方法

Publications (2)

Publication Number Publication Date
CN107727101A true CN107727101A (zh) 2018-02-23
CN107727101B CN107727101B (zh) 2020-09-11

Family

ID=61216921

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711137596.XA Active CN107727101B (zh) 2017-11-16 2017-11-16 基于双偏振光矢量的三维姿态信息快速解算方法

Country Status (1)

Country Link
CN (1) CN107727101B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110702116A (zh) * 2019-10-08 2020-01-17 沈阳航空航天大学 一种基于光电池阵列电流的单位太阳矢量求解方法及测量装置
CN110887475A (zh) * 2019-12-09 2020-03-17 北京航空航天大学 一种基于偏振北极点及偏振太阳矢量的静基座粗对准方法
CN111156956A (zh) * 2020-01-13 2020-05-15 中北大学 基于大气偏振e-矢量模式特征的空间姿态参数获取方法
CN111207773A (zh) * 2020-01-16 2020-05-29 大连理工大学 一种用于仿生偏振光导航的姿态无约束优化求解方法
CN112444245A (zh) * 2020-11-17 2021-03-05 大连理工大学 一种基于偏振光、光流矢量、双目视觉传感器的仿昆虫视觉组合导航方法
CN113819907A (zh) * 2021-11-22 2021-12-21 北京航空航天大学 一种基于偏振和太阳双矢量切换的惯性/偏振导航方法
CN114076594A (zh) * 2020-08-21 2022-02-22 大连理工大学 一种分布式偏振光全球定位测量系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09229600A (ja) * 1996-02-23 1997-09-05 Mitsubishi Electric Corp 飛しょう体の制御装置
CN102902276A (zh) * 2012-10-12 2013-01-30 大连理工大学 一种基于偏振光传感器的飞行控制系统
CN103697893A (zh) * 2013-12-26 2014-04-02 中北大学 利用大气偏振光的三维定姿方法
CN104374388A (zh) * 2014-11-10 2015-02-25 大连理工大学 一种基于偏振光传感器的航姿测定方法
WO2016116511A1 (fr) * 2015-01-21 2016-07-28 Centre National D'etudes Spatiales Senseur stellaire diurne et nocturne à polarisateur actif

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09229600A (ja) * 1996-02-23 1997-09-05 Mitsubishi Electric Corp 飛しょう体の制御装置
CN102902276A (zh) * 2012-10-12 2013-01-30 大连理工大学 一种基于偏振光传感器的飞行控制系统
CN103697893A (zh) * 2013-12-26 2014-04-02 中北大学 利用大气偏振光的三维定姿方法
CN104374388A (zh) * 2014-11-10 2015-02-25 大连理工大学 一种基于偏振光传感器的航姿测定方法
WO2016116511A1 (fr) * 2015-01-21 2016-07-28 Centre National D'etudes Spatiales Senseur stellaire diurne et nocturne à polarisateur actif

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
RENCHENG JIN 等: "Integrated navigation system for UAVs based on the sensor of polarization", 《2016 IEEE INTERNATIONAL CONFERENCE ON MECHATRONICS AND AUTOMATION》 *
ZHONGGUANGYANG 等: "Measuring solar vector with polarization sensors based on polarization pattern", 《OPTIK》 *
任建斌等: "利用大气偏振模式确定姿态参数的方法", 《光子学报》 *
支炜等: "基于偏振光及红外传感器的辅助定姿方法", 《中国惯性技术学报》 *

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110702116A (zh) * 2019-10-08 2020-01-17 沈阳航空航天大学 一种基于光电池阵列电流的单位太阳矢量求解方法及测量装置
CN110702116B (zh) * 2019-10-08 2023-06-20 沈阳航空航天大学 一种基于光电池阵列电流的单位太阳矢量求解方法及测量装置
CN110887475A (zh) * 2019-12-09 2020-03-17 北京航空航天大学 一种基于偏振北极点及偏振太阳矢量的静基座粗对准方法
CN111156956A (zh) * 2020-01-13 2020-05-15 中北大学 基于大气偏振e-矢量模式特征的空间姿态参数获取方法
CN111207773A (zh) * 2020-01-16 2020-05-29 大连理工大学 一种用于仿生偏振光导航的姿态无约束优化求解方法
CN111207773B (zh) * 2020-01-16 2023-04-11 大连理工大学 一种用于仿生偏振光导航的姿态无约束优化求解方法
CN114076594A (zh) * 2020-08-21 2022-02-22 大连理工大学 一种分布式偏振光全球定位测量系统
CN114076594B (zh) * 2020-08-21 2023-12-15 大连理工大学 一种分布式偏振光全球定位测量系统
CN112444245A (zh) * 2020-11-17 2021-03-05 大连理工大学 一种基于偏振光、光流矢量、双目视觉传感器的仿昆虫视觉组合导航方法
CN113819907A (zh) * 2021-11-22 2021-12-21 北京航空航天大学 一种基于偏振和太阳双矢量切换的惯性/偏振导航方法

Also Published As

Publication number Publication date
CN107727101B (zh) 2020-09-11

Similar Documents

Publication Publication Date Title
CN107727101A (zh) 基于双偏振光矢量的三维姿态信息快速解算方法
Wahba A least squares estimate of satellite attitude
CN103033189B (zh) 一种深空探测巡视器惯性/视觉组合导航方法
CN103822635B (zh) 基于视觉信息的无人机飞行中空间位置实时计算方法
CN107588771B (zh) 基于李群描述的捷联惯性导航解算方法
CN104374388B (zh) 一种基于偏振光传感器的航姿测定方法
CN106871928A (zh) 基于李群滤波的捷联惯性导航初始对准方法
CN104729497A (zh) 超小型双涵道无人机组合导航系统及双模式导航方法
CN106767785B (zh) 一种双回路无人机的导航方法及装置
CN105953795B (zh) 一种用于航天器表面巡视的导航装置及方法
CN101344391A (zh) 基于全功能太阳罗盘的月球车位姿自主确定方法
CN109556631A (zh) 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法
CN103913167B (zh) 利用自然光偏振模式确定大气层内飞行器空间姿态的方法
CN109084760B (zh) 一种楼宇间导航系统
CN109506660B (zh) 一种用于仿生导航的姿态最优化解算方法
CN103697893B (zh) 利用大气偏振光的三维定姿方法
CN103017772B (zh) 一种基于可观性分析的光学和脉冲星融合自主导航方法
CN105737858A (zh) 一种机载惯导系统姿态参数校准方法与装置
CN105841698A (zh) 一种无需调零的auv舵角精确实时测量系统
CN108387236A (zh) 一种基于扩展卡尔曼滤波的偏振光slam方法
CN110196445A (zh) 系绳约束下的空间三体系统多传感器精确定位方法
CN107024206A (zh) 一种基于ggi/gps/ins的组合导航系统
CN110044361A (zh) 基于目标投影位置的光学载荷星上自主调度方法
CN111207773A (zh) 一种用于仿生偏振光导航的姿态无约束优化求解方法
Huang et al. Research on UAV flight performance test method based on dual antenna GPS/INS integrated system

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant