Dubins Curve Based Continuous-Curvature Trajectory Planning for Autonomous Mobile Robots

Xuanhao Huang,Chao-Bo Yan

DOI: https://doi.org/10.48550/arXiv.2309.07565

2023-09-14

Abstract:AMR is widely used in factories to replace manual labor to reduce costs and improve efficiency. However, it is often difficult for logistics robots to plan the optimal trajectory and unreasonable trajectory planning can lead to low transport efficiency and high energy consumption. In this paper, we propose a method to directly calculate the optimal trajectory for short distance on the basis of the Dubins set, which completes the calculation of the Dubins path. Additionally, as an improvement of Dubins path, we smooth the Dubins path based on clothoid, which makes the curvature varies linearly. AMR can adjust the steering wheels while following this trajectory. The experiments show that the Dubins path can be calculated quickly and well smoothed.

Robotics,Optimization and Control

What problem does this paper attempt to address?

The problem that this paper attempts to solve is: to plan the optimal trajectory for autonomous mobile robots (AMR) in short - distance situations. Specifically, this research aims to solve the following problems:

1. **Low transportation efficiency and high energy consumption**: Current logistics robots often encounter unreasonable problems in path planning, resulting in unnecessary turning, detouring and other actions, which reduce transportation efficiency and increase energy consumption.

2. **Limitations of Dubins paths**: Although Dubins paths take into account the maximum curvature and direction limitations of AMR, their computational complexity is relatively high, especially in short - distance situations. In addition, Dubins paths are composed of line segments and arcs with fixed curvatures, resulting in discontinuous path curvatures. AMR needs to stop frequently to adjust the steering wheels, which further reduces efficiency and increases energy consumption.

3. **Real - time performance and computational efficiency**: In some application scenarios with strict real - time requirements (such as real - time robot motion planning), quickly calculating Dubins paths is crucial for improving the system's response speed.

### Main contributions of the paper

To solve the above problems, this paper proposes a method based on the Dubins curve set to directly calculate the optimal trajectory in short - distance situations, and smoothes the Dubins path by introducing the Clothoid curve to make the curvature change continuous. The specific contributions are as follows:

- **A fast calculation method for short - distance Dubins paths**: The paper has developed a complete set of calculation methods that can efficiently calculate Dubins paths in short - distance situations without explicitly calculating the lengths of all types of paths.

- **Smoothing treatment based on Clothoid**: By introducing the Clothoid curve, the problem of discontinuous curvature of Dubins paths is solved, allowing AMR to smoothly adjust the steering wheels when following the trajectory, improving transportation efficiency and reducing energy consumption.

- **Experimental verification**: The experimental results show that the proposed Dubins path can be quickly calculated and well - smoothed, and is suitable for logistics robots in practical applications.

### Mathematical formulas

The mathematical formulas involved in the paper include:

- **Differential equation of Clothoid curve**:
\[
d\kappa=\sigma dl
\]
where \(\kappa\) is the curvature of the curve, \(l\) is the length of the curve, and \(\sigma\) is the Clothoid sharpness related to the front - wheel steering speed.

- **Calculation of critical distances**:
\[
d_0 = \max \{d_{ll}, d_{lr}, d_{rl}, d_{rr}\}
\]
where
\[
d_{ll}=\sqrt{4 - (\cos\alpha - \cos\beta)^2 - (\sin\alpha + \sin\beta)^2}
\]
\[
d_{lr}=\sqrt{4 - (\cos\alpha + \cos\beta)^2 - (\sin\alpha - \sin\beta)^2}
\]
\[
d_{rl}=\sqrt{4 - (\cos\alpha + \cos\beta)^2 + (\sin\alpha + \sin\beta)^2}
\]
\[
d_{rr}=\sqrt{4 - (-\cos\alpha + \cos\beta)^2 + (\sin\alpha - \sin\beta)^2}
\]

Through these improvements, this paper provides a more efficient and practical AMR trajectory planning method, especially suitable for short - distance logistics scenarios.