The applications of Simultaneous Localization and Mapping (SLAM) for atechnique has achieved astonishing progress and has generated considerable interest in the autonomous driving with respect to different driving scenarios, vehicle system components and the characteristics of the SLAM approaches are discussed. A real-world road test is presented to demonstrate a multi-sensor-based modernizedcommunity. With its conceptual roots in navigation and mapping, SLAM outperforms some traditional positioning and localization techniques since it can support more reliable and robust localization, planning, and controlling to meet some key criteria for autonomous driving. An overview of the different SLAM implementation approaches and then discuss the applications of SLAM procedure for autonomous driving. The numerical results show that a high-precision 3D point cloud map can be generated by with respect to different driving scenarios, vehicle system components and the characteristics of the SLAM procedure with the integration of Lidar and GNSS/INSapproaches are given.
1. Introduction
D
Autonomous (also calle
pd se
nding on the different characteristics of Simultaneous Localization and Mapping (SLAM) techniques, there could be different applicatilf-driving, driverless, or robotic) vehicle operation is a significant academic as well as an industrial research topic. It is predicted that fully autonomous vehicles will become an important part of total vehicle sales in the next decades. The promotion of autonomous vehicles draws attention to the many advantages, such as service for disabled or elderly persons, reduction in driver stress and costs, reduction in road accidents, elimination of the need for conventional public transit services, etc. [1][2].
A typical auton
omous
for auvehicle system contains four key parts: localization, perception, planning, and controlling (Figure 1). Posit
ion
omous driving. One classificing is the process of obtaining a (moving or static) object’s coordinates with respect to a given coordinate system. The coordinate system may be a local coordinate system or a geodetic datum such as WGS84. Localization
of the applications is whether they are offline is a process of estimating the carrier’s pose (position and attitude) in relation to a reference frame or a map. The perception system monitors the road environment around the host vehicle and identifies interested objects such as pedestrians, other vehicles, traffic lights, signage, etc.
Figure 1. Functional components of an autonomous driving system.
By determining the co
or
online. A map satisfyingdinates of objects in the surrounding environment a map can be generated. This process is known as Mapping.
Path pla
high-performance requirement is typically generated offline, sucnning is the step that utilizes localization, mapping, and perception information to determine the optimal path in subsequent driving epochs, guiding the automated vehicle from one location to another location. This plan is then converted into action using the controlling system components, e.g., brake control before the detected traffic lights, etc.
All th
ese as the High Definition (HD)parts are closely related. The location information for both vehicle and road entities can be obtained by combining the position, perception, and map
[1]information.
FIn co
r this kind of 3D point cloud map, an ontrast, localization and mapping can be used to support better perception. Accurate localization and perception information is essential for correct planning and controlling.
To achieve f
full
ine map generation process ensures the accuracy and reliability of the map. Such maps can be pre-generated to support the real-time operatiy automated driving, there are some key requirements that need to be considered for the localization and perception steps. The first is accuracy. For autonomous driving, the information about where the road is and where the vehicle is within the lane supports the planning and controlling steps. To realize these, and to ensure vehicle safety, there is a stringent requirement for position estimation at the lane level, or even the “where-in-lane” level (i.e., the sub-lane level). Recognition range is important because the planning and controlling steps need enough processing time for the vehicle to react [3]. Ro
bustn
s of autonomous vehicles.
2. High Definition Map Generation and Updating
Aess means the localization and perception should be robust to any changes while driving, such as
driving s
tatecenarios (urban, highway, tunnel, rural, etc.), lighting conditions, weather, etc.
Trad
itional earlier, SLAM can be used to generate digital maps used for autonomous driving, such as the HD mapvehicle localization and perception techniques cannot meet all of the aforementioned requirements. For instance, GNSS error occurs as the signals may be distorted, or even blocked, by trees, urban canyons, tunnels, etc. Often an inertial navigation system (INS) is used to support navigation during GNSS signal outages, to continue providing position, velocity, and altitude information. However, inertial measurement bias needs frequently estimated corrections or calibration, which is best achieved using GNSS measurements. Nevertheless, an integrated GNSS/INS system is still not sufficient since highly automated driving requires not only positioning information of the host [1].vehicle, Dbu
e to the stringent requirementst also the spatial characteristics of the objects in the surrounding environment. Hence perceptive sensors, such as Lidar and Cameras, are often used for both localization and perception. Lidar can acquire a 3D point cloud directly and map the environment, with the aid of GNSS and INS, to an accuracy that can reach the centimeter level in urban road driving conditions [4]. However,
the high
quality sensors are used.cost has limited the commercial adoption of Lidar systems in vehicles. Furthermore, its accuracy is influenced by weather (such as rain) and lighting conditions. Compared to Lidar
is one of, Camera systems have lower accuracy but are also affected by numerous error sources [5][6]. Nevertheless, the
y core sensors for automated cars asare much cheaper, smaller in size, require less maintenance, and use less energy. Vision-based systems can provide abundant environment information, similar to what human eyes can perceive, and the data can be fused with other sensors to determine the location of detected features.
A map wit
can generate high-density 3D point clouds. High-end GNSS and INS technology are also used toh rich road environment information is essential for the aforementioned sensors to achieve accurate and robust localization and perception. Pre-stored road information makes autonomous driving robust to the changing environment and road dynamics. The recognition range requirement can be satisfied since an onboard map can provide
accurate position infotimely information on the road network. Map-based localization and navigation have been studied using different types of map information.
Cameras can Google Map is one example as it provide
s worldwide map information
that iincluding images, topographic details, and satellite images
[7], and it is
available vi
milar to the information detea mobile phone and vehicle apps. However, the use of maps will be limited by the accuracy of the maps, and in some selected areas the map’s resolution may be inadequate. In [8], the authors c
tonsidered
by human eyes. The low-accuracy maps for navigation by combining data from other sensors. They detected moving objects using Lidar data and utilized a GNSS/INS system with a coarse open-source GIS map. Their results show their fusion
oftechnique can successfully detect and track moving objects. A precise curb-map-based localization method that uses a 3D-Lidar sensor
daand a high-precision map is proposed in [9]. However, t
his method will fa
andil when curb information is lacking, or obstructed.
Recently, so-ca
nalysis oflled “high-definition” (HD) maps have received considerable interest in the context of autonomous driving since they contain very accurate, and large volumes of, road
network information
[10]. According to
some major players in the commercial HD map market, 10–20 cm accuracy has been achieved [11][12], and it is predicted that in the next generat
eion of HD maps
needs con, a few centimeters of accuracy will be reached. Such maps contain considerable
computational power, which is not feasible in current onboard vehicle systemsinformation on road features, not only the static road entities and road geometry (curvature, grades, etc.), but also traffic management information such as traffic signs, traffic lights, speed limits, road markings, and so on. The autonomous car can use the HD map to precisely locate the host-car within the road lane and to estimate the relative location of the car with respect to road objects by matching the landmarks which are recognized by onboard sensors with pre-stored information within the HD map.
Therefore
, themaps, especially HD map
is built-up offline, using tes, play several roles in support of autonomous driving and may be able to meet the stringent requirements of accuracy, precision, recognition ranging, robustness, and information richness. However, the application of the “map” for autonomous driving is also facilitated by techniques such as
optimization-based SLAM. The ofSimultaneous Localization and Mapping (SLAM). SLAM is a process by which a moving platform builds a map of the environment and uses that map to deduce its location at the same time. SLAM, which is widely used in the robotic field, has been demonstrated [13][14] as being applicable f
or autonomous vehicl
ine operations as it can support not only accurate map
creatgeneration but also online localization within a previously generated map.
Wi
th appro
n can be performed bypriate sensor information (perception data, absolute and dead reckoning position information), a high-density and accurate map can be generated offline by SLAM. When driving
the road network several times to collect, the self-driving car can locate itself within the pre-stored map by matching the sensor data to the map. SLAM can also be used to address the problem of DATMO (detection and tracking of moving objects) [15] whi
ch is importan
formation, and then all the collected perceptive sensor infort for detecting pedestrians or other moving objects. As the static parts of the environment are localized and mapped by SLAM, the dynamic components can concurrently be detected and tracked relative to the static objects or features. However, SLAM also has some challenging issues when applied to autonomous driving applications. For instance, “loop closure” can be used to reduce the accumulated bias within SLAM estimation
and position informatioin indoor or urban scenarios, but it is not normally applicable to highway scenarios.
2. Key SLAM Techniques
Sin
ce i
s pts initial introduction in 1986 [16], a var
iety o
cessed tof SLAM techniques have been developed. SLAM has its conceptual roots in geodesy and geospatial mapping [17].
In ge
neral, ther
to improve the accuracy of the fe are two types of approaches to SLAM estimation: filter-based and optimization-based. Both approaches estimate the vehicle pose states and map states at the same time. The vehicle pose includes 3D or 2D vehicle position, but sometimes also velocity, orientation or attitude, depending on the sensor(s) used and on the application(s).
2.1. Online and Offline SLAM
Figure 2 and Figure 3 illustrate two general SLAM implementations: onlin
e SLAM a
l map. Annd offline SLAM (sometimes referred to as full SLAM). According to [18], full SLAM se
xample of a HD map is shown ineks to calculate variables over the entire path along with the map, instead of just the current pose, while the online SLAM problem is solved by removing past poses from the full SLAM problem.
Figure 1 [2].
2. Description of online SLAM.
T Description of offline SLAM.
Here, xk represents the vehicle pose (position, attitude, velocity, etc.) at time k. m is the map that consists of stored landmarks (f1–f4) with their position states. uk is the
contro
ad environmel inputs that represent the vehicle motion information between time epochs k − 1 an
d k, such as accelerat
ion, and road rules mturn angle, etc., which can be acquired from vehicle motion sensors such as wheel encoders or an inertial sensor. At some epoch k, the onboa
yrd sensors change, for instance, the speed l(such as Camera, Lidar, and Radar) will perceive the environment and detect one or more landmarks. The relative observations between the vehicle and all the observed landmarks are denoted as zk. Wi
th this inform
it may be ation, the variables (including the vehicle pose and the map states) can be estimated.
The re
dctangle with blu
cede background in Figure 2 and
u Figure 3 represents the state variable
s t
o road work, rohat are estimated in these two implementations. In most cases, for online SLAM, only the current vehicle pose xk+2 is estima
ted
infrastruwhile the map is generated and updated with the most recent measurements (uk+2 and zk+2), whereas in the c
ase of the offline SLAM implement
ure may be changed due to buildingation, the whole trajectory of the vehicle is updated together with the whole map. All the available control and observation measurements will be utilized together for the offline SLAM implementation.
However, with the development
of SLAM algorithms and increased computational capabilities,
and so on the full SLAM solution may be obtained in real-time with an efficient SLAM algorithm, which can also be treated as an online problem. Therefore
the HD map needs frequent update, implementing a SLAM method online or offline may be dependent on whether the measurement inputs (control and observation) it requires are from current/history or from future epochs, and on its processing time (real-time or not).
2.2. Filter-Based SLAM
Filter-bas
.ed S
uch updates can utilize the oLAM recursively solves the SLAM problem in two steps. Firstly, the vehicle and map states are predicted with processing models and control inputs. In the next step, a correction of the predicted state is carried out using the current sensor observations. Therefore, the filter-based SLAM is suitable for online
SLAM.
Extend
ed Ka
ta collectelman Filter-based SLAM (EKF-SLAM) represents a standard solution for the SLAM problem. It is derived from
any autonomous car. For example, the daBayesian filtering in which all variables are treated as Gaussian random variables. It consists of two steps: time update (prediction) and measurement update (filtering). At each time epoch the measurement and motion models are linearized (using the current state with the first-order Taylor expansion). However, since the linearization is not made around the true value of the state vector, but around the estimated value [19], t
he lineariza
is transmittion error will accumulate and could cause a divergence of the estimation. Therefore, inconsistencies can occur.
Anot
he
d to central (cloud) computers where the updatr issue related to EKF-SLAM is the continuous expansion of map size which makes the quadratic calculation process of large-scale SLAM impractical. For autonomous driving, the complex road environment and long driving period will introduce a large number of features, which makes real-time computatio
ns are performed. Other n not feasible. A large number of algorithms have been developed in order to improve computational efficiency. For example, the Compressed Extended Kalman Filter (CEKF) [20] algorithm ca
n significantly r
s can receive such cloud-educe computations by focusing on local areas and then extending the filtered information to the global map. Algorithms with sub-maps have also been used to address the computation issues [21][22][23][24]. A new b
la
sed updates and make a timnk map is used to replace the old map when the old one reaches a predefined map size. A higher-level map is maintained to track the link between each sub-map.
The
re are some other fil
y adjustment to driving plans. Jo et al.ter-based SLAM approaches, such as some variants of the Kalman Filter. One of them, the Information Filter (IF), is propagated with the inverse form of the state error covariance matrix, which makes this method more stable [325]. prThis method is more popular in multi-vehicle SLAM than in single-vehicle systems.
Ano
pther class o
sed af filter-based SLAM
change update (SLAMCU) algorithm, utilizing a techniques is the Particle Filter (PF) which has become popular in recent years. PF executes Sequential Monte-Carlo (SMC) estimation by a set of random point clusters (or particles) representing the Bayesian aposteriori. The Rao–Blackwellized P
F approarticle Filter was proposed in [26]. Fast-SLAM is a
ch for online vehicle popular implementation that treats the robot position
and (new) map state estimationdistribution as a set of Rao–Blackwellized particles, and uses an EKF to maintain local maps. In th
e work ofis way, the computational complexity of SLAM is greatly reduced. Real-time application is possible with Fast-SLAM [427],
ma
new feature layer of HD mapking online SLAM possible for autonomous driving. Another advantage over EKF is that the particle filters can
be genecope with non-linear motion models [28]. However
, a
tccording to [29][30], Fast-SLAM suffe
rs from d
using Graph egeneration since it cannot forget the past. If marginalizing the map and when resampling is performed, statistical accuracy is lost.
2.3. Optimization-Based SLAM
Full SLAM
whestimate
n a s all the vehicle
is temporarily stopped or in a parking lot. The new feature layer from one vehicle can then be uploadpose and map states using the entire sensor data, and it is mostly optimization based. Similar to filter-based SLAM, the optimization-based SLAM system consists of two main parts: the frontend and the backend. In the frontend step, the SLAM system extracts the constraints of the problem with the sensor data, for example, by performing feature detection and matching, motion estimation, loop closure detection, etc. Nonlinear optimization is then applied to
acquire the ma
p cloud andximum likelihood estimation at the backend.
Graph SLAM i
s on
tegrated with that from other vehicles into a newe of the main classes of full SLAM which uses a graphical structure to represent the Bayesian SLAM. All the platform poses along the whole trajectory and all the detected feature
layer in the map cloud, thus enabling more precise and robust vehicle locals are treated as nodes. Spatial constraints between poses are encoded in the edges between the nodes. These constraints result from observations, odometry measurements, and from loop closure constraints. After the graph construction, graph optimization
. In the work of Zhang et al is applied in order to optimize the graph model of the whole trajectory and map.
[5],To solve rthe
al-time semantic segmentation and Visual full optimization and to calculate the Gaussian approximation of the aposteriori, a number of methods can be used, such as Gauss–Newton or Levenberg–Marquardt [31].
For graph-based SLAM
, were combined to the size of its covariance matrix and update time are constant after generat
e semantic point cloud data oing the graph, therefore graph SLAM has become popular for building large-scale maps. Reducing the computational complexity of the optimization step has become one of the
road environment, which was then matched with a pre-constructed HD map to confirm map elements thatmain research topics for practical implementations of the high-dimensional SLAM problem. The key to solving the optimization step efficiently is the sparsity of the normal matrix. The fact that each measurement is only associated with a very limited number of variables makes the matrix very sparse. With Cholesky factorization and QR factorization methods, the information matrix and measurement Jacobian matrix can be factorized efficiently, and hence the computational cost can be significantly reduced. Several algorithms have
not changed,been proposed, such as TORO and g2o. The sub-map method is also a popular strategy for solving large-scale problems [32][33][34][35][36]. The sub-maps can
d generate new elements when appearing, thus facilitati be optimized independently and are related to a local coordinate frame. The sub-map coordinates can be treated as pose nodes, linked with motion constraints or loop closure constraints. Thus, a global pose graph is generated. In this way the computational complexity and update time will be improved.
Smoothing and Mapping
c(SAM), another
owdsource updates of HD maps optimization-based SLAM algorithm, is a type of nonlinear least squares problem. Such a least squares problem can be solved incrementally by Incremental Smoothing and Mapping (iSAM) [37] and iSAM2 [38].
3. Small Local Map Generation
Online SLAM can
be obta
lso be used for small local arined with incremental SAMs as they avoid unnecessary calculations with the entire covariance matrix. iSAM2 is more efficient as it uses a Bayes tree to obtain incremental variable re-ordering and fluid re-linearization.
SLAM++ is anothe
r incrementa
s. One example is within parking areas. The driving speed in a parking l solution for nonlinear least squares optimization-based SLAM which is very efficient. Moreover, for online SLAM implementations, fast state covariance recovery is very important for data association, obtaining reduced state representations, active decision-making, and next best-view [39][40]. SLAM++ has an advantage as it allo
ws for increment
is low, therefoal covariance calculation which is faster than other implementations [40].
Table 1 is a summar
ey of the
visioncharacteristics of some typical SLAM technique
will be more s. Note that Graph SLAM utilizes all available observations and control information and can achieve very accurate and robust
than in other high-speed driving scenarios. The parking area cestimation results. It is suitable for offline applications and its performance relies on a good initial state guess. Filter-based SLAM is more suitable for small-scale environments when used for online estimation, but for the complex environment, a real-time computation may be difficult with the traditional EKF-SLAM. Other variants or fastSLAM should be
unknown (public parking lot or garagconsidered. The incremental optimization method can do incremental updating, so as to provide an optimal estimation of a large-scale map with very high efficiency and in real-time.
2.4. Sensors and Fusion Method for SLAM
Ne
),w SLAM or known (home zone)–both cases can benefit from SLAM. Since SLAM can be used withoumethods have appeared thanks to advances in sensor and computing technology. These methods are also optimization-based or filtered-based at the backend estimation step while the frontend step is highly dependent on the application of different sensor modalities. Two of the major sensors used for SLAM are Lidar and Camera. The Lidar method has become popular due to its simplicity and accuracy compared to other sensors [52]. The core of Lidar-based localizat
ion GNSS signals, it is suitable for vehicles in indand mapping is scan-matching, which recovers the relative position and orientation of two scans or point clouds. Popular approaches for scan matching include the Iterative Closet Point (ICP) algorithm and its variants [53][54][55], and the no
rmal distributio
r n transform (NDT) [56]. These metho
ds ar
undee highly dependent on good initial guess, and are impacted by local minimums [57][58]. Some other
matching
round parking methods include probabilistic methods such as correlative scan matching (CSM) [59], fea
ture
as-based methods [57][60],
and using just the perceptivothers. Many of the scan-matching methods focus on initial free of or robust to, initialization error, but they still face the computation efficiency challenge.
Some range sensor
s and odometry measurements (that can be used for SLAM estimation are Radar and Sonar/ultrasonic sensors. Radar works in a similar manner to Lidar, but the system emits radio waves instead of light to measure the distance to objects. Furthermore, since Radar can observe the relative velocity
, turn angle) or IMU between the sensor and the object using the measure
mend Doppler shift [61], it
is
. For unknown public suitable for distinguishing between stationary and moving objects, and can be used to discard moving objects during the map-building process p[62]. Some resear
kch on using
areRadar for SLAM can be found in [42][62][63][64][65][66]. When compa
red to Lidar, lower price, lower power cons
, the position of the car and the obstacumption, and less sensitivity to atmospheric conditions make it well suited for outdoor applications. However, Radar has lower measurement resolution, and its detections are more sparse than Lidar. Thus, it is harder to match Radar data and deal with the data association problem, which results in its 3D mapping being less accurate.
Sonar/ul
trasonic se
s, such as pillars, sidewallsnsors also measure the time-of-flight (TOF) to determine the distance to objects, by sending and receiving sound waves. Sonar-based SLAM was initially used for underwater [67][68],
and indoor [69] applications. It has become
popular due to it
c.,s low cost and low power consumption. It is not affected by visibility restrictions and can be
estused with multiple surface types [70]. However, sim
ila
ted at the same time, guiding the parking syr to Radar, it obtains sparse information and suffers from inaccurate feature extraction and long processing time. Thus, it is of limited use for high-speed vehicle applications. Moreover, Sonar/ ultrasonic sensors have limited sensing range and may be affected by environmental noise and other platforms using ultrasound with the same frequency [71].
Camera is
anot
em. For home zonher popular sensor for SLAM. Different techniques have been developed, such as monocular [72][73], ste
reo p[74][75][76][77], and multi-ca
mer
ka [78][79][80][81]. These techniques can be used in a wi
de rang
, the pre-gene of environments, both indoor and outdoor. The single-camera system is easy to deploy, however, it suffers from scale uncertainty [82]. Stereo-camera
syste
d map and a frequent parking trajectorms can overcome the scale factor problem and can retrieve 3D structural information by comparing the same scene from two different perspectives [61]. Multi-camera sy
stems have gained can be stored wincreasing interest, particularly as they achieve a large field of view [78] or are even capable of panoramic visi
ton [81]. Thi
ns the automated vehiclesystem is more robust in complicated environments, while single sensor system
. Eac may be very vulnerable to environmental interference [81]. However, th
e time the car retintegration of Cameras requires additional software and hardware, and requires more calibration and synchronization effort [71][83]. Another special Camera, the RGB-D Camera, has been stu
died by the SLAM and computer
n vision communities
[84][85][86][87][88][89][90][91] since it can directly obtain depth
info
me, re-localization using the storrmation. However, this system is mainly applicable in indoor environments because it uses infrared spectrum light and is therefore sensitive to external illumination [70].
The
d map can be carried out by matching deteVisual SLAM can also be classified as feature-based or direct SLAM depending on how the measurements are used. The feature-based SLAM repeatedly detects features in images and utilizes descriptive features for tracking and depth estimation [92]. Some fundamental frameworks for this feature-based system inc
lude MonoSLAM [72][93], PTAM [94], ORB-SLAM [95], and ORB-SLAM2 [96]. Inste
ad
fof using any feature
s with the map detectors and descriptors, the direct SLAM method uses the whole image. Examples of direct SLAM include DTAM [97], LSD-SLAM [73], and SVO [98].
ThA dense or semi-dense
frequent trajectory could be useenvironment model can be acquired by these methods, which makes them more computationally demanding than feature-based methods. Engel et al. [74] extended
the LSD-SLAM f
or the prom a monocular to a stereo model while Caruso et al. [99] extended the LSD-SLAM to an omnidirectional model. A detailed review of Visual
SLAM can
ning be found in [5] and
[70][92][100][101].
Eac
h o
ntrolling stepf these perceptive sensors has its advantages and limitations.
An Lidar approach
es that utilizes multi-level surface (MLS) maps to locate the vehicle, and to calculate and plan the can provide precise and long-range observations, but with limitations such as being sensitive to atmospheric conditions, being expensive, and currently rather bulky. Radar systems are relatively low cost, but are more suitable for object detection than for 3D map building. Sonar/ultrasonic sensors are not suitable for high-speed platform applications. Cameras are low-cost, even when multiple Cameras are used. Cameras can also provide rich visual information. However, they are sensitive to environment texture and light, and in general, have high computational demands. Therefore, a popular strategy is to combine a variety of sensors, making the SLAM system more robust.
There are sev
eral strategies to inte
hicle grate data from different sensors for SLAM. One is fusing independently processed sensor results to then obtain the final solution. In [102], a mapp
ing method that
h within indoor parking areas merged two grid maps, which were generated individually from laser and stereo camera measurements, into a single grid map was proposed
in. In this method, the measurements of the different sensors need to be mapped to a joint reference system. In [6103]., a In this rearch, graphmulti-sensor SLAM system that combined the 3-DoF pose estimation from laser readings, the 6-DoF pose estimation from a monocular visual system, and the inertial-based
SLAM was used for mapping navigation estimation results to generate the final 6-DoF position using an EKF processing scheme was proposed. For this type of strategy, the sensors can provide redundancy and the system will be robust to possible single-sensor failure. A decision-making step may be needed to identify whether the data from each sensor is reliable, and t
he MLS map is then used to plan a global path from the staro decide whether to adopt the estimation from that sensor modality or to ignore it. Another fusion strategy is using an assistant sensor to improve the performance of other sensor-based SLAM algorithms. The main sensor could be Lidar or Camera, while the assistant sensor could be any other type of sensor. In this strategy, the assistant sensor is used to overcome the limitations of the main sensor. The work in [104] incorporat
ed visual to the destininformation to provide a good initial guess on the rigid body transformation, and t
o robustlyhen used this initial transformation to seed the ICP framework. Huang et al. [105] extracted the depth of lpo
calize the vehicle with laser range measuremenint-based and line-based landmarks from the Lidar data. The proposed system used this depth information to guide camera tracking and also to support the subsequent point-line bundle adjustment to further improve the estimation accuracy.
The above t
wo s
trategies can be combined. In the work of
[7106],
the fusing consists of two models, one dea
grid map and an Extended Kalman Filter (EKF)ls with feature fusion that utilizes line feature information from an image to remove any “pseudo-segments”, which result from dynamic objects, in the laser segments. Another is a modified EKF SLAM
algorithm were used with W-band radar for autframework that incorporates the state estimates obtained from the individual monocular and laser SLAM in order to reduce the pose estimation covariance and improve localization accuracy. This modified SLAM framework can run even when one sensor fails since the sensor SLAM processes are parallel to each other.
So
nme examples o
mous baf more tight fusion can also be found in the literature. The work of [107] c
k-ombin
parking. In this research, an efficieed both the laser point cloud data and image feature point data as constraints and conducted a graph optimization with both of these constraints using a specific cost function. Furthermore, an image feature-based loop closure was added to this system to remove accumulation errors.
In
ert
EKF SLAM algorithm was proposed to enableial SLAM incorporates an inertial measurement unit (IMU) as an assistant sensor. The IMU can be fused with the Camera or Lidar to support pose (position, velocity, attitude) estimation. With an IMU, the attitudes, especially the heading, are observable [108]. The integr
eal-time processing. Iation of IMU measurements can also improve the motion tracking performance during the gaps of observations. For instance, for a Visual SLAM, illumination change, texture-less area, or motion
blur will cause losses of visual tracks [8108]. For a Lidar system, the
authors propraw Lidar scan data may suffer from skewing caused by high-acceleration motion, such as moving fast or shaking suddenly, resulting in sensing error that is difficult to account for [109]. The work o
f [110] used an
IMU sensor to dea
round-view monitor (AVM)/l with fast velocity changes and to initialize motion estimates for scan-matching Lidar odometry to support their LOAM system. The high-frequency IMU data between two Lidar s
ensor cans can be used to de-skew Lidar point clouds and improve their accuracy [109].
The fusion
of inertial sensors can be as a sim
etple assistant [111][112] or more tigh
tly co
dupled [108][113][114][115]. For t
o recognize the parking lane and to provide rapid loop closinghe simple assistant case, the IMU is mainly used to provide orientation information, such as to support the system initialization. The IMU is used as prior for the whole system, and the IMU measurements are not used for further optimization. For the tightly coupled case, IMU data is fused with Camera/Lidar states to build up measurement models, and then perform state estimation and feedback to the inertial navigation system to improve navigation performance
[116]. The
refore above studiesthe former method is more efficient than the latter, however, it is less accurate [117]. For th
ave demonstrated thae tightly coupled case, a Kalman filter could be used to correct the IMU states, even during GNSS outages [118].
2.5. Deep Learning-Based SLAM
Most
bo
th filterf the aforementioned SLAM methods are geometric model-based
SLAM and optimization-based SLAM can be used to support efficient and accurate vehicle parking assistance (local area mapping and l, which build up models of platform motion and the environment based on geometry. These methods have achieved great success in the past decade. However, they still face many challenging issues. For instance, Visual SLAM (VSLAM) is limited under extreme lighting conditions. For large-scale applications, the model-based methods need to deal with large amounts of information, such as features and dynamic obstacles. Recently, deep learning techniques, such as data-driven approaches developed in the computer vision field, have attracted more attention. Many researchers have attempted to apply deep learning methods to SLAM problems.
Mo
st of the c
alization), even without GNSS. Iurrent research activities focus on utilizing learning-based methods for VSLAM problems since deep learning techniques have made breakthroughs in the
work of Qin et al.areas of image classification, recognition, object detection, and image segmentation [9119]. For instance,
pose graph optimizdeep learning has been successfully applied to the visual odometry (VO) problem, which is an important element of VSLAM. Optical flow estimation is
performed so as tutilized in some learned VO models as inputs [120][121][122][123][124]. The applicatio
n achieve an optimized trof learning approaches can be applied in an end-to-end manner without adopting any module in the conventional VO pipeline [125][126]. Wa
jng e
ctory at al. [125] in
trod
a global map of a parking lot, with semantic features suchuced an end-to-end VO algorithm with deep Recurrent Convolutional Neural Networks (RCNNs) by combining CNNs with the RNNs. With this algorithm, the pose of the camera is directly estimated from raw RGB images, and neither prior knowledge nor parameters are needed to recover the absolute scale [125]. Li et a
l. [127] propos
ed an guide signs, parking lines, and speed bumps. These kiUnsupervised Deep Learning based VO system (UnDeepVO) which is trained with stereo image pairs and then performs both pose estimation and dense depth map estimation with monocular images. Unlike the one proposed by Wang et al. [125], ground
truth is
of features are mornot needed for UnDeepVO since it operates in an unsupervised manner.
The
(l
ong-term) stable and robust thaearning-based methods can be combined with the VSLAM system to replace or add on an individual or some modules of traditional SLAM, such as image depth estimation
[128][129][130], pose est
imation [131][132][133], and loop closur
e [134][135][136][137], etc., to improve the traditional
gme
ometricalthod. Li et al. f[138] propose
d a
tures, especially in underground parking environments. An EKF was then used to co fully unsupervised deep learning-based VSLAM that contains several components, including Mapping-net, Tracking-net, Loop-net, and a graph optimization unit. This DeepSLAM method can achieve accurate pose estimation and is robust in some challenging scenarios, combining the important geometric models and constraints into the network architecture and the loss function.
Sem
atic p
lete the localization system erception of the environment and semantic segmentation are current research topics in the computer vision field. They can provide a high-level understanding of the environment and are extremely important for autonomous
driving.
4. Localization within the Existing Map
Iapplications. The rapid development of deep learning can assist in the introduction of seman
tic map-binformation into VSLAM [139] for sema
ntic se
dgmentation [140][141][142], localization
, a
matchnd mapping
[143][144][145][146][147], and dynam
ic obje
thct removal [148][149][150][151]. So
me d
is used etailed reviews of deep learning-based VSLAM can be found in [92][139][152][153][154].
Fusion wit
h an inertial senso
match “live” data with map informr can also benefit from deep learning techniques, especially the RNN, which has an advantage in integrating temporal information and helping to establish consistency between nearby frames [139]. The integration
, of using methovisual and inertial data with RNN or Long Short-Term Memory (LSTM), a variant of RNN that allows RNN to learn long-term trends
[155], has
u been proven to be more effective and c
h asonvenient than traditional fusion I[156][157][158]. According to Clark et al. [157], t
he
rative Closest Point (ICP), Normal Distribution Transform (NDT), and others data-driven approach eliminates the need for manual synchronization of the camera and IMU, and the need for manual calibration between the camera and IMU. It outperforms the traditional fusion method since it is robust to calibration errors and can mitigate sensor drifts. However, to deal with the drift problem, a further extension of the learning-based [1][10].visual-inertial Thodome
se algorithms can be linktry system to a larger SLAM-like system with loop-closure detection and global relocalization still needs to be investigated.
Compared to the
visual-based SLAM
problem since, the applications of deep learning techniques for laser scanners or Lidar-based SLAM
executes loop closingare still in the early stages and can be considered a new challenge [159]. Vela
nds re-let al. [160] used CNN fo
cr Lida
lizr odometry estimation
using similar methods. For a SLAM pby using the IMU sensor to support rotation parameter estimation. The results are competitive with state-of-the-art methods such as LOAM. Li et al. [161] introduced an end-to-end Lidar
o
blem, the ability to recodometry, LO-Net, which has high efficiency, and high accuracy, and can handle dynamic objects. However, this method is trained with ground truth data, which limits its application to large-scale outdoor scenarios. Li et al. [162] design
ed a vi
ze a previously mapped object or featursual-Lidar odometry framework, which is self-supervised, without using any ground truth labels. The results indicate that this VLO method outperforms other current self-supervised visual or Lidar odometry methods, and performs better than fully supervised VOs. Data-driven approaches also make semantic segmentation of Lidar data more accurate and
to relfaster, making it suitable for supporting autonomous vehicles [163][164][165]. Mo
ving objects ca
te then be distinguished from static objects by LMNet v[166] base
hd on CNNs of 3D Li
cle within the dar scans. One limitation of some cost-effective 3D Lidar applications for autonomous driving in challenging dynamic environment
is essential for correctis is its relatively sparse point clouds. In order to overcome this drawback, high-resolution camera images were utilized by Yue et al. [167] to en
rich the raw 3D point cloud. ERFNet is employed to seg
the mapsment the image with the aid of sparse [11]Lidar data.
Meanwhile, Therefore, the reuse of a pre-generated map to localize the vethe sparsity invariant CNN (SCNN) is employed to predict the dense point cloud. Then the enriched point clouds can be refined by combining these two outputs using a multi-layer convolutional neural network (MCNN). Finally, Lidar SLAM can be performed with this enriched point cloud. Better target segmentation can be achieved with this Lidar data enrichment neural network method. However, due to the small training dataset, this method did not show improvement in SLAM accuracy with the enriched point cloud when compared to the original sparse point cloud. More training and further investigation of dynamic objects may be needed to satisfy autonomous driving application requirements [167].
Th
e generati
cle can be considered an extension of a SLAM algorithm. In other words, the pre-generated and stored map can be treated as a type of “sensor” to support localizon of complex deep learning architectures has contributed to achieving more accurate, robust, adaptive, and efficient computer vision solutions, confirming the great potential for their application to SLAM problems. The availability of large-scale datasets is still the key to boosting these applications. Moreover, with no need for ground truth, unsupervised learning is more promising for SLAM applications in autonomous driving. Compared to the traditional SLAM algorithms, data-driven SLAM is still in the development stage, especially for Lidar SLAM. In addition, combining multiple sensing modalities may overcome the shortcomings of individual sensors, for which the learning methods-based integration system still needs further investigation.