Environment modeling and path planning method based on multi-sensor fusion

Abstract

The invention discloses an environment modeling and path planning method based on multi-sensor fusion. The method comprises the following steps: acquiring an image and laser point cloud data in a camera field of view on an unmanned vehicle at the same time; generating a dense point cloud depth map according to the image and the laser point cloud data; taking coordinate values in the dense point cloud depth map as input, and combining a radial basis function neural network to construct an environment model in a camera view field; and determining a path planning track point sequence of the unmanned vehicle by taking the minimum height and gradient of the track point as a target and taking an environment feature vector threshold value and a single-step length as constraint conditions. The laser point cloud data and the image of the camera are fused to serve as input data of environment model construction, the position information of the obstacles can serve as input weights to be applied to environment modeling, the positioning accuracy of the field concave-convex obstacles in the environment model can be improved, and the search time is shortened.

Description

technical field [0001] The invention belongs to the technical field of autonomous perception and obstacle avoidance of unmanned systems, and in particular relates to an environment modeling and path planning method based on multi-sensor fusion. Background technique [0002] The rapid development of society and science has brought more extensive technical support to the research of intelligent systems. With the development of sensor and computer technology, the research on ground intelligent mobile unmanned platform continues to deepen, and the unmanned vehicle system is one of the typical representatives. Unmanned vehicles are often used to replace humans to perform dangerous, complex and repetitive tasks, such as reconnaissance, search and rescue, transportation, archaeological exploration, sample collection, military strike, etc. Wait. Research work on ground mobile unmanned vehicles is of extensive value for the development of future unmanned systems. [0003] Environm...

AI Technical Summary

Problems solved by technology

Different from the structured urban environment, the wild environment has the characteristics of undulating ground, various obstacles, and no road sign prompts, which lead to a high error rate in the environment perception and path planning of the unmanned vehicle, which brings great difficulties to the environment perception and path planning of the unmanned vehicle. here comes the big challenge

Images