 Original Article
 Open Access
 Published:
Compound Impedance Control of a Hydraulic Driven Parallel 3UPS/S Manipulator
Chinese Journal of Mechanical Engineering volume 33, Article number: 56 (2020)
Abstract
The hydraulic parallel manipulator combines the highpower density of the hydraulic system and high rigidity of the parallel mechanism with excellent loadcarrying capacity. However, the highprecision trajectory tracking control of the hydraulic parallel manipulator is challenged by the coupling dynamics of the parallel mechanism and the high nonlinearities of the hydraulic system. In this study, the trajectory control of a 3DOF symmetric spherical parallel 3UPS/S manipulator is evaluated. Focusing on the highly coupling and nonlinear system dynamics, a compound impedance control method for a hydraulic driven parallel manipulator is proposed, which combines impedance control with the spatial motion characteristics of a parallel manipulator. The control strategy is divided into the inner and outer loops. The inner loop controls the impedance of the actuator in the joint space, and the outer loop controls the impedance of the entire platform in the task space to compensate the coupling of the actuators and improve the tracking accuracy of the moving platform. Compound impedance control does not require force or pressure sensors and is less dependent on modeling precision. The experimental results show that the compound impedance control effectively improves the tracking accuracy of the moving platform. This research proposes a compound impedance control strategy for a 3DOF hydraulic parallel manipulator, which has high tracking precision with a simple and cheap system configuration.
Introduction
Parallel manipulators are widely applied in flight simulators [1, 2], machine tools [3], and sixdimensional force sensors [4] because they have higher stiffness, increased precision, lower inertia of moving parts at a high speed, and higher accuracy than those of their serial counterparts. However, their closed chain structure creates a complicated forward kinematic analysis and highly coupled timevarying nonlinear system dynamics. In addition, the uncertainty in the manipulator parameters and disturbances make it difficult to achieve high trajectory tracking control for parallel manipulators.
A number of works have investigated improving the tracking accuracy of parallel manipulators. PID control is the conventional and simplest method used to control the system and is widely used in parallel manipulators. However, because of the highly nonlinear and coupled dynamic behaver of parallel manipulators, the tracking error of pure PID control rapidly increases with speed [5]. To improve the performance of the PID controller, Amit Shukla proposed a novel controller that includes a PID controller and a compensator to deal with the coupling terms and varying parameters [6]. Londhe et al. [7] proposed a robust nonlinear PIDlike fuzzy control scheme for a 3DOF parallel manipulator, by combining a feed forward term and PIDlike fuzzy logic control. However, these methods cannot achieve a high tracking accuracy.
To overcome the highly coupled dynamics of parallel manipulators, a number of modelbased control methods have been proposed, such as computed torque control [8, 9], feedforward force with PD feedback control [10, 11], adaptive control [12, 13], and robust control [14, 15]. A computed torque controller has been proposed for parallel manipulators, which is well suited for trajectory tracking control and disturbance rejection. However, the computed torque controller depends on the knowledge of the system, and the performance is generally significantly degraded when the modeling is inaccurate. Tien Dung Le proposed an online selfgain tuning method for a 2DOF planar parallel manipulator, which is based on a combination of a conventional computed torque controller and an online tuning method using the neural network [16]. Feedforward force with PD feedback control is a popular control strategy applied to parallel manipulators. This method combines the advantages of calculated torque control and PID control and reduces the dependence of the calculated torque control on the accuracy of the system model. To reduce the dynamic tracking error in a highly real time application, Yang et al. [17] proposed a computed force and velocity controller for hydraulic 6DOF parallel manipulators, which is composed of a conventional PID feedback controller and a desired driven force and actuator velocity as feed forward.
The adaptive control method enhances the adaptability of the control performance for the uncertainty by constructing a new dynamic system to continuously learn the system characteristics. Considering the uncertainty effect caused by a combination of rigid body parameters, friction, and actuator dynamics, Cazalilla et al. [18] developed an adaptive controller for trajectory tracking control of a 3DOF parallel manipulator. The application of adaptive control in parallel mechanisms reduces the requirement of precise dynamic modeling in the controller. However, the adaptive control increases the realtime calculation burden of the controller, and the realization of adaptive control requires meeting the persistence excitation conditions, which improves the requirements of the tracking trajectory. Robust control can also deal with model uncertainties. Li et al. [19] designed a controller based on a passivitybased robust control scheme for a 3PRC parallel manipulator. Other robust control methods include linear robust control [20], sliding mode control [21], etc.; however, the common disadvantage of these methods is that law leads to a chattering problem, which significantly reduces trajectory tracking performance.
Impedance control [22] improves the motion of the manipulators by adjusting the relationship between the motion and driving force. It is typically used in applications that require complex interaction with the environment, such as assembly, drilling, and milling. However, some researches [23, 24] have shown that impedance control also demonstrates the desirable trajectory tracking ability in free motion. The tracking ability of impedance control in free motion can be explained by introducing the concept of a virtual surface. Ghosh [25] proposed a robust control framework based on a bond graph modeling process. This method reduces the influence of system dynamics parameter uncertainties by adding dominant terms for complex and highly nonlinear robot dynamics. For manipulators with flexible foundations, Pathak et al. [26] improved the above method to eliminate the interference of flexible foundations more effectively without knowing the dynamic parameters of flexible foundations by adjusting the dynamic characteristics of the mechanism in the form of an algorithm. Based on the physical reliability of the flexible foundation, the virtual surface concept is further proposed. The impedance controller constructs the virtual surface through the desired trajectory in real time and realizes trajectory tracking in free motion by adjusting the motion error between the actual position and virtual surface; thus, trajectory tracking control is realized.
Recently, lowermobility parallel mechanisms were widely used in aviation, medical, and other industries owing to the lower cost and simpler controller [27]. Considering joint couplings, Liu et al. [28] proposed an iterative approach for feedforward controller parameter tuning for a 3DOF parallel mechanism. For a 2DOF 2PRPPPR parallel manipulator, Santhakumar Mohan [29] proposed a robust cascaded control scheme for the endeffector pose error correction in trajectory tracking caused by mechanical inaccuracies. Angel et al. [30] applied a computed torque control strategy with a fractional order PID method. This strategy shows a robust and active disturbance rejection compared to that with the integer order PID method. The research objective of this study is a 3DOF spherical space parallel 3UPS/S mechanism for wave compensation, whose tracking accuracy affects the quality of compensation.
As an important driving form, hydraulic actuators provide an attractive alternative for parallel manipulators, because they are robust and can produce significant forces/torques for their size without concern of overloading. However, the highly nonlinear dynamics and uncertainties in the hydraulic system make their closedloop control design extremely challenging [31]. Common control strategies considering the dynamics of hydraulic actuators for parallel manipulators include cascade control [32, 33], backstepping control [34], virtual decomposition control [35], etc. One of the key problems in motion control of the hydraulic driven parallel mechanism is realizing highprecision driving force control of the hydraulic system. Guo et al. [33] integrated nonlinear compensation of the flow rate of the servo valve, positive velocity feedback, and load pressure feedback to control the pressure of the two chambers of the hydraulic cylinder. Considering the influence of the pipeline pressure transients and friction, Yang et al. [1] monitored the driving force in real time using a force sensor and obtained the piston force controller of the hydraulic actuator based on feedback linearization. Huang et al. [36] applied incremental nonlinear dynamic inversion (INDI) to design a robust force controller based on the pressure/force sensor and obtained better force tracking performance than that of the feedback linearization method. The control performance of the above methods depends on the high precision force/pressure sensor, which limits the application of these methods. Yoo et al. [37] presented an impedance control approach for a hydraulic system that required no external force/pressure sensors based on a backdrivable servovalve. However, the manufacturing cost of this type of system is relatively high.
In this paper, a compound impedance control method is proposed for a 3DOF hydraulic parallel manipulator. The proposed method adopts a double loop structure to deal with the highly coupling dynamic and complex driving characteristics of hydraulic parallel manipulators. The proposed method does not require exact system dynamic parameters, such as mass distribution and friction. The proposed method uses a simplified asymmetric hydraulic servo system model based on a singular perturbation analysis, which has the characteristics of universality. Moreover, the proposed method uses the displacement sensors and regular servovalves without expensive force or pressure sensors, creating a simple and cheap system configuration. The experimental result shows that the proposed method can track the typical reference signals according to wave motion and achieve a higher tracking accuracy than that of the finetuned PID controller.
The paper is organized as follows. The dynamic models of the 3UPS/S parallel mechanism and hydraulic actuator are established in the second and third section. In the fourth section, the singular perturbation analysis for the hydraulic servo system is discussed. The relationship between the input signal of the valve and the driving force is given, and the exponential convergence of the corresponding boundary layer model is determined. Then, the impedance control processes in the joint space and task space are described. Finally, the overall structure of the compound impedance control is given. In the fifth section, the 3UPS/S manipulator prototype is developed. Experiments are carried out for the tracking performance validation of the proposed method compared with the wellturned PID control.
Modeling of the 3UPS/S Parallel Manipulator
As shown in Figure 1, the moving platform of 3UPS/S is connected to the fixed platform by a central spherical joint and three symmetrically distributed actuators. The upper end of each actuator is connected to the moving platform by a spherical joint, and the lower end is connected to the fixed platform by universal joints. The 3UPS/S mechanism is driven by hydraulic actuators, and the posture of the moving platform is adjusted by changing the length of the actuators. In contrast to the Stewart mechanism, the center spherical joint restrains the threedimensional translation of the moving platform, retaining the threedimensional rotation of the moving platform. Considering the workspace characteristics of the mechanism, the pitching and rolling motion of the moving platform are mainly used in practice.
Modeling of the 3UPS/S Parallel Manipulator
As shown in Figure 2, coordinate system \(\left\{ N \right\}\) is fixed to the fixed platform. Frame \(\left\{ A \right\}\)is fixed to the moving platform. The upper joint point distribution radius is R_{1}. The joint point distribution radius is R_{2}, and the center height of the central spherical joint is h.
The coordinates of the lower joint point B_{i} (i = 1,2,3) in {N} can be expressed as
where \(\eta_{1} = \pi ,\;\eta_{2} = {\pi \mathord{\left/ {\vphantom {\pi 3}} \right. \kern0pt} 3},\;\eta_{3} = {{  \pi } \mathord{\left/ {\vphantom {{  \pi } 3}} \right. \kern0pt} 3}.\)
The coordinates of upper joint point A_{i} (i = 1, 2, 3) in {A} can be expressed as follows:
The RPY angle is used to describe the relative motion relationship between the moving platform and fixed platform. The relationship between coordinate system {A} and coordinate system {N} can be expressed by the rotation matrix.
The transformation relationship between the vectors in {A} and {N} is as follows:
where \({}^{N}{\varvec{u}}\) and \({}^{A}{\varvec{u}}\) represent the coordinates of vector \({\mathbf{u}}\) in {A} and f {N}, respectively.
3UPS/S has threedimensional rotational degrees of freedom around the central spherical joint, and the rotation angle of the moving platform relative to the fixed platform determines the posture of the manipulator. The length of the three actuators can be obtained uniquely from the rotation angle, which is referred to as the inverse kinematics model of the 3UPS/S manipulator.
In {N}, the coordinates of each position vector are as follows.
Inverse Dynamics Model
The dynamic model of the 3UPS/S parallel mechanism is established by Kane’s method. The threedimensional rotation in the task space of the moving platform is selected as the generalized coordinates and denoted as \({\varvec{q}} = [q_{1} ,q_{2} ,q_{3} ]^{\text{T}}\). The coordinate \({\varvec{u}} = [u_{1} ,u_{2} ,u_{3} ]^{\text{T}}\) of the angular velocity of the moving platform in {N} is selected as the generalized velocity, which yields the following:
The dynamics model of the 3UPS/S manipulator can be written as
where \({\varvec{T}}\) denotes the generalized active force caused by gravity and the forces in the Cartesian space of the moving platform, \({\varvec{T}} = {\varvec{T}}({\varvec{q}},{\varvec{F}}_{L} ,{\varvec{T}}_{L} ,{\varvec{G}})\); \({\varvec{F}}_{L} ,{\varvec{T}}_{L}\) denotes the load force on the moving platform; \({\varvec{M}}\) denotes the mapping matrix of the driving force from the joint space to the workspace, \({\varvec{M}} = {\varvec{M}}\left( {\varvec{q}} \right)\); \({\varvec{Q}}\) denotes the driving force vector; \({\varvec{F}}^{*}\) denotes the generalized inertial force, \({\varvec{F}}^{*} = {\varvec{F}}^{*} \left( {{\varvec{q}},{\dot{\varvec{q}}},{\varvec{\ddot{q}}}} \right)\). The detailed expressions for the above symbols are given in Appendix.
The inverse dynamic model of 3UPS/S can be written as follows:
Dynamic Model of the Hydraulic Servo System
The 3UPS/S hydraulic servo system is shown in Figure 3, where r represents the input signal; K_{p} represents the proportional gain of the system; F_{L} represents the load force; P_{S} represents the supply pressure; P_{0} represents the tank pressure; P_{A} and P_{B} represent the pressures of the two chambers of the hydraulic cylinder; A_{1} and A_{2} represent the effective area of the two chambers.
The bond graph model of the hydraulic servo system is shown in Figure 4, where \(R_{f}\) represents the friction of the hydraulic cylinder; \(R_{i} \left( {i = 1,2,3,4} \right)\) represents the four resistances of the servovalve.
The servo valve can be expressed as four hydraulic resistances connected to each other, which can be expressed as follows:
Here, P, T, A, and B represent the four ports of the servo valve; \(Q_{PA} ,\;Q_{AT} ,\)\(Q_{BT}\) and \(Q_{PB}\) denote the flow of the corresponding valve port, which is in the positive direction of P to A, A to T, B to T, and P to B, respectively; \(C_{d}\) represents the flow coefficient of the valve orifice; \(w\) represents the gradient of the servo orifice area with the opening of the valve; \(x_{v}\) represents the displacement of the spool; \(\rho\) represents the density of the oil, and \(\Delta P_{i}\) (i = 1, 2, 3, 4) represents the differential pressure between the corresponding ports.
The friction force of the hydraulic cylinder is assumed to be proportional to the velocity.
where \(C\) is the damping coefficient, and v_{p} is the velocity of the hydraulic actuator.
Assuming that the internal leakage of the hydraulic cylinder is small and can be ignored, the model of the hydraulic servo system can be expressed as follows:
Assumption 1
In a practical hydraulic system under normal working conditions, \(P_{1}\) and \(P_{2}\) are bounded by \(P_{0}\) and \(P_{s}\), i.e., \(P_{0} \le P_{1} ,P_{2} \le P_{s} .\)
Controller Design
Hydraulic Driving Force Model Based on Singular Perturbation
An important problem in a hydraulic driven parallel manipulator is the force generation in the hydraulic servo system. In this study, the relationship between the valve input signal and driving force is determined by a singular perturbation analysis. Most physical system models can be described by states with different rates, which can be divided into boundary layer subsystems described by faster states and reduced order subsystems described by slower states. The Tikhonov theorem [38] states that when the boundary layer model is stable, the fastchanging states can be removed, while the static relationship is considered the boundary condition to participate in the process of the slowchanging states, thus achieving system dimensionality reduction and simplification. The singular perturbation analysis is widely applied in the hydraulic servo system [39]. Based on the above analysis, the hydraulic servo system can be described by four states: the pressure states and mechanical states, which refer to the displacement and velocity of the actuator. Because of the pressure conduction characteristics of oil, the rate of the pressure states is much faster than that of the mechanical states. Through singular perturbation, the relationship between the valve input signal and driving force can be obtained from the static relation of the fastchanging states. In this section, the corresponding singular perturbation analysis process and the proof of the exponential convergence of the boundary layer are given.
For the hydraulic servo system described in Eq. (13), the mechanical state is \(x_{h} = \left[ {x_{1} ,x_{2} } \right]^{\text{T}}\), and the pressure state of the hydraulic system is \(z_{h} = \left[ {x_{3} ,x_{4} } \right]^{\text{T}}\).
Considering the difference between the bulk modulus of the two chambers, the following is assumed:
The state equation for pressure can be written as follows:
Substituting Eq. (10) into Eq. (15) with \(\varepsilon = 0\), a quasistatic representation of the pressure state is given by
where \(K_{Q1} \triangleq C_{d1} w_{1} K_{v} \sqrt {\frac{\rho }{2}} \;\;\;,\;\;\;K_{Q2} \triangleq C_{d2} w_{2} K_{v} \sqrt {\frac{\rho }{2}}\).
The simplified order reduction model of the hydraulic servo system can be obtained by substituting Eqs. (16) and (17) into Eq. (18):
The boundary layer model of the hydraulic servo system can be written as follows:
The auxiliary variable \({\varvec{y}} = {\varvec{z}}_{h}  {\varvec{h}}\left( {t,x} \right)\) is introduced to move the equilibrium point of the boundary layer model to the origin:
Substituting Eq. (20) into Eq. (19) and introducing time variable \(\tau = \frac{1}{\varepsilon }\left( {t  t_{0} } \right)\), the boundary layer model is given as follows:
where
When \(u > 0,\)
Based on Assumption 1, one can obtain the following:
When \(u < 0,\)
Based on Assumption 1, one can obtain the following:
The following boundary layer model is obtained:
When \(u > 0\), \(x_{2} > 0,\;\left {x_{2} } \right = x_{2} ,\)
When \(u < 0\), \(x_{2} < 0,\;\left {x_{2} } \right =  x_{2} ,\)
Here, \(\varvec{y} = 0\) is the equilibrium point of \(\frac{{{\text{d}}\varvec{y}}}{{\text{d}}\tau } = \varvec{g}\). After linearization, the stability of the boundary layer model is evaluated by solving the Jacobian matrix.
The Jacobian matrix can be written as follows:
where
With Eq. (24), the following is obtained:
then
The sign of \(\frac{{\partial g_{1} }}{{\partial y_{1} }}\) yields
Similarly, by defining \(y_{2} = z_{2}  h_{2} = x_{4}  h_{2}\), the sign of \(\frac{{\partial g_{2} }}{{\partial y_{2} }}\) is given by
The boundary layer model satisfies \(\text{Re} \left[ {\lambda \left\{ {\frac{{\partial {\varvec{g}}}}{{\partial {\varvec{y}}}}} \right\}} \right] \le  c < 0,\forall \left( {t,x} \right) \in \left[ {0,t_{1} } \right] \times D_{x}\). Thus, the boundary layer model of the singularly perturbed system has exponential convergence [38].
Hydraulic Driving Force Model Based on Singular Perturbation
The relationship between the valve input signal and output force of the hydraulic cylinder piston is obtained by the singular perturbation analysis for the hydraulic servo system. To realize position tracking control, the relationship between the output force and motion of the hydraulic actuator should be determined. To achieve an effective and stable drive, this relationship is designed as a spring damping model, as shown in Figure 5.
The desired force \(F_{v}\) satisfies
With the singular perturbation analysis, by ignoring the tank pressure, the driving force yields
where K_{A} denotes the valve characteristic coefficient and is defined as follows:
To realize trajectory tracking control, the following should be satisfied:
Here, \(F_{L}\) denotes the total load force, including the friction force.
After replacing the actual speed with the instruction speed, the final control law is obtained:
Remark 1
One of the advantages of this algorithm is that the stiffness expression can be freely programmed. The drive stiffness should be large enough to guarantee position accuracy and robustness. In addition, the output signal is required to be bounded without an infinite signal.
The drive stiffness could be planned by a hyperbolic tangent function, as shown in Figure 6.
Here, \(F_{D}^{S}\) denotes the driving force produced by the spring effect, and F_{m} is the maximum of the spring force.
Remark 2
To prevent output u from being infinite, the following should be satisfied:
To improve system reliability, the output can be further limited:
where \(S_{m}\) is the maximum input of the valve; \(\dot{r}_{0}\) is a typical value of the command rate.
To track the abnormal reference speed, the effective command rate of 0.1–0.5 is used, substituting \(\hbox{min} \left( {0.5,\hbox{max} \left( {\left {\dot{r}} \right,0.1} \right)} \right)\) for \(\left {\dot{r}} \right\) in Eq. (40).
Impedance Control in the Task Space
The proposed impedance control is an operation process that takes load, command, and feedback signal as the input and the valve input signal as the output. To ensure reliability of the control process, the trajectory command of each actuator is obtained by an inverse kinematics model. Based on the idea of impedance control, the correcting moment is obtained from the motion deviation in the task space of the manipulator and then mapped to the additional driving force of each driving branch as the load input to compensate the overall motion characteristics of the manipulator.
When the manipulator is subjected to external torque T_{s}, the driving force in the equilibrium state is correspondingly increased by \(\Delta {\varvec{Q}}\). To obtain the mapping relationship between external torque T_{s} and driving force increment \(\Delta {\varvec{Q}}\), the platform dynamic inverse model Eq. (9) is written in increment form:
where the external moment \(\Delta {\varvec{T}}\) yields:
Using Eqs. (44) and (45), the relationship between \(\Delta {\varvec{T}}\) and \(\Delta {\varvec{Q}}\) is given as follows:
The generalized velocity of the moving platform relative to the fixed platform yields the following:
The mapping relationship between the task space and joint space of the 3UPS/S manipulator yields the following:
For impedance control, virtual spring damping is constructed in the task space, and the force is mapped to each actuator through matrix \({\varvec{M}}^{  1}\):
Impedance Control in the Task Space
Compound impedance control performs impedance control in the joint space and task space. First, through the singular perturbation analysis of the hydraulic servo system, a single cylinder trajectory tracking control method, including load factors, is obtained and combined with impedance control. Then, for impedance control, virtual spring damping is constructed in the task space of the mechanism, and the force is mapped to the driving branch in reverse. For each actuator, trajectory tracking control is performed in the joint space of the manipulator, and realtime adjustment is performed according to the motion error in the task space.
Combining the impedance control algorithm in the joint space, an additional driving force \(\Delta Q_{i}\) is added to each actuator. The 3UPS/S overall control algorithm can be expressed as follows:
where
The corresponding block diagram is shown in Figure 7.
To realize the impedance control in the task space, the threeaxis rotation angle should be obtained in the task space of the parallel platform in real time. Considering the measurement accuracy and reliability, an indirect measurement method is adopted to obtain the moving platform rotation angle by detecting the displacement of the driving joint based on forward kinematics solution of the manipulator. The forward kinematics analysis process of the 3UPS/S mechanism (nonlinear algebraic equations) is complex and has multiple solutions. In practice, numerical methods [40] are often applied to obtain the motion of the moving platform. In this study, the forward position solution of 3UPS/S is obtained using the neural network method, based on the comparison of accuracy and computational efficiency.
Prototype System and Experimental Results
To verify the trajectory tracking performance of compound impedance control, a hydraulic driven 3UPS/S parallel manipulator prototype is developed, as shown in Figure 8 and Figure 9. The control system consists of the host computer and slave computer. The host computer is implemented by Labview in Windows to realize command generation/reception, data supervision, and recording. The slave computer adopts the NIcRIO controller and completes the trajectory tracking control of each actuator according to the sequence of the displacement command sent by the host computer. For the 3UPS/S manipulator prototype, the distribution radius is 0.38 m; the distribution radius of the joint point of the lower platform is 0.51 m; the height of the platform at the center of central ball joint h is 1.15 m; the initial rotation angle of the moving platform is \({{\pi }}/6\); the stroke of the hydraulic actuator is 450 mm; the diameter of the hydraulic cylinder is 40 mm; the diameter of the hydraulic piston rod is 25 mm; the hydraulic cylinder displacement sensor accuracy is 0.02%, and the moving platform inclination sensor accuracy is ±1.67×10^{‒3} rad. From the wave spectrum, the desired trajectories in two freedoms are designed as follows:
The platform is designed to compensate wave motion and provide a stable working environment for shipboard equipment. The tracking curves of the PID control and compound impedance control for compound sinusoidal instructions with a frequency of 0.1‒0.4 Hz, according to the statistical law of wave motion, are shown in Figure 10 and Figure 11. The classical PID control scheme is also applied to the parallel manipulator as a benchmark. For convenience of description, the rotation of the 3UPS/S platform around the n_{1} axis is defined as rolling motion \(\alpha\), and the rotation around the n_{2} axis is defined as pitching motion \(\beta\). The attitude signal of the platform is obtained by the inclination sensor arranged on the moving platform. In Figures 10 and 11, the tracking curve of compound impedance control can reproduce the shape of the command curve, while the PID control shows obvious errors when the command speed sharply changes.
In Figure 12, the trajectory tracking curve of the manipulator in the pitchroll motion plane is given with compound impedance and PID control. The tracking command is the synthetic motion of the moving platform in the pitchroll motion plane shown in Figures 9 and 10. In Figure 12, the platform with compound impedance control shows better tracking ability than that with PID control.
The trajectory tracking performance of the parallel manipulator can be evaluated by the concept of comprehensive error [41]. In the pitchroll plane, the trajectory error is defined as
where E_{P} is the pitch trajectory tracking error of the moving platform, and E_{R} is the roll trajectory tracking error.
Figure 13 shows the variation of synthetic error with respect to time. From Figure 13, the PID control error shows a continuous fluctuation trend with a peak of approximately 0.02 rad and an average of approximately 0.01 rad. Whereas, the compound impedance control error is maintained at a low level overall, with a peak of 0.01 rad and an average of approximately 0.005 rad. Jouni Mattila [31] adopted the ratio of tracking error and motion speed to evaluate the control accuracy level of the mechanism. Figure 14 shows the distribution of the command velocity of the comprehensive trajectory error with different control methods. The comprehensive trajectory error definition is shown in Eq. (52), and the command speed is defined as:
where \(\hat{v}_{\text{P}}\) is the command speed of the moving platform in pitch motion; \(\hat{v}_{\text{R}}\) is the roll command speed in roll motion.
From Figure 14, the compound impedance control error increases gradually with the command speed in the lowspeed interval with the rate of 0.1 s. With further increasing command speed, the tracking error is stable at 0.005 rad. The PID control error fluctuates at 0–0.02 rad.
Conclusions

