Velocity Obstacle for Polytopic Collision Avoidance for Distributed Multi-robot Systems

Jihao Huang,Jun Zeng,Xuemin Chi,Koushil Sreenath,Zhitao Liu,Hongye Su

2024-06-10

Abstract:Obstacle avoidance for multi-robot navigation with polytopic shapes is challenging. Existing works simplify the system dynamics or consider it as a convex or non-convex optimization problem with positive distance constraints between robots, which limits real-time performance and scalability. Additionally, generating collision-free behavior for polytopic-shaped robots is harder due to implicit and non-differentiable distance functions between polytopes. In this paper, we extend the concept of velocity obstacle (VO) principle for polytopic-shaped robots and propose a novel approach to construct the VO in the function of vertex coordinates and other robot's states. Compared with existing work about obstacle avoidance between polytopic-shaped robots, our approach is much more computationally efficient as the proposed approach for construction of VO between polytopes is optimization-free. Based on VO representation for polytopic shapes, we later propose a navigation approach for distributed multi-robot systems. We validate our proposed VO representation and navigation approach in multiple challenging scenarios including large-scale randomized tests, and our approach outperforms the state of art in many evaluation metrics, including completion rate, deadlock rate, and the average travel distance.

Robotics,Systems and Control,Optimization and Control

What problem does this paper attempt to address?

The paper primarily focuses on addressing the obstacle avoidance problem faced by polytopic-shaped robots during navigation in distributed multi-robot systems.

Specifically, the paper investigates the following key points:

1. **Problems with existing methods**: Existing multi-robot navigation algorithms often simplify system dynamics or transform the collision avoidance problem into convex or non-convex optimization problems with positive distance constraints when dealing with polytopic-shaped robots. This limits real-time performance and scalability. Additionally, the implicit and non-differentiable nature of the distance function between polytopes poses challenges for generating collision-free behaviors.

2. **Extension of the Velocity Obstacle (VO) concept**: The paper proposes a new method to construct velocity obstacles between polytopic-shaped robots and extends the concept of velocity obstacles to polytopic-shaped robots. This method constructs velocity obstacles based on vertex coordinates and the states of other robots. Compared to existing obstacle avoidance methods for polytopic-shaped robots, this method is more computationally efficient as it does not require an optimization process.

3. **Navigation method for distributed multi-robot systems**: Based on the extended velocity obstacle representation, the paper proposes a navigation method suitable for distributed multi-robot systems. This method enables each robot to independently decide its movement direction to avoid collisions while progressing towards the target location.

4. **Experimental validation**: The proposed velocity obstacle representation and navigation method were validated through multiple challenging scenarios, including large-scale random tests. The results show that the method outperforms existing techniques in several evaluation metrics such as completion rate, deadlock rate, and average travel distance.

In summary, the paper aims to address the obstacle avoidance problem faced by polytopic-shaped robots during navigation in distributed multi-robot systems. It proposes a new velocity obstacle representation method and a navigation strategy based on this representation. Experiments demonstrate the effectiveness and superiority of the proposed method.