3D Semantic Heuristic Planning for Safer Aerial Robot Navigation Indoors

This paper presents a 3D safe heuristic planner for aerial robot indoor navigation incorporating semantic information of the environment. Our interest lies in how the inclusion of semantic information in industrial environments or buildings can positively affect planning to ensure 3D safe navigation within the environment. The planner is based on an any-angle path planning algorithm, particularly Lazy Theta* algorithm. There are many works in the literature that include non-uniform costs related to distance to the closest obstacles in order to achieve a safe planner, but they generally do not consider the semantic information which is relevant in factories. Semantic-aware planning opens the door to safer plans, adapting the distance to obstacles depending on the category of the objects. Our Semantic Heuristic planner considers the semantic information of all the nodes along the line of sight between an initial and final node. Tests in a 3D environment with corridors, stairs, doors, columns and walls are performed to evaluate the proposed planner with respect to Lazy Theta* algorithms and a cost-aware Lazy-Theta* over Euclidean distance functions. The results show advantages of the Semantic Heuristic planner in terms of safety depending on the type of obstacle, the length of the path and efficiency with respect to the cost-aware Lazy-Theta* which only considers the distance to obstacles in its cost function.