(1)
The trajectory tracking control of a parallel 3DOF manipulator is studied. The kinematics and dynamics model of the 3DOF 3UPS/S mechanism as well as the dynamics model of the hydraulic servo system are established. Through the singular perturbation analysis, a force sensorless hydraulic force generator is obtained, and the exponential stability of the boundary layer model of the singular system is demonstrated.

(2)
A compound impedance control strategy for trajectory tracking of the hydraulic parallel manipulator is proposed. The control strategy is divided into the inner loop and outer loop. The inner loop controls the impedance of each actuator in the joint space, and the outer loop controls the impedance of the entire manipulator in the task space to compensate for the coupling of the actuators. The experimental results show that the compound impedance control has better trajectory tracking ability than that of the wellturned PID controller.

(3)
The proposed compound impedance control does not require force or pressure sensors and has a low dependence on the accuracy of the modeling. Compared with other advanced control methods, the compound impedance control has higher control accuracy and provides a novel framework for dealing with the highly coupling and nonlinear dynamics of hydraulic parallel manipulators.
References
 [1]
C F Yang, Q T Huang, J W Han, et al. Decoupling control for spatial sixdegreeoffreedom electrohydraulic parallel robot. Robotics and ComputerIntegrated Manufacturing, 2012, 28(1): 1423.
 [2]
