CN110726415A - 一种自适应的水下多波束同步定位与建图方法 - Google Patents
一种自适应的水下多波束同步定位与建图方法 Download PDFInfo
- Publication number
- CN110726415A CN110726415A CN201911000169.6A CN201911000169A CN110726415A CN 110726415 A CN110726415 A CN 110726415A CN 201911000169 A CN201911000169 A CN 201911000169A CN 110726415 A CN110726415 A CN 110726415A
- Authority
- CN
- China
- Prior art keywords
- particle
- mean
- time
- map
- mmap
- 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
- 238000000034 method Methods 0.000 title claims abstract description 54
- 238000013507 mapping Methods 0.000 title claims abstract description 27
- 230000001360 synchronised effect Effects 0.000 title claims abstract description 25
- 239000002245 particle Substances 0.000 claims abstract description 162
- 238000004364 calculation method Methods 0.000 claims abstract description 5
- 238000012952 Resampling Methods 0.000 claims description 27
- 238000000605 extraction Methods 0.000 claims description 8
- 238000001514 detection method Methods 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 6
- 230000000717 retained effect Effects 0.000 claims description 2
- 230000003044 adaptive effect Effects 0.000 claims 9
- 238000001914 filtration Methods 0.000 abstract description 6
- 238000012876 topography Methods 0.000 abstract description 6
- 238000005070 sampling Methods 0.000 abstract description 4
- 238000005516 engineering process Methods 0.000 abstract description 3
- 230000007613 environmental effect Effects 0.000 abstract description 3
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000010586 diagram Methods 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/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
- G01C21/32—Structuring or formatting of map data
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明属于海底地形同步定位与建图领域,具体涉及一种自适应的水下多波束同步定位与建图方法。本发明采用反距离加权方法实现在不提取环境特征的情况下进行数据关联并通过库尔贝克‑莱布勒散度采样实现粒子数实时调整的基于粒子滤波的AUV测深数据同步定位与建图技术。本发明通过粒子分地图与均值轨迹分地图匹配实现不需要提取特征情况下的数据关联,通过库尔贝克—莱布勒散度实时控制粒子数,同时采用地形丰富度对粒子权值进行修正,提高了算法的鲁棒性。本发明不需要在海底地形中提取特征,可以实时控制粒子数,同时能够保证建图精度和实时性,适用性好,计算开销小,可以保证实时性。
Description
技术领域
本发明属于海底地形同步定位与建图领域,具体涉及一种自适应的水下多波束同步定位与建图方法。
背景技术
同步定位与建图(Simultaneous Localization and Mapping,SLAM)提供了一种AUV在没有先验地图的情况下实现全海域航行的方法。粒子滤波是进行水下多波束声纳SLAM的重要手段之一。传统粒子滤波方法由于固定了粒子数目。计算开销较大。除此之外,海底地形趋于平缓,典型的粒子滤波SLAM框架如FastSLAM需要识别海洋环境中尺度独立的特征,导致适用性较差。因此,需要一种可以在不需要对海底特征识别和建模的情况下,能够实时控制粒子数的粒子滤波SLAM方法。
目前针对自适应的水下多波束同步定位与建图没有相关方法,较为相似的是使用其它传感器和算法来实现水下SLAM的方法。
公开日为2019年1月11日,公开号为CN109186610A,发明名称为“一种AUV地形匹配导航的鲁棒BSLAM方法”的专利申请,该方法以多波束声纳为传感器,使用图优化算法进行水下SLAM,计算开销较大。
公开日为2019年3月29日,公开号为CN109541606A,发明名称为“单水声信标测距辅助的水下同步定位与构图方法”的专利申请,该方法以单水声信标测距辅助来进行水下SLAM,需要提前布置水声信标,适用性较差。
发明内容
本发明的目的在于提供在不需要对海底特征识别和建模的情况下,能够实时控制粒子数,同时保证建图精度和实时性的一种自适应的水下多波束同步定位与建图方法。
本发明的目的通过如下技术方案来实现:包括以下步骤:
步骤一:初始粒子数M(0)、粒子集P(0)和粒子权值w(0);根据GPS数据初始化粒子集均值轨迹mean(0);设定算法总步数T和检测半径R,设定当前算法步数t=1;
步骤二:若t=1,根据里程计对t时刻粒子集P(t)进行运动更新,得到t时刻粒子均值轨迹mean(t),并令t=t+1后返回步骤二;若1<t<T,构建t-1时刻临时粒子集P(t-1),初始化粒子标号i=0,初始化t时刻粒子数M(t)=0,初始化空直方图与非空位数k=1;若t>T,则判定完成建图,结束计算;
步骤三:令M(t)=M(t)+1,i=i+1,判断M(t)与t-1时刻的粒子集数目M(t-1)的大小关系,若M(t)≤M(t-1),则按下式对第i号粒子进行运动更新:
步骤五:判断第i号粒子是否落入直方图空位;计算第i号粒子距其他M(t)-1个粒子的欧式距离若第i号粒子与某一粒子的距离在界限D内,则判定第i号粒子未落入空位,保持k不变;若第i号粒子与所有粒子的距离均大于界限D,则判定第i号粒子落入空位,并令k=k+1;
步骤六:计算界限粒子数Mx;
步骤六:若M(t)<Mx,则返回步骤三;若M(t)=Mx,则保留t时刻的M(t)值;
步骤七:判断是否进行重采样;若进行重采样,则修正历史均值轨迹地图并更新历史均值轨迹;若不进行重采样,则只更新历史均值轨迹,不进行修正;
步骤八:t=t+1,回到步骤二。
本发明还可以包括:
所述的步骤六中计算界限粒子数Mx的方法具体为:
其中,z1-δ和ε均为固有参数。
所述的步骤七中判断是否进行重采样的方法具体为:判定Neff与Nth的大小:
所述的步骤七中若进行重采样,则修正历史均值轨迹地图并更新历史均值轨迹的方法具体为:进行重采样后,粒子均值位置随重采样发生突变,此时刻移动向量move(t),线性修正回环时刻t(resample)至t时刻的均值轨迹并更新历史均值轨迹mean(1:t);其中t时刻均值轨迹的移动向量move(t)的具体公式为:
其中,move(t)为t时刻均值轨迹的移动向量;t(resample)为与t时刻对应的历史轨迹回环时刻;t(s)∈[t(resample),t],s为标记,表示属于此回环内的时刻。
步骤4.1:输入第i号粒子的位姿x(i)与历史均值轨迹mean(1:t-1),计算x(i)距所有历史均值轨迹点的距离X(1:t-1);
步骤4.2:提取满足条件D<R的mean(1:t-1)的子集m,记录子集m所对应所有时刻的均值t(resample),以m的位置为基准,结合其相应时刻的观测,构成均值轨迹分地图mmap;其中t(resample)向下取整;
步骤4.3:以x(i)为基准,将t-n的均值轨迹移动到x(i),结合t-n时刻至t时刻的观测,构成粒子分地图pmap;其中n为自定义的测线数目;
步骤4.4:分别计算mmap与pmap的地形丰富度α(mmap)与α(pmap);
步骤4.5:以mmap为基础,使用反距离加权算法插值出其在pmap中测点位置的估计值,根据mmap与pmap同一测点v的估计值与真实值,按下式为第i号粒子加权;
本发明的有益效果在于:
本发明提出一种基于库尔贝克—莱布勒散度(Kullback-Leibler Divergence,KLD)采样的自适应的水下多波束同步定位与建图方法。本发明采用反距离加权方法实现在不提取环境特征的情况下进行数据关联并通过库尔贝克-莱布勒散度采样实现粒子数实时调整的基于粒子滤波的AUV测深数据同步定位与建图技术。本发明通过粒子分地图与均值轨迹分地图匹配实现不需要提取特征情况下的数据关联,通过库尔贝克—莱布勒散度实时控制粒子数,同时采用地形丰富度对粒子权值进行修正,提高了算法的鲁棒性。本发明不需要在海底地形中提取特征,可以实时控制粒子数,同时能够保证建图精度和实时性,适用性好,计算开销小,可以保证实时性。
附图说明
图1是本发明的总体流程图。
图2是本发明中粒子回环检测与粒子加权流程图。
具体实施方式
下面结合附图对本发明做进一步描述。
结合图1,本发明总体包括如下步骤,其中,通过步骤二、三、五、六实现了算法的自适应,步骤四实现了算法在不进行特征提取的情况下进行数据关联:
步骤一:一是设定初始粒子数M(0),初始化粒子集P(0),初始化粒子集均值轨迹mean(0),设定算法总步数T,设定检测半径R,初始化粒子权值w(0),设定当前算法步数t=1,进入步骤二;
步骤二:判断t与T的关系。若t=1,根据里程计对t时刻粒子集P(t)进行运动更新,更新t时刻粒子均值轨迹mean(t),t=t+1,转入步骤二,若1<t<T,则构建t-1时刻临时粒子集P(t-1),初始化粒子标号i=0,t时刻粒子数M(t)=0,初始化空直方图与非空位数k=1,进入步骤三,若t>T,则算法结束;
步骤三:M(t)=M(t)+1,i=i+1,判断M(t)与t-1时刻的粒子集数目M(t-1)的大小关系,若M(t)≤M(t-1),则使用公式
ut:t时刻控制
εt-1:t-1时刻误差
步骤五:计算是否落入直方图空位,即计算距其他M(t)-1个粒子的欧式距离若与某一粒子的距离在界限D内,认为该粒子未落入空位,若与所有粒子的距离均大于D,则该粒子落入空位。若是,k=k+1,否则k不变,若k>1,使用公式
其中:z1-δ、ε:固有参数
计算界限粒子数Mx,进入步骤六;
步骤六:比较M(t)与Mx大小,若M(t)<Mx,则转入步骤三,否则进入步骤七;
步骤七:使用公式
其中:Neff:重采样判据
Nth:重采样界限
判定Neff与Nth的大小,判断是否满足Neff<Nth条件,若满足,则进行重采样,粒子均值位置随重采样发生突变,此时刻移动向量move(t),根据公式
其中:t(resample):与t时刻对应的历史轨迹回环时刻
t(s)∈[t(resample),t]
s:标记,表示属于此回环内的时刻
move(t):t时刻均值轨迹的移动向量
结合图2,步骤四中粒子回环检测与粒子加权具体步骤如下,其中,步骤4.2与4.3实现了算法在不依赖特征提取的情况下直接应用原始数据进行数据关联,步骤4.4实现了算法根据地图方差实现粒子权值的调整:
步骤4.1:输入第i号粒子的位姿x(i)与历史均值轨迹mean(1:t-1),计算x(i)距所有历史均值轨迹点的距离X(1:t-1),进入步骤4.2;
步骤4.2:提取满足条件D<R的mean(1:t-1)的子集m,记录子集m所对应所有时刻的均值(向下取整)t(resample),以m的位置为基准,结合其相应时刻的观测,构成均值轨迹分地图mmap,进入步骤4.3;
步骤4.3:以x(i)为基准,将t-n(其中n为自定义的测线数目)的均值轨迹移动到x(i),结合t-n时刻至t时刻的观测,构成粒子分地图pmap,进入步骤4.4;
步骤4.4:使用公式
其中:map:地图
分别计算mmap与pmap的地形丰富度α(mmap)与α(pmap),进入步骤4.5;
步骤4.5:以mmap为基础,使用反距离加权算法插值出其在pmap中测点位置的估计值,根据mmap与pmap同一测点v的估计值与真实值,使用公式
V:测点总数
为第i号粒子赋值。
本发明公开的是一种自适应的水下多波束同步定位与建图方法,主要是一种采用反距离加权方法实现在不提取环境特征的情况下进行数据关联并通过库尔贝克-莱布勒散度采样实现粒子数实时调整的基于粒子滤波的AUV测深数据同步定位与建图技术。本发明通过粒子分地图与均值轨迹分地图匹配实现不需要提取特征情况下的数据关联,通过库尔贝克—莱布勒散度实时控制粒子数,同时采用地形丰富度对粒子权值进行修正,提高了算法的鲁棒性。主要步骤包括:一是设定初始粒子数M(0),初始化时间t=0时刻粒子集P(0),初始化粒子集均值轨迹mean(0),设定算法总步数T,设定检测半径R,设定当前算法步数t=1,进入步骤二;二是判断t与T的大小关系,若t=1,则对t时刻粒子集P(t)进行简单更新,更新t时刻粒子均值轨迹mean(1:t),t=t+1,转入步骤二,若1<t<T,则构建t-1时刻临时粒子集P(t-1),初始化粒子标号i=0,t时刻粒子数M(t)=0,初始化空直方图与非空位数k=1,进入步骤三,若t>T,则算法结束;三是M(t)=M(t)+1,i=i+1,判断M(t)与t-1时刻的粒子数M(t-1)的大小关系,若有M(t)≤M(t-1),则直接对第i号粒子进行运动更新,否则从上一时刻临时粒子集中随机抽取一粒子作为第i号粒子进行运动更新,进入步骤四;四是判定是否进入回环范围,若是则对进行加权,否则粒子权值不变,进入步骤五;五是计算是否落入直方图空位,若是,k=k+1,否则k不变,若k>1,计算界限粒子数Mx,进入步骤六;六是比较M(t)与Mx大小,若M(t)<Mx,则转入步骤三,否则进入步骤七;七是判断算法是否满足重采样条件,若满足,则进行重采样并修正和更新历史均值轨迹,t=t+1,转入步骤二,否则更新历史均值轨迹但不进行修正,t=t+1,转入步骤二。其中,步骤二、三、五、六实现了算法的自适应,步骤四实现了算法在不进行特征提取的情况下进行数据关联的过程。
本发明的有益效果在于提出的自适应的水下多波束同步定位与建图方法不需要在海底地形中提取特征,适用性好,计算开销小,可以保证实时性。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (9)
1.一种自适应的水下多波束同步定位与建图方法,其特征在于,包括以下步骤:
步骤一:初始粒子数M(0)、粒子集P(0)和粒子权值w(0);根据GPS数据初始化粒子集均值轨迹mean(0);设定算法总步数T和检测半径R,设定当前算法步数t=1;
步骤二:若t=1,根据里程计对t时刻粒子集P(t)进行运动更新,得到t时刻粒子均值轨迹mean(t),并令t=t+1后返回步骤二;若1<t<T,构建t-1时刻临时粒子集P(t-1),初始化粒子标号i=0,初始化t时刻粒子数M(t)=0,初始化空直方图与非空位数k=1;若t>T,则判定完成建图,结束计算;
步骤五:判断第i号粒子是否落入直方图空位;计算第i号粒子距其他M(t)-1个粒子的欧式距离若第i号粒子与某一粒子的距离在界限D内,则判定第i号粒子未落入空位,保持k不变;若第i号粒子与所有粒子的距离均大于界限D,则判定第i号粒子落入空位,并令k=k+1;
步骤六:计算界限粒子数Mx;
步骤六:若M(t)<Mx,则返回步骤三;若M(t)=Mx,则保留t时刻的M(t)值;
步骤七:判断是否进行重采样;若进行重采样,则修正历史均值轨迹地图并更新历史均值轨迹;若不进行重采样,则只更新历史均值轨迹,不进行修正;
步骤八:t=t+1,回到步骤二。
步骤4.1:输入第i号粒子的位姿x(i)与历史均值轨迹mean(1:t-1),计算x(i)距所有历史均值轨迹点的距离X(1:t-1);
步骤4.2:提取满足条件D<R的mean(1:t-1)的子集m,记录子集m所对应所有时刻的均值t(resample),以m的位置为基准,结合其相应时刻的观测,构成均值轨迹分地图mmap;其中t(resample)向下取整;
步骤4.3:以x(i)为基准,将t-n的均值轨迹移动到x(i),结合t-n时刻至t时刻的观测,构成粒子分地图pmap;其中n为自定义的测线数目;
步骤4.4:分别计算mmap与pmap的地形丰富度α(mmap)与α(pmap);
步骤4.5:以mmap为基础,使用反距离加权算法插值出其在pmap中测点v位置的估计值,根据mmap与pmap同一测点的估计值与真实值,按下式为第i号粒子加权;
步骤4.1:输入第i号粒子的位姿x(i)与历史均值轨迹mean(1:t-1),计算x(i)距所有历史均值轨迹点的距离X(1:t-1);
步骤4.2:提取满足条件D<R的mean(1:t-1)的子集m,记录子集m所对应所有时刻的均值t(resample),以m的位置为基准,结合其相应时刻的观测,构成均值轨迹分地图mmap;其中t(resample)向下取整;
步骤4.3:以x(i)为基准,将t-n的均值轨迹移动到x(i),结合t-n时刻至t时刻的观测,构成粒子分地图pmap;其中n为自定义的测线数目;
步骤4.4:分别计算mmap与pmap的地形丰富度α(mmap)与α(pmap);
步骤4.5:以mmap为基础,使用反距离加权算法插值出其在pmap中测点位置的估计值,根据mmap与pmap同一测点v的估计值与真实值,按下式为第i号粒子加权;
步骤4.1:输入第i号粒子的位姿x(i)与历史均值轨迹mean(1:t-1),计算x(i)距所有历史均值轨迹点的距离X(1:t-1);
步骤4.2:提取满足条件D<R的mean(1:t-1)的子集m,记录子集m所对应所有时刻的均值t(resample),以m的位置为基准,结合其相应时刻的观测,构成均值轨迹分地图mmap;其中t(resample)向下取整;
步骤4.3:以x(i)为基准,将t-n的均值轨迹移动到x(i),结合t-n时刻至t时刻的观测,构成粒子分地图pmap;其中n为自定义的测线数目;
步骤4.4:分别计算mmap与pmap的地形丰富度α(mmap)与α(pmap);
步骤4.5:以mmap为基础,使用反距离加权算法插值出其在pmap中测点位置的估计值,根据mmap与pmap同一测点v的估计值与真实值,按下式为第i号粒子加权;
步骤4.1:输入第i号粒子的位姿x(i)与历史均值轨迹mean(1:t-1),计算x(i)距所有历史均值轨迹点的距离X(1:t-1);
步骤4.2:提取满足条件D<R的mean(1:t-1)的子集m,记录子集m所对应所有时刻的均值t(resample),以m的位置为基准,结合其相应时刻的观测,构成均值轨迹分地图mmap;其中t(resample)向下取整;
步骤4.3:以x(i)为基准,将t-n的均值轨迹移动到x(i),结合t-n时刻至t时刻的观测,构成粒子分地图pmap;其中n为自定义的测线数目;
步骤4.4:分别计算mmap与pmap的地形丰富度α(mmap)与α(pmap);
步骤4.5:以mmap为基础,使用反距离加权算法插值出其在pmap中测点位置的估计值,根据mmap与pmap同一测点v的估计值与真实值,按下式为第i号粒子加权;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911000169.6A CN110726415B (zh) | 2019-10-21 | 2019-10-21 | 一种自适应的水下多波束同步定位与建图方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911000169.6A CN110726415B (zh) | 2019-10-21 | 2019-10-21 | 一种自适应的水下多波束同步定位与建图方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110726415A true CN110726415A (zh) | 2020-01-24 |
CN110726415B CN110726415B (zh) | 2023-09-29 |
Family
ID=69220390
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911000169.6A Active CN110726415B (zh) | 2019-10-21 | 2019-10-21 | 一种自适应的水下多波束同步定位与建图方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110726415B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112562052A (zh) * | 2020-12-03 | 2021-03-26 | 广东工业大学 | 一种面向近岸水域的实时定位与建图方法 |
CN112732854A (zh) * | 2021-01-11 | 2021-04-30 | 哈尔滨工程大学 | 一种粒子滤波bslam方法 |
CN112857313A (zh) * | 2020-12-31 | 2021-05-28 | 哈尔滨工程大学 | 一种面向低带宽声学信道的测深信息传输方法 |
CN113008223A (zh) * | 2021-03-03 | 2021-06-22 | 哈尔滨工程大学 | 基于粒子滤波与图优化的海底地形同步定位与建图方法 |
CN113917939A (zh) * | 2021-10-09 | 2022-01-11 | 广东汇天航空航天科技有限公司 | 飞行器的定位导航方法、系统及计算设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120281507A1 (en) * | 2011-05-06 | 2012-11-08 | Rikoski Richard J | Systems and methods for overpinging synthetic aperture sonar transmitters |
US20160167750A1 (en) * | 2012-10-19 | 2016-06-16 | Ixblue | System and method for the navigation of a movable vehicle, suitable for determining and displaying a safe navigation zone |
CN107589748A (zh) * | 2017-08-21 | 2018-01-16 | 江苏科技大学 | 基于UnscentedFastSLAM算法的AUV自主导航方法 |
CN108562287A (zh) * | 2018-01-08 | 2018-09-21 | 哈尔滨工程大学 | 一种基于自适应采样粒子滤波的水下地形辅助导航方法 |
CN109084777A (zh) * | 2018-09-13 | 2018-12-25 | 黎建军 | 基于自适应遗传算法的粒子滤波定位与地图构建方法 |
-
2019
- 2019-10-21 CN CN201911000169.6A patent/CN110726415B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120281507A1 (en) * | 2011-05-06 | 2012-11-08 | Rikoski Richard J | Systems and methods for overpinging synthetic aperture sonar transmitters |
US20160167750A1 (en) * | 2012-10-19 | 2016-06-16 | Ixblue | System and method for the navigation of a movable vehicle, suitable for determining and displaying a safe navigation zone |
CN107589748A (zh) * | 2017-08-21 | 2018-01-16 | 江苏科技大学 | 基于UnscentedFastSLAM算法的AUV自主导航方法 |
CN108562287A (zh) * | 2018-01-08 | 2018-09-21 | 哈尔滨工程大学 | 一种基于自适应采样粒子滤波的水下地形辅助导航方法 |
CN109084777A (zh) * | 2018-09-13 | 2018-12-25 | 黎建军 | 基于自适应遗传算法的粒子滤波定位与地图构建方法 |
Non-Patent Citations (2)
Title |
---|
STEPHEN BARKBY等: "An Efficient Approach to Bathymetric SLAM" * |
刘丹;段建民;于宏啸;: "基于自适应渐消EKF的FastSLAM算法" * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112562052A (zh) * | 2020-12-03 | 2021-03-26 | 广东工业大学 | 一种面向近岸水域的实时定位与建图方法 |
CN112857313A (zh) * | 2020-12-31 | 2021-05-28 | 哈尔滨工程大学 | 一种面向低带宽声学信道的测深信息传输方法 |
CN112732854A (zh) * | 2021-01-11 | 2021-04-30 | 哈尔滨工程大学 | 一种粒子滤波bslam方法 |
CN113008223A (zh) * | 2021-03-03 | 2021-06-22 | 哈尔滨工程大学 | 基于粒子滤波与图优化的海底地形同步定位与建图方法 |
CN113008223B (zh) * | 2021-03-03 | 2022-10-28 | 哈尔滨工程大学 | 基于粒子滤波与图优化的海底地形同步定位与建图方法 |
CN113917939A (zh) * | 2021-10-09 | 2022-01-11 | 广东汇天航空航天科技有限公司 | 飞行器的定位导航方法、系统及计算设备 |
Also Published As
Publication number | Publication date |
---|---|
CN110726415B (zh) | 2023-09-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110726415A (zh) | 一种自适应的水下多波束同步定位与建图方法 | |
CN111486845B (zh) | 基于海底地形匹配的auv多策略导航方法 | |
CN109724599B (zh) | 一种抗野值的鲁棒卡尔曼滤波sins/dvl组合导航方法 | |
CN105424036B (zh) | 一种低成本水下潜器地形辅助惯性组合导航定位方法 | |
CN112146654B (zh) | 基于关键约束帧的前视成像声呐水下定位与导航方法 | |
CN110794409B (zh) | 一种可估计未知有效声速的水下单信标定位方法 | |
CN109307511A (zh) | 一种人工鱼群算法优化的容积粒子滤波导航方法 | |
CN113739795B (zh) | 一种基于偏振光/惯性/视觉组合导航的水下同步定位与建图方法 | |
CN110320520B (zh) | 一种测深信息同步定位与建图的鲁棒后端图优化方法 | |
CN110132281B (zh) | 一种基于询问应答模式的水下高速目标高精度自主声学导航方法 | |
CN110954132A (zh) | Grnn辅助自适应卡尔曼滤波进行导航故障识别的方法 | |
Zhou et al. | Terrain aided navigation for autonomous underwater vehicles with coarse maps | |
CN110207721B (zh) | 一种考虑残差分布的无效地形匹配结果识别方法 | |
CN112800075B (zh) | 一种基于实船六自由度姿态数据的船舶操纵预报数据库更新方法 | |
CN112802195B (zh) | 一种基于声呐的水下机器人连续占据建图方法 | |
CN109799513A (zh) | 一种基于二维激光雷达数据中直线特征的室内未知环境定位方法 | |
CN117118398A (zh) | 一种基于自适应似然分布的离散四元数粒子滤波数据处理方法 | |
CN116295414A (zh) | 基于鲸鱼算法优化的AUV-UFastSLAM算法 | |
CN110908404A (zh) | 一种基于数据驱动的auv智能观测运动方法 | |
CN110763234A (zh) | 一种水下机器人海底地形匹配导航路径规划方法 | |
CN114660641A (zh) | 一种自适应gps融合定位系统、方法及介质 | |
CN114863146A (zh) | 一种水下地形匹配定位方法、装置及存储介质 | |
CN113554705A (zh) | 一种变化场景下的激光雷达鲁棒定位方法 | |
Ding et al. | An optimized combination of improved particle filter and affine transformation for underwater terrain-based localization | |
CN110888104A (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 |