CN104787260B - 一种基于融合滤波器的水翼双体船纵向姿态估计方法 - Google Patents
一种基于融合滤波器的水翼双体船纵向姿态估计方法 Download PDFInfo
- Publication number
- CN104787260B CN104787260B CN201510140991.8A CN201510140991A CN104787260B CN 104787260 B CN104787260 B CN 104787260B CN 201510140991 A CN201510140991 A CN 201510140991A CN 104787260 B CN104787260 B CN 104787260B
- Authority
- CN
- China
- Prior art keywords
- wave filter
- filter
- longitudinal attitude
- state
- hydrofoil
- 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
- 238000000034 method Methods 0.000 title claims abstract description 18
- 230000004927 fusion Effects 0.000 title claims abstract description 12
- 238000011156 evaluation Methods 0.000 claims abstract description 27
- 238000001914 filtration Methods 0.000 claims description 18
- 230000000694 effects Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 abstract description 9
- 238000006073 displacement reaction Methods 0.000 description 11
- 238000005070 sampling Methods 0.000 description 11
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 3
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 2
- 238000013019 agitation Methods 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 239000012141 concentrate Substances 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 239000002245 particle Substances 0.000 description 2
- 230000009897 systematic effect Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000003190 augmentative effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000003455 independent Effects 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000002844 melting Methods 0.000 description 1
- 230000008018 melting Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
- Navigation (AREA)
Abstract
本发明具体涉及一种通过测量系统得到船体部分纵向姿态信息(含测量噪声)的基于融合滤波器的水翼双体船纵向姿态估计方法。本发明包括:一船上测量系统测出船体部分纵向姿态信息,分别传递给第一滤波器和第二滤波器,同时作用在船上的控制量也分别传递给第一滤波器和第二滤波器;由第一滤波器和第二滤波器得到船体纵向姿态估计值k=1,2,…;分别计算第一滤波器和第二滤波器的评价函数,通过评价函数准则,得到水翼双体船纵向姿态的融合估计本发明估计结果的统计特性达到很好估计精度,两个滤波器独立并行运算,不会增加运算时间,基于波浪有色干扰而没进行状态扩维,减少了滤波估计的计算量和复杂度,提高了运算速度。
Description
技术领域
本发明具体涉及一种通过测量系统得到船体部分纵向姿态信息(含测量噪声)的基于融合滤波器的水翼双体船纵向姿态估计方法。
背景技术
水翼双体船经常航行在具有随机干扰作用的海情下,从而使船体发生摇摆,加之测量仪器中也不可避免地存在着观测噪声。为了保持船体的姿态,尤其是高海情情况下,采取一定的控制是必须的,而对此需要对船体摇摆时的状态(姿态)量进行观测,而在实际中,并不是所有需要的状态量都是可以观测到的,即使对于部分可以观测的状态量,也含有随机噪声,因此就需要对这些无法直接观测到的和含有随机噪声的状态量运用一些方法进行估计或运用易于观测的量间接求出来。
水翼双体船姿态运动具有较强的非线性,因此对水翼双体船姿态估计要选择非线性估计方法,对于非线性估计问题的处理,常用的方法用EKF(扩展卡尔曼滤波)、PF(粒子滤波)以及UKF(无迹卡尔曼滤波),EKF虽然使用广泛,但是由于其自身存在的不足,可能导致某些非线性问题不能准确解决,而PF虽然使用范围广且精度高,但是其计算大而导致计算速度相对较慢。
本发明依据水翼船在海浪中建立的纵向运动非线性方程为基础,对船体纵向运动姿态进行估计。在分析非线性估计方法的基础上,提出一种融合滤波器。首先通过两个滤波器分别对水翼双体船姿态进行估计,将滤波器单个估计误差样本的平方作为评价函数,引入一个评价函数准则,进行两个滤波器的切换,进而达到了两个滤波器优势的融合,提高了估计精度,两个滤波器并行独立运算,不会增加运算量和运算时间。
发明内容
本发明的目的在于提供一种基于融合滤波器的水翼双体船纵向姿态估计方法。
本发明的目的是这样实现的:
一种基于融合滤波器的水翼双体船纵向姿态估计方法,包括:
(1)船上测量系统测出船体部分纵向姿态信息,分别传递给第一滤波器和第二滤波器,同时作用在船上的控制量也分别传递给第一滤波器和第二滤波器;
(2)由第一滤波器和第二滤波器得到船体纵向姿态估计值
(3)分别计算第一滤波器和第二滤波器的评价函数,通过评价函数准则,得到水翼双体船纵向姿态的融合估计
所述的第一滤波器和第二滤波器是通过sigma点发生器获取sigma点,经过非线性状态函数进行时间更新获得状态一步预报和状态一步预报协方差,经过非线性观测函数进行测量更新获得输出预测、输出预测自协方差和输出预测互方差,将观测量、输出预测、输出预测自协方差、输出预测互协方差、状态一步预报和状态一步预报协方差送给状态估计器后得到船体纵向姿态估计值
所述的非线性状态函数和非线性观测函数为:
所述的sigma点发生器是指按采样策略获取sigma点
第一滤波器按如下采样策略获取sigma点:
第二滤波器按如下采样策略获取sigma点:
所述的时间更新是指将Sigma点集中的每一个点带入到非线性状态函数中去,
式中j=A或j=B代表第一滤波器或第二滤波器
状态一步预报为
状态一步预报协方差为
所述的测量更新是指基于时间更新中的和利用sigma点发生器获得sigma点经过非线性观测函数传播
输出预测为
输出预测自协方差为
输出预测互协方差为
所述的状态估计器是指运用新的观测量得到船体纵向姿态估计值
所述的观测量是指通过测量系统得到的船体部分纵向姿态信息;所述的船体部分纵向姿态信息是指垂荡位移和纵摇角位移;所述的测量系统是指在一定海情下,采集船舶实际航向、航速、垂荡和纵摇角的位移传感器、陀螺仪,计程仪、船载经纬仪。
所述的评价函数是指将滤波器单个估计误差样本的平方作为评价函数:i表示xk的第i行元素;所述的评价函数准则是指将第一滤波器和第二滤波器的每一时刻的评价函数进行比较,评价函数小的滤波器的估计值即为水翼双体船纵向姿态的融合估计
所述的水翼双体船纵向姿态的融合估计是指达到第一滤波器和第二滤波器优势的融合。
本发明的有益效果在于:
该方法是为解决水翼双体船航行在高海情下发生姿态摇摆的相对复杂而产生的,利用融合滤波器解决水翼船纵向姿态估计是合理可行的,并且其估计结果的统计特性达到很好估计精度,融合滤波器融合了两个滤波器的优点,两个滤波器独立并行运算,不会增加运算时间,基于波浪有色干扰而没进行状态扩维,减少了滤波估计的计算量和复杂度,提高了运算速度。
附图说明
图1为基于融合滤波器的水翼双体船纵向姿态估计的结构框图;
图2为五级海情、水翼船航速为35节,航行角为180度时基于融合滤波器的对船体升沉位移与升沉速度的估计结果与真实值的对比图;
图3为五级海情、水翼船航速为35节,航行角为180度时基于融合滤波器的对船体纵摇角与其角速度的估计结果与真实值的对比图;
图4为水翼双体船纵向(姿态)状态估计的统计特性。
具体实施方法
下面结合附图对本发明做进一步描述。
包括滤波器A、滤波器B。船上测量系统(位移传感器、陀螺仪,计程仪、船载经纬仪)测出船体部分纵向姿态信息(观测量,包括垂荡位移和纵摇角位移),分别传递给滤波器A和滤波器B,同时作用在船上的控制量也分别传递给滤波器A和滤波器B,由滤波器A和滤波器B得到船体纵向姿态估计值分别计算滤波器A和滤波器B的评价函数,通过一个评价函数准则,得到水翼双体船纵向姿态的融合估计
本发明的基于船体姿态信息估计海浪浪高的方法还可以包括:
1、所述的滤波器是通过sigma点发生器获取sigma点,经过非线性状态函数进行时间更新获得状态一步预报和状态一步预报协方差,经过非线性观测函数进行测量更新获得输出预测、输出预测自协方差和输出预测互方差,将观测量、输出预测、输出预测自协方差、输出预测互协方差、状态一步预报和状态一步预报协方差送给状态估计器后得到船体纵向姿态估计值
2、所述的非线性状态函数和非线性量测函数为:
3、所述的sigma点发生器是指按一定采样策略获取sigma点。
滤波器A按如下采样策略获取sigma点:
滤波器B按如下采样策略获取sigma点:
4、所述的时间更新是指将Sigma点集中的每一个点带入到非线性状态函数中去,
式中j=A或j=B代表滤波器A或滤波器B。
状态一步预报为
状态一步预报协方差为
5、所述的测量更新是指基于时间更新中的和利用sigma点发生器获得sigma点经过非线性观测函数传播
输出预测为
输出预测自协方差为
输出预测互协方差为
6、所述的状态估计器是指运用新的观测量得到船体纵向姿态估计值
7、所述的观测量是指通过测量系统得到的船体部分纵向姿态信息
8、所述的船体部分纵向姿态信息是指垂荡位移和纵摇角位移。
9、所述的测量系统是指在一定海情下,采集船舶实际航向、航速、垂荡和纵摇角的位移传感器、陀螺仪,计程仪、船载经纬仪。
10、所述的评价函数是指将滤波器单个估计误差样本的平方作为评价函数:i表示xk的第i行元素。。
11、所述的评价函数准则是指将滤波器A和滤波器B的每一时刻的评价函数进行比较,评价函数小的滤波器的估计值即为水翼双体船纵向姿态的融合估计
12、所述的水翼双体船纵向姿态的融合估计是指达到滤波器A和滤波器B优势的融合。
本发明的工作原理是:对原水翼双体船纵向运动建立非线性状态方程和观测方程,并离散化;将基于两个滤波器的水翼双体船纵向姿态估计结果进行优势融合;两个滤波器独立并行运算,将滤波器单个估计误差样本的平方作为评价函数,通过一个评价函数准则,进行两个滤波器的切换,进而进行估计误差和方差的控制。
本发明描述的是一种水翼双体船纵向姿态估计方法,该方法能够能够快速并且准确的得到水翼双体船纵向姿态的估计值,操作方便且不会增加运算时间。本发明的设计方案如图1所示,具体的步骤如下:
第一步水翼双体船纵向运动离散状态空间方程的建立
水翼双体船垂荡和纵摇运动的非线性运动模型如下:
式(1)、(2)中,m为船体质量,z为船体在垂直方向上的升沉位移,u表示船体在纵向的速度(假设为定值),θ为船体的纵摇角,Lfi表示船体水翼产生的升力,Fai为水翼附加质量而产生的惯性力,▽表示船体所受的浮力,LH为船体引起的升力,g表示重力加速度,Iyy为船体相对于船体的Y轴转动惯量,|xfi|、|xg|、|xb|和|xH|分别为船体水翼、重心、浮力作用点以及船体升力作用点到船体中心的距离。
将船体水翼作为刚体看待,其惯性力的大小与水翼的加速度成正比,其方向和加速度方向相反,计算公式如下:
式中mfi为水翼附加质量,是海浪水质点在水翼处垂直于水面的运动加速度。
船体所产生的升力:
式中,Aw为船体水线面面积,CLH是船体升力系数的斜率。
将(3)、(4)两式分别代入到式(1)、(2)中,整理可得:
为使表达简单明确,(5)、(6)两式表示为:
式(7)、(8)中aij(i,j=3,5)为附加质量;bij(i,j=3,5)为阻尼力系数;cij(i,j=3,5)为恢复力系数;将aij、bij、cij统称为水动力系数,Fwi和Mwi分别是第i个水翼处所受的垂向波浪力和纵摇波浪力矩。
如上(7)、(8)两式为微分方程形式的船体纵向运动方程,为便于问题的处理,将式(7)、(8)中微分方程转化为向量形式的状态方程,此时取状态向量为 表示船体在垂直方向上的升沉速度,表示船体的纵摇角速度。为此(7)、(8)两式写为:
其中,Fw=Fw1+Fw2,Mw=Mw1+Mw2,Fw和Mw统称为波浪扰动,是有色噪声。f1(θ)=(▽+mg)cosθ,f2(θ)=(xg-xb)▽cosθ。
以水翼船水动力系数的水池实验数据代入式(9),求得系统特征值,可知系统开环是不稳定的。为此引入虚拟控制
将式(10)代入式(9)得:
可验证引入虚拟控制后,式(11)所表示系统开环特征值具有负实部,则开环系统是稳定的。
或式(11)又可写成
式中:
则状态方程如下
式中:
A=E-1A*, B=E-1, C=E-1C*, g(x)=E-1[0 f1(θ) 0 f2(θ)]T
令虚拟控制(从式(10)可以看出,相当于对系统施加适当的比例微分控制),则式(12)为:
选取升沉z与纵摇角θ作为系统的观测量,建立观测方程如下:
y=hx+v(14)
式中v为系统观测噪声向量。
固定海清、航速、航向角下,方程(13)中等式右边第一项可看作是线性项,而第二项是非线性项,第三项是波浪扰动。
分别运用线性离散化和非线性龙格库塔法对式(13)、(14)进行离散化,则船体纵向运动系统的离散化方程如下:
k为时间。
第二步滤波器工作原理
滤波器利用采样策略来逼近非线性分布,以UT(unscented)变换为基础,采用卡尔曼滤波框架以及确定性采样来完成滤波问题。
首先由sigma点发生器获取sigma点,经过非线性状态函数进行时间更新,然后经过非线性观测函数进行测量更新,最后运用新的观测量得到船体纵向姿态估计值,过程如下:
(1)sigma点发生器
滤波器A和滤波器B的sigma点发生器的采样策略不同。
滤波器A采用如下采样策略获取sigma点:
式中为k时刻状态均值和协方差,n是状态向量维数,κ是比例参数,常设为0或3-n。,为(n+k)pk的平方根矩阵的第i列。
滤波器B采用如下采样策略获取sigma点:
式中h为尺度参数,它决定了sigma点的均值附近的分布,其它参数的意义同滤波器A。
(2)时间更新:
将Sigma点集中的每一个点带入到非线性状态函数中去,得
式中j=A或j=B代表滤波器A或滤波器B。
状态一步预报为
式中
λ=α2(n+κ)-n,α为比例缩放因子,用于调整sigma点与均值x的距离,通常设为较小的正数(如1e-4≤α≤1);
状态一步预报协方差为
式中
β为引入非线性函数高阶项信息的参数。
(3)测量更新:
基于时间更新(2)中的和利用sigma点发生器获得sigma点经过非线性观测函数传播为
输出预测为
输出预测自协方差为
输出预测互协方差为
(4)状态估计器
运用新的观测量来修正计算的状态后验估计值:
式中状态协方差更新为
系统观测噪声协方差Qvv=diag([0.010.001])。
滤波器A:式(17),式(18),式(24),式(26)中取α1=α-1,α=1e-4,β=2,κ=0。基于matlab平台,根据式(31)估计出船体运动状态
滤波器B(基于中心差分卡尔曼滤波器):式(20),式(21)中h2=3。基于matlab平台,根据式(31)估计出船体运动状态
两个滤波器A和B并行运算,计算各自评价函数。评价函数定义为滤波器单个估计误差样本的平方:i表示的第i行元素。
将每一时刻的评价函数进行比较,水翼双体船纵向姿态估计取评价函数小的滤波器的估计值。即:
其中,评价函数准则:
Ι是单位阶跃函数,即
图2,图3表示的是五级海情、水翼船航速为35节,航行角为180度时基于融合滤波器得到的水翼船纵向姿态估计序列。表1为水翼双体船纵向姿态估计的统计特性。
Claims (1)
1.一种基于融合滤波器的水翼双体船纵向姿态估计方法,其特征在于:
(1)船上测量系统测出船体部分纵向姿态信息,分别传递给第一滤波器和第二滤波器,同时作用在船上的控制量也分别传递给第一滤波器和第二滤波器;
(2)由第一滤波器和第二滤波器得到船体纵向姿态估计值
(3)分别计算第一滤波器和第二滤波器的评价函数,通过评价函数准则,得到水翼双体船纵向姿态的融合估计
所述的第一滤波器和第二滤波器是通过sigma点发生器获取sigma点,经过非线性状态函数进行时间更新获得状态一步预报和状态一步预报协方差,经过非线性观测函数进行测量更新获得输出预测、输出预测自协方差和输出预测互方差,将观测量、输出预测、输出预测自协方差、输出预测互协方差、状态一步预报和状态一步预报协方差送给状态估计器后得到船体纵向姿态估计值A为第一滤波器,B为第二滤波器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510140991.8A CN104787260B (zh) | 2015-03-27 | 2015-03-27 | 一种基于融合滤波器的水翼双体船纵向姿态估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510140991.8A CN104787260B (zh) | 2015-03-27 | 2015-03-27 | 一种基于融合滤波器的水翼双体船纵向姿态估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104787260A CN104787260A (zh) | 2015-07-22 |
CN104787260B true CN104787260B (zh) | 2017-05-24 |
Family
ID=53552549
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510140991.8A Expired - Fee Related CN104787260B (zh) | 2015-03-27 | 2015-03-27 | 一种基于融合滤波器的水翼双体船纵向姿态估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104787260B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105825738B (zh) * | 2016-05-24 | 2018-11-13 | 哈尔滨工程大学 | 一种水翼双体船半实物仿真系统 |
CN106919106A (zh) * | 2017-02-27 | 2017-07-04 | 威海海洋职业学院 | 船舶运动姿态数据采集装置及传输方法 |
CN107128454B (zh) * | 2017-03-27 | 2019-09-27 | 哈尔滨工程大学 | 一种水翼双体船姿态估计方法 |
CN107600352B (zh) * | 2017-08-22 | 2019-03-05 | 哈尔滨工程大学 | 一种基于船舶水动力在线预报的船舶减摇控制系统 |
CN107942095B (zh) * | 2017-11-15 | 2019-11-26 | 哈尔滨工程大学 | 波浪滑翔器实际航向预测方法 |
CN109398594B (zh) * | 2018-07-11 | 2021-03-19 | 哈尔滨工程大学 | 一种水翼船爬浪控制方法 |
CN110083057B (zh) * | 2019-06-12 | 2021-12-07 | 三亚哈尔滨工程大学南海创新发展基地 | 基于水翼运动姿态的pid控制方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104316025A (zh) * | 2014-10-16 | 2015-01-28 | 哈尔滨工程大学 | 一种基于船体姿态信息估计海浪浪高的系统 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4049268B2 (ja) * | 2004-04-23 | 2008-02-20 | 株式会社新来島どっく | 航海システム |
-
2015
- 2015-03-27 CN CN201510140991.8A patent/CN104787260B/zh not_active Expired - Fee Related
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104316025A (zh) * | 2014-10-16 | 2015-01-28 | 哈尔滨工程大学 | 一种基于船体姿态信息估计海浪浪高的系统 |
Non-Patent Citations (3)
Title |
---|
低成本AHRS/GPS紧耦合融合滤波技术研究;夏琳琳;《信息科技辑》;20100630;I135-10 * |
基于扩展卡尔曼滤波的船舶纵向运动受扰力与力矩的估计;赵希人等;《中国造船》;20040930;全文 * |
船舶减纵摇控制的LQG方法研究;陈虹丽等;《哈尔滨工程大学》;20040831;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN104787260A (zh) | 2015-07-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104787260B (zh) | 一种基于融合滤波器的水翼双体船纵向姿态估计方法 | |
CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
Huang et al. | High accuracy navigation information estimation for inertial system using the multi-model EKF fusing adams explicit formula applied to underwater gliders | |
CN103759742B (zh) | 基于模糊自适应控制技术的捷联惯导非线性对准方法 | |
CN105424036B (zh) | 一种低成本水下潜器地形辅助惯性组合导航定位方法 | |
CN103389506B (zh) | 一种用于捷联惯性/北斗卫星组合导航系统的自适应滤波方法 | |
CN106772524B (zh) | 一种基于秩滤波的农业机器人组合导航信息融合方法 | |
CN109634307A (zh) | 一种无人水下航行器复合航迹跟踪控制方法 | |
CN101833338B (zh) | 无人潜航器垂直面欠驱动运动控制方法 | |
CN103033186A (zh) | 一种用于水下滑翔器的高精度组合导航定位方法 | |
CN101982732B (zh) | 一种基于esoqpf和ukf主从滤波的微小卫星姿态确定方法 | |
CN104316025B (zh) | 一种基于船体姿态信息估计海浪浪高的系统 | |
CN108197350A (zh) | 一种无人船速度和不确定性估计系统及设计方法 | |
CN106950974A (zh) | 欠驱动自主水下航行器的对三维路径进行理解及跟踪控制方法 | |
CN100498373C (zh) | 一种sar运动补偿用sins/gps组合导航自适应降维滤波方法 | |
CN106354901A (zh) | 一种运载火箭质量特性及动力学关键参数在线辨识方法 | |
CN107179693A (zh) | 基于Huber估计的鲁棒自适应滤波和状态估计方法 | |
CN110906933A (zh) | 一种基于深度神经网络的auv辅助导航方法 | |
CN103115625A (zh) | 一种浮体横纵荡及升沉运动的测量方法及系统 | |
CN110083057A (zh) | 基于水翼运动姿态的pid控制方法 | |
CN107128454A (zh) | 一种水翼双体船姿态估计方法 | |
CN104677359B (zh) | 一种动态载体运行轨迹预测预报的方法 | |
CN104155043B (zh) | 一种动力定位系统外界环境力测量方法 | |
CN115903800A (zh) | 一种基于领导者协同的多无人船编队的严格安全控制方法 | |
CN110610513B (zh) | 自主移动机器人视觉slam的不变性中心差分滤波器方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170524 |
|
CF01 | Termination of patent right due to non-payment of annual fee |