S H Koekebakker. Coordinate reconstruction in model based control of a stewart platform. IFAC Proceedings Volumes, 1998, 31(27): 103108.
 [3]
D Wang, J Wu, L P Wang, et al. A method for designing control parameters of a 3DOF parallel tool head. Mechatronics, 2017: 102113.
 [4]
J T Yao, D L Wang, D J Cai, et al. Faulttolerant strategy and experimental study on compliance assembly of a redundant parallel sixcomponent force sensor. Sensors and Actuators APhysical, 2017: 114124.
 [5]
M Honegger, R Brega, G Schweiter, et al. Application of a nonlinear adaptive controller to a 6 DOF parallel manipulator. International Conference on Robotics and Automation, San Francisco, California, 2000: 19301935.
 [6]
A Shukla, H Karki. Modeling simulation & control of 6DOF parallel Manipulator using PID controller and compensator. IFAC Proceedings Volumes, 2014, 47(1): 421428.
 [7]
P S Londhe, Y Singh, M Santhakumar, et al. Robust nonlinear PIDlike fuzzy logic control of a planar parallel (2PRPPPR) manipulator. ISA Transactions, 2016: 218232.
 [8]
H Cheng, Y K Yiu, Z X Li, et al. Dynamics and control of redundantly actuated parallel manipulators. IEEE/ASME Transactions on Mechatronics, 2003, 8(4): 483491.
 [9]
A Codourey. Dynamic modeling of parallel robots for computedtorque control implementation. The International Journal of Robotics Research, 1998, 17(12): 13251336.
 [10]
H Abdellatif, B Heimann. Advanced modelbased control of a 6DOF hexapod robot: a case study. IEEE/ASME Transactions on Mechatronics, 2010, 15(2): 269279.
 [11]
J S Wang, J Wu, L P Wang, et al. Dynamic feedforward control of a parallel kinematic machine. Mechatronics, 2009, 19(3): 313324.
 [12]
W W Shang, S Cong, Y Ge, et al. Adaptive computed torque control for a parallel manipulator with redundant actuation. Robotica, 2012, 30(3): 457466.
 [13]
L Ren, J K Mills, D Sun, et al. Experimental comparison of control approaches on trajectory tracking control of a 3DOF parallel robot. IEEE Transactions on Control Systems and Technology, 2007, 15(5): 982988.
 [14]
H S Kim, Y M Cho, K Lee, et al. Robust nonlinear task space control for 6 DOF parallel manipulator. Automatica, 2005, 41(9): 15911600.
 [15]
D H Kim, J Y Kang, K Lee, et al. Robust tracking control design for a 6 DOF parallel manipulator. Journal of Robotic Systems, 2000, 17(10): 527547.
 [16]
