Abstract:Whenever a robotic task needs to be defined and adapted based on a reference motion, Dynamic Movement Primitives (DMP) represent a standard and efficient method for encoding it. The nominal trajectory is typically obtained through a Programming by Demonstration (PbD) approach, where the robot is taught a specific task through kinesthetic guidance. Subsequently, the motion is reproduced by the manipulator in terms of both geometric path and timing law. The basic approach for modifying the duration of the execution involves adjusting a time constant characterizing the model. On the contrary, the goal of this paper is to achieve a complete decoupling between the geometric information of the task and the timing law governing the execution, thanks to a new spatial sampling algorithm. This leads to a new DMP concept called Geometric DMP (GDMP), which exhibits the property of being phase-free since the phase variable is no longer constrained to the demonstration timing law. GDMP open up to a variety of applications, including task duration optimization subject to velocity and acceleration constraints and human-in-the-loop applications in co-manipulation tasks. With reference to the latter application, a co-manipulation activity where the robot assists the humans in reproducing simple rehabilitation tasks is considered in this paper as a case study. A custom phase law is designed and the system passivity and stability analyses are carried out. The conclusions drawn through the system stability analysis are validated by the proposed experimental results.
What problem does this paper attempt to address?
The main problem that this paper attempts to solve is the time - dependence of Dynamic Movement Primitives (DMP) and the coupling problem between geometric paths and time laws when dealing with robot cooperative operation tasks. Specifically, the paper proposes a new concept - Geometric DMP (GDMP), which fully decouples geometric information from time laws by introducing a spatial sampling algorithm. This method makes DMP no longer restricted by the time laws during demonstration, so it can be more flexibly applied to various scenarios, such as task execution time optimization, task optimization under speed and acceleration constraints, and applications in human - robot collaborative operations.
### Problems mainly solved in the paper:
1. **Elimination of time - dependence**: In the traditional DMP method, the time law of the trajectory (that is, the evolution of the phase variable \(s(t)\)) is closely related to the time law during demonstration. This leads to the limitations of the traditional DMP in certain application scenarios, such as tasks that require temporary stops or speed changes. Through the proposed spatial sampling algorithm, the paper decouples geometric information from time laws, enabling DMP to be adjusted independently of the time law during demonstration.
2. **Decoupling of geometric paths and time laws**: Through the spatial sampling algorithm, the paper converts the demonstration trajectory into a spatially - sampled trajectory based on the arc - length parameter. In this way, the information of the geometric path is no longer affected by the time law, and different phase variables \(s(t)\) can be freely selected, thereby achieving more flexible trajectory control and optimization.
3. **Optimization of task execution time**: The paper shows how to use the GDMP framework to minimize task execution time by optimizing the phase variable \(s(t)\) while meeting the constraints of speed and acceleration. This optimization method can significantly improve the efficiency and flexibility of tasks.
4. **Application in human - robot collaborative operations**: The paper also explores the application of GDMP in human - robot collaborative operation tasks, especially in rehabilitation task assistance. By designing a custom - made phase law, the paper verifies the passivity and stability of the system and further verifies these conclusions through experimental results.
### Formula presentation:
- **Basic equations of DMP**:
\[
\tau \dot{z}(t)=\alpha [\beta (g - y(t)) - z(t)]+f(s(t)),
\]
\[
\tau \dot{y}(t)=z(t),
\]
\[
\tau \dot{s}(t)=-\delta s(t).
\]
- **Expression of the forcing term \(f(s(t))\)**:
\[
f(s(t))=\sum_{i = 1}^{N}\omega_i\phi_i(s(t))\cdot s(t)\cdot (g - y_0),
\]
where,
\[
\phi_i(s(t))=\frac{b_i(s(t))}{\sum_{j = 1}^{N}b_j(s(t))},\quad b_i(s(t))=\exp\left(-\frac{(s(t)-c_i)^2}{2h}\right).
\]
- **Mathematical formulation of the optimization problem**:
\[
\min_{u(\cdot)}T_f=\int_{0}^{T_f}1\,dt=\int_{0}^{\Delta M}\frac{1}{\dot{s}(t)}\,ds(t),
\]
subject to the following constraints:
\[
s(0) = 0,\quad s(T_f)=\Delta M,\quad \dot{s}(0)=\dot{s}(T_f)=0,\quad \dot{s}(t)\geq0,\quad \ddot{s}(0)=\ddot{s}(T_f)=0.
\]
In addition, additional constraints can be imposed on \(x\) and \(u\).