一种目标跟踪信号的融合滤波方法技术

本发明专利技术公开了一种目标跟踪信号的融合滤波方法，基于主控单元、驱动单元以及运动平台构成的跟踪控制系统，主控单元包括融合滤波器和跟踪环控制器，运动平台包括平台轴系、陀螺以及视觉传感系统；本发明专利技术方法将脱靶量与光电系统中其他传感器信号进行互补滤波，滤波信号相较于脱靶量而言能够显著提升信号频率、降低系统延时，进而提升光电系统的跟踪性能。进而提升光电系统的跟踪性能。进而提升光电系统的跟踪性能。

【技术实现步骤摘要】
一种目标跟踪信号的融合滤波方法


[0001]本专利技术属于伺服控制
，具体涉及一种针对低频运动目标的用于改善低带宽、高延时的目标跟踪信号的融合滤波方法，适用于光电跟踪系统的目标跟踪控制。

技术介绍

[0002]光电跟踪系统多用于目标的探测、跟踪，此类系统通常使用视觉传感器获取目标距离视场中心的偏差量(即脱靶量)来进行闭环控制，从而实现传感器光轴与目标的跟随。
[0003]但由于输出脱靶量需要针对视觉信息进行大量复杂处理，在硬件性能有限时，脱靶量的输出帧频一般较低且有很大的测量延时。从而对系统的跟踪性能产生严重消极影响。
[0004]因此，如果能够获取高带宽、低延时的目标跟踪信号，就能够有效提升目标跟踪时的跟踪环路控制器增益，进而提升跟踪环路带宽。

技术实现思路

