[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

CN115574766A - 一种面向遮挡环境的偏振融合定向方法 - Google Patents

一种面向遮挡环境的偏振融合定向方法 Download PDF

Info

Publication number
CN115574766A
CN115574766A CN202211169884.4A CN202211169884A CN115574766A CN 115574766 A CN115574766 A CN 115574766A CN 202211169884 A CN202211169884 A CN 202211169884A CN 115574766 A CN115574766 A CN 115574766A
Authority
CN
China
Prior art keywords
time
polarization
frequency
course angle
orientation method
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.)
Pending
Application number
CN202211169884.4A
Other languages
English (en)
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.)
North University of China
Original Assignee
North University of China
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 North University of China filed Critical North University of China
Priority to CN202211169884.4A priority Critical patent/CN115574766A/zh
Publication of CN115574766A publication Critical patent/CN115574766A/zh
Priority to US18/332,788 priority patent/US20240111062A1/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/35Constructional details or hardware or software details of the signal processing chain
    • G01S19/37Hardware or software details of the signal processing chain
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C1/00Measuring angles
    • 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/02Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
    • 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
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/393Trajectory determination or predictive tracking, e.g. Kalman filtering

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Signal Processing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Automation & Control Theory (AREA)
  • Astronomy & Astrophysics (AREA)
  • Filters That Use Time-Delay Elements (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种面向遮挡环境的偏振融合定向方法,首先通过偏振相机采集天空偏振图像,然后将E矢量偏振定向方法输出的航向角作为状态量,以拟合对称轴偏振定向方法输出的航向角作为观测量,通过多频变分贝叶斯强跟踪容积卡尔曼滤波器(MF‑VBSTCKF)实现航向角融合,针对采样处及采样间隔期间,分别选择不同的方法更新最优航向角。本发明解决了偏振光在遮挡环境下不能实现高精度、高鲁棒航向角测量的问题,可以提高遮挡环境下偏振光定向方法的精度和鲁棒性,同时确保航向角的高频输出。

Description

一种面向遮挡环境的偏振融合定向方法
技术领域
本发明涉及偏振光定向与信息融合技术领域,具体地说,是指一种面向遮挡环境的偏振融合定向方法。
背景技术
导航技术是为载体提供持续、安全、可靠服务的重要技术,惯性导航系统(INS)和全球卫星导航系统(GNSS)是目前应用最广泛的导航系统。然而,在某些情况下,它们可能变得不可靠。例如INS的导航误差随时间累积,GNSS信号容易受到电磁干扰。随着对动物导航机制的深入研究,偏振定向技术由于具有长航时、高精度、抗电磁干扰等优异性能,已被应用于无人车、无人机等各种无人平台。
虽然在偏振定向方法已经取得了显著的进展,例如在晴天条件下具有较高定向精度和实时性的E矢量偏振定向方法和遮挡环境下抗干扰能力较强的拟合对称轴偏振定向方法,但这些的方法仍然有一些局限性。特别是缺乏对云、树、建筑物等不同遮挡条件的考虑,使得偏振罗盘在遮挡环境下无法发挥实时性和高精度的优势。因此,在遮挡环境下,很难做到高精度和高实时性的偏振定向。
发明内容
发明目的:为了解决现有技术中偏振光罗盘在遮挡环境中难以实现高精度、高实时性航向角测量的问题,本发明提供一种面向遮挡环境的偏振融合定向方法。
技术方案:一种面向遮挡环境的偏振融合定向方法,包括以下步骤:
步骤一:利用偏振相机获取天空偏振图像,根据天空偏振图像,分别采用E矢量偏振定向方法及拟合对称轴偏振定向方法计算航向角,采用拟合对称轴偏振定向方法时,由于需进行图像重绘,其采样频率相对较低;
步骤二:将E矢量偏振定向方法输出的航向角作为状态量,拟合对称轴偏振定向方法输出的航向角作为观测量,将状态量和观测量输入多频率变分贝叶斯强跟踪容积卡尔曼滤波器,进行航向角融合;
步骤三:已知观测矩阵,在低频率的观测量采样处,高频率的状态量和低频率的观测量均存在,利用观测矩阵计算残差及估计误差,再通过多频率变分贝叶斯强跟踪容积卡尔曼滤波器更新此时的最优航向角;
已知状态转移矩阵,在低频率的观测量采样间隔期间,低频率的观测量不存在,利用状态转移矩阵更新估计误差,利用更新后的估计误差更新残差,再利用更新后的残差更新最优航向角。
进一步地,步骤一中,在E矢量偏振定向方法中,首先计算天顶区域的偏振信息,通过查阅太阳星历获取导航坐标系下的太阳方位角
Figure BDA0003858368570000011
然后根据瑞利散射理论中入射光E矢量垂直于观测方向和太阳向量组成的平面来获取航向角;
在拟合对称轴偏振定向方法中,通过计算所有区域的偏振信息,重新绘制偏振角图像并选择AOP值接近90°的点来拟合太阳子午线,最终确定相机坐标系下的太阳子午线与载体体轴的夹角αs,由
Figure BDA0003858368570000021
αs计算出航向角;
根据φ、
Figure BDA0003858368570000022
αs分别计算两种方法各自的航向角:
Figure BDA0003858368570000023
Figure BDA0003858368570000024
其中,
Figure BDA0003858368570000025
是E矢量偏振定向方法得到的航向角,φ是偏振角,
Figure BDA0003858368570000026
是导航坐标系下的太阳方位角,
Figure BDA0003858368570000027
是拟合对称轴偏振定向方法得到的航向角。
进一步地,步骤二中,航向角融合的具体方法为:
假设高频率的状态量和低频率的观测量均存在,基于多频率变分贝叶斯强跟踪容积卡尔曼滤波器通过变分贝叶斯方法近似状态量和观测噪声方差的联合后验分布,该联合后验分布表示为高斯分布和逆伽马分布的乘积:
Figure BDA0003858368570000028
其中,p(xk,Rk|z1:k)是k时刻的联合后验分布,Pk是k时刻的滤波估计协方差,xk,zk分别表示k时刻的状态量和观测量,
Figure BDA0003858368570000029
表示k时刻状态量的估值,λk,μk是逆伽马分布参数,N(·)表示高斯分布,IG(·)表示逆伽马分布,观测噪声方差Rk可由下式计算得到:
Rk=(λk-n-1)-1μk (4)
其中,n是观测量的维数,λk和μk通过以下公式更新:
λk=1+λk/k-1 (5)
Figure BDA00038583685700000210
其中,λk/k-1和μk/k-1是k-1时刻到k时刻的逆伽马分布参数,m=2n为容积点的数量,j=1,2,…,m,zk,j为第j个容积点的观测量;
同时,基于多频率变分贝叶斯强跟踪容积卡尔曼滤波器通过引入衰落因子τk来实时调整Pk/k-1
Figure BDA00038583685700000211
其中,Pk/k-1表示k-1时刻到k时刻的滤波估计协方差,xk/k-1,j表示k-1时刻到k时刻的第j个容积点的状态量预测值,
Figure BDA0003858368570000031
表示k-1时刻到k时刻的状态量预测值,Qk为状态噪声方差,τk表示为:
Figure BDA0003858368570000032
Figure BDA0003858368570000033
tr(·)表示矩阵的迹,Vk是残差的协方差阵,zk/k-1,j表示k-1时刻到k时刻的第j个容积点的观测量预测值,
Figure BDA0003858368570000034
表示k-1时刻到k时刻的观测量预测值,ρ是遗忘因子,取值ρ=0.95,γk为残差,表示为:
Figure BDA0003858368570000035
其中,Hk代表观测矩阵。
进一步地,步骤三中,在低频率的观测量采样处,高频率的状态量和低频率的观测量均存在,残差、估计误差及最优航向角的计算公式为:
其中,γk、βk分别为k时刻的残差和估计误差,xk,zk分别表示k时刻的状
Figure BDA0003858368570000036
态量和观测量,
Figure BDA0003858368570000037
表示k时刻状态量的估值,
Figure BDA0003858368570000038
表示k-1时刻到k时刻的状态量预测值,Hk代表观测矩阵,Kk为卡尔曼滤波增益,
Figure BDA0003858368570000039
表示k-1时刻到k时刻的观测量的预测值。
进一步地,步骤三中,在低频率的观测量采样间隔期间,低频率的观测量不存在,估计误差、残差及最优航向角的计算公式为:
Figure BDA00038583685700000310
其中,βk+1、γk+1分别为k+1时刻的估计误差和残差,Fk是系统的状态转移矩阵,
Figure BDA00038583685700000311
表示k+1时刻状态量的估值,
Figure BDA00038583685700000312
表示k时刻到k+1时刻的状态量预测值,∈k+1=diag([∈1,k,∈2,k,…∈n,k+1])是调整因子。
有益效果:相比较现有技术,本发明提供一种面向遮挡环境的偏振融合定向方法,将基于E矢量偏振定向方法和拟合对称轴偏振定向方法进行融合,同时解决了遮挡环境下E矢量偏振定向方法精度差、拟合对称轴偏振定向方法实时性差的问题,使偏振光罗盘在遮挡环境下也可实现高精度、高实时性定向,提高了偏振罗盘的鲁棒性;
通过引入衰落因子来调节增益矩阵的输出,实现了对系统状态的快速跟踪。同时,以系统状态和观测噪声方差为待估计变量,在每次递归状态估计前通过变分贝叶斯学习迭代逼近得到观测噪声的后验分布,从而提高航向角的估计精度;
通过引入基于残差补偿的多频数据融合算法来解决采样频率不同导致的数据融合问题,在低频数据采样间隔处,对高频数据进行时间更新和残差补偿,从而实现航向角的无缝融合和输出。
附图说明
图1是面向遮挡环境的偏振融合定向方法的流程图;
图2是多频变分贝叶斯强跟踪容积卡尔曼滤波器的示意图;
图3是本发明在静态遮挡环境下的航向角误差图;
图4是本发明在动态遮挡环境下的航向角误差图。
具体实施方式
下面结合附图和具体实施例对本发明做进一步解释说明。
如图1所示,一种面向遮挡环境的偏振融合定向方法,包括以下步骤:
步骤一:利用偏振相机获取天空偏振图像,根据天空偏振图像,分别采用E矢量偏振定向方法及拟合对称轴偏振定向方法计算航向角,采用拟合对称轴偏振定向方法时,由于需进行图像重绘,其采样频率相对较低。
本实施例中,在E矢量偏振定向方法中,首先通过天空偏振图像计算天顶区域的偏振信息,选择有效观测点G,其观测方向在入射光坐标系i中可以表示为:
Figure BDA0003858368570000041
其中,O表示偏振罗盘的位置;
在入射光坐标系i中,入射光E矢量的方向可以用偏振角φ表示:
Figure BDA0003858368570000042
太阳向量
Figure BDA0003858368570000043
在导航坐标系中可以表示为:
Figure BDA0003858368570000044
其中,
Figure BDA0003858368570000045
和hs是通过太阳星历解算出的太阳在导航坐标系中的方位角和高角度;
然后根据瑞利散射模型,入射光E矢量垂直于观测方向和太阳向量组成的平面,所以有:
Figure BDA0003858368570000051
其中,c是可以使两侧模相等的常量,
Figure BDA0003858368570000052
Figure BDA0003858368570000053
生成的反对称矩阵,
Figure BDA0003858368570000054
是从导航坐标系到入射光坐标系的方向余弦矩阵,
Figure BDA0003858368570000055
可由航向角
Figure BDA0003858368570000056
表示;
Figure BDA0003858368570000057
最终,E矢量偏振定向方法的航向角
Figure BDA0003858368570000058
通过下式获得:
Figure BDA0003858368570000059
其中,φ为偏振角,
Figure BDA00038583685700000510
是导航坐标系下的太阳方位角。
拟合对称轴偏振定向方法是通过计算所有区域的偏振信息,根据AOP分布以太阳子午线为对称轴并呈现反对称分布的显著特征,提取太阳子午线周围点的偏振信息;接下来,重新绘制AOP图像,并选择AOP值接近90°的点。最后,将这些点投影到二维平面上,用最小二乘法拟合出太阳子午线,最终确定相机坐标系下的太阳子午线与载体体轴的夹角αs,拟合对称轴偏振定向方法的航向角
Figure BDA00038583685700000511
可表示为:
Figure BDA00038583685700000512
其中,
Figure BDA00038583685700000513
是E矢量偏振定向方法得到的航向角,φ是偏振角,
Figure BDA00038583685700000514
是导航坐标系下的太阳方位角,
Figure BDA00038583685700000515
是拟合对称轴偏振定向方法得到的航向角。
步骤二:将E矢量偏振定向方法输出的航向角作为状态量,拟合对称轴偏振定向方法输出的航向角作为观测量,将状态量和观测量输入如图2所示的多率变分贝叶斯强跟踪容积卡尔曼滤波器(MF-VBSTCKF),进行航向角融合。
航向角融合的具体方法为:
假设高频率的状态量和低频率的观测量均存在,基于多频率变分贝叶斯强跟踪容积卡尔曼滤波器通过变分贝叶斯方法近似状态量和观测噪声方差的联合后验分布,该联合后验分布表示为高斯分布和逆伽马分布的乘积:
Figure BDA00038583685700000516
其中,p(xk,Rk|z1:k)是k时刻的联合后验分布,Pk是k时刻的滤波估计协方差,xk,zk分别表示k时刻的状态量和观测量,
Figure BDA00038583685700000517
表示k时刻状态量的估值,λk,μk是逆伽马分布参数,N(·)表示高斯分布,IG(·)表示逆伽马分布,观测噪声方差Rk可由下式计算得到:
Rk=(λk-n-1)-1μk (9)
其中,n是观测量的维数,λk和μk通过以下公式更新:
λk=1+λk/k-1 (10)
Figure BDA0003858368570000061
其中,λk/k-1和μk/k-1是k-1时刻到k时刻的逆伽马分布参数,m=2n为容积点的数量,j=1,2,…,m,zk,j为第j个容积点的观测量;
同时,基于多频率变分贝叶斯强跟踪容积卡尔曼滤波器通过引入衰落因子τk来实时调整Pk/k-1,从而实现对状态量的快速跟踪,
Figure BDA0003858368570000062
其中,Pk/k-1表示k-1时刻到k时刻的滤波估计协方差,xk/k-1,j表示k-1时刻到k时刻的第j个容积点的状态量预测值,
Figure BDA0003858368570000063
表示k-1时刻到k时刻的状态量预测值,Qk为状态噪声方差,τk表示为:
Figure BDA0003858368570000064
Figure BDA0003858368570000065
tr(·)表示矩阵的迹,Vk是残差的协方差阵,zk/k-1,j表示k-1时刻到k时刻的第j个容积点的观测量预测值,
Figure BDA0003858368570000066
表示k-1时刻到k时刻的观测量预测值,ρ是遗忘因子,取值ρ=0.95,γk为残差,表示为:
Figure BDA0003858368570000067
其中,Hk代表观测矩阵。
步骤三:针对低频率的观测量采样处及间隔处,选择使用不同的方法更新最优航向角。因为采样间隔处,不存在低频率的观测量,无法通过式(9)(11)更新观测噪声方差,因此需要根据不同情况选择不同更新方法。
(a)在低频率的观测量采样处,高频率的状态量和低频率的观测量均存在,可以根据观测函数获取观测矩阵,利用观测矩阵计算残差及估计误差,再通过多频率变分贝叶斯强跟踪容积卡尔曼滤波器更新此时的最优航向角;
因高频状态量和低频观测量均存在,因此残差可由公式(15)表示,而估计误差βk表示为:
Figure BDA0003858368570000071
当低频率的观测量存在时,最优航向角更新公式为:
Figure BDA0003858368570000072
其中,γk、βk分别为k时刻的残差和估计误差,xk,zk分别表示k时刻的状态量和观测量,
Figure BDA0003858368570000073
表示k时刻状态量的估值,
Figure BDA0003858368570000074
表示k-1时刻到k时刻的状态量预测值,Hk代表观测矩阵,Kk为卡尔曼滤波增益,
Figure BDA0003858368570000075
表示k-1时刻到k时刻的观测量的预测值。
(b)在低频率的观测量采样间隔期间,低频率的观测量不存在,无法通过式(9)、(11)更新观测噪声方差,Rk+1会趋于无穷大,而k+1时刻的卡尔曼增益Kk+1会趋于零,因此k+1时刻的估计误差可以表示为:
Figure BDA0003858368570000076
其中,Fk是系统的状态转移矩阵,
Figure BDA0003858368570000077
为k时刻到k+1时刻的状态量预测值。
由于观测量zk+1不存在,无法通过式(15)更新残差,此时选择利用估计误差更新残差:
Figure BDA0003858368570000078
以上,当低频率的观测量不存在时,由式(18)可知估计误差可进行连续自更新,而由式(19)可知,残差可以用估计误差来表示,在常规形式下的滤波中,最优航向角可以由式(17)表示,而在低频率的观测量采样间隔,卡尔曼增益的大小是未知的并且其值理论上非常小,因此最优航向角的估计公式可以调整为
Figure BDA0003858368570000079
其中,βk+1、γk+1分别为k+1时刻的估计误差和残差,
Figure BDA00038583685700000710
表示k+1时刻状态量的估值,∈k+1=diag([∈1,k,∈2,k,…∈n,k+1])是调整因子,相当于卡尔曼增益。
为了验证本方法的效果,通过以下对比实验进行说明。实验所用的偏振罗盘是由偏振相机以及NVIDIA Jetson TX2开发板组成。参考系统的航向角来自高精度紧凑型光纤组合导航系统SPAN-KVH1750,其航向精度可达0.035°,采样频率设置为4HZ。图1为面向遮挡环境的偏振融合定向方法的流程图,其中E矢量偏振定向方法的采样频率为4HZ,拟合对称轴偏振定向方法的采样频率为1HZ。图2是多频变分贝叶斯强跟踪容积卡尔曼滤波器的示意图,TE和TS分别为E矢量偏振定向方法和的拟合对称轴偏振定向方法采样周期。为了证明本发明的有效性,给出了不同遮挡环境下采用单一偏振定向方法和两种偏振定向方法采用不同融合算法后的对比实验结果。对比采用的融合算法包括:多频率容积卡尔曼滤波算法(MF-CKF)、多频率强跟踪容积卡尔曼滤波算法(MF-STCKF)、多频率变分贝叶斯强跟踪容积卡尔曼滤波算法(MF-VBSTCKF)。图3是本发明在静态遮挡环境下各种方法的航向角误差图,图4是本发明在动态遮挡环境下各种方法的航向角误差图。从图3、图4中可以看出,由于遮挡的影响,E矢量偏振定向方法得到的航向角度变化较大,降低了航向精度。拟合对称轴偏振定向方法得到的航向角即使在有遮挡的情况下也能保持较高的精度,但输出频率较低。通过对低频数据区间的状态量进行残差补偿,所有融合算法的输出频率与E矢量偏振定向方法一致。在三种融合方法中,MF-CKF的最优航向角估计精度最差,MF-STCKF通过引入强跟踪衰落因子,可以更好地跟踪目标状态,但由于观测噪声缺乏实时性估计和更新,仍然存在误差,MF-VBSTCKF利用变分贝叶斯方法在时变噪声自适应估计方面的优势,可以在保持较高跟踪精度的同时,显著提高航向角的估计性能,减小航向误差,以上可以说明所提出的面向遮挡环境的偏振融合定向方法可以实现高精度、高鲁棒性航向角测量。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明精神和原则之内所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (5)

1.一种面向遮挡环境的偏振融合定向方法,其特征在于,包括以下步骤:
步骤一:利用偏振相机获取天空偏振图像,根据天空偏振图像,分别采用E矢量偏振定向方法及拟合对称轴偏振定向方法计算航向角,采用拟合对称轴偏振定向方法时,由于需进行图像重绘,其采样频率相对较低;
步骤二:将E矢量偏振定向方法输出的航向角作为状态量,拟合对称轴偏振定向方法输出的航向角作为观测量,将状态量和观测量输入多频率变分贝叶斯强跟踪容积卡尔曼滤波器,进行航向角融合;
步骤三:已知观测矩阵,在低频率的观测量采样处,高频率的状态量和低频率的观测量均存在,利用观测矩阵计算残差及估计误差,再通过多频率变分贝叶斯强跟踪容积卡尔曼滤波器更新此时的最优航向角;
已知状态转移矩阵,在低频率的观测量采样间隔期间,低频率的观测量不存在,利用状态转移矩阵更新估计误差,利用更新后的估计误差更新残差,再利用更新后的残差更新最优航向角。
2.根据权利要求1所述的面向遮挡环境的偏振融合定向方法,其特征在于,步骤一中,在E矢量偏振定向方法中,首先计算天顶区域的偏振信息,通过查阅太阳星历获取导航坐标系下的太阳方位角
Figure FDA0003858368560000011
然后根据瑞利散射理论中入射光E矢量垂直于观测方向和太阳向量组成的平面来获取航向角;
在拟合对称轴偏振定向方法中,通过计算所有区域的偏振信息,重新绘制偏振角图像并选择AOP值接近90°的点来拟合太阳子午线,最终确定相机坐标系下的太阳子午线与载体体轴的夹角αs,由
Figure FDA0003858368560000012
αs计算出航向角;
根据φ、
Figure FDA0003858368560000013
αs分别计算两种方法各自的航向角:
Figure FDA0003858368560000014
Figure FDA0003858368560000015
其中,
Figure FDA0003858368560000016
是E矢量偏振定向方法得到的航向角,φ是偏振角,
Figure FDA0003858368560000017
是导航坐标系下的太阳方位角,
Figure FDA0003858368560000018
是拟合对称轴偏振定向方法得到的航向角。
3.根据权利要求1或2所述的面向遮挡环境的偏振融合定向方法,其特征在于,步骤二中,航向角融合的具体方法为:
假设高频率的状态量和低频率的观测量均存在,基于多频率变分贝叶斯强跟踪容积卡尔曼滤波器通过变分贝叶斯方法近似状态量和观测噪声方差的联合后验分布,该联合后验分布表示为高斯分布和逆伽马分布的乘积:
Figure FDA0003858368560000019
其中,p(xk,Rk|z1:k)是k时刻的联合后验分布,Pk是k时刻的滤波估计协方差,xk,zk分别表示k时刻的状态量和观测量,
Figure FDA0003858368560000021
表示k时刻状态量的估值,λk,μk是逆伽马分布参数,N(·)表示高斯分布,IG(·)表示逆伽马分布,观测噪声方差Rk可由下式计算得到:
Rk=(λk-n-1)-1μk (4)
其中,n是观测量的维数,λk和μk通过以下公式更新:
λk=1+λk/k-1 (5)
Figure FDA0003858368560000022
其中,λk/k-1和μk/k-1是k-1时刻到k时刻的逆伽马分布参数,m=2n为容积点的数量,j=1,2,…,m,zk,j为第j个容积点的观测量;
同时,基于多频率变分贝叶斯强跟踪容积卡尔曼滤波器通过引入衰落因子τk来实时调整Pk/k-1
Figure FDA0003858368560000023
其中,Pk/k-1表示k-1时刻到k时刻的滤波估计协方差,xk/k-1,j表示k-1时刻到k时刻的第j个容积点的状态量预测值,
Figure FDA0003858368560000024
表示k-1时刻到k时刻的状态量预测值,Qk为状态噪声方差,τk表示为:
Figure FDA0003858368560000025
Figure FDA0003858368560000026
tr(·)表示矩阵的迹,Vk是残差的协方差阵,zk/k-1,j表示k-1时刻到k时刻的第j个容积点的观测量预测值,
Figure FDA0003858368560000027
表示k-1时刻到k时刻的观测量预测值,ρ是遗忘因子,取值ρ=0.95,γk为残差,表示为:
Figure FDA0003858368560000028
其中,Hk代表观测矩阵。
4.根据权利要求1或2所述的面向遮挡环境的偏振融合定向方法,其特征在于,步骤三中,在低频率的观测量采样处,高频率的状态量和低频率的观测量均存在,残差、估计误差及最优航向角的计算公式为:
Figure FDA0003858368560000031
其中,γk、βk分别为k时刻的残差和估计误差,xk,zk分别表示k时刻的状态量和观测量,
Figure FDA0003858368560000032
表示k时刻状态量的估值,
Figure FDA0003858368560000033
表示k-1时刻到k时刻的状态量预测值,Hk代表观测矩阵,Kk为卡尔曼滤波增益,
Figure FDA0003858368560000034
表示k-1时刻到k时刻的观测量的预测值。
5.根据权利要求1或2所述的面向遮挡环境的偏振融合定向方法,其特征在于,步骤三中,在低频率的观测量采样间隔期间,低频率的观测量不存在,估计误差、残差及最优航向角的计算公式为:
Figure FDA0003858368560000035
其中,βk+1、γk+1分别为k+1时刻的估计误差和残差,Fk是系统的状态转移矩阵,
Figure FDA0003858368560000036
表示k+1时刻状态量的估值,
Figure FDA0003858368560000037
表示k时刻到k+1时刻的状态量预测值,∈k+1=diag([∈1,k,∈2,k,…∈n,k+1])是调整因子。
CN202211169884.4A 2022-09-22 2022-09-22 一种面向遮挡环境的偏振融合定向方法 Pending CN115574766A (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202211169884.4A CN115574766A (zh) 2022-09-22 2022-09-22 一种面向遮挡环境的偏振融合定向方法
US18/332,788 US20240111062A1 (en) 2022-09-22 2023-06-12 Polarization fusion orientation method for occluded environment

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211169884.4A CN115574766A (zh) 2022-09-22 2022-09-22 一种面向遮挡环境的偏振融合定向方法

Publications (1)

Publication Number Publication Date
CN115574766A true CN115574766A (zh) 2023-01-06

Family

ID=84580304

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211169884.4A Pending CN115574766A (zh) 2022-09-22 2022-09-22 一种面向遮挡环境的偏振融合定向方法

Country Status (2)

Country Link
US (1) US20240111062A1 (zh)
CN (1) CN115574766A (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118464019B (zh) * 2024-07-10 2024-09-13 北京航空航天大学 一种考虑未知干扰的水下惯性/差分偏振紧组合导航方法

Also Published As

Publication number Publication date
US20240111062A1 (en) 2024-04-04

Similar Documents

Publication Publication Date Title
Wang et al. Student’s t-based robust Kalman filter for a SINS/USBL integration navigation strategy
CN113203418B (zh) 基于序贯卡尔曼滤波的gnssins视觉融合定位方法及系统
CN106772524B (zh) 一种基于秩滤波的农业机器人组合导航信息融合方法
CN107255795B (zh) 基于ekf/efir混合滤波的室内移动机器人定位方法和装置
Wang et al. Adaptive H-infinite Kalman filter based on multiple fading factors and its application in unmanned underwater vehicle
CN110514203B (zh) 一种基于isr-ukf的水下组合导航方法
CN111964667B (zh) 一种基于粒子滤波算法的地磁_ins组合导航方法
CN109059911B (zh) 一种gnss、ins和气压计的数据融合方法
CN111238467A (zh) 一种仿生偏振光辅助的无人作战飞行器自主导航方法
CN113253325B (zh) 惯性卫星序贯紧组合李群滤波方法
CN109506660A (zh) 一种用于仿生导航的姿态最优化解算方法
Zhang et al. Application of modified ekf based on intelligent data fusion in auv navigation
CN113686299B (zh) 一种海上动态目标定位与移速预测方法
CN107525523B (zh) 卫星导航辅助sins进行初始方位对准的方法及装置
CN113739795A (zh) 一种基于偏振光/惯性/视觉组合导航的水下同步定位与建图方法
CN111156986A (zh) 一种基于抗差自适应ukf的光谱红移自主组合导航方法
CN110779514B (zh) 面向仿生偏振导航辅助定姿的分级卡尔曼融合方法及装置
CN111238485B (zh) 一种基于导航敏感器拍摄火星图像的系统误差自补偿方法
CN115574766A (zh) 一种面向遮挡环境的偏振融合定向方法
Han et al. Precise positioning with machine learning based Kalman filter using GNSS/IMU measurements from android smartphone
Zhang et al. RETRACTED: An improved RISS-GPS ship navigation approach via azimuth updates and magnetometer-calibration technology
CN116222551A (zh) 一种融合多种数据的水下导航方法及装置
CN115878939A (zh) 基于飞行器舵面偏转的高精度动态测量方法
CN115113646A (zh) 基于卡尔曼滤波的卫星编队平根状态连续估计方法及系统
CN115014321B (zh) 一种基于自适应鲁棒滤波的仿生偏振多源融合定向方法

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