Next Article in Journal
Micromagnetic and Robust Evaluation of Surface Hardness in Cr12MoV Steel Considering Repeatability of the Instrument
Next Article in Special Issue
Recent Progress of Tactile and Force Sensors for Human–Machine Interaction
Previous Article in Journal
An Electrochemical Sensor for Sulfadiazine Determination Based on a Copper Nanoparticles/Molecularly Imprinted Overoxidized Polypyrrole Composite
Previous Article in Special Issue
Comparison of Different Technologies for Soft Robotics Grippers
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

A Hybrid Controller for a Soft Pneumatic Manipulator Based on Model Predictive Control and Iterative Learning Control

1
School of Mechanical Engineering and Automation, Harbin Institute of Technology (Shenzhen), Shenzhen 518055, China
2
Guangdong Key Laboratory of Intelligent Morphing Mechanisms and Adaptive Robotics, Shenzhen 518055, China
*
Author to whom correspondence should be addressed.
Sensors 2023, 23(3), 1272; https://doi.org/10.3390/s23031272
Submission received: 14 December 2022 / Revised: 10 January 2023 / Accepted: 17 January 2023 / Published: 22 January 2023

Abstract

:
Due to the outstanding characteristics of the large structural flexibility and strong dexterity of soft robots, they have attracted great attention. However, the dynamic modeling and precise control of soft robots face huge challenges. Traditional model-based and model-free control methods find it difficult to obtain a balance between complexity and accuracy. In this paper, a dynamic model of a three-chamber continuous pneumatic manipulator is established based on the modal method. Moreover, a hybrid controller integrating model predictive control (MPC) and iterative learning control (ILC) is proposed, which can simultaneously perform model parameter learning and trajectory tracking control. Experimental results show that the proposed control method can optimize the parameters of the dynamic model in real time with less iterations than the traditional model-free method and have good control performance in trajectory tracking experiments. In the future, the proposed dynamic model and the hybrid controller should be verified on a multi-section manipulator.

1. Introduction

Differently from rigid robots, soft continuum manipulators benefit from great compliance, lightweight, safer interaction, and a high power-to-weight ratio [1,2,3]. There has been increasing research on continuum robotics in recent years. They have a promising future and provide new capabilities in some fields, such as surgical applications [4,5] where continuum robots perform better when passing through narrow passages between organs for their flexible mechanisms and dexterous mobility [6]. There have been many attempts at soft robots in bionics design, such as octopus tentacles [7,8], manta [9], caterpillars [10], and elephant trunks [11,12]. Soft continuum manipulators are mainly divided into two categories according to their actuation methods: cable-driven manipulators [13,14] and pneumatically actuated manipulators [15,16]. Compared with general cable-driven continuum robots, pneumatic robots are more lightweight and compliant. This is due to the physical properties of the air used for both actuation and structure. However, the advantages of soft pneumatic continuum robots come with the trade-off of complexity in their modeling and control [17]. Due to the continuity, non-linear flexible material, and the unlimited number of degrees of freedom of the manipulator [18], it is challenging to establish its model.
The common assumptions of traditional rigid multi-segment robots do not apply to soft robots. At this stage, for soft manipulators, kinematics modeling is mainly studied [19,20]. OctArm by Walker et al. [21] is a successful implementation of a multi-section continuum robot using a pneumatic muscle actuator, according to the model proposed by Jones et al. [22]. However, the system dynamics is still a challenge and the using of different materials will make it even more difficult. Soft materials such as silicone, eco flex, rubber, or gel have high hyper-elasticity [23], which needs to be considered in the continuum mechanics model instead of extending the classical elastic beam theory used for rigid robots to soft robots. Early dynamic model derivations are mainly presented by Chirikjian [24] for a hyper-redundant manipulator, by Khalil et al. [25] for a serial eel-like robot, and by Matsuno and Sato for a snake robot [26]. However, most robots in these studies have rigid connections. They are not suitable for robots with completely flexible structures. Tatlicioglu et al. [27] deduced the dynamic model of the continuous manipulator arm. Godage I et al. [28] further deduced the dynamic model of each cavity in the three-dimensional space, but his study was limited in special experimental materials and background. The latest study on the dynamic model of soft robots is based on the Cosserat rod model proposed by Gazzola et al. [29] to capture the shearing, bending, and stretching of the continuum section. Although this model has extensively proven its applicability in various environments, its calculation process is too complicated to be applied in real-time control. In terms of the control algorithm of soft robots, the existing control methods are mainly divided into three categories: model-free method, model-based method, and the method based on hybrid controller [30]. Model-free methods are usually based on machine learning techniques or empirical evidence. Although such controllers have great advantages in highly nonlinear and non-uniform conditions, stability and convergence are difficult to guarantee due to probabilistic or non-parametric properties [31].
In applications that require high stability and predictable system behavior, model-based methods are a more appropriate choice. Model-based controllers usually require analytical models to derive the controller, and these controllers tend to perform better in terms of accuracy and reliability [32]. However, they need to define an accurate dynamic model of the soft robot which is not easy due to its flexible structure [33]. In addition, advanced accurate modeling methods are limited due to their computational complexity and the cost of the required sensors. Hybrid controllers [30] combine model-free and model-based controllers, usually based on the model to capture the main part of the system’s inherent properties, which are used to learn the model, thereby supplementing the dynamic uncertainty.
In this article, we use the modal method based on the CP kinematics of the continuous soft robot. It reduces the degree of numerical nonlinearity and eliminates singularity problems effectively, speeding up the solution of the dynamic model. The dynamic model of the three-chamber soft manipulator presented in this paper was established by this method. Based on the derived dynamic model, MPC and ILC are combined as a hybrid controller, which can perform model parameter learning and trajectory tracking at the same time. The simulation result shows that the control algorithm proposed in this paper can optimize and update the model parameters in real time. Compared with the traditional model-free closed-loop feedback control (e.g., PID controller), it can obtain higher tracking accuracy with fewer iterations. In addition, it can obtain more accurate model parameters according to different prototypes, and adapt to the inconsistent prototype parameters caused by manufacturing process.
Compared with existing research, the major contribution of this paper is as follows.
  • Taylor expansion was used to solve kinematics singular solution problems.
  • Universal dynamic modeling for the three-chamber continuous pneumatic manipulator is presented based on the modal method.
  • A hybrid controller integrating the model predictive control method and iterative learning control method was proposed.
The scientific flowchart of this paper is shown in Figure 1. The rest of this paper is organized as follows. Section 2 describes the designing and manufacturing method of the multi-chamber continuous soft manipulator. Section 3 describes the kinematics and dynamic model. Section 4 describes the derivation process of the model-based parameter adaptive learning control algorithm. In Section 5, simulations based on different control algorithms are conducted and compared. In Section 6, experiments are carried out and the results are analyzed. Finally, conclusions are made in Section 7.

2. System Description

