基于MLS的三维扩展目标PMBM跟踪算法.pdf

第 卷第 期 年 月系统工程与电子技术 文章编号：（）网址：收稿日期：；修回日期：；网络优先出版日期：。网络优先出版地址：基金项目：国家自然科学基金（）资助课题通讯作者引用格式：衡博文，李翠芸，李想基于的三维扩展目标跟踪算法系统工程与电子技术，（）：犚犲 犳 犲 狉 犲 狀 犮 犲犳 狅 狉犿犪 狋：，（）：基于犕犔犛的三维扩展目标犘犕犅犕跟踪算法衡博文，李翠芸，李想（西安电子科技大学电子工程学院，陕西 西安 ）摘要：针对传统三维扩展目标跟踪算法形状估计精度低的问题，提出了一种基于移动最小二乘的泊松多伯努利混合（，）滤波跟踪算法。该算法基于模型构建三维扩展目标的形状矩阵，通过滤波器预测和更新目标的运动状态，利用移动最小二乘算法更新形状矩阵，结合目标质心状态与形状估计完成对三维扩展目标的跟踪。仿真实验与实际点云数据的验证表明，与现有算法相比，本文所提算法在多扩展目标的形状估计方面具有更优的性能，具有较高的泛用性。关键词：多扩展目标跟踪；移动最小二乘；形状矩阵；泊松多伯努利混合中图分类号：文献标志码：犇犗犐：犇犲 狓 狋 犲 狀 犱 犲 犱狋 犪 狉 犵 犲 狋犘犕犅犕狋 狉 犪 犮 犽 犻 狀 犵犪 犾 犵 狅 狉 犻 狋 犺犿犫 犪 狊 犲 犱狅 狀犿狅 狏 犻 狀 犵犾 犲 犪 狊 狋狊 狇 狌 犪 狉 犲，（犛 犮 犺 狅 狅 犾狅 犳犈 犾 犲 犮 狋 狉 狅 狀 犻 犮犈狀犵 犻 狀 犲 犲 狉 犻 狀犵，犡犻 犱 犻 犪 狀犝狀 犻 狏 犲 狉 狊 犻 狋 狔，犡犻犪 狀 ，犆犺 犻 狀 犪）犃犫 狊 狋 狉 犪 犮 狋：，（），犓犲 狔狑狅 狉 犱 狊：；（）；（）引言目标跟踪是根据传感器获得的数据，对一定观测区域内运动目标的状态进行估计的过程。扩展目标跟踪除了跟踪目标运动状态外，还要估计目标的形状。基于随机有限集理论的目标跟踪方法避免了复杂的关联计算，关联精度也更高。其中，泊松多伯努利混合（，）滤波器使用泊松点过程表示未检测到的目标，即使在目标存在漏检、新生或消亡的情况下，依然能够准确估计多目标的状态，因此一经提出就成为了研究热点。现有的扩展目标形状估计方法大多是针对二维目标的。其中，较为典型的是随机矩阵（，）和随机超曲面模型（，），而样条和高斯过程也常用于扩展目标跟踪。文献 将和伯努利滤波算法相结合，实现了对椭圆扩展目标的跟踪。除此之外，等人针对非椭圆目标提出了多椭圆法 。随后，文献 针对多椭圆法做出了改进，不需要预先设定子椭圆数量且子对象数量可变。在三维目标的形状估计方面，文献 将 等人提出的伽马高斯逆威舍特（，）滤波器 扩展到三维空间，但只能将目标建模为椭球，不能对目标形状进行精细刻 系统工程与电子技术第 卷画。文献 通过径向函数和高斯过程来估计目标三维形状，但三维点云数据的计算负载较高。文献 将稀疏点云测量与高斯过程结合来估计三维目标表面，但计算量大、估计精度不高。利用样条对三维目标的形状进行估计时，需要对样条曲线进行拟合，再由拟合后的样条曲线组成样条曲面。这种方法估计出的目标三维形状平滑，但每次估计形状时都需要进行曲线的拟合，计算量较大、算法运行时间长。针对以上问题，本文提出了一种基于移动最小二乘（，）模型的扩展目标 滤波跟踪算法。算法将融合后的量测集输入至滤波器，获得目标质心运动状态，通过模型处理量测数据，对形状矩阵中的控制点进行移动，结合目标质心状态与形状估计完成对三维扩展目标的跟踪。仿真实验与实际点云数据的验证表明，本文所提算法在三维目标形状估计方面具有更高的精度，在实际场景中能够实现对不规则形状扩展目标的有效跟踪，泛用性更广。扩展目标跟踪模型文献 中的算法 通过调整控制点，可将简单形状变形为复杂目标的形状，并且简单形状可以预先设定，控制点则根据量测数据进行计算。该理论可在三维空间中对扩展目标的形状进行估计。犕犔犛算法算法引入了紧支撑权函数，保证了在目标跟踪中单个量测的影响区域有限。紧支（，）即函数值狔只受狓附近邻域内数据点的影响，域内定义狓的权值函数为（狓）。在拟合区域上，待拟合函数可表示为犳（狓）（狓）狆（狓）（）式中：（狓）（狓），（狓），犿（狓）是系数向量；狆（狓）狆（狓），狆（狓），狆犿（狓）是基函数；犿是基函数的项数，基函数有线性基、二次基和立方基。由拟合函数和狔利用加权最小二乘算法得到犑狀犻犻（狓）犳（狓）狔犻（）式中：狀是狓邻域内的数据点数量；犻（狓）是节点狓的权函数。在节点狓的邻域内，犻（狓）；在邻域外，犻（狓）。将式（）转为矩阵形式，并对（狓）求偏导得犑（犘狔）犠（犘狔）（）犑犃（狓）（狓）犅（狓）狔（）其中狔狔，狔，狔犿，（狓）犃（狓）犅（狓）狔（）犃犇犠（狓）犇（）犅犇犠（狓）（）其中犇狆（狓）狆（狓）狆犿（狓）狆（狓）狆（狓）狆犿（狓）狆（狓狀）狆（狓狀）狆犿（狓狀熿燀燄燅）（）犠（狓）（狓狓）（狓狓）（狓狓狀熿燀燄燅）（）将式（）代入式（）可得拟合函数为犳（狓）狀犻犻（狓）狔犻（）其中（狓）（狓），（狓），犿（狓）狆（狓）犃（狓）犅（狓）（）基于最小二乘算法的图像变形，最早于 年由 等提出。当利用算法处理要变形的图像时，可以将变形后的图像中的点视为变形前图像中的点的映射，这种映射变换设为函数犳。为了便于描述，在此设狆为变形前图像点集，狇为点集狆经过犳变换后的变形后点集。利用算法构造的变换犳可满足性质。设点狏为变换前点集狆中的一个点，为了求得最佳变形函数犾狏（狓），需得满足式（）取最小值：犻狑犻狘犾狏（狆犻）狇犻狘，狑犻狘狆犻狏狘（）式中：狆和狇分别是变形前和变形后的控制点集；狑犻为权重值；狆犻指点集狆中的第犻个控制点；每个控制点都有对应的权值函数和变形函数犾狏。上文提到的变换犳是对变形函数犾狏的抽象表达，即犳（狓）犾狏（狓）。形状矩阵模型在多目标跟踪中，三维扩展目标的形状可以看作是由简单形状变形而来，变形前的形状称为初始形状，通常选取球体作为初始形状。如图所示，在给定初始形状的曲面上设立控制点，控制点组成的矩阵即形状矩阵犆。形状矩阵随时间进行估计和更新，当前时刻更新后的形状矩阵在下一时刻将再次进行估计。图初始化形状与控制点 第 期衡博文等：基于的三维扩展目标跟踪算法 形状矩阵中的每一个元素代表扩展形状上的一个控制点，在三维空间中，可以用一组三维坐标表示控制点的空间位置。首先对扩展形状进行空间上的划分，在狕轴方向上划分犪个区域，对于每个区域，在水平方向上沿顺时针方向再划分犫个子空间。在每个子空间中设置一个控制点，通过划分到该子空间范围内的量测对控制点进行更新。参数犪和犫决定了子空间的数量，子空间越多，对应的控制点就越多，需要的量测也越多。选择合适的参数对于形状矩阵的精确性十分重要，犪和犫过小会导致控制点过少，从而无法准确描述目标外形；过大则会导致子空间过小，如果小于传感器的距离分辨力，就无法获得有效量测。设犱为传感器的距离分辨力，则子空间参数应满足以下条件，即狉犪犱狉犫烅烄烆犱（）式中：狉为初始形状的半径。基于犕犔犛模型的犘犕犅犕滤波算法在多扩展目标的跟踪中，主要是对部分状态进行估计，分别是扩展目标的量测率、运动学状态和扩展形状。通过个分布分别表示上述状态，并建模为狓（狓?，狓?，狓）犚犚狀犛犿（）式中：狓?犚、狓?犚狀和狓犛犿分别表示目标产生量测的泊松率、目标的运动状态和目标的扩展状态，其中扩展状态由模型进行建模；犚、犚狀和犛犿分别为正实数空间、狀维实数空间和犿维状态空间，且犿犪犫。所以，目标在时刻犽的状态是上面个状态的乘积，即狆犽（狓）狆犽（狓?，犽）狆（狓?，犽狓，犽）狆（狓，犽）?（狓?，犽；犽，犽）?（狓?，犽；犿犽，犘犽犽犐）犕（狓，犽；犘犽）?（狓?，犽；犽，犽）?（狓犆，犽；犿犽，犘犽犽犐）犕（狓，犽；犕犽，犽）（）式中：狆（狓）表示状态狓服从的分布；?（狓?，犽；犽，犽）表示伽马分布的概率密度函数，形状参数，逆尺度参数；?（狓?，犽；犿犽，犘犽犽犐）表示高斯分布的概率密度函数，犿犽和犘犽分别表示目标质心的均值和协方差，犐 ，犽犿犿犻（犻）犽；犕（狓，犽；犘犽）表示模型，它服从高斯分布，其均值矩阵与协方差矩阵分别为犕犽（狇犽）（狇犽）（狇犽犫）（狇犽）（狇犽）（狇犽犫）（狇犽犪）（狇犽犪）（狇犽犪 犫）熿燀燄燅（）犽犽 犽 犽犫犽 犽 犽犫 犽犪犽犪犽犪熿燀燄燅犫（）式中：狇犽表示控制矩阵中控制点变换前后的偏移量均值；犽是控制点偏移方差。将上文提出的模型与滤波器相结合，给出滤波过程：步骤状态初始化并获得量测集首先，根据滤波器中的模型对目标进行初始化，目标量测率与运动学状态均与滤波器相同。根据形状矩阵模型建立形状矩阵犆。犆中的控制点在变换的过程中，只受邻域内量测数据的影响。实验中选取的是均匀控制点，将目标沿狕轴方向的长度与水平方向的旋转角按照犪和犫进行等分，每个区域的中心即为设立的控制点。需要注意的是，控制点之间的距离理论上要不小于每个控制点的邻域半径，否则可能会出现控制点错位的现象。在模型中，一个量测点可能处于多个节点的邻域内，这就意味着这个量测数据可以用来求解多个控制点变换后的位置。步骤预测进行预测时，目标的强度由伽马高斯（，）联合分布来表示。其中伽马分布用来表示量测率，高斯分布表示目标的运动学状态，分布实际服从高斯分布，这里指基于模型的三维目标的扩展形状。目标状态可参数化表示为，犿，犘，犕，目标的强度为犇狌犽 狘犽（）犖犫犽狀犫，狀犽?（；犫，狀犽）犖狊犽 狘犽狀狊，狀犽 狘犽?（；狊，狀犽 狘犽）犖犫犽狀犫，狀犽?（狓?，犽；犫，狀犽，犫，狀犽）?（狓?，犽；犿犫，狀犽，犘犫，狀犽）?（狓，犽；犿犫，狀犽，犫，狀犽）犖狊犽 狘犽狀狊，狀犽 狘犽?（狓?，犽；狊，狀犽 狘犽，狊，狀犽 狘犽）?（狓?，犽；犿狊，狀犽 狘犽，犘狊，狀犽 狘犽）?（狓，犽；犿狊，狀犽 狘犽，狊，狀犽 狘犽）（）式中：犫，狀犽?（；犫，狀犽）、狊，狀犽 犽?（；狊，狀犽 犽）分别为新生和存活目标的强度函数。此时，伯努利项的存在概率和密度函数也由分布来表示：狉犼，犻犽 犽狆狊狉犼，犻犽（）犳犼，犻犽 犽?（；犼，犻犽 犽）（）式中：犼表示第犼个多伯努利（，）项；犻表示该项中第犻个伯努利项。目标量测率和运动学状态的预测见文献 ，这里只对目标的扩展形状的预测进行说明，预测步骤如下：犕犉狊犕（）犉狊（犉狊）犙狊（）其中，犉狊犽犐犿狀（）步骤更新没有关联到量测时的扩展状态由于没有量测进行更新，所以维持原状：犕犽犽犕犽犽，犽犽犽犽（）系统工程与电子技术第 卷当目标关联到量测时，设量测集为犠狕（），狕（），狕（犠），则量测率的更新为犽犽犽犽犠，犽犽犽犽（）目标运动学状态更新为犿犽犽犿犽犽犓犽（狕犠犽犎犿犽犽）（）犘犽犽犘犽犽犓犽犎犘犽犽（）狕犠犽狘犠狘狕（犻）犠狕（犻）（）犓犽犘犽犽犎犛犽（）犛犽犎犘犽犽犎犠（）扩展状态的更新是将模型中变形后的点视为量测数据，即式中的犕，利用犕对预测的扩展状态进行更新。假设在犽时刻，第犻个控制点关联到的量测集合可以表示为犣犻狕犻，犼犿犻犼，则更新过程可参数化表示为狆犻犽犽狆犻犽犽犓犻犽（狕犻犽犎犾狆犻犽犽）（）犘犻犽犽犘犻犽犽犓犻犽犎犾犘犻犽犽（）狕犼犽犿犻狕犻，犼犣犻狕犻，犼（）犓犻犽犘犻犽犽（犎犾）（犛犻犽）（）犛犻犽犎犾犘犻犽犽（犎犾）犿犻（）式中：犎犾的含义见文献 。最后，根据更新后的状态并结合中的曲面拟合函数，得到三维空间中目标的扩展形状。仿真实验与分析为了验证所提算法在目标三维形状估计方面的有效性，本节设计实验对比了 和 滤波算法在三维形状估计方面的性能。此外，利用 公开数据集的点云数据生成模拟量测，验证了 在街道场景中的实际跟踪效果。实验中的量测均为表面量测，共设置了两组实验，实验对比多目标场景下，估计多种扩展目标形状时两种算法的有效性。实验模拟复杂情况下的真实场景，验证 的工程应用价值。蒙特卡罗次数为 ，本文采用的评价指标有两个，对于目标质心运动性能的评价，采用的是最优子模式分配距离（，）；对于目标形状的估计，采用的是交并比（，），即估计结果与真实值交集和并集的比值，该值越接近，表示估计结果越贴合实际。实验为了研究 和 同时对多个扩展目标的跟踪能力，设置如下实验场景。算法跟踪区域为 ，传感器的位置分别为 ，、，和 ，。目前，激光雷达输出的点云数据大多包含有方位角和三维笛卡尔坐标等空间位置信息，可以直接作为 的输入，因此传感器均假设为同型激光雷达；初始化的扩展目标形状是球体，球径为。其中目标是轴长分别为、和的椭球；目标是边长为的立方体；目标为十字架，长为，宽为，高为，目标的体积差异不影响本文算法的形状辨识性能。扩展目标的运动学模型为模型，其状态转移矩阵犉，量测矩阵犎，过程噪声协方差矩阵犙和量测噪声协方差矩阵犚为犉犐犜 犐犐，犎犐（）犙犜犐犜犐犜犐犜 犐熿燀燄燅，犚狏犐（）式中：犜为采样间隔；，狏。扩展目标以狆狊 的概率存活，以狆犇 的概率被检测到；扩展目标的量测率为，背景噪声和杂波的泊松率为。目标初始球径狉，实验设置狉，根据式（）得犪，犫，实验取犪，犫。的参数设为犮，狆。图是全局坐标系下所有传感器的量测，图中个目标的运动轨迹并没有在运动过程中相交。图是个目标的运动轨迹。表说明了目标的初始化状态与存活时间。图图是两种算法跟踪椭球目标、立方体目标和十字架目标的局部放大图。图跟踪多个目标时传感器接收到的量测 图个目标的运动轨迹 第 期衡博文等：基于的三维扩展目标跟踪算法 表目标的初始化参数犜 犪 犫 犾 犲犐 狀 犻 狋 犻 犪 犾 犻 狕 犪 狋 犻 狅 狀狆 犪 狉 犪犿犲 狋 犲 狉 狊犳 狅 狉狋 犺 犲狋 犪 狉 犵 犲 狋 狊目标目标初始运动状态存活时间狓 ，狋，狓 ，狋，狓 ，狋，图 估计椭球目标形状效果图 图 跟踪立方体目标时的局部放大图 图 跟踪十字架目标时的局部放大图 图 估计椭球目标形状效果图 图 跟踪立方体目标时的运动轨迹图 图 跟踪十字架目标时的运动轨迹图 可以看出，即使同时跟踪多个目标，依然可以准确地估计出各个目标的三维形状，且所估计的形状贴合真实形状。直接将目标形状建模为椭球，不能对复杂形状的三维目标进行形状估计。算法可以实现不同目标的三维形状估计，不受目标尺寸变化的影响。因此，算法在精度与泛用性上来说，更胜一筹。此外，依靠算法的紧支这一性质，可以对同一个量测数据进行多次利用，即一个量测可以更新多个控制点。表为 和 算法跟踪个目标时，在形状估计稳定后的 系统工程与电子技术第 卷平均 值。表为种算法的单步耗时对比，表中数据均是程序运行 次的平均值。图 是 的目标数估计，图 是两种算法的。表犕犔犛 犘犕犅犕和犌犌 犐犠 犘犕犅犕算法估计目标的平均犐 狅犝对比犜 犪 犫 犾 犲犆狅犿狆 犪 狉 犻 狊 狅 狀狅 犳犪 狏 犲 狉 犪 犵 犲犐 狅犝犲 狊 狋 犻 犿犪 狋 犲 犱犫 狔犕犔犛 犘犕犅犕犪 狀 犱犌犌 犐犠 犘犕犅犕犪 犾 犵 狅 狉 犻 狋 犺犿狊目标类型算法 椭球 立方体 十字架 表算法单步耗时对比犜 犪 犫 犾 犲犆狅犿狆 犪 狉 犻 狊 狅 狀狅 犳狋 犺 犲狋 犻 犿犲狋 犪 犽 犲 狀犫 狔狊 犻 狀 犵 犾 犲狊 狋 犲 狆犪 狉 犻 狋 犺犿犲 狋 犻 犮算法估计椭球目标形状时算法的单步耗时估计立方体目标形状时算法的单步耗时估计十字架目标形状时算法的单步耗时 图 实验目标数估计 图 两种算法的对比 从表中可知，所提的 算法对个目标的形状估计都可以达到较高的精度，稳定后的 值均超过了；而 算法在跟踪立方体和十字架等不规则形状时，仍然将目标形状建模为椭圆，导致 较低，不能实现对目标扩展形状的有效跟踪。从图 和图 可以看出，所提算法对目标数量与质心均有较好的估计效果。图 在目标死亡时会出现目标数错估的现象。这是因为算法通过全局假设的概率来判定该假设是否被采用。在目标死亡时，包含目标死亡这一状态的全局假设概率小，未被采用；在下个时刻，该全局假设随着状态的更新而概率变大，最终被采用，所以出现了 时刻目标数量不变的现象。表中的数据表明，同一算法估计不同的三维目标时，单步耗时相差不大。算法的单步耗时低，但是结合实验结果可知，难以估计复杂三维目标的形状细节。综合来看，算法能准确估计复杂目标的三维形状，适用性广。实验为了研究 算法在实际场景中对不规则外形扩展目标的跟踪性能，设计如下实验场景。，为算法的跟踪区域，个传感器的位置分别为 ，、，和 ，。为模拟真实目标外形，借助悉尼大学 激光雷达数据集中的汽车点云分布获得目标尺寸并进行建模。在跟踪过程中，通过对原始点云数据进行扩充和平移等操作生成目标的量测数据。数据集通过使用激光雷达扫描悉尼街道景观获得，提供的点云数据中包含扫描点的强度、方位角及三维笛卡尔坐标等信息，其使用的 测量距离可达 ，测距精度为，水平视场分辨率为 ，垂直视场分辨率为 ，较高的探测精度保证了原始点云数据的可靠性。在本实验中，选取的原始点云数据可视化结果如图 所示。滤波器的有关参数均与实验相同。目标与目标均为依据点云数据生成的汽车目标，长度为，宽度为，高度为。图 原始点云可视化结果图 表说明了两目标各阶段的运动状态，模拟目标加速追上目标，并排行驶一段时间后，再超过目标的场景。图 为跟踪过程中单个汽车目标的局部放大图，图 为产生交叉时目标的局部放大图。图 为跟踪过程中算法的目标数估计，图 为算法的。第 期衡博文等：基于的三维扩展目标跟踪算法 表目标各阶段运动状态犜 犪 犫 犾 犲犕狅 狋 犻 狅 狀狊 狋 犪 狋 犲狅 犳犲 犪 犮 犺狊 狋 犪 犵 犲狅 犳狋 犺 犲狋 犪 狉 犵 犲 狋目标目标运动状态时间狓，狋，狓，狋，狓，狋，狓 ，狋，图 跟踪汽车目标时的局部放大图 图 目标交叉时跟踪结果局部放大图 从图 和图 可以看出，对于外形不规则的扩展目标，也能够实现对其三维扩展形状的有效描述。但在目标距离较近时，两目标的点云将有一定程度的交叉。由于点云数据未对目标作出区分，经过量测聚类生成的量测簇只有一个，只能分配给一个目标，从而导致目标的外形估计出现偏差。图 实验目标数估计 图 跟踪汽车模型时算法的 从图 可以看出，在目标交叉后的第一个时刻，目标数仍然保持了正确的估计。这是因为 从权重最大的全局假设中提取目标状态，由于交叉时间较短，此时两目标仍然具有较大的存在概率，目标数为的全局假设权重较大。随着交叉时间的增加，其中一个目标的存在概率下降至阈值以下，包含目标死亡的全局假设权重变大，导致 产生了漏检。从图 可以看出，所提算法对不规则外形扩展目标的质心有着良好的估计效果。上述实验表明，能够实现对多个实际目标的质心和形状跟踪，验证了所提算法的泛用性。结束语本文针对三维空间下的多扩展目标形状估计问题，提出了在多传感器的情况下，基于模型的多目标滤波器。算法将融合后的量测数据输入至滤波器，对目标的质心运动状态进行迭代更新，通过模型并结合量测数据计算形状矩阵中移动后的控制点，最后将目标质心状态与形状矩阵结合得到三维目标的扩展状态。仿真实验和实际点云数据的验证表明，与 相比，所提算法在不规则形状扩展目标的形状估计方面具有更高的精度，能够有效应用于实际场景中。在实际场景中，激光雷达扫描得到的点云数据来自于各类目标，为了保证跟踪精度，需要对原始点云进行分割分类等预处理，从而实现不同目标量测数据的区分。当目标之间出现邻近、遮挡等特殊情况时，将会使来自不同目标的点云数据相互交叉，导致 算法对目标数量和扩展形状的估计产生错误。针对上述问题，本文的下一步工作，是对 的聚类算法进行改进，充分利用点云数据中的扫描点强度等信息，实现更加精准的点云分割分类，提高算法在复杂场景中的适用性。参考文献 ：，：系统工程与电子技术第 卷 ，（）：?，?，：，（）：，（）：，：，（）：?，：陈辉，杜金瑞，韩崇昭基于星凸形随机超曲面模型多扩展目标多伯努利滤波器自动化学报，（）：，（）：张永权，张海涛，姬红兵基于椭圆的扩展目标伯努利滤波算法系统工程与电子技术，（）：，（）：，（）：?，：，：，：，：范泽昊基于泊松多伯努利混合滤波器的三维多扩展目标跟踪算法研究西安：西安电子科技大学，：，：?，：，：，：，（）：，（）：，：，（），：作者简介衡博文（），男，硕士研究生，主要研究方向为多目标跟踪、随机集滤波。李翠芸（），女，副教授，博士，主要研究方向为多目标跟踪、随机集滤波。李想（），男，硕士研究生，主要研究方向为多目标跟踪、随机集滤波。