Simultaneous Localization and Map Change Update for the High Definition Map-Based Autonomous Driving Car

High Definition (HD) maps are becoming key elements of the autonomous driving because they can provide information about the surrounding environment of the autonomous car without being affected by the real-time perception limit. To provide the most recent environmental information to the autonomous driving system, the HD map must maintain up-to-date data by updating changes in the real world. This paper presents a simultaneous localization and map change update (SLAMCU) algorithm to detect and update the HD map changes. A Dempster–Shafer evidence theory is applied to infer the HD map changes based on the evaluation of the HD map feature existence. A Rao–Blackwellized particle filter (RBPF) approach is used to concurrently estimate the vehicle position and update the new map state. The detected and updated map changes by the SLAMCU are reported to the HD map database in order to reflect the changes to the HD map and share the changing information with the other autonomous cars. The SLAMCU was evaluated through experiments using the HD map of traffic signs in the real traffic conditions

An experiment and simulation study on developing algorithms for CAVs to navigate through roadworks

Navigating through roadworks represents one of the main sources of safety risk for Connected and Autonomous Vehicles (CAVs) due to the altered road layouts. The built-in base maps do not normally reflect these changes, causing CAVs to experience difficulties in sensing and trajectory generation. Therefore, the objective of this paper is to evaluate different collision-free trajectory generation for CAVs at roadworks to improve safety and traffic performance. Trajectory generation algorithms using lane-level dynamic maps were examined for: 1) CAVs rely on data from in-vehicle sensor only; and 2) CAVs receive additional information via a Smart Traffic Cone (STC) in advance regarding roadwork configurations. Experiments were conducted at a controlled motorway facility operated by National Highways (England) using a vehicle instrumented with a suite of sensors. Schematics of the roadworks scenario were translated into an integrated simulation platform consisting of a traffic microsimulation (VISSIM) to simulate traffic dynamics and a sub-microscopic simulator (PreScan) capable of simulating vehicle autonomy and connectivity. Results indicate that traffic conflicts and delays decrease by 40% and 3% respectively when CAVs receive additional information in advance (i.e., Scenario 2) compared to the other scenario. These findings would assist road network operators in developing ‘CAV-enabled roadworks’ and vehicle manufacturers in designing a vehicle-based ‘roadworks assist’ system

埼玉工大の自動運転機能後付けバスとその安全性向上に関する研究

埼玉工業大学202

Integrierte Multi-Sensor-Fusion für die simultane Lokalisierung und Kartenerstellung für mobile Robotersysteme

In this work, probabilistic methods for combining multiple sensors utilizing multi-sensor fusion for robust and precise localization and mapping in heterogeneous outdoor environments are presented. Aspects of increasing the reliability of landmark recognition are highlighted, as well as the integration of additional absolute and relative sensors using advanced filtering techniques

Robotika kolaboratiboa nabigazio autonomoarekin bihurketa prozesuak egiteko entengabeko lanetan

Capítulo 6.2 confidencial . -- Tesis completa 190 p. -- Tesis censurada 165 p.Proiektu honek bi prototipo ezberdin jasotzen ditu. Alde batetik, nabigazio autonomoa erabiltzen duen AMR prototipo baten garapena erakutsiko da. Bestetik, Mercedes ¿ Benz barnean landuriko tresneria baten ikerketa aurkeztuko da. AMR-ak plataforma mugikor ahaltsuak dira eta hauek barneko nabigazio autonomoa erabiltzen dute, edozein gune ezagunetik mugiarazteko. Horregatik, Gasteizko Ingeniaritza Eskolak halako plataforma baten diseinua burutzen hasi da, lokalizazio algoritmoak lantzeko. Robot mugikor honek elementu industrialak erabiliko ditu eta hauek inteligentzia garapenean zenbait oztopo ezarriko ditu. AMR - ri robot bat atxiki ahal zaio, horregatik Mercedes ¿ Benz barnean elementu komertzialekin AMR bateri robot kolaboratibo bat ezarri zaio. Garapen honek lan postuen efizientziak lantzeko baliagarria izango da eta horretarako robotak etengabeko lanetan mugiarazi, kokatu eta kalitatezko lana burutu behar du

Localization and Mapping for Autonomous Driving: Fault Detection and Reliability Analysis

Autonomous driving has advanced rapidly during the past decades and has expanded its application for multiple fields, both indoor and outdoor. One of the significant issues associated with a highly automated vehicle (HAV) is how to increase the safety level. A key requirement to ensure the safety of automated driving is the ability of reliable localization and navigation, with which intelligent vehicle/robot systems could successfully make reliable decisions for the driving path or react to the sudden events occurring within the path. A map with rich environment information is essential to support autonomous driving system to meet these high requirements. Therefore, multi-sensor-based localization and mapping methods are studied in this Thesis. Although some studies have been conducted in this area, a full quality control scheme to guarantee the reliability and to detect outliers in localization and mapping systems is still lacking. The quality of the integration system has not been sufficiently evaluated. In this research, an extended Kalman filter and smoother based quality control (EKF/KS QC) scheme is investigated and has been successfully applied for different localization and mapping scenarios. An EKF/KS QC toolbox is developed in MATLAB, which can be easily embedded and applied into different localization and mapping scenarios. The major contributions of this research are: a) The equivalence between least squares and smoothing is discussed, and an extended Kalman filter-smoother quality control method is developed according to this equivalence, which can not only be used to deal with system model outlier with detection, and identification, can also be used to analyse, control and improve the system quality. Relevant mathematical models of this quality control method have been developed to deal with issues such as singular measurement covariance matrices, and numerical instability of smoothing. b) Quality control analysis is conducted for different positioning system, including Global Navigation Satellite System (GNSS) multi constellation integration for both Real Time Kinematic (RTK) and Post Processing Kinematic (PPK), and the integration of GNSS and Inertial Navigation System (INS). The results indicate PPK method can provide more reliable positioning results than RTK. With the proposed quality control method, the influence of the detected outlier can be mitigated by directly correcting the input measurement with the estimated outlier value, or by adapting the final estimation results with the estimated outlier’s influence value. c) Mathematical modelling and quality control aspects for online simultaneous localization and mapping (SLAM) are examined. A smoother based offline SLAM method is investigated with quality control. Both outdoor and indoor datasets have been tested with these SLAM methods. Geometry analysis for the SLAM system has been done according to the quality control results. The system reliability analysis is essential for the SLAM designer as it can be conducted at the early stage without real-world measurement. d) A least squares based localization method is proposed that treats the High-Definition (HD) map as a sensor source. This map-based sensor information is integrated with other perception sensors, which significantly improves localization efficiency and accuracy. Geometry analysis is undertaken with the quality measures to analyse the influence of the geometry upon the estimation solution and the system quality, which can be hints for future design of the localization system. e) A GNSS/INS aided LiDAR mapping and localization procedure is developed. A high-density map is generated offline, then, LiDAR-based localization can be undertaken online with this pre-generated map. Quality control is conducted for this system. The results demonstrate that the LiDAR based localization within map can effectively improve the accuracy and reliability compared to the GNSS/INS only system, especially during the period that GNSS signal is lost