The prototype is shown in Figure 2a. It contains chambers, inner layer, fiber, and the outer layer. The three chambers are separated by 120° intervals and their radii is equal. This structure enables the soft pneumatic manipulator to extend and contract, as well as bend in the space. Inspired by the design in [34], each pneumatic chamber is reinforced with a thin nylon fiber, forming a tight spiral on the outside of the cavity in the form of a diagonal. The radial expansion of the soft manipulator is limited and axial stretching is allowed. The purpose of covering the fiber layer with a silica layer is to prevent the fiber from slipping, which will affect the bending angle of the manipulator.
The manufacturing process of the soft pneumatic manipulator is shown in Figure 3. Firstly, silica gel (Ecoflex-0300) is used as the raw material, and the A-liquid and the B-liquid are mixed with the same quality. After stirring, they are put into a vacuum box to remove the dissolved air so as to avoid bubbles forming in the soft arm. Subsequently, the inner molds, as shown in Figure 3a, were coated with a release agent (Vaseline) to facilitate demolding. The silica gel is poured into the mold and placed in the heating box for solidification. After the manipulator is formed, the fiber layer is wound around it. The thickness of the fiber layer is 2 mm. Then it is put into the outer layer mold again, and the evenly mixed silica gel is poured.

3. System Modeling

3.1. Kinematic Modeling

Based on the assumption of constant curvature, a continuous curved section can be described by three independent parameters { θ , φ , λ } . As shown in Figure 4, θ indicates the rotating angle, which is the angle between the bending plane and the x-axis. φ indicates the bending angle. λ indicates the bending radius. Note the length variation of the three chambers { l 1 , l 2 , l 3 } , the original length L 0 and the radius r of soft manipulator. The parameter relationship of the bending section can be written as:
λ = ( 3 L 0 + l 1 + l 2 + l 3 ) r 2 l 1 2 + l 2 2 + l 3 2 l 1 l 2 l 1 l 3 l 2 l 3
ϕ = 2 l 1 2 + l 2 2 + l 3 2 l 1 l 2 l 1 l 3 l 2 l 3   / ( 3 R )
θ = tan 1 ( 3 ( l 3 l 2 ) / ( l 2 + l 3 2 l 1 ) )
As for soft pneumatic manipulators, robot mapping describes the coordinate transformation between task space and configuration space. While the traditional Denavit–Hartenberg [35] is not applicable due to the flexibility of the proposed manipulator, the homogeneous transformation matrix can be derived by applying the standard rotational and translational matrices. As shown in Figure 4, according to the bending parameters { θ , φ , λ } , the homogeneous transformation matrix shows the relationship between the base coordinate system and the tip end coordinate system of the manipulator. It can be written as:
T c ( ξ , q ) = R z ( θ ) P x ( λ ) R y ( ξ ϕ ) P x ( λ ) R z T ( θ ) = [ R c ( ξ , q ) P c ( ξ , q ) 0 1 × 3 1 ]
where ξ [ 0 , 1 ] represents the normalized position parameter. When located at the base, ξ = 0 . When located at the top, ξ = 1 . The generalized coordinates q = [ l 1   l 2   l 3 ] T . Rz and RY are the rotation matrices about the z-axis and y-axis, respectively. Px is the homogeneous translation matrix. Some elements (see Appendix A for details) are as follows:
[ R c ] 11 = cos ( ξ ϕ ) cos 2 θ + sin 2 θ [ R c ] 12 = cos θ sin θ ( cos ( ξ ϕ ) 1 ) [ R c ] 13 = sin ( ξ ϕ ) cos θ [ P c ] 1   = λ cos θ ( 1 cos ( ξ ϕ ) )
If the pressure in the three chambers is the same, the manipulator will stretch along the axial direction. At this time, both the bending angle and the bending radius tend to infinity, which leads to singularities in the kinematics solution. On the other hand, from the above Equations (1)–(3), it can be seen that bringing { l 1 , l 2 , l 3 } into { θ , φ , λ } , respectively, and then the elements in the homogeneous transformation matrix, will produce many triangular and denominator terms. As a result, the calculation will be very complicated. Thus, in this paper, the high-order Taylor expansion of each element will be expressed as a numerically stable multivariate polynomial form. The modal matrix can be obtained as follows:
[ R ] 11 = ( l 2 2 l 1 + l 3 ) 2 ( ξ 2 18 r 2 + μ 2 ξ 4 486 r 4 + μ 4 ξ 6 32805 r 6 ) + 1 [ R ] 12 = 3 ( l 2 l 3 ) ( l 2 2 l 1 + l 3 ) [ ξ 2 18 r 2 + u 2 ξ 4 486 r 4 u 4 ξ 6 32805 r 6 ] [ R ] 13 = ( l 2 2 l 1 + l 3 ) [ ξ 3 r 2 u 2 ξ 3 81 r 3 + 2 u 4 ξ 5 3645 r 5 ] [ P ] 1 = ( 3 L 0 + l 1 + l 2 + l 3 ) ( l 2 2 l 1 + l 3 ) [ ξ 2 18 r + u 2 ξ 4 486 r 3 u 4 ξ 6 32805 r 5 ]
where u = l 1 2 + l 2 2 + l 3 2 l 1 l 2 l 1 l 3 l 2 l 3 . It can be found that this model is completely composed of numerically stable multivariate polynomials, which eliminates the problem of singularities and reduces the complexity of calculations, making it easy to find derivation.

3.2. Dynamic Modeling

When establishing the dynamic model, the curved section is divided into countless small slices. The thickness of each slice is s Δ ξ , where s = λ φ represents the arc length of the central axis. Note the modal rotation matrix as R ( q , ξ ) 3 × 3 and the modal position vector as P ( q , ξ ) 3 .
The linear velocity at the center of a slice is:
v ξ b = R T P ˙ ( q , ξ ) = R T P ( q , ξ ) q T q ˙
and the angular velocity with respective to the base coordinate axes is:
w ξ b = R T ( R ˙ R T ) = ( R T R ˙ )
Thus, the velocity vector of a single slice is:
δ M ( q ) = δ m d i a g { 1 , 1 , 1 , r 2 4 , r 2 4 , r 2 4 }
where J ξ b ( q ) is the modal Jacobian matrix.
Note the mass of continuum section is m , the inertial matrix of any slice is:
δ M ( q ) = δ m d i a g { 1 , 1 , 1 , r 2 4 , r 2 4 , r 2 4 }
According to the velocity vector, the kinetic energy of any slice can be derived by:
δ K ( q , q ˙ ) = 1 2 ( V ξ b ) T δ M ( q ) ( V ξ b ) = 1 2 ( J ξ b q ˙ ) T δ M ( q ) ( J ξ b q ˙ )
and with the assumption of equal density, the total kinetic energy is then calculated by integrating all slice kinetic energies as:
K ( q , q ˙ ) = 0 1 δ K ( q , q ˙ ) d ξ = 1 2 q ˙ T M ( q ) q ˙
where the generalized mass matrix is defined as in Equation (13)
M ( q ) = 0 1 ( J ξ b ) T δ M ( q ) ( J ξ b ) d ξ
Due to the particularity of the silicone material, the potential energy of the soft manipulator consists of three parts: gravitational potential energy, elastic potential energy, bending potential energy. The gravitational potential energy can be calculated by modal position vector as:
P G ( q ) = m 0 1 P ( q , ξ ) g d ξ
The elastic potential energy is caused by the elongation or contraction of the silicone material chamber. It can be described as:
P E ( q ) = 1 2 q T K e q
where K e = d i a g { k e 1 , k e 2 , k e 3 } is the elastic stiffness matrix of the joint space and k e i is the elastic stiffness coefficient of each chamber.
To simplify the calculation of the bending potential energy, the assumption is cited that the bending potential energy is proportional to the square of the bending angle. Thus, the bending potential energy of soft continuum manipulator can be derived by
P B ( q ) = 1 2 K b ( ϕ 2 ) 2 = K b ( l 1 2 + l 2 2 + l 3 2 l 1 l 2 l 2 l 3 l 1 l 3 18 R 2 )
where K b is the bending stiffness coefficient of the arm which is assumed to be constant. In summary, the potential energy of the soft continuum manipulator is
  P ( q ) = P G ( q ) + P E ( q ) + P B ( q )
The Lagrangian function of the system is defined by L = KP, and the equation of motion can be obtained by applying the Euler–Lagrange equation formulated in Equation (18).
d d t L q ˙ L q = P a
The newly derived dynamics of the soft pneumatic manipulator is obtained in matrix form as:
M ( q ) q ¨ + C ( q , q ˙ ) q ˙ + G ( q ) = F
where C ( q , q ˙ ) is the centrifugal and Coriolis forces matrix that can be derived by:
c k j = i = 1 3 1 2 [ M k j q i + M k i q j M i j q k ] q ˙ i
and G ( q ) is the conservative forces vector that can be derived by G ( q ) = p / q i .

4. Control Algorithm

In the process of establishing the mathematical model, in order to simplify the modeling difficulty, assumptions such as the constant curvature [36] and equal linear density were made. However, due to the non-linearity of the soft material itself, the relationship between the pressure and the length change of the chambers based on the dynamic model is not completely accurate. In order to further improve the accuracy of the model, a parameter adaptive learning control method based on the dynamic model is proposed. The control algorithm diagram is shown in Figure 5 as follows.

4.1. Parameters of the Control Model

According to the dynamic model of the continuous section, the motion equation of a single chamber after decoupling can be equivalently expressed as:
J q ¨ + D q ˙ + K q = a P
where J is the equivalent moment of inertia, D is the equivalent damping coefficient, K is the equivalent stiffness, a is the cross-sectional area. Converted to the form of the state space equation:
x ˙ = A x + B u ;   y = C x
Through the Laplace transform, the system transfer function is obtained as:
G ( s ) = Y ( s ) U ( s ) = C [ s I A ] 1 B = a J / ( s 2 + D s + K J )
However, in a real control situation, the system runs discretely. In this paper, a zero-order holder is used to discretize the continuous system, and the sampling time is set as 0.1 s. The system pulse transfer function is derived through z transformation:
G ( z ) = ( p 1 z 1 + p 2 z 2 ) / ( 1 + p 3 z 1 + p 4 z 2 )
Thus, the control model parameters can be expressed as p = [ p 1 p 2 p 3 p 4 ] T .

4.2. Hybrid Controller

The soft pneumatic manipulator is assumed to be a linear time-invariant system. A linear MPC controller will be used. The cost function of the model predictive control method is:
m i n u i k = 1 k = H { Q ( y i r e f ( k ) y i ( k ) ) 2 + R u i 2 ( k ) }
Subject to:
x i ( k + 1 ) = A x i ( k ) + B u i ( k ) ;   y i ( k ) = C x i ( k ) y m i n y i ( k ) y m a x ;   u m i n u i ( k ) u m a x
where y r e f is the reference length of the chamber, Q and R are the output and input weight factors, respectively, H is the prediction horizon. The input pressure of the soft pneumatic manipulator corresponding to the system parameters at the sampling time is optimized through model predictive control. The optimized input air pressure is used as the feedback pressure.
Iterative learning control has no requirements on the model, but the dynamic model parameters of the soft pneumatic manipulator derived previously can be used as the starting point of the iteration, which can greatly accelerate the iteration speed and reduce the number of iterations.
u i + 1 ( k ) = u i ( k ) + λ E i r ( k + 1 ) y i r e f = [ y i r e f ( 1 ) y i r e f ( 2 ) y i r e f ( N ) ] N × 1 T y i = [ y i ( 1 ) y i ( 2 ) y i ( N ) ] N × 1 T
where E i r = y i r e f y i representing error between reference length and actual chamber length; k is sampling instant; i is the number of iterations. The feedforward input coefficient λ is a constant.

4.3. Model Parameters Iterative Learning Law

The relationship between model input and output is expressed as:
y ( k t ) = p i 1 z 1 + p i 2 z 2 1 + p i 3 z 1 + p i 4 z 2 u ( k t )
where y ( k t ) is the model estimated chamber length. Through the inverse z transformation, we can obtain:
φ ( k ) = [ u ( k 1 ) u ( k 2 ) y ( k 1 ) y ( k 2 ) ] T
where k = 2, 3, …, N, and N = T / T s , T s is sampling time. Then we have:
y ( k ) = φ ( k ) T p
Input the same pressure, the error between the actual change of chamber length and the change predicted by the model is:
E i t = y ( k ) y ( k )
where y ( k ) = φ ( k ) T p i is the estimated length change, y ( k ) = φ ( k ) T p t is the true length change and p t is the true model parameter.
The estimated model is constantly being updated by minimizing the error E i t , as shown by the following quadratic function. Then the Gauss–Newton method [37] is applied to update the model parameters.
m i n θ i E i t 2 2

4.4. Parameter-Adaptive-Learning Control Algorithm

A complete algorithm description about parameter-adaptive-learning control based on the soft continuum section dynamic model is presented in Algorithm 1. Note ε r as the error tolerance between the reference length and the actual length. ε t is the error tolerance between the actual length and the model estimated length.
Algorithm 1. Model parameters learning adaptive control
Step1: Initialize the model parameter M 0 , Plan length trajectory y r e f ;
Step2: Obtain the initial pressure u 0 based on MPC;
Step3: Compare with length tolerance ε t and ε r .
Step4: Obtain u i m trough model parameters iterative learning law and MPC
Step5: Obtain u i l based trough ILC
Step6: Obtain total input pressure u i , real chamber length y i t and model estimated length y i p trough real system and estimated model, respectively. Then go to step 3.
To summarize, in this section, a model-based parameter adaptive learning control algorithm is proposed for the soft pneumatic manipulator. The previously established dynamics model of the manipulator is used. A hybrid controller integrating MPC and ILC is proposed and integrated into the parameter learning control law. Real-time optimization and update of model parameters is realized in the form of online learning. It can improve the accuracy of the dynamic model and achieve trajectory tracking with a small number of iterations. This control algorithm is verified by simulation, and results show that the control proposed algorithm has faster convergence and higher control precision.

5. Simulation

In order to verify the effect of the control algorithm on the parameter learning of the dynamic model and the desired chamber length change trajectory tracking, a single-chamber soft pneumatic manipulator is used to carried out the verification simulation.

5.1. Control Algorithm Simulation

The dynamic parameters of the soft continuous section are shown in Table 1.
Then we can obtain the initial continuous time model:
G ( s ) = 4 / ( s 2 + 1.78 s + 173 )
The discretization of the control system is realized by using the zero-order holder with the sampling time of 0.1 s. The discretization result is:
G ( z ) m = 0.016 z 1 + 0.015 z 2 1 0.468 z 1 + 0.837 z 2
and the initial parameter of the model is p i n i t = [ 0.016   0.015     0.0468   0.837 ] T . In the simulation, we assume that the real continuous-time system is:
G ( s ) t = 8 / ( s 2 + 4 s + 400 )
Similarly, the discretization result is:
G ( z ) t = 0.025 z 1 + 0.021 z 2 1 + 0.666 z 1 + 0.671 z 2
The reference length which represents the change of the chamber length is set to be the tracking target. The minimum jerk theory [38] is used to plan the motion trajectory. When jerk movement is minimized, higher-order polynomials will be reduced to fifth-order polynomials. The reference trajectory can be expressed as:
r ( t ) = l m i n + ( l m a x l m i n ) × [ 10 ( t T ) 3 15 ( t T ) 4 + 6 ( t T ) 5 ]
The relevant parameters of the control algorithm during the simulation are shown in Table 2.
The simulation results are shown in Figure 6. We can see that using the initial model parameters obtained by the dynamic model as the starting point, the model parameters gradually converge to the real model parameters during the adaptive control learning process. This result effectively proves the convergence of the control algorithm. It also shows that the real system parameters can be obtained through the rapid iterative learning of the control algorithm and if we take the dynamic model parameters as the initial values, the trajectory tracking simulation can be achieved with better performance.
In addition, as the number of iterations increases, the input pressure is brought into the real model and the estimated model, respectively. It can be seen from Figure 7a that the chamber length of the estimated model gradually tends to the real chamber length after model parameter iterative learning. The root mean square error (RMSE) between the estimated chamber length and the real length is shown in Figure 7b. After 15 iterations, the RMSE approaches 0. This result indicates that the proposed control algorithm can effectively improve the accuracy of the model parameters. In Figure 7c we can see that the real chamber length gradually tends to the reference length. The RMSE between them is presented in Figure 7d which shows that, after 20 iterations, the RMSE is 0.57 mm. Compared to the 150 mm long manipulator, this RMSE value is very small. This result indicates the good convergence performance of the control algorithm in length control.

5.2. Comparison with Traditional Model-Free Algorithms

A diagram of a traditional model-free closed-loop feedback control algorithm is shown in Figure 8 (classic PID controller is selected here). Assume that the rest of the simulation parameters are the same as Table 2 and reference trajectory is also set as Equation (37).
The simulation results are shown in Figure 9. It can be seen from Figure 9a that in the first 5 control cycles, the error between the real chamber length and the reference chamber length is large. The real chamber length fluctuates greatly. RMSE is about 5 mm, which is always called the “overshoot” phenomenon. Figure 9b shows the RMSE between the reference chamber length and the real chamber length, which are obtained by the classic PID control algorithm and the proposed control algorithm, respectively. The RMSE value of the proposed parameter adaptive learning control algorithm is significantly smaller than the PID controller in the beginning. Moreover, the proposed control algorithm needs less iterations to achieve good trajectory tracking performance. After the 5th iteration of learning, the RMSE is 0.4 mm, which is lower than the RMSE value of PID method after 25 control cycles. Most importantly, the accuracy of the model parameters is gradually adjusted and perfected by the proposed control algorithm, which cannot be achieved by the traditional model-free closed-loop feedback control algorithm.

5.3. Effect of Initial Model Parameter Value

To analyze the influence of the initial value of the model parameters on the performance of the control algorithm, simulations withs different initial model parameters are carried out. Three different parameters are set, such as p 1 = [ 1 ;   1 ;   1 ;   1 ] T , p 2 = [ 1 ;   1 ;   1 ;   1 ] T , and p 3 = p i n i t , where p i n i t is the dynamic model parameter. Taking p 3 as a detailed example, all control parameters are the same as Table 2 except the initial model value.
It can be seen from Figure 10 that for different initial values of model parameters, the algorithm can guarantee the convergence to the real model parameters. When p i n i t is used as the initial model value, the convergence speed is the fastest. After the 12th iteration, it has almost converged to the real model parameters and satisfies the tolerance. However, under the other initial values, at least 20 iterations are required to meet the tolerance. This indicates that the establishment of an accurate initial values of model parameters can speed up the convergence of the control algorithm and reduce the amount of iterative learning.

5.4. Effect of Reference Length Change Trajectory

To analyze the influence of the reference length change trajectory, we set different types of reference trajectories to obtain the length change of the manipulator’s chamber. All control parameters are the same as Table 2, except the reference trajectories.
In the simulation results in Figure 11, a trajectory tracking effect under the step length change, the rectangular wave length change, and the sine wave length change are, respectively, shown. As shown in Figure 11b,d,f, the RMSE under the sine wave reference trajectory becomes almost 0 after 15 iterations, and the RMSE under the step signal reference trajectory also changes from 5.3 mm to 1 mm after 15 iterations. Even if the step chamber length change is used as the reference trajectory, the tracking error can still gradually converge towards the decreasing direction with iterations, and the error is reduced by 72%. It is further verified that the proposed control algorithm can maintain convergence under different reference trajectories.

6. Experiments

In this section, we conduct some preliminary experiments for the single-chamber and the three-chamber soft pneumatic manipulators to verify our control method. Figure 12 shows the experimental setup of the soft manipulators. The upper computer is used to run control algorithms, dynamic model solving, and other scenarios that require higher computing power. The lower computer uses the advantages of the MCU to control and drive the proportional valve.

6.1. Verification Experiment of the Control Algorithm for Single-Chamber Manipulator

The single-chamber soft manipulator has only one degree of freedom. The change of the manipulator’s length is planned. The corresponding expressions for setting the desired length change trajectory are the same as Equation (34). Set the sampling period T = 8 s, and the sampling time Ts = 0.2 s. The setting of the control algorithm parameters is consistent with the simulation. Take the single-chamber soft manipulator dynamic model parameter p i n i t = [ 0.016   0.015   0.0468   0.837 ] T as the initial value of the model for iterative learning control.
Experiment results are shown in Figure 13. As shown in Figure 13a, the manipulator begins to elongate after being pressurized. It can be seen from Figure 13c that in the first sampling period, the maximum chamber length change is 21.3 mm, which is 8.7 mm away from the expected length change peak 30 mm. The relative error is. As the number of iterations of the control algorithm increases, the real chamber length change keeps approaching the desired length change trajectory. After 10 iterations, the maximum length of the chamber change is 28.3 mm, which is 1.7 mm away from the expected peak trajectory, and the error is reduced to 5%. Figure 13d shows the RMSE of the real chamber length and the expected trajectory at each sampling time. It can be seen that RMSE has been decreasing from the initial 7.3 mm, and when the sampling ends after 16 iterations, it becomes 0.9 mm, which verifies the expected trajectory tracking performance of the proposed control algorithm. Similarly, Figure 13e,f show the performance of the control algorithm model parameter learning. The model estimated chamber length continues to tend to the actual chamber length, and the corresponding RMSE continues to decrease.

6.2. Verification Experiment of the Control Algorithm for Multi-Chamber Manipulator

Compared with the single-chamber actuator, the three-channel soft manipulator can perform linear contraction and bending motions in the space. We plan the trajectory of the three chamber lengths in joint space. As shown in Figure 14a, each chamber uses a different form of step signal as the desired length change trajectory, and the peak change length of each chamber is 30 mm, 20 mm, and 10 mm, respectively. For the convenience of display, the expected length change of each chamber is brought into Equation (2) to obtain the expected bending angle of the soft arm under the assumption of equal curvature segments.
The experimental results are shown in Figure 14. It can be seen from Figure 14c that in the first iteration when the dynamic model is used as the initial value of the soft arm model, the peak bending angle is 102°. Compared with the expected trajectory peak bending angle of 126°, the error between the real bend angle and the desired bend angle (obtained through desired chamber lengths) is 20.1%. As shown in Figure 14d, the RMSE of the first iteration in the multi-chamber manipulator is 18.97°. With the iterative calculation of the control program, the error gradually decreases.
This result shows that the three-chamber soft manipulator is complicated, which makes it difficult to model the dynamics model and the accuracy is low. However, with continuous iterative operation, under the effect of the parameter adaptive learning control algorithm, the actual bending angle is basically the same as the expected trajectory trend, and the RMSE in each sampling period is gradually reduced. The RMSE value of the dynamics model changes from 18.97° to 1.92° after 10 iterations. It is reduced by 87% from the original value. This result verified the effectiveness of the model-based parameter adaptive learning control algorithm for the three-chamber soft manipulator.

6.3. Trajectory Tracking Experiment for the Multi-Chamber Manipulator

In this experiment, trajectory planning will be carried out in the task space, and the expected trajectory length of each chamber in the joint space will be calculated through the inverse kinematics solution. The experiment is carried out in the x-y plane to plan the equilateral triangle trajectory and the side length is 125 mm.
The experiment process is shown in Figure 15a. The end position is recorded by the NDI electromagnetic positioning system. It can be seen in Figure 15b that the experimental trajectory of the three-chamber continuous soft manipulators basically matches the desired equilateral triangle trajectory, the maximum absolute error is within 15 mm, and the average error is 4.7 mm, compared to the 150-mm-long manipulator. This result indicates that the proposed control method has good control accuracy of the soft pneumatic manipulator.

6.4. Discussion

From the above experiments we can see that the proposed hybrid controller has good performance in controlling the length change, bend angle, and tip end position of soft pneumatic manipulators. However, the proposed controller needs to combine the MPC and ILC together, which is more complicated than most used model-free controller or model-based controller. In this paper, the proposed method is only verified on a single-section pneumatic manipulator, its effect on a multi-section manipulator is unknown.

7. Conclusions

In this paper, the structural design and manufacturing process of a soft pneumatic manipulator is presented and a corresponding dynamic model based on modal method is derived which solves the problem of instability caused by the singular points in the CP kinematics. Moreover, to control the manipulator in real time and with good accuracy, a hybrid controller integrating MPC and ILC is proposed and verified through simulations and experiments. The simulation results show that the more accurate initial values of model parameters obtained by the dynamic model, the faster the convergence of the control algorithm. The experimental results show that the proposed hybrid control algorithm has good performance in controlling the manipulators’ length. During the chamber length control experiment, the RMSE value of the dynamics model changes from 18.97° to 1.92° after 10 iterations, which is an 87% reduction from the original value. In the equilateral triangle trajectory experiment, the maximum tracking error is 15 mm, and the average tracking error is 4.7 mm. This result indicates that the proposed control method has good control accuracy of the soft pneumatic manipulator. To sum up, the proposed dynamic model can be used when there exist kinematics singular solution problems, and the hybrid controller can be used when the convergence of the control algorithm is low.
Although the proposed dynamic model and the hybrid controller have been verified through experiments, the experiments are relatively simple and the prototype is a single-section manipulator. In the future, the application of the proposed method on the control of the soft multi-section manipulator will be verified and more complicated experiments will be conducted.

Author Contributions

Conceptualization, H.Y.; methodology, Y.D. and Z.D.; validation, Z.D. and Y.D.; formal analysis, Z.D. and Y.D.; investigation, H.Y.; writing—original draft preparation, Z.D. and Y.D.; writing—review and editing, H.Y., Y.D. and X.W.; visualization, Y.D.; funding acquisition, H.Y. and X.W. All authors have read and agreed to the published version of the manuscript.

Funding

This work was supported by the National Natural Science Foundation of China (Grants No. 62173114), the Science and Technology Innovation Committee of Shenzhen (Grants No. JCYJ20210324115812034, JCYJ20210324115811033, JCYJ20190809110415177, GXWD20201230155427003-20200821181254002), and the Program of Shenzhen Peacock Innovation Team (Grant No. KQTD20210811090146075).

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

Appendix A

[ R c ] 11 = cos ( ξ ϕ ) cos 2 θ + sin 2 θ
[ R c ] 12 = cos θ sin θ ( cos ( ξ ϕ ) 1 )
[ R c ] 13 = sin ( ξ ϕ ) cos θ
[ R c ] 21 = [ R c ] 12
[ R c ] 22 = cos ( ξ ϕ ) sin 2 θ + cos 2 θ
[ R c ] 23 = sin ( ξ ϕ ) sin θ
[ R c ] 31 = [ R c ] 13
[ R c ] 32 = [ R c ] 23
[ R c ] 33 = cos ( ξ ϕ )
[ P c ] 1 = λ cos θ ( 1 cos ( ξ ϕ ) )
[ P c ] 2 = λ sin θ ( 1 cos ( ξ ϕ ) )
[ P c ] 3 = λ sin ( ξ ϕ )
All elements are modalized after expansion of the 6th-order multivariate Taylor series for joint space variables { l 1 , l 2 , l 3 } at the zero point, and the results are as follows:
[ R ] 11 = ( l 2 2 l 1 + l 3 ) 2 ( ξ 2 18 R 2 + u 2 ξ 4 486 R 4 u 4 ξ 6 32805 R 6 ) + 1
[ R ] 12 = 3 ( l 2 l 3 ) ( l 2 2 l 1 + l 3 ) [ ξ 2 18 R 2 + u 2 ξ 4 486 R 4 u 4 ξ 6 32805 R 6 ]
[ R ] 13 = ( l 2 2 l 1 + l 3 ) [ ξ 3 R 2 u 2 ξ 3 81 R 3 + 2 u 4 ξ 5 3645 R 5 ]
[ R ] 21 = [ R ] 12 = 3 ( l 2 l 3 ) ( l 2 2 l 1 + l 3 ) [ ξ 2 18 R 2 + u 2 ξ 4 486 R 4 u 4 ξ 6 32805 R 6 ]
[ R ] 23 = 3 ( l 2 l 3 ) [ ξ 3 R 2 u 2 ξ 3 81 R 3 + 2 u 4 ξ 5 3645 R 5 ]
[ R ] 31 = [ R ] 13 = ( l 2 2 l 1 + l 3 ) [ ξ 3 R 2 u 2 ξ 3 81 R 3 + 2 u 4 ξ 5 3645 R 5 ]
[ R ] 32 = [ R ] 23 = 3 ( l 2 l 3 ) [ ξ 3 R 2 u 2 ξ 3 81 R 3 + 2 u 4 ξ 5 3645 R 5 ]
[ R ] 33 = 1 2 u 2 ξ 2 9 R 2 + 2 u 4 ξ 4 243 R 4
[ P ] 1 = ( 3 L 0 + l 1 + l 2 + l 3 ) ( l 2 2 l 1 + l 3 ) [ ξ 2 18 R + u 2 ξ 4 486 R 3 u 4 ξ 6 32805 R 5 ]
[ P ] 2 = 3 ( 3 L 0 + l 1 + l 2 + l 3 ) ( l 2 l 3 ) [ ξ 2 18 R + u 2 ξ 4 486 R 3 u 4 ξ 6 32805 R 5 ]
[ P ] 3 = ( 3 L 0 + l 1 + l 2 + l 3 ) [ ξ 3 2 u 2 ξ 3 81 R 2 + 2 u 4 ξ 5 3645 R 4 ]

References

  1. Paternò, L.; Tortora, G.; Menciassi, A. Hybrid Soft–Rigid Actuators for Minimally Invasive Surgery. Soft Robot. 2018, 5, 783–799. [Google Scholar] [CrossRef]
  2. Laschi, C.; Mazzolai, B.; Cianchetti, M. Soft Robot.ics: Technologies and systems pushing the boundaries of robot abilities. Sci. Robot 2016, 1, eaah3690. [Google Scholar] [CrossRef] [PubMed] [Green Version]
  3. Marchese, A.D.; Katzschmann, R.K.; Rus, D. A Recipe for Soft Fluidic Elastomer Robots. Soft Robot. 2015, 2, 7–25. [Google Scholar] [CrossRef] [PubMed] [Green Version]
  4. Ranzani, T.; Gerboni, G.; Cianchetti, M.; Menciassi, A. A bioinspired soft manipulator for minimally invasive surgery. Bioinspiration Biomim. 2015, 10, 035008. [Google Scholar] [CrossRef] [PubMed]
  5. Runciman, M.; Avery, J.; Zhao, M.; Darzi, A.; Mylonas, G.P. Deployable, Variable Stiffness, Cable Driven Robot for Minimally Invasive Surgery. Front. Robot. AI 2020, 6, 141. [Google Scholar] [CrossRef] [Green Version]
  6. Ding, J.; Goldman, R.E.; Xu, K.; Allen, P.K.; Fowler, D.L.; Simaan, N. Design and Coordination Kinematics of an Insertable Robotic Effectors Platform for Single-Port Access Surgery. IEEEASME Trans. Mechatron. 2013, 19, 109–120. [Google Scholar] [CrossRef] [PubMed] [Green Version]
  7. Walker, I.D.; Dawson, D.M.; Flash, T.; Grasso, F.W.; Hanlon, R.T.; Hochner, B.; Kier, W.M.; Pagano, C.C.; Rahn, C.D.; Zhang, Q.M. Continuum robot arms inspired by cephalopods. In Proceedings of the Defense and Security, Orlando, FL, USA, 27 May 2005; p. 303. [Google Scholar] [CrossRef]
  8. Laschi, C.; Cianchetti, M.; Mazzolai, B.; Margheri, L.; Follador, M.; Dario, P. Soft Robot. Arm Inspired by the Octopus. Adv. Robot. 2012, 26, 709–727. [Google Scholar] [CrossRef]
  9. Suzumori, K.; Endo, S.; Kanda, T.; Kato, N.; Suzuki, H. A Bending Pneumatic Rubber Actuator Realizing Soft-bodied Manta Swimming Robot. In Proceedings of the 2007 IEEE International Conference on Robotics and Automation, Rome, Italy, 10–14 April 2007; pp. 4975–4980. [Google Scholar] [CrossRef]
  10. Lin, H.-T.; Leisk, G.G.; Trimmer, B. GoQBot: A caterpillar-inspired soft-bodied rolling robot. Bioinspir. Biomim. 2011, 6, 026007. [Google Scholar] [CrossRef]
  11. Guan, Q.; Sun, J.; Liu, Y.; Wereley, N.M.; Leng, J. Novel Bending and Helical Extensile/Contractile Pneumatic Artificial Muscles Inspired by Elephant Trunk. Soft Robot. 2020, 7, 597–614. [Google Scholar] [CrossRef]
  12. Luo, R.; Wang, T.; Shi, Z.; Tian, J. Design and kinematic analysis of an elephant-trunk-like robot with shape memory alloy actuators. In Proceedings of the 2017 IEEE 2nd Advanced Information Technology, Electronic and Automation Control Conference (IAEAC), Chongqing, China, 25–26 March 2017; pp. 157–161. [Google Scholar] [CrossRef]
  13. Liu, T.; Xu, W.; Yang, T.; Li, Y. A Hybrid Active and Passive Cable-Driven Segmented Redundant Manipulator: Design, Kinematics, and Planning. IEEEASME Trans. Mechatron. 2021, 26, 930–942. [Google Scholar] [CrossRef]
  14. Rone, W.S.; Ben-Tzvi, P. Continuum Robot Dynamics Utilizing the Principle of Virtual Power. IEEE Trans. Robot. 2014, 30, 275–287. [Google Scholar] [CrossRef]
  15. Franco, E.; Garriga-Casanovas, A. Energy-shaping control of soft continuum manipulators with in-plane disturbances. Int. J. Robot. Res. 2021, 40, 236–255. [Google Scholar] [CrossRef]
  16. Pritts, M.B.; Rahn, C.D. Design of an artificial muscle continuum robot. In Proceedings of the IEEE International Conference on Robotics and Automation, New Orleans, LA, USA, 26 April–1 May 2004; Volume 5, pp. 4742–4746. [Google Scholar] [CrossRef]
  17. Li, X.; Sun, K.; Guo, C.; Liu, H. Modeling and Experimental Validation for a Large-Scale and Ultralight Inflatable Robotic Arm. IEEEASME Trans. Mechatron. 2022, 27, 418–429. [Google Scholar] [CrossRef]
  18. Mustaza, S.M.; Elsayed, Y.; Lekakou, C.; Saaj, C.; Fras, J. Dynamic Modeling of Fiber-Reinforced Soft Manipulator: A Visco-Hyperelastic Material-Based Continuum Mechanics Approach. Soft Robot. 2019, 6, 305–317. [Google Scholar] [CrossRef] [Green Version]
  19. Jones, B.A.; Walker, I.D. Kinematics for multisection continuum robots. IEEE Trans. Robot. 2006, 22, 43–55. [Google Scholar] [CrossRef]
  20. Bailly, Y.; Amirat, Y.; Fried, G. Modeling and Control of a Continuum Style Microrobot for Endovascular Surgery. IEEE Trans. Robot. 2011, 27, 1024–1030. [Google Scholar] [CrossRef]
  21. McMahan, W.; Chitrakaran, V.; Csencsits, M.; Dawson, D.; Walker, I.; Jones, B.; Pritts, M.; Dienno, D.; Grissom, M.; Rahn, C. Field trials and testing of the OctArm continuum manipulator. In Proceedings of the 2006 IEEE International Conference on Robotics and Automation, Orlando, FL, USA, 15–19 May 2006; pp. 2336–2341. [Google Scholar] [CrossRef]
  22. Jones, B.A.; Walker, I.D. Practical Kinematics for Real-Time Implementation of Continuum Robots. IEEE Trans. Robot. 2006, 22, 1087–1099. [Google Scholar] [CrossRef] [Green Version]
  23. Majidi, C. Soft Robotics: A Perspective—Current Trends and Prospects for the Future. Soft Robot. 2014, 1, 5–11. [Google Scholar] [CrossRef]
  24. Chirikjian, G.S. Hyper-redundant manipulator dynamics: A continuum approximation. Adv. Robot. 1994, 9, 217–243. [Google Scholar] [CrossRef]
  25. Khalil, W.; Gallot, G.; Ibrahim, O.; Boyer, F. Dynamic Modeling of a 3-D Serial Eel-Like Robot. In Proceedings of the 2005 IEEE International Conference on Robotics and Automation, Barcelona, Spain, 18–22 April 2005; pp. 1270–1275. [Google Scholar] [CrossRef]
  26. Matsuno, F.; Sato, H. Trajectory Tracking Control of Snake Robots Based on Dynamic Model. In Proceedings of the 2005 IEEE International Conference on Robotics and Automation, Barcelona, Spain, 18–22 April 2005; pp. 3029–3034. [Google Scholar] [CrossRef]
  27. Tatlicioglu, E.; Walker, I.D.; Dawson, D.M. Dynamic Modelling for Planar Extensible Continuum Robot Manipulators. In Proceedings of the 2007 IEEE International Conference on Robotics and Automation, Barcelona, Spain, 18–22 April 2007; pp. 1357–1362. [Google Scholar] [CrossRef]
  28. Godage, I.S.; Branson, D.T.; Guglielmino, E.; Medrano-Cerda, G.A.; Caldwell, D.G. Dynamics for biomimetic continuum arms: A modal approach. In Proceedings of the 2011 IEEE International Conference on Robotics and Biomimetics, Karon Beach, Thailand, 7–11 December 2011; pp. 104–109. [Google Scholar] [CrossRef]
  29. Gazzola, M.; Dudte, L.H.; McCormick, A.G.; Mahadevan, L. Forward and inverse problems in the mechanics of soft filaments. R. Soc. Open Sci. 2018, 5, 171628. [Google Scholar] [CrossRef] [Green Version]
  30. Thuruthel, T.G.; Ansari, Y.; Falotico, E.; Laschi, C. Control Strategies for Soft Robotic Manipulators: A Survey. Soft Robot. 2018, 5, 149–163. [Google Scholar] [CrossRef] [PubMed]
  31. Kocijan, J. Modelling and Control of Dynamic Systems Using Gaussian Process Models; Springer International Publishing: Cham, Switzerland, 2016. [Google Scholar] [CrossRef]
  32. Tang, Z.Q.; Heung, H.L.; Tong, K.Y.; Li, Z. Model-based online learning and adaptive control for a “human-wearable Soft Robot.” integrated system. Int. J. Robot. Res. 2021, 40, 256–276. [Google Scholar] [CrossRef]
  33. Trimmer, B. Soft Robot. Control Systems: A New Grand Challenge? Soft Robot. 2014, 1, 231–232. [Google Scholar] [CrossRef]
  34. Singh, G.; Krishnan, G. Designing Fiber-Reinforced Soft Actuators for Planar Curvilinear Shape Matching. Soft Robot. 2019, 7, 109–121. [Google Scholar] [CrossRef] [PubMed]
  35. Hock, O.; Drgoňa, P.; Paškala, M. Simulation model of adjustable arm using Denavit-Hartenberg parameters. In Proceedings of the 2014 ELEKTRO, Rajecke Teplice, Slovakia, 19–20 May 2014; pp. 176–179. [Google Scholar] [CrossRef]
  36. Webster, R.J.; Jones, B.A. Design and Kinematic Modeling of Constant Curvature Continuum Robots: A Review. Int. J. Robot. Res. 2010, 29, 1661–1683. [Google Scholar] [CrossRef]
  37. Mascarenhas, W.F. The divergence of the BFGS and Gauss Newton methods. Math. Program. 2014, 147, 253–276. [Google Scholar] [CrossRef] [Green Version]
  38. Amirabdollahian, F.; Loureiro, R.; Harwin, W. Minimum jerk trajectory control for rehabilitation and haptic applications. In Proceedings of the 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292), Washington, DC, USA, 11–15 May 2002; Volume 4, pp. 3380–3385. [Google Scholar] [CrossRef]
Figure 1. The scientific flowchart of this paper.
Figure 1. The scientific flowchart of this paper.
Sensors 23 01272 g001
Figure 2. Structure of the soft continuum manipulator.
Figure 2. Structure of the soft continuum manipulator.
Sensors 23 01272 g002
Figure 3. The manufacturing process of the multi-chamber soft pneumatic manipulator. (a) Design of the inner layer mold. It is composed of 3 chambers with a diameter of 6mm and an inner wall with a diameter of 25 mm. The inner wall is spirally convex, which is convenient for subsequent Fiber winding. The top fixing is used for sealing and positioning and the mold is made by 3D printing. (b) The manufacturing process of the soft manipulator, including the inner and outer mold design.
Figure 3. The manufacturing process of the multi-chamber soft pneumatic manipulator. (a) Design of the inner layer mold. It is composed of 3 chambers with a diameter of 6mm and an inner wall with a diameter of 25 mm. The inner wall is spirally convex, which is convenient for subsequent Fiber winding. The top fixing is used for sealing and positioning and the mold is made by 3D printing. (b) The manufacturing process of the soft manipulator, including the inner and outer mold design.
Sensors 23 01272 g003
Figure 4. Schematic of the kinematic parameters of the proposed soft pneumatic manipulator.
Figure 4. Schematic of the kinematic parameters of the proposed soft pneumatic manipulator.
Sensors 23 01272 g004
Figure 5. Parameter-adaptive-learning control diagram based on the soft continuum section dynamic model. Model predictive control (MPC) and iterative learning control (ILC), which are used as feedback and feedforward, are combined to iteratively learn model parameters, respectively.
Figure 5. Parameter-adaptive-learning control diagram based on the soft continuum section dynamic model. Model predictive control (MPC) and iterative learning control (ILC), which are used as feedback and feedforward, are combined to iteratively learn model parameters, respectively.
Sensors 23 01272 g005
Figure 6. The changes of the dynamic model parameters alone with the iterative process of the control algorithm. ((ad) represent the changes of P1, P2, P3, P4 along with iterations, respectively).
Figure 6. The changes of the dynamic model parameters alone with the iterative process of the control algorithm. ((ad) represent the changes of P1, P2, P3, P4 along with iterations, respectively).
Sensors 23 01272 g006
Figure 7. Chamber length change trajectory following simulation results. (a,b) show the comparison between the model estimated chamber length and the real chamber length. (c,d) show the comparison between the real chamber length and the reference chamber length.
Figure 7. Chamber length change trajectory following simulation results. (a,b) show the comparison between the model estimated chamber length and the real chamber length. (c,d) show the comparison between the real chamber length and the reference chamber length.
Sensors 23 01272 g007
Figure 8. Traditional model-free PID feedback control diagram.
Figure 8. Traditional model-free PID feedback control diagram.
Sensors 23 01272 g008
Figure 9. PID control simulation results. (a) shows the true chamber length, which can also tend to the reference length after more iterations. (b) the RMSE between the PID control algorithm and the proposed control algorithm.
Figure 9. PID control simulation results. (a) shows the true chamber length, which can also tend to the reference length after more iterations. (b) the RMSE between the PID control algorithm and the proposed control algorithm.
Sensors 23 01272 g009
Figure 10. Simulation results under different initial model values. The initial values of different model parameters will converge to the real model parameters at different speeds. Taking the dynamic model parameters as the initial values can effectively reduce the number of iterations.
Figure 10. Simulation results under different initial model values. The initial values of different model parameters will converge to the real model parameters at different speeds. Taking the dynamic model parameters as the initial values can effectively reduce the number of iterations.
Sensors 23 01272 g010
Figure 11. Simulation results under different reference trajectories. (a,c,e), show the step, rectangular wave, and sine wave as the chamber length reference, respectively; the real chamber length tends to the reference length with the number of iterations. (b,d,f), respectively, show the variation of the rms between the real length and the reference length under different reference trajectories.
Figure 11. Simulation results under different reference trajectories. (a,c,e), show the step, rectangular wave, and sine wave as the chamber length reference, respectively; the real chamber length tends to the reference length with the number of iterations. (b,d,f), respectively, show the variation of the rms between the real length and the reference length under different reference trajectories.
Sensors 23 01272 g011
Figure 12. Experimental setup. The control algorithm is implemented on host computer (64-bit operating system, i5 CPU, and 16 GB RAM) based on ROS operating system. The pressure of the chamber is controlled by the SMC electric proportional valve (ITV1050). The NDI Aurora electromagnetic positioning system is used to capture the end pose of the actuator and communicate with the host through a serial port. The PCB broad is mainly used for hardware control drive.
Figure 12. Experimental setup. The control algorithm is implemented on host computer (64-bit operating system, i5 CPU, and 16 GB RAM) based on ROS operating system. The pressure of the chamber is controlled by the SMC electric proportional valve (ITV1050). The NDI Aurora electromagnetic positioning system is used to capture the end pose of the actuator and communicate with the host through a serial port. The PCB broad is mainly used for hardware control drive.
Sensors 23 01272 g012
Figure 13. Single-chamber soft manipulator experimental results. (a) Schematic diagram of the experimental process. (b) Model parameters converge to stable values during the learning iterations. (c,d) demonstrated trajectory tracking performance. (e,f) demonstrated model parameter learning performance.
Figure 13. Single-chamber soft manipulator experimental results. (a) Schematic diagram of the experimental process. (b) Model parameters converge to stable values during the learning iterations. (c,d) demonstrated trajectory tracking performance. (e,f) demonstrated model parameter learning performance.
Sensors 23 01272 g013
Figure 14. Three-chamber soft manipulator experimental results. (a,b) Set step signal as reference trajectory. (c) Schematic diagram of the experimental process. (d,e) shows the change process of the real bending angle and the reference bending angle, the RMSE gradually decreases.
Figure 14. Three-chamber soft manipulator experimental results. (a,b) Set step signal as reference trajectory. (c) Schematic diagram of the experimental process. (d,e) shows the change process of the real bending angle and the reference bending angle, the RMSE gradually decreases.
Sensors 23 01272 g014
Figure 15. Trajectory planning experimental results. (a) experiment procedure. (b) the coordinates of the end position of the data collected by the experiment and the expected trajectory.
Figure 15. Trajectory planning experimental results. (a) experiment procedure. (b) the coordinates of the end position of the data collected by the experiment and the expected trajectory.
Sensors 23 01272 g015
Table 1. Dynamical Model Parameters.
Table 1. Dynamical Model Parameters.
Chamber   Radius   r 0 Robot Mass
m
Chamber Length
L0
Chamber   Elastic   Stiffness   K e Chamber   Bending   Stiffness   K b
0.0060.030.15400 N/m0.1 N/rad
Table 2. Simulation Control Parameters.
Table 2. Simulation Control Parameters.
Min chamber length l min 0 mFeedforward input coefficient λ 10
Max chamber length l max 0.04 mSampling time T s 0.1 s
Output weight factor Q100Total time T 10 s
Input weight factor R1Error tolerance ε t 0.001
Prediction horizon H10Error tolerance ε r 0.001
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Dai, Y.; Deng, Z.; Wang, X.; Yuan, H. A Hybrid Controller for a Soft Pneumatic Manipulator Based on Model Predictive Control and Iterative Learning Control. Sensors 2023, 23, 1272. https://doi.org/10.3390/s23031272

AMA Style

Dai Y, Deng Z, Wang X, Yuan H. A Hybrid Controller for a Soft Pneumatic Manipulator Based on Model Predictive Control and Iterative Learning Control. Sensors. 2023; 23(3):1272. https://doi.org/10.3390/s23031272

Chicago/Turabian Style

Dai, Yicheng, Zhihao Deng, Xin Wang, and Han Yuan. 2023. "A Hybrid Controller for a Soft Pneumatic Manipulator Based on Model Predictive Control and Iterative Learning Control" Sensors 23, no. 3: 1272. https://doi.org/10.3390/s23031272

APA Style

Dai, Y., Deng, Z., Wang, X., & Yuan, H. (2023). A Hybrid Controller for a Soft Pneumatic Manipulator Based on Model Predictive Control and Iterative Learning Control. Sensors, 23(3), 1272. https://doi.org/10.3390/s23031272

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop