The invention relates to the technical field of
computer vision, and provides a synchronous positioning and mapping method for a
robot under a
corn field canopy, and the method comprises the steps: obtaining and preprocessing an environment image, IMU data and
encoder data, and obtaining visual data, inter-frame motion increment and motion data; updating a world coordinate
system state value based on the inter-frame motion increment; performing visual SFM
processing on the basis of the visual data to obtain an
image acquisition posture and a road sign point position; performing visual
inertia combination to obtain an InEKF initial state; performing InEKF fusion based on the state value of the world coordinate
system, the motion data and the initial state of the InEKF to construct a self-sensing
odometer; and performing nonlinear optimization
processing based on the visual data, the inter-frame motion increment, the motion data and the self-sensing
speedometer to obtain a
pose estimation result and a map
point cloud. According to the method,
feature matching, edge feature supplementation and IMU-
encoder sensor fusion technologies are utilized, and high-robustness and high-precision
robot positioning and map construction adaptive to the whole corn
growth cycle are achieved.