一种路径跟踪方法、装置及系统

技术领域

本申请涉及物联网技术领域，尤其是涉及一种路径跟踪方法、装置及系统。

背景技术

将物联网技术以及“工业4.0”理念引入车间生产过程，能够帮助管理人员全方位、自动、实时、透明地追踪生产过程信息，从而快速协调生产计划和资源，并提高企业的生产管理水平。在这个背景下，数字孪生技术应运而生，虚实交互成为智能车间或数字孪生车间的基本特征之一。而在数字孪生车间的实际应用当中，为了映射工件、物料在车间的流转，大多依靠着射频识别技术(Radio Frequency Identification，RFID)进行非接触式的数据通信，识别工件上的标签，并将数据传入制造执行系统(Manufacturing ExecutionSystem，MES)中，以事件数据源作为位置信息判断条件，确定该工件处于哪个工位上，并判断该工件是否正在被加工。判断工件离开工位同样源于事件触发机制。因此RFID的定位跟踪精度会影响物料运输路径同步映射的准确性，从而影响管理人员的决策。

但目前应用广泛的RFID技术普遍采用接收信号强度信息(Received SignalStrength Information，RSSI)的原理提取标签与读写器之间的距离，这种方式会受到周围噪声源的干扰，因此无法进行精准定位。

发明内容

本申请的目的在于提供一种路径跟踪方法、装置及系统，从而解决现有技术中由于定位跟踪精度低导致确定的运输路径不准确的问题。

第一方面，为了达到上述目的，本申请提供一种路径跟踪方法，包括：

获取各个读写器确定的目标对象在第一时刻的测量位置；

将各个所述测量位置输入至当前已更新的基于非线性卡尔曼滤波算法的自适应目标动力学模型，获取所述目标对象在所述第一时刻的最优状态向量；其中，所述自适应目标动力学模型用于根据各个所述测量位置，预测所述目标对象在所述第一时刻的最优状态向量；

根据不同时刻的最优状态向量，确定所述目标对象的路径。

可选地，根据各个所述测量位置，预测所述目标对象在所述第一时刻的最优状态向量，包括：

获取在第二时刻预测的所述目标对象在所述第一时刻的预测状态向量；其中，所述第二时刻为所述第一时刻的前一时刻；

获取非线性卡尔曼滤波器的增益；

根据各个所述测量位置、所述预测状态向量和所述增益，预测所述目标对象在所述第一时刻的最优状态向量。

可选地，获取在第二时刻预测的所述目标对象在所述第一时刻的预测状态向量，包括：

