The invention discloses a blind guide stick local
obstacle avoidance navigation method based on multi-
sensor fusion, which comprises a telescopic blind guide stick, an RGB-D depth camera, a
radar and other sensors and a high-performance processor, so as to realize accurate
environmental perception and intelligent navigation functions and improve the travel safety and convenience of blind people and
visually impaired people. The method comprises the following steps: acquiring depth information of a surrounding environment through an RGB-D depth camera, providing a three-dimensional
perception capability of a scene, performing auxiliary correction on information acquired by the RGB-D depth camera through a plurality of sensors such as
radar, transmitting the information acquired by the sensors to a high-performance processor, and performing SLAM (Simultaneous Localization and Map Construction)
algorithm so as to obtain the three-dimensional
perception capability of the scene. According to the method, information collected by multiple sensors is fused, the
pose information of the current blind guiding stick is calculated, nonlinear optimization is carried out according to the calculated
pose information and
measured depth information, the result of nonlinear optimization is used for establishing an
octree map of the environment, and a reasonable
obstacle avoidance path is generated according to the
octree map. And the
obstacle avoidance path is fed back to the blind and
visually impaired people in real time in a voice or vibration mode.