Bahraini Masoud S, Rad Ahmad B, Bozorg Mohammad
Department of Mechanical Engineering, Sirjan University of Technology, Sirjan 78137-33385, Iran.
School of Mechatronic Systems Engineering, Simon Fraser University, Surrey, BC V3T 0A3, Canada.
Sensors (Basel). 2019 Aug 26;19(17):3699. doi: 10.3390/s19173699.
The important problem of Simultaneous Localization and Mapping (SLAM) in dynamic environments is less studied than the counterpart problem in static settings. In this paper, we present a solution for the feature-based SLAM problem in dynamic environments. We propose an algorithm that integrates SLAM with multi-target tracking (SLAMMTT) using a robust feature-tracking algorithm for dynamic environments. A novel implementation of RANdomSAmple Consensus (RANSAC) method referred to as multilevel-RANSAC (ML-RANSAC) within the Extended Kalman Filter (EKF) framework is applied for multi-target tracking (MTT). We also apply machine learning to detect features from the input data and to distinguish moving from stationary objects. The data stream from LIDAR and vision sensors are fused in real-time to detect objects and depth information. A practical experiment is designed to verify the performance of the algorithm in a dynamic environment. The unique feature of this algorithm is its ability to maintain tracking of features even when the observations are intermittent whereby many reported algorithms fail in such situations. Experimental validation indicates that the algorithm is able to perform consistent estimates in a fast and robust manner suggesting its feasibility for real-time applications.
与静态环境中的对应问题相比,动态环境下的同时定位与地图构建(SLAM)这一重要问题的研究较少。在本文中,我们提出了一种针对动态环境中基于特征的SLAM问题的解决方案。我们提出了一种算法,该算法使用一种适用于动态环境的鲁棒特征跟踪算法,将SLAM与多目标跟踪(SLAMMTT)相结合。在扩展卡尔曼滤波器(EKF)框架内,一种称为多级随机抽样一致性(ML-RANSAC)的随机抽样一致性(RANSAC)方法的新颖实现被应用于多目标跟踪(MTT)。我们还应用机器学习从输入数据中检测特征,并区分移动对象和静止对象。来自激光雷达和视觉传感器的数据流被实时融合,以检测物体和深度信息。设计了一个实际实验来验证该算法在动态环境中的性能。该算法的独特之处在于,即使观测是间歇性的,它也能够保持对特征的跟踪,而许多已报道的算法在这种情况下会失败。实验验证表明,该算法能够以快速且稳健的方式进行一致的估计,表明其在实时应用中的可行性。