The invention belongs to the technical field of unmanned aerial
vehicle control, and particularly relates to an incremental Kd-Tree
laser-inertial fusion positioning method based on improvement, the method provided by the invention adopts a practical filtering scheme, the
operand is small, the real-time performance is high, and the requirement of a
laser radar on an illumination condition is lower than that of a camera, so that the method is very practical. The
noise is much lower than that of visual measurement, so that the precision of the method is higher than that of a visual
algorithm; according to the method provided by the invention, two kinds of data are fused in a
deep level, so that the method is not liable to fail during
strenuous exercise, and a GPU is not needed during operation. The filtering
algorithm adopts an iterative
error state Kalman filtering algorithm, so that the precision of the
system is not very low under
nonlinear motion, and the map
management efficiency is also improved by the improved incremental Kd-Tree
algorithm in the aspect of map management. In conclusion, aiming at a special scene without a GNSS
signal, the
robot can efficiently position the
robot and construct a surrounding environment map only by depending on the sensor of the
robot.