T D Le, H J Kang, Y S Suh, et al. An online selfgain tuning method using neural networks for nonlinear PD computed torque controller of a 2DOF parallel manipulator. Neurocomputing, 2013: 5361.
 [17]
C F Yang, Q T Huang, J W Han, et al. Computed force and velocity control for spatial multiDOF electrohydraulic parallel manipulator. Mechatronics, 2012, 22(6): 715722.
 [18]
J Cazalilla, M Valles, V Mata, et al. Adaptive control of a 3DOF parallel manipulator considering payload handling and relevant parameter models. Robotics and Computerintegrated Manufacturing, 2014, 30(5): 468477.
 [19]
Y M Li, Q S Xu. Dynamic modeling and robust control of a 3PRC translational parallel kinematic machine. Robotics and Computerintegrated Manufacturing, 2009, 25(3): 630640.
 [20]
H T Liu, X H Tian, Wang G, et al. Finitetime Hinf control for highprecision tracking in robotic manipulators using backstepping control. IEEE Transactions on Industrial Electronics, 2016, 63(9): 55015513.
 [21]
Y Singh, V Vinoth, Y R Kiran, et al. Inverse dynamics and control of a 3DOF planar parallel (Ushaped 3PPR) manipulator. Robotics and ComputerIntegrated Manufacturing, 2015: 164179.
 [22]
