CN102128625B - 重力辅助惯性导航***中重力图匹配的初始匹配方法 - Google Patents
重力辅助惯性导航***中重力图匹配的初始匹配方法 Download PDFInfo
- Publication number
- CN102128625B CN102128625B CN201010592977A CN201010592977A CN102128625B CN 102128625 B CN102128625 B CN 102128625B CN 201010592977 A CN201010592977 A CN 201010592977A CN 201010592977 A CN201010592977 A CN 201010592977A CN 102128625 B CN102128625 B CN 102128625B
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- carrier
- gravity
- coupling
- initial matching
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Navigation (AREA)
Abstract
重力辅助惯性导航***中重力图匹配的初始匹配方法,根据惯导***短时测量精度高的特点,利用惯导***在相邻时刻t1t2间和t2t3间测得的运载体行驶的距离信息L1、L2,以及测得运载体在t2时刻的相对转向角θ,利用这三个参数构建高精度几何约束模型,并结合重力传感器在t1、t2和t3时刻测得的重力值所对应的等值线C1、C2和C3,基于几何约束的等值线匹配算法获取重力图匹配的初始值。本发明是一种自主式初始匹配方法,具有精度高、鲁棒性好的特点,可应用于地形/地磁/重力辅助惯性导航等无源导航***中的初始匹配。
Description
技术领域
本发明涉及了重力辅助惯性导航***中重力图匹配的初始匹配方法,主要针对重力辅助惯性导航中重力图匹配算法的初始匹配方法。
背景技术
就地球物理场辅助惯性导航的无源导航技术来说,并不是一个新鲜的课题,最早开始的是陆地上的地形辅助惯性导航研究,并于20世纪70年代末80年代初取得明显的成果。近年来,借助大地测量技术成果,惯性/重力、惯性/地磁无源组合导航的理论和方法同样引起了国内外研究机构和学者的注意,相继开展了重力匹配导航、地磁匹配导航等技术的研究。目前重力辅助惯性导航的技术常采用的方法大多是沿用地形匹配的相关技术,主要有SITAN算法、TERCOM算法等。无论是SITAN算法,还是TERCOM算法,其基本流程都是通过运载体上承载的传感器实时测量运载体运动轨迹上的地球物理场数据;同时,根据惯导***提供的运载***置信息,从导航用参考重力图中获取地球物理场数据;然后将这两组数据集送给匹配解算计算机,利用匹配算法确定运载体的最佳匹配位置。
数据集匹配问题最早可以追溯到二十世纪五十年代末的遥感图像分析,那时Hobrough首次对遥感模拟图像进行了相似性分析,提出了图像匹配的概念,至六七十年代,数据集匹配的研究方法大多基于对图像的特征提取,如,Anuta的快速Fourier变换(FFT)方法,但是,由于提取特征方法的限制,使得在特征提取时数据集的信息不能完全得到反映。直到八十年代初,Lucas针对视频图像匹配给出了一种迭代算法,由于该方法直接针对图像数据集进行搜索,因此Lucas的方法完全保留了图像的性质,从而确保了匹配的精确性。到了九十年代初,Chen和Medioni,Besl和McKay以及Zhang等人分别在Lucas的工作基础上将各种具体匹配问题上升到数据集之间的匹配问题,并独立提出了求解数据集匹配问题的ICP(Iterated Closest Point,简称:ICP)算法,尤其是Besl和McKey的工作已经成为数据集匹配问题的一个基础,ICP方法也已经成为求解数据集匹配问题的一般性方法而被广泛采用,而且已被广泛应用于地球物理场辅助惯性导航的重力图(地形图/地磁图)匹配。
ICP算法是一个关于全局收敛性的研究,在理论上可以在任何初始位置误差情况都能工作,而在实际应用中由于目标函数、对应关系选择、变换类型以及初始位置的选择等因素的影响,几乎所有基于ICP的现有方法都只能得到局部最优匹配,是否能取得全局匹配最优的关键在于初始匹配参数的选择。针对初始匹配的选择问题,Hugli等人提出了基于初始参数划分的SIC-range方法,Chetverikov等人通过对每一步迭代中对应点的选择范围进行“裁剪”,并随着迭代的进行逐步缩小和修正对应点的选择范围,以上方法主要源于对静态遥感图像的相似性匹配,不要求实时性。在重力辅助惯性导航***中,由于要保证惯性导航***长时间、高精度的工作,必须实时修正惯导***本身的***误差,所以重力辅助惯性导航***对匹配算法具有实时性和可靠性要求。
发明内容
本发明的技术解决问题:克服现有技术的不足,提供一种重力辅助惯性导航***中重力图匹配的初始匹配方法,可有效地提高重力辅助惯性导航***的可靠性和实时性,从而可消除和克服在惯导***输出的位置信息存在大误差条件下重力图匹配算法失效的缺陷。
本发明采用的技术方案步骤如下:一种重力辅助惯性导航***中重力图匹配的初始匹配方法,实现步骤如下:
第一步,判断运载体已进入重力场适配区域Ψ,选取运载体所承载的重力场传感器连续的三个采样点,三个采样点所对应的时间分别为t1、t2和t3时刻。
第二步,确定运载体重力匹配参考图的搜索区域Ω;根据运载体所承载惯导***的误差分布特性函数,确定当前时刻惯性***的距离误差阈值δ,以惯导***所提供的运载体当前位置信息为中心,距离误差阈值δ为半径,划定重力匹配参考图的搜索区域Ω。
第三步,构建高精度三角形几何约束模型,并构建三角空间Γ。
第四步,利用运载体所承载的重力场传感器在t1、t2和t3时刻所采取的重力值,获取运载体在t1、t2和t3时刻对应参考重力场等值线C1、C2和C3所包含的点集P1、P2和P3。
第五步,基于三角形几何约束模型等值线匹配算法,获取运载体在当前时刻的所有初始匹配对这些初始匹配对组成的集合定义为初始匹配集j为自然数,1<j<N,N为匹配对集所包含的匹配对数,pj、qj、mj分别表示第j个初始匹配对在等值线C1、等值线C2、等值线C3上所对应的点。
第六步,采用加权概率估计模型算法,利用价值函数为角度误差因子和距离误差因子的二次函数这一特点,并计算初始匹配集中各组数据的代价值,最终获取精确的初始匹配值。
所述第二步中划定搜索区域Ω,其过程为:首先根据惯导***的误差分布特性函数以及误差模型,确定惯导***提供的位置信息的误差阈值δ,然后以惯导***提供的运载体当前位置为中心,惯导***的误差阈值δ为半径,划定搜索区域Ω,从而在减小搜索区域提高搜索速度前提条件下,确保运载体真实位置信息落于区域Ω内。
所述第三步构建高精度三角形几何约束模型,并确定三角形几何模型的三角空间Γ。其过程为:首先,利用惯导***短时测量精度高的特点,获取惯导***在相邻时刻t1t2间和t2t3间的测得运载体行驶的距离信息L1、L2,以及运载体在t2时刻的相对转向角θ,构建高精度的三角型几何约束模型;然后,选取任意三角形,假定三角形的边长分别为a、b和c,且a>b>c;用两个参数b/a和c/a来表示该三角形,从而把由(x,y)空间中的三个点构成的三角形转换成(b/a,c/a)空间中用一个点来表示,该空间即为三角形空间Γ。
所述第五步基于三角形几何约束模型等值线匹配,获取运载体所有可能位置的初始匹配集 (j为自然数,1<j<N,N为匹配对集所包含的匹配对数,pj、qj、mj分别表示第j个初始匹配对在等值线C1、等值线C2、等值线C3上所对应的点)。其过程为:首先从点集P1、P2和P3中各取一点组成一个三角形匹配对然后分别计算匹配对所对应三角形各边边长ai、bi和ci(i为自然数,表示对应的第i个匹配对);最后把第i个匹配对投影到三角形空间,并判断投影点是否落入三角空间Γ内;遍历点集P1、P2和P3中所有点,选取投影点落入三角空间Γ内的所有匹配对组成初始匹配集。
所述第六步采用加权概率估计模型算法,利用价值函数为角度误差因子和距离误差因子的二次函数这一特点,计算初始匹配集中各组数据的代价值,取代价值最小的那组数据为运载体最终初始匹配位置的具体过程如下:
构建的代价函数为:
cost=f(l,α) (1)
式中l表示匹配点与惯导***所提供的对应位置点之间的距离参数,α表示匹配点的方向角与惯导***所提供的对应点的方向角之间的夹角。
从匹配对集中任选一组匹配对由公式(1)分别计算匹配对所对应的三个匹配点pj、qj和mj的匹配代价值costpj、costqj和costmj,可得匹配对的匹配代价值选取中最小值所对应的一组匹配对为运载体最终的初始匹配值。
本发明与现有的技术方法相比有益的效果是:
(1)针对实时性要求,目前已有的初始匹配方法如Hugli等人提出了基于初始参数划分的SIC-range方法,Chetverikov等人提出的“裁剪”法都是针对静态遥感图像的相似性匹配,不要求实时性。利用本发明,可直接利用惯导***短时测量的高精度参数构建几何约束模型并结合等值线匹配算法直接获取高精度实时性和可靠的初始匹配参数,从而可消除和克服在惯导***输出的位置信息存在大误差条件下重力图匹配算法失效的缺陷。
(2)针对***对匹配算法实时性的要求,国内的孙枫等人利用惯性导航***短时高精度的特点,采用基于误差平方和价值函数最优的等值线匹配算法,吴太旗等人提出了一种基于直线段方式的重力图匹配方法,这两种方法都是为了获取高精度的初始位置信息,但是它们都以假设运载体做直线运动为前提条件,因此在实际应用上具有一定的局限性。本发明提出的几何约束模型,它可适用于运载体做任何轨迹的运动,应用范围广泛。
附图说明
图1为重力辅助惯性导航基本原理框图;
图2为本发明的流程图;
图3为惯导***的航位推算定位原理框图;
图4为本发明构建的几何约束模型示意图;
图5为本发明构建的三角形空间Γ示意图;
图6为本发明基于几何约束模型的等直线匹配算法示意图。
具体实施方式
如图1所示,传统的重力辅助惯性导航***一般主要分成A、B、C和D四个模块。A模块的主要目的是利用运载体上所承载的重力场传感器实时测量运载体运行轨迹上的实际重力场数据;B模块的主要目的是利用运载体上所承载的惯导***实时提供的运载***置信息并结合重力参考图最终获取参考重力场数据;C模块的目的是利用匹配算法最终获取运载体的最优位置信息;D模块的目的是利用最优匹配位置信息采用信息融合技术实时修正惯导***内部的***误差。
本发明主要是针对C模块中匹配算法的初始对准方法,以提高重力辅助惯性导航***的可靠性和实时性。
如图2所示,本发明将按照以下步骤实现:
第一步,判断运载体已进入重力场适配区域Ψ,选取运载体所承载的重力场传感器连续的三个采样点,三个采样点所对应的时间分别为t1、t2和t3时刻。
为了确保匹配算法在大位置误差时可用,以及本发明构建的三角形约束模型的特点,在判断运载体已进入重力场适配区域Ψ时,选取运载体所承载的地球物理场传感器连续的三个采样点的地球物理场观测值后,记录三个采样点对应的时间分别为t1、t2和t3时刻。
第二步,确定运载体重力匹配参考图的搜索区域Ω;根据运载体所承载惯导***的误差分布特性函数,确定当前时刻惯性***的距离误差阈值δ,以惯导***所提供的运载体当前位置信息为中心,距离误差阈值δ为半径,划定重力匹配参考图的搜索区域Ω。
目前惯性技术已非常成熟,所以首先根据惯导***的误差分布特性函数以及误差模型,确定当前时刻惯导***提供的位置信息的误差阈值δ,然后以惯导***提供的运载体当前位置为中心,惯导***的误差阈值δ为半径,划定重力匹配参考图的搜索区域Ω,从而在减小搜索区域提高搜索速度前提条件下,确保运载体真实位置信息落于重力匹配参考图的搜索区域Ω内。
第三步,构建高精度三角形几何约束模型,并确定三角形几何模型的三角空间Γ。
利用惯导***短时测量精度高的特点,获取惯导***在相邻时刻t1t2间和t2t3间的测得运载体行驶的距离信息L1、L2,以及运载体在t2时刻的相对转向角θ,构建高精度的三角型几何约束模型。
如图3所示,惯导***的定位方法是采用航位推算原理,根据航位推算原理可知惯导***在短时内具有高精度的测量值,所以如图4所示,利用相邻的t1时刻到t2时刻这个时间段内惯导输出的距离L1,t2时刻到t3时刻这个时间段内惯导输出的距离L2,以及在t2时刻惯导***测得运载体的相对转向角θ构建几何约束模型ABC;然后,选取任意三角形,假定三角形的边长分别为a、b和c,且a>b>c;用两个参数b/a和c/a来表示该三角形,从而把由(x,y)空间中的三个点构成的三角形转换成(b/a,c/a)空间中用一个点来表示,如图5所示,该空间即为三角形空间Γ,并获取构建的高精度三角形几何约束模型在三角形空间Γ上的投影点Q0。
第四步,利用运载体所承载的重力场传感器在t1、t2和t3时刻所采取的重力值,获取运载体在t1、t2和t3时刻对应参考重力场等值线C1、C2和C3所包含的点集P1、P2和P3。其过程如下:
如图6所示,等值线C1在Ω区域内的点集P1 (i为自然数,0<i<L1,L1表示点集P1包含的点数)位于区间[P10,P1n]内;等值线C2在Ω区域内的点集P2 (i为自然数,0<i<L2,L2表示点集P2包含的点数)位于区间[P20,P2n]内;以及等值线C3在Ω区域内的点集P3 (i为自然数,0<i<L3,L3表示点集P3包含的点数)位于区间[P30,P3n]内。
第五步,基于三角形几何约束模型等值线匹配算法,获取运载体在当前时刻的初始匹配集 (j为自然数,1<j<N,N为匹配对集所包含的匹配对数,pj、qj、mj分别表示第j个初始匹配对在等值线C1、等值线C2、等值线C3上所对应的点)。其过程如下:
首先从点集P1、P2和P3中各取一点组成一个三角形匹配对然后分别计算匹配对所对应三角形各边边长ai、bi和ci(i为自然数,表示对应的第i个匹配对);最后获取第i个匹配对在三角形空间Γ上的投影点Qi;遍历点集P1、P2和P3中所有点,获取所有三角形匹配对在三角形空间Γ上的投影点集Q(Q1、Q2、...、Qk、...、QM)(k为自然数,1<k<M,M为点集Q包含的点数),计算投影点Qi与投影点Q0之间的距离选取的所有投影点所对应的匹配对组成初始匹配集 (j为自然数,1<j<N,N为匹配对集所包含的匹配对数,pj、qj、mj分别表示第j个初始匹配对在等值线C1、等值线C2、等值线C3上所对应的点)。。
第六步,采用加权概率估计模型算法,利用价值函数为角度误差因子和距离误差因子的二次函数这一特点,并计算初始匹配集中各组数据的代价值,最终获取精确的初始匹配值。
构建的价值函数为:
cost=f(l,α)=M1l2+M2α2 (1)
式中l表示匹配点与惯导***所提供的对应位置点之间的距离参数,α表示匹配点的方向角与惯导***所提供的对应点的方向角之间的夹角,M1表示距离加权因子,M2表示角度加权因子。
从匹配对集中任选一组匹配对由公式(1)分别计算匹配对所对应的三个匹配点pj、qj和mj的匹配代价值costpj、costqj和costmj,可得匹配对的匹配代价值选取中最小值所对应的一组匹配对为运载体最终的初始匹配值。
以上所述仅是重力辅助惯性导航***中重力图匹配初始对准方法,应当指出,几何约束模型的构建过程中提出了t1、t2和t3时刻为三个相邻时刻,如果运载体在某个时间段内做严格的直线运动,用户可以根据实际需要并结合惯导***的累积误差特性,可取t1、ti和ti+n(i、n为自然数,i≥2),其中必须保证运载体在t1到ti时刻内和ti到ti+n内做严格的直线运动,这些使用也应视为本发明的保护范围。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (4)
1.重力辅助惯性导航***中重力图匹配的初始匹配方法,其特征在于步骤如下:
第一步,判断运载体已进入重力场适配区域Ψ,选取运载体所承载的重力场传感器连续的三个采样点,三个采样点所对应的时间分别为t1、t2和t3时刻;
第二步,确定运载体重力匹配参考图的搜索区域Ω
首先根据运载体所承载惯导***的误差分布特性函数,确定当前时刻惯性***的距离误差阈值δ,然后以惯导***所提供的运载体当前位置信息为中心,距离误差阈值δ为半径,划定重力匹配参考图的搜索区域Ω,从而在减小搜索区域提高搜索速度前提条件下,确保运载体真实位置信息落于重力匹配参考图的搜索区域Ω内;
第三步,构建三角形几何约束模型,并构建三角空间Γ;
第四步,利用运载体所承载的重力场传感器在t1、t2和t3时刻所采取的重力值,获取运载体在t1、t2和t3时刻对应参考重力场等值线C1、C2和C3所包含的点集P1、P2和P3;
第五步,基于三角形几何约束模型等值线匹配算法,获取运载体在当前时刻的所有初始匹配对 这些初始匹配对组成的集合定义为初始匹配集j为自然数,1<j<N,N为匹配对集所包含的匹配对数,pj、qj、mj分别表示第j个初始匹配对在等值线C1、等值线C2、等值线C3上所对应的点;
第六步,采用加权概率估计模型算法,利用价值函数为角度误差因子和距离误差因子的二次函数,计算初始匹配集中各组数据的代价值,最终获取精确的初始匹配值。
2.根据权利要求1所述的重力辅助惯性导航***中重力图匹配的初始匹配方法,其特征在于:所述第三步构建三角形几何约束模型,并构建三角空间Γ的其过程为:首先获取惯导***在相邻时刻t1t2间和t2t3间的测得运载体行驶的距离信息L1、L2,以及运载体在t2时刻的相对转向角θ,构建高精度的三角型几何约束模型;然后,选取任意三角形,假定三角形的边长分别为a、b和c,且a>b>c;用两个参数b/a和c/a来表示该三角形,从而把由(x,y)空间中的三个点构成的三角形转换成(b/a,c/a)空间中用一个点来表示,该空间即为三角形空间Γ。
4.根据权利要求1所述的重力辅助惯性导航***中重力图匹配的初始匹配方法,其特征在于:所述第六步采用加权概率估计模型算法,利用价值函数为角度误差因子和距离误差因子的二次函数这一特点,计算初始匹配集中各组数据的代价值,取代价值最小的那组数据为运载体最终初始匹配位置的具体过程如下:
a.构建的代价函数为:
cost=f(l,α)=M1l2+M2α2 (1)
式中l表示匹配点与惯导***所提供的对应位置点之间的距离参数,α表示匹配点的方向角与惯导***所提供的对应点的方向角之间的夹角,M1表示距离加权因子,M2表示角度加权因子;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010592977A CN102128625B (zh) | 2010-12-08 | 2010-12-08 | 重力辅助惯性导航***中重力图匹配的初始匹配方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010592977A CN102128625B (zh) | 2010-12-08 | 2010-12-08 | 重力辅助惯性导航***中重力图匹配的初始匹配方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102128625A CN102128625A (zh) | 2011-07-20 |
CN102128625B true CN102128625B (zh) | 2012-09-05 |
Family
ID=44266807
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201010592977A Expired - Fee Related CN102128625B (zh) | 2010-12-08 | 2010-12-08 | 重力辅助惯性导航***中重力图匹配的初始匹配方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102128625B (zh) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102706348B (zh) * | 2012-05-16 | 2015-05-20 | 北京航空航天大学 | 一种基于三角形的重力图快速匹配方法 |
CN102809376B (zh) * | 2012-08-06 | 2015-02-25 | 哈尔滨工程大学 | 一种基于等值线的辅助导航定位方法 |
CN105021182B (zh) * | 2015-06-03 | 2018-04-24 | 北京理工大学 | 一种重力辅助惯性导航适配区的选择方法 |
CN105157703A (zh) * | 2015-06-03 | 2015-12-16 | 北京理工大学 | 一种重力辅助惯性导航适配区可导航性的评价方法 |
CN105737831B (zh) * | 2016-01-29 | 2019-02-12 | 北京理工大学 | 基于粒子滤波的变尺度变方向重力采样矢量匹配定位方法 |
CN105716605B (zh) * | 2016-03-30 | 2018-07-10 | 北京理工大学 | 一种重力辅助惯性导航***匹配方法 |
CN108955669A (zh) * | 2017-05-17 | 2018-12-07 | 田亮 | 一种重磁场组合导航算法 |
CN108225310B (zh) * | 2017-12-22 | 2020-08-25 | 中国船舶重工集团公司第七0七研究所 | 一种重力辅助导航航迹规划方法 |
CN108362281B (zh) * | 2018-02-24 | 2020-11-24 | 中国人民解放军61540部队 | 一种长基线水下潜艇匹配导航方法及*** |
CN108896040B (zh) * | 2018-03-30 | 2021-03-26 | 中国空间技术研究院 | 天空海一体化水下潜器惯性/重力组合导航方法和*** |
CN109141426B (zh) * | 2018-08-10 | 2020-11-10 | 中国空间技术研究院 | 一种水下重力匹配导航适配区的方法 |
CN109059964B (zh) * | 2018-09-19 | 2021-07-23 | 中国船舶重工集团公司第七0七研究所 | 一种基于“重力峰”的惯性导航与重力测量双校准方法 |
CN110031001B (zh) * | 2019-05-21 | 2020-12-11 | 北京理工大学 | 一种重力辅助惯性导航的适配区选取方法 |
CN110081884B (zh) * | 2019-05-21 | 2021-02-12 | 北京理工大学 | 基于虚拟航向的重力辅助惯性导航区域适配性评价方法 |
CN111397599A (zh) * | 2020-02-25 | 2020-07-10 | 河海大学 | 基于三角形匹配算法改进的iccp水下地磁匹配方法 |
CN113503871B (zh) * | 2021-05-19 | 2024-04-16 | 北京理工大学 | 基于相关滤波的重力匹配方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5339684A (en) * | 1991-12-10 | 1994-08-23 | Textron Inc. | Gravity aided inertial navigation system |
CN101424534A (zh) * | 2008-12-09 | 2009-05-06 | 东南大学 | 惯性/重力组合导航半实物模拟装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE602004029253D1 (de) * | 2003-07-03 | 2010-11-04 | Northrop Grummann Corp | Verfahren und vorrichtung zum erhöhen der inertialeicherter schwerkraftsgradiente |
-
2010
- 2010-12-08 CN CN201010592977A patent/CN102128625B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5339684A (en) * | 1991-12-10 | 1994-08-23 | Textron Inc. | Gravity aided inertial navigation system |
CN101424534A (zh) * | 2008-12-09 | 2009-05-06 | 东南大学 | 惯性/重力组合导航半实物模拟装置 |
Non-Patent Citations (3)
Title |
---|
夏冰等.基于SPSS的重力匹配区域选择算法.《中国惯性技术学报》.2010,第18卷(第1期),第81-84页. * |
夏冰等.重力辅助导航联邦滤波算法仿真研究.《计算机仿真》.2010,第27卷(第11期),第1-4,13页. * |
孙岚.重力辅助惯性导航的匹配算法初探.《海洋测绘》.2006,第26卷(第1期),第44-46页. * |
Also Published As
Publication number | Publication date |
---|---|
CN102128625A (zh) | 2011-07-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102128625B (zh) | 重力辅助惯性导航***中重力图匹配的初始匹配方法 | |
CN104235618B (zh) | 一种基于mems惯性测量单元的管道测绘及缺陷定位装置及其管道测绘及缺陷定位方法 | |
CN103472823B (zh) | 一种智能机器人用的栅格地图创建方法 | |
CN103776446B (zh) | 一种基于双mems-imu的行人自主导航解算算法 | |
CN105783923B (zh) | 基于rfid和mems惯性技术的人员定位方法 | |
CN108955675A (zh) | 一种基于惯性测量的地下管道轨迹检测***及方法 | |
CN104215259B (zh) | 一种基于地磁模量梯度和粒子滤波的惯导误差校正方法 | |
CN103822634B (zh) | 一种基于改进的iccp算法的重力匹配辅助惯性导航方法 | |
CN109000642A (zh) | 一种改进的强跟踪容积卡尔曼滤波组合导航方法 | |
CN102706366B (zh) | 一种基于地球自转角速率约束的sins初始对准方法 | |
CN104390646B (zh) | 水下潜器地形辅助惯性导航***的位置匹配方法 | |
CN104197935B (zh) | 一种基于移动智能终端的室内定位方法 | |
CN104819716A (zh) | 一种基于mems的ins/gps组合的室内外个人导航算法 | |
CN101793522B (zh) | 基于抗差估计的稳健滤波方法 | |
CN104075715A (zh) | 一种结合地形和环境特征的水下导航定位方法 | |
CN104061934A (zh) | 基于惯性传感器的行人室内位置跟踪方法 | |
CN106507913B (zh) | 用于管道测绘的组合定位方法 | |
CN105021198B (zh) | 一种基于多传感器综合导航的位置估计方法 | |
CN108061889A (zh) | Ais与雷达角度***偏差的关联方法 | |
CN103149580A (zh) | 一种基于stkf和wnn的gps/ins组合导航方法 | |
CN105865450A (zh) | 一种基于步态的零速更新方法及*** | |
CN102168979B (zh) | 一种基于三角形约束模型的无源导航的等值线匹配方法 | |
CN110412596A (zh) | 一种基于图像信息和激光点云的机器人定位方法 | |
CN109141408A (zh) | 一种长输地下管道定位***的误差补偿方法及实施*** | |
CN104359496A (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20120905 Termination date: 20211208 |