The invention discloses a three-dimensional positioning method for an inspection unmanned aerial vehicle in an underground
pipe gallery based on multi-
sensor fusion, and relates to the technical field of unmanned aerial
vehicle positioning, and the method comprises the following steps: obtaining UWB
distance measurement information, IMU attitude information,
optical flow motion information and TOF
distance measurement information, correcting the UWB and TOF information based on the IMU and
optical flow information, and analyzing the global coordinates of a UWB
label on the unmanned aerial vehicle; acquiring original
point cloud data of the
laser radar, performing motion
distortion compensation on the original
point cloud data through an interpolation
algorithm based on the
pose data of the unmanned aerial vehicle, and converting the original
point cloud data from local coordinates to global coordinates; further calculating the
Euclidean distance between each point cloud coordinate and the UWB
label coordinate, setting a dynamic threshold interval based on the UWB
label positioning result, precision and
pipe gallery mapping data, and filtering the point
cloud data with the distance in the threshold interval; and finally, analyzing the residual point
cloud data through a
laser positioning
algorithm, and outputting a high-precision positioning result of the unmanned aerial vehicle.