CN106885576B - 一种基于多点地形匹配定位的auv航迹偏差估计方法 - Google Patents
一种基于多点地形匹配定位的auv航迹偏差估计方法 Download PDFInfo
- Publication number
- CN106885576B CN106885576B CN201710094805.0A CN201710094805A CN106885576B CN 106885576 B CN106885576 B CN 106885576B CN 201710094805 A CN201710094805 A CN 201710094805A CN 106885576 B CN106885576 B CN 106885576B
- Authority
- CN
- China
- Prior art keywords
- positioning
- terrain
- point
- matching
- error
- 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
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
-
- 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
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)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明提供的是一种基于多点地形匹配定位的AUV航迹偏差估计方法。(1)地形匹配定位的搜索区间估计;(2)未知潮差和测量误差情况下的地形匹配定位;(3)测量误差估计和定位置信区间估计;(4)定位误差估计;(5)多点地形匹配定位初航迹偏差估计;(6)航迹关联与误定位点剔除;(7)航迹二次拟合。本发明的优点是结合了推算导航在时域和空域都缓慢变化而地形匹配定位结果在时域和空域不具有扩散性的特点,在航迹线上获得多个密集的地形匹配定位点,多点的定位信息拟合推算导航的航迹线从而使得定位的精度和可靠性大幅增加。
Description
技术领域
本发明涉及的是一种地形匹配定位方法,具体地说是一种AUV航迹偏差估计方法。
背景技术
地形匹配定位的有效性和可靠性是地形匹配定位和地形匹配导航技术的关键内容,如在地形匹配导航的初始阶段通常推算导航系统的导航偏差非常大,从而使得地形匹配定位的搜索区间非常大这种情况很容易产生误定位和伪点。而且,较大的推算导航使得地形匹配导航结果收敛较慢,而且容易导致导航结果的发散。目前较常用的地形匹配导航方法如TERCOM方法采用批处理的方法实现定位,但该方法并未提及如何处理定位伪点的问题,SITAN方法采用了递推滤波技术,但需要对地形进行线性化而且新型化带来的滤波误差很容易导致滤波发散,此外哈尔滨工程大学陈小龙博士在其博士论文AUV《水下地形匹配辅助导航技术研究》中,将粒子滤波技术应用于地形匹配导航定位使得滤波过不需要线性化地形,但仍然无法解决初始匹配点的推算导航误差大带来的滤波收敛慢,滤波发散等问题。因此,地形匹配导航系统的性能与初始位置的定位精度有很大的关系,我们希望在地形匹配导航的初始地形匹配定位点能以较高的精度和可靠性接近AUV真实的位置,也就是说在初始的地形匹配定位点AUV的推算导航偏差估计一定要精确可靠。
发明内容
本发明的目的在于提供一种定位的精度和可靠性高的基于多点地形匹配定位的AUV航迹偏差估计方法。
本发明的目的是这样实现的:
(1)地形匹配定位的搜索区间估计
对于第n个地形匹配点,根据推算导航的输出位置Xn=(xn,yn)推算导航的估计误差Wn=(Wxn,Wyn),推算导航给出的AUV的航行里程估计AUV推算导航系统给出的当前匹配点的推算导航偏差区间,即当前点的地形匹配定位的搜索区间
其中:xn和yn表示推算导航的位置,令Xn=(xn,yn);
λx和λy表示导航偏差占载体的运行里程的百分比,由参导航系统的统计结果事先给出;
Pxn和Pyn表示推算导航的误差,由推算导航给出。
(2)未知潮差和测量误差情况下的地形匹配定位
带入似然函数:
获得搜索点的似然函数值,则似然函数取值最大的位置就是地形匹配定位的位置:
(3)测量误差估计和定位置信区间估计
根据步骤(2)得到的定位信息Xpn,得到定位点的地形面插值高度序列和地形的测量高度差序列Δhpn:
Δhpn=Zn-h(Xpn)
以及高度偏差的标准差:
spn=std(Δhpn);
在获得误差估计和定位位置之后,对地形匹配定位的结果进行有效性检验,设地形测量误差服从高斯分布,则定位点位置的高度偏差Δhpn服从统计分布:
L-(xpn)表示定点的似然函数值在置信度为α时能到达的下界,这个下界就是一个截平面,每一个定位点的似然函数L(xpn)与这个截平面的交线构成了一个等值线,等值线包围的区域就是定位的置信区间Cpn。
(4)定位误差估计
其中:(x1,y1)(x2,y2)(x3,y3)(x4,y4)分别表示插值点所在的地形网格内,左下角为1号点顺时针排列的四个地形节点;
式中:
同理计算
以x-和x+的大值作为x的定位误差,以y-和y+的大值作为y的定位误差,得到最终的定位误差为:
(5)多点地形匹配定位初航迹偏差估计
式中,λxn,λyn表示对第i定位结果在x和y方向的加权,且满足加权系数λxn,λyn按如下方法进行求取,
从而得到当前时刻的定位位置:
(6)航迹关联与误定位点剔除
根据步骤(3)得到的地形匹配定位的有效区间构建的地形匹配定位的有效检验条件如下:
式中:Xn表示经过地形匹配定位修正后地形匹配定位点在推算导航航线上的位置。
(7)航迹二次拟合
如果在步骤(6)中有无效的定位点,就将该定位点剔除;如果剔除了定位点,则重新计算各个定位点的权重,对航迹进行再一次的拟合计算,
本发明提出了一种基于多点地形匹配定位的推算导航航迹偏差修正方法,该方法的优点是结合了推算导航在时域和空域都缓慢变化而地形匹配定位结果在时域和空域不具有扩散性的特点,在航迹线上获得多个密集的地形匹配定位点,多点的定位信息拟合推算导航的航迹线从而使得定位的精度和可靠性大幅增加。
与常规的地形匹配算法不同的是,本发明利用了AUV推算导航在时间和地形空间上的推算导航偏差缓慢变化和AUV地形匹配定位结果在时间和地形空间上不扩散的特点。地形匹配定位的时间不扩散性和推算导航的时域扩散性形成互补,利用地形匹配定位可以修正推算导航长时间的累积偏差;推算导航偏差在空间的缓慢变化的特性与地形匹配定位的空间跳变特性形成互补,利用这种缓变特性可以对地形匹配定位结果进行航迹关联和有效监测,提高地形匹配定位的有效性。本发明提出的方法可以解决由于初始匹配时推算导航偏差过大导致的收敛慢和地形精度低的问题,同时还可以对定位点进行有效性检测,和定位伪点,误定位点的筛选,提高地形匹配导航的精度和可靠性。
附图说明
图1是匹配定位点与参考导航点位置关系;
图2a-图2b是偏差初估计与定位点有效性检验及二次偏差估计模型;
图3是基于航线拟合的水下地形匹配定位方法流程图;
图4是双线性插值节点位置示意图;
图5是本发明的流程图。
具体实施方式
下面举例对基于多点地形匹配定位的AUV航迹偏差估计方法的主要步骤做进一步描述:
步骤一:多点地形匹配定位
假设规划了N个地形匹配定位点来修正航迹偏差,当前时刻到达第n个地形匹配定位点,当前地形匹配点的地形测量序列Zn,推算导航系统给出的推算位置Xn=(xn,yn),推算导航的误差Wn=(Wxn,Wyn),推算导航给出的航程(图3中第300步)。
Zn表示第n个地形匹配定位点的测量地形;
i表示测量地形中的节点索引号;
k表示测量地形中的节点总数;
首先计算地形匹配导航点的搜索区间(图3中第317步):
其中:xn和yn表示推算导航的位置;
λx和λy表示导航偏差占载体的运行里程的百分比,由参导航系统的统计结果事先给出;
Wxn和Wyn表示推算导航的误差,由推算导航给出。
序列的高度差(图3中第301步)。
通过极大似然估计函数(图3中第304步):
得到每一个匹配点的匹配似然函数Ln(图3中第304步),其中Xsn表示对第n参考导航点Xn进行匹配定位时匹配区域节点序列,h(Xsn)表示搜索点地形序列Xsn对应的地形插值高度序列。
似然函数Ln最大值位置对应的就是地形匹配的定位位置Xpn=(xpn,ypn)(图3中第302步),黑色点(图1、图2a和图2b中的100)表示地形匹配导航点在推算导航航迹线上的位置,圆圈(图1、图2a和图2b中的101)表示地形匹配导航点的对地形匹配位置。
由此;我们可以通过这一步获得第n个地形匹配导航点的定位坐标Xpn,似然函数Ln(Xsn)。步骤二:测量误差估计和定位置信区间估计
通过步骤一得到定位信息Xpn(图3中第302步)就可以得到定位点的地形面插值高度序列和地形的测量高度差序列Δhpn(图3中第318步):
Δhpn=Zn-h(Xpn)
以及高度偏差的标准差:
spn=std(Δhpn)(图3中第318步)
在获得误差估计和定位位置之后就可以对地形匹配定位的结果进行有效性检验(图3中第309步)。若假设地形测量误差服从高斯分布,那么定位点位置的高度偏差Δhpn服从统计分布:
L-(xpn)表示定点的似然函数值在置信度为α时能到达的下界,这个下界就是一个截平面。每一个定位点的似然函数L(xpn)与这个截平面的交线构成了一个等值线,等值线包围的区域就是定位的置信区间Cpn(图3中第309步)。
步骤三:定位误差估计
步骤二我们得到了定位点的测量误差估计spn(图3中第318步),下面我们就可以对地形匹配的定位精度进行估计(图3中第306,307步),根据估计能达到的下界来近似的获得定位的精度,下面就对定位点的定位误差Pn进行估计,首先计算定位点地形的Fisher信息量In(图3中第306步),由于地形的信息量沿x和y的正向和负方向不同,分别用和表示正向和负向。
其中:(x1,y1)(图4中的401)(x2,y2)(图4中的402)(x3,y3)(图4中的403)(x4,y4)(图4中的404)分别表示插值点所在的地形网格内,左下角为1号点顺时针排列的四个地形节点,待插值点(图4中的400)。
式中:
以x-和x+的大值作为x的定位误差,以y-和y+的大值作为y的定位误差,得到最终的定位误差为:
完成当前工作之后判断当前点数是否等于N(图3中第309步),若是则进入步骤四若不是则进入步骤一。
步骤四:多定位点初航迹拟合
步骤三我们得到了地形匹配定位的定位误差估计,这一步对推算导航的航线进行初步的拟合,假设推算导航航线具有固有偏移Δx(图1中103)和Δy(图1中104),参考导航所提供的航线在每个地形匹配导航点的导航误差认为是偏差相同,这一假设是基于短时间内参考导航误差小的原因。步骤一计算得到的地形匹配定位的位置Xpn=(xpn,ypn)和参考导航位置(xn,yn),利用加权最小二乘估计可以得到(Δx,Δy)的估计结果(图1中103,104和图3中312步)。
式中,λxn,λyn表示对第i定位结果在x和y方向的加权,且满足
下面就对加权系数λxn,λyn进行求取(图3中第311步)。
从而得到当前时刻的定位位置:
步骤五:航迹关联与误定位点剔除
由步骤四得到了拟合航线下的推算导航航线上的地形匹配导航点的位置(图2a中202),下面就对每一个地形匹配定位位置进行有效性检验。根据步骤二得到的地位点的置信区间估计Cpn(图3中第313步),虚线椭圆(图2a中200)表示每一个地形匹配定位点的置信区间,构建的有效检验条件(图3中第314步)如下:
式中:Xn表示经过地形匹配定位修正后地形匹配定位点在推算导航航线上的位置。
步骤六:航迹二次拟合
如果在步骤五中有无效的定位点,那么就将该定位点(图2a中203)剔除。如果剔除了定位点(图3中第315步)那么就要重新计算各个定位点的权重(图3中第316步),对航迹进行再一次的拟合计算(图3中第317步),拟合计算与步骤四相同。
最后:输出结果(图3中第318步)。
Claims (1)
1.一种基于多点地形匹配定位的AUV航迹偏差估计方法,包括如下步骤:
(1)地形匹配定位的搜索区间估计;
(2)未知潮差和测量误差情况下的地形匹配定位;
(3)测量误差估计和定位置信区间估计;
(4)定位误差估计;
(5)多点地形匹配定位初航迹偏差估计;
(6)航迹关联与误定位点剔除;
(7)航迹二次拟合;
其特征是:
所述步骤(1)具体包括:
对于第n个地形匹配点,根据推算导航的输出位置Xn=(xn,yn)推算导航的估计误差Wn=(Wxn,Wyn),推算导航给出的AUV的航行里程估计AUV推算导航系统给出的当前匹配点的推算导航偏差区间,即当前点的地形匹配定位的搜索区间
其中:xn和yn表示推算导航的位置,令Xn=(xn,yn);
λx和λy表示导航偏差占载体的运行里程的百分比,由参导航系统的统计结果事先给出;
Wxn和Wyn表示推算导航的误差,由推算导航给出;
所述步骤(2)具体包括:
带入似然函数:
获得搜索点的似然函数值,则似然函数取值最大的位置就是地形匹配定位的位置:
Zn表示第n个地形匹配定位点的测量地形;
h(Xsn)表示搜索点地形序列Xsn对应的地形插值高度序列;
所述步骤(3)具体包括:
根据步骤(2)得到的定位信息Xpn,得到定位点的地形面插值高度序列和地形的测量高度差序列Δhpn:
Δhpn=Zn-h(Xpn)
以及高度偏差的标准差:
spn=std(Δhpn);
在获得误差估计和定位位置之后,对地形匹配定位的结果进行有效性检验,设地形测量误差服从高斯分布,则定位点位置的高度偏差Δhpn服从统计分布:
得到χ2(N-1)的置信度为α的分位点
L-(xpn)表示定点的似然函数值在置信度为α时能到达的下界,这个下界就是一个截平面,每一个定位点的似然函数L(xpn)与这个截平面的交线构成了一个等值线,等值线包围的区域就是定位的置信区间Cpn;
所述步骤(4)具体包括:
其中:(x1,y1)(x2,y2)(x3,y3)(x4,y4)分别表示插值点所在的地形网格内,左下角为1号点顺时针排列的四个地形节点;
式中:
以x-和x+的大值作为x的定位误差,以y-和y+的大值作为y的定位误差,得到最终的定位误差为:
所述步骤(5)具体包括:
根据地形匹配定位的位置Xpn=(xpn,ypn)和参考导航位置(xn,yn),利用加权最小二乘估计得到(Δx,Δy)的估计结果Δx和Δy为推算导航航线的固有偏移;
从而得到当前时刻的定位位置:
所述步骤(6)具体包括:
根据步骤(3)得到的地形匹配定位的有效区间构建的地形匹配定位的有效检验条件如下:
式中:Xn表示经过地形匹配定位修正后地形匹配定位点在推算导航航线上的位置;
所述步骤(7)具体包括:
如果在步骤(6)中有无效的定位点,就将该定位点剔除;如果剔除了定位点,则重新计算各个定位点的权重,对航迹进行再一次的拟合计算,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710094805.0A CN106885576B (zh) | 2017-02-22 | 2017-02-22 | 一种基于多点地形匹配定位的auv航迹偏差估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710094805.0A CN106885576B (zh) | 2017-02-22 | 2017-02-22 | 一种基于多点地形匹配定位的auv航迹偏差估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106885576A CN106885576A (zh) | 2017-06-23 |
CN106885576B true CN106885576B (zh) | 2020-02-14 |
Family
ID=59180183
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710094805.0A Active CN106885576B (zh) | 2017-02-22 | 2017-02-22 | 一种基于多点地形匹配定位的auv航迹偏差估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106885576B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107504974B (zh) * | 2017-09-15 | 2020-09-25 | 哈尔滨工程大学 | 地形分块与地形测点加权的地形匹配定位方法 |
CN108445481B (zh) * | 2018-02-12 | 2021-11-19 | 四川九洲电器集团有限责任公司 | 一种信息处理方法及测控系统 |
CN109099920B (zh) * | 2018-07-20 | 2021-10-12 | 重庆长安汽车股份有限公司 | 基于多传感器关联的传感器目标精确定位方法 |
CN109034629A (zh) * | 2018-08-01 | 2018-12-18 | 北京电子工程总体研究所 | 一种评价指控系统多元信息融合性能的分析方法和系统 |
CN111435084B (zh) * | 2019-01-12 | 2023-07-11 | 上海航空电器有限公司 | 一种基于置信椭圆的高精度地形参考导航匹配方法 |
CN109900271B (zh) * | 2019-02-25 | 2022-10-14 | 河海大学 | 地形匹配定位中有效伪波峰估计与多点融合初始定位方法 |
CN110428451B (zh) * | 2019-08-15 | 2021-09-24 | 中国地质大学(北京) | 利用gps航迹将地形图与gps设备进行匹配的操作方法 |
CN110763234B (zh) * | 2019-10-15 | 2022-10-28 | 哈尔滨工程大学 | 一种水下机器人海底地形匹配导航路径规划方法 |
CN111121778B (zh) * | 2019-12-03 | 2023-06-16 | 河海大学 | 一种导航系统初始化方法 |
CN111307136B (zh) * | 2020-02-12 | 2021-08-27 | 哈尔滨工程大学 | 一种双智能水下机器人水下航行地形匹配导航方法 |
CN111709517B (zh) * | 2020-06-12 | 2022-07-29 | 武汉中海庭数据技术有限公司 | 一种基于置信度预测系统的冗余融合定位增强的方法和装置 |
CN117634987B (zh) * | 2024-01-25 | 2024-04-02 | 中建安装集团有限公司 | 一种基于物联网的建筑高边坡施工评价管理系统及方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4700307A (en) * | 1983-07-11 | 1987-10-13 | General Dynamics Corp./Convair Division | Feature navigation system and method |
CN101339036A (zh) * | 2008-08-20 | 2009-01-07 | 北京航空航天大学 | 地形辅助导航方法和设备 |
CN102426018A (zh) * | 2011-08-19 | 2012-04-25 | 北京航空航天大学 | 基于混合地形轮廓匹配tercom算法和粒子滤波的地形辅助导航方法 |
CN102788578A (zh) * | 2012-07-25 | 2012-11-21 | 中国人民解放军海军工程大学 | 一种基于局部重力场逼近的匹配导航方法 |
CN103697894A (zh) * | 2013-12-27 | 2014-04-02 | 南京航空航天大学 | 基于滤波器方差阵修正的多源信息非等间隔联邦滤波方法 |
CN104061932A (zh) * | 2014-06-10 | 2014-09-24 | 中国空间技术研究院 | 一种利用引力矢量和梯度张量进行导航定位的方法 |
CN105547300A (zh) * | 2015-12-30 | 2016-05-04 | 航天恒星科技有限公司 | 用于auv的全源导航系统及方法 |
CN106123850A (zh) * | 2016-06-28 | 2016-11-16 | 哈尔滨工程大学 | Auv配载多波束声呐水下地形测绘修正方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1206085B1 (en) * | 2000-11-08 | 2005-09-07 | Infonet Services Corporation, A California Corporation | Method and apparatus for automated service level agreements |
US9495395B2 (en) * | 2013-04-11 | 2016-11-15 | Oracle International Corporation | Predictive diagnosis of SLA violations in cloud services by seasonal trending and forecasting with thread intensity analytics |
-
2017
- 2017-02-22 CN CN201710094805.0A patent/CN106885576B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4700307A (en) * | 1983-07-11 | 1987-10-13 | General Dynamics Corp./Convair Division | Feature navigation system and method |
CN101339036A (zh) * | 2008-08-20 | 2009-01-07 | 北京航空航天大学 | 地形辅助导航方法和设备 |
CN102426018A (zh) * | 2011-08-19 | 2012-04-25 | 北京航空航天大学 | 基于混合地形轮廓匹配tercom算法和粒子滤波的地形辅助导航方法 |
CN102788578A (zh) * | 2012-07-25 | 2012-11-21 | 中国人民解放军海军工程大学 | 一种基于局部重力场逼近的匹配导航方法 |
CN103697894A (zh) * | 2013-12-27 | 2014-04-02 | 南京航空航天大学 | 基于滤波器方差阵修正的多源信息非等间隔联邦滤波方法 |
CN104061932A (zh) * | 2014-06-10 | 2014-09-24 | 中国空间技术研究院 | 一种利用引力矢量和梯度张量进行导航定位的方法 |
CN105547300A (zh) * | 2015-12-30 | 2016-05-04 | 航天恒星科技有限公司 | 用于auv的全源导航系统及方法 |
CN106123850A (zh) * | 2016-06-28 | 2016-11-16 | 哈尔滨工程大学 | Auv配载多波束声呐水下地形测绘修正方法 |
Non-Patent Citations (9)
Title |
---|
"AUV水下地形匹配辅助导航技术研究";陈小龙;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20140415(第04期);C036-33 * |
"Hierarchical triangular patches for terrain rendering with their matching blocks";Lederer, C等;《3rd International Conference on Digital Interactive Media in Entertainment and Arts》;20081231;全文 * |
"Review of AUV Underwater Terrain Matching Navigation";Chen, Pengyun等;《JOURNAL OF NAVIGATION》;20151130;第68卷(第6期);1155-1172 * |
"Study on the Algorithm of Sea bottom Terrain Match";Tong, Zheng等;《ICIC 2009: SECOND INTERNATIONAL CONFERENCE ON INFORMATION AND COMPUTING SCIENCE》;20091231;179 * |
"Terrain Matching Positioning Method Based on Node Multi-information Fusion";Li, Ye等;《JOURNAL OF NAVIGATION》;20170131;第70卷(第1期);82-100 * |
"一种基于电子海图的欠驱动AUV区域搜索方案";李晔等;《机器人》;20140930;第36卷(第5期);609-618 * |
"基于海底地形匹配定位的导航技术";周贤高等;《惯性技术发展动态发展方向研讨会文集》;20121231;157-162 * |
"大潜深AUV下潜定位误差纯距离修正算法研究";张强等;《Proceedings of the 35th Chinese Control Conference》;20160729;5590-5595 * |
"海底地形匹配辅助导航技术现状及发展";李临;《舰船电子工程》;20081231;第28卷(第2期);17-19 * |
Also Published As
Publication number | Publication date |
---|---|
CN106885576A (zh) | 2017-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106885576B (zh) | 一种基于多点地形匹配定位的auv航迹偏差估计方法 | |
CN108519615B (zh) | 基于组合导航和特征点匹配的移动机器人自主导航方法 | |
CN106052688B (zh) | 基于地形轮廓匹配的惯性导航系统速度累积误差修正方法 | |
CN108061889B (zh) | Ais与雷达角度系统偏差的关联方法 | |
CN106767836B (zh) | 一种auv地形匹配导航滤波方法 | |
CN103616036B (zh) | 一种基于合作目标的机载传感器系统误差估计与补偿方法 | |
WO2018072350A1 (zh) | 车辆轨迹预测方法及装置 | |
CN103776453A (zh) | 一种多模型水下航行器组合导航滤波方法 | |
CN106443622A (zh) | 一种基于改进联合概率数据关联的分布式目标跟踪方法 | |
CN109059964B (zh) | 一种基于“重力峰”的惯性导航与重力测量双校准方法 | |
CN108896040B (zh) | 天空海一体化水下潜器惯性/重力组合导航方法和系统 | |
CN113074739A (zh) | 基于动态鲁棒容积卡尔曼的uwb/ins融合定位方法 | |
CN110441760B (zh) | 一种基于先验地形图的大范围海底地形图拓展构图方法 | |
CN106772524A (zh) | 一种基于秩滤波的农业机器人组合导航信息融合方法 | |
CN107966145B (zh) | 一种基于稀疏长基线紧组合的auv水下导航方法 | |
CN109507706B (zh) | 一种gps信号丢失的预测定位方法 | |
CN103047982B (zh) | 基于角度信息的目标自适应跟踪方法 | |
CN106840211A (zh) | 一种基于kf和stupf组合滤波的sins大方位失准角初始对准方法 | |
CN103369466A (zh) | 一种地图匹配辅助室内定位方法 | |
CN112346104A (zh) | 一种无人机信息融合定位方法 | |
CN104613966B (zh) | 一种地籍测量事后数据处理方法 | |
CN105245627A (zh) | 一种基于网络坐标系统的ip定位方法 | |
CN107504974A (zh) | 地形分块与地形测点加权的地形匹配定位方法 | |
CN108332756B (zh) | 一种基于拓扑信息的水下航行器协同定位方法 | |
CN110132281A (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 |