CN111750865A - 一种用于双功能深海无人潜器导航***的自适应滤波导航方法 - Google Patents
一种用于双功能深海无人潜器导航***的自适应滤波导航方法 Download PDFInfo
- Publication number
- CN111750865A CN111750865A CN202010634537.9A CN202010634537A CN111750865A CN 111750865 A CN111750865 A CN 111750865A CN 202010634537 A CN202010634537 A CN 202010634537A CN 111750865 A CN111750865 A CN 111750865A
- Authority
- CN
- China
- Prior art keywords
- filtering
- deep sea
- matrix
- navigation
- adaptive
- 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
- 238000001914 filtration Methods 0.000 title claims abstract description 92
- 238000000034 method Methods 0.000 title claims abstract description 60
- 238000005259 measurement Methods 0.000 claims abstract description 33
- 230000007613 environmental effect Effects 0.000 claims abstract description 10
- 230000001588 bifunctional effect Effects 0.000 claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 68
- 230000008569 process Effects 0.000 claims description 29
- 230000003044 adaptive effect Effects 0.000 claims description 25
- XEBWQGVWTUSTLN-UHFFFAOYSA-M phenylmercury acetate Chemical compound CC(=O)O[Hg]C1=CC=CC=C1 XEBWQGVWTUSTLN-UHFFFAOYSA-M 0.000 claims description 6
- 230000009286 beneficial effect Effects 0.000 abstract description 3
- 230000008859 change Effects 0.000 abstract description 3
- 238000004364 calculation method Methods 0.000 description 4
- 238000001514 detection method Methods 0.000 description 4
- 230000005012 migration Effects 0.000 description 4
- 238000013508 migration Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 2
- 238000005265 energy consumption Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
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
- G01C21/203—Specially adapted for sailing ships
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明提出一种用于双功能深海无人潜器导航***的水下自适应滤波导航方法,根据深海潜器不同工作模式实际需求的不同而进行滤波算法的调整,深海潜器处于滑翔模式时,***对稳定性要求高,对导航精度要求一般,滤波算法以保证稳定性为主要目的;当深海潜器处于巡航模式时,滤波需在保证稳定性的基础上尽可能提升导航精度。本发明在增强滤波稳定性、有效避免滤波发散的同时保留其解算精度;还使得滤波更加重视当前的观测信息同时减弱历史观测信息对滤波的影响,增加了对量测噪声变化的跟踪能力;有助于保持滤波的自适应度和鲁棒性,能有效应对水下复杂多变的环境干扰,实现水下高精度导航定位。
Description
技术领域
本发明属于属于导航技术领域,具体涉及一种用于双功能深海无人潜器导航***的改进自适应滤波方法。
背景技术
深海无人潜器在水下实际导航定位工作中需要兼顾精度和能耗的基本条件,不同精度要求下其传感器使用、算法复杂度都有一定差异,继而影响到***功耗的差异。基于以上考虑,我们设计一种双功能深海无人潜器,具备滑翔和巡航两种工作模式。滑翔模式下,其工作任务为跨海域迁徙,无探测任务,此时***要求的稳定性较高,导航精度较低,启用MEMS-IMU和磁力计完成导航解算,***功耗较小;巡航模式下,工作任务为探测与搜寻,此时要在保证稳定性基础上提升导航精度,***启用FOG-IMU、DVL和深度计完成高精度的导航解算。
线性离散的***状态方程和量测方程为:
其中,Xk是线性离散***的状态向量,Zk为***观测向量,Φk,k-1为***的状态转移矩阵,Hk为***的观测矩阵,Wk和Vk分别为***噪声和量测噪声,其统计特性满足以下条件:
其中,qk代表线性离散***的***噪声均值,rk代表量测噪声均值,Qk表示***噪声方差阵,Rk表示量测噪声方差阵,两种噪声方差阵都是不确定的,自适应滤波算法的优势在于能够将量测信息Zk利用起来,并且估计出噪声方差阵Qk和Rk,实时调整滤波的增益K。
在实际应用滤波算法进行导航估计解算时,***噪声方差阵Q和观测噪声方差阵R基本都是预先未知不确定的,当***模型不够精确便会导致滤波精度的下降,甚至会发散。进一步的,如果***模型精确,但在实际工程中,外界复杂多变的环境会导致数学模型产生扰动,即Q、R发生了不可预知的变化。若对***噪声方差阵Q和量测噪声方差阵R同时进行估计,每次滤波都需要估计出***噪声Q和量测噪声R的值,相比于传统的卡尔曼滤波算法此算法的计算量较大,滤波的实时性不够理想,从而导致极易影响到导航算法的实时性,另外Q和R同时估计的过程中,当***噪声和量测噪声同时增强时,仅仅根据新息的值是无法分辨误差来源的,进而有较大可能导致滤波的效果变差,甚至发散。
深海无人潜器处于任一模式下进行工作时,都会受到水下复杂多变环境的干扰,若不能对环境噪声进行良好的估计与补偿,***的导航精度就会受到较大的影响。
发明内容
为解决上述问题,本发明提出一种用于双功能深海无人潜器导航***的水下自适应滤波导航方法,针对不同工作模式下的不同导航需求,滤波算法对应地进行不同的调整,以期有效应对水下复杂多变的环境干扰,实现水下高精度导航定位。深海无人潜器导航***具有滑翔和巡航两种工作状态,分别对应低精度跨海域迁徙和高精度探测搜寻两种工作模式。为了满足两种模式不同的导航精度需求,自适应滤波算法分别作出了相应调整。
为了达到上述目的,本发明提供如下技术方案:
一种双功能深海无人潜器导航***,具备滑翔和巡航两种工作模式,在不同工作模式情况下进行不同的调整来满足对应的导航需求,当深海潜器处于低精度滑翔模式时,在传统卡尔曼滤波的基础上加入对量测噪声方差阵R进行自适应更新的过程,将R表达式中负项去除,在滤波自适应过程中对量测噪声方差阵R表达式中自适应系数进行阶段性更新重置;当深海潜器处于高精度巡航模式时,只对量测噪声方差阵R进行迭代更新,在R更新过程中加入对R矩阵的正定性在线判定,并根据判定结果修正R的表达式;在滤波自适应时对量测噪声方差阵R进行自适应系数更新,并在滤波全过程中加入对状态误差协方差矩阵P和量测噪声协方差矩阵R的上下界限定,将P矩阵的二范数作为判定滤波收敛的必要条件。
进一步的,当深海潜器处于滑翔模式时,包括如下步骤:
(1)在传统卡尔曼滤波基础上加入R矩阵的迭代更新过程实现对环境噪声的跟踪能力,R的具体更新表达式为:
其中自适应系数dk-1=(1-b)/(1-bk-1),b为遗忘因子;
(2)此时导航***对稳定性要求极高,R矩阵的正定性是滤波稳定的必要条件,为保证R矩阵的正定性,此处进一步将R表达式中负项去除,即:
(4)当滤波递推次数k达到阈值时,令dk中k=0,重新开始自适应过程。
进一步的,在步骤(1)之前还包括如下步骤:
建立状态向量X、量测向量Z,并根据已知的器件误差和设定的姿态、速度、位置误差初始化***噪声协方差矩阵Q0、量测噪声协方差矩阵R0和状态误差协方差矩阵P0;所述的状态向量X为:
X=[δvx δvy φx φy φz δL δλ ▽x ▽y εx εy εz]T
其中,δvx、δvy表示东向、北向速度误差,φx、φy、φz表示俯仰、横滚、航向角误差,δL、δλ表示位置误差,▽x、▽y表示加速度计误差,εx、εy、εz表示陀螺随机漂移误差,量测向量Z为单维向量,Z=δφz表示航向角测量误差,Q0、R0、P0均为对角矩阵;
进行常规卡尔曼滤波更新。
进一步的,滤波递推次数k的更新阈值为900。
进一步的,当深海潜器处于巡航模式时,包括如下步骤:
(1)在传统卡尔曼滤波基础上加入R矩阵的迭代更新过程实现对环境噪声的跟踪能力,R的具体更新表达式为:
(3)巡航模式下,为选择在滤波次数k达到阈值时,令dk中k=0,重新开始自适应过程;
(4)对滤波过程中状态误差协方差矩阵P和量测噪声协方差矩阵R的上下界进行限定;
(5)对矩阵P的二范数进行监测,并将其作为判定滤波最终收敛的必要条件。
进一步的,在步骤(1)之前还包括如下步骤:
(1)建立状态向量X、量测向量Z,并根据已知的器件误差和设定的姿态、速度、位置误差初始化***噪声协方差矩阵Q0、量测噪声协方差矩阵R0和状态误差协方差矩阵P0;所述的状态向量X(不考虑天向通道)为:
X=[δvx δvy φx φy φz δL δλ ▽x ▽y εx εy εz δvd δΔ δc]T
其中,δvx、δvy表示东向、北向速度误差,φx、φy、φz表示俯仰、横滚、航向角误差,δL、δλ表示位置误差,▽x、▽y表示加速度计误差,εx、εy、εz表示陀螺随机漂移误差,δvd表示多普勒计程仪的速度偏移误差,δΔ表示偏流角误差,δc表示标度因数误差;
量测向量Z为:
其中vx表示真实东向速度,vdx表示多普勒计程仪东向速度,vx-vdx表示东向速度测量误差,vy-vdy表示北向速度测量误差,Q0、R0、P0均为对角矩阵;
进行常规卡尔曼滤波更新。
进一步的,滤波递推次数k的更新阈值为500。
进一步的,下界值取初值的0.01倍,上界取初值的10倍。
与现有技术相比,本发明具有如下优点和有益效果:
本发明可根据双功能深海潜器不同模式的实际导航需求进行滤波方式的调整,在增强滤波稳定性、有效避免滤波发散的同时保留其解算精度;还使得滤波更加重视当前的观测信息同时减弱历史观测信息对滤波的影响,增加了对量测噪声变化的跟踪能力;有助于保持滤波的自适应度和鲁棒性,能有效应对水下复杂多变的环境干扰,实现水下高精度导航定位。
附图说明
图1为适用于双功能深海无人潜器导航***的自适应滤波流程示意图。
具体实施方式
以下将结合具体实施例对本发明提供的技术方案进行详细说明,应理解下述具体实施方式仅用于说明本发明而不用于限制本发明的范围。
本发明提供了一种用于双功能深海无人潜器导航***的自适应滤波导航方法。深海潜器具备滑翔和巡航两种工作模式,两种模式分别配备不同的导航传感器以满足不同模式下的工作需求。针对跨海域长途迁徙的工作任务,***处于滑翔模式。滑翔模式下,其工作任务为跨海域迁徙,无探测任务,此时***要求的导航精度较低,启用传感器件MEMS-IMU和磁力计完成导航解算,此时导航精度较低,***的能耗很低。传感器具体为ADI公司推出的一款工业级IMU单元ADIS16405,它采用iSensor技术与混合信号处理技术,集成了完整的三轴陀螺仪、三轴加速度计和三轴磁力计,工作时功耗较低,是高集成度的解决方案。针对高精度的搜寻和探测任务,***切换到巡航模式,巡航模式下,工作任务为探测与搜寻,此时精度要求高,***启用FOG-IMU进行惯性导航解算,结合多普勒测速仪(DVL)和深度计进行辅助,完成高精度的导航解算,此时导航定位精度较高。
经过研究发现,在深海潜器导航***中,***噪声主要由惯性器件随机误差引起,且一般在工作以前已经经过了建模补偿,而量测噪声主要是由水下外界环境引起的,此类噪声具有较大的不确定性,无法建模补偿,综合考虑下本发明在传统卡尔曼滤波基础上只加入对量测噪声方差阵的估计。
基础的卡尔曼滤波公式如下:
Pk=(I-KkHk)Pk/k-1
公式含义及相关变量定义可参见《GNSS与惯性及多传感器组合导航***原理》P79。
据此,本发明提出了一种自适应滤波导航方法,如图1所示,包括如下两方面:
1、当深海潜器处于滑翔模式时,自适应滤波导航方法包括以下步骤:
(1)建立状态向量X、量测向量Z,并根据已知的器件误差和设定的姿态、速度、位置误差初始化***噪声协方差矩阵Q0、量测噪声协方差矩阵R0和状态误差协方差矩阵P0。所述的状态向量X(不考虑天向通道)为:
X=[δvx δvy φx φy φz δL δλ ▽x ▽y εx εy εz]T
其中,δvx、δvy表示东向、北向速度误差,φx、φy、φz表示俯仰、横滚、航向角误差,δL、δλ表示位置误差,▽x、▽y表示加速度计误差,εx、εy、εz表示陀螺随机漂移误差。
量测向量Z为单维向量,Z=δφz表示航向角测量误差,Q0、R0、P0均为对角矩阵,设置方法可参考《GNSS与惯性及多传感器组合导航***原理》P77-80。
(2)常规卡尔曼滤波更新。具体更新过程可参考《GNSS与惯性及多传感器组合导航***原理》P79-82。
(3)在传统卡尔曼滤波基础上加入R矩阵的迭代更新过程实现对环境噪声的跟踪能力,R的具体更新表达式为:
其中自适应系数dk-1=(1-b)/(1-bk-1),b为遗忘因子,一般取值为0.95~0.99之间。
(4)此时导航***对稳定性要求极高,R矩阵的正定性是滤波稳定的必要条件,为保证R矩阵的正定性,此处进一步将R表达式中负项去除,即:
(5)由严格数学计算可知,当滤波递推次数k达到约900次后,自适应系数dk逐渐收敛为定值1-b,这就意味着滤波对新近量测信息置信程度较低,原有信息具有较大占比,此时滤波的自适应程度迅速降低,效果较差,不符合预期滤波效果,因此需要对自适应系数进行阶段性更新重置避免其趋于定值,即当滤波递推次数k达到900时,令dk中k=0,重新开始自适应过程。
2、当深海潜器处于巡航模式时,自适应滤波导航方法包括以下步骤:
(1)建立状态向量X、量测向量Z,并根据已知的器件误差和设定的姿态、速度、位置误差初始化***噪声协方差矩阵Q0、量测噪声协方差矩阵R0和状态误差协方差矩阵P0。所述的状态向量X(不考虑天向通道)为:
X=[δvx δvy φx φy φz δL δλ ▽x ▽y εx εy εz δvd δΔ δc]T
其中,δvx、δvy表示东向、北向速度误差,φx、φy、φz表示俯仰、横滚、航向角误差,δL、δλ表示位置误差,▽x、▽y表示加速度计误差,εx、εy、εz表示陀螺随机漂移误差,δvd表示多普勒计程仪的速度偏移误差,δΔ表示偏流角误差,δc表示标度因数误差。
量测向量Z为:
其中vx表示真实东向速度,vdx表示多普勒计程仪东向速度,vx-vdx表示东向速度测量误差,同理,vy-vdy表示北向速度测量误差。Q0、R0、P0均为对角矩阵,设置方法同样参考《GNSS与惯性及多传感器组合导航***原理》P77-80。
(2)常规卡尔曼滤波更新。具体更新过程可参考《GNSS与惯性及多传感器组合导航***原理》P79-82。
(3)同样在传统卡尔曼滤波基础上加入R矩阵的迭代更新过程实现对环境噪声的跟踪能力,R的具体更新表达式为:
(5)巡航模式下,为增强滤波对量测信息的跟踪能力,进一步提升滤波自适应能力和导航精度,选择在滤波次数k达到500时,令dk中k=0,重新开始自适应过程。
(6)进一步地,对滤波过程中状态误差协方差矩阵P和量测噪声协方差矩阵R的上下界进行限定,临界值取决于实际场景,一般下界值取初值的0.01倍,上界取初值的10倍,此举可有效加快滤波的收敛过程,提升滤波精度。
(7)对矩阵P的二范数进行监测,并将其作为判定滤波最终收敛的必要条件。滤波的收敛过程是P矩阵二范数不断减小的过程,一般小于某个阈值可认定滤波收敛完毕,阈值往往是一个小值,可在滤波调试过程中凭经验选取。
本发明方案所公开的技术手段不仅限于上述实施方式所公开的技术手段,还包括由以上技术特征任意组合所组成的技术方案。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也视为本发明的保护范围。
Claims (8)
1.一种用于双功能深海无人潜器导航***的自适应滤波导航方法,具备滑翔和巡航两种工作模式,其特征在于:在不同工作模式情况下进行不同的调整来满足对应的导航需求,当深海潜器处于低精度滑翔模式时,在传统卡尔曼滤波的基础上加入对量测噪声方差阵R进行自适应更新的过程,将R表达式中负项去除,在滤波自适应过程中对量测噪声方差阵R表达式中自适应系数进行阶段性更新重置;当深海潜器处于高精度巡航模式时,只对量测噪声方差阵R进行迭代更新,在R更新过程中加入对R矩阵的正定性在线判定,并根据判定结果修正R的表达式;在滤波自适应时对量测噪声方差阵R进行自适应系数更新,并在滤波全过程中加入对状态误差协方差矩阵P和量测噪声协方差矩阵R的上下界限定,将P矩阵的二范数作为判定滤波收敛的必要条件。
3.根据权利要求2所述的用于双功能深海无人潜器导航***的自适应滤波导航方法,其特征在于,在步骤(1)之前还包括如下步骤:
建立状态向量X、量测向量Z,并根据已知的器件误差和设定的姿态、速度、位置误差初始化***噪声协方差矩阵Q0、量测噪声协方差矩阵R0和状态误差协方差矩阵P0;所述的状态向量X为:
X=[δvx δvy φx φy φz δL δλ ▽x ▽y εx εy εz]T
其中,δvx、δvy表示东向、北向速度误差,φx、φy、φz表示俯仰、横滚、航向角误差,δL、δλ表示位置误差,▽x、▽y表示加速度计误差,εx、εy、εz表示陀螺随机漂移误差,量测向量Z为单维向量,Z=δφz表示航向角测量误差,Q0、R0、P0均为对角矩阵;
进行常规卡尔曼滤波更新。
4.根据权利要求2或3所述的用于双功能深海无人潜器导航***的自适应滤波导航方法,其特征在于,滤波递推次数k的更新阈值为900。
5.根据权利要求1所述的用于双功能深海无人潜器导航***的自适应滤波导航方法,其特征在于,当深海潜器处于巡航模式时,包括如下步骤:
(1)在传统卡尔曼滤波基础上加入R矩阵的迭代更新过程实现对环境噪声的跟踪能力,R的具体更新表达式为:
(3)巡航模式下,为选择在滤波次数k达到阈值时,令dk中k=0,重新开始自适应过程;
(4)对滤波过程中状态误差协方差矩阵P和量测噪声协方差矩阵R的上下界进行限定;
(5)对矩阵P的二范数进行监测,并将其作为判定滤波最终收敛的必要条件。
6.根据权利要求5所述的用于双功能深海无人潜器导航***的自适应滤波导航方法,其特征在于,在步骤(1)之前还包括如下步骤:
(1)建立状态向量X、量测向量Z,并根据已知的器件误差和设定的姿态、速度、位置误差初始化***噪声协方差矩阵Q0、量测噪声协方差矩阵R0和状态误差协方差矩阵P0;所述的状态向量X(不考虑天向通道)为:
X=[δvx δvy φx φy φz δL δλ ▽x ▽y εx εy εz δvd δΔ δc]T
其中,δvx、δvy表示东向、北向速度误差,φx、φy、φz表示俯仰、横滚、航向角误差,δL、δλ表示位置误差,▽x、▽y表示加速度计误差,εx、εy、εz表示陀螺随机漂移误差,δvd表示多普勒计程仪的速度偏移误差,δΔ表示偏流角误差,δc表示标度因数误差;
量测向量Z为:
其中vx表示真实东向速度,vdx表示多普勒计程仪东向速度,vx-vdx表示东向速度测量误差,vy-vdy表示北向速度测量误差,Q0、R0、P0均为对角矩阵;
进行常规卡尔曼滤波更新。
7.根据权利要求5或6所述的用于双功能深海无人潜器导航***的自适应滤波导航方法,其特征在于,滤波递推次数k的更新阈值为500。
8.根据权利要求5或6所述的用于双功能深海无人潜器导航***的自适应滤波导航方法,其特征在于,下界值取初值的0.01倍,上界取初值的10倍。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010634537.9A CN111750865B (zh) | 2020-07-04 | 2020-07-04 | 一种用于双功能深海无人潜器导航***的自适应滤波导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010634537.9A CN111750865B (zh) | 2020-07-04 | 2020-07-04 | 一种用于双功能深海无人潜器导航***的自适应滤波导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111750865A true CN111750865A (zh) | 2020-10-09 |
CN111750865B CN111750865B (zh) | 2023-05-16 |
Family
ID=72679154
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010634537.9A Active CN111750865B (zh) | 2020-07-04 | 2020-07-04 | 一种用于双功能深海无人潜器导航***的自适应滤波导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111750865B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112683271A (zh) * | 2020-12-17 | 2021-04-20 | 东南大学 | 一种考虑可观测性的水域观测平台的组合定位方法 |
CN113959430A (zh) * | 2021-10-13 | 2022-01-21 | 广东汇天航空航天科技有限公司 | 飞行汽车的航姿确定方法、装置、车载终端及存储介质 |
CN114740789A (zh) * | 2022-05-10 | 2022-07-12 | 中国科学院沈阳自动化研究所 | 一种支持双工作模式的轻型长航程auv控制*** |
CN117367410A (zh) * | 2023-12-04 | 2024-01-09 | 中南大学 | 状态估计方法、无人水下航行器及计算机可读存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101393025A (zh) * | 2008-11-06 | 2009-03-25 | 哈尔滨工程大学 | Auv组合导航***无迹切换方法 |
CN104422948A (zh) * | 2013-09-11 | 2015-03-18 | 南京理工大学 | 一种嵌入式组合导航***及其方法 |
CN109443379A (zh) * | 2018-09-28 | 2019-03-08 | 东南大学 | 一种深海潜航器的sins/dvl水下抗晃动对准方法 |
CN109974695A (zh) * | 2019-04-09 | 2019-07-05 | 东南大学 | 基于Krein空间的水面舰艇导航***的鲁棒自适应滤波方法 |
US20190242711A1 (en) * | 2018-02-08 | 2019-08-08 | Raytheon Company | Image geo-registration for absolute navigation aiding using uncertainy information from the on-board navigation system |
-
2020
- 2020-07-04 CN CN202010634537.9A patent/CN111750865B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101393025A (zh) * | 2008-11-06 | 2009-03-25 | 哈尔滨工程大学 | Auv组合导航***无迹切换方法 |
CN104422948A (zh) * | 2013-09-11 | 2015-03-18 | 南京理工大学 | 一种嵌入式组合导航***及其方法 |
US20190242711A1 (en) * | 2018-02-08 | 2019-08-08 | Raytheon Company | Image geo-registration for absolute navigation aiding using uncertainy information from the on-board navigation system |
CN109443379A (zh) * | 2018-09-28 | 2019-03-08 | 东南大学 | 一种深海潜航器的sins/dvl水下抗晃动对准方法 |
CN109974695A (zh) * | 2019-04-09 | 2019-07-05 | 东南大学 | 基于Krein空间的水面舰艇导航***的鲁棒自适应滤波方法 |
Non-Patent Citations (1)
Title |
---|
章怀宇等: "面向深海无人潜航器的导航***设计与实现", 《船舶工程》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112683271A (zh) * | 2020-12-17 | 2021-04-20 | 东南大学 | 一种考虑可观测性的水域观测平台的组合定位方法 |
CN112683271B (zh) * | 2020-12-17 | 2023-10-27 | 东南大学 | 一种考虑可观测性的水域观测平台的组合定位方法 |
CN113959430A (zh) * | 2021-10-13 | 2022-01-21 | 广东汇天航空航天科技有限公司 | 飞行汽车的航姿确定方法、装置、车载终端及存储介质 |
CN113959430B (zh) * | 2021-10-13 | 2023-12-22 | 广东汇天航空航天科技有限公司 | 飞行汽车的航姿确定方法、装置、车载终端及存储介质 |
CN114740789A (zh) * | 2022-05-10 | 2022-07-12 | 中国科学院沈阳自动化研究所 | 一种支持双工作模式的轻型长航程auv控制*** |
CN114740789B (zh) * | 2022-05-10 | 2024-04-19 | 中科星图深海科技有限公司 | 一种支持双工作模式的轻型长航程auv控制*** |
CN117367410A (zh) * | 2023-12-04 | 2024-01-09 | 中南大学 | 状态估计方法、无人水下航行器及计算机可读存储介质 |
CN117367410B (zh) * | 2023-12-04 | 2024-03-19 | 中南大学 | 状态估计方法、无人水下航行器及计算机可读存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN111750865B (zh) | 2023-05-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109211276B (zh) | 基于gpr与改进的srckf的sins初始对准方法 | |
CN111024064B (zh) | 一种改进Sage-Husa自适应滤波的SINS/DVL组合导航方法 | |
CN107621264B (zh) | 车载微惯性/卫星组合导航***的自适应卡尔曼滤波方法 | |
CN111750865A (zh) | 一种用于双功能深海无人潜器导航***的自适应滤波导航方法 | |
CN108827310B (zh) | 一种船用星敏感器辅助陀螺仪在线标定方法 | |
CN110687799B (zh) | 一种智能船舶自动舵***的模糊自适应输出反馈控制方法及*** | |
CN105136145A (zh) | 一种基于卡尔曼滤波的四旋翼无人机姿态数据融合的方法 | |
CN105806363B (zh) | 基于srqkf的sins/dvl水下大失准角对准方法 | |
CN110954102B (zh) | 用于机器人定位的磁力计辅助惯性导航***及方法 | |
CN109945859B (zh) | 一种自适应h∞滤波的运动学约束捷联惯性导航方法 | |
CN108387236B (zh) | 一种基于扩展卡尔曼滤波的偏振光slam方法 | |
CN111897225B (zh) | 一种智能船舶自动舵***的模糊自适应输出反馈控制方法及*** | |
CN110940340A (zh) | 基于小型uuv平台的多传感器信息融合方法 | |
CN112432644A (zh) | 基于鲁棒自适应无迹卡尔曼滤波的无人艇组合导航方法 | |
CN110595434B (zh) | 基于mems传感器的四元数融合姿态估计方法 | |
CN111190207B (zh) | 基于pstcsdref算法的无人机ins bds组合导航方法 | |
CN116007620A (zh) | 一种组合导航滤波方法、***、电子设备及存储介质 | |
CN113434806B (zh) | 一种抗差自适应多模型滤波方法 | |
CN116222551A (zh) | 一种融合多种数据的水下导航方法及装置 | |
CN114964226A (zh) | 噪声自适应强跟踪扩展卡尔曼滤波器四旋翼姿态解算方法 | |
CN113175926B (zh) | 一种基于运动状态监测的自适应水平姿态测量方法 | |
CN111982126B (zh) | 一种全源BeiDou/SINS弹性状态观测器模型设计方法 | |
CN110873577B (zh) | 一种水下快速动基座对准方法及装置 | |
CN110375773B (zh) | Mems惯导***姿态初始化方法 | |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |