The invention discloses a firefighter safety dynamic path planning and intelligent navigation homeward voyage method and
system, and relates to the field of path planning, and the method comprises the steps: collecting the air pressure, distance, attitude and other data of a fire scene through an air
pressure sensor, a UWB, an electronic
compass and other sensors, obtaining the three-dimensional positioning coordinates of a firefighter through a fusion
algorithm, and carrying out the navigation of the firefighter. Recording tracks and marking feature points to construct a path
database; evaluating a danger level in combination with environmental parameters, and dynamically planning an optimal path by using an improved A *
algorithm; judging getting lost through positioning continuity and the like, triggering return voyage, generating a reference path through reverse track tracing, and correcting the reference path; when the UWB
signal is lower than a threshold value, a
search and rescue request is sent, the position is optimized through
triangulation positioning, the direction is guided, a manual and automatic multi-scene alarm mechanism is constructed, and alarm related data are synchronously transmitted through multiple channels. The
system has the advantages that through precise three-dimensional positioning, dynamic path planning, intelligent homeward voyage and cooperative
search and rescue, the
system adapts to the complex environment of a fire scene, and the
operation safety of firefighters and the emergency disposal efficiency are guaranteed.