Setting Method of Downsampling Factor and Grid Factor for NDT Relocation Algorithm in Dynamic Environment

Normal Distribution Transform (NDT) algorithm plays the role of detecting the relative pose of the vehicle in high-precision map. In this paper, a method of setting downsampling factor and grid factor for NDT relocation algorithm in dynamic environment is proposed, which can solve the problems of excessive NDT relocation error and location loss caused by dynamic objects accounting for 1% to 35% of the volume of scanning point cloud in vehicle environment. To simulate a real dynamic point cloud environment, the single-frame LiDAR point cloud space is voxelized into a mesh. Each grid is assigned a random number evenly distributed between 0 and 1. The threshold value for whether to add a Gaussian noise point is also set. Seven representative dynamic objects on the highway are selected. The threshold value of probability distribution function of Gaussian noise object needs to be set. Then the volume content of the dynamic object in the single frame point cloud space is calculated according to the set threshold value by using the definite integral. By changing the content and volume of dynamic obstacles in a dynamic environment, the effects of the downsampling factor and the grid factor on the accuracy of the repositioning trajectory are obtained. The resampling and mesh coefficients are optimized based on the analysis of the repositioning trajectory accuracy. The results show that When the current sampling factor is fixed, the grid factor of the NDT algorithm is proportional to the RMSE factor. When the NDT grid factor is fixed and the down sampling factor is equal to the side length of the obstacle, the NDT relocation accuracy is the highest and reaches the local optimum.

[1]  Ankit Jain,et al.  Kalman Filter and Correlated Measurement Noise: The Variance Inflation Factor , 2022, IEEE Transactions on Aerospace and Electronic Systems.

[2]  V. M. Artyushenko,et al.  Using the Poly-Gaussian Models to Represent non-Gaussian Signals and Noises , 2022, 2022 Systems of Signals Generating and Processing in the Field of on Board Communications.

[3]  Qingquan Li,et al.  NDT-LOAM: A Real-Time Lidar Odometry and Mapping With Weighted NDT and LFA , 2022, IEEE Sensors Journal.

[4]  A. Rövid,et al.  Automatic Label Injection Into Local Infrastructure LiDAR Point Cloud for Training Data Set Generation , 2022, IEEE Access.

[5]  A. Gellert,et al.  Estimation of Missing LiDAR Data for Accurate AGV Localization , 2022, IEEE Access.

[6]  Huiliang Shang,et al.  Improved Point Pair Feature based Cloud Registration on Visibility and Downsampling , 2021, 2021 International Conference on Networking Systems of AI (INSAI).

[7]  Ding Yang,et al.  An Optimization Method for Video Upsampling and Downsampling Using Interpolation-Dependent Image Downsampling , 2021, 2021 4th International Conference on Information Communication and Signal Processing (ICICSP).

[8]  Liang Yuan,et al.  RS-SLAM: A Robust Semantic SLAM in Dynamic Environments Based on RGB-D Sensor , 2021, IEEE Sensors Journal.

[9]  Fupeng Chen,et al.  An Optimized FPGA-Based Real-Time NDT for 3D-LiDAR Localization in Smart Vehicles , 2021, IEEE Transactions on Circuits and Systems II: Express Briefs.

[10]  Xu Li,et al.  A Novel Visual Measurement Framework for Land Vehicle Positioning Based on Multimodule Cascaded Deep Neural Network , 2021, IEEE Transactions on Industrial Informatics.

[11]  Tom Duckett,et al.  NDT-Transformer: Large-Scale 3D Point Cloud Localisation using the Normal Distribution Transform Representation , 2021, IEEE International Conference on Robotics and Automation.

[12]  K. Chiang,et al.  Performance Analysis of 3D NDT Scan Matching for Autonomous Vehicles Using INS/GNSS/3D LiDAR-SLAM Integration Scheme , 2021, 2021 IEEE International Symposium on Inertial Sensors and Systems (INERTIAL).

[13]  E. Chung,et al.  Performance Evaluation on Map-Based NDT Scan Matching Localization Using Simulated Occlusion Datasets , 2021, IEEE Sensors Letters.

[14]  Osamu Hirose,et al.  Acceleration of Non-Rigid Point Set Registration With Downsampling and Gaussian Process Regression , 2020, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[15]  Jiaru Lin,et al.  Intelligent Reflecting Surface Enhanced Indoor Robot Path Planning: A Radio Map-Based Approach , 2020, IEEE Transactions on Wireless Communications.

[16]  Huosheng Hu,et al.  An Integrated GNSS/LiDAR-SLAM Pose Estimation Framework for Large-Scale Map Building in Partially GNSS-Denied Environments , 2021, IEEE Transactions on Instrumentation and Measurement.

[17]  Pin Lyu,et al.  Optimal Time Difference-Based TDCP-GPS/IMU Navigation Using Graph Optimization , 2021, IEEE Transactions on Instrumentation and Measurement.

[18]  Vijayan K. Asari,et al.  DALES Objects: A Large Scale Benchmark Dataset for Instance Segmentation in Aerial Lidar , 2021, IEEE Access.

[19]  Mikael Skoglund,et al.  New Formulation and Computation of NRDF for Time-Varying Multivariate Gaussian Processes With Correlated Noise , 2021, IEEE Control Systems Letters.

[20]  Zhitao Zhang,et al.  Three-dimensional reconstruction of plants and a single building from UAV images , 2021 .

