The invention discloses a complex environment-oriented body agent navigation and three-dimensional
reconstruction method, and relates to the technical field of body agent navigation, and the method comprises the following steps: collecting environment data around a navigation body, using a fine-grained
octree for close-range key areas (narrow slits and dead corners), adopting coarse
voxel acceleration for a far area, and adopting coarse
voxel acceleration for a near-range key area (narrow slits and dead corners); extracting large planes such as wall surfaces, beam columns and the like by using RANSAC (Random Sample
Consensus), and constructing an environment'abstract skeleton 'for navigation reference; establishing a temporary three-dimensional space based on the
point cloud of the
whole body environment, dividing a plurality of detection planes in the space, performing position correction on an obstacle edge
dot matrix in the detection planes, determining a movable range, and generating a safe motion path in a feasible space by applying a
local planning algorithm;
octree +
differential coding is carried out on a
local map, and only a current activity area and crisis
point cloud are reserved; local full-stack deployment enables navigation to be free of dependence on
remote communication, and sensing, mapping and navigation
closed loop can still be completed when a link is broken.