N Hogan. Impedance control: An approach to manipulation: Part I—Theory. Journal of Dynamic Systems Measurement and ControlTransactions of the ASME, 1985, 107(1): 17.
 [23]
H Sadjadian, H D Taghiradf. Impedance control of the hydraulic shoulder a 3DOF parallel manipulator. Robotics and Biomimetics, 2006: 526531.
 [24]
H Z Arabshahi, A B Novinzadeh. Impedance control of the 3RPS parallel manipulator. International Conference on Robotics and Mechatronics, Bali, Indonesia, 2014: 486492.
 [25]
A K Ghosh. Dynamics and robust control of robotic systems: a bond graph approach. Kharagpur: Indian Institute of Technology, 1990.
 [26]
P M Pathak, A Mukherjee, A Dasgupta, et al. Impedance control of space robots using passive degrees of freedom in controller domain. Journal of Dynamic Systems Measurement and ControlTransactions of the ASME, 2005, 127(4): 564578.
 [27]
W Ye, Q C Li. Type synthesis of lower mobility parallel mechanisms: A review. Chinese Journal of Mechanical Engineering, 2019, 32(1): 111.
 [28]
Q Liu, J L Xiao, X Yang, et al. An iterative tuning approach for feedforward control of parallel manipulators by considering joint couplings. Mechanism and Machine Theory, 2019: 159169.
 [29]
S Mohan. Error analysis and control scheme for the error correction in trajectorytracking of a planar 2PRPPPR parallel manipulator. Mechatronics, 2017: 7083.
 [30]
L Angel, J Viola. Fractional order PID for tracking control of a parallel robotic manipulator type delta. ISA Transactions, 2018: 172188.
 [31]
J Mattila, J Koivumaki, D G Caldwell, et al. A survey on control of hydraulic robotic manipulators with projection to future trends. IEEEASME Transactions on Mechatronics, 2017, 22(2): 669680.
 [32]
W H Ding, H Deng, Y M Xia, et al. Tracking control of electrohydraulic servo multiclosedchain mechanisms with the use of an approximate nonlinear internal model. Control Engineering Practice, 2017: 225241.
 [33]
H B Guo, Y G Liu, G R Liu, et al. Cascade control of a hydraulically driven 6DOF parallel robot manipulator based on a sliding mode. Control Engineering Practice, 2008, 16(9): 10551068.
 [34]
S H Chen, L C Fu. Observerbased backstepping control of a 6dof parallel hydraulic manipulator. Control Engineering Practice, 2015, 36(36): 100112.
 [35]
J Koivumaki, J Mattila. Stabilityguaranteed forcesensorless contact force/motion control of heavyduty hydraulic manipulators. IEEE Transactions on Robotics, 2015, 31(4): 918935.
 [36]
Y Z Huang, D M Pool, O Stroosma, et al. Longstroke hydraulic robot motion control with incremental nonlinear dynamic inversion. IEEE/ASME Transactions on Mechatronics, 2019, 24(1): 304314.
 [37]
S Yoo, W Lee, W K Chung, et al. Impedance control of hydraulic actuation systems with inherent backdrivability. IEEE/ASME Transactions on Mechatronics, 2019, 24(5): 19211930.
 [38]
Hassan K Khalil. Nonlinear systems. 3rd ed. Prentice Hall, 2001.
 [39]
C W Wang, L Quan, S J Zhang, et al. Reducedorder model based active disturbance rejection control of hydraulic servo system with singular value perturbation theory. ISA Transactions, 2017, 67: 455465.
 [40]
A Zubizarreta, M Larrea, E Irigoyen, et al. Real time direct kinematic problem computation of the 3PRS robot using neural networks. Neurocomputing, 2018, 271: 104114.
 [41]
