CN113791240A - 基于高阶滑膜跟踪微分器的加速度估计方法、***、设备和介质 - Google Patents
基于高阶滑膜跟踪微分器的加速度估计方法、***、设备和介质 Download PDFInfo
- Publication number
- CN113791240A CN113791240A CN202111003208.5A CN202111003208A CN113791240A CN 113791240 A CN113791240 A CN 113791240A CN 202111003208 A CN202111003208 A CN 202111003208A CN 113791240 A CN113791240 A CN 113791240A
- Authority
- CN
- China
- Prior art keywords
- acceleration
- target
- estimation
- speed
- value
- 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
- 230000001133 acceleration Effects 0.000 title claims abstract description 126
- 238000000034 method Methods 0.000 title claims abstract description 74
- 210000001258 synovial membrane Anatomy 0.000 title claims abstract description 34
- 238000005259 measurement Methods 0.000 claims abstract description 53
- 230000003190 augmentative effect Effects 0.000 claims abstract description 31
- 238000004422 calculation algorithm Methods 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 10
- 230000006870 function Effects 0.000 claims description 8
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 241000764238 Isis Species 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000004590 computer program Methods 0.000 description 5
- 230000008569 process Effects 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000004069 differentiation Effects 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P15/00—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
- G01P15/003—Kinematic accelerometers, i.e. measuring acceleration in relation to an external reference frame, e.g. Ferratis accelerometers
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Automation & Control Theory (AREA)
- Radar Systems Or Details Thereof (AREA)
- Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
Abstract
本发明公开了一种基于高阶滑膜跟踪微分器的加速度估计方法、***、设备和介质,所述方法包括:利用增广最小二乘法对速度进行参数辨识,得到速度估计的最大测量噪声幅值;根据所述速度估计的最大测量噪声幅值,使用一阶滑膜跟踪微分器精确估计目标的速度,得到目标速度的估计值;根据所述目标速度的估计值,得到加速度估计的最大测量噪声幅值;根据所述加速度估计的最大测量噪声幅值,使用高阶滑膜跟踪微分器精确估计目标的加速度,得到目标加速度的估计值。本发明使用增广最小二乘法进行参数辨识,分别获得速度和加速度估计的最大测量噪声幅值;同时使用高阶滑膜跟踪微分器,保证了加速度估计值能够达到要求的精度。
Description
技术领域
本发明属于自动控制技术领域,特别是涉及一种基于高阶滑膜跟踪微分器的加速度估计方法、***、计算机设备和存储介质。
背景技术
随着计算机视觉的发展,目标跟踪方法可以精确地获得图片集或视频中目标物体的运动轨迹。根据目标物体的运动轨迹我们可以获得更多的运动特性,以此来预测目标物体下一时刻的运动趋势。其中,加速度的获取尤为重要。但是由物体的位置信息估计加速度的过程是三阶微分过程,对噪声十分敏感,在连续迭代多次后,微分的精度会迅速下降,学者和工程技术人员近年来对其进行了很多的研究。
最小二乘法和卡尔曼滤波是经典的状态估计方法。基于最小二乘法的加速度估计方法,需要进行两层微分计算过程,每经过一层的微分计算,噪声就会被放大一次,导致得到的结果严重失真。基于卡尔曼滤波的加速度估计方法,需要被估计的模型是线性模型,并且观测器的噪声已知。在实际实践过程中,观测器的噪声通常难以获得,因此使用该方法进行加速度估计也难以实现。
对于上述问题,Atassi和Khalil等人提出了一种高增益微分器,该微分器在增益趋于无穷大的时候可以提供精确的导数,但是也造成对小幅值的高频噪声的高敏感性。同时,当增益趋于无穷大的时候,***处于瞬时状态时的最大输出值也将会变成无穷大。因此,该微分器所收敛的值是加速度的附近值,无法得到准确的加速度值。Golembo等人提出了滑膜微分器,但是该微分器是对输出进行滤波,并没有提供有限时间收敛的精确微分,因此也无法得到精确的加速度值。
发明内容
为了解决上述现有技术的不足,本发明提供了一种基于高阶滑膜跟踪微分器的加速度估计方法、***、计算机设备和存储介质,该方法通过设计一种对感测器噪声具有良好鲁棒性的高阶精确微分器,从而完成对加速度的准确估计。
本发明的第一个目的在于提供一种基于高阶滑膜跟踪微分器的加速度估计方法。
本发明的第二个目的在于提供一种基于高阶滑膜跟踪微分器的加速度估计***。
本发明的第三个目的在于提供一种计算机设备。
本发明的第四个目的在于提供一种存储介质。
本发明的第一个目的可以通过采取如下技术方案达到:
一种基于高阶滑膜跟踪微分器的加速度估计方法,所述方法包括:
利用增广最小二乘法对速度进行参数辨识,得到速度估计的最大测量噪声幅值;
根据所述速度估计的最大测量噪声幅值,使用一阶滑膜跟踪微分器精确估计目标的速度,得到目标速度的估计值;
根据所述目标速度的估计值,利用增广最小二乘法对加速度进行参数辨识,得到加速度估计的最大测量噪声幅值;
根据所述加速度估计的最大测量噪声幅值,使用高阶滑膜跟踪微分器精确估计目标的加速度,得到目标加速度的估计值。
进一步的,所述利用增广最小二乘法对速度进行参数辨识,具体包括:
设目标物体的运动轨迹为x(t),其中真实的运动轨迹为x0(t),白噪声为e(t),则其连续时间域表示为:
x(t)=x0(t)+e(t) (1)
其中,t为连续时间域上的时间;
将公式(1)转换为离散时间域:
x(k)=x0(k)+e(k) (2)
其中,k为离散域上的时刻值,k取大于或等于0的整数;e(k)服从N(0,1)的高斯分布;
目标跟踪***的采样时间为TS,kTs时刻的真实速度为v0(k),则由速度的定义式得到:
x0(k)-x0(k-1)=v0(k)TS (3)
因此测量得到的速度值满足以下关系:
x(k)-x(k-1)=v0(k)Ts+e(k)-e(k-1) (4)
根据公式(1)中的关系,令:
y(k)=x(k)-x(k-1)+e(k-1) (5)
根据公式(4)和(5),得到对速度v0(k)进行参数辨识的关系式为:
y(k)=v0(k)Ts+e(k) (6)。
进一步的,所述利用增广最小二乘法对速度进行参数辨识,得到速度估计的最大测量噪声幅值,具体包括:
根据公式(6),得到带遗忘因子的增广最小二乘法的速度v0(k)递推估计算法,如下所示:
进一步的,所述根据所述速度估计的最大测量噪声幅值,使用一阶滑膜跟踪微分器精确估计目标的速度,得到目标速度的估计值,具体包括:
一阶滑膜跟踪微分器的具体形式,如下所示:
其中,f(t)为一阶滑膜跟踪微分器微分器的输入,即目标的测量位移,sgn(·)为符号函数,参数α,λ之间满足的关系如下:
其中,L1为所述速度估计的最大测量噪声幅值;
根据公式(9)和(10),计算出精确的目标速度的估计值v(t)。
进一步的,所述根据所述目标速度的估计值,利用增广最小二乘法对加速度进行参数辨识,得到加速度估计的最大测量噪声幅值,具体包括:
将所述目标速度的估计值v(t)离散化后,得到:
y(k)=v(k)-v(k-1)+e(k-1) (11)
其中,v(k)为k时刻目标速度的估计值,e(k-1)为k-1时刻的白噪声;
根据公式(6),得到对加速度a0(k)进行参数辨识的关系式为:
y(k)=a0(k)Ts+e(k) (12)
根据公式(12),得到带遗忘因子的增广最小二乘法的速度a0(k)递推估计算法如下:
进一步的,所述根据所述加速度估计的最大测量噪声幅值,使用高阶滑膜跟踪微分器精确估计目标的加速度,得到目标加速度的估计值,具体包括:
高阶滑膜跟踪微分器的具体形式如下:
其中,σ为目标跟踪***的输入,r为目标跟踪***的阶次,sign(·)为开关函数;
根据公式(15),得到加速度的估计的公式如下:
其中,σ为目标跟踪***的输入,即跟踪目标当前时刻的位置坐标;L2为所述加速度估计的最大测量噪声幅值;v0为当前时刻的速度估计值;z0、z1、z2分别为微分器中位移、速度和加速度的预测值,分别为z0、z1、z2的一阶导数;a为***的输出值,作为加速度的估计值;
进一步的,所述方法之前还包括:
在基于视频的目标跟踪***中,获取目标物体的运动轨迹。
本发明的第二个目的可以通过采取如下技术方案达到:
一种基于高阶滑膜跟踪微分器的加速度估计***,所述***包括:
第一参数辨识模块,用于利用增广最小二乘法对速度进行参数辨识,得到速度估计的最大测量噪声幅值;
第一估计模块,用于根据所述速度估计的最大测量噪声幅值,使用一阶滑膜跟踪微分器精确估计目标的速度,得到目标速度的估计值;
第二参数辨识模块,用于根据所述目标速度的估计值,利用增广最小二乘法对加速度进行参数辨识,得到加速度估计的最大测量噪声幅值;
第二估计模块,用于根据所述加速度估计的最大测量噪声幅值,使用高阶滑膜跟踪微分器精确估计目标的加速度,得到目标加速度的估计值。
本发明的第三个目的可以通过采取如下技术方案达到:
一种计算机设备,包括处理器以及用于存储处理器可执行程序的存储器,所述处理器执行存储器存储的程序时,实现上述的加速度估计方法。
本发明的第四个目的可以通过采取如下技术方案达到:
一种存储介质,存储有程序,所述程序被处理器执行时,实现上述的加速度估计方法。
本发明相对于现有技术具有如下的有益效果:
1、本发明提出使用增广最小二乘法进行参数辨识,分别获得速度和加速度估计的最大测量噪声幅值。
2、本发明根据高阶滑膜跟踪微分器的精度与最大测量噪声的幅值成正相关关系,因此使用两个串联的滑膜跟踪微分器,保证了加速度估计值能够达到要求的精度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图示出的结构获得其他的附图。
图1为本发明实施例1的基于高阶滑膜跟踪微分器的加速度估计方法的流程图。
图2为本发明实施例2的基于高阶滑膜跟踪微分器的加速度估计***的结构框图。
图3为本发明实施例3的计算机设备的结构框图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明的一部分实施例,而不是全部的实施例,基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。应当理解,描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。
实施例1:
Arie Levant提出了一种可以达到任意阶精确鲁棒性的高阶滑模跟踪微分器,该微分器基于理论证明,即含有噪声的信号存在n阶导数,其n阶导数的Lipschitz常数被给定的常数L限制时,第i(i<=n)阶导数的最佳微分精度与最大测量噪声的幅值成正相关关系。基于该理论的微分器在获得最大测量噪声的幅值,即真实加速度的最大值时可以达到任意阶、任意精度的逼近真实值,但是在缺少加速度传感器实际应用场景下,要获取真实加速度的最大值非常困难。因此,本发明采取一种折衷的方法,采用最小二乘辨识获取最大测量噪声幅值的近似值,再通过参数微调,达到微分器的高精度估计。
如图1所示,本实施例提供了一种基于高阶滑膜跟踪微分器的加速度估计方法,在一个基于视频的目标跟踪***中,已知目标跟踪所得到目标物体的运动轨迹为x(t),则该物体运动的加速度估计过程,包括以下步骤:
S101、利用增广最小二乘法对速度进行参数辨识,得到速度估计的最大测量噪声幅值。
若已知测量得到的目标物体运动轨迹为x(t),其中真实的运动轨迹为x0(t),白噪声为e(t),则其连续时间域表示为:
x(t)=x0(t)+e(t) (1)
其中,t为连续时间域上的时间;
将公式(1)转换为离散时间域:
x(k)=x0(k)+e(k) (2)
其中,k为离散域上的时刻值,k取大于或等于0的整数;e(k)服从N(0,1)的高斯分布;
目标跟踪***的采样时间为TS,kTs时刻的真实速度为v0(k),则由速度的定义式可得:
x0(k)-x0(k-1)=v0(k)TS (3)
其中,本实施例中Ts取值为0.1s。
因此测量得到的速度值满足以下关系:
x(k)-x(k-1)=v0(k)Ts+e(k)-e(k-1) (4)
根据公式(1)中的关系,令:
y(k)=x(k)-x(k-1)+e(k-1) (5)
根据公式(4)和(5),得到对速度v0(k)进行参数辨识的关系式为:
y(k)=v0(k)Ts+e(k) (6)
根据公式(6),得到带遗忘因子的增广最小二乘法的速度v0(k)递推估计算法如下:
K(k)的初始默认值K(0)=0,P(k)的初始值一般来说越大越好,μ∈(0,1)。
本实施例中,P(k)的初始值P(0)=1000000,遗忘因子μ=0.33。
S102、根据速度估计的最大测量噪声幅值,使用一阶滑膜跟踪微分器精确估计目标的速度,得到目标速度的估计值。
其中,f(t)是该微分器的输入,即目标的测量位移,sgn(·)为符号函数,参数α,λ之间满足的关系如下:
其中,L1为步骤S101得到的速度估计的最大测量噪声幅值;
由公式(9)和(10)可以计算出精确的目标速度的估计值v(t)。
S103、根据目标速度的估计值,利用增广最小二乘法对加速度进行参数辨识,得到加速度估计的最大测量噪声幅值。
根据步骤S102得到的目标速度的估计值v(t),将其离散化后,可得到:
y(k)=v(k)-v(k-1)+e(k-1) (11)
其中,v(k)表示k时刻目标速度的估计值,e(k-1)表示k-1时刻的白噪声。
根据公式(6),得到对加速度a0(k)进行参数辨识的关系式为:
y(k)=a0(k)Ts+e(k) (12)
根据公式(12),得到带遗忘因子的增广最小二乘法的速度a0(k)递推估计算法如下:
S104、根据加速度估计的最大测量噪声幅值,使用高阶滑膜跟踪微分器精确估计目标的加速度,得到目标加速度的估计值。
高阶滑膜跟踪微分器的具体形式如下:
其中,σ为目标跟踪***的输入,r为目标跟踪***的阶次,sign(·)为开关函数;
由公式(15),可得加速度的估计的公式如下:
其中,σ为目标跟踪***的输入,即跟踪目标当前时刻的位置坐标;L2为加速度估计的最大测量噪声幅值;v0为当前时刻的速度估计值;a为***的输出值,作为加速度的估计值;z0、z1、z2分别为微分器中位移、速度和加速度的预测值,分别为z0、z1、z2的一阶导数。
上述v0是微分器里面的中间量,是由微分器计算出来的速度估计值。
由于步骤S103得到了精确的L2的值,因此可以获得精确的加速度估计值a。
本领域技术人员可以理解,实现上述实施例的方法中的全部或部分步骤可以通过程序来指令相关的硬件来完成,相应的程序可以存储于计算机可读存储介质中。
应当注意,尽管在附图中以特定顺序描述了上述实施例的方法操作,但是这并非要求或者暗示必须按照该特定顺序来执行这些操作,或是必须执行全部所示的操作才能实现期望的结果。相反,描绘的步骤可以改变执行顺序。附加地或备选地,可以省略某些步骤,将多个步骤合并为一个步骤执行,和/或将一个步骤分解为多个步骤执行。
实施例2:
如图2所示,本实施例提供了一种基于高阶滑膜跟踪微分器的加速度估计***,该***包括第一参数辨识模块201、第一估计模块202、第二参数辨识模块203和第二估计模块204,其中:
第一参数辨识模块201,用于利用增广最小二乘法对速度进行参数辨识,得到速度估计的最大测量噪声幅值;
第一估计模块202,用于根据所述速度估计的最大测量噪声幅值,使用一阶滑膜跟踪微分器精确估计目标的速度,得到目标速度的估计值;
第二参数辨识模块203,用于根据所述目标速度的估计值,利用增广最小二乘法对加速度进行参数辨识,得到加速度估计的最大测量噪声幅值;
第二估计模块204,用于根据所述加速度估计的最大测量噪声幅值,使用高阶滑膜跟踪微分器精确估计目标的加速度,得到目标加速度的估计值。
本实施例中各个模块的具体实现可以参见上述实施例1,在此不再一一赘述;需要说明的是,本实施例提供的***仅以上述各功能模块的划分进行举例说明,在实际应用中,可以根据需要而将上述功能分配由不同的功能模块完成,即将内部结构划分成不同的功能模块,以完成以上描述的全部或者部分功能。
实施例3:
本实施例提供了一种计算机设备,该计算机设备可以为计算机,如图3所示,其通过***总线301连接的处理器302、存储器、输入***303、显示器304和网络接口305,该处理器用于提供计算和控制能力,该存储器包括非易失性存储介质306和内存储器307,该非易失性存储介质306存储有操作***、计算机程序和数据库,该内存储器307为非易失性存储介质中的操作***和计算机程序的运行提供环境,处理器302执行存储器存储的计算机程序时,实现上述实施例1的加速度估计方法,如下:
利用增广最小二乘法对速度进行参数辨识,得到速度估计的最大测量噪声幅值;
根据所述速度估计的最大测量噪声幅值,使用一阶滑膜跟踪微分器精确估计目标的速度,得到目标速度的估计值;
根据所述目标速度的估计值,利用增广最小二乘法对加速度进行参数辨识,得到加速度估计的最大测量噪声幅值;
根据所述加速度估计的最大测量噪声幅值,使用高阶滑膜跟踪微分器精确估计目标的加速度,得到目标加速度的估计值。
实施例4:
本实施例提供了一种存储介质,该存储介质为计算机可读存储介质,其存储有计算机程序,所述计算机程序被处理器执行时,实现上述实施例1的加速度估计方法,如下:
利用增广最小二乘法对速度进行参数辨识,得到速度估计的最大测量噪声幅值;
根据所述速度估计的最大测量噪声幅值,使用一阶滑膜跟踪微分器精确估计目标的速度,得到目标速度的估计值;
根据所述目标速度的估计值,利用增广最小二乘法对加速度进行参数辨识,得到加速度估计的最大测量噪声幅值;
根据所述加速度估计的最大测量噪声幅值,使用高阶滑膜跟踪微分器精确估计目标的加速度,得到目标加速度的估计值。
需要说明的是,本实施例的计算机可读存储介质可以是计算机可读信号介质或者计算机可读存储介质或者是上述两者的任意组合。计算机可读存储介质例如可以是但不限于电、磁、光、电磁、红外线、或半导体的***、***或器件,或者任意以上的组合。计算机可读存储介质的更具体的例子可以包括但不限于:具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、随机访问存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、光纤、便携式紧凑磁盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。
以上所述,仅为本发明专利较佳的实施例,但本发明专利的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明专利所公开的范围内,根据本发明专利的技术方案及其发明构思加以等同替换或改变,都属于本发明专利的保护范围。
Claims (10)
1.一种基于高阶滑膜跟踪微分器的加速度估计方法,其特征在于,所述方法包括:
利用增广最小二乘法对速度进行参数辨识,得到速度估计的最大测量噪声幅值;
根据所述速度估计的最大测量噪声幅值,使用一阶滑膜跟踪微分器精确估计目标的速度,得到目标速度的估计值;
根据所述目标速度的估计值,利用增广最小二乘法对加速度进行参数辨识,得到加速度估计的最大测量噪声幅值;
根据所述加速度估计的最大测量噪声幅值,使用高阶滑膜跟踪微分器精确估计目标的加速度,得到目标加速度的估计值。
2.根据权利要求1所述的加速度估计方法,其特征在于,所述利用增广最小二乘法对速度进行参数辨识,具体包括:
设目标物体的运动轨迹为x(t),其中真实的运动轨迹为x0(t),白噪声为e(t),则其连续时间域表示为:
x(t)=x0(t)+e(t) (1)
其中,t为连续时间域上的时间;
将公式(1)转换为离散时间域:
x(k)=x0(k)+e(k) (2)
其中,k为离散域上的时刻值,k取大于或等于0的整数;e(k)服从N(0,1)的高斯分布;
目标跟踪***的采样时间为TS,kTs时刻的真实速度为v0(k),则由速度的定义式得到:
x0(k)-x0(k-1)=v0(k)TS (3)
因此测量得到的速度值满足以下关系:
x(k)-x(k-1)=v0(k)Ts+e(k)-e(k-1) (4)
根据公式(1)中的关系,令:
y(k)=x(k)-x(k-1)+e(k-1) (5)
根据公式(4)和(5),得到对速度v0(k)进行参数辨识的关系式为:
y(k)=v0(k)Ts+e(k) (6)。
5.根据权利要求2所述的加速度估计方法,其特征在于,所述根据所述目标速度的估计值,利用增广最小二乘法对加速度进行参数辨识,得到加速度估计的最大测量噪声幅值,具体包括:
将所述目标速度的估计值v(t)离散化后,得到:
y(k)=v(k)-v(k-1)+e(k-1) (11)
其中,v(k)为k时刻目标速度的估计值,e(k-1)为k-1时刻的白噪声;
根据公式(6),得到对加速度a0(k)进行参数辨识的关系式为:
y(k)=a0(k)Ts+e(k) (12)
根据公式(12),得到带遗忘因子的增广最小二乘法的速度a0(k)递推估计算法如下:
6.根据权利要求1所述的加速度估计方法,其特征在于,所述根据所述加速度估计的最大测量噪声幅值,使用高阶滑膜跟踪微分器精确估计目标的加速度,得到目标加速度的估计值,具体包括:
高阶滑膜跟踪微分器的具体形式如下:
其中,σ为目标跟踪***的输入,r为目标跟踪***的阶次,sign(·)为开关函数;
根据公式(15),得到加速度的估计的公式如下:
其中,σ为目标跟踪***的输入,即跟踪目标当前时刻的位置坐标;L2为所述加速度估计的最大测量噪声幅值;v0为当前时刻的速度估计值;z0、z1、z2分别为微分器中位移、速度和加速度的预测值,分别为z0、z1、z2的一阶导数;a为***的输出值,作为加速度的估计值;
7.根据权利要求1所述的加速度估计方法,其特征在于,所述方法之前还包括:
在基于视频的目标跟踪***中,获取目标物体的运动轨迹。
8.一种基于二阶滑膜跟踪微分器的加速度估计***,其特征在于,所述***包括:
第一参数辨识模块,用于利用增广最小二乘法对速度进行参数辨识,得到速度估计的最大测量噪声幅值;
第一估计模块,用于根据所述速度估计的最大测量噪声幅值,使用一阶滑膜跟踪微分器精确估计目标的速度,得到目标速度的估计值;
第二参数辨识模块,用于根据所述目标速度的估计值,利用增广最小二乘法对加速度进行参数辨识,得到加速度估计的最大测量噪声幅值;
第二估计模块,用于根据所述加速度估计的最大测量噪声幅值,使用高阶滑膜跟踪微分器精确估计目标的加速度,得到目标加速度的估计值。
9.一种计算机设备,包括处理器以及用于存储处理器可执行程序的存储器,其特征在于,所述处理器执行存储器存储的程序时,实现权利要求1-7任一项所述的加速度估计方法。
10.一种存储介质,存储有程序,其特征在于,所述程序被处理器执行时,实现权利要求1-7任一项所述的加速度估计方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111003208.5A CN113791240B (zh) | 2021-08-30 | 2021-08-30 | 基于高阶滑膜跟踪微分器的加速度估计方法、***、设备和介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111003208.5A CN113791240B (zh) | 2021-08-30 | 2021-08-30 | 基于高阶滑膜跟踪微分器的加速度估计方法、***、设备和介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113791240A true CN113791240A (zh) | 2021-12-14 |
CN113791240B CN113791240B (zh) | 2023-07-25 |
Family
ID=78876619
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111003208.5A Active CN113791240B (zh) | 2021-08-30 | 2021-08-30 | 基于高阶滑膜跟踪微分器的加速度估计方法、***、设备和介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113791240B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115046620A (zh) * | 2021-12-22 | 2022-09-13 | 中南大学 | 基于fbg应变传感器阵列的结构振动感知方法 |
CN116700306A (zh) * | 2023-06-02 | 2023-09-05 | 北京理工大学 | 一种用于捷联导引飞行器的一体化制导控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100082286A1 (en) * | 2008-09-30 | 2010-04-01 | Leung Omar S | Method and apparatus for operating an input device |
CN104485866A (zh) * | 2014-12-15 | 2015-04-01 | 南京理工大学 | 基于高阶滑模微分器的电机间接自适应鲁棒输出反馈控制方法 |
CN106706957A (zh) * | 2016-11-29 | 2017-05-24 | 中车株洲电力机车研究所有限公司 | 加速度估计方法、装置、机车运动控制方法及机车 |
CN110865334A (zh) * | 2019-11-26 | 2020-03-06 | 北京航空航天大学 | 一种基于噪声统计特性的多传感器目标跟踪方法及*** |
-
2021
- 2021-08-30 CN CN202111003208.5A patent/CN113791240B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100082286A1 (en) * | 2008-09-30 | 2010-04-01 | Leung Omar S | Method and apparatus for operating an input device |
CN104485866A (zh) * | 2014-12-15 | 2015-04-01 | 南京理工大学 | 基于高阶滑模微分器的电机间接自适应鲁棒输出反馈控制方法 |
CN106706957A (zh) * | 2016-11-29 | 2017-05-24 | 中车株洲电力机车研究所有限公司 | 加速度估计方法、装置、机车运动控制方法及机车 |
CN110865334A (zh) * | 2019-11-26 | 2020-03-06 | 北京航空航天大学 | 一种基于噪声统计特性的多传感器目标跟踪方法及*** |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115046620A (zh) * | 2021-12-22 | 2022-09-13 | 中南大学 | 基于fbg应变传感器阵列的结构振动感知方法 |
CN115046620B (zh) * | 2021-12-22 | 2023-08-18 | 中南大学 | 基于fbg应变传感器阵列的结构振动感知方法 |
CN116700306A (zh) * | 2023-06-02 | 2023-09-05 | 北京理工大学 | 一种用于捷联导引飞行器的一体化制导控制方法 |
CN116700306B (zh) * | 2023-06-02 | 2024-02-27 | 北京理工大学 | 一种用于捷联导引飞行器的一体化制导控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113791240B (zh) | 2023-07-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113791240A (zh) | 基于高阶滑膜跟踪微分器的加速度估计方法、***、设备和介质 | |
CN110375772B (zh) | 自适应卡尔曼滤波的环形激光器随机误差建模与补偿方法 | |
CN116736286B (zh) | 基于随机超曲面的渐进贝叶斯扩展目标跟踪方法及*** | |
CN108413986B (zh) | 一种基于Sage-Husa卡尔曼滤波的陀螺仪滤波方法 | |
Zhou et al. | Critical issues on Kalman filter with colored and correlated system noises | |
CN110231620B (zh) | 一种噪声相关***跟踪滤波方法 | |
CN108120452B (zh) | Mems陀螺仪动态数据的滤波方法 | |
CN111444474B (zh) | 一种基于乘性噪声相关自适应ckf的目标跟踪方法 | |
CN113625182A (zh) | 一种对电池状态进行在线估计的方法 | |
CN110677140B (zh) | 一种含未知输入和非高斯量测噪声的随机***滤波器 | |
CN109471192B (zh) | 一种全自动重力测试仪高精度动态数据处理方法 | |
CN117131747B (zh) | 一种基于采样点卡尔曼滤波的状态估计方法及装置 | |
Fatemi et al. | A study of MAP estimation techniques for nonlinear filtering | |
CN112067844B (zh) | Mems传感器阵列式高精度输出控制方法 | |
Fu et al. | Maneuvering target tracking with improved unbiased FIR filter | |
CN113920156A (zh) | 基于视频目标跟踪的加速度估计方法、***、设备及介质 | |
CN106871905B (zh) | 一种非理想条件下高斯滤波替代框架组合导航方法 | |
CN117392215A (zh) | 一种基于改进amcl和pl-icp点云匹配的移动机器人位姿校正方法 | |
CN113884914B (zh) | 一种渐消并行卡尔曼滤波动力电池荷电状态估计方法 | |
CN113848704B (zh) | 基于二阶滑膜跟踪微分器的加速度估计方法、***、设备和介质 | |
CN115114985A (zh) | 一种基于集合理论的传感器***分布式融合方法 | |
CN111090281B (zh) | 基于改进粒子滤波算法估算机器人方位的方法和装置 | |
CN112577478A (zh) | 微机电***陀螺随机噪声的处理方法及处理装置 | |
CN114624994B (zh) | 高阶柔性直线***的新型自抗扰控制方法及*** | |
CN113009468B (zh) | 一种视线坐标系内的解耦cmkf跟踪方法及*** |
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 |