Table of contents
- Table of contents
- Executable form
- Diagram of 2D SLAM
- Accumulated error problem
- Data association
- Loop closure
- Batch processing
- Sequential processing
I studied SLAM refer to the following book. I'm introducing my studying log in dividing into multiple articles. In this article, I wrote some fundamental knowledge of SLAM as memo.
First problem of executing SLAM is how a trajectory for getting sensor data should be decided. There are 2 kinds of way to decide the trajectory.
- A robot is given the trajectory by human
- The robot decide the trajectory automatically
|Dimension of robot pos
|Dimension of map
|2D LiDAR, Odometry, Gyro
|2D/3D LiDAR, Camera, Odometry, Gyro
|3D LiDAR, Camera, IMU
Diagram of 2D SLAM
The following diagram is an example of 2D/2D SLAM.
State of Robot
Amount of movement by Odometry
Calculating landmark position depend on robot position
Predicting robot position by odometry
The amount of movement by odometry is minute and the robot can be assumed that it is moving straight. At the same time, an component y can be assumed as 0.
This calculation can be expressed like the following formula.
Accumulated error problem
To resolve this problem, the robot need to measure same landmark multiple times. And then, the robot position can be modified by calculating backward with measured landmark position. In the above diagram, the following simultaneous equations. x1 is an initial position and can not be decided. This is defined as an appropriate constant valuables(usually, the origin of map coordinate system).
Typically, this simultaneous equations can be solved by least squares method.
Typically, association with only position constraint is not efficient. If there were two landmarks at almost same position, it would be difficult to decide which landmarks should be associated. Firstly, association candidates are reduced with an feature value. After that, position constraint will be used for the association.
Loop closure is executed by the following sequence.
Detecting what the robot returned same position. The following diagram is before loop detection. Land mark and , and are same landmarks each other. At that time, the robot position will be modified as a position where and , and become same.
Modifying robot trajectory and map
The original robot position will be modified as follow. And then, need to be modified too because the difference of those positions.
- Robot needs sufficient many sensor data to execute SLAM. This processing is not suitable for real time processing.
- It takes long time to process but an accuracy of map is good.
- Map is being constructing in real time sequentially. This is effective to work in a unknown or dynamic environment.
- Only part of all sensor data is used. The processing time is short but an accuracy of map is not good.