S-Nav: Semantic-Geometric Planning for Mobile Robots

Paul Kremer,Hriday Bavle,Jose Luis Sanchez-Lopez,Holger Voos

2023-07-04

Abstract:Path planning is a basic capability of autonomous mobile robots. Former approaches in path planning exploit only the given geometric information from the environment without leveraging the inherent semantics within the environment. The recently presented S-Graphs constructs 3D situational graphs incorporating geometric, semantic, and relational aspects between the elements to improve the overall scene understanding and the localization of the robot. But these works do not exploit the underlying semantic graphs for improving the path planning for mobile robots. To that aim, in this paper, we present S-Nav a novel semantic-geometric path planner for mobile robots. It leverages S-Graphs to enable fast and robust hierarchical high-level planning in complex indoor environments. The hierarchical architecture of S-Nav adds a novel semantic search on top of a traditional geometric planner as well as precise map reconstruction from S-Graphs to improve planning speed, robustness, and path quality. We demonstrate improved results of S-Nav in a synthetic environment.

Robotics

What problem does this paper attempt to address?

The paper mainly addresses the issue of efficient path planning for mobile robots in complex indoor environments. Traditional path planning methods only utilize the geometric information of the environment and do not fully exploit the semantic information within the environment. The previously proposed S-Graphs can construct a 3D situational graph that integrates geometric, semantic, and relational information to improve the robot's scene understanding and localization capabilities. However, these works have not applied situational graphs to improve the path planning of mobile robots.

To solve this problem, this paper proposes a novel semantic-geometric path planner named S-Nav. S-Nav utilizes the information in S-Graphs to perform fast and robust hierarchical planning. Specifically, it includes the following key contributions:

1. **Novel Hierarchical Planner**: Called S-Nav, it combines geometric, semantic, and relational information to achieve faster path planning.
2. **Semantic Planner**: Used to generate faster global path planning.
3. **Semantic Subproblem Solver**: Further simplifies the global path into local subproblems for the underlying geometric planner to handle.

Through these techniques, S-Nav can achieve faster, more robust, and higher quality path planning in complex indoor environments. Additionally, experimental results show that compared to using only IRRT* (a sampling-based planning algorithm), combining the knowledge of S-Graphs and the subproblem solver of S-Nav can significantly improve the consistency and efficiency of path planning, generate shorter paths, and create more sample points within a given time.