CN104280026A - 基于aukf的深海机器人长基线组合导航方法 - Google Patents
基于aukf的深海机器人长基线组合导航方法 Download PDFInfo
- Publication number
- CN104280026A CN104280026A CN201310284939.0A CN201310284939A CN104280026A CN 104280026 A CN104280026 A CN 104280026A CN 201310284939 A CN201310284939 A CN 201310284939A CN 104280026 A CN104280026 A CN 104280026A
- Authority
- CN
- China
- Prior art keywords
- variance
- information
- filter
- aukf
- long baselines
- 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
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
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)
- Manipulator (AREA)
Abstract
本发明涉及一种基于AUKF的深海机器人长基线组合导航方法,利用全球定位***获取深海机器人的初始绝对位置作为航迹推算的初始点,并采深海机器人的集初始信息;构建无色卡尔曼滤波主滤波器并对采集到的初始信息进行滤波估计,构建无色卡尔曼辅助滤波器,对主滤波器滤波估计后信息进一步滤波估计,采用自适应无色卡尔曼滤波的方法对采集到的初始信息进行数据融合,得出融合后的信息。本发明提高使用长基线定位***的深海机器人的导航精度,同时能够平滑深海机器人控制***所需的航向、深度以及载体坐标系下的速度信息。
Description
技术领域
本发明涉及海洋工程领域的一种深海机器人导航技术,具体地说是一种基于自适应无色卡尔曼滤波的长基线组合导航方法。
背景技术
精确的导航能力是水下机器人有效作业和安全回收的关键。导航***必须提供远距离及长时间范围内的精确定位、速度和姿态信息。但是由于受到水下环境的复杂性、机器人自身体积、重量、能源以及隐蔽性等因素的影响,实现高精度的水下机器人导航仍然是一项艰巨的任务。
现有的水下导航方法主要是多传感器组合导航方法,对多传感器信息进行滤波。但是针对深海机器人的导航问题,在***噪声信息未知时,如果设置的噪声参数与实际的噪声相差过大,就会导致有偏估计甚至滤波算法的发散。海洋环境复杂多变,很难对噪声做出较为准确的先验估计,因此要设计和采用更适合于实时估计***噪声信息的滤波算法。长基线定位数据野值较多、延迟较大,而且某些情况下工作状态不正常,因此对长基线数据的正确处理对提高导航精度也至关重要。
发明内容
针对现有技术的不足,本发明提供一种基于自适应无色卡尔曼滤波的深海机器人组合导航方法,目的在于提高使用长基线定位***的深海机器人的导航精度,同时能够平滑深海机器人控制***所需的航向、深度以及载体坐标系下的速度信息。
本发明为实现上述目的所采用的技术方案是:一种基于AUKF的深海机器人长基线组合导航方法,利用全球定位***获取深海机器人的初始绝对位置作为航迹推算的初始点,并采集深海机器人的初始信息;
构建无色卡尔曼滤波主滤波器并对采集到的初始信息进行滤波估计,构建无色卡尔曼辅助滤波器,对主滤波器滤波估计后信息进一步滤波估计;
采用自适应无色卡尔曼滤波的方法对采集到的初始信息进行数据融合,得出融合后的信息。
所述初始信息包括多普勒计程仪采集的线速度信息,运动传感器采集的姿态信息,长基线声学定位装置采集的位置信息和深度计采集的深度信息。
所述长基线声学定位装置通过自行解算深海机器人绝对位置的方法获取位置信息。
所述自行解算深海机器人绝对位置的方法,步骤如下:
长基线数据包协议解析出深海机器人到每个信标的距离信息,判断各信标数据的有效性,根据每个有效信标的绝对位置信息和深海机器人到信标的距离信息,建立三元二次方程组:
上述方程组中(xA,yA,zA),(xB,yB,zB),(xC,yC,zC)分别为各有效信标的绝对位置坐标,lA、lB、lC分别为深海机器人到各个信标的距离,解此方程组得(xo,yo,zo)为深海机器人的绝对位置坐标,得到机器人绝对位置坐标的两组解,根据当前时刻深度计采集的深度信息判定两组解中的有效解,作为观测矢量中的东向位置观测值和北向位置观测值。
无色卡尔曼主滤波器滤波估计的实现过程为:
对上一时刻随机向量的被估计量均值和方差经非线性无色变换后,得到离散Sigma点,经主滤波器的状态方程计算更新Sigma点,然后计算出更新Sigma点的状态均值和方差,对状态均值和方差计算得到一步估计的状态均值和方差;对一步估计的状态均值和方差再经无色变换和主滤波器的测量方程计算更新,得到深海机器人可观测状态的均值、方差及协方差的估计值;读取传感器采集观测信息,并与状态均值、方差、观测状态的估计值和增益矩阵计算估计,得到***均值、方差的估算值,并得到新息;根据主滤波器的新息经计算得到测量值作为辅助滤波器的观测信号。
辅助滤波器对***过程噪声进行滤波估计的实现过程如下:
上一时刻估计得到辅助滤波器的***噪声方差矩阵的对角线元素和方差,用辅助滤波器的状态方程对对角线元素和方差计算更新后得到对角线元素和方差的一步估计值;用辅助滤波器的测量方程根据主滤波器的一步估计的方差、状态方差和增益矩阵计算更新后得到估计的观测值,将得到的一步估计值、观测值和主滤波器的测量值计算估计得到***过程噪声方差阵的对角线元素的估算值和方差,当有新观测信息时,继续下一控制周期主滤波器的实现步骤。
所述辅助滤波器的状态方程建立如下:
其中为辅助滤波器中的***噪声,为***噪声方差矩阵角线元素。
所述辅助滤波器的测量方程建立如下:
其中,vdiag(·)表示一个向量,其分量为矩阵(·)的主对角线元素,***噪声方差矩阵角线元素作为***的观测信号,Pk|k-1为主滤波器状态矢量的一步估计的方差,Pk为主滤波器状态矢量的方差,Kk为主滤波器的增益矩阵,为估计的观测值。
所述主滤波器的测量方程根据长基线定位数据的有效时刻进行切换:
当长基线声学定位装置提供的观测值有效时,测量方程定义为:
yk=xk+Nn
其中,y=[uy,vy,wy,ry,ξy,ηy,ζy,ψy]T为观测矢量,其中uy、vy、wy、ry分别是前向速度、侧向速度、垂向速度和转艏角速度的观测量,ξy、ηy、ζy、ψy是北向位置、东向位置、深度和艏向角的观测量,Nn为观测噪声;
当长基线声学定位装置提供的观测值无效时,测量方程定义为:
其中,y=[uy,vy,wy,ry,ζy,ψy]T为观测矢量。
所述有效时刻为长基线数据更新并且不是野值的时刻。
本发明具有以下有益效果及优点:
1.本发明提出了根据长基线数据包协议,由机器人到信标距离解算机器人绝对位置的方法,解决了某些情况下长基线定位***不能提供较为准确的定位信息的问题。
2.本发明提出了根据长基线定位数据的有效性切换观测方程,解决了长基线定位数据野值较多以及长基线声学定位装置与其他传感器采集数据更新率不一致的问题。
3.本发明导航精度高,由于AUKF算法中的辅助滤波器可以对***的噪声信息进行实时估计,且能够较快的收敛,解决了复杂多变的海洋环境以及深海机器人执行任务而引起的***噪声难以获得较为准确的先验信息进而导致有偏估计甚至滤波发散的问题。
附图说明
图1是本发明的组合导航方法的工作原理图;
图2是本发明的自适应无色卡尔曼滤波算法的流程图;
图3是基于AUKF的深海机器人长基线组合导航的实施例结果。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
一种基于AUKF的深海机器人组合导航方法,主要包括以下步骤:
利用全球定位***获取深海机器人的初始绝对位置信息作为航迹推算的初始点,利用多普勒计程仪采集线速度信息,利用运动传感器采集姿态信息,利用长基线声学定位装置和深度计采集位置信息;采用自适应无色卡尔曼滤波方法对上述信息进行数据融合,取载体坐标系下的速度矢量和大地坐标系下的位置矢量和艏向角作为滤波器状态矢量,取各传感器采集的信息作为滤波器观测矢量,某些情况下长基线定位***不能提供较为准确的定位信息时,根据信标距离信息自行解算机器人位置作为位置信息的观测值,选择长基线数据有效时刻切换观测方程。滤波结果被深海机器人控制***与导航***直接使用。
进一步地,如果长基线定位***由于水中声速值设置不准确等原因引起定位误差较大,本发明还涉及一种根据长基线数据包中的机器人距水下信标(不少于3个)的距离信息自行解算机器人绝对位置的方法,步骤如下:
每个接收到长基线数据包的时刻,根据长基线数据协议解析出机器人到每个信标(水下布放应不少于3个信标)的距离信息,由数据包协议判断各信标数据的有效性,根据每个有效信标的绝对位置信息和机器人到信标的距离信息,建立对应的球相交的三元二次方程组,解此方程组,得到机器人绝对坐标的两组解,根据当前时刻深度计采集的深度信息判定两组解中的有效解。
所述采用自适应无色卡尔曼滤波方法步骤如下:
在深海机器人运动学模型的基础上,取载体坐标系下的速度矢量、大地坐标系下的位置矢量和艏向角作为滤波器状态矢量,建立***状态方程;
AUKF方法的主滤波器选择标准UKF滤波器,对***状态传递和更新,实时估计出***的状态信息,得到***估算的结果值均值和方差Pk;
依据主滤波器计算估计的新息信息ξk计算出辅助滤波器的测量值Sqk;建立辅助滤波器的状态方程和测量方程,依据测量值Sqk作为***的观测信号,采用AUKF的辅助滤波器KF对***的噪声信息进行实时估计,得到***噪声协方差阵Q的对角线元素和方差的估算值,这里的噪声信息包括过程噪声vk和测量噪声nk,它们的协方差矩阵分别为Qv和Qn。
进一步地,由于长基线声学定位装置与多普勒计程仪、运动传感器、深度计的数据更新率不一致,长基线声学定位装置的野值较多,选择长基线数据有效时刻切换观测方程。
如图1所示为本发明的组合导航方法的工作原理图,利用多普勒计程仪采集线速度信息,利用长基线声学定位装置采集平面位置信息,利用深度计采集深度信息,利用运动传感器采集姿态信息,利用数据融合方法对上述信息进行融合,得到深海机器人在海中的三维运动轨迹,同时能够平滑深海机器人控制***所需的航向以及载体坐标系下的速度信息。
(1)取载体坐标系下的速度矢量和大地坐标系下的位置矢量和艏向角作为滤波器状态矢量,定义为:x=[ux,vx,wx,rx,ξx,ηx,ζx,ψx]T,其中ux、vx、wx和rx分别是前向速度,侧向速度,垂向速度和转艏角速度的状态量,ξx、ηx、ζx和ψx分别是北向位置、东向位置、深度和艏向角的状态量。
状态方程定义为:
Nv为***噪声,Δt为传感器采样间隔。
(2)观测方程根据长基线定位数据的有效性进行切换,长基线数据有效时刻是指长基线数据更新并且不是野值的时刻。
(3)AUKF的主滤波器选用UKF对状态方程进行滤波估计。***噪声分布的变化规律是未知的,此时通常将其视为噪声驱动的不相关随机漂移量,故选择KF作为AUKF的辅助滤波器。
(4)AUKF算法中辅助滤波器状态方程的构建:
由深海机器人***噪声方差矩阵Q对角线元素可将辅助滤波器的状态方程表示为:
其中为辅助滤波器中的***噪声,是零均值高斯白噪声为零均值高斯白噪声;
由于的变化规律未知,可将其视为噪声驱动的不相关的随机漂移向量,故将辅助滤波器的状态方程定义为:
(5)AUKF算法中辅助滤波器测量方程的构建:
辅助滤波器是以主滤波器的新息ξk方差矩阵的对角线元素作为***的观测信号,依据主滤波器状态矢量的一步估计的方差Pk|k-1,主滤波器状态矢量的方差Pk,主滤波器的增益矩阵Kk组成辅助滤波器的观测方程定义为:
其中vdiag为取中括号内矩阵的主对角线元素组成的一个向量。
如图2所示为自适应无色卡尔曼滤波算法的实现流程。自适应无色卡尔曼滤波为主滤波器和辅助滤波器相结合的滤波实现过程。
主滤波器滤波估计的实现过程:
对上一时刻随机向量的被估计量均值和方差Pk-1经非线性无色变换后,得到的一组离散Sigma点χk-1,经***状态方程计算更新Sigma点,然后计算出更新Sigma点的状态均值和方差Pk|k-1,对状态均值和方差Pk|k-1计算得到一步估计的状态均值和方差;对一步估计的状态均值和方差再经无色变换和用测量方程计算更新,得到深海机器人可观测状态的均值其方差及协方差的估计值;读取传感器采集可观测信息yk同状态均值和方差Pk|k-1和可观测状态的估计值及增益矩阵Kk经计算估计,得到***均值方差Pk的估算值,从中得到新息ξk;依主滤波器的新息ξk经计算得到测量值Sqk作为辅助滤波器的观测信号,然后接续辅助滤波器程序步骤。
辅助滤波器KF对***过程噪声进行滤波估计的实现过程:
上一时刻估计得到辅助滤波器的***噪声方差矩阵的对角线元素和其方差用辅助滤波器的状态方程对和计算更新后得到对角线元素和其方差的一步估计值;用辅助滤波器的测量方程依主滤波器的一步估计的方差Pk|k-1、状态方差Pk和增益矩阵Kk经计算更新后得到估计的观测值所得到的一步估计值和估计的观测值同主滤波器的测量值Sqk经计算估计得到***过程噪声方差阵Qv的对角线元素的估算值和其方差,当有新观测信息yk时,接续下一控制周期主滤波器程序步骤。
某些情况下长基线定位***不能提供较为准确的定位信息,所述采用根据长基线数据包中的机器人距水下信标(不少于3个)的距离信息自行解算机器人绝对位置的方法步骤如下:
每个接收到长基线数据包的时刻,根据长基线数据协议解析出机器人到每个信标(水下布放应不少于3个信标)的距离信息,由数据包协议判断各信标数据的有效性,根据每个有效信标的绝对位置信息和机器人到信标的距离信息,建立对应的球相交的三元二次方程组:
上述方程组中(xA,yA,zA),(xB,yB,zB),(xC,yC,zC)为各有效信标的绝对位置坐标,lAlBlC为机器人到各个信标的距离,解此方程组得(xo,yo,zo)为机器人的绝对位置坐标。得到机器人绝对坐标的两组解,根据当前时刻深度计采集的深度信息判定两组解中的有效解,此解作为观测矢量中的东向和北向位置观测值。
如图3为基于AUKF的深海机器人长基线组合导航的实施例结果:
外场实验中,机器人以不超过1.5m/s的速度在水面航行。图3给出了利用本发明基于自适应无色卡尔曼滤波的深海机器人长基线组合导航方法进行机器人导航的结果,并同长基线设备的定位结果和航迹推算法的导航结果作比较。其中实线表示GPS获取的绝对位置,点划线表示航迹推算法的导航结果,点表示长基线设备的定位结果,虚线表示基于自适应无色卡尔曼滤波的深海机器人长基线组合导航方法的导航结果。从图中可以明显看出,采用基于自适应无色卡尔曼滤波的深海机器人长基线组合导航方法估计出的机器人的轨迹可以克服长基线设备某些情况下的定位不准和航迹推算法随时间增长的累积误差,且更接近GPS获取的绝对位置。此实施例表明本发明基于自适应无色卡尔曼滤波的深海机器人长基线组合导航方法可显著提高组合导航***精度。
融合后的信息包括:平面位置信息、深度信息、姿态信息、线速度信息、角速度信息。
Claims (10)
1.一种基于AUKF的深海机器人长基线组合导航方法,其特征在于:
利用全球定位***获取深海机器人的初始绝对位置作为航迹推算的初始点,并采集深海机器人的初始信息;
构建无色卡尔曼滤波主滤波器并对采集到的初始信息进行滤波估计,构建无色卡尔曼辅助滤波器,对主滤波器滤波估计后信息进一步滤波估计;
采用自适应无色卡尔曼滤波的方法对采集到的初始信息进行数据融合,得出融合后的信息。
2.根据权利要求1所述的基于AUKF的深海机器人长基线组合导航方法,其特征在于:所述初始信息包括多普勒计程仪采集的线速度信息,运动传感器采集的姿态信息,长基线声学定位装置采集的位置信息和深度计采集的深度信息。
3.根据权利要求2所述的基于AUKF的深海机器人长基线组合导航方法,其特征在于:所述长基线声学定位装置通过自行解算深海机器人绝对位置的方法获取位置信息。
4.根据权利要求3所述的基于AUKF的深海机器人长基线组合导航方法,其特征在于:所述自行解算深海机器人绝对位置的方法,步骤如下:
长基线数据包协议解析出深海机器人到每个信标的距离信息,判断各信标数据的有效性,根据每个有效信标的绝对位置信息和深海机器人到信标的距离信息,建立三元二次方程组:
上述方程组中(xA,yA,zA),(xB,yB,zB),(xC,yC,zC)分别为各有效信标的绝对位置坐标,lA、lB、lC分别为深海机器人到各个信标的距离,解此方程组得(xo,yo,zo)为深海机器人的绝对位置坐标,得到机器人绝对位置坐标的两组解,根据当前时刻深度计采集的深度信息判定两组解中的有效解,作为观测矢量中的东向位置观测值和北向位置观测值。
5.根据权利要求1所述的基于AUKF的深海机器人长基线组合导航方法,其特征在于:无色卡尔曼主滤波器滤波估计的实现过程为:
对上一时刻随机向量的被估计量均值和方差经非线性无色变换后,得到离散Sigma点,经主滤波器的状态方程计算更新Sigma点,然后计算出更新Sigma点的状态均值和方差,对状态均值和方差计算得到一步估计的状态均值和方差;对一步估计的状态均值和方差再经无色变换和主滤波器的测量方程计算更新,得到深海机器人可观测状态的均值、方差及协方差的估计值;读取传感器采集观测信息,并与状态均值、方差、观测状态的估计值和增益矩阵计算估计,得到***均值、方差的估算值,并得到新息;根据主滤波器的新息经计算得到测量值作为辅助滤波器的观测信号。
6.根据权利要求1所述的基于AUKF的深海机器人长基线组合导航方法,其特征在于:辅助滤波器对***过程噪声进行滤波估计的实现过程如下:
上一时刻估计得到辅助滤波器的***噪声方差矩阵的对角线元素和方差,用辅助滤波器的状态方程对对角线元素和方差计算更新后得到对角线元素和方差的一步估计值;用辅助滤波器的测量方程根据主滤波器的一步估计的方差、状态方差和增益矩阵计算更新后得到估计的观测值,将得到的一步估计值、观测值和主滤波器的测量值计算估计得到***过程噪声方差阵的对角线元素的估算值和方差,当有新观测信息时,继续下一控制周期主滤波器的实现步骤。
7.根据权利要求6所述的基于AUKF的深海机器人长基线组合导航方法,其特征在于:所述辅助滤波器的状态方程建立如下:
其中为辅助滤波器中的***噪声,为***噪声方差矩阵角线元素。
8.根据权利要求6所述的基于AUKF的深海机器人长基线组合导航方法,其特征在于:所述辅助滤波器的测量方程建立如下:
其中,vdiag(·)表示一个向量,其分量为矩阵(·)的主对角线元素,***噪声方差矩阵角线元素作为***的观测信号,Pk|k-1为主滤波器状态矢量的一步估计的方差,Pk为主滤波器状态矢量的方差,Kk为主滤波器的增益矩阵,为估计的观测值。
9.根据权利要求5所述的基于AUKF的深海机器人长基线组合导航方法,其特征在于:所述主滤波器的测量方程根据长基线定位数据的有效时刻进行切换:
当长基线声学定位装置提供的观测值有效时,测量方程定义为:
yk=xk+Nn
其中,y=[uy,vy,wy,ry,ξy,ηy,ζy,ψy]T为观测矢量,其中uy、vy、wy、ry分别是前向速度、侧向速度、垂向速度和转艏角速度的观测量,ξy、ηy、ζy、ψy是北向位置、东向位置、深度和艏向角的观测量,Nn为观测噪声;
当长基线声学定位装置提供的观测值无效时,测量方程定义为:
其中,y=[uy,vy,wy,ry,ζy,ψy]T为观测矢量。
10.根据权利要求9所述的基于AUKF的深海机器人长基线组合导航方法,其特征在于:所述有效时刻为长基线数据更新并且不是野值的时刻。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310284939.0A CN104280026B (zh) | 2013-07-08 | 2013-07-08 | 基于aukf的深海机器人长基线组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310284939.0A CN104280026B (zh) | 2013-07-08 | 2013-07-08 | 基于aukf的深海机器人长基线组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104280026A true CN104280026A (zh) | 2015-01-14 |
CN104280026B CN104280026B (zh) | 2017-11-14 |
Family
ID=52255154
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310284939.0A Active CN104280026B (zh) | 2013-07-08 | 2013-07-08 | 基于aukf的深海机器人长基线组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104280026B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107576939A (zh) * | 2017-07-21 | 2018-01-12 | 哈尔滨工程大学 | 一种基于虚拟测距信标的单信标测距定位方法 |
CN109375646A (zh) * | 2018-11-14 | 2019-02-22 | 江苏科技大学 | 基于fmsrupf算法的auv对接回收自主导航方法 |
CN109376642A (zh) * | 2018-10-16 | 2019-02-22 | 长安大学 | 一种基于驾驶员行为的运动车辆状态预测方法 |
CN110542884A (zh) * | 2019-08-28 | 2019-12-06 | 中国科学院声学研究所 | 一种基于惯导修正的长基线导航定位方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1361431A (zh) * | 2000-12-23 | 2002-07-31 | 林清芳 | 完全整合式导航定位方法和*** |
CN1325932C (zh) * | 2004-11-17 | 2007-07-11 | 中国科学院沈阳自动化研究所 | 载人潜水器的组合导航定位方法 |
CN102519450B (zh) * | 2011-12-12 | 2014-07-02 | 东南大学 | 一种用于水下滑翔器的组合导航装置及方法 |
-
2013
- 2013-07-08 CN CN201310284939.0A patent/CN104280026B/zh active Active
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107576939A (zh) * | 2017-07-21 | 2018-01-12 | 哈尔滨工程大学 | 一种基于虚拟测距信标的单信标测距定位方法 |
CN109376642A (zh) * | 2018-10-16 | 2019-02-22 | 长安大学 | 一种基于驾驶员行为的运动车辆状态预测方法 |
CN109375646A (zh) * | 2018-11-14 | 2019-02-22 | 江苏科技大学 | 基于fmsrupf算法的auv对接回收自主导航方法 |
CN110542884A (zh) * | 2019-08-28 | 2019-12-06 | 中国科学院声学研究所 | 一种基于惯导修正的长基线导航定位方法 |
CN110542884B (zh) * | 2019-08-28 | 2020-11-06 | 中国科学院声学研究所 | 一种基于惯导修正的长基线导航定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104280026B (zh) | 2017-11-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108519615B (zh) | 基于组合导航和特征点匹配的移动机器人自主导航方法 | |
CN108362281B (zh) | 一种长基线水下潜艇匹配导航方法及*** | |
CN105823480B (zh) | 基于单信标的水下移动目标定位算法 | |
CN104280025A (zh) | 基于无色卡尔曼滤波的深海机器人超短基线组合导航方法 | |
CN109282808B (zh) | 用于桥梁三维巡航检测的无人机与多传感器融合定位方法 | |
CN103776453B (zh) | 一种多模型水下航行器组合导航滤波方法 | |
CN108759838A (zh) | 基于秩卡尔曼滤波器的移动机器人多传感器信息融合方法 | |
CN106679662B (zh) | 一种基于tma技术的水下机器人单信标组合导航方法 | |
CN111928850B (zh) | 适用于极地冰架下环境的自主水下机器人的组合导航方法 | |
CN102928858B (zh) | 基于改进扩展卡尔曼滤波的gnss单点动态定位方法 | |
CN107966145B (zh) | 一种基于稀疏长基线紧组合的auv水下导航方法 | |
CN101793522B (zh) | 基于抗差估计的稳健滤波方法 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
CN103808316A (zh) | 室内飞行智能体惯性***与激光测距仪组合导航改进方法 | |
CN104316058B (zh) | 一种采用交互多模型的移动机器人wsn/ins组合导航方法 | |
CN104280026A (zh) | 基于aukf的深海机器人长基线组合导航方法 | |
CN108387236A (zh) | 一种基于扩展卡尔曼滤波的偏振光slam方法 | |
CN103968838A (zh) | 一种基于极坐标系的auv曲线运动状态下的协同定位方法 | |
CN113433553B (zh) | 一种水下机器人多源声学信息融合精确导航方法 | |
CN112578394B (zh) | 附有几何约束的LiDAR/INS融合定位与制图方法 | |
CN110646783A (zh) | 一种水下航行器的水下信标定位方法 | |
CN103399336A (zh) | 一种非高斯噪声环境下gps/sins组合导航方法 | |
CN114777812B (zh) | 一种水下组合导航***行进间对准与姿态估计方法 | |
CN104280024B (zh) | 一种深水机器人组合导航装置和方法 | |
CN111174774A (zh) | 一种某深度水层面模式下的导航信息融合方法及*** |
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 |