The invention provides a robust multi-layer
parking lot mapping positioning method based on visual
inertia information, and the method comprises the steps: firstly obtaining an original image gray-
scale map and IMU original information, inputting a
feature detection and tracking module, and outputting an
image frame pose and an IMU pre-integration result; then the local vision inertial
odometer module receives the data, VIO optimization is carried out through a sliding window, and the poses of the
key frame and the
loopback frame are judged and output; then, the back-end
graph optimization module receives the
pose construction
factor graph for
global optimization, and
relocation thread acceleration is started; and finally, the floor control and constraint module receives the high-frequency elevation information of the local module, processes the high-frequency elevation information, inputs the processed high-frequency elevation information into a rear-end module, receives a rear-end feedback
pose to eliminate a height accumulated error, and finally outputs a vehicle pose. Compared with the prior art, the method has the advantages that the same-layer mapping availability is improved, the multi-layer mapping robustness is enhanced, and light weight and precision are both considered.