[21]  Xuefeng Yi,et al.  PLD-SLAM: A New RGB-D SLAM Method with Point and Line Features for Indoor Dynamic Scene , 2021, ISPRS Int. J. Geo Inf..

[22]  Kichun Jo,et al.  A Geodetic Normal Distribution Map for Long-Term LiDAR Localization on Earth , 2021, IEEE Access.

[23]  Franc Solina,et al.  Learning to Predict Superquadric Parameters From Depth Images With Explicit and Implicit Supervision , 2021, IEEE Access.

[24]  Kai-Wei Chiang,et al.  Robust IMU/GPS/VO Integration for Vehicle Navigation in GNSS Degraded Urban Areas , 2020, IEEE Sensors Journal.

[25]  Guang-Je Tsai,et al.  Assessment for INS/GNSS/Odometer/Barometer Integration in Loosely-Coupled and Tightly-Coupled Scheme in a GNSS-Degraded Environment , 2020, IEEE Sensors Journal.

[26]  Yunfeng Wang,et al.  An Improved Single-Epoch GNSS/INS Positioning Method for Urban Canyon Environment Based on Real-Time DISB Estimation , 2020, IEEE Access.

[27]  Bochang Zou,et al.  Point Cloud Reduction and Denoising Based on Optimized Downsampling and Bilateral Filtering , 2020, IEEE Access.

[28]  Chang Xu,et al.  Point Cloud Generation From Multiple Angles of Voxel Grids , 2019, IEEE Access.

[29]  Qingxuan Jia,et al.  A Visual Relocation Algorithm With Illumination Changing Robustness , 2019, 2019 6th International Conference on Systems and Informatics (ICSAI).

[30]  Kai Huang,et al.  Lidar Mapping Optimization Based on Lightweight Semantic Segmentation , 2019, IEEE Transactions on Intelligent Vehicles.

[31]  J. Wang,et al.  Assessment of the Impact of the Measurement Noise on the Gravity Anomaly Matching Technique , 2019, 2019 26th Saint Petersburg International Conference on Integrated Navigation Systems (ICINS).

[32]  Hao Wang,et al.  Robust and Precise Vehicle Localization Based on Multi-Sensor Fusion in Diverse City Scenes , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[33]  Li Yi,et al.  Development of a robot with 3D perception for accurate row following in vineyard , 2018, International Journal of Precision Agricultural Aviation.

[34]  Yi Li,et al.  Robust SLAM system based on monocular vision and LiDAR for robotic urban search and rescue , 2017, 2017 IEEE International Symposium on Safety, Security and Rescue Robotics (SSRR).

[35]  Juan D. Tardós,et al.  ORB-SLAM2: An Open-Source SLAM System for Monocular, Stereo, and RGB-D Cameras , 2016, IEEE Transactions on Robotics.

[36]  Clark N. Taylor,et al.  Conservative Uncertainty Estimation in Map-Based Vision-Aided Navigation , 2016, IEEE Transactions on Aerospace and Electronic Systems.

[37]  Markus Schreiber,et al.  Vehicle localization with tightly coupled GNSS and visual odometry , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[38]  Wolfgang Hess,et al.  Real-time loop closure in 2D LIDAR SLAM , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[39]  Georgy Gimel'farb,et al.  Lidar guided stereo simultaneous localization and mapping (SLAM) for UAV outdoor 3-D scene reconstruction , 2016, 2016 International Conference on Image and Vision Computing New Zealand (IVCNZ).

[40]  Ezzeddine Zagrouba,et al.  Dense 3D SLAM in Dynamic Scenes Using Kinect , 2015, IbPRIA.

[41]  Yan Wang,et al.  Dynamic Simulation of Noise in 3D Infrared Scene Simulation , 2015, 2015 International Conference on Network and Information Systems for Computers.

[42]  Davide Scaramuzza,et al.  SVO: Fast semi-direct monocular visual odometry , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[43]  Daniel Cremers,et al.  LSD-SLAM: Large-Scale Direct Monocular SLAM , 2014, ECCV.

[44]  Ji Zhang,et al.  LOAM: Lidar Odometry and Mapping in Real-time , 2014, Robotics: Science and Systems.

[45]  Franz Kummert,et al.  Monocular Road Terrain Detection by Combining Visual and Spatial Information , 2014, IEEE Transactions on Intelligent Transportation Systems.

[46]  Tim D. Barfoot,et al.  RANSAC for motion-distorted 3D visual sensors , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[47]  Tim D. Barfoot,et al.  Gaussian Process Gauss-Newton for 3D laser-based Visual Odometry , 2013, 2013 IEEE International Conference on Robotics and Automation.

[48]  Emilio Frazzoli,et al.  Synthetic 2D LIDAR for precise vehicle localization in 3D urban environment , 2013, 2013 IEEE International Conference on Robotics and Automation.

[49]  F. Aghili,et al.  Driftless 3-D Attitude Determination and Positioning of Mobile Robots By Integration of IMU With Two RTK GPSs , 2013, IEEE/ASME Transactions on Mechatronics.

[50]  Jay A. Farrell,et al.  Real-Time Computer Vision/DGPS-Aided Inertial Navigation System for Lane-Level Vehicle Navigation , 2012, IEEE Transactions on Intelligent Transportation Systems.

[51]  Andrew J. Davison,et al.  DTAM: Dense tracking and mapping in real-time , 2011, 2011 International Conference on Computer Vision.

[52]  Kazunobu Ishii,et al.  Development of Crawler-Type Robot Tractor based on GPS and IMU , 2010 .