The invention relates to a visual inertial navigation SLAM method based on
ground plane hypothesis. According to the method, feature points are extracted from an image to perform IMU pre-integration,a camera
projection model is established, and camera internal parameter calibration and external parameter calibration between an IMU and a camera are performed; a
system is initialized, a visually observed
point cloud and a camera
pose are aligned to the IMU pre-integration, and a ground equation and the camera
pose are restored; the ground is initialized to obtain a ground equation, the ground equation under the current camera
pose is determined and back projected to an image coordinate
system, and a more accurate ground region is acquired; and based on state
estimation, all
sensor observation models are derived, camera observation, IMU observation and ground feature observation are fused to do state
estimation, a
graph optimization model is used to do state
estimation, and a sparse
graph optimization and
gradient descent method is used to realize overall optimization. Compared with previous algorithms, the precision of the method is greatly improved, estimation of the camera pose can be limited globally, and therefore accuracy is greatly improved.