基于激光雷达点云数据的目标跟踪算法
source link: https://mp.weixin.qq.com/s/-sJURbreWSbrPJ8UcybaxA
Go to the source link to view the article. You can view the picture content, updated content and better typesetting reading experience. If the link is broken, please click the button below to view the snapshot at that time.
基于激光雷达点云数据的目标跟踪算法
The following article is from CV研习社 Author 爱做菜的炼丹师
点击上方“3D视觉工坊”,选择“星标”
干货第一时间送达
文章导读
本文介绍激光点云的目标跟踪算法,跟踪算法主要分为生成式和判别式两类,传统的滤波跟踪大多属于生成式,而近几年深度学习做跟踪基本归为判别式跟踪方法。本文从传统的卡尔曼滤波原理说起,然后分析工程中点云目标跟踪可能遇到的问题。1
有哪些目标跟踪算法?
目标跟踪就是在连续的数据序列中,建立所需要跟踪目标的位置关系,得到目标完整的运动轨迹。通常是给定上一帧的目标位置特征,在下一帧中对该目标的位置以及边界框的尺寸大小进行预测。目标跟踪的常用算法有很多,从传统的滤波算法到深度学习的网络预测,可以分为两大类:- 生成式模型:建立目标模型或者提取目标特征,利用外观表征在后续帧中进行相似性搜索,最小化跟踪目标和候选目标之间的误差进行定位。
- 判别式模型:通过对比目标模型和背景信息的差异,将目标模型提取出来,从而得到当前帧中的目标位置。
2
卡尔曼滤波
卡尔曼滤波根据系统状态方程,通过系统输出作为观测方程来修正估计值,实现系统状态的最优估计。其中涉及两个方程:状态方程和观测方程状态方程是根据上一时刻的状态和控制变量以及过程噪声来估计当前时刻的状态,如下式:qk是满足高斯分布的过程噪声,期望是0,方差是Qk。观测方程是由当前时刻的估计值和测量噪声得到当前时刻的观测值。如下式:rk是满足高斯分布的测量噪声,期望是0,方差是Rk。卡尔曼滤波可以分为两个部分:预测阶段根据上一时刻的后验估计值来估计当前时刻的状态,得到当前时刻的先验估计值;校正阶段使用当前时刻的测量值来更新预测阶段估计值,得到当前时刻的后验估计值。其中先验估计是根据系统过程原理或者经验得到的估计值,实际应用中可以通过传感器数据去预测下一时刻的数据。后验估计是结合之前的先验状态估计值,再加权测量值得到一个理论上最接近真实值的结果。卡尔曼滤波仅适用于线性系统,并且系统的过程噪声和测量噪声均为高斯白噪声。然后现实场景中一般系统状态变量的差分方程都是非线性的。3
扩展卡尔曼滤波
扩展卡尔曼滤波可以将非线性系统在其参考点上做泰勒级数展开,取其一阶线性部分作为该非线性模型的逼近,从而得到非线性系统在当前时刻的线性化描述。所以它的状态方程和观测方程如下:状态方程:观测方程:当我们将非线性系统线性化后,扩展卡尔曼滤波后面的原理和推导流程就和卡尔曼滤波一样了。扩展卡尔曼滤波利用线性化来近似非线性函数,但是如果在近似点非线性程度越高、概率分布本身越不确定,得到的近似结果就会越差,通俗点说就是泰勒展开式中被忽略的高阶项带来的误差有可能是滤波发散。4
无迹卡尔曼滤波
无迹卡尔曼滤波通过无损变换来近似一个高斯分布,通过使用加权统计线性回归过程来实现随机线性化。它通过含有均值和协方差的确定的Sigma点来近似概率分布,通过系统的非线性模型生成更多的Sigma 点,经过选择合适的权值估计均值和协方差,避免了求解雅克比矩阵。相比EKF,它没有丢弃高阶项所有具有更高的估计精度,满足了具有各种特殊要求的非线性滤波和控制方面的应用。所以无迹卡尔曼滤波是对非线性系统的概率密度分布进行逼近,而不是对非线性系统函数进行逼近。但是无迹卡尔曼滤波采用抽样近似的方法,计算量较大;相比于扩展卡尔曼滤波,只有在方差很大的情况下效果才明显。5
点云的滤波跟踪
由于运动的场景比较复杂并且障碍物形状经常发生变化,如何跟踪一个不断变化的目标是跟踪任务的一大挑战。基于点云的目标跟踪存在的难点如下:物体遮挡:不管是图像数据还是点云数据都会存在物体被遮挡的问题,如下图所示,右下方的车辆被遮挡后导致点云数据被截断,进而特征分布发生了变化。检测输出的外接框形状会出现变化导致跟踪拿不到稳定的观测值。物体形变:由于激光点云近密远疏的采样特性,同一个物体在不同的位置反射回来的点云特征会出现很大的变化,而物体表征模型的变化会造成检测和跟踪难以适应,如下图所示:一辆车从后方开到前方时,外观表征的不同。背景干扰:如果运动目标比较靠近场景中的静态障碍物,采用传统聚类算法得到的检测目标很可能外观表征会被放大,出现如下图所示的问题,红路灯处路边的骑车人和灌木点集靠的太近被聚类在一起,当骑车人运动时又被分开,造成跟踪目标的表征出现变化。其实在实际应用中会出现很多特殊场景导致动态障碍物的点云分布产生变化,严重影响跟踪效果。追根溯源点云目标跟踪的好坏和两点有关:- 目标检测的稳定性;
- 选择稳定的观测值做数据关联;
重磅!3DCVer-学术论文写作投稿 交流群已成立
扫码添加小助手微信,可申请加入3D视觉工坊-学术论文写作与投稿 微信交流群,旨在交流顶会、顶刊、SCI、EI等写作与投稿事宜。同时也可申请加入我们的细分方向交流群,目前主要有3D视觉、CV&深度学习、SLAM、三维重建、点云后处理、自动驾驶、多传感器融合、CV入门、三维测量、VR/AR、3D人脸识别、医疗影像、缺陷检测、行人重识别、目标跟踪、视觉产品落地、视觉竞赛、车牌识别、硬件选型、学术交流、求职交流、ORB-SLAM系列源码交流、深度估计等微信群。
一定要备注:研究方向+学校/公司+昵称,例如:”3D视觉 + 上海交大 + 静静“。请按照格式备注,可快速被通过且邀请进群。原创投稿也请联系。
▲长按加微信群或投稿▲长按关注公众号
3D视觉从入门到精通知识星球:针对3D视觉领域的知识点汇总、入门进阶学习路线、最新paper分享、疑问解答四个方面进行深耕,更有各类大厂的算法工程人员进行技术指导。与此同时,星球将联合知名企业发布3D视觉相关算法开发岗位以及项目对接信息,打造成集技术与就业为一体的铁杆粉丝聚集区,近3000星球成员为创造更好的AI世界共同进步,知识星球入口:
学习3D视觉核心技术,扫描查看介绍,3天内无条件退款 圈里有高质量教程资料、可答疑解惑、助你高效解决问题觉得有用,麻烦给个赞和在看~
Recommend
About Joyk
Aggregate valuable and interesting links.
Joyk means Joy of geeK