CN106017467B - 一种基于多水下应答器的惯性/水声组合导航方法 - Google Patents
一种基于多水下应答器的惯性/水声组合导航方法 Download PDFInfo
- Publication number
- CN106017467B CN106017467B CN201610623261.8A CN201610623261A CN106017467B CN 106017467 B CN106017467 B CN 106017467B CN 201610623261 A CN201610623261 A CN 201610623261A CN 106017467 B CN106017467 B CN 106017467B
- Authority
- CN
- China
- Prior art keywords
- auv
- underwater
- transponder
- navigation
- information
- 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
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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明涉及一种基于多水下应答器的惯性/水声组合导航方法,其技术特点包括:水下应答器布放与位置标定;通过距离变换位置算法计算AUV的绝对位置信息;通过AUV中的惯性导航系统INS/DVL与计算得到的AUV绝对位置信息进行位置组合导航算法来校正自身航位推算误差;布放一个后续水下应答器,利用AUV与当前水下应答器之间的距离组合输出去估计出后续水下应答器位置,AUV再与后续水下应答器进行距离组合导航,并重复执行上述过程。本发明能够充分结合惯性导航、水声导航的二者信息优势,同时考虑到水下应用的实际背景,通过在AUV航行路径上接力式地布放一系列水下应答器,仅利用水声距离信息解决了水下AUV导航设备的校准问题,具有广泛的应用前景。
Description
技术领域
本发明属于惯性导航与水声定位技术领域,尤其是一种基于多水下应答器的惯性/水声组合导航方法。
背景技术
光学捷联惯导技术成熟解决了海上无人装备对惯导系统小型化以及高可靠性的问题,其通过水下自主式航行器(AUV)自身惯性导航系统(INS)/多普勒测速仪(DVL)以及压力传感器等获取航向、速度以及深度信息,完成航位推算导航。但是,导航设备定位误差随时间累积的问题依然存在,导致AUV不得不依靠上浮水面利用GPS来完成校准,既浪费了能源又增加了暴露的几率。
在无线电波、光波受限的水下空间,水声信号成为水下信息最有效的传播载体,水声导航具有多目标、双向定位的技术特点。为满足水下AUV高精度、长时间、隐蔽性的导航需求,如何将惯性与水声进行结合并实现精确导航功能上,是目前迫切需要解决的问题。
发明内容
本发明的目的在于克服现有设计的不足,提供一种设计合理、精度高且性能稳定的基于多水下应答器的惯性/水声组合导航方法。
本发明解决其技术问题是采取以下技术方案实现的:
一种基于多水下应答器的惯性/水声组合导航方法,包括以下步骤:
步骤1、水下应答器布放与位置标定:当水下AUV运行到某作业区域布放一个水下应答器,利用AUV自身运动信息以及AUV与该水下应答器相互之间的距离信息标定出水下应答器位置;
步骤2、通过距离变换位置算法,将AUV与水下应答器之间的相对距离信息转换成AUV相对于应答器之间的三维几何位置,根据标定出的水下应答器位置信息,计算AUV的绝对位置信息;
步骤3、通过AUV中的惯性导航系统INS/DVL与计算得到的AUV绝对位置信息进行位置组合导航算法来校正自身航位推算误差;
步骤4、当AUV即将超出水下应答器作用范围时,布放一个后续水下应答器,利用AUV与当前水下应答器之间的距离组合输出去估计出后续水下应答器位置,当AUV运行区域超出了当前水下应答器的水声作用范围后,AUV再次与后续水下应答器进行距离组合导航,并重复执行上述过程。
所述步骤1标定水下应答器位置的方法为:
建立直角坐标系下AUV到水下应答器绝对位置X(x0,y0,z0)校准的观测方程:
式中:i=1,2,...,n表示测量次数,(xi,yi,zi)表示AUV导航系统第i次测量点位置;然后利用泰勒级数展开法和最小二乘法迭代求解上述方程,将所得结果X(x0,y0,z0)利用直角坐标至球面坐标转换公式,完成水下应答器位置P0(L0,λ0,h0)的标定。
所述步骤2的具体处理方法为:
建立以水下应答器点为原点的东北天直角坐标系,将AUV与水下应答器之间的相对距离信息转换成AUV相对于水下应答器之间的三维几何位置:东向距离xe、北向距离xn和天向距离xu,定义AUV导航系统状态变量方程f(XK)为三维状态向量Xk=[xe xn xu]T,导航系统动态方程f(XK)如下:
式中:
xe,xn,xu分别为AUV相对于水下应答器之间的东向、北向和天向距离;
vs为AUV合速度;
φ,β分别为AUV航向角、俯仰角;
在距离组合导航定位系统中,扩展卡尔曼滤波器k时刻观测方程为Zk,由状态变量构成的观测方程h(Xk)=[d z]T详细表示如下:
式中:
di——AUV与水下应答器之间的距离;
zi——AUV深度;
ni——距离信息di和深度信息zi的量测噪声为零均值的高斯白噪声;
采用扩展卡尔曼滤波器处理,状态方程f(Xk)的雅克比矩阵Fk,观测方程h(Xk)的雅克比矩阵Hk,扩展卡尔曼滤波器的一步预测方程如下:
Φk=I+Fk·T
Pk,k-1=ΦkPk-1Φk+Qk-1
扩展卡尔曼滤波器的一步滤波方程为:
Pk=(I-KkHk)Pk,k-1(I-KkHk)T+KkRkKk T
式中:
Φk为状态转移矩阵;
Kk为滤波器增益矩阵;
Pk,k-1,Pk分别为一步预测均方误差、估计均方误差;
通过扩展卡尔曼滤波器相应运算过程,将距离信息转换为AUV与水下应答器之间的相对东向距离xe、相对北向距离xn、相对天向距离xu,根据事先标定的水下应答器位置信息P0(L0,λ0,h0),进而得到AUV的绝对位置信息Pc(Lc,λc,hc):
上式中,xe为AUV与水下应答器之间的相对东向距离,xn为AUV与水下应答器之间的相对北向距离,zi为AUV深度,RM和RN为地球主曲率半径,Lc、λc和hc为AUV纬度、经度和深度信息。
所述步骤3的具体方法为:通过距离信息变换位置算法实时更新得到的AUV位置,与AUV中导航设备INS/DVL实时输出的位置信息做差后进入位置组合导航kalman滤波器,对系统姿态、速度和位置输出值进行实时补偿,同时反馈修正导航设备内部状态信息。
所述步骤4的具体方法为:当AUV即将超出水下应答器作用范围时,布放一个后续水下应答器,利用AUV与当前水下应答器之间的距离组合输出去估计出后续水下应答器位置,当AUV运行区域超出了当前水下应答器的水声作用范围后,AUV再次与后续水下应答器进行距离组合导航,并重复执行上述过程。
本发明的优点和积极效果是:
1、本发明在AUV航行路径上通过接力式地布放一系列水下应答器b1、b2、……、bn,不断地与当前水下应答器进行距离组合导航同时估计另一个水下应答器位置,仅利用声学测距手段,可实现抑制自身INS/DVL航位推算误差发散的位置校准功能,始终保证水下AUV位置误差有界,采用本发明的AUV全程定位精度优于20m,远远高于INS/DVL航位推算条件下随时间积累约为50m/h的定位误差,可有效抑制INS/DVL组合定位误差的发散趋势,保证了导航设备输出满足精度指标要求,为解决AUV导航设备水下校准提供了可能。
2、本发明能够充分结合惯性导航、水声导航的二者信息优势,同时考虑到水下应用的实际背景,通过在AUV航行路径上接力式地布放一系列水下应答器,仅利用水声距离信息解决了水下AUV导航设备的校准问题,具有广泛的应用前景。
附图说明
图1为本发明的处理流程图;
图2为本发明的位置组合导航算法原理框图;
图3为本发明的导航方法原理框图。
具体实施方式
以下结合附图对本发明实施例做进一步详述:
一种基于多水下应答器的惯性/水声组合导航方法,如图1所示,当水下AUV运行到某作业区域布放一个水下应答器b1,首先利用AUV自身运动信息以及AUV与水下应答器b1相互之间的距离信息估计出水下应答器b1的位置,然后进行AUV中的惯性导航系统INS/DVL与水下应答器之间的位置组合导航算法来校正自身航位推算误差;当AUV即将超出水下应答器b1作用范围时布放水下应答器b2,利用AUV与水下应答器b1之间的距离组合输出去估计出水下应答器b2位置,当AUV运行区域超出了水下应答器b1的水声作用范围后,AUV再次与水下应答器b2进行距离组合导航,上述过程依次类推。由此可以看出,在AUV航行路径上通过接力式地布放一系列水下应答器b1、b2、……、bn,不断地与当前水下应答器进行距离组合导航同时估计另一个水下应答器位置,仅利用声学测距手段,可实现抑制自身INS/DVL航位推算误差发散的位置校准功能,始终保证水下AUV位置误差有界。
本发明包括以下步骤:
步骤1、水下应答器布放与位置标定:当水下AUV运行到某作业区域布放一个水下应答器b1,利用AUV自身运动信息以及AUV与水下应答器b1相互之间的距离信息标定出水下应答器b1的位置。
水下导航系统一般采用自身的惯性导航系统INS/DVL组合方式进行航位推算,当AUV运行到某作业区域,布放水下应答器,水下应答器沉入水底经触发后以等间隔时间发出声信息,提供自身与AUV相互间的距离信息。水下应答器布放后,AUV进行机动航行,建立直角坐标系下AUV到水下应答器绝对位置X(x0,y0,z0)校准的观测方程:
式中:i=1,2,...,n表示测量次数,(xi,yi,zi)表示AUV导航系统第i次测量点位置。
利用泰勒级数展开法和最小二乘法迭代求解公式(1),将所得结果X(x0,y0,z0)利用直角坐标至球面坐标转换公式,完成水下应答器位置P0(L0,λ0,h0)的精确标定。
步骤2、通过距离变换位置算法计算出AUV的绝对位置信息。
建立以水下应答器点为原点的东北天直角坐标系,将AUV与水下应答器之间的相对距离信息转换成AUV相对于水下应答器之间的三维几何位置(东向距离xe、北向距离xn和天向距离xu)。定义AUV导航系统状态变量方程f(XK)为三维状态向量Xk=[xe xn xu]T,导航系统动态方程f(XK)如下:
式中:
xe,xn,xu——AUV相对于水下应答器之间的东向、北向和天向距离;
vs——AUV合速度;
φ,β——AUV航向角、俯仰角。
在距离组合导航定位系统中,扩展卡尔曼滤波器k时刻观测方程为Zk,由状态变量构成的观测方程h(Xk)=[d z]T详细表示如下:
式中:
di——AUV与水下应答器之间的距离;
zi——AUV深度;
ni——距离信息di和深度信息zi的量测噪声为零均值的高斯白噪声。
上述两式子构成了纯距离组合导航系统的基本方程,显然这是一个非线性方程,需采用扩展卡尔曼滤波器(EKF)处理,公式(2)状态方程f(Xk)的雅克比矩阵Fk,公式(3)观测方程h(Xk)的雅克比矩阵Hk,扩展卡尔曼滤波器的一步预测方程如下:
扩展卡尔曼滤波器的一步滤波方程为:
式中:
Φk——状态转移矩阵;
Kk——滤波器增益矩阵;
Pk,k-1,Pk——一步预测均方误差,估计均方误差。
通过扩展卡尔曼滤波器相应运算过程,可将距离信息转换为AUV与水下应答器之间的相对东向距离xe、相对北向距离xn、相对天向距离xu,根据事先标定的水下应答器位置信息P0(L0,λ0,h0),进而得到AUV的绝对位置信息Pc(Lc,λc,hc):
步骤3、通过AUV中的惯性导航系统INS/DVL与计算得到的AUV绝对位置信息进行位置组合导航算法来校正自身航位推算误差。
如图2所示,通过距离信息变换位置算法实时更新得到的AUV位置,与AUV中导航设备INS/DVL实时输出的位置信息做差后进入位置组合导航kalman滤波器,对系统姿态、速度和位置输出值进行实时补偿,同时反馈修正导航设备内部状态信息(姿态角、速度、位置及惯性元件漂移等),从而抑制自身导航设备误差的发散增长,有效提高了导航定位精度。
步骤4、当AUV即将超出水下应答器b1作用范围时布放水下应答器b2,利用AUV与水下应答器b1之间的距离组合输出去估计出水下应答器b2位置,当AUV运行区域超出了水下应答器b1的水声作用范围后,AUV再次与水下应答器b2进行距离组合导航,上述过程依次类推。
水下AUV继续在水中行进,根据水声导航具有多目标、双向定位的技术特点,利用AUV自身的INS/DVL的导航信息以及AUV与水下应答器之间的声学距离信息既能标定出水下应答器的位置;又能将声学距离信息进行距离组合导航(声学距离信息转换成载体与水下应答器之间的几何位置信息,结合标定后的水下应答器位置实时估算得到载体AUV自身的位置,融合自身的INS/DVL的导航信息进行组合导航),从而获取AUV自身更加精确的位置估计,同时修正AUV导航设备中的误差。当AUV即将超出当前水下应答器作用范围时,布放并估计新水下应答器的位置,当超出当前水下应答器作用范围时,再利用新水下应答器进行距离组合导航,依此类推,通过在AUV的航行路径上接力式地布放一系列水下应答器,即可实现这种基于多水下应答器的惯性/水声组合导航方法,从而在AUV航行路径中的较大范围内保持一定的定位精度,上述导航方法原理框图如图3所示。
需要强调的是,本发明所述的实施例是说明性的,而不是限定性的,因此本发明包括并不限于具体实施方式中所述的实施例,凡是由本领域技术人员根据本发明的技术方案得出的其他实施方式,同样属于本发明保护的范围。
Claims (3)
1.一种基于多水下应答器的惯性/水声组合导航方法,其特征在于包括以下步骤:
步骤1、水下应答器布放与位置标定:当水下AUV运行到某作业区域布放一个水下应答器,利用AUV自身运动信息以及AUV与该水下应答器相互之间的距离信息标定出水下应答器位置;
步骤2、通过距离变换位置算法,将AUV与水下应答器之间的相对距离信息转换成AUV相对于应答器之间的三维几何位置,根据标定出的水下应答器位置信息,计算AUV的绝对位置信息;本步骤的具体处理方法为:
建立以水下应答器点为原点的东北天直角坐标系,将AUV与水下应答器之间的相对距离信息转换成AUV相对于水下应答器之间的三维几何位置:AUV相对于水下应答器之间的东向距离xe、北向距离xn和天向距离xu,AUV导航系统状态变量方程为f(XK),三维状态向量为Xk=[xe xn xu]T,导航系统状态变量方程f(XK)如下:
式中:
vs为AUV合速度;
φ,β分别为AUV航向角、俯仰角;
在距离组合导航定位系统中,扩展卡尔曼滤波器k时刻观测方程为Zk,由状态变量构成的观测方程详细表示如下:
式中:
di——AUV与水下应答器之间的距离;
zi——AUV深度;
ni——距离信息di和深度信息zi的量测噪声为零均值的高斯白噪声;
采用扩展卡尔曼滤波器处理,状态变量方程f(Xk)的雅克比矩阵Fk,观测方程h(Xk)的雅克比矩阵Hk,扩展卡尔曼滤波器的一步预测方程如下:
Φk=I+Fk·T
Pk,k-1=ΦkPk-1Φk+Qk-1
扩展卡尔曼滤波器的一步滤波方程为:
Pk=(I-KkHk)Pk,k-1(I-KkHk)T+KkRkKk T
式中:
Φk为状态转移矩阵;
Kk为滤波器增益矩阵;
Pk,k-1,Pk分别为一步预测均方误差、估计均方误差;
通过扩展卡尔曼滤波器相应运算过程,将距离信息转换为AUV相对于水下应答器之间的东向距离xe、北向距离xn、天向距离xu,根据事先标定的水下应答器位置信息P0(L0,λ0,h0),进而得到AUV的绝对位置信息Pc(Lc,λc,hc):
上式中,zi为AUV深度,RE为地球主曲率半径,Lc、λc和hc为AUV纬度、经度和深度信息;
步骤3、通过AUV中的惯性导航系统INS/DVL与计算得到的AUV绝对位置信息进行位置组合导航算法来校正自身航位推算误差;
步骤4、当AUV即将超出水下应答器作用范围时,布放一个后续水下应答器,利用AUV与当前水下应答器之间的距离组合输出去估计出后续水下应答器位置,当AUV运行区域超出了当前水下应答器的水声作用范围后,AUV再次与后续水下应答器进行距离组合导航,并重复执行上述过程。
2.根据权利要求1所述的一种基于多水下应答器的惯性/水声组合导航方法,其特征在于:所述标定水下应答器位置的方法为:
建立直角坐标系下AUV到水下应答器绝对位置X(x0,y0,z0)校准的观测方程:
式中:i=1,2,...,n表示测量次数,Fi为第i次AUV与水下应答器之间的相对距离,(xi,yi,zi)表示AUV导航系统第i次测量点位置;然后利用泰勒级数展开法和最小二乘法迭代求解上述方程,将所得结果X(x0,y0,z0)利用直角坐标至球面坐标转换公式,完成水下应答器位置P0(L0,λ0,h0)的标定。
3.根据权利要求1所述的一种基于多水下应答器的惯性/水声组合导航方法,其特征在于:所述步骤3的具体方法为:通过距离信息变换位置算法实时更新得到的AUV位置,与AUV中导航设备INS/DVL实时输出的位置信息做差后进入位置组合导航kalman滤波器,对系统姿态、速度和位置输出值进行实时补偿,同时反馈修正导航设备内部状态信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610623261.8A CN106017467B (zh) | 2016-07-28 | 2016-07-28 | 一种基于多水下应答器的惯性/水声组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610623261.8A CN106017467B (zh) | 2016-07-28 | 2016-07-28 | 一种基于多水下应答器的惯性/水声组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106017467A CN106017467A (zh) | 2016-10-12 |
CN106017467B true CN106017467B (zh) | 2019-02-05 |
Family
ID=57133581
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610623261.8A Active CN106017467B (zh) | 2016-07-28 | 2016-07-28 | 一种基于多水下应答器的惯性/水声组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106017467B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107990891B (zh) * | 2016-10-26 | 2021-05-28 | 中国科学院沈阳自动化研究所 | 基于长基线和信标在线标定的水下机器人组合导航方法 |
CN106767918B (zh) * | 2016-12-09 | 2019-08-30 | 交控科技股份有限公司 | 电子地图中应答器位置数据校准方法、终端及控制中心 |
CN107255810B (zh) * | 2017-07-24 | 2020-05-15 | 哈尔滨工程大学 | 基于单信标测距定位双精度加权融合的航向误差补偿方法 |
CN108303079B (zh) * | 2017-12-21 | 2021-01-26 | 中国船舶重工集团公司第七0七研究所 | 一种水下usbl反向应用的数据平滑方法 |
CN107966145B (zh) * | 2017-12-21 | 2020-12-15 | 中国船舶重工集团公司第七0七研究所 | 一种基于稀疏长基线紧组合的auv水下导航方法 |
CN109084802B (zh) * | 2018-10-10 | 2020-10-09 | 北京理工大学 | 基于混合编码的多站接力导航下运动体路径规划方法 |
CN109765523B (zh) * | 2018-12-21 | 2022-11-01 | 山东省科学院海洋仪器仪表研究所 | 基于自适应akf的单应答器斜距水声定位方法及系统 |
CN110057365B (zh) * | 2019-05-05 | 2022-06-21 | 哈尔滨工程大学 | 一种大潜深auv下潜定位方法 |
CN110132281B (zh) * | 2019-05-21 | 2023-10-20 | 哈尔滨工程大学 | 一种基于询问应答模式的水下高速目标高精度自主声学导航方法 |
CN110456357B (zh) * | 2019-08-27 | 2023-04-07 | 吉林大学 | 一种导航定位方法、装置、设备及介质 |
CN110542884B (zh) * | 2019-08-28 | 2020-11-06 | 中国科学院声学研究所 | 一种基于惯导修正的长基线导航定位方法 |
CN110542438B (zh) * | 2019-09-30 | 2022-07-26 | 中国船舶重工集团公司第七0七研究所 | 一种基于sins/dvl组合导航误差标定的方法 |
CN110646783B (zh) * | 2019-09-30 | 2021-07-09 | 哈尔滨工程大学 | 一种水下航行器的水下信标定位方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104180804A (zh) * | 2014-09-11 | 2014-12-03 | 东南大学 | 基于水下信息网络的单参考节点水下航行器组合导航方法 |
CN104197939A (zh) * | 2014-09-11 | 2014-12-10 | 东南大学 | 基于水下信息网络的多参考节点水下航行器组合导航方法 |
CN105157701A (zh) * | 2015-09-01 | 2015-12-16 | 北京理工大学 | 一种水下位置基准布设的方法 |
-
2016
- 2016-07-28 CN CN201610623261.8A patent/CN106017467B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104180804A (zh) * | 2014-09-11 | 2014-12-03 | 东南大学 | 基于水下信息网络的单参考节点水下航行器组合导航方法 |
CN104197939A (zh) * | 2014-09-11 | 2014-12-10 | 东南大学 | 基于水下信息网络的多参考节点水下航行器组合导航方法 |
CN105157701A (zh) * | 2015-09-01 | 2015-12-16 | 北京理工大学 | 一种水下位置基准布设的方法 |
Non-Patent Citations (1)
Title |
---|
"惯性导航系统水下校准新方法";汪湛清;《中国惯性技术学报》;20110831;第19卷(第4期);正文第467-471页 |
Also Published As
Publication number | Publication date |
---|---|
CN106017467A (zh) | 2016-10-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106017467B (zh) | 一种基于多水下应答器的惯性/水声组合导航方法 | |
CN107314768B (zh) | 水下地形匹配辅助惯性导航定位方法及其定位系统 | |
CN104075715B (zh) | 一种结合地形和环境特征的水下导航定位方法 | |
CN109324330A (zh) | 基于混合无导数扩展卡尔曼滤波的usbl/sins紧组合导航定位方法 | |
CN103697910B (zh) | 自主水下航行器多普勒计程仪安装误差的校正方法 | |
CN111595348B (zh) | 一种自主水下航行器组合导航系统的主从式协同定位方法 | |
CN1325932C (zh) | 载人潜水器的组合导航定位方法 | |
CN111928850B (zh) | 适用于极地冰架下环境的自主水下机器人的组合导航方法 | |
CN108362288B (zh) | 一种基于无迹卡尔曼滤波的偏振光slam方法 | |
CN108387236B (zh) | 一种基于扩展卡尔曼滤波的偏振光slam方法 | |
CN106767752A (zh) | 一种基于偏振信息的组合导航方法 | |
CN102829777A (zh) | 自主式水下机器人组合导航系统及方法 | |
CN112945224B (zh) | 一种采用因子图和和积算法的多auv协同导航方法 | |
CN105628016B (zh) | 一种基于超短基线的导航定位方法 | |
CN107966145B (zh) | 一种基于稀疏长基线紧组合的auv水下导航方法 | |
CN110514203A (zh) | 一种基于isr-ukf的水下组合导航方法 | |
CN111829512A (zh) | 一种基于多传感器数据融合的auv导航定位方法及系统 | |
CN104656058A (zh) | 分布式多移动节点协作定位系统 | |
CN105547300A (zh) | 用于auv的全源导航系统及方法 | |
CN103558622B (zh) | 相对距离与追踪坐标值相结合的多auv自主定位方法 | |
Bo et al. | Cooperative localisation of AUVs based on Huber-based robust algorithm and adaptive noise estimation | |
Troni et al. | Preliminary experimental evaluation of a Doppler-aided attitude estimator for improved Doppler navigation of underwater vehicles | |
CN111025229B (zh) | 一种水下机器人纯方位目标估计方法 | |
Xu et al. | Accurate two-step filtering for AUV navigation in large deep-sea environment | |
Zhang et al. | Ocean current-aided localization and navigation for underwater gliders with information matching algorithm |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |