Abstract:The aim of coordinated planning is to avoid robot-to-robot collisions in a multi-robot system, and there are two standard solution approaches: centralized planning and decoupled planning. Our first contribution is a decoupled planning approach that ensures C2-continuous control commands with zero velocities at the start and goal. We benchmark our decoupled approach with a centralized approach. Contrary to literature, we show that for a standard motion planning pipeline, such as the one used by MoveIt!, centralized planning is superior to decoupled planning in dual-arm manipulation: It has a lower computation time and a higher robustness. Our second contribution is an optimization that minimizes the rotational motion of an end-effector while considering obstacle avoidance. We derive the analytic gradients of this optimization problem, making the algorithm suitable for online motion planning. Our optimization extends an existing path quality improvement method. Integrating it into our decoupled approach overcomes its shortcomings and provides a motion planning pipeline that is robust at up to 99.9% with a planning time of less than 1s and that computes high-quality paths.
What problem does this paper attempt to address?
The problem that this paper attempts to solve is: in a dual - arm collaborative robot system, how to effectively perform path planning to avoid collisions between robots, and ensure that the generated paths are of high quality, with short calculation time and strong robustness. Specifically, the paper compares two methods, centralized planning and decoupled planning, aiming to find a planning strategy more suitable for dual - arm manipulation tasks.
### Core Problems of the Paper
1. **Path Quality and Computational Efficiency**
- Centralized planning regards the two robots as a whole for planning. Although the computational complexity is high, it can ensure the completeness of finding solutions, that is, if there is a feasible path, it will surely be found.
- Decoupled planning plans the path of each robot separately and then coordinates these paths through a post - processing step to avoid collisions. This method has a lower computational cost, but in some cases may not be able to find solutions.
2. **Special Challenges of Dual - Arm Collaboration**
- Dual - arm collaborative planning is a special multi - robot planning problem. It not only needs to consider the collision between robots and the environment, but also needs to avoid collisions between the two robots.
- Due to the increase in the degrees of freedom (DoF) of the dual - arm system, standard single - arm motion planning algorithms may no longer be applicable in multi - arm systems, because their calculation time and the amount of calculation in the collision detection module will rise sharply with the increase in degrees of freedom.
### Main Contributions of the Paper
1. **Proposing a New Decoupled Planning Method**
- The author proposes a decoupled planning method based on cubic spline interpolation, ensuring that the control commands have \(C^2\) continuity and the velocity is zero at the starting and ending points. This makes the path smoother and reduces the abrupt changes in the motion of the robotic arm.
2. **Optimizing Path Quality**
- A path post - processing method is proposed to minimize the total movement distance (including translation and rotation) of the end - effector in the Cartesian space. This method extends the existing path quality improvement methods and introduces the theory of how to shorten the movement in the rotation group \(SO(3)\).
3. **Experimental Verification**
- In an actual dual - arm manipulation scenario, centralized and decoupled planning are benchmarked. The results show that in the standard motion planning pipeline, centralized planning is superior to decoupled planning in terms of calculation time and robustness.
### Formula Presentation
- **Path Continuity**
\[
\begin{aligned}
&\text{For position:} & q(c(t)) \\
&\text{For velocity:} & \dot{q}=\frac{\partial q(c(t))}{\partial c}\cdot\frac{\partial c(t)}{\partial t} \\
&\text{For acceleration:} & \ddot{q}=\frac{\partial^{2}q(c(t))}{\partial c^{2}}\left(\frac{\partial c(t)}{\partial t}\right)^{2}+\frac{\partial q(c(t))}{\partial c}\cdot\frac{\partial^{2}c(t)}{\partial t^{2}}
\end{aligned}
\]
Through the above formulas, the paper shows how to ensure the continuity and smoothness of the path, thereby improving the motion planning quality of the dual - arm collaborative robot.