一种运动蛙人的跟踪方法

本发明涉及一种运动蛙人的跟踪方法，所述方法包括：步骤1)接收t时刻蛙人状态的观测值；步骤2)建立t时刻蛙人多方向运动的运动模型集；步骤3)根据所述运动模型集计算t时刻每个运动模型的蛙人状态估计初值和协方差估计初值；步骤4)将t时刻每个运动模型的蛙人状态估计初值和协方差估计初值输入若干个滤波器，结合t时刻蛙人状态的观测值计算每个运动模型的蛙人状态估计及其协方差估计；步骤5)根据的t时刻每个运动模型的蛙人状态估计及其协方差估计更新t时刻每个运动模型的概率；步骤6)根据更新后的每个运动模型的概率对蛙人状态进行融合估计，得到t时刻蛙人状态的估计及其协方差的估计。本发明的方法具有精度高，稳定性强的特点。