CN108225336B - 一种基于置信度的偏振自主组合导航方法 - Google Patents
一种基于置信度的偏振自主组合导航方法 Download PDFInfo
- Publication number
- CN108225336B CN108225336B CN201810066303.1A CN201810066303A CN108225336B CN 108225336 B CN108225336 B CN 108225336B CN 201810066303 A CN201810066303 A CN 201810066303A CN 108225336 B CN108225336 B CN 108225336B
- Authority
- CN
- China
- Prior art keywords
- vector
- polarization
- coordinate system
- solar
- sun
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/02—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
- G01C21/025—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means with the use of startrackers
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于置信度的偏振自主组合导航方法,首先利用载体上携带的多个偏振传感器阵列测量计算得到模块坐标系下天空中多个偏振矢量,再将其转化到本体坐标系下;然后由瑞利散射模型,建立偏振矢量与太阳矢量的关系;利用多偏振矢量与太阳的关系,通过建立置信度函数来得到量测太阳矢量,最后通过卡尔曼滤波器对导航参数进行估计。该方法是利用大气中多点的偏振信息进行信息融合辅助导航,精度高,避免了单个点易受环境因素的干扰,能够实现高环境适应性、自主导航。
Description
技术领域
本发明属于组合导航领域,具体涉及一种基于置信度的偏振自主组合导航方法。
背景技术
太阳光入射到地球,由于地球大气中的各种气溶胶粒子和气体分子,太阳光会出现散射,140多年前英国科学家瑞利提出了瑞利散射模型,随后人们利用瑞利散射获得了大气偏振分布模型,该模型是稳定的。通过不断的研究发现,很多生物利用天空偏振光进行导航或者辅助导航,例如,沙蚁可以通过观察天空偏振光进行觅食和归巢,维京人利用方解石观察天空偏振模式进行航海。偏振导航具有隐蔽性强、无源、无辐射等特点,可以运用于多种复杂环境,是现代导航技术的一个新方向。
现有的点源式偏振辅助导航利用的偏振传感器数量较少,只能测得太空中少数点的偏振模式,且单点的偏振模式容易受到云层等干扰,未能充分利用大气中的偏振信息。中国专利一种基于天空偏振光分布模式的导航定位方法,专利号:201410012966.7,提出一种基于偏振分布模式的导航定位方法,利用全天空偏振模式进行偏振匹配,但该模式易受环境影响,并且建立模式难度较大;中国专利基于多方向偏振光的实时导航装置,专利号:201610717237.0,利用五个偏振传感器测量偏振矢量,认为偏振度大的传感器测量的偏振矢量信息较准确,用最准确的两个矢量进行融合得到太阳矢量,未能从太阳矢量自身出发去判断精度,信息过滤较多,且传感器数量较少,测量获得的偏振信息有限。
发明内容
本发明要解决的技术问题是:克服现有技术的不足,提供一种基于置信度的偏振自主组合导航方法,利用多个偏振传感器得到模块坐标系下的偏振矢量,通过矢量叉乘得到太阳矢量的方向,再通过基于置信度的动态信息分配得到更加准确的太阳矢量信息,然后由经纬度和时间信息解算地理系下的单位太阳矢量St。最后利用得到的不同坐标系下的单位太阳矢量建立偏振导航线性模型,通过卡尔曼滤波器对导航参数进行估计。
本发明解决上述技术问题采用的技术方案为:一种基于置信度的偏振自主组合导航方法,实现步骤如下:
步骤(2)利用载体的地理位置信息和时间信息,确定地理坐标系下的标准太阳矢量St;
步骤(4)通过将标准太阳矢量St转化到本体坐标系中得到本体坐标系下的标准矢量Sb,以矢量Sb为半径,以观测点为球心,根据球心角建立太阳矢量的置信度;
步骤(6)对步骤(5)中的量测太阳矢量和步骤(2)中的标准太阳矢量进行做差,得到偏振量测信息,与惯性导航组合,通过卡尔曼滤波,得到更高精度的姿态信息;
所述步骤(1)具体实现如下:
其中,为第i个传感器的偏振方位角,mi表示模块坐标系下的第i个偏振传感器,利用第i偏振传感器安装角度αi、βi和μi,设m表示模块坐标系,b表示本体坐标系,t表示地理坐标系。则可以求得第i个偏振传感器的模块坐标系与本体坐标系的转换矩阵如下:
所述步骤(2)具体实现如下:
所述步骤(3)偏振矢量和太阳矢量的关系具体实现如下:
根据瑞利散射模型,太阳矢量始终垂直于偏振矢量,因此,任意两个不平行的偏振矢量相互叉乘,即可得到测量太阳矢量的方向,再进行单位化可得到测量太阳矢量。
其中wij为测量噪声,||Eij||为矢量Eij的模值。
所述步骤(4)测量太阳矢量的置信度的建立具体实现如下:
由于实际的本体坐标系下的标准太阳矢量和测量的太阳矢量是较为相近的,由本体坐标系下的标准太阳矢量Sb和观测点建立的单位球,此时,由圆心角A得到测量的偏振矢量根据经验设置信度函数为:
所述步骤(5)量测太阳矢量具体实现如下:
不同偏振矢量的融合协方差矩阵为Pij,对融合系数进行动态信息分配,则可以都得到:
其中||·||p为矩阵对角线元素的绝对值和的平方根,mij为得到的太阳矢量的置信度。
所述步骤(6)所述组合导航系统实现如下:
其中,φ为平台失准角,(St)×如下:
最后,以SINS误差方程作为状态方程,通过组合导航滤波器得到载体的导航数据。
本发明与现有技术相比的优点在于:
(1)本发明提出了一种基于置信度的偏振自主组合导航方法,通过多个偏振传感器采集天空中多个偏振矢量,然后根据偏振矢量与太阳矢量垂直的特点,通过矢量叉乘得到太阳矢量,对得到的多个太阳矢量进行信息融合,最后通过与经纬度和时间计算的太阳矢量做差,得到导航系统的姿态量测模型,通过与惯性导航组合进行卡尔曼滤波,得到更加准确的姿态信息。
(2)本发明采用的偏振传感器为自主导航传感器,通过多个偏振矢量信息融合,可以避免因为单传感器照到天空云层或者其他干扰物引起的测量不准确,通过多个太阳矢量的融合,提高了系统的鲁棒性和抗干扰能力。
(3)本发明提出的一种基于置信度的偏振自主组合导航方法,可以有效判断两个偏振矢量融合后得到太阳矢量的精度,利用多个偏振传感器的信息,使得得到太阳矢量信息更加准确。
附图说明
图1为本发明的一种基于置信度的偏振自主组合导航方法流程图;
图2为本发明涉及模块系下测量太阳矢量Sm;
图3为本发明涉及当地地理坐标系下标准太阳矢量St;
图4为本发明涉及太阳矢量置信区间图。
具体实施方式
下面结合附图以及具体实施方式进一步说明本发明。
如图1所示,本发明一种基于置信度的偏振自主组合导航方法的具体实现步骤如下:
1、在图2所示的偏振传感器安装在载体上,以偏振传感器为基准建立模块坐标系,模块坐标系x轴沿载体横轴指向右侧,y轴沿载体纵轴指向载体前方,z轴沿载体竖轴指向载体上方,利用N个偏振传感器获取多个偏振方位角则模块系下的偏振矢量如图3所示,其中E1……E10为偏振矢量,模块坐标系下其表达式为:
3、根据瑞利散射模型,太阳矢量始终垂直于偏振矢量,因此,任意两个不平行的偏振矢量相互叉乘,即可得到太阳矢量的方向,再进行单位化可得到测量太阳矢量。
其中wij为测量噪声,||Eij||为矢量Eij的模值。
由于实际的本体坐标系下的标准太阳矢量和测量的太阳矢量是较为相近的,由本体坐标系下的标准太阳矢量Sb和观测点建立的单位球,此时,由圆心角A得到测量的偏振矢量,置信度分布图如图4所示,根据经验设置信度函数为:
不同偏振矢量的融合协方差矩阵为Pij,对融合系数进行动态信息分配,则可以都得到:
其中||·||p为矩阵对角线元素的绝对值和的平方根,mij为得到的太阳矢量的置信度。
6、采用卡尔曼滤波器,以SINS误差方程作为状态方程,状态方程为
其中,X=[φEφNφUδVEδVNδVUδLδλδhεxεyεz▽x▽y▽z]为状态量,F(t)为状态转移矩阵,G(t)为噪声转移矩阵,W(t)为系统干扰。
其中,φ为平台失准角,(St)×如下:
采用卡尔曼滤波方法对所述的偏振惯性组合导航状态方程和量测方程进行滤波处理,得到载体姿态的估计值,即得到所述载体的导航信息。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。
Claims (7)
1.一种基于置信度的偏振自主组合导航方法,其特征在于:该方法实现步骤如下:
步骤(2)、利用载体的地理位置信息和时间信息,确定地理坐标系下的标准太阳矢量St;
步骤(4)、通过将标准太阳矢量St转化到本体坐标系中得到本体坐标系下的标准矢量Sb,以矢量Sb为半径,以观测点为球心,根据球心角建立太阳矢量的置信度;
步骤(6)、对步骤(5)中的量测太阳矢量和步骤(2)中的标准太阳矢量进行做差,得到偏振量测信息,与惯性导航组合,通过卡尔曼滤波,得到更高精度的姿态信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810066303.1A CN108225336B (zh) | 2018-01-24 | 2018-01-24 | 一种基于置信度的偏振自主组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810066303.1A CN108225336B (zh) | 2018-01-24 | 2018-01-24 | 一种基于置信度的偏振自主组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108225336A CN108225336A (zh) | 2018-06-29 |
CN108225336B true CN108225336B (zh) | 2021-06-25 |
Family
ID=62668689
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810066303.1A Active CN108225336B (zh) | 2018-01-24 | 2018-01-24 | 一种基于置信度的偏振自主组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108225336B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11168984B2 (en) * | 2019-02-08 | 2021-11-09 | The Boeing Company | Celestial navigation system and method |
CN110887509B (zh) * | 2019-12-09 | 2021-09-07 | 北京航空航天大学 | 一种仿复眼偏振传感器多方向标定方法 |
CN110887476B (zh) * | 2019-12-09 | 2021-08-13 | 北京航空航天大学 | 基于偏振-天文夹角信息观测的自主航向与姿态确定方法 |
CN110887478B (zh) * | 2019-12-09 | 2021-09-07 | 北京航空航天大学 | 一种基于偏振/天文辅助的自主导航定位方法 |
CN111220150B (zh) * | 2019-12-09 | 2021-09-14 | 北京航空航天大学 | 一种基于水下偏振分布模式的太阳矢量解算方法 |
CN113819907B (zh) * | 2021-11-22 | 2022-02-11 | 北京航空航天大学 | 一种基于偏振和太阳双矢量切换的惯性/偏振导航方法 |
CN113834484B (zh) * | 2021-11-26 | 2022-03-08 | 北京航空航天大学 | 一种基于非瑞利散射模型误差的惯导/偏振组合导航方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104880191A (zh) * | 2015-06-02 | 2015-09-02 | 北京航空航天大学 | 一种基于太阳矢量的偏振辅助导航方法 |
CN104880192A (zh) * | 2015-06-12 | 2015-09-02 | 北京航空航天大学 | 一种基于偏振罗盘的载体航向角计算方法 |
CN106767752A (zh) * | 2016-11-25 | 2017-05-31 | 北京航空航天大学 | 一种基于偏振信息的组合导航方法 |
CN107063170A (zh) * | 2017-03-31 | 2017-08-18 | 中国人民解放军国防科学技术大学 | 复杂环境下基于大气偏振角模式的航向角估计方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9383261B2 (en) * | 2014-06-13 | 2016-07-05 | Ge Aviation Systems Llc | Method of eliminating spurious signals and a relative navigation system |
-
2018
- 2018-01-24 CN CN201810066303.1A patent/CN108225336B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104880191A (zh) * | 2015-06-02 | 2015-09-02 | 北京航空航天大学 | 一种基于太阳矢量的偏振辅助导航方法 |
CN104880192A (zh) * | 2015-06-12 | 2015-09-02 | 北京航空航天大学 | 一种基于偏振罗盘的载体航向角计算方法 |
CN106767752A (zh) * | 2016-11-25 | 2017-05-31 | 北京航空航天大学 | 一种基于偏振信息的组合导航方法 |
CN107063170A (zh) * | 2017-03-31 | 2017-08-18 | 中国人民解放军国防科学技术大学 | 复杂环境下基于大气偏振角模式的航向角估计方法 |
Non-Patent Citations (2)
Title |
---|
Polarized Light Compass-Aided Visual-Inertial Navigation Under Foliage Environment;Wang Yujie,etc;《IEEE SENSORS JOURNAL》;20170930;第17卷(第17期);第5646-5653页 * |
仿生偏振光导航传感器量测模型研究;卢皓等;《军械工程学院学报》;20131231;第25卷(第6期);第72-75页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108225336A (zh) | 2018-06-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108225336B (zh) | 一种基于置信度的偏振自主组合导航方法 | |
CN108759819B (zh) | 一种基于全天域偏振度信息的偏振导航实时定位方法 | |
Mandlburger et al. | Evaluation of a novel UAV-borne topo-bathymetric laser profiler | |
CN109459027B (zh) | 一种基于偏振-地磁矢量紧组合的导航方法 | |
CN113219496A (zh) | 一种星载海洋大气参数激光雷达探测系统 | |
CN102175241B (zh) | 一种火星探测器巡航段自主天文导航方法 | |
CN109556631B (zh) | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法 | |
CN106679645A (zh) | 基于多方向偏振光的实时导航装置 | |
CN111947652A (zh) | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 | |
CN110132308B (zh) | 一种基于姿态确定的usbl安装误差角标定方法 | |
CN106093892A (zh) | 基于标校卫星同时开展雷达rcs标定与外测标定系统 | |
EP1724592A1 (fr) | Système d'estimation de la vitesse d'un aéronef et son application à la détection d'obstacles | |
CN103968834B (zh) | 一种近地停泊轨道上深空探测器的自主天文导航方法 | |
CN110567454A (zh) | 一种复杂环境下sins/dvl紧组合导航方法 | |
CN108919304B (zh) | 一种基于参考平面的移动测量系统中pos误差补偿方法 | |
CN113280785B (zh) | 基于偏振模式一致性的天空偏振光定向方法 | |
CN113834480A (zh) | 一种基于散射角权重分配的仿复眼偏振传感器自主定位方法 | |
Tang et al. | Application of polarized light compass system on solar position calculation | |
CN113819904B (zh) | 一种基于天顶点矢量的偏振/vio三维姿态确定方法 | |
CN113341432B (zh) | 基于激光雷达卫星的地基激光雷达气溶胶反演方法及系统 | |
CN103344252B (zh) | 一种航空高光谱成像系统定位误差分析方法 | |
Chu et al. | Design of a novel polarization sensor for navigation | |
CN114964259A (zh) | 基于红外焦平面阵列时域信号与红外图像的姿态解算方法及系统 | |
KR100543971B1 (ko) | 태양과 지피에스를 이용한 자세 방위각 측정시스템 및 그측정방법 | |
CN114025320A (zh) | 一种基于5g信号的室内定位方法 |
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 |