1. Introduction
Parallel manipulators are becoming more and more interesting in the field of machine tools and robots due to their precision, stiffness, and dynamics [
1,
2,
3,
4,
5,
6,
7]. Jiang proposed a modal space control strategy suitable for the electro-hydraulic Steward manipulator [
8]. This method maps the control and feedback variables of the joint space to the modal space, therefore every degree of freedom can be individually controlled and adjusted. Compared with the traditional PID controller, simulation results show that the modal space controller has better control performance in almost all aspects.
In order to ensure good dynamic characteristics, servo valve is usually adopted to Stewart manipulator as the drive part, which waste large amount of energy. Direct drive electro-hydraulic servo system has the advantages of energy saving, simple structure, convenient installation, and low failure rate [
9]. But its dynamic characteristics are so poor that it can only be applied to occasions where a quick response is not needed. With greatly improved dynamic characteristics, the application of direct drive system in Stewart manipulator instead of valve control system can not only greatly reduce the energy consumption, but also an independent pump station, which is quite big, is no longer needed. For its poor dynamic characteristics, the structure and control strategy of direct drive system are widely studied. Shen et al. [
10] enhanced the dynamic response of a new type electro-hydraulic actuator adopted variable displacement pump with a fuzzy controller. Sliding mode controller was also applied to direct drive system [
11,
12,
13], especially, the real-time values of the rod velocity and acceleration obtained from the measurement signal of displacement were applied with the discrete variable structure control algorithm, by using a third-order integral chain differentiator [
14]. Wang et al. proposed a state estimation-based model predictive control strategy to deal with the constraints and poor robustness problems existing in the system of a servo motor driven pump-controlled asymmetric cylinder [
15]. A model predictive controller applicable to the model of unidirectional proportional pump-controlled asymmetric cylinder was proposed based on model predictive control theory and QPhild quadratic optimization algorithm in order to guarantee its non-overshooting output by Xiong et al. [
16].
But in the above papers which focused on the structure and control strategy of direct drive system, one servo motor driving one actuator was basically adopted as the main part of direct drive system, and the load was quite simple, but due to the structure of Stewart manipulator, six servo motors driving six piston actuators is the main part, and the coupling of the dynamic model of the Stewart manipulator in this paper which did not exist and was not considered in the papers above should be considered and solved first. Moreover, the control system design with the speed of the servo motor as the control input is usually adopted and the coupling of the dynamic model of the Stewart manipulator can be easily solved with modal space coordinate transformation similar to the servo valve Stewart manipulator, but this will cause current coupling of all six servo motors, which is difficult to be achieved and controlled with the details below. So the control system design which is closer to the direct drive Stewart manipulator with both the coupling of the dynamic model of the Stewart manipulator and the current coupling of the servo motors solved is of great engineering importance, finally, simple but effective control strategy which can improve the dynamic characteristics is also quite necessary, well these requirements are solved in this paper.
The paper is organized as follows. First the key method to improve the dynamic characteristics of direct drive system is summarized. Then, combined with the structure of Stewart manipulator, the transfer function based on the speed of the servo motor and modal space coordinate transformation is established, and the current coupling of the servo motors is investigated. In next the transfer function based on the current of the servo motor and modal space coordinate transformation in which the current coupling disappears is established. Finally, the PD plus dynamic pressure feedback control strategy is put forward according to the transfer function previously obtained, which is verified by using a simulated hydraulically driven Stewart manipulator.
3. Transfer Function Analysis of the Direct Drive Stewart Manipulator Based on the Motor Speed and Current Coupling
The basic schematic diagram of the direct drive hydraulic system above is shown in
Figure 4.
For direct drive system, rotation speed of the servo motor is usually selected as the control input. The flow continuity equation of the rod-less cavity is:
where
and
are the displacements of the double pump,
is the piston area of the rod-less cavity,
and
are the pressures of the rod cavity and the rod-less cavity,
is the volume of the rod-less cavity,
is the volume of the pipeline,
l is the displacement of the actuator piston,
is the oil bulk modulus,
,
,
, and
are the internal and external leakage coefficients of the actuator and the double pump,
is the volumetric efficiency of the double pump,
is the rotation speed of the servo motor.
The flow continuity equation of the rod cavity is:
where
is the piston area of the rod cavity,
is the volume of the rod cavity.
From the relationship between the double pump and the area ratio of the two chambers of the hydraulic actuator, we know:
so, Equation (7) will be rewritten as:
and load pressure
can be defined as:
assuming
,
and
, writing
as
for convenience, combining with Equations (6)–(9), the flow continuity equation of the direct drive system can be rewritten as:
where
.
Taking Laplace transform of Equation (11), the flow equilibrium equation of the
i-th actuator can be written as:
also, the net output force of the
i-th actuator is given as:
where
is the viscous damping coefficient of the actuator. Combining with Equations (13) and (4), we have the dynamic equations in joint space as:
combining with Equation (5), defining new variables
,
, the dynamic model in the modal space is given by:
therefore, similar to the transform function of the servo valve Stewart manipulator, the coupled direct drive system can be decomposed into six independent third-order systems along the modal direction, which consist of an integration link and a two-order oscillation link, which have the same form as a hydraulically driven mechanical system with one degree of freedom.
Considering the torque equation of the servo motor and vector control, following equation can be obtained as:
since roughly
, ignoring the influence of the accumulator, and according to modal space coordinate transformation, Equation (16) can be written as:
since the matrix
and
of the right side are not diagonal, it can be seen that strong coupling still exists in the current of the six servo motors, which not only leads to high requirements for the motor control, but also makes the control of speed extremely difficult. Moreover, the current control signal of each servo motor usually comes from the speed error signal itself, so the strong coupling in the current which cannot be compensated from the speed error signal can greatly reduce the bandwidth of the speed loop of all six servo motors.
Therefore, it is not appropriate to treat the rotation speed as the control input to establish the transfer function of the direct drive Stewart manipulator. However, the electrical mechanical parameters of the motor-gear pump unit are basically stable. Besides, the dynamic characteristics of the current-loop of the servo motor is satisfactory, which can be guaranteed from the electrical time constant of 1kw-2kw servo motor, which is usually about 3.5ms. Therefore, the control system of the direct drive Stewart manipulator with the current of the servo motor as the control input will be closer to the actual system, and the control algorithm based on the current of all six servo motors will bring out actual control effect. Moreover, pre-multiplying both sides of Equation (17) by , the matrix and of right side become diagonal, which means the coupling in current can be solved with modal space coordinate transformation.
4. Transfer Function of the Direct Drive Stewart Manipulator Based on the Motor Current and Modal Space Coordinate Transformation
Taking Laplace transform, Equation (16) can be rearranged as:
where
TL is the load torque
,
is the pressure change of the accumulator, if
can be ignored, the load torque
can be defined as:
Equation (19) can be rewritten as:
where
,
.
The relationship between the pressure change of the accumulator
and the displacement of the actuator is:
where
is the equivalent spring stiffness. Taking Laplace transform, the flow equilibrium equation of the
i-th actuator can be written as:
Equation (22) can be rewritten as:
therefore, although the direct drive system in this paper also treat the current as the control input, its transfer function is different from that of a servo valve controlled system.
Similar to Equation (14), we have the dynamic equations of the direct drive Stewart manipulator in joint space as:
similarly, the transfer function of the direct drive system based on modal space coordinate transformation can be written as:
in this way, the transfer function of the direct drive Stewart manipulator is obtained.
It is worth noting that the elasticity of the accumulator will affect the basic structure of the transfer function. If the elasticity of the accumulator needs to be considered, the system is composed of two second-order oscillation links. But if the accumulator in the system has is so large that the elasticity of the accumulator can be ignored that is the displacement of the piston rod will not cause an apparent change of the pressure in the accumulator, then correspondingly, the transfer function consists of an integral link, an inertial link, and a second-order oscillation link.
According to the consideration above, a large accumulator should be selected. Although the order of the transfer function can not be reduced, for control algorithm, the less complex the transfer function, the better control effect can be easily achieved. Generally, the leakage is little,
Kce can be omitted, so Equation (25) becomes:
while control strategy will be added next.
5. PD plus Dynamic Pressure Feedback Control Strategy
For servo valve Stewart manipulator, the damping ratio of the second-order link can be increased or decreased by using dynamic pressure feedback control [
18]. As second-order link still exists, dynamic pressure feedback control is still necessary. Since the inertia link will cause lag, which adversely affects the dynamic characteristics of the manipulator, the PD plus dynamic pressure feedback control strategy is needed for this system.
With dynamic pressure feedback control, Equation (23) will become:
where
is the transfer function of the dynamic pressure feedback link. Therefore, Equation (26) will become:
supposing
is the denominator of the inertial link and
is the denominator of the second-order oscillation link. Denominator of the whole link can be expressed as:
since
is much bigger than
and
in value, which can be calculated from parameters. So if
is applied as a first derivative link with a proportionality factor and added to the original direct drive system, the damping ratio of the second-order link could be changed, and the oscillation frequency of the second-order link is not greatly affected, but the coefficient of the inertia link is affected. So in order to achieve the corresponding increase or decrease of the damping ratio, the first derivative of the load pressure should be taken, similar to the servo valve Stewart manipulator.
Due to the inertia link, the motor-gear pump unit can not quickly convert the error signal into effective flow. Generally, the transfer function of PD link can be written as:
Since the differentiation of the error signal can predict its variation, and the change of the input signal also can be obtained from the differentiation of the error signal and added to the control signal for compensation. So PD control should be applied to improve the transient process of the system. Due to the order of Equation (26), the closed-loop poles of the transfer function are basically unchanged with PD control added., but PD control leads to another open-loop zero point which usually has an effect on the damping ratio [
20]. So PD control should be used in conjunction with dynamic pressure feedback control to achieve good control effect.
6. Simulation and Comparison
The control strategy proposed in this paper is verified by using MATLAB software, the Stewart manipulator and the corresponding control algorithm are both built using Simulink block. The schematic diagram of the simulation model is shown in
Figure 5.
This model consists of six blocks on top level. The first is the Signal Generator block, which can generate white noise signals. The second is the Inverse Motion block, used to calculate actuators commands. The third is the Hydraulic System block, including a PD control block, a Dynamic Pressure Feedback block, and an Actuator block. The fourth is the Plant block, representing the dynamic equations of Stewart manipulator. The fifth is the Forward Solution block, used to compute platform positions from measured actuator lengths in real time. The sixth is the Inverse Dynamics block, which calculates the modal transform matrix. Parameters of the hydraulic system of the simulation model are shown in
Table 1.
According to the principle of modal space coordinate transformation, the displacement signal of the actuator with respect to the position and attitude of the manipulator and the load pressure need to be subjected to the modal space first. Then, the sum of the current signals calculated from the PD control block and the Dynamic Pressure Feedback block needs to be transformed in an inverse transformation as shown in
Figure 6.
In
Figure 6, approximate differentiation is adopted in the Approximate Differential block. This approximate differentiation not only ensures the dynamic characteristics of the differentiation, but also reduces the effect of noise. Then, these signals are amplified in the Dynamic Pressure Feedback block with corresponding coefficients. The PD Control block performs proportion and differentiation operation on the error signal. The Actuator block is used to imitate the hydraulic system. Manual Switch blocks (Manual Switch 1 and Manual Switch 2) are also applied to implement different control effects.
According to the previous description, PD control has an impact on the damping ratio of the second order link. It is worth noting that dynamic pressure feedback control will also affect the control effect of PD control, so the parameters of the PD control block and the Dynamic Pressure Feedback block should be adjusted repeatedly to achieve good effect. The closed-loop Bode diagram of the original direct drive Stewart manipulator is shown in
Figure 7. Apparently, only four lines can be found, the main reason is that the closed-loop characteristics of x and y direction, rx and ry direction, are basically the same respectively due to the structural symmetry of the manipulator. And both coupling of the dynamic model of the Stewart manipulator and current coupling of the six servo motors are solved and the closed-loop bode diagram of each degree of freedom is independent from each other which is of great engineering importance. And as can be seen in the figure, bandwidths of all six degrees of freedom of the manipulator are narrow. PD control should be added.
The closed-loop Bode diagram of the direct drive Stewart manipulator with PD control is shown in
Figure 8. As PD control added, each closed-loop bandwidth is greatly expanded, and closed-loop bandwidths of all six degrees of freedom exceed 20 rad/s, while resonance peaks still exist, and nearly all resonance peaks go through the zero-decibel line which is bad to the system stability. So dynamic pressure feedback control should be applied to increase the damping ratio of the second-order oscillation link.
The closed-loop Bode diagram of the direct drive Stewart manipulator with PD plus dynamic pressure feedback control is shown in
Figure 9. Compared with
Figure 8, resonance peaks of all degrees of freedom disappear, and the stability of the direct drive Stewart manipulator is guaranteed.
7. Conclusions
The conclusions organized are as follow:
Modal space coordinate transformation is applicable and quite necessary to the direct drive Stewart manipulator.
The control design based on the speed of the servo motor and modal space coordinate transformation for the direct drive Stewart manipulator can not only solve the dynamic coupling but also cause current coupling which is quite difficult to achieve, while the control design based on the current of the servo motor and modal space coordinate transformation can solve both dynamic coupling and current coupling.
The PD plus dynamic pressure feedback control strategy proposed in this paper is quite simple and effective which can expand the bandwidths of all degrees of freedom of the direct drive Stewart manipulator.