Efficient RRT*-based Safety-Constrained Motion Planning for Continuum Robots in Dynamic Environments

Peiyu Luo,Shilong Yao,Yiyao Yue,Jiankun Wang,Hong Yan,Max Q.-H. Meng

2023-09-25

Abstract:Continuum robots, characterized by their high flexibility and infinite degrees of freedom (DoFs), have gained prominence in applications such as minimally invasive surgery and hazardous environment exploration. However, the intrinsic complexity of continuum robots requires a significant amount of time for their motion planning, posing a hurdle to their practical implementation. To tackle these challenges, efficient motion planning methods such as Rapidly Exploring Random Trees (RRT) and its variant, RRT*, have been employed. This paper introduces a unique RRT*-based motion control method tailored for continuum robots. Our approach embeds safety constraints derived from the robots' posture states, facilitating autonomous navigation and obstacle avoidance in rapidly changing environments. Simulation results show efficient trajectory planning amidst multiple dynamic obstacles and provide a robust performance evaluation based on the generated postures. Finally, preliminary tests were conducted on a two-segment cable-driven continuum robot prototype, confirming the effectiveness of the proposed planning approach. This method is versatile and can be adapted and deployed for various types of continuum robots through parameter adjustments.

Robotics

What problem does this paper attempt to address?

The problem that this paper attempts to solve is: **To achieve efficient and safe motion planning for continuum robots in dynamic environments**.

### Specific problems and challenges:
1. **High degrees of freedom and complexity**:
- Continuum robots have an infinite number of degrees of freedom (DoFs), which requires a large amount of computational time during motion planning, thus hindering their practical applications.

2. **Autonomous navigation and obstacle avoidance in dynamic environments**:
- In dynamic environments, continuum robots need to adapt to constantly changing obstacles and other uncertain factors in real - time. Traditional motion planning methods are difficult to deal with such complexity and rapidly changing environments.

3. **Safety constraints**:
- In order to ensure the safety of the robot during task execution, safety constraints must be introduced, especially for obstacle avoidance in the robot's pose state.

### Methods proposed in the paper:
- **Motion planning method based on RRT***:
- This method combines the advantages of the RRT* algorithm, can efficiently explore feasible paths, and deals with the geometric characteristics of continuum robots by introducing the optimization - Jacobian method.

- **Embedding safety constraints**:
- By extracting safety constraints from the robot's pose state, it is ensured that the robot can autonomously navigate and avoid obstacles in a rapidly changing environment.

### Main contributions:
1. **For the first time, applying RRT* to the motion planning of continuum robots in dynamic environments**:
- Combining the optimization constraints and the geometric characteristics of the soft robot model, emphasizing the geometric safety constraints.

2. **Improving the performance in scenarios with more dynamic obstacles**:
- Verified by simulation, this method significantly reduces the computational time and outperforms other methods in terms of success rate.

3. **Experimental verification of the effectiveness of the method**:
- In actual experiments, a two - section cable - driven continuum robot prototype was tested, confirming the feasibility of this method in real - time control.

### Summary:
The main objective of the paper is to develop an efficient and safe motion planning method, enabling continuum robots to autonomously navigate and avoid obstacles in dynamic environments. By combining the RRT* algorithm and the optimization - Jacobian method, the paper successfully addresses the challenges of motion planning for continuum robots in dynamic environments.