Amirhossein Kazemipour,Oliver Fischer,Yasunori Toshimitsu,Ki Wan Wong,Robert K. Katzschmann
Abstract:Soft robots are made of compliant materials and perform tasks that are challenging for rigid robots. However, their continuum nature makes it difficult to develop model-based control strategies. This work presents a robust model-based control scheme for soft continuum robots. Our dynamic model is based on the Euler-Lagrange approach, but it uses a more accurate description of the robot's inertia and does not include oversimplified assumptions. Based on this model, we introduce an adaptive sliding mode control scheme, which is robust against model parameter uncertainties and unknown input disturbances. We perform a series of experiments with a physical soft continuum arm to evaluate the effectiveness of our controller at tracking task-space trajectory under different payloads. The tracking performance of the controller is around 38\% more accurate than that of a state-of-the-art controller, i.e., the inverse dynamics method. Moreover, the proposed model-based control design is flexible and can be generalized to any continuum robotic arm with an arbitrary number of segments. With this control strategy, soft robotic object manipulation can become more accurate while remaining robust to disturbances.
What problem does this paper attempt to address?
This paper attempts to solve the problem of precise control of soft continuous robots when performing dynamic tasks. Specifically, in view of the modeling difficulties brought by the continuous characteristics of soft robots, the paper proposes a dynamic model based on the Lagrange method, and on this basis, an adaptive sliding - mode control strategy is introduced. This control strategy aims to improve the trajectory - tracking accuracy of soft robots under different load conditions, while enhancing the robustness to model - parameter uncertainties and unknown input disturbances.
### Main problems
1. **Accuracy of dynamic modeling**:
- The continuous nature of soft robots makes it difficult to directly apply traditional rigid - body dynamic models. The paper establishes a more accurate dynamic model through the Lagrange method, avoiding the simplified assumption of concentrating mass at the end of segments, thus improving the accuracy of the model.
2. **Robustness of control strategy**:
- Traditional controllers perform poorly when dealing with model - parameter uncertainties or unknown input disturbances. The adaptive sliding - mode control strategy proposed in the paper can estimate dynamic coefficients online, and by means of the terminal sliding - mode control strategy, the convergence speed of the tracking error is increased, and the robustness of the system is enhanced.
3. **Performance verification in practical applications**:
- The paper verifies the effectiveness of the proposed control strategy through a series of experiments. The experimental results show that, compared with the existing inverse - dynamic controllers, the newly proposed control strategy has higher trajectory - tracking accuracy under different load conditions, especially when performing at high - speed motion and with load changes.
### Solutions
- **Dynamic model**: Establish a dynamic model based on the Lagrange method, considering the mass distribution of each segment and avoiding over - simplified assumptions.
- **Adaptive sliding - mode control**: Combine adaptive control and terminal sliding - mode control strategies to improve the robustness and tracking accuracy of the system.
- **Experimental verification**: Verify the effectiveness and robustness of the proposed control strategy through experiments on actual soft robotic arms.
### Formula summary
- **Dynamic equation**:
\[
M(q)\ddot{q}+C(q, \dot{q})\dot{q}+D(q)\dot{q}+g(q)+k(q)=A(q)p + d
\]
where:
- \(M(q)\) is the generalized inertia matrix.
- \(C(q, \dot{q})\) is the Coriolis/centrifugal force matrix.
- \(D(q)\) is the damping matrix.
- \(g(q)\) is the gravitational force vector.
- \(k(q)\) is the elastic force vector.
- \(A(q)\) is the actuator mapping matrix.
- \(p\) is the air pressure in the fluid cavity.
- \(d\) is the unknown input disturbance.
- **Adaptive control law**:
\[
p = A^\dagger(q)\left(\hat{M}(q)\ddot{q}_r+\hat{C}(q, \dot{q})\dot{q}_r+\hat{D}(q)\dot{q}+\hat{g}(q)+\hat{k}(q)-K_Ds-\hat{b}\text{sign}(s)\right)
\]
where:
- \(\hat{M}(q)\), \(\hat{C}(q, \dot{q})\), \(\hat{D}(q)\), \(\hat{g}(q)\) and \(\hat{k}(q)\) are the estimated feedback linearization terms.
- \(K_D\) is a positive diagonal matrix.
- \(A^\dagger(q)\) is the pseudo - inverse of the mapping matrix.
- \(s\) is the terminal sliding - mode surface.
- \(\hat{b}\) is the estimated value of the upper bound of the unknown disturbance.
- **Adaptation law**:
\[
\dot{\hat{a}}=-\Gamma Y^T(q, \dot{q}, \dot{q}_r, \ddot{q}_r)s, \quad \dot{\hat{b}}=\Psi|s|
\]
where: