CN113834484A - 一种基于非瑞利散射模型误差的惯导/偏振组合导航方法 - Google Patents
一种基于非瑞利散射模型误差的惯导/偏振组合导航方法 Download PDFInfo
- Publication number
- CN113834484A CN113834484A CN202111417764.7A CN202111417764A CN113834484A CN 113834484 A CN113834484 A CN 113834484A CN 202111417764 A CN202111417764 A CN 202111417764A CN 113834484 A CN113834484 A CN 113834484A
- Authority
- CN
- China
- Prior art keywords
- error
- rayleigh scattering
- navigation
- polarization
- scattering model
- 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
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/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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于非瑞利散射模型误差的惯导/偏振组合导航方法。首先,基于缓变小角度近似假设,引入非瑞利散射模型误差并与捷联惯导误差状态联合构建扩维系统状态向量,以扩维后的系统状态微分方程作为组合导航系统的状态方程;以偏振矢量与太阳矢量之间的点积作为量测建立量测方程,同时在量测方程中加入对非瑞利散射模型误差的建模;应用扩展卡尔曼滤波方法对扩维状态量进行估计并反馈,从而提高组合导航系统针对模型误差的抗干扰能力。本发明提出的基于非瑞利散射模型误差的惯导/偏振组合导航方法可以实现针对非瑞利散射模型误差的在线估计和补偿,从而提高不良气象环境和非理想瑞利散射条件下惯导/偏振组合系统的导航精度。
Description
技术领域
本发明涉及导航领域,尤其是一种基于非瑞利散射模型误差的惯导/偏振组合导航方法,该方法对非瑞利散射模型误差进行表征,建立了基于非瑞利散射模型误差的惯导/偏振组合导航模型,同时应用EKF完成状态估计。
背景技术
高精度定姿一直是导航领域备受关注的问题,捷联惯导/GPS组合导航系统无疑是现有最成熟的组合导航系统,差分GPS具有高精度定向的能力,但是GPS信号易受干扰限制了其在复杂环境下的应用,因此,自主导航系统成为人们关注的热点。
捷联惯导系统凭借自身的完全自主性是自主导航领域的代表,其在短时间内具有高精度导航能力,但由于惯性器件漂移的存在,其输出的导航信息包含了累计误差,而且误差随时间增加而增大,这使其无法长时间高精度工作。面对复杂环境对自主导航方式的迫切需求,人们开始将注意力转向仿生导航。随着偏振导航方式的出现,仿生偏振导航近几年发展迅速,因其在定向上的独立自主特性受到导航领域的广泛关注。
目前,仿生偏振导航方式中应用最广泛的是单次Rayleigh散射理论,其假设太阳光经过大气层后被大气分子散射一次,且大气分子粒子直径远小于光波波长。单次Rayleigh散射对导航的贡献在于其理论蕴含的几何关系,即偏振矢量垂直于由太阳矢量与观测矢量构成的散射平面,其原理简单,受到导航领域的青睐。论文“天空偏振光辅助的组合导航方法”利用偏振传感器输出的航向信息与惯导输出航向直接作差构建量测进行导航,取得了不错的效果,此方法需要对角度的方向性进行判定;中国授权专利CN 110779514A同样基于单次Rayleigh散射建立了惯导/偏振组合子系统;论文“惯性/偏振光组合定姿技术研究”利用预测偏振矢量和实测偏振矢量间的差值作为量测构建了惯导/偏振组合导航模型,其充分利用了单次Rayleigh散射理论中矢量间的垂直关系;论文“Method andImplementation of a Bioinspired Polarization-Based Attitude and HeadingReference System by Integration of Polarization Compass and Inertial Sensors”巧妙地利用矢量间夹角的关系,将偏振矢量与太阳矢量之间夹角的余弦作为量测进行导航,其同样是利用了Rayleigh散射理论中矢量间的垂直关系。上述专利论文均只考虑理想条件下的单次Rayleigh散射模型,未考虑非理想条件下的非瑞利散射模型误差对系统的影响,非瑞利散射模型误差的存在将直接影响系统姿态精度。因此,含非瑞利散射模型误差的惯导/偏振组合导航方法亟待研究。
发明内容
本发明为了解决上述问题,克服现有技术的不足,针对偏振导航中由于实际大气中气溶胶等微粒多次散射引起的非瑞利散射模型误差问题,提出了一种基于非瑞利散射模型误差的惯导/偏振组合导航方法,将非瑞利散射模型误差引入惯导/偏振组合导航系统的建模中,同时对其进行在线估计与抑制,提高系统的抗干扰能力与精度。
本发明的技术解决方案为:一种基于非瑞利散射模型误差的惯导/偏振组合导航方法,具体实现步骤如下:
第三步,将第一步中的非瑞利散射模型误差差引入偏振矢量,为由传感器坐标系到载体系间的姿态转换矩阵,同时利用偏振矢量、n系下太阳矢量s n 与惯导解算得到的姿态旋转矩阵构建量测Z,进而完成基于非瑞利散射模型误差的量测建模,h(X)为量测函数,v为量测噪声,与第二步中的状态方程共同构成惯导/偏振组合导航的系统模型;
第四步,在第三步所建系统模型的基础上,应用扩展卡尔曼滤波方法对系统状态进行估计并反馈得到修正后的姿态旋转矩阵为b系到n系的旋转矩阵理想值,为实际计算的b系到n系的旋转矩阵,为姿态失准角的反对称矩阵,进而通过姿态旋转矩阵得到俯仰角,横滚角和航向角,将其作为捷联解算过程的初值重复第一、二、三、四步,完成惯导/偏振组合导航。
为了简化建模,将非瑞利散射模型误差建模为5°以内的缓变小角度常值,因此,所述的非瑞利散射模型误差具有以下特点:
进一步地,所述第二步中,将第一步中的非瑞利散射模型误差与惯导失准角、速度误差,位置误差共同构成组合导航模型中的状态变量,、分别为陀螺、加计的常值漂移;进而建立组合导航系统的状态方程,F为状态转移矩阵,W为过程噪声,具体实现如下:
导航系统涉及两种坐标系:导航系,即n系,坐标轴分别指向东(E)、北(N)、天(U);载体系,即b系,坐标轴分别指向载体右(x),前(y),上(z)。
捷联惯导误差状态方程如下:
失准角动态方程:
速度误差动态方程:
位置误差动态方程:
漂移动态方程:
其中,V n 为载体在n系下的速度,为速度误差;为位置误差,分别为纬度误差、经度误差、高度误差;为地球自转角速度在n系下的投影,为的误差,为n系相对于e系(地球坐标系)的角速度在n系下的投影,为的误差,为b系到n系的旋转矩阵;f b 为b系下加速度,、分别为陀螺、加计的常值漂移;为位置误差导数与速度误差之间的关系矩阵,为位置误差导数与速度之间的关系矩阵;
整合捷联惯导误差状态与非瑞利散射模型误差得到系统状态变量:
系统状态方程为:
其中,F为状态转移矩阵,W为过程噪声。
进一步地,所述第三步中,将第一步中的非瑞利散射模型误差引入偏振矢量,为由传感器坐标系到载体系间的姿态转换矩阵,同时利用偏振矢量、n系下太阳矢量s n 与惯导解算得到的姿态旋转矩阵构建量测Z,进而完成基于非瑞利散射模型误差的量测建模,h(X)为量测函数,v为量测噪声,与第二步中的状态方程共同构成惯导/偏振组合导航的系统模型:
利用矢量点积建立偏振量测,具体模型推导如下:
根据小角度假设,对l进行泰勒展开,只保留一阶项,得到:
其中,
由于惯性器件漂移的存在使得姿态旋转矩阵存在如下关系:
则偏振量测为:
考虑传感器噪声,得到基于非瑞利散射模型误差的偏振量测方程:
因此,惯导/偏振组合导航的系统模型为:
与现有的技术相比,本发明具有以下的优点:
目前存在的组合导航方法,尚未考虑传感器解算误差以及非瑞利散射模型误差对导航的影响,本发明中引入误差非瑞利散射模型误差对非瑞利偏振方位角进行建模,同时利用滤波方法对其进行在线估计与抑制,使得组合系统在非瑞利天气下仍然能够正常工作,提高惯导/偏振组合导航的抗干扰能力和精度。
附图说明
图1为本发明一种基于非瑞利散射模型误差的惯导/偏振组合导航方法的流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整的描述,显然,所描述的实施例仅为本发明的一部分实施例,而不是全部的实施例,基于本发明中的实施例,本领域的普通技术人员在不付出创造性劳动的前提下所获得的所有其他实施例,都属于本发明的保护范围。
非瑞利天气下气溶胶等粒子的多次散射等问题将使得瑞利散射理论不再适用,这也意味着沿用瑞利散射理论的导航方法将存在非瑞利散射模型误差,本发明提出的一种基于非瑞利散射模型误差的惯导/偏振组合导航方法可以实现非瑞利散射模型误差的在线估计与抑制,实现惯导/偏振组合系统在非瑞利天气下的高精度导航。
如图1所示,本发明涉及一种基于非瑞利散射模型误差的惯导/偏振组合导航方法。第一步,考虑非理想瑞利天气下由于气溶胶多次散射引起的非瑞利散射模型误差对组合导航的影响,对非瑞利散射模型误差进行建模,记为非瑞利散射模型误差;
为了简化建模,将非瑞利散射模型误差建模为5°以内的缓变小角度常值,因此,所述的非瑞利散射模型误差具有以下特点:
导航系统涉及两种坐标系:导航系,即n系,坐标轴分别指向东(E)、北(N)、天(U);载体系,即b系,坐标轴分别指向载体右(x),前(y),上(z);
捷联惯导误差状态方程如下:
失准角动态方程:
速度误差动态方程:
位置误差动态方程:
漂移动态方程:
其中,V n 为载体在n系下的速度,为速度误差;为位置误差,分别为纬度误差、经度误差、高度误差;为地球自转角速度在n系下的投影矢量,为的误差,为n系相对于e系(地球坐标系)的角速度在n系下的投影,为的误差,为b系到n系的旋转矩阵;f b 为b系下加速度,、分别为陀螺、加计的常值漂移;为位置误差导数与速度误差之间的关系矩阵,为位置误差导数与速度之间的关系矩阵;
整合捷联惯导误差状态与非瑞利散射模型误差得到系统状态变量:
系统状态方程为:
其中,F为状态转移矩阵,W为过程噪声。
第三步、将第一步中的非瑞利散射模型误差引入偏振矢量,为由传感器坐标系到载体系间的姿态转换矩阵,同时利用偏振矢量、n系下太阳矢量s n 与惯导解算得到的姿态旋转矩阵构建量测Z,进而完成基于非瑞利散射模型误差的量测建模为量测函数,v为量测噪声,与第二步中的状态方程共同构成惯导/偏振组合导航的系统模型;
利用矢量点积建立偏振量测,具体模型推导如下:
根据小角度假设,对l进行泰勒展开,只保留一阶项,得到:
其中,
由于惯性器件漂移的存在使得姿态旋转矩阵存在如下关系:
则偏振量测为:
考虑传感器噪声,得到基于非瑞利散射模型误差的偏振量测方程:
因此,惯导/偏振组合导航的系统模型为:
第四步、在第三步所建系统模型的基础上,应用扩展卡尔曼滤波方法对系统状态进行估计并反馈得到修正后的姿态旋转矩阵,为b系到n系的旋转矩阵修正值,为实际计算的b系到n系的旋转矩阵,为姿态失准角的反对称矩阵,进而通过姿态旋转矩阵得到俯仰角,横滚角和航向角,将其作为捷联解算过程的初值重复第一、二、三、四步,完成惯导/偏振组合导航。
尽管上面对本发明说明性的具体实施方式进行了描述,以便于本技术领域的技术人员理解本发明,且应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (4)
1.一种基于非瑞利散射模型误差的惯导/偏振组合导航方法,其特征在于,包括以下步骤:
第三步,将第一步中的非瑞利散射模型误差引入偏振矢量,为由传感器坐标系到载体系间的姿态转换矩阵,同时利用偏振矢量、n系下太阳矢量s n 与惯导解算得到的姿态旋转矩阵构建量测Z,进而完成基于非瑞利散射模型误差的量测建模,h(X)为量测函数,v为量测噪声,与第二步中的状态方程共同构成惯导/偏振组合导航的系统模型;
3.根据权利要求1所述的一种基于非瑞利散射模型误差的惯导/偏振组合导航方法,其特征在于:所述第二步中,将第一步中的非瑞利散射模型误差与惯导失准角、速度误差,位置误差共同构成组合导航模型中的状态变量,进而建立组合导航系统的状态方程,F为状态转移矩阵,W为过程噪声,具体实现如下:
导航系统涉及两种坐标系:导航系,即n系,坐标轴分别指向东、北、天;载体系,即b系,坐标轴分别指向载体右,前,上;
捷联惯导误差状态方程如下:
失准角动态方程:
速度误差动态方程:
位置误差动态方程:
漂移动态方程:
其中,V n 为载体在n系下的速度,为速度误差;为位置误差,分别为纬度误差、经度误差、高度误差;为地球自转角速度在n系下的投影,为的误差,为n系相对于地球坐标系即e系的角速度在n系下的投影,为的误差,为b系到n系的旋转矩阵;f b 为b系下加速度,、分别为陀螺、加计的常值漂移;为位置误差导数与速度误差之间的关系矩阵,为位置误差导数与速度之间的关系矩阵;
整合捷联惯导误差状态与非瑞利散射模型误差得到系统状态变量:
系统状态方程为:
其中,F为状态转移矩阵,W为过程噪声。
4.根据权利要求1所述的一种基于非瑞利散射模型误差的惯导/偏振组合导航方法,其特征在于:所述第三步中,将第一步中的非瑞利散射模型误差引入偏振矢量,为由传感器坐标系到载体系间的姿态转换矩阵,同时利用偏振矢量、n系下太阳矢量s n 与惯导解算得到的姿态旋转矩阵构建量测Z,进而完成基于非瑞利散射模型误差的量测建模为量测函数,v为量测噪声,与第二步中的状态方程共同构成惯导/偏振组合导航的系统模型,具体实现步骤如下:
利用矢量点积建立偏振量测,具体模型推导如下:
根据小角度假设,对l进行泰勒展开,只保留一阶项,得到:
其中,
由于惯性器件漂移的存在使得姿态旋转矩阵存在如下关系:
则偏振量测为:
考虑传感器噪声,得到基于非瑞利散射模型误差的偏振量测方程:
因此,惯导/偏振组合导航的系统模型为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111417764.7A CN113834484B (zh) | 2021-11-26 | 2021-11-26 | 一种基于非瑞利散射模型误差的惯导/偏振组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111417764.7A CN113834484B (zh) | 2021-11-26 | 2021-11-26 | 一种基于非瑞利散射模型误差的惯导/偏振组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113834484A true CN113834484A (zh) | 2021-12-24 |
CN113834484B CN113834484B (zh) | 2022-03-08 |
Family
ID=78971598
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111417764.7A Active CN113834484B (zh) | 2021-11-26 | 2021-11-26 | 一种基于非瑞利散射模型误差的惯导/偏振组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113834484B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040061863A1 (en) * | 2002-08-20 | 2004-04-01 | Digonnet Michel J.F. | Fiber optic sensors with reduced noise |
CN108225336A (zh) * | 2018-01-24 | 2018-06-29 | 北京航空航天大学 | 一种基于置信度的偏振自主组合导航方法 |
CN109506660A (zh) * | 2019-01-08 | 2019-03-22 | 大连理工大学 | 一种用于仿生导航的姿态最优化解算方法 |
CN109556631A (zh) * | 2018-11-26 | 2019-04-02 | 北方工业大学 | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法 |
CN109556632A (zh) * | 2018-11-26 | 2019-04-02 | 北方工业大学 | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 |
CN110672130A (zh) * | 2019-11-19 | 2020-01-10 | 北方工业大学 | 一种大失准角下惯性/偏振光组合导航系统ekf对准方法 |
CN111504312A (zh) * | 2020-07-02 | 2020-08-07 | 中国人民解放军国防科技大学 | 一种基于视觉惯性偏振光融合的无人机位姿估计方法 |
CN113137977A (zh) * | 2021-04-21 | 2021-07-20 | 扬州大学 | 一种sins/偏振光组合导航初始对准滤波方法 |
-
2021
- 2021-11-26 CN CN202111417764.7A patent/CN113834484B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040061863A1 (en) * | 2002-08-20 | 2004-04-01 | Digonnet Michel J.F. | Fiber optic sensors with reduced noise |
CN108225336A (zh) * | 2018-01-24 | 2018-06-29 | 北京航空航天大学 | 一种基于置信度的偏振自主组合导航方法 |
CN109556631A (zh) * | 2018-11-26 | 2019-04-02 | 北方工业大学 | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法 |
CN109556632A (zh) * | 2018-11-26 | 2019-04-02 | 北方工业大学 | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 |
CN109506660A (zh) * | 2019-01-08 | 2019-03-22 | 大连理工大学 | 一种用于仿生导航的姿态最优化解算方法 |
CN110672130A (zh) * | 2019-11-19 | 2020-01-10 | 北方工业大学 | 一种大失准角下惯性/偏振光组合导航系统ekf对准方法 |
CN111504312A (zh) * | 2020-07-02 | 2020-08-07 | 中国人民解放军国防科技大学 | 一种基于视觉惯性偏振光融合的无人机位姿估计方法 |
CN113137977A (zh) * | 2021-04-21 | 2021-07-20 | 扬州大学 | 一种sins/偏振光组合导航初始对准滤波方法 |
Non-Patent Citations (2)
Title |
---|
冯路明等: "惯性/偏振光组合定姿技术研究", 《航天控制》 * |
宫晓琳等: "SINS快速精确传递对准技术研究", 《宇航学报》 * |
Also Published As
Publication number | Publication date |
---|---|
CN113834484B (zh) | 2022-03-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103245360B (zh) | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 | |
CN101846510B (zh) | 一种基于星敏感器和陀螺的高精度卫星姿态确定方法 | |
CN106643709B (zh) | 一种海上运载体的组合导航方法及装置 | |
CN100559125C (zh) | 一种基于Euler-q算法和DD2滤波的航天器姿态确定方法 | |
CN104880191B (zh) | 一种基于太阳矢量的偏振辅助导航方法 | |
CN105698822B (zh) | 基于反向姿态跟踪的自主式惯性导航行进间初始对准方法 | |
CN101261130B (zh) | 一种船用光纤捷联惯导系统传递对准精度评估方法 | |
CN110567454A (zh) | 一种复杂环境下sins/dvl紧组合导航方法 | |
CN101949703A (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN111623771B (zh) | 一种基于光强的偏振惯导紧组合导航方法 | |
CN104713555A (zh) | 应用全天域中性点辅助定向的车辆自主导航方法 | |
CN108444476B (zh) | 一种考虑水声通信延迟的多水下无人航行器极区协同导航方法 | |
CN106997061B (zh) | 一种基于扰动星间相对速度提高重力场反演精度的方法 | |
CN103017787A (zh) | 适用于摇摆晃动基座的初始对准方法 | |
CN103900608A (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN109489661B (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN113834483A (zh) | 一种基于可观测度的惯性/偏振/地磁容错导航方法 | |
CN110887472B (zh) | 一种偏振-地磁信息深度融合全自主姿态解算方法 | |
CN103123487B (zh) | 一种航天器姿态确定方法 | |
CN113503892A (zh) | 一种基于里程计和回溯导航的惯导系统动基座初始对准方法 | |
CN109708663A (zh) | 基于空天飞机sins辅助的星敏感器在线标定方法 | |
CN105606093B (zh) | 基于重力实时补偿的惯性导航方法及装置 | |
CN111722295A (zh) | 一种水下捷联式重力测量数据处理方法 | |
CN104501809A (zh) | 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法 | |
CN113108781B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |