A journal of IEEE and CAA , publishes
high-quality papers in English on original
theoretical/experimental research
and development in all areas of automation
G. F. Li, D. Z. Song, L. Sun, S. Xu, H. P. Wang, and J. T. Liu, "Static Force-Based Modeling and Parameter Estimation for a Deformable Link Composed of Passive Spherical Joints With Preload Forces," IEEE/CAA J. Autom. Sinica, vol. 8, no. 11, pp. 1817-1826, Nov. 2021. doi: 10.1109/JAS.2019.1911549
Citation:
G. F. Li, D. Z. Song, L. Sun, S. Xu, H. P. Wang, and J. T. Liu, "Static Force-Based Modeling and Parameter Estimation for a Deformable Link Composed of Passive Spherical Joints With Preload Forces," IEEE/CAA J. Autom. Sinica, vol. 8, no. 11, pp. 1817-1826, Nov. 2021. doi: 10.1109/JAS.2019.1911549
G. F. Li, D. Z. Song, L. Sun, S. Xu, H. P. Wang, and J. T. Liu, "Static Force-Based Modeling and Parameter Estimation for a Deformable Link Composed of Passive Spherical Joints With Preload Forces," IEEE/CAA J. Autom. Sinica, vol. 8, no. 11, pp. 1817-1826, Nov. 2021. doi: 10.1109/JAS.2019.1911549
Citation:
G. F. Li, D. Z. Song, L. Sun, S. Xu, H. P. Wang, and J. T. Liu, "Static Force-Based Modeling and Parameter Estimation for a Deformable Link Composed of Passive Spherical Joints With Preload Forces," IEEE/CAA J. Autom. Sinica, vol. 8, no. 11, pp. 1817-1826, Nov. 2021. doi: 10.1109/JAS.2019.1911549
Humanoids and Human Centered Mechatronics Research Line, Italian Institute of Technology, 16163 Genova, Italy
3.
Department of Computer Science and Engineering, Texas A&M University, College Station, Texas 77843 USA
4.
Institute of Robotics and Automatic Information System, Nankai University, Tianjin 300350, China
5.
Tianjin Key Laboratory of Intelligent Robotics, Nankai University, Tianjin 300350, China
Funds:
This work was supported by National Natural Science Foundation of China (NSFC) (61573198, 61375087), and the Natural Science Foundation of Tianjin (15JCZDJC31200)
Gaofeng Li received the B.E. and Ph.D. degrees from Nankai University in 2013 and 2018, respectively. He was a Visiting Student with Netbot Lab., Texas A&M University, College Station, USA, from November 2015 to December 2016. He is currently a Postdoctoral Researcher with the Italian Institute of Technology, Italy. His research interests include model-less motion control, lie group in robotics, haptic teleoperation, and soft robotics. Dr. Li was the Recipient of the Outstanding Doctoral Dissertation of Nankai University in 2019. He is also a Member of the IEEE Robotics and Automation Society and an Independent Reviewer for the IEEE Transactions on Automation Science and Engineering, IEEE/ASME Transactions on Mechatronics, IEEE Robotic and Automation Letters, IEEE International Conference on Robotics and Automation, IEEE/RSJ International Conference on Intelligent Robots and Systems, IEEE International Conference on Automation Science and Engineering, etc
Dezhen Song received the B.S. and M.S. degrees from Zhejiang University in 1995 and 1998, respectively, and the Ph.D. degree from the University of California, USA, in 2004. He is currently a Professor with Texas A&M University, College Station, USA. His primary research interests include networked robotics, distributed sensing, computer vision, surveillance, and stochastic modeling. Dr. Song received the Kayamori Best Paper Award of the 2005 IEEE International Conference on Robotics and Automation (with J. Yi and S. Ding). He received the NSF Faculty Early Career Development (CAREER) Award in 2007. From 2008 to 2012, he was an Associate Editor of the IEEE Transactions on Robotics. From 2010 to 2014, he was an Associate Editor of the IEEE Transactions on Automation Science and Engineering
Lei Sun received the B.E. and M.E. degrees in mechatronics engineering from Tianjin University in 1999 and 2002, respectively, and the Ph.D. degree in control theory and control engineering from Nankai University in 2005. In 2005, he joined Nankai University. He is currently an Associate Professor at the College of Artificial Intelligence, Nankai University. His research interests include robotics and automatic control, teleoperation of robots in networks, wireless sensor network, and micro-electromechanical systems
Shan Xu received the B.E. degree in intelligent science and technology and the M.E. degree in control science and engineering from Nankai University in 2016 and 2019, respectively. She is currently working toward the Ph.D. degree in systems engineering with the University of Virginia, Charlottesville, USA. She is currently focusing on the human perception of touch for haptics display and human-machine interaction. Her research interests include robot kinematics, screw theory, trajectory planning, 3-D tracking, and haptics
Hongpeng Wang received the B.S degree in physics and the Ph.D degree in control theory and engineering from Nankai University in 2000 and 2009, respectively. He is currently an Associate Professor with Nankai University. His primary research interests include cloud and networked robotics, aerial and wheeled robotics systems, cyber-physical network systems, and ecological tele-observation. During Sept. 2007–Sept. 2008, Dec. 2014–Feb. 2015, he was a Visiting Research Fellow with the Department of Computer Science and Engineering, Texas A&M University, College Station. During Mar. 2016–Mar. 2017, he was a Visiting Scholar and Post Doc. with the Department of Computer Science and Engineering, Texas A&M University, College Station. Dr. Wang is a Member of the IEEE Robotics and Automation Society
Jingtai Liu received the B.S. degree in engineering of industry automation from Tianjin University in 1983, the M.Eng. degree in electrical engineering from Tianjin University in 1986, and the Ph.D. degree in robotics engineering from Nankai University in 1998. He is currently the Director of the Institute of Robotics and Automatic Information System, Nankai University, where he is also a Professor with the College of Artificial Intelligence. His current research interests include robotics and automatic control, competitive networked robots, wireless sensor networks, automatic information systems, and robotics education for kids. During 2006–2007, he was a Visiting Scholar with the Laboratory for Automation Science and Engineering, University of California, USA. Dr. Liu was a Member of the Industry Robotics Technology Expert Group, which was a High-tech Research and Development Program of China (China 863 Program), during 1997–2001
To balance the contradiction between higher flexibility and heavier load bearing capacity, we present a novel deformable manipulator which is composed of active rigid joints and deformable links. The deformable link is composed of passive spherical joints with preload forces between socket-ball surfaces. To estimate the load bearing capacity of a deformable link, we present a static force-based model of spherical joint with preload force and analyze the static force propagation in the deformable link. This yields an important result that the load bearing capacity of a spherical joint only depends on its radius, preload force, and static friction coefficient. We further develop a parameter estimation method to estimate the product of preload force and static friction coefficient. The experimental results validate our model. 80.4% of percentage errors on the maximum payload mass prediction are below 15%.
SOFT robotics, robotic systems which use structures based on soft materials (hereafter, simplified as “soft structures”), are increasingly being used as opposed to traditional rigid structures. The use of soft structures opens up new opportunities to solve problems in traditional rigid robotic systems, but also leads to new challenges, the foremost among these being how to accurately model and control such systems. A soft structure has an infinite degree of freedom, making it impossible to develop a model as accurate as that of a rigid structure. It, in turn, makes the fine-grained control of the soft structure challenging, especially the tuning of its dynamic responses. Serious concerns are thus raised, especially in applications such as rehabilitation, where the fine-grained control of muscles supported by a soft structure is necessary. Another example is in high-speed applications, such as industrial soft robotic grippers; the fine-tuning of dynamic responses is essential.
Soft robotics, being and emerging field, has limited research done on accurate modeling and dynamic response tuning. Vikas et al. [1], [2] proposed a graph-based, model-free framework for controlling the locomotion of soft robots. Calisti et al. [3], [4] proposed control strategies inspired by aquatic life. Both proposals only deal with coarse-grained locomotion of soft robots instead of fine-grained control and dynamic response tuning. Reymundo et al. [5] used a statistical model to control system responses, but this method assumes the model to be linear and predictable for a given range of operations. These assumptions and the absence of a feedback loop can render the system unstable and produce an undesirable response. Frederick et al. [6]–[8] proposed a finite element method (FEM)-based control strategy which can achieve high accuracy but requires detailed knowledge of the mechanical properties of the soft structured materials. Furthermore, FEM-based control strategies incur high computation costs, which makes real-time execution impractical on embedded processors. One remedy is to run FEM-based control strategies in a feedforward open-loop fashion, but this makes the control prone to error and decreases overall robustness. Marchese et al. [9]–[11] proposed a model-based control strategy to optimize the dynamic responses of soft robots.
Few model-based approaches to regulate the dynamic response have been proposed in the literature. As an example, Ni et al. [12] proposed an approach to control the dynamic response of the soft actuator by attaching an external mechanical damper to the body of a soft robot. Similarly, Wei et al. [13] and Li et al. [14] presented a design of soft actuators with particle chambers. These approaches dissipate excessive kinetic energy by using mechanical components. However, the mechanical overhead causes the system to become bulky and increases fabrication cost. Luo et al. [15] proposed a sliding-mode controller (SMC) based controller. However, their proposed controller requires careful manual tuning of its parameter. All of the aforementioned controllers heavily rely on the mathematical models which govern the soft-robots and does not adapt to mechanical variations in the soft-robot. However, soft robots usually suffer from inevitable wear and tear [16] after several usage cycles, which affect the behaviour of the robots; therefore, the performance of the controllers also degrade.
Due to the aforementioned constraints, should the model of soft robots not be given a priori, model-free closed-loop PID controllers become the choice for fine-grained control and dynamic response tuning [17]. This fact is strengthened by the wide adoption and popularity of PID control. Several variants of model-free PID-controller are discussed in [18]–[22]. In this paper, we conduct a detailed comparison of these controllers. We re-evaluated the performance of PID variants for soft robots and highlighted their key differences from the PID-controller for rigid robots. The main contributions of this paper can be summarized as:
1) Compilation of comprehensive experimental results to analyze the comparative performance of the PID controllers, specifically for soft robots. The paper compares three different types of PID controllers; regular PID, piecewise PID, and fuzzy PID. Along with two different types of parameter tuning algorithms; Ziegler–Nichols for manual tuning, and coordinate descent automatic tuning.
2) Various general-purpose controllers have been designed for soft robots in the literature without much recognition of uniqueness to soft robots. This work conducts extensive experiments and uses data to show that the dynamical behaviors of soft robots are indeed different from rigid robots.
3) Researchers usually intuitively think PID-controllers do not differ much for both rigid-body and soft robots. However, we have identified a fundamental difference from extensive experimentation. To our knowledge, this is the first time that this inherent difference has been recognized. This difference may help researchers design improved controllers for soft robots by leveraging their uniqueness.
4) Following the identified inherent differences of PID control for soft and rigid-body robots, six types of dominating PID variants are systematically evaluated and compared on an experimental soft robot platform. The best PID variant is identified, and the rationale of its outstanding performance is also established.
The remainder of this paper is organized as follows. Section II discusses related works on soft robot control. Section III presents PID-controller variants along with formulation of coordinate descent algorithm for automatic parameter tuning of PID-controllers. Section IV describes the platform, methodology, and results of the experiment. Section V concludes the paper.
II.
Background and Related Work
Recent developments in soft robotics have focused on the design, fabrication, control, and applications of soft robots. In this section, a brief review of recent advances in soft robotics is presented. Table I contains a summary of this review.
Soft robots are being developed as counterparts to traditional rigid mechanical robots, which offer the same functionality as rigid structures with the added benefit of flexibility. For example, in conventional robotic systems, linear motion is provided by using linear actuators such as linear DC motors. To provide the same functionality with soft structures, [23], [24] have proposed a design for soft materials based muscles, actuated using pneumatic systems. Similarly, to produce circular or bending motions, soft actuators [25]–[29] have been designed to replace rigid servos. Efforts have also been made to develop soft structures, capable of performing motions in three-dimensional space. Soft robots shaped like octopus tentacles [30], without any rigid joints or links, are capable of maneuvering in three-dimensional space using pneumatic actuation.
One of the fundamental difference between traditional rigid robots and soft robots is the formulation of an accurate mathematical model which governs their control. Robots consisting of rigid links and joints can be accurately modeled because their motion is deterministic and can be easily predicted; however, soft robots are flexible, which make highly nonlinear and theoretically require an infinite degree of freedom to model them accurately [31]. Lack of an accurate mathematical model makes it difficult to formulate an accurate control algorithm. Model estimation techniques have been explored to model soft robots using a linear mathematical model [32]; however, these estimations fail to model their nonlinear dynamics.
Most soft robots use a pneumatic system for actuation. Although pneumatics are an excellent choice for the actuation of soft structures, they make the system heavy, bulky, and reduce portability. Efforts have been made to develop alternate actuation principles for soft robots, the notable being the dielectric elastomer actuators (DEA) [33]–[35], which are capable of producing a large actuation when an electric voltage is applied across the actuator. Much work has also been done on the sensing of soft actuators. The use of combustion-based air pumps for soft robot actuation has also been considered [36]. This actuation principle makes the system more compact but reduces the safety of soft robots.
Because of their flexible structure, soft robots require different sensing mechanisms from rigid robots. The compliant structure of soft robots makes it possible to integrate sensory mechanisms as part of its fabrication material, or to embed it inside the soft robots itself. Felt et al. [37] proposed using electrically conductive fabric to cover the body of the soft actuator, and to measure deformation by identifying changes in the electrical properties of the fabric. Attempts have also been made to embed the sensor inside the soft robots [38]–[42].
A large proportion of the literature on soft robots is on their use in rehabilitation applications [5], [43]–[47]. Traditional rehabilitation robotic systems use rigid exoskeletons to help patients perform recovery exercises. Soft robots are more suitable in such applications because of their flexibility, compliance, and human-skin like feeling, which can help accelerate the recovery process. Object grippers based on soft robots [48] have also been shown to be competitive with rigid robotic structures. These grippers can easily handle objects of various sizes and shapes. Delicate materials are also much more safely handled using soft grippers.
As discussed in Section I, research on the control of soft robots is still in its infancy. The subject has only attracted research attention after recent developments in the design, fabrication, and sensing of new soft actuators. The most common control approach used in soft robots based applications is the closed-loop PID-controller [17] because it does not require an a priori mathematical model of the soft robot. Efforts have also been made to approximate the mathematical model of the soft robot using linear ODEs and to use an adaptive controller to compensate for unmodeled parameters [32]. Other control methods introduced in the literature also require an a priori mathematical model of the soft robot. Since an accurate analytical model for soft robots cannot be formulated, most industrial application of the soft robots use model-free control techniques.
III.
PID-controllers for Soft Robots
In this section, mathematical formulation of three such PID variant controllers are presented. The variants presented here include piecewise PID and fuzzy PID, which differ in the way PID parameters adapt with respect to the input reference angle. This section also presents automatic algorithms to obtain optimal controller parameters by optimizing the dynamic response of the soft robot.
A
Formulating the Controllers
The following presents the formulation of a regular PID, a piecewise PID, and a fuzzy PID, which are used for comparison in this paper, and the discussion of their differences.
1) A Regular PID-controller
Let us denote a state of the soft robot plant as θ(t), and the desired or reference state as θr. The system error is then e(t)=θr−θ(t), and the system control input is denoted as u(t). Based on this notation, a regular PID-controller defines the system input u(t) as
u(t)=Kpe(t)+Ki∫t0e(τ)dτ+Kdddte(t)
(1)
where Kp,Ki, and Kd are controller parameters. These controller parameters can be adjusted to tune the dynamic responses of the system. The above formulation assumes a continuous time system. In case sensor data acquisition and actuation take place in discrete time, (1) becomes
u[n]=Kpe[n]+Kin∑i=1e[i]Δti+KdΔenΔtn
(2)
where n is the discrete index number, e[n]=θr−θ[n], Δen=e[n]−e[n−1], and Δtn is the time difference between two consecutive sensor readings, i.e., (θ[n] and θ[n−1]). For simplicity of notation, let us denote the parameter vector and system error vector as
K=[KpKiKd],E[n]=[e[n]n∑i=1e[i]ΔtiΔenΔtn].
Using this, (2) becomes
u[n]=KTE[n].
(3)
The schematic diagram of the PID-controller used in our experimental system is shown in Fig. 1. The main task in PID control is to adjust vector K to obtain the desired dynamic responses. The algorithms to tune K will be explained later.
Figure
1.
Schematic diagram of canonical form of PID-controller for soft muscle control
The regular PID-controller of (2) and (3) fixes the control parameter vector K for all possible values of reference input θr. However, to fine tune dynamic responses, different θrs needs different optimal control parameters. In other words, the optimal K is dependent on the given θr. A piecewise PID matches this demand by expressing K as a piecewise constant function of θr. The valid range of θr is divided into several subranges and the value of K is separately tuned for each subrange. That is, K now becomes K(θr). Correspondingly, Formula 3 becomes
u[n]=K(θr)TE[n].
(4)
Fig. 2 illustrates the concept of the piecewise PID control parameter vector K.
Figure
2.
Parameter variation in a piecewise PID (solid lines) vs. a fuzzy PID (dashed lines)
Although a piecewise PID increases flexibility in tuning control parameter vector K, abrupt changes still occur at the boundaries of the subranges (see Fig. 2). Fuzzy PID further increases the flexibility of the controller parameters K. Instead of defining K(θr) as a piecewise constant function, K(θr) is defined as a piecewise linear and continuous function of θr. This formulation allows for a continuous change in the control parameter vector K at the boundaries of the subranges. The concept of the fuzzy control parameter vector is shown in Fig. 2. The mathematical formulation of the Fuzzy PID-controller is the same as in (4); the only difference is how K changes with θr.
B
Control Parameter Tuning
After formulation, the second task in implementing the PID-controllers as mentioned earlier is tuning the control parameter vector K for fine-grained control or optimal dynamic responses. Two methods to tune K will be discussed. The first is the manual method, which involves visually observing the performance of the system with different values of K and selecting an optimal value. The second method is to tune K using algorithms automatically. Both of these tuning methods are explained below.
1) Manual Tuning
Manual tuning involves adjusting the control parameter vector K by hand and observing the corresponding system performances. If the performances are undesirable, then K should be changed manually, and the performances must be observed again, and so on. In this way, by manually adjusting K in a hit-or-miss approach, it is possible to achieve the desired system performances. This approach labor-intensive and depends heavily on the experience and judgment of the operators.
We used the Ziegler–Nichols method to manually tune the PID parameters which goes as follow: given θr, we first set Ki and Kd to zero and increase Kp until the step response of the control system is in converging oscillations. If the steady-state response contains a constant error, then Kp should be kept constant and Ki increased until the steady-state response error decreases to zero. At this stage, we can further fine-tune the oscillations behavior of the step response: settling time and overshoot. For example, to reduce overshooting, Ki should be kept constant, and Kd should be increased.
2) Automatic Tuning
In contrast to manual tuning, automatic tuning is more principled and is based on rigorous algorithms. Several metaheuristic optimization algorithms have been proposed in the literature to tune the controller parameter [49]–[51]. However, most of these algorithms assume that the mathematical model of the controlled system is known apriori. However, in the case of soft robots, such assumptions are not practical. Therefore, we must rely on the real robot to obtain the response and calculate the performance metric. Therefore, we used a classic automatic tuning algorithm, called coordinate descent algorithm [52]. It is a metaheuristic algorithm that tries to optimize a concerned control performance metric in the output of the system. The pseudo-code is given in Algorithm 1. The heuristics of the algorithm runs as follows. It starts with a random value for the controller parameter vector K and a small probing positive step size dK. It then calculates concerned performance metric M(K) of the control system. If the metric is not good enough, then the algorithm probes the neighborhood of K with a step size of dK. If the metric improves, we update K and increase the step size dK; otherwise, we try smaller step sizes. We repeat the above process until the step size shrinks below a threshold, or until a maximum iteration count is reached.
Algorithm 1. Coordinate descent algorithm
Input: System error model M, stop threshold Kstop and maximum iterations N.
Output: Optimized parameter K∗ = K
initialization;
K← random 3 × 1 vector;
dK← positive random 3 × 1 vector;
count← 0;
besterror←M(K);
while|dK|1≥Kstop and count < Ndo
fori← {1, 2, 3} do
K[i]←K[i]+dK[i];
error ←M(K);
if error ≤ besterrorthen
dK[i]←1.2∗dK[i];
besterror←error;
else
K[i]←K[i]−2∗dK[i];
error ←M(K);
if error ≤ besterrorthen
dK[i]←1.2∗dK[i];
besterror←error;
else
K[i]←K[i]+dK[i];
dK[i]←0.8∗dK[i];
end
end
end
count←count + 1;
end
Note that the coordinate descent algorithm is a metaheuristic algorithm; therefore, it may converge to a local optimum instead of a global optimum, or not converge at all, depending on the initial value. In this paper, our concerned control performance metric is defined by the following:
M(K)=1nn∑i=1(|e[i]|+|ΔeiΔti|)
(5)
where e[i] and Δei/Δti are the same as defined in (2). This definition takes into consideration both; the response oscillation magnitude (as measured by |e[i]|) and the oscillation slope (as measured by |Δei/Δti|), and therefore can reflect the control accuracy and dynamic response quality.
To summarize, our coordinate descent algorithm aims to find the optimal PID control parameter vector
M∗=argminKM(K)
(6)
by minimizing the M(K) of (5), which is a holistic metric of control accuracy and dynamic response quality.
IV.
Experiments and Comparison
In this section, we evaluate the various model-free closed-loop PID-controllers on soft robots via experiments.
A
Experimental Platform
PneuNet [25] is a soft bending robot, fabricated using silicones. It consists of a series of chambers connected through a central channel. One side of each chamber is stiffer than the other. This difference in stiffness causes PneuNet to bend when chambers are actuated using air pressure. The fabrication, sensing, and actuation mechanisms are described now.
1) Fabrication
The 3D designs of PneuNets molds are open source and available in the soft robotic toolkit [53]. The silicone material used for fabrication is dragon skin 10 from SMOOTH-ON Inc. [54]. This silicone material consists of two separate mixtures named Part A and Part B. The process of curing the silicone starts after both mixtures are combined thoroughly and left in open air for some time.
We 3D printed the molds and prepared the elastomer by thoroughly mixing Part A and Part B of dragon skin 10 in a 1:1 ratio by volume. The printed molds consist of three parts: one part is used to fabricate the bottom of PneuNet, and the other two parts are combined to fabricate the upper chambers. A prepared elastomer is poured into the molds and allowed to be cured in open air at room temperature for 8 hours. Since the bottom of the actuator needs to be stiffer, a piece of paper is embedded inside it. Once the bottom and upper chambers are cured, they are glued with a liquid elastomer to form a holistic PneuNet soft robot. Fig. 3 shows the whole fabrication process.
Figure
3.
Flowchart of the process for fabricating the PneuNet used in our experimental platform
PneuNets are capable of producing only angular motion. Therefore, FlexiForce bending sensors are used to determine the angular motion of PneuNets. Such a sensor is a resistor, whose resistance changes with the bending angle. We developed mapping from resistance readings to bending angles through field measurements. The sensor is then attached to the base of our PneuNet soft robot, as shown in Fig. 4(a).
Figure
4.
(a) Sensing mechanism in experiments to measure the bending angle of the PneuNet (PneuNet: white object, flex sensor: brown strip). (b) Experimental platform: containing ① an Air pump, ② a Arduino Mega, ③ MOSFET switches, ④ valves, ⑤ the bending sensor and the PneuNet robot.
We used a 12V DC air pump to actuate our PneuNet soft robot. The pump was connected to the robot via an electro-mechanic valve controlled by a MOSFET switch. The valve has a response period of T = 1/30 (s), and an adjustable switched-on time duration To (s) in each response period. The ratio To/T is called the duty cycle. By adjusting the MOSFET switch duty cycle, we can adjust the open/close time ratio of the valve, and in turn, control the air pressure injected into the PneuNet soft robot. Between the bending sensor and the MOSFET switch is the PID-controller that is under evaluation. The controller runs on an Arduino Mega 2560 board and outputs PWM signals to adjust the duty cycle of the MOSFET switch. The developed system is shown in Fig. 4(b).
B
Experiments, Results and Discussion
We conducted a series of step and sinusoidal input experiments to demonstrate the effectiveness of tuning and control algorithms, respectively. First, the results for the parameter tuning experiments, both manual and automatic, will be presented. The tuned parameters are then used to compare the accuracy of the presented controllers.
1) Parameter Tuning
To use the piecewise and fuzzy PID formulations described in Section III-A, the entire reference angle range [0°, 90°] is divided into the following three subranges: [0°, 30°), [30°, 60°) and [60°, 90°]. The midpoint of each subrange, i.e., (15°, 45°, and 75°) is used as the representative point when tuning the control parameter for that subrange. The endpoints of the entire range, i.e., 0° and 90°, are also considered for tuning. Since 0° is trivial (θr= 0° is the natural state of the PneuNet), the results are only presented for θr= 90°.
In manual control parameter tuning experiments, the PneuNet is given a step input of θr=90 degrees while manually adjusting control parameter vector K. The observed responses are shown in Fig. 5. The blue line shows the desired response, whereas the solid red line shows the response that was chosen as the best by the observer because of the short rising time and damped oscillations after the reference angle was reached. In all of the cases, it is observed that setting Kd≠0 results in oscillations and unstable responses, therefore Kd=0 is an optimal value for the PneuNet actuation. It can be explained in the context of the interpretation of PID-controller terms. The derivative term in PID is essentially a prediction of future behavior of the robotic system. Estimation of the derivative term is trivial for a rigid robotic system since its behavior is mathematically predictable and strictly follow system model. In contrast, soft robots are characterized by a high degree of uncertainty and chaotic motion. Therefore, the estimation of future motion usually results in large variations and errors. These variations manifest themselves in the form of unexpected variation in controller output, thus resulting in erratic behavior. Therefore, a combination of Kp≠0 and Ki≠0 is recommended since they can produce the desired performance. This behavior can also be explained in terms of the second-order lumped element model of the soft robot. By analyzing a general second-order model of a robotic system driven by a PID controller, the system can become unstable if the natural damping of the robot is very small. Since soft robots are inherently flexible, the internal mechanical damping produced by the elastic material is minimal. Thus, using a large value of Kd can render the system unstable. This heuristic was used while manually adjusting the control parameters for θr=15°, 45°, 75°. Table II summarizes the results of the manual tuning experiments.
Table
II.
Summary of the Parameter Tuning Experiments (The Final Tuned Values Are Given)
Figure
5.
System responses for the manual tuning of control parameters K for θr= 90°. The solid blue line represents the reference response while solid red line represents the response, visually chosen to be the best
In automatic parameter tuning experiments, the coordinate descent algorithm described in Section III-B is used to minimize performance metric (5). The PneuNet is programmed to sequentially select the reference angle from the set {15°, 45°, 75°, 90°} for an equal amount of time. Fig. 6(a) shows the convergence of control parameters K in 96 iterations of the coordinate descent. For the described experiment, the set of parameters that produces the minimum value for a performance metric (5), is chosen as the best. These results also support the assertion that Kd=0 is an optimal value for the soft actuator.
Figure
6.
Control parameter convergance by coordinate descent. Each iteration of coordinate descent represents one expreiment. (a) shows the tuning results for the complete operation range θr∈ [0°, 90°], i.e., θr is sequentially selected from set [15°, 45°, 75°, 90°]. The final values are Kp=0.5,Ki=1.86,andKd=0. (b) shows the results for subrange θr∈ [0°, 30°), i.e., θr= 15°, the final values are Kp=1,Ki=2.44,andKd=0. (c) shows the results for subrange θr∈ [30°, 60°), i.e., θr= 45°, the final values are Kp=1.48,Ki=3.77,andKd=0. (d) shows the results for subrange θr∈ [60°, 90°), i.e., θr= 75°, the final values are Kp=1.49,Ki=2.43,andKd=0.
The convergence of the control parameters for the first subrange [0°, 30°), i.e., θr= 15°, using the coordinate descent is shown in Fig. 6(b). Similar results are shown for the second subrange [30°, 60°) (θr= 45°) in Fig. 6(c) and for the third subrange [60°, 90°) (θr= 75°) in Fig. 6(d). These results further strengthen the assertion that Kd=0 is optimal. Table II gives a summary of the parameter tuning experiments.
2) Comparison of Controllers
The following presents a comparison of the three PID-controllers, presented in Section III-A, with manual and automatic tuned control parameters. The controllers are applied with sinusoidally varying reference signals of different frequencies. The controllers are compared based on their ability to accurately track time-varying reference signals. The tracking accuracy of a controller is calculated using the following error metric:
E=1nn∑i=1|θr[i]−θ[i]|
(7)
where θr[i] is a sinusoidally varying reference angle and θ[i] is the PneuNet bending angle from the sensor.
Comparisons between the following six distinct PID controllers: {ordinary, piecewise, fuzzy} PID × {manual, automatic} are discussed now. The tuned control parameters summarized in Table III are used to perform all of the experiments. Each method was tested using seven reference signal frequencies of progressively increasing distinct values, varying from 0.05 Hz to 5 Hz. A total of 25 trials were performed for each experimental case. The response of one trial (out of 25) for tracking the signal frequency of 0.05, 0.5, and 5 Hz and shown in Figs. 7–9, respectively. Due to the low frequency of the reference signal, the PneuNet can accurately track the time-varying reference angle. Statistics on the error distributions in the 25 trials for each experiment are shown in Fig. 10. It can be seen that, in most cases, the automatically tuned parameters usually provided better results than the manually tuned parameters. A similar trend can be observed for the Piecewise and Fuzzy PID-controllers, i.e., the error metric is of a smaller value as compared to the ordinary PID. These observations are consistent with the theory of PID-controllers. Since Piecewise and fuzzy PID-controllers continually adapt the parameters according to the reference angle, they provide superior performance as compared to the ordinary PID-controller. At very high frequencies, the performance deteriorates significantly; therefore, fuzzy may exhibit high errors as compared to other methods. Similarly, at low frequencies, the system can easily track reference signals; therefore, all methods perform similarly.
Table
III.
Comparison Between 6 Differnet Scenarios of PID Variants and Tuning Algorithm Is Summarized. For Each Scenario, 25 Experiments Are Performed and Summarized as Median Along With First and Third Qurantiles of Error Metric Defined in (7). In Most Cases Fuzzy PID With Automatic Tuning Produce Best Results
Frequency
Manual tuning
Automatic tuning
Ordinary PID
Piecewise PID
Fuzzy PID
Ordinary PID
Piecewise PID
Fuzzy PID
0.05
19.03 (16.54, 21.65)
12.29 (10.50, 13.71)
16.37 (13.55, 18.50)
9.07 (7.49, 12.56)
11.41 (9.29, 12.88)
9.79 (7.86, 12.99)
0.10
18.94 (17.08, 21.51)
17.81 (15.20, 21.13)
19.22 (15.59, 20.99)
17.12 (14.31, 19.50)
13.44 (10.86, 15.32)
11.05 (9.21, 14.04)
0.20
23.08 (20.25, 24.87)
22.29 (18.10, 25.58)
24.67 (20.40, 26.86)
19.59 (16.77, 21.42)
16.76 (13.24, 20.05)
15.29 (13.42, 18.48)
0.50
28.40 (24.30, 31.36)
26.49 (21.38, 33.78)
28.48 (26.75, 39.98)
32.74 (31.32, 34.31)
26.15 (22.86, 28.03)
25.46 (23.01, 29.63)
1.00
42.56 (38.54, 44.64)
36.39 (34.53, 38.14)
35.47 (32.89, 36.35)
39.29 (37.78, 43.43)
34.00 (32.21, 36.40)
32.32 (31.02, 35.33)
2.00
67.66 (57.90, 70.58)
43.96 (41.53, 48.90)
49.13 (44.89, 60.95)
44.95 (42.14, 46.73)
42.25 (40.60, 45.66)
42.22 (39.99, 44.58)
5.00
55.78 (53.48, 58.14)
50.01 (39.66, 53.26)
46.20 (41.46, 52.41)
52.78 (44.87, 60.29)
52.03 (46.55, 55.71)
45.14 (41.80, 39.42)
* Values are written as median (25th, 75th) percentile.
Figure
7.
Response of one trial (out of 25) for six distinct methods with a sinusoidal reference signal of 0.05 Hz. At low frequencies, the controller can accurately track time varying reference signals, hence the low value of the error metric (7)
Figure
9.
Response of one trial (out of 25) for six distinct methods with a sinusoidal reference signal of 5 Hz. At such a high frequency, the physical property (e.g., inertia) of soft muscles constraint the frequency at which it can track input sinusoidal reference. The soft muscle is completely unable to track the reference signal
Figure
10.
Summary of the tracking error comparision of six distinct experiments at frequencies ranging from 0.05 Hz to 5 Hz. The dots shows the median value while box edges shows 25th and 75th percentile. At higher frequencies, the error metric defined by (7) increase
Moving toward higher frequencies in Fig. 10, it can be observed that the error metric began to increase gradually. This can be attributed to the quickly varying reference angle and the slow response rate of the PneuNet. The mechanical properties of the PneuNet (i.e., inertia and the response rate of hydraulic systems) contribute to the slow response in the case of a sudden change in reference angle. From the experiments, it was observed that the PneuNet can track reference signals of up to 0.5 Hz. Higher frequencies cause error metrics of large values. The response in one trial (out of 25) for a reference signal frequency of 0.5 Hz is shown in Fig. 8. In this case, the PneuNet is barely able to track the reference signal, with a large lag between output and input. Similar results for 5 Hz are shown in Fig. 9.
Figure
8.
Response of one trial (out of 25) for six distinct methods with a sinusoidal reference signal of 0.5 Hz. At increase in frequency of above 0.05 Hz the output begins to lag the input due to the slow reposne of the PneuNet. The error metric of (7) is high as compared to the 0.05 Hz
In this paper, we presented a comparison between three different PID-based control algorithms to operate a soft robot. Since PID-controllers require control parameter tuning, we presented a brief overview of manual and automatic control parameter tuning algorithms. We showed that an automatic tuning algorithm such as the coordinate descent can be used to optimize a defined performance metric to obtain optimal control parameters. A comparison was made between six distinct methods. It was shown that automatically tuned parameters generally produce better results than manually tuned parameters. Furthermore, the piecewise and fuzzy PID was shown to be more accurate in most cases because of their flexibility in continually adapting the control parameters based on a reference angle. Before ending this section as well as this paper, it is worth mentioning that this is the first systematical evaluation of various PID-controller variants using extensive data from real experiments and the first time that a critical difference between rigid-body and soft robots are identified.
R. C. Luo, M. C. Ko, Y. T. Chung, and R. Chatila, “Repulsive reaction vector generator for whole-arm collision avoidance of 7-DoF redundant robot manipulator,” in Proc. IEEE/ASME Int. Conf. Advanced Intelligence Mechatronics, Besancon, France, 2014, pp. 1036–1041.
[2]
T. S. Li, C. J. Lin, P. H. Kuo, and Y. H. Wang, Grasping Posture Control Design for a Home Service Robot using an ABC-based Adaptive PSO Algorithm, International Journal of Advanced Robotic Systems, vol. 13, no. 3, p. 118, 2016.
[3]
A. Kazakidi, X. Zabulis, and D. P. Tsakiris, “Vision-based 3D motion reconstruction of octopus arm swimming and comparison with an 8-arm underwater robot,” in Proc. IEEE Int. Conf. Robotics and Automation, Seattle, USA, 2015, pp. 1178–1183.
[4]
M. Sfakiotakis, A. Kazakidi, A. Chatzidaki, T. Evdaimon, and D. P. Tsakiris, “Multi-arm robotic swimming with octopus-inspired compliant web,” in Proc. IEEE/RSJ Int. Conf. Intelligent Robots and Systems, Chicago, USA, 2014, pp. 302–308.
[5]
Y. Sakuhara, H. Shimizu, and K. Ito, “Climbing soft robot inspired by octopus”, in Proc. IEEE Int. Conf. Intell. Syst., Varna, Bulgaria, 2020, pp. 463–468.
[6]
V. Falkenhahn, F. A. Bender, A. Hildebrandt, R. Neumann, and O. Sawodny, “Online TCP trajectory planning for redundant continuum manipulators using quadratic programming,” in Proc. IEEE Int. Conf. Advanced Intelligent Mechatronics, Alberta, Canada, 2016, pp. 1163–1168.
[7]
C. Escande, T. Chettibi, R. Merzouki, V. Coelen, and P. M. Pathak, “Kinematic calibration of a multisection bionic manipulator,” IEEE/ASME Trans. Mechatronics, vol. 20, no. 2, pp. 663–674, 2015. doi: 10.1109/TMECH.2014.2313741
[8]
T. Mahl, A. Hildebrandt, and O. Sawodny, “A variable curvature continuum kinematics for kinematic control of the bionic handling assistant,” IEEE Trans. Robotics, vol. 30, no. 4, pp. 935–949, 2014. doi: 10.1109/TRO.2014.2314777
[9]
H. B. Gilbert, D. C. Rucker, and R. J. Webster, “Concentric tube robots: The state of the art and future directions,” Robotics Research, 2016, pp. 253–269.
[10]
C. Bergeles, A. H. Gosline, N. V. Vasilyev, P. J. Codd, P. J. Nido, and P. E. Dupont, “Concentric tube robot design and optimization based on task and anatomical constraints,” IEEE Trans. Robotics, vol. 31, no. 1, pp. 67–84, 2015. doi: 10.1109/TRO.2014.2378431
[11]
M. F. Rox, D. S. Ropella, R. J. Hendrick, E. Blum, R. P. Naftel, H. C. Bow, S. D. Herrell, K. D. Weaver, L. B. Chambless, and R. J. Webster III, “Mechatronic design of a two-arm concentric tube robot system for rigid neuroendoscopy,” IEEE/ASME Trans. Mechatronics, vol. 25, no. 3, pp. 1432–1443, 2020.
[12]
G. Li, L. Sun, X. Lu, J. Hao, and J. Liu, “A practical, fast, and lowcost kinematic calibration scheme for a deformable manipulator by using leap motion,” in Proc.IEEE Int. Conf. Robotics and Biomimetics, Qingdao, China, 2016, pp. 719–724.
[13]
G. Li, S. Xu, L. Sun, and J. Liu, “Kinematic-free position control for a deformable manipulator,” in Proc. 35th Chinese Control Conf., Chengdu, China, 2016, pp. 10302–10307.
[14]
G. Li, L. Sun, S. Xu, D. Song, and J. Liu, “A hybrid model and kinematic-free control framework for a low-cost deformable manipulatror using in home service,” in Proc.IEEE Int. Conf. Automation Science and Engineering, Fort Worth, Texas, 2016, pp. 1002–1007.
[15]
M. C. Yip and D. B. Camarillo, “Model-less hybrid position/force control: A minimalist approach for continuum manipulators in unknown,” Constrained Environments,IEEE Robotics and Automation Letters, vol. 1, no. 2, pp. 844–851, 2016. doi: 10.1109/LRA.2016.2526062
[16]
M. C. Yip and D. B. Camarillo, “Model-less feedback control of continuum manipulators in constrained environments,” IEEE Trans. Robotics, vol. 30, no. 4, pp. 880–889, 2014. doi: 10.1109/TRO.2014.2309194
[17]
N. G. Cheng, M. B. Lobovsky, S. J. Keating, A. M. Setapen, K. I. Gero, A. E. Hosoi, and K. D. Iagnemma, “Design and analysis of a robust, lowcost, highly articulated manipulator enabled by jamming of granular media,” in Proc. IEEE Int. Conf. Robotics and Automation, Saint Paul, USA, 2012, pp. 4328–4333.
[18]
H. Jiang, Z. Wang, Y. Jin, X. Chen, P. Li, Y. Gan, S. Lin, and X. Chen, “Hierarchical control of soft manipulators towards unstructured interactions,” The Int. J. of Robot. Research, vol. 40, no. 1, pp. 411–434, 2021.
[19]
R. H. Sturges and S. Laowattana, “A flexible tendon-controlled device for endoscopy,” The Int. J. Robotics Research, vol. 12, no. 2, pp. 121–131, 1993. doi: 10.1177/027836499301200202
[20]
K. S. Roh, S. Yoon, Y. D. Kwon, Y. Shim, and Y.-J. Kim, “Single-port surgical robot system with flexible surgical instruments,” in Proc. Int. Conf. Intelligent Robotics and Applications, vol. 9245, pp. 447–459, 2015.
[21]
J. Lee, Y.-J. Kim, S. Roh, J. Kim, Y. Lee, J. Kim, B. Choi, and K. Roh, “Tension propagation analysis of novel robotized surgical platform for transumbilical single-port access surgery,” in Proc. IEEE/RSJ Int. Conf. Intelligent Robots and Systems, Tokyo, Japan, 2013, pp. 3083–3089.
[22]
A. R. Hanzaki, S. K. Saha, and P. Rao, “An improved dynamic modeling of a multibody system with spherical joints,” Multibody System Dynamics, vol. 21, no. 4, pp. 325–345, 2009. doi: 10.1007/s11044-008-9141-3
[23]
J. Zhang, H. Guo, R. Liu, and Z. Deng, “Nonlinear characteristic of spherical joints with clearance,” J. Aerospace Technology and Management, vol. 7, no. 2, pp. 179–184, 2015. doi: 10.5028/jatm.v7i2.464
[24]
P. Flores, J. Ambrósio, J. C. P. Claro, and H. M. Lankarani, “Dynamics of multibody systems with spherical clearance joints,” J. Computational and Nonlinear Dynamics, vol. 1, no. 3, pp. 240–247, 2006. doi: 10.1115/1.2198877
[25]
A. Faraz and S. Payandeh, “Towards approximate models of coulomb frictional moments in: (I) Revolute pin joints and (II) Spherical-socket ball joints,” J. Engineering Mathematics, vol. 40, no. 3, pp. 283–296, 2001. doi: 10.1023/A:1017545030199
[26]
A. Uguz and S. H. Oka, “Modeling the effects of mechanical loads: Finite element modeling of ball joints under dynamic loading,” Materialpruefung/Materials Testing, vol. 46, no. 10, pp. 506–512, 2004. doi: 10.3139/120.100618
[27]
G. G. Adams and M. Nosonovsky, “Contact modeling-forces,” Tribology International, vol. 33, no. 5–6, pp. 431–442, 2000. doi: 10.1016/S0301-679X(00)00063-3
[28]
T. Schmidt, R. Newcombe, and D. Fox, “DART: Dense articulated realtime tracking with consumer depth cameras,” Autonomous Robots, vol. 39, no. 3, pp. 239–258, 2015. doi: 10.1007/s10514-015-9462-z
To balance the contradiction between flexibility and load bearing capacity, we introduce a deformable link composed of series of spherical joints
We present a static force-based model of spherical joints with preload forces and analyze the static force propagation in the deformable link
We proposed a low-cost calibration method to identify the model parameters
Export File
Citation
G. F. Li, D. Z. Song, L. Sun, S. Xu, H. P. Wang, and J. T. Liu, "Static Force-Based Modeling and Parameter Estimation for a Deformable Link Composed of Passive Spherical Joints With Preload Forces," IEEE/CAA J. Autom. Sinica, vol. 8, no. 11, pp. 1817-1826, Nov. 2021. doi: 10.1109/JAS.2019.1911549
G. F. Li, D. Z. Song, L. Sun, S. Xu, H. P. Wang, and J. T. Liu, "Static Force-Based Modeling and Parameter Estimation for a Deformable Link Composed of Passive Spherical Joints With Preload Forces," IEEE/CAA J. Autom. Sinica, vol. 8, no. 11, pp. 1817-1826, Nov. 2021. doi: 10.1109/JAS.2019.1911549
Table
III.
Comparison Between 6 Differnet Scenarios of PID Variants and Tuning Algorithm Is Summarized. For Each Scenario, 25 Experiments Are Performed and Summarized as Median Along With First and Third Qurantiles of Error Metric Defined in (7). In Most Cases Fuzzy PID With Automatic Tuning Produce Best Results
Frequency
Manual tuning
Automatic tuning
Ordinary PID
Piecewise PID
Fuzzy PID
Ordinary PID
Piecewise PID
Fuzzy PID
0.05
19.03 (16.54, 21.65)
12.29 (10.50, 13.71)
16.37 (13.55, 18.50)
9.07 (7.49, 12.56)
11.41 (9.29, 12.88)
9.79 (7.86, 12.99)
0.10
18.94 (17.08, 21.51)
17.81 (15.20, 21.13)
19.22 (15.59, 20.99)
17.12 (14.31, 19.50)
13.44 (10.86, 15.32)
11.05 (9.21, 14.04)
0.20
23.08 (20.25, 24.87)
22.29 (18.10, 25.58)
24.67 (20.40, 26.86)
19.59 (16.77, 21.42)
16.76 (13.24, 20.05)
15.29 (13.42, 18.48)
0.50
28.40 (24.30, 31.36)
26.49 (21.38, 33.78)
28.48 (26.75, 39.98)
32.74 (31.32, 34.31)
26.15 (22.86, 28.03)
25.46 (23.01, 29.63)
1.00
42.56 (38.54, 44.64)
36.39 (34.53, 38.14)
35.47 (32.89, 36.35)
39.29 (37.78, 43.43)
34.00 (32.21, 36.40)
32.32 (31.02, 35.33)
2.00
67.66 (57.90, 70.58)
43.96 (41.53, 48.90)
49.13 (44.89, 60.95)
44.95 (42.14, 46.73)
42.25 (40.60, 45.66)
42.22 (39.99, 44.58)
5.00
55.78 (53.48, 58.14)
50.01 (39.66, 53.26)
46.20 (41.46, 52.41)
52.78 (44.87, 60.29)
52.03 (46.55, 55.71)
45.14 (41.80, 39.42)
* Values are written as median (25th, 75th) percentile.
Figure 1. The deformable manipulator deployed on a home service robot and its deformable links. The deformable links are composed of passive spherical joints with preload forces between socket-ball surfaces. One important problem is to estimate the load bearing capacity of the deformable link.
Figure 2. The preload force between socket-ball surfaces is isotropic with magnitude δ0. Under the external force, the stress distribution between socket-ball surfaces is composed of two half-ellipsoids. The two half-ellipsoids share a pair of equal semi-axes with δ0. The third semi-axes, which rotate θ to ˆXi, are δ0+δmax and δ0−δmax, respectively.
Figure 3. The infinitesimal amount of the normal and the tangential forces exerted on the i-th spherical joint by the (i+1)-th component. The resulting force and the moment are obtained by the integration over the socket-ball surfaces.
Figure 4. For iFi with any direction and acting point, it can easily be transferred to a representative case that iFi=[f,0,0]T and iQ=[0,0,l]T.
Figure 5. The geometry size of one component of the deformable link.
Figure 6. (a) A photo of the experiment setup. The base component of the deformable link is fixed on a vise clamp. An RGB-D camera (RealSense, F200) is placed on the top of the deformable link to measure its kinematic parameters. (b) A screenshot of the measurement process.
Figure 7. Data-fitted curve for spherical joints in Link1.
Figure 8. The residuals of the data-fitted curve for spherical joints in Link1.
Figure 9. Data-fitted curve for spherical joints in Link2
Figure 10. The residuals of the data-fitted curve for spherical joints in Link2
Figure 11. The comparison of the maximum payload masses between the measured payload and the model prediction. (a) Comparison for Link1. (b) Comparison for Link2.
Figure 12. The histogram of the total 46 percentage errors.