A Tutorial on Graph-Based SLAM
Cyrill Stachniss Wolfram Burgard
-
A graph
- Node: The poses of the robot at different points
- Edges: Constraints between the poses. Obtained from observations or movement actions
- a probability distribution over a relative transformations between two pose nodes
- eg odometry measurement, aligning observations from two robot locations.
- Include data association problem. included in front-end.
- tasks of pose graph slam
- Graph construction (Front-end)
- Graph optimization (Back-end)
-
Solutions for SLAM
Estimating the robot trajectory and the map of environment.
- Filtering: on-line state estimation of current robot position and the map
- Smoothing: estimate the full trajectory from full set of measurements.
-
Solving a large error minimization problem to find a configuration of the graph (trajectory) that is maximally consistent with the measurement.
minx∑<i,j>∈CeijTΩijeij \min_{x}{\sum _{<i,j>\in C } e^T_{ij}\Omega _{ij} e_{ij}}\\ xmin<i,j>∈C∑eijTΩijeij
where
eij(xi,xj)=zij−z^ij(xi,xj) e_{ij}(x_i, x_j) = z_{ij}-\hat z_{ij}(x_i, x_j)eij(xi,xj)=zij−z^ij(xi,xj) and Ωij\Omega _{ij} Ωijis information matrix of a virtual measurement.-
Solutions
-
Iterative local linearizations: fist order Taylor expansion around the current guess of xxx ( for x is robot pose)
Some question about sparcse construction and sparse Cholesky factorization.
Summary: Gauss-Newton plus Cholesky factorization.
Practical Application: 2D mapping system
-
Least Squares on a Manifold (Lie group?) ( for x is robot transfomation)
Define a operator map 3D transformation to manifold.
-
-
-
Map:
Map can be parametrized as a set of spatially located landmarks, by dense representations like occupancy grids, surface maps, or by raw sensor measurements.
- map is different from 3d reconstruction? (3d surface map is reconstruction?)
-
Dynamic Bayesian Network (DBN)
- A directed graph to describe stochastic process
- observed variable nodes (like measurements)
- hidden variable nodes (like robot position state, map)
- state transition model
- observation model