CN106767836A - 一种auv地形匹配导航滤波方法 - Google Patents
一种auv地形匹配导航滤波方法 Download PDFInfo
- Publication number
- CN106767836A CN106767836A CN201710086012.4A CN201710086012A CN106767836A CN 106767836 A CN106767836 A CN 106767836A CN 201710086012 A CN201710086012 A CN 201710086012A CN 106767836 A CN106767836 A CN 106767836A
- Authority
- CN
- China
- Prior art keywords
- terrain match
- navigation
- sigma
- error
- terrain
- 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
- G01C21/203—Specially adapted for sailing ships
-
- 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
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海底地形匹配导航的滤波方法。包括对地形匹配定位的误差估计,地形匹配定位的似然函数修正,地形匹配定位的置信区间估计,参考导航与地形匹配结果的融合滤波。本发明的主要部分是地形匹配定位的误差估计方法、地形匹配定位数据和参考导航数据的融合方法,地形匹配导航计算机接收参考导航数据和实时地形测量数据,通过匹配定位,融合滤波两个步骤得到定位位置估计,然后将位置信息送入参考导航计算机进行导航修正,实现连续的递推导航。
Description
技术领域
本发明涉及的是一种水下地形匹配导航方法,具体地说是一种AUV的地形匹配导航滤波方法。
背景技术
水下地形匹配导航具有无累计导航偏差的优点可作为推算导航的偏差修正,修正过程实际上是地形匹配定位结果与推算导航结果的融合滤波过程,由于地形匹配定位通常不具有连续性以及地形变化的具有很强的随机性容易导致滤波结果的发散。目前地形匹配导航方法主要有TERCOM方法,SIATN方法。TERCOM法属于批处理算法,通过获得航线下方的部分地形与载体携带的先验地形配准获得定位位置,TERCOM算法不涉及滤波和递推导航的问题,由于没有充分利用推算导航的信息,导致算法本身不具备较好的可靠性和连续导航能力;SITAN方法属于递推形式的导航方法,但递推过程需要进行地形的线性化,由于地形具有很强的非线性特征和较大的测量误差,这容易导致滤波发散。
发明内容
本发明的目的在于提供一种能实现连续的地形匹配导航和非连续的地形匹配导航,提高导航方式的灵活性的AUV地形匹配导航滤波方法。
本发明的目的是这样实现的:
AUV在水下航行lt|t距离之后到达地形匹配导航的修正点,推算导航给出了推算导航位置推算导航的误差并开启地形匹配导航程序,此时按照如下的步骤完成地形匹配导航的滤波;
步骤一、向地形匹配导航系统输入初始数据,所述初始数据包括:推算导航位置推算导航误差AUV航程当前时刻测量得到的地形Z以及先验地形图h;
步骤二、计算地形匹配定位的搜索区间估计,所述搜索区间由下式确定:
其中:λx,λy表示导航偏差占载体的运行里程的百分比,由参导航系统的统计结果事先给出;α≥1表示放大倍数,取(1,1.5];
以为中心,和为x方向和y方向的长度构成的矩形区域就是搜索区间XS;
步骤三、地形匹配定位,
根据步骤二中计算得到的搜索范围XS开始进行地形搜索匹配,假设潮差为tij,搜索点ij的先验地形插值序列与测量地形的高度偏差序列:
假设地形高度偏差序列满足白噪声分布而潮差是常量,得到搜索点ij的潮差和地形测量误差估计:
得到了潮差的估计值之后,计算测量地形和先验地形的真实相似程度:
其中:h(xij,yij)表示测量序列点(xij,yij)在先验地形图h中的插值结果;zij∈Z,Z表示测量地形,zij表示测量地形内的点;
查找似然函数Lij值最大的位置得到地形匹配定位的位置得到定位位置后将定位位置的潮差估计和测量地形的误差估计作为当前定位位置的最优潮差估计和测量误差估计记为:
步骤四、地形匹配地位结果的有效性检验
根据地形匹配定位位置检验该定位点的有效性,建立如下的有效性检验模型:
其中Ct|t为有效区间,由下面的方法得到:
(1)以步骤三中得到的似然函数Lij为输入,计算定位点似然函数的下界Llow;
其中:σp表示地形匹配地位点的测量误差估计;mn表示地形匹配地位点的个数;Zα/2表示以σp为正态分布的上分位点对应的值;
(2)以Llow为等高平面截取步骤三中的似然函数Lij,得到的等高线其中i表示等高线索引号,假设共有n条等高线;
(3)查找包围地形匹配定位点的等高线 在等高线所包围区域的内部,就是地形匹配定位的置信区间Ct|t;
步骤五、地形匹配定位结果的定位误差估计,其估计方法如下,先计算地形匹配定位点的信息量,I+,I-表示正向和负向的信息量,先计算I+:
式中:m,n表示测量地形的节点数目,k,l表示地形节点的索引号,σp表示定位点的测量误差估计,表示测量地形中的(k,l)号节点在先验地形中的插值结果;
由于定位误差等于信息矩阵的逆P+=(I+)-1进一步简化:
其中:
由此得到了定位点在x+和y+方向的定位误差将I+计算式中的+d换成-d同理计算P-:
由此得到了定位点在x-和y-方向的定位误差以及x+和y+方向的定位误差
将定位误差标记为:
步骤六、地形匹配定位与推算导航的融合滤波
利用推算导航输出误差Pt|t和推算导航的位置地形匹配定位位置地形匹配定位误差和求得两个估计值的滤波结果:
再计算滤波误差滤波误差为:
由于地形的强非线性和随机性特征导致地形匹配导航的滤波难以采用常规的方法(如Kalman滤波)容易滤波发散和收敛太慢,通常滤波过程需要计算观测预测值,这就需要进行地形的线性化操作,不仅实现困难还会引入更大的误差。本发明就是为了简化滤波过程,实现地形匹配导航的连续或非连续递推而设计的。本发明提出了一种新的地形匹配导航的滤波方法。该方法可以实现连续的地形匹配导航和非连续的地形匹配导航,并且导航过程中不需要对地形做额外的处理,避免地形的线性化等其他复杂的操作,导航过程可以对地形匹配定位点进行有效性判定和推算导航与地形匹配定位结果的递推融合滤波。
本发明滤波过程简单不需要进行额外的地形线性化处理,由于滤波过程包含了地形匹配定位结果的有效性评估具有较好的鲁棒性,不存在滤波结果发散的问题。利用本方法不仅可以实现连续的地形匹配定位与推算导航的融合滤波,而且还可以进行间断性的融合滤波,也就是说两次滤波之间可以有一段时间只使用推算导航,当获得有效的地形匹配定位位置后再进行滤波融合,提高了导航方式的灵活性。
附图说明
图1是地形匹配导航的滤波过程;
图2是地形匹配定位过程流程图;
图3是地形匹配定位点有效性检测流程图;
图4是地形匹配定位与推算导航定位结果的相对位置关系。
具体实施方式
下面举例对本发明作更详细的描述。
AUV在水下航行lt|t距离之后到达地形匹配导航的修正点,推算导航给出了推算导航位置推算导航的误差并开启地形匹配导航程序,此时按照如下的步骤完成地形匹配导航的滤波。
步骤100:初始数据输入,向地形匹配导航系统输入初始数据:
推算导航位置
推算导航误差
AUV航程
当前时刻测量得到的地形Z;
先验地形图h。
1.计算地形匹配定位的搜索区间估计(结合图中101)
该搜索区间即使AUV可能的位置区间,搜索区间由下式确定:
式中:
λx,λy表示导航偏差占载体的运行里程的百分比,由参导航系统的统计结果事先给出;
α≥1表示放大倍数,一般取(1,1.5];
以为中心,和为x方向和y方向的长度构成的矩形区域就是搜索区间XS。
2.地形匹配定位(结合图中102)
根据发明步骤1中计算得到的搜索范围XS(结合图中101)开始进行地形搜索匹配,假设潮差为tij,搜索点ij的先验地形插值序列(结合图中201)与测量地形(结合图中103)的高度偏差序列:
假设地形高度偏差序列满足白噪声分布而潮差是常量,得到搜索点ij的潮差和地形测量误差估计(结合图中202):
得到了潮差的估计值之后,计算测量地形和先验地形的真实相似程度(结合图中203):
式中:
h(xij,yij)表示测量序列点(xij,yij)在先验地形图h中的插值结果;
zij∈Z,Z表示测量地形,zij表示测量地形内的点。
查找似然函数Lij值最大的位置(结合图中206)可得到地形匹配定位的位置得到定位为之后将定位位置的潮差估计和测量地形的误差估计作为当前定位位置的最优潮差估计和测量误差估计记为:(结合图中207)。
3.地形匹配地位结果的有效性检验(结合图中107)
根据步骤2中获得的地形匹配定位位置下面即使检验该定位点的有效性,建立如下的有效性检验模型:
(结合图中305,结合图中306)
式中Ct|t为有效区间,由下面的方法得到:
(1)以步骤3中得到的似然函数Lij为输入(结合图中203),计算定位点似然函数的下界Llow(结合图中301);
式中:σp表示地形匹配地位点的测量误差估计;
mn表示地形匹配地位点的个数;
Zα/2表示以σp为正态分布的上分位点对应的值。
(2)以Llow为等高平面截取步骤2中的似然函数Lij,得到的等高线(结合图中302),其中i表示等高线索引号,假设共有n条等高线;
(3)查找包围地形匹配定位点(结合图中206)的等高线(在等高线所包围区域的内部)(结合图中303),就是地形匹配定位的置信区间Ct|t(结合图中304)。
4.地形匹配定位结果的定位误差估计(结合图中105)
其估计方法如下,先计算地形匹配定位点的信息量,I+,I-表示正向和负向的信息量,先计算I+:
式中:m,n表示测量地形的节点数目;k,l表示地形节点的索引号,σp表示定位点的测量误差估计。表示测量地形中的(k,l)号节点在先验地形中的插值结果。由于定位误差等于信息矩阵的逆P+=(I+)-1进一步简化:
式中:
由此得到了定位点在x+和y+方向的定位误差将I+计算式中的+d换成-d同理可以计算P-:
由此得到了定位点在x-和y-方向的定位误差以及x+和y+方向的定位误差
将定位误差标记为:
5.地形匹配定位与推算导航的融合滤波(108)
利用推算导航输出误差Pt|t和推算导航的位置地形匹配定位位置地形匹配定位误差和直接求得两个估计值的滤波结果:
式中的取值从取得,取值的规则如下:
A.如果地形匹配定位的位置与推算导航的位置点(结合图中402)和点(结合图中401)则有:
B.如果地形匹配定位的位置与推算导航的位置点(结合图中403)和点(结合图中401)则有:
C.如果地形匹配定位的位置与推算导航的位置点(结合图中404)和点(结合图中401)则有:
D.如果地形匹配定位的位置与推算导航的位置点(结合图中405)和点(结合图中401)则有:
E.如果地形匹配定位的位置与推算导航的位置点(结合图中406)和点(结合图中401)则有:
F.如果地形匹配定位的位置与推算导航的位置点(结合图中407)和点(结合图中401)则有:
G.如果地形匹配定位的位置与推算导航的位置点(结合图中408)和点(结合图中401)则有:
H.如果地形匹配定位的位置与推算导航的位置点(结合图中409)和点(结合图中410)则有:
I.如果地形匹配定位的位置与推算导航的位置重合都位于点(结合图中401)则有:
下面就可以计算滤波误差滤波误差为:
通过以上的步骤就可以实现地形匹配导航的递推估计。
Claims (7)
1.一种AUV地形匹配导航滤波方法,其特征是:AUV在水下航行lt|t距离之后到达地形匹配导航的修正点,推算导航给出了推算导航位置推算导航的误差并开启地形匹配导航程序,此时按照如下的步骤完成地形匹配导航的滤波;
步骤一、向地形匹配导航系统输入初始数据;
步骤二、计算地形匹配定位的搜索区间估计;
步骤三、地形匹配定位;
步骤四、地形匹配地位结果的有效性检验;
步骤五、地形匹配定位结果的定位误差估计;
步骤六、地形匹配定位与推算导航的融合滤波。
2.根据权利要求1所述的AUV地形匹配导航滤波方法,其特征是:所述初始数据包括:推算导航位置推算导航误差AUV航程当前时刻测量得到的地形Z以及先验地形图h。
3.根据权利要求3所述的AUV地形匹配导航滤波方法,其特征是:所述搜索区间由下式确定:
其中:λx,λy表示导航偏差占载体的运行里程的百分比,由参导航系统的统计结果事先给出;α≥1表示放大倍数,取(1,1.5];
以为中心,和为x方向和y方向的长度构成的矩形区域就是搜索区间XS。
4.根据权利要求3所述的AUV地形匹配导航滤波方法,其特征是所述地形匹配定位具体包括:
根据步骤二中计算得到的搜索范围XS开始进行地形搜索匹配,假设潮差为tij,搜索点ij的先验地形插值序列与测量地形的高度偏差序列:
假设地形高度偏差序列满足白噪声分布而潮差是常量,得到搜索点ij的潮差和地形测量误差估计:
得到了潮差的估计值之后,计算测量地形和先验地形的真实相似程度:
其中:h(xij,yij)表示测量序列点(xij,yij)在先验地形图h中的插值结果;zij∈Z,Z表示测量地形,zij表示测量地形内的点;
查找似然函数Lij值最大的位置得到地形匹配定位的位置得到定位位置后将定位位置的潮差估计和测量地形的误差估计作为当前定位位置的最优潮差估计和测量误差估计记为:
5.根据权利要求4所述的AUV地形匹配导航滤波方法,其特征是所述地形匹配地位结果的有效性检验具体包括:
根据地形匹配定位位置检验该定位点的有效性,建立如下的有效性检验模型:
其中Ct|t为有效区间,由下面的方法得到:
(1)以步骤三中得到的似然函数Lij为输入,计算定位点似然函数的下界Llow;
其中:σp表示地形匹配地位点的测量误差估计;mn表示地形匹配地位点的个数;Zα/2表示以σp为正态分布的上分位点对应的值;
(2)以Llow为等高平面截取步骤三中的似然函数Lij,得到的等高线其中i表示等高线索引号,假设共有n条等高线;
(3)查找包围地形匹配定位点的等高线 在等高线所包围区域的内部,就是地形匹配定位的置信区间Ct|t。
6.根据权利要求5所述的AUV地形匹配导航滤波方法,其特征是所述地形匹配定位结果的定位误差估计的估计方法为:
先计算地形匹配定位点的信息量,I+,I-表示正向和负向的信息量,先计算I+:
式中:m,n表示测量地形的节点数目,k,l表示地形节点的索引号,σp表示定位点的测量误差估计,表示测量地形中的(k,l)号节点在先验地形中的插值结果;
由于定位误差等于信息矩阵的逆P+=(I+)-1进一步简化:
其中:
由此得到了定位点在x+和y+方向的定位误差将I+计算式中的+d换成-d同理计算P-:
由此得到了定位点在x-和y-方向的定位误差以及x+和y+方向的定位误差
将定位误差标记为:
7.根据权利要求6所述的AUV地形匹配导航滤波方法,其特征是所述地形匹配定位与推算导航的融合滤波具体包括:
利用推算导航输出误差Pt|t和推算导航的位置地形匹配定位位置地形匹配定位误差和求得两个估计值的滤波结果:
再计算滤波误差滤波误差为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710086012.4A CN106767836B (zh) | 2017-02-17 | 2017-02-17 | 一种auv地形匹配导航滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710086012.4A CN106767836B (zh) | 2017-02-17 | 2017-02-17 | 一种auv地形匹配导航滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106767836A true CN106767836A (zh) | 2017-05-31 |
CN106767836B CN106767836B (zh) | 2019-12-06 |
Family
ID=58958124
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710086012.4A Active CN106767836B (zh) | 2017-02-17 | 2017-02-17 | 一种auv地形匹配导航滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106767836B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107314768A (zh) * | 2017-07-06 | 2017-11-03 | 上海海洋大学 | 水下地形匹配辅助惯性导航定位方法及其定位系统 |
CN107727096A (zh) * | 2017-09-15 | 2018-02-23 | 哈尔滨工程大学 | 基于有效节点筛选的auv地形匹配定位方法 |
CN108415445A (zh) * | 2018-02-09 | 2018-08-17 | 西北工业大学 | 一种基于开关约束的水下航行器定位鲁棒优化方法 |
CN109900271A (zh) * | 2019-02-25 | 2019-06-18 | 河海大学 | 地形匹配定位中有效伪波峰估计与多点融合初始定位方法 |
CN110017839A (zh) * | 2019-03-27 | 2019-07-16 | 中国空间技术研究院 | 一种提高水下导航匹配概率的方法和系统 |
CN110220510A (zh) * | 2019-06-03 | 2019-09-10 | 哈尔滨工程大学 | 一种考虑地图准确性的水下机器人海底地形匹配导航路径规划方法 |
CN110763234A (zh) * | 2019-10-15 | 2020-02-07 | 哈尔滨工程大学 | 一种水下机器人海底地形匹配导航路径规划方法 |
CN111121778A (zh) * | 2019-12-03 | 2020-05-08 | 河海大学 | 一种导航系统初始化方法 |
CN111307136A (zh) * | 2020-02-12 | 2020-06-19 | 哈尔滨工程大学 | 一种双智能水下机器人水下航行地形匹配导航方法 |
CN113932811A (zh) * | 2021-08-25 | 2022-01-14 | 河海大学 | 一种新的地形匹配导航系统、方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104390646A (zh) * | 2014-09-15 | 2015-03-04 | 东南大学 | 水下潜器地形辅助惯性导航系统的位置匹配方法 |
CN104484891A (zh) * | 2014-10-22 | 2015-04-01 | 哈尔滨工程大学 | 一种基于纹理特征和地形特征参数的水下地形匹配方法 |
CN105115492A (zh) * | 2015-08-14 | 2015-12-02 | 武汉大学 | 基于声学多普勒计程仪的水下地形匹配导航系统 |
CN105547300A (zh) * | 2015-12-30 | 2016-05-04 | 航天恒星科技有限公司 | 用于auv的全源导航系统及方法 |
CN106123850A (zh) * | 2016-06-28 | 2016-11-16 | 哈尔滨工程大学 | Auv配载多波束声呐水下地形测绘修正方法 |
-
2017
- 2017-02-17 CN CN201710086012.4A patent/CN106767836B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104390646A (zh) * | 2014-09-15 | 2015-03-04 | 东南大学 | 水下潜器地形辅助惯性导航系统的位置匹配方法 |
CN104484891A (zh) * | 2014-10-22 | 2015-04-01 | 哈尔滨工程大学 | 一种基于纹理特征和地形特征参数的水下地形匹配方法 |
CN105115492A (zh) * | 2015-08-14 | 2015-12-02 | 武汉大学 | 基于声学多普勒计程仪的水下地形匹配导航系统 |
CN105547300A (zh) * | 2015-12-30 | 2016-05-04 | 航天恒星科技有限公司 | 用于auv的全源导航系统及方法 |
CN106123850A (zh) * | 2016-06-28 | 2016-11-16 | 哈尔滨工程大学 | Auv配载多波束声呐水下地形测绘修正方法 |
Non-Patent Citations (1)
Title |
---|
周贤高等: "基于海底地形匹配定位的导航技术", 《惯性技术发展动态发展方向研讨会文集》 * |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107314768A (zh) * | 2017-07-06 | 2017-11-03 | 上海海洋大学 | 水下地形匹配辅助惯性导航定位方法及其定位系统 |
CN107314768B (zh) * | 2017-07-06 | 2020-06-09 | 上海海洋大学 | 水下地形匹配辅助惯性导航定位方法及其定位系统 |
CN107727096A (zh) * | 2017-09-15 | 2018-02-23 | 哈尔滨工程大学 | 基于有效节点筛选的auv地形匹配定位方法 |
CN108415445B (zh) * | 2018-02-09 | 2020-11-06 | 西北工业大学 | 一种基于开关约束的水下航行器定位鲁棒优化方法 |
CN108415445A (zh) * | 2018-02-09 | 2018-08-17 | 西北工业大学 | 一种基于开关约束的水下航行器定位鲁棒优化方法 |
CN109900271A (zh) * | 2019-02-25 | 2019-06-18 | 河海大学 | 地形匹配定位中有效伪波峰估计与多点融合初始定位方法 |
CN110017839A (zh) * | 2019-03-27 | 2019-07-16 | 中国空间技术研究院 | 一种提高水下导航匹配概率的方法和系统 |
CN110220510A (zh) * | 2019-06-03 | 2019-09-10 | 哈尔滨工程大学 | 一种考虑地图准确性的水下机器人海底地形匹配导航路径规划方法 |
CN110220510B (zh) * | 2019-06-03 | 2023-03-31 | 哈尔滨工程大学 | 一种考虑地图准确性的水下机器人海底地形匹配导航路径规划方法 |
CN110763234A (zh) * | 2019-10-15 | 2020-02-07 | 哈尔滨工程大学 | 一种水下机器人海底地形匹配导航路径规划方法 |
CN111121778A (zh) * | 2019-12-03 | 2020-05-08 | 河海大学 | 一种导航系统初始化方法 |
CN111307136A (zh) * | 2020-02-12 | 2020-06-19 | 哈尔滨工程大学 | 一种双智能水下机器人水下航行地形匹配导航方法 |
CN111307136B (zh) * | 2020-02-12 | 2021-08-27 | 哈尔滨工程大学 | 一种双智能水下机器人水下航行地形匹配导航方法 |
CN113932811A (zh) * | 2021-08-25 | 2022-01-14 | 河海大学 | 一种新的地形匹配导航系统、方法 |
CN113932811B (zh) * | 2021-08-25 | 2023-10-27 | 河海大学 | 一种新的地形匹配导航系统、方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106767836B (zh) | 2019-12-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106767836A (zh) | 一种auv地形匹配导航滤波方法 | |
Jo et al. | Generation of a precise roadway map for autonomous cars | |
CN106885576B (zh) | 一种基于多点地形匹配定位的auv航迹偏差估计方法 | |
Li et al. | A variational Bayesian-based unscented Kalman filter with both adaptivity and robustness | |
CN108931795B (zh) | 定位设备轨迹优化和边界提取方法及装置 | |
CN103411609B (zh) | 一种基于在线构图的飞行器返航路线规划方法 | |
CN106052688A (zh) | 基于地形轮廓匹配的惯性导航系统速度累积误差修正方法 | |
CN105891863B (zh) | 一种基于高度约束的扩展卡尔曼滤波定位方法 | |
CN104575075B (zh) | 一种基于北斗的城市路网车辆坐标校正方法及装置 | |
CN103759732B (zh) | 一种角度信息辅助的集中式多传感器多假设跟踪方法 | |
CN108732603A (zh) | 用于定位车辆的方法和装置 | |
CN104075715A (zh) | 一种结合地形和环境特征的水下导航定位方法 | |
CN106017400A (zh) | 基于耕作轨迹等效矩形累加的农机作业面积测量方法 | |
CN104833361A (zh) | 复杂路况下的基于多权重值的地图匹配方法 | |
CN103399336B (zh) | 一种非高斯噪声环境下gps/sins组合导航方法 | |
Heo et al. | Consistent EKF-based visual-inertial navigation using points and lines | |
CN107966145B (zh) | 一种基于稀疏长基线紧组合的auv水下导航方法 | |
CN104677361A (zh) | 一种综合定位的方法 | |
CN110441760A (zh) | 一种基于先验地形图的大范围海底地形图拓展构图方法 | |
CN113581260B (zh) | 一种基于gnss的列车轨道占用判别方法 | |
CN102052925A (zh) | 基于空间关系约束的适配区景象匹配方法 | |
CN115951379A (zh) | 基于gnss系统的厘米级定位纠偏方法 | |
Wu et al. | A Vehicle Map-matching Algorithm based on Measure Fuzzy Sorting. | |
Kupervasser et al. | Robust positioning of drones for land use monitoring in strong terrain relief using vision-based navigation | |
CN103322999A (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 | ||
EE01 | Entry into force of recordation of patent licensing contract | ||
EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20170531 Assignee: T-SEA MARINE TECHNOLOGY CO.,LTD. Assignor: HARBIN ENGINEERING University Contract record no.: X2022980000982 Denomination of invention: A terrain matching navigation filtering method for AUV Granted publication date: 20191206 License type: Common License Record date: 20220124 |