An Improved Kernelized Correlation Tracking Algorithm Based on a Joint Confidence Measurement and Motion Model
-
摘要: 红外制导技术是武器制导领域研究的热点和主要方向.针对探测跟踪过程中核相关跟踪算法(Kemelized Correlation Filter,KCF)对快速运动和严重遮挡目标的跟踪精度下降问题,提出一种融合卡尔曼滤波和运动模型的改进核相关目标跟踪算法.该算法首先利用运动模型对目标的位置进行初始估计,提出一种自适应搜索区域选择的方法.针对测试样本的置信度响应图呈现多峰平坦的情况,本文提出了一种用于目标相似度量的组合置信度测量策略,采用相关峰的锐度和置信图的平滑度约束来进一步计算疑似区域的置信度,提升算法的抗干扰能力;同时,本文也提出了一种基于最优置信度的自适应参数更新,增强模型的泛化能力.大量的仿真实验结果表明本文所提的算法的跟踪性能超过传统的核相关跟踪算法,对复杂的跟踪场景具有更强的鲁棒性与抗干扰能力.
-
0. 引言
在沿海机场往往会面临机场跑道方向上时有货轮经过附近海域或大型海上平台在航线方向海上作业影响飞机起飞降安全的情况,由于机场位于开阔水域,往来船舶等频繁,发生跑道入侵事件的风险很大[1];在内陆江河或沿海航道上同样会面临过往船只过高对跨江或跨海大桥产生安全威胁的情况,需要预防桥梁受到船舶撞击[2]。为此这些地方往往需要对过往船只的高度乃至位置进行监测,实时掌握目标航向和目标高度以便评估其威胁程度。
在船舶移动的过程中由于多普勒效应影响,同时雷达引导上传目标数据周期性长、实时性差,单纯的雷达探测只能获取滞后的目标绝对位置信息,不可避免会产生一定的误差[3-4],无法掌握目标准确的高度,且随着水位的涨落,同一型船只在不同的时间经过同一位置也难以保证船只最高点的高程保持不变,为此需要一种高精度目标定位系统能够实时解算出目标的绝对位置和高程信息。
为此,本文设计了一种集成有高清可见光相机、红外热像仪、高精度激光测距机、倾角仪、光电编码器于一体的光电船只目标定位系统。
1. 测量原理
光电船只目标定位系统安装于陆地基座上,依靠内部集成的高清可见光相机、红外热像仪及激光测距机可实现昼夜对目标船只位置和高程信息的监测,下文图中云台均以PTZ代表,系统工作示意图如图 1所示。
通过北斗定位装置获取云台自身的经纬度高程坐标信息(本文中经纬度高程坐标信息均基于2000国家大地坐标系),通过激光测距机和云台编码器获取目标相对于云台的相对坐标信息,通过倾角仪获取云台安装基座姿态变化信息以对目标解算位置进行实时修正。以上信息经云台内部目标定位解算模块解算,给出目标的绝对位置信息,如图 2所示。
由于系统设备安装方式为陆基安装,故只需在系统安装完毕后,利用北斗定位装置对光电系统安装位置进行一次自身坐标位置标定,以获取光电系统的经纬度坐标和高程信息。同时利用云台内部的水平向和高低向光电编码器获取目标相对于云台的角度信息,通过激光测距机获取目标相对于云台的测量距离,由此可解算出目标对于光电系统的相对位置和高程信息,再结合光电系统自身的大地坐标位置即可解算出目标的绝对位置和高程信息,目标与云台坐标系关系如图 3所示。
目标相对于云台坐标系的相对位置信息为:
$$ \left[ {\begin{array}{*{20}{c}} {{x_1}} \\ {{y_1}} \\ {{z_1}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} {d\cos a\sin b} \\ {d\cos a\cos b} \\ {d\sin a} \end{array}} \right] $$ (1) 式中:x1、y1、z1为目标在云台坐标系内的坐标信息;d为目标相对云台的直线距离;a为目标相对于云台的俯仰角;b为目标相对于云台的方位角。
实际应用中,云台所处的安装基座一般要高出地面或者建筑物一定高度,长期受到大风或者振动影响后基座面相对于初始安装时往往会发生一定的姿态改变,这会造成目标相对于云台自身的相对位置也会发生轻微变化,进而一定程度上会影响对目标的定位解算精度。因此引入云台内倾角仪输出的姿态信息对云台姿态进行校正。目标与发生偏移后云台坐标系关系如图 4所示。
目标在偏移后的云台坐标系的绝对位置信息为:
$$ \left[ {\begin{array}{*{20}{c}} {{x_2}} \\ {{y_2}} \\ {{z_2}} \end{array}} \right] = {\mathit{\boldsymbol{C}}}\left[ {\begin{array}{*{20}{c}} {{x_1}} \\ {{y_1}} \\ {{z_1}} \end{array}} \right] + \left[ {\begin{array}{*{20}{c}} {{x_0}} \\ {{y_0}} \\ {{z_0}} \end{array}} \right] $$ (2) 式中:x0、y0、z0为在大地坐标系下三轴的坐标;x2、y2、z2为在大地坐标系下三轴的坐标;α、β、δ分别为偏移后的云台坐标系各轴相对于原坐标系各轴的姿态变化角度,矩阵C为:
$$ {\mathit{\boldsymbol{C}}} = \left[ {\begin{array}{*{20}{c}} {\cos \delta \cos \beta }&{\sin \alpha \sin \delta \cos \beta - \cos \alpha \sin \beta }&{\cos \alpha \sin \delta \cos \beta + \sin \alpha \sin \beta } \\ {\cos \beta }&{\sin \alpha \sin \delta \sin \beta + \cos \alpha \sin \beta }&{\cos \alpha \sin \delta \cos \beta - \sin \alpha \cos \beta } \\ { - \sin \delta }&{\sin \alpha \cos \delta }&{\cos \alpha \cos \delta } \end{array}} \right] $$ (3) 2. 云台伺服系统设计
云台伺服系统采用经典的位置环、速度环、电流环三环设计,通过位置环结合速度环和电流环实现云台根据雷达系统引导信息调转到指定位置,由于雷达引导坐标位置精确性较差且具有滞后性,需要进一步优化工作流程才能锁定测量目标。因此云台在接收雷达引导信息调转到位后,转入识别跟踪流程,识别并锁定跟踪目标船只最高点,并对其进行目标定位测量解算。伺服系统控制方案如图 5所示。
其中位置环和电流环采用Proportional integral比例积分控制器,速度环采用Linear active disturbance rejection control线性自抗扰控制器。
自抗扰控制由韩京清教授最早提出,通过跟踪-微分器、反馈控制律、扩张状态观测器组成的控制器不依赖于系统的精确数学模型具有良好的鲁棒性和适应性[5]。针对自抗扰控制中非线性结构多、待调控制参数多的不便于工程化使用情况,高志强教授进一步提出了待调参数数量简化的线性自抗扰控制算法即LADRC,使整定参数和带宽相关,整定难度简化,更适合应用于工程领域[6]。
云台采用表贴式永磁同步电机,电机转矩和运动方程为:
$$ \left\{ \begin{array}{l} {T_{\rm{e}}} = {T_{\rm{L}}} + B\omega + J\frac{{{\rm{d}}\omega }}{{{\rm{d}}t}} \hfill \\ {T_{\rm{e}}} = {C_{\rm{t}}}{i_{\rm{q}}} \hfill \end{array} \right. $$ (4) 式中:Te为电磁转矩;TL为负载转矩;B为阻尼系数;ω为电机机械角速度;J为转动惯量;Ct为转矩系数;iq为转矩电流分量。
根据电机转矩和运动方程可见,速度环适宜使用一阶LADRC速度控制器,首先设计扩张状态观测器部分。
由式(4)可以进一步得到状态方程:
$$ \left\{ \begin{array}{l} {{\dot x}_1} = {x_2} + {l_0}{i_{\rm{q}}} \hfill \\ {x_2} = f \hfill \end{array} \right. $$ (5) 式中:x1=ω为电机机械角速度;x2为$ f = \frac{1}{J}({C_t}{i_{\rm{q}}} - {T_{\rm{L}}} - B\omega ) - l{}_0{i_{\rm{q}}} $,为未知待观测量;l0为速度环LADRC控制器待调参数。
采用的线性状态观测器方程为:
$$ \left\{ \begin{array}{l} \dot z = {\mathit{\boldsymbol{A}}}z + {\mathit{\boldsymbol{B}}}u + {\mathit{\boldsymbol{L}}}({x_1} - {z_1}) \hfill \\ {\mathit{\boldsymbol{A}}} = \left[ {\begin{array}{*{20}{c}} 0&1 \\ 0&0 \end{array}} \right] \hfill \\ {\mathit{\boldsymbol{B}}} = \left[ {\begin{array}{*{20}{c}} {{l_0}} \\ 0 \end{array}} \right] \hfill \\ {\mathit{\boldsymbol{L}}} = \left[ {\begin{array}{*{20}{c}} {{l_1}} \\ {{l_2}} \end{array}} \right] \hfill \end{array} \right. $$ (6) 式中:z为系统观测的状态量;x为系统实际的状态量;u为系统输入量。
由式(5)、式(6)可以得到:
$$ \left\{ \begin{array}{l} \dot {\hat \omega} = \hat f + {l_0}{i_{\rm{q}}} + {l_1}(\omega - \hat \omega ) \hfill \\ \hat f = {l_2}(\omega - \hat \omega ) \hfill \end{array} \right. $$ (7) 式中:$ \hat \omega $为电机角速度观测值;$ \hat f $为待观测量f的观测值。
取$ {l_0}{i_q} = {u_0} - \hat f $,当$ \hat f $无限接近于f时,则由式(5)有:
$$ \dot \omega = f + ({u_0} - \hat f) = {u_0} $$ (8) 式中:u0为控制律输出量。
电机速度环经过控制器可等效为一阶积分环节,故LADRC控制律环节可简化设计为比例控制器[7],取$ {u_0} = {K_{\rm{p}}}({\omega _{{\rm{ref}}}} - \hat \omega ) $,ωref为速度环给定转速。云台采用的力矩电机为低速电机且长期工作于低速运行状态,故省去LADRC中的跟踪-微分器环节设计,由此可以得到速度环LADRC控制器结构如图 6所示。
系统中俯仰向采用J180LWX005型无刷力矩电机和EAC90F-0M21S型光电编码器,采用的电机和编码器参数如表 1所示。
表 1 电机和编码器参数Table 1. Motor and encoder parameterJ180LWX005 motor Value EAC90F-0M21S encoder Value Rated torque/(N⋅m) 8 Resolution 21 bits Rated current/A 4 Accuracy < 30″ No-load speed/rpm 110 Maximum speed/rpm 6000 Torque coefficient/(N⋅m/A) 2 Phase resistor/Ω 1.6 Phase inductance/mH 4.5 速度环给定转速ωref=3.66°/s,分别测试速度环采用PI控制器和LADRC控制器速度响应情况,并在速度达到稳定后突加一固定干扰力矩,速度环响应曲线如图 7所示。
由图 7、图 8可见采用LADRC控制器后,云台速度环可更快抑制扰动,转速控制波动量小更加平稳,位置调转响应更快。
位置闭环响应曲线如图 8所示,电机初始位置为30°,测试时先回到0°位置,再调转至50°位置。
3. 系统软件设计
该目标定位系统工作流程如图 9所示。云台根据雷达引导信息调转至指定位置,由于雷达引导位置存在一定误差,加上目标船只处于移动状态因此雷达引导信息具有滞后性,且雷达不能获取到目标最高点位置,因此云台调转到位后不能立刻进行目标船只定位测高,需要先识别选定视场内目标船只最高点,然后再开启跟踪锁定目标船只最高点进行定位测高。
在得到目标船只测距值后,通过依次读取云台倾角仪获取云台相对大地坐标系姿态角、云台编码器值获取目标船只相对云台坐标系极坐标,结合云台所处的经纬度高程信息,即可解算出目标船只准确的经纬度和高程信息。
4. 测试结果
随机选取了4个不同方向不同距离的目标点对系统的测量精度进行测试,目标点经纬度测试情况如表 2所示。
表 2 目标经纬度测量对照Table 2. Target longitude and latitude measurement comparisonActual value of target longitude and latitude/° Measurement value of target longitude and latitude/° Distance/m Deviation/m Longitude: 118.7693622; Latitude: 31.87598539 Longitude: 118.7693379; Latitude: 31.8759465 2638 4.77 Longitude: 118.7841865; Latitude: 31.896963 Longitude: 118.7841426; Latitude: 31.8969342 3825 4.86 Longitude: 118.7775752; Latitude: 31.9166531 Longitude: 118.777571; Latitude: 31.9166863 6025 3.71 Longitude: 118.86845383; Latitude: 31.89987727 Longitude: 118.868425; Latitude: 31.8998692 8224 2.84 目标点高程测试情况,如表 3所示。综合表 2和表 3可见,该系统对目标点在经纬度测量上误差不超过5 m,高程测量上误差不超过2 m,可实现较高的测量精度。
表 3 目标高程测量对照Table 3. Target height measurement comparisonActual value of target height/m Measurement value/m Distance/m Deviation/m 87.944 88.2 2638 0.256 113.346 112.4 3825 -0.946 116.26 115.2 6025 -1.06 230.2 228.7 8224 -1.5 5. 结束语
文中提出了一种光电式高精度目标船只定位系统,利用该系统可获取较高精度的目标位置和高程信息,有效提高了目标定位测算的准确度和效率。
试验表明了该设计的合理性。试验结果证明该系统可给出目标位置较高精度的定位数据,投入使用后工作稳定可靠,具有良好的性能,在无人值守监控定位领域具有广泛的应用前景。
-
期刊类型引用(1)
1. 李绍军,李英杰,李威,徐哲,王国右,徐妍,荆凡胜. 车载升降式光电云台共振抑制方法研究. 红外技术. 2024(04): 406-412 . 本站查看
其他类型引用(0)
计量
- 文章访问数: 97
- HTML全文浏览量: 22
- PDF下载量: 17
- 被引次数: 1