[0005]针对脱靶量闭环跟踪控制方法中跟踪信号存在低带宽、高延时等不足的问题，本专利技术提出一种用于改善低频率、高延时的目标跟踪信号的融合滤波方法。
[0006]本专利技术解决其技术问题所采用的技术方案是：一种目标跟踪信号的融合滤波方法，基于一个主控单元、一个驱动单元以及具有惯性稳定及视觉提取功能的运动平台构成的跟踪控制系统，所述的主控单元包括融合滤波器和跟踪环控制器，所述的运动平台包括平台轴系、可敏感平台运动的陀螺以及可提取目标距离视场中心的视觉传感系统；包括如下步骤：
[0007]1)视觉传感系统采集目标与视场中心的偏差，得到测量滞后时间为τ的测量脱靶量e
m
(t
‑
>τ)，陀螺采集视觉传感系统光轴在惯性空间中的角速度ω
g
，角速度ω
g
进行积分可以得到视觉传感系统光轴在惯性系下相对于初始位置θ
s0
的相对角位移θ
g
；
[0008]2)将相对角位移θ
g
人工滞后τ时间，与脱靶量e
m
(t
‑
τ)在时域上进行对齐，得到对齐后角位移θ
g
(t
‑
τ)，通过互补滤波器融合脱靶量e
m
(t
‑
τ)与对齐后角位移θ
g
(t
‑
τ)，得到滤波后脱靶量e
m
'(t
‑
τ)，脱靶量e
m
'(t
‑
τ)相对于脱靶量e
m
(t
‑
τ)大幅提升了测量带宽；
[0009]3)将新的滤波后脱靶量e
m
'(t
‑
τ)和相对角位移θ
g
作为测量信号输入修正补偿滤波器进行延时补偿，得到延时补偿后的脱靶量估计值脱靶量的估计相对于脱靶量e
m
'(t
‑
τ)大幅减小了延时，最终获得带宽、延时均优于原始脱靶量信号的脱靶量估计。
[0010]所述的一种目标跟踪信号的融合滤波方法，其脱靶量e
m
(t
‑
τ)的特点是更新频率较低(通常≤60Hz)、测量延时较大，由于频率低，其测量带宽也很低。
[0011]所述的一种目标跟踪信号的融合滤波方法，其互补滤波器由低通滤波器H1和与低通滤波器H1互补的高通滤波器H2并联构成。
[0012]所述的一种目标跟踪信号的融合滤波方法，其步骤3)是修正补偿滤波器以滤波后脱靶量e
m
'(t
‑
τ)和对齐后角位移θ
g
(t
‑
τ)为测量值，建立n阶目标运动模型(n≥1)，并根据运
动模型进行预测估计，同时结合相对角位移θ
g
对光轴运动部分的延时进行修正补偿，最终得到补偿滤波后脱靶量的估计值
[0013]本专利技术的有益效果在于：
[0014]本专利技术方法将脱靶量与光电系统中其他传感器信号进行互补滤波，滤波信号相较于脱靶量而言能够显著提升信号频率、降低系统延时，进而提升光电系统的跟踪性能。
[0015]本专利技术的融合滤波方法融合陀螺数据后大幅提升了脱靶量信号测量带宽，能够有效提升目标跟踪时高频扰动的抗扰能力。
[0016]本专利技术的融合滤波方法获取的估计信号大幅减小了测量延时，能够有效提升目标跟踪时的跟踪环路控制器增益，进而提升跟踪环路带宽。
附图说明
[0017]图1为本专利技术跟踪控制系统的结构框图；
[0018]图2为本专利技术融合滤波器的原理图；
[0019]图3为本专利技术互补滤波器的原理图；
[0020]图4为本专利技术修正补偿滤波器的原理图。
[0021]各附图标记为：1—主控单元，11—融合滤波器，111—互补滤波器，112—修正补偿滤波器，12—跟踪环控制器，2—驱动单元，3—运动平台，31—平台轴系，32—陀螺，33—视觉传感系统。
具体实施方式
[0022]为进一步说明本专利技术的目的和技术方案，下面将结合附图和具体实施例对本专利技术作进一步详细说明。
[0023]参照图1所示，本专利技术基于一个主控单元1、一个驱动单元2以及具有惯性稳定及视觉提取功能的运动平台3构成的跟踪控制系统，所述的主控单元1包括融合滤波器11和跟踪环控制器12，所述的运动平台3包括平台轴系31、可敏感平台运动的陀螺32以及可提取目标距离视场中心的视觉传感系统33。
[0024]本专利技术实施的一种针对低频运动目标的用于改善低带宽、高延时的目标跟踪信号的融合滤波方法，原理如图2所示。
[0025]1)视觉传感系统33采集目标与视场中心的偏差，得到测量滞后时间为τ的测量脱靶量e
m
(t
‑
τ)，获取脱靶量e
m
(t
‑
τ)测量延时，陀螺32采集视觉传感系统33光轴在惯性空间中的角速度ω
g
，角速度ω
g
进行积分可以得到视觉传感系统33光轴在惯性系下相对于初始位置θ
s0
的相对角位移θ
g
，即陀螺积分信号。其中脱靶量e
m
(t
‑
τ)的特点是更新频率较低(通常≤60Hz)、测量延时较大，由于频率低，其测量带宽也很低，而角速度ω
g
的特点是测量带宽较高、延时较小，但存在零偏b
b
及随机游走b
r
等低频误差。
[0026]2)将相对角位移θ
g
人工滞后τ时间，与脱靶量e
m
(t
‑
τ)时域对齐，一同输入互补滤波器111获得滤波后的脱靶量信号e
m
'(t
‑
τ)，脱靶量e
m
'(t
‑
τ)相对于脱靶量e
m
(t
‑
τ)大幅提升了测量带宽。
[0027]3)将滤波后脱靶量本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种目标跟踪信号的融合滤波方法，其特征在于，基于一个主控单元(1)、一个驱动单元(2)以及运动平台(3)构成的跟踪控制系统，所述的主控单元(1)包括融合滤波器(11)和跟踪环控制器(12)，所述的运动平台(3)包括平台轴系(31)、可敏感平台运动的陀螺(32)以及可提取目标距离视场中心的视觉传感系统(33)；包括如下步骤：1)视觉传感系统(33)采集目标与视场中心的偏差，得到测量滞后时间为τ的测量脱靶量e
m
(t
‑
τ)，陀螺(32)采集视觉传感系统(33)光轴在惯性空间中的角速度ω
g
，角速度ω
g
进行积分得到视觉传感系统(33)光轴在惯性系下相对于初始位置θ
s0
的相对角位移θ
g
；2)将相对角位移θ
g
人工滞后τ时间，与脱靶量e
m
(t
‑
τ)在时域上进行对齐，得到对齐后角位移θ
g
(t
‑
τ)，通过互补滤波器(111)融合脱靶量e
m
(t
‑
t)与对齐后角位移θ
g
(t
‑
τ)，得...

【专利技术属性】
技术研发人员：吴海涛，方昉，欧阳胡坡，
申请(专利权)人：武汉华中天经通视科技有限公司，
类型：发明
国别省市：