J H Chin, Y Sun, Y M Cheng, et al. Force computation and continuous path tracking for hydraulic parallel manipulators. Control Engineering Practice, 2008, 16(6): 697709.
Acknowledgements
Not applicable.
Funding
Supported by National Natural Science Foundation of China (Grant No. 51875499).
Author information
Affiliations
Contributions
LZ was in charge of the whole trial; LW wrote the manuscript; SC and CM assisted with sampling and laboratory analyses. All authors read and approved the final manuscript.
Authors’ Information
Lihang Wang, born in 1989. He received his PhD degrees from Yanshan University, China, in 2019. His PhD work was in the field of hydraulic servo control system for parallel mechanism.
Shaofei Cui, born in 1993, is a master candidate majoring in mechanical engineering at Yanshan University, China. His research interests are fluid transmission and control.
Chong Ma, born in 1994, is a master candidate majoring in mechanical engineering at Yanshan University, China. His research interests are fluid transmission and control.
Lijie Zhang, born in 1969, is currently a professor at College of Mechanical Engineering, Yanshan University, China. He received his PhD degree in 2006 from Yanshan University, China. His research interests include hydraulic system control, hydraulic components reliability and robot control.
Corresponding author
Ethics declarations
Competing Interests
The authors declare no competing financial interests.
Appendix
Appendix
In this Appendix, the detailed expressions for the symbols in Eq. (8) are given as follows:
Here, \({\varvec{F}}_{L}\) and \({\varvec{T}}_{L}\) are the load force and moment of the moving platform, respectively, given by
where \({\varvec{G}}_{{W_{\text{u}} }} ,{\varvec{G}}_{{L_{u} }}^{i} ,{\varvec{G}}_{{L_{d} }}^{i}\)are the gravity of the moving platform and the ith driving branch, given below:
Here, \({\varvec{v}}_{r}^{{W_{\text{u}} *}}\) denotes the partial velocity of the mass center of the moving platform; \({\varvec{\omega}}_{r}^{{W_{\text{u}} }}\) denotes the partial angular velocity of the moving platform; \({\varvec{\omega}}_{r}^{{L_{i} }}\) denotes the partial angular velocity of the ith driving branch; \({\varvec{v}}_{r}^{{L_{u}^{i} *}}\) denotes the partial velocity of the mass center of the ith upper driving branch, and \({\varvec{v}}_{r}^{{L_{d}^{i} *}}\) denotes the partial velocity of the mass center of the ith lower driving branch (r = 1, 2, 3):
Here, \({\varvec{s}}_{i}\) denotes the unit vector of the ith driving branch.
For moving platform W_{u}, the generalized inertial force and generalized moment of inertia are respectively expressed as
where \({\varvec{a}}^{{W_{\text{u}}^{*} }}\) denotes the acceleration of the mass center of the moving platform; \({\varvec{\alpha}}^{{W_{\text{u}} }}\) denotes the angular acceleration of the moving platform; \({\varvec{\omega}}^{{W_{\text{u}} }}\) denotes the angular velocity the moving platform, and \({\varvec{ I}}^{{W_{\text{u}} }}\) denotes the central inertia dyadic of the moving platform.
For the ith upper driving branch \(L_{u}^{i}\), the generalized inertial force and generalized moment of inertia are respectively expressed as
where \(\varvec{a}^{{L_{u}^{i} *}}\) denotes the acceleration of the mass center of the ith upper driving branch; \(\varvec{\alpha}^{{L_{u}^{i} }}\) denotes the angular acceleration of the ith upper driving branch; \({\varvec{\omega}}^{{L_{i} }}\) denotes the angular velocity of the ith upper driving branch, and \({\varvec{ I}}^{{W_{\text{u}} }}\) denotes the central inertia dyadic of the ith upper driving branch.
The relationship between the motion of the moving platform and generalized velocity can be obtained as follows:
For the ith driving branch, the relationship can be obtained by
where \({\varvec{v}}^{{A_{i} }}\) denotes the velocity of upper joint A_{i}; \({\varvec{a}}^{{A_{i} }}\) denotes the acceleration of upper joint A_{i}, \(\varvec{a}^{{A_{i} }} =\varvec{\alpha}^{A} \times \varvec{r}^{{PA_{i} }} +\varvec{\omega}^{A} \times \left( {\varvec{\omega}^{A} \times \varvec{r}^{{PA_{i} }} } \right)\;\).
The generalized velocity vectors are defined as
and the unit vector is as follows:
The partial velocities of each component are listed in Table 1.
Rights and permissions
Open Access This article is licensed under a Creative Commons Attribution 4.0 International License, which permits use, sharing, adaptation, distribution and reproduction in any medium or format, as long as you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons licence, and indicate if changes were made. The images or other third party material in this article are included in the article's Creative Commons licence, unless indicated otherwise in a credit line to the material. If material is not included in the article's Creative Commons licence and your intended use is not permitted by statutory regulation or exceeds the permitted use, you will need to obtain permission directly from the copyright holder. To view a copy of this licence, visit http://creativecommons.org/licenses/by/4.0/.
About this article
Cite this article
Wang, L., Cui, S., Ma, C. et al. Compound Impedance Control of a Hydraulic Driven Parallel 3UPS/S Manipulator. Chin. J. Mech. Eng. 33, 56 (2020). https://doi.org/10.1186/s10033020004702
Received:
Revised:
Accepted:
Published:
Keywords
 Parallel manipulator
 Impedance control
 Hydraulic servo system
 Trajectory tracking