Benchmarking Particle Filter Algorithms for Efficient Velodyne-Based Vehicle Localization

Keeping a vehicle well-localized within a prebuilt-map is at the core of any autonomous vehicle navigation system. In this work, we show that both standard SIR sampling and rejection-based optimal sampling are suitable for efficient (10 to 20 ms) real-time pose tracking without feature detection that is using raw point clouds from a 3D LiDAR. Motivated by the large amount of information captured by these sensors, we perform a systematic statistical analysis of how many points are actually required to reach an optimal ratio between efficiency and positioning accuracy. Furthermore, initialization from adverse conditions, e.g., poor GPS signal in urban canyons, we also identify the optimal particle filter settings required to ensure convergence. Our findings include that a decimation factor between 100 and 200 on incoming point clouds provides a large savings in computational cost with a negligible loss in localization accuracy for a VLP-16 scanner. Furthermore, an initial density of ∼2 particles/m 2 is required to achieve 100% convergence success for large-scale (∼100,000 m 2 ), outdoor global localization without any additional hint from GPS or magnetic field sensors. All implementations have been released as open-source software

A Survey of Recent Advances in Particle Filters and Remaining Challenges for Multitarget Tracking

[EN]We review some advances of the particle filtering (PF) algorithm that have been achieved in the last decade in the context of target tracking, with regard to either a single target or multiple targets in the presence of false or missing data. The first part of our review is on remarkable achievements that have been made for the single-target PF from several aspects including importance proposal, computing efficiency, particle degeneracy/impoverishment and constrained/multi-modal systems. The second part of our review is on analyzing the intractable challenges raised within the general multitarget (multi-sensor) tracking due to random target birth and termination, false alarm, misdetection, measurement-to-track (M2T) uncertainty and track uncertainty. The mainstream multitarget PF approaches consist of two main classes, one based on M2T association approaches and the other not such as the finite set statistics-based PF. In either case, significant challenges remain due to unknown tracking scenarios and integrated tracking management

Adapting the Number of Particles in Sequential Monte Carlo Methods through an Online Scheme for Convergence Assessment

Particle filters are broadly used to approximate posterior distributions of hidden states in state-space models by means of sets of weighted particles. While the convergence of the filter is guaranteed when the number of particles tends to infinity, the quality of the approximation is usually unknown but strongly dependent on the number of particles. In this paper, we propose a novel method for assessing the convergence of particle filters online manner, as well as a simple scheme for the online adaptation of the number of particles based on the convergence assessment. The method is based on a sequential comparison between the actual observations and their predictive probability distributions approximated by the filter. We provide a rigorous theoretical analysis of the proposed methodology and, as an example of its practical use, we present simulations of a simple algorithm for the dynamic and online adaption of the number of particles during the operation of a particle filter on a stochastic version of the Lorenz system

Enhanced localization with adaptive normal distribution transform Monte Carlo localization for map based navigation robot

Map-based navigation is the common navigation method used among the mobile robotic application. The localization plays an important role in the navigation where it estimates the robot position in an environment. Monte Carlo Localization (MCL) is found as the widely used estimation algorithm due to it non-linear characteristic. There are classifications of MCL such as Adaptive MCL (AMCL), Normal Distribution Transform MCL (NDT-MCL) which can perform better than the MCL. However, AMCL is adaptive to particles but the position estimation accuracy is not optimized. NDT-MCL has good position estimation but it requires higher number of particles which results in higher computational effort. The objective of the research is to design and develop a localization algorithm which can achieve better performance in term of position estimation and computational effort. The new MCL algorithm which is named as Adaptive Normal Distribution Transform Monte Carlo Localization (ANDT-MCL) is then designed and developed. It integrates Kullback–Leibler divergence, Normal Distribution Transform and Systematic Resampling into the algorithm. Three experiments are conducted to evaluate the performance of proposed ANDT-MCL in simulated environment. These experiments include evaluating the performance of ANDT-MCL with different path shape, distance and velocity. In the end of the research work, the proposed ANDT-MCL is successfully developed. It is adaptive to the number of particles used, higher position estimation and lower computational effort than existing algorithms. The algorithm can produce better position estimation with less computational effort in any kind paths and is consistent in long journey as well as can outperform in high speed navigation

Monte Carlo Localization in Hand-Drawn Maps

Robot localization is a one of the most important problems in robotics. Most of the existing approaches assume that the map of the environment is available beforehand and focus on accurate metrical localization. In this paper, we address the localization problem when the map of the environment is not present beforehand, and the robot relies on a hand-drawn map from a non-expert user. We addressed this problem by expressing the robot pose in the pixel coordinate and simultaneously estimate a local deformation of the hand-drawn map. Experiments show that we are able to localize the robot in the correct room with a robustness up to 80