根据公式x(t

其中，x(t

可选地，所述系统状态转移矩阵为：

其中，

其中，η＝x,y，分别表示x，y坐标轴；th

可选地，根据各个所述测量位置、所述预测状态向量和所述增益，预测所述目标对象在所述第一时刻的最优状态向量，包括：

根据公式

其中，x(t

可选地，根据各个所述测量位置、所述预测状态向量和所述增益，预测所述目标对象在所述第一时刻的最优状态向量，包括：

根据公式

其中，x(t

可选地，获取所述目标对象在所述第一时刻的最优状态向量之后，所述方法还包括：

根据所述目标对象在所述第一时刻的最优状态向量中的加速度估计值，更新所述自适应目标动力学模型中的机动频率和/或高斯白噪声方差。

可选地，根据所述目标对象在所述第一时刻的最优状态向量中的加速度估计值，更新所述自适应目标动力学模型中的机动频率和/或高斯白噪声方差，包括：

根据如下公式，确定更新后的所述机动频率和高斯白噪声方差：

其中，

第二方面，为了达到上述目的，本申请实施例还提供一种路径跟踪装置，包括：

获取模块，用于获取各个读写器确定的目标对象在第一时刻的测量位置；

预测模块，用于将各个所述测量位置输入至当前已更新的基于非线性卡尔曼滤波算法的自适应目标动力学模型，获取所述目标对象在所述第一时刻的最优状态向量；其中，所述自适应目标动力学模型用于根据各个所述测量位置，预测所述目标对象在所述第一时刻的最优状态向量；

确定模块，用于根据不同时刻的最优状态向量，确定所述目标对象的路径。

第三方面，为了达到上述目的，本申请实施例还提供一种路径跟踪系统，包括：处理器，存储器及存储在所述存储器上并可在所述处理器上运行的程序，所述程序被所述处理器执行时实现如第一方面所述的路径跟踪方法的步骤。

第四方面，为了达到上述目的，本申请实施例还提供一种可读存储介质，所述可读存储介质上存储有程序，所述程序被处理器执行时实现如第一方面所述的路径跟踪方法的步骤。

本申请的上述技术方案至少具有如下有益效果：

本申请实施例的路径跟踪方法，首先，获取各个读写器确定的目标对象在第一时刻的测量位置；其次，将各个所述测量位置输入至当前已更新的基于非线性卡尔曼滤波算法的自适应目标动力学模型，获取所述目标对象在所述第一时刻的最优状态向量；其中，所述自适应目标动力学模型用于根据各个所述测量位置，预测所述目标对象在所述第一时刻的最优状态向量；如此，提高了对目标对象的定位精度，最后，根据不同时刻的最优状态向量，确定所述目标对象的路径。这样，在对目标对象的定位精度提高的基础上，能够进一步提高对目标对象的路径的跟踪精度，为管理人员的决策提供可靠的依据。

附图说明

图1为本申请实施例的路径跟踪方法的流程示意图；

图2为数据融合的分类及常用算法的示意图；

图3为RFID读写器放置于测量范围显示示例图；

图4为物料运送轨迹设置示意图；

图5为各仿真数据记录示例图；

图6为基于EKF/UKF的物料估计轨迹与参考轨迹曲线图；

图7为基于EKF/UKF的横纵轴估计轨迹与参考轨迹的曲线图；

图8为基于EKF/UKF的横纵轴轨迹跟踪误差曲线图；

图9为RFID读写器分布区域特点示意图；

图10为重复对比试验中部分RFID读写器摆放位置及物料运输路径曲线图；

图11为本申请实施例的路径跟踪装置的结构示意图。

具体实施方式

下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本申请一部分实施例，而不是全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本申请保护的范围。

本申请的说明书和权利要求书中的术语“第一”、“第二”等是用于区别类似的对象，而不用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换，以便本申请的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外，说明书以及权利要求中“和/或”表示所连接对象的至少其中之一，字符“/”，一般表示前后关联对象是一种“或”的关系。

在对本申请实施例的路径跟踪方法、装置及系统进行详细说明之前，先对相关技术点进行说明：

一、RFID

一种物联网技术，它依靠无线通信实现对物体的自动识别。典型RFID系统的基本组件包括RFID标签、读写器、天线以及后台应用系统。其中标签被附加到待识别和定位的对象上，而读写器使用系统天线接收到携带有RFID标签的对象进入系统识别范围内时产生的电磁信息，再传输到后台的应用系统中进行处理，从而达到使用者要求的各类应用效果。

在定位领域当中，基于全球定位系统(Global Positioning System，GPS)的户外定位服务已经得到了广泛应用，但由于卫星与接收机之间缺乏视距无线传输(Line ofSight)通道，GPS无法在室内环境提供足够精确的定位服务。此外，许多其他问题使得室内环境的定位和跟踪比室外环境更加复杂且具有挑战性。例如障碍物分布过多导致的信号散射以及信号经过墙体和物体反射导致的多径效应等。随着基于红外、无线局域网、超宽带、RFID等技术方法的提出开发，为室内环境中的定位问题提供了各种渠道。但RFID可以识别不同的人和设备，且由于其较低的成本、有着较高精度定位对象的潜在能力和能够在遮挡和没有视野的环境中运作的特点，逐渐被广泛用于室内位置感知和目标跟踪领域中，也成为了车间无线传感器网络中一项应用广泛的技术。

二、数据融合：

数据融合是对多源数据进行分析处理的一种策略和理论方法，通过把不同时间和空间的数据在一定准则下进行综合分析与处理，精确、及时地获得对系统的一致性解释与描述，从而实现与之对应的信息处理、决策以及估计任务，能够使系统获得更为充分的信息。目前数据融合领域主要分为三类，分别是传感器融合、图像融合和信息融合。传感器融合使用来自不同传感器的数据，并通过数据测量和分析过程将其整合为单一数据，能够实现更准确和更具体的推断；图像融合通过减少不确定性和冗余度来提高图像的信息含量，包括将各种表现形式的图像合并成一个单一的图像；信息融合是一个过程，用于从不完整的信息中提取信息，处理信息的相关性、组合性等多层次的过程，并最终用于完成所需的估计和决策环节。

数据融合按操作对象分类又可以分为数据级融合、特征级融合以及决策级融合，其中数据级融合在图像领域又被称为像素级融合。各个层级分别针对数据本身、数据特征以及数据所反应的决策问题进行融合，各层级分类以及常用的算法如图2所示。本申请属于数据级融合层次。

三、卡尔曼滤波法(Kalman Filter)：

一种凭借前一时刻的系统状态预测值与当前时刻的测量值，根据递推方式计算得到最优估计值的最优化自回归数据处理算法。在室内定位和目标跟踪领域，卡尔曼滤波法及其各类衍生算法通常都可以起到优秀的估计效果。

在实际的系统应用中，由于系统状态噪声与测量噪声等不确定因素的干扰影响，致使工程实践中往往充斥着大量的非线性滤波问题，例如RFID测量系统便是典型的非线性系统。但是，最开始提出的卡尔曼滤波法只适用于线性系统，其对非线性系统的估计效果很差，因此学者们陆续提出了扩展卡尔曼滤波(Extended Kalman Filter，EKF)、无迹卡尔曼滤波(Unscented Kalman Filter，UKF)、容积卡尔曼滤波(Cubature Kalman Filter，CKF)、高斯-厄米特卡尔曼滤波(Gauss-Hermite Kalman Filter，GHKF)等非线性卡尔曼滤波算法。其中本申请主要研究了基于EKF与UKF的RFID轨迹跟踪数据融合。

四、EKF算法模型

考虑一般的离散时间非线性系统模型为：

x(k)＝f[x(k-1),w(k-1)]

z(k)＝h[x(k),v(k)]

其中，x(k)表示在k时刻的系统待估计状态向量；z(k)表示在k时刻的系统状态测量值；w(k-1)表示系统过程噪声，为高斯白噪声序列；v(k)表示测量噪声，为与系统噪声相互独立的高斯白噪声；f(·)和h(·)表示非线性的过程方程与测量方程。

EKF算法将非线性系统模型经过泰勒级数展开后处理为线性化模型，算法主要分为以下几个部分：

(1)预测x(k∣k-1)：

x(k∣k-1)＝f[x(k-1∣k-1),0]

(2)更新x(k∣k)：

x(k∣k)＝x(k∣k-1)+K(k)[z(k)-h(x(k∣k-1),0]

其中，K(k)为滤波器增益，代表了估计值与测量值对于真实值影响的权重。

(3)滤波器增益K(k)：

K(k)＝P(k∣k-1)H

其中，P(k∣k-1)代表向前一步预测方差；R(k)代表测量噪声协方差矩阵，为已知值；H(k)、M(k)如下式所示。

(4)向前一步预测方差P(k∣k-1)：

P(k∣k-1)＝F(k-1)P(k-1∣k-1)F

其中，P(k-1∣k-1)代表k-1时刻估计方差；Q(k-1)代表过程噪声方差，为已知值；F(k)、L(k)如下式所示。

(5)状态估计方差P(k∣k)：

P(k∣k)＝[I-K(k)H(k)]P(k∣k-1)

五、UKF算法模型

无迹变换是指通过一定的方法从众多数值点中选取合适的若干点，称之为sigma点，并用这些sigma点来计算均值和方差，且能够很好地接近真实值。具体的选取方法在此不做赘述，UKF算法则是利用无迹变换处理非线性系统模型，从而进行更准确的预测和更新。算法主要分为以下几个部分：

(1)预测x(k∣k-1)：

x

x

其中x

(2)更新x(k∣k)：

x

(3)滤波器增益K(k)：

(4)向前一步预测方差P(k∣k-1)：

(5)状态估计方差P(k+1∣k+1)：

P(k+1∣k+1)＝P(k∣k+1)-K(k)P

下面结合附图，通过具体的实施例及其应用场景对本申请实施例提供的路径跟踪方法、装置及系统进行详细地说明。

如图1所示，为本申请实施例的路径跟踪方法的流程示意图，该方法包括：

步骤101，获取各个读写器确定的目标对象在第一时刻的测量位置；

这里需要说明的是，目标对象上贴有标签，读写器通过识别目标对象上的标签，确定读写器与目标对象之间的距离，从而进一步确定目标对象的测量位置；

这里，还需要说明的是，目标对象在第一时刻的测量位置可以用读写器与目标对象之间的距离向量表示。

步骤102，将各个所述测量位置输入至当前已更新的基于非线性卡尔曼滤波算法的自适应目标动力学模型，获取所述目标对象在所述第一时刻的最优状态向量；其中，所述自适应目标动力学模型用于根据各个所述测量位置，预测所述目标对象在所述第一时刻的最优状态向量；

这里，需要说明的是，本步骤中，通过将各个测量位置输入至基于非线性卡尔曼滤波算法的自适应目标动力学模型，使得基于非线性卡尔曼滤波算法的自适应目标动力学模型能够对这些测量位置进行数据融合，以获得该目标对象的最优状态向量；其中，该目标对象的最优状态向量至少包括该目标对象的位移、速度和加速度等。

步骤103，根据不同时刻的最优状态向量，确定所述目标对象的路径。

本申请实施例的路径跟踪方法，首先，获取各个读写器确定的目标对象在第一时刻的测量位置；其次，将各个所述测量位置输入至当前已更新的基于非线性卡尔曼滤波算法的自适应目标动力学模型，获取所述目标对象在所述第一时刻的最优状态向量；其中，所述自适应目标动力学模型用于根据各个所述测量位置，预测所述目标对象在所述第一时刻的最优状态向量；如此，提高了对目标对象的定位精度，最后，根据不同时刻的最优状态向量，确定所述目标对象的路径。这样，在对目标对象的定位精度提高的基础上，能够进一步提高对目标对象的路径的跟踪精度，为管理人员的决策提供可靠的依据。

这里，对步骤101，获取各个读写器确定的目标对象在第一时刻的测量位置的具体实现过程进行说明：

RFID测量系统通过RSSI方法获取在t

式中，d

实际测量当中，测得距离z

z

其中，v

作为一个可选的实现方式，步骤102，根据各个所述测量位置，预测所述目标对象在所述第一时刻的最优状态向量，包括：

获取在第二时刻预测的所述目标对象在所述第一时刻的预测状态向量；其中，所述第二时刻为所述第一时刻的前一时刻；

获取非线性卡尔曼滤波器的增益；

根据各个所述测量位置、所述预测状态向量和所述增益，预测所述目标对象在所述第一时刻的最优状态向量。

本可选实现方式中，基于各个所述测量位置、前一时刻(第二时刻)预测的目标对象在本时刻(第一时刻)的预测状态向量和所述非线性卡尔曼滤波器的增益，预测所述目标对象在所述第一时刻的最优状态向量，实现了仅基于前一时刻的预测结果和本时刻的测量结果即可确定本时刻的最优状态向量，减少了预测过程中的运算时间，提高了预测速度。

作为一个具体的实现方式，获取在第二时刻预测的所述目标对象在所述第一时刻的预测状态向量，包括：

根据公式x(t

其中，x(t

其中，所述系统在t

其中，

其中，η＝x,y，分别表示x，y坐标轴；th

作为另一个可选的实现方式，根据各个所述测量位置、所述预测状态向量和所述增益，预测所述目标对象在所述第一时刻的最优状态向量，包括：

根据公式

其中，x(t

这里，需要说明的是，在本可选实现方式中，非线性卡尔曼滤波器具体可以为EKF；则非线性卡尔曼滤波器的增益具体为：

其中，K

其中，h

其中，P

其中，h

h

也就是说，在非线性卡尔曼滤波算法为EKF算法时，基于获取到的各个读写器确定的目标对象在第一时刻的测量位置确定目标对象在第一时刻的最优状态向量的过程如下：

(1)，获取各个所述测量位置z

(2)，基于公式x(t

其中，

(3)基于如下公式，获取非线性卡尔曼滤波器的增益：

P(t

其中，Q(t

(4)根据公式

作为另一个可选的实现方式，根据各个所述测量位置、所述预测状态向量和所述增益，预测所述目标对象在所述第一时刻的最优状态向量，包括：

根据公式

其中，x(t

这里，需要说明的是，本可选实现方式具体适用于非线性卡尔曼滤波算法为EKF算法的自适应目标动力学模型；

下面，对在非线性卡尔曼滤波算法为EKF算法时，基于获取到的各个读写器确定的目标对象在第一时刻的测量位置确定目标对象在第一时刻的最优状态向量的过程进行说明：

(1)，获取各个所述测量位置z

(2)，基于公式x(t

其中，

(3)计算所述目标对象在所述第一时刻的预测位置

(a)根据如下公式，获取sigma点：

其中，W

(b)根据公式

(c)根据公式

(d)通过计量模型

(e)根据公式

(4)根据如下公式，确定非线性卡尔曼滤波器的增益：

其中，K

(5)根据公式

这里，还需要说明的是，在所述第一时刻为第一个时刻的情况下，在确定目标对象在所述第一时刻的最优状态向量的过程中，可以利用预先设定的初始状态向量/参数作为前述第二时刻的相关状态向量/参数。

进一步地，作为一个可选的实现方式，获取所述目标对象在所述第一时刻的最优状态向量之后，所述方法还包括：

根据所述目标对象在所述第一时刻的最优状态向量中的加速度估计值，更新所述自适应目标动力学模型中的机动频率和/或高斯白噪声方差。

本可选实现方式中，通过更新自适应目标动力学模型中的激动频率和/或高斯白噪声方差，实现了自适应目标动力学模型的自适应改变，从而进一步提高了自适应目标动力学模型的预测的准确性。

作为一个具体的实现方式，根据所述目标对象在所述第一时刻的最优状态向量中的加速度估计值，更新所述自适应目标动力学模型中的机动频率和/或高斯白噪声方差，包括：

根据如下公式，确定更新后的所述机动频率和高斯白噪声方差：

其中，

这里，需要说明的是，公式

这里，还需要说明的是，由于

其中，l(0)与l(1)表示估计加速度的自相关函数，如下式所示：

则可以得到β和

因此，可以根据公式

另外，参数更新的过程还可以按照如下方式进行更新：

假设

当i≤K

当K

当i＞K

这里，还需要说明的是，车间数据信号具有规模海量、多源异构、多时空尺度、多维度等大数据特征，为了数据融合方法与数字孪生系统更好的结合，现提出了基于数据融合的数字孪生系统数据传输流。其中软传感数据包括了零件性能参数数据、机构行程规划、工作过程模拟数据等传感器无法直接测量得到的数据；传感器实际物理数据包括了物理属性数据、历史存储数据等可以由传感器直接获取的数据。本申请实施例所研究的路径跟踪方法同样适用于该数据传输流。

下面，结合附图对应用本申请实施例的路径跟踪方法的实验验证与分析进行说明：

首先运用RFID测量系统的基于RSSI原理的基础上改进开发了车间RFID路径跟踪系统仿真数据平台，能够模拟放置若干个RFID读写器，并可以记录携带有RFID标签的物料运送轨迹的各测量点位距离读数，且运送轨迹可以自行设置并记录可供对照的真实值，如图3、图4和图5所示。

在仿真数据生成之后，通过前述的EKF、UKF算法估计物料实际位置，同时利用车间自适应目标动力学模型估计物料运动过程，我们便可以得到基于EKF/UKF的车间RFID数据融合路径跟踪算法。

其中基于EKF的路径跟踪算法包括了状态预测、状态融合估计(多RFID数据融合)、参数更新等部分；而基于UKF的路径跟踪算法包括了sigma点获取、预测均值、预测方差、协方差改进、交叉协方差矩阵、更新、参数更新等部分，其中更新部分使用了多RFID数据融合的方法，与基本的UKF方法不同。最终得到的路径跟踪实验效果如图6、图7和图8所示。

从实验结果图6至图8中可以得知，EKF算法在某些RFID读写器分布较少的区域的估计误差会提升到很大，但在大多数情况下拥有良好的估计效果；而UKF算法在整体轨迹跟踪过程中都拥有稳定的估计效果，但在部分RFID读写器数量充足的区域估计效果差于EKF算法，其中图9展示了本次仿真实验RFID读写器分布区域特点。

然后，进行了多次重复实验来对得到的实验结果进行验证。通过更改RFID读写器的数量及摆放位置，并且模拟了各种物料运输轨迹，且与高斯-厄密特卡尔曼滤波(GHKF)算法以及传统方法粒子滤波法进行了对比实验。部分选取的RFID摆放位置和物料轨迹路径如图10所示。

经过多次重复实验，EKF方法的横轴平均误差为4.7947，平均估计协方差为46.0732，纵轴平均误差为2.5930，平均估计协方差为28.9697；UKF方法的横轴平均误差为3.8297，平均估计协方差为37.5835，纵轴平均误差为2.3428，估计协方差为26.1844。将实验结果与GHKF算法以及传统方法粒子滤波法进行比较，结果如下表1所示。该结果表明基于EKF、UKF的车间RFID数据融合路径跟踪算法能够有效的提升车间RFID跟踪定位精度。

表1

除此之外，EKF方法具有更少的估计运算时间，UKF方法在整体的估计性能上具有更强的优势，能够很好地适应RFID数量以及摆放情况的各类更改。且在RFID读写器数量充足的情况下，两种估计方法的精确程度相差不大，原因是携带有RFID标签的物料被多个读写器同时读取数据后，多组数据经历了数据融合算法处理之后，算法估计性能有着很大的提升。

本申请实施例的路径跟踪方法，具体涉及以非线性卡尔曼滤波法为代表的数据融合算法模型及车间应用方法，采用了基于EKF和/或UKF的车间RFID数据融合路径跟踪算法，用以提升智能车间物料运输轨迹跟踪的准确度。仿真结果表明，本申请实施例所提出的算法能够有效地降低RFID定位误差，其中基于UKF的方法可以提供更好的整体估计性能，但基于EKF的方法拥有更少的运算时间。同时，本文的研究也给车间其他传感器测量性能的提升起到了参考作用，通过数据融合等方法以满足智能化车间对于高精密传感器的需求。

简言之，本申请实施例首先根据车间目标运动特性和不规则采样间隔下的系统模型，建立含有自适应参数(目标机动频率α以及噪声方差

需要说明的是，本申请实施例提供的路径跟踪方法，执行主体可以为路径跟踪装置，或者该路径跟踪装置中的用于执行加载路径跟踪方法的控制模块。本申请实施例中以路径跟踪装置执行加载路径跟踪方法为例，说明本申请实施例提供的路径跟踪方法。

如图11所示，本申请实施例还提供一种路径跟踪装置，包括：

获取模块1101，用于获取各个读写器确定的目标对象在第一时刻的测量位置；

预测模块1102，用于将各个所述测量位置输入至当前已更新的基于非线性卡尔曼滤波算法的自适应目标动力学模型，获取所述目标对象在所述第一时刻的最优状态向量；其中，所述自适应目标动力学模型用于根据各个所述测量位置，预测所述目标对象在所述第一时刻的最优状态向量；

确定模块1103，用于根据不同时刻的最优状态向量，确定所述目标对象的路径。

本申请实施例的路径跟踪装置，首先，获取模块1101获取各个读写器确定的目标对象在第一时刻的测量位置；其次，预测模块1102将各个所述测量位置输入至当前已更新的基于非线性卡尔曼滤波算法的自适应目标动力学模型，获取所述目标对象在所述第一时刻的最优状态向量；其中，所述自适应目标动力学模型用于根据各个所述测量位置，预测所述目标对象在所述第一时刻的最优状态向量；如此，提高了对目标对象的定位精度，最后，确定模块1103根据不同时刻的最优状态向量，确定所述目标对象的路径。这样，在对目标对象的定位精度提高的基础上，能够进一步提高对目标对象的路径的跟踪精度，为管理人员的决策提供可靠的依据。

可选地，所述预测模块1102包括：

第一获取子模块，用于获取在第二时刻预测的所述目标对象在所述第一时刻的预测状态向量；其中，所述第二时刻为所述第一时刻的前一时刻；

第二获取子模块，用于获取非线性卡尔曼滤波器的增益；

预测子模块，用于根据各个所述测量位置、所述预测状态向量和所述增益，预测所述目标对象在所述第一时刻的最优状态向量。

可选地，所述预测子模块具体用于：

根据公式x(t

其中，x(t

可选地，所述系统状态转移矩阵为：

其中，

其中，η＝x,y，分别表示x，y坐标轴；th

可选地，所述预测子模块具体用于：

根据公式

其中，x(t

可选地，所述预测子模块具体用于：

根据公式

其中，x(t

可选地，所述装置还包括：

更新模块，用于根据所述目标对象在所述第一时刻的最优状态向量中的加速度估计值，更新所述自适应目标动力学模型中的机动频率和/或高斯白噪声方差。

可选地，所述更新模块具体用于：

根据如下公式，确定更新后的所述机动频率和高斯白噪声方差：

其中，

本申请实施例还提供一种路径跟踪系统，包括：处理器，存储器及存储在所述存储器上并可在所述处理器上运行的程序，所述程序被所述处理器执行时实现如上所述的路径跟踪方法实施例的各个过程，且能达到相同的技术效果，为了避免重复，这里不再赘述。

本申请实施例还提供一种可读存储介质，可读存储介质上存储有程序，该程序被处理器执行时实现如上所述的路径跟踪方法实施例的各个过程，且能达到相同的技术效果，为避免重复，这里不再赘述。其中，该可读存储介质，如只读存储器(Read-Only Memory，简称ROM)、随机存取存储器(Random Access Memory，简称RAM)、磁碟或者光盘等。

最后，还需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者终端设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。

以上所述是本申请的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本申请所述原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本申请的保护范围。