You are on page 1of 10

International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:18 No:05

Force control for electro-hydraulic servo actuator


used for a humanoid robotic arm
A.Abdellatif*, Tan Quang DUONG*, S.ALFAYAD*, Olivier BRUNEAU*
*Laboratoire d’ingénierie des systèmes de Versailles, Université Paris-Saclay, 78140 Vélizy, Paris, France

Abstract—Due to the great power of hydraulic system of the gearbox torque and the inability to produce an
actuators, the control of electro-hydraulic actuators has been an instantaneous high torque without using a large sized motor.
important and ever developing point of research in the field of The other actuation discipline is using hydraulic power. This
humanoid robots. But due to the non-linearities of the hydraulic
systems, It is very difficult to implement either motion or force technology is characterized by its high power to weight ratio,
controllers on the hydraulic actuators experimentally before high power to volume index, high durability, producing large
the mechanism is modeled and simulated. This is due safety forces at high speeds and its high holding torque serve as
reasons and complex control issues. So, taking into account an interesting factors in humanoid robots actuation. Some of
the humanoid robot HYDROïD, this paper presents the design global known humanoid robots like ATLAS [8], SARCOS[9],
of PID position and force control algorithms, tested on an
electro-hydraulic servo actuator. This actuator is one of the HYQ[10] and the underdevelopment HYDROïD [11] are
actuators present on the robotic arm of HYDROïD. The virtual actuated hydraulically.
model of the system is built through co-simulation between
ADAMS [1] and EASY5 [2] software. The output results were So, in traditional terms, the robot must perform tedious and
later validated using hardware implementation. repetitive tasks with great speed and accuracy [13]. In which,
the repetition of tasks and the controllable environment, the
Index Terms—Humanoid Robot, HYDROïD, Force Control, position and force controlled robotic manipulators should
PID Control, Hydraulic systems.
trace the predefined joint trajectories with ease. Hence,
precise interaction with humans and objects, the desire for a
I. I NTRODUCTION force controlled actuator would be of a great necessity.
For decades, advancement of robots has been proven by
the efforts and aspiration of the human being in making a But unfortunately, the dynamic characteristics of hydraulic
robot to be a real human companion in life [3]. Humanoid actuated systems makes it very difficult for such type of
robots, in particular, can be used in assisting aging humans control, due to the highly non-linear dynamics of such
and children, replacing humans in hazardous environments systems. This makes the force controlled actuators would
and as a test-bed for new prosthesis and or-thesis devices. have always limitations in the form of impedance, friction and
Hence, there have been a constant need for a convenient bandwidth. This limits the traditional linear controllers and
actuator for the joints of humanoid robots enabling a precise makes the electro-hydraulic actuator control a major point of
and powerful actions in addition to a safe and compliance research. However, several strategies have been introduced
motion. to work around the force control deficiencies of the electro-
hydraulic actuator. T. H. Lambert[12] derived the nonlinear
Actuation of the humanoid robots have become one of equations representing the hydraulic servos and showed the
the biggest challenges in robotics. Demanding performances assumptions necessary for linearizing such equations using
in actuation became needed to enhance the autonomy of analog computation. Such work, directed the attention to the
humanoid robots. Within this field, essential and desirable influence of the hydraulic parameters on the nonlinear closed
properties for actuators are required which include: 1) high loop behaviors. After that, Liu[14] proposed a mathematical
power to mass ratio; 2) ability to produce high torque at model for a typical servo system and exposed the nonlinear
low speed; 3) high integrated mechanism as it could occupy parameters with a compensation adaptive algorithm [15].
reduced volume or what can be called high power to volume C.L. Hwang and C.H. Lan [16] succeeded in eliminating
ratio; 4) human-like movements; 5) for safety reasons, the the non-linear behaviors of the hydraulic servo-mechansims
actuator must also ensure active compliance of the robot for through variable structure system controller algorithm. While,
safe interaction with humans [4]. Sohl and Bobrow[17] used a lyapunov derived function as
a controller design methodology to provide a stable force
Nowadays, actuation of humanoid robots depends mainly control with position tracking. In which, the controller
on two disciplines. Electric actuation, which is for humanoid is applied to an existing experimental hydraulic system
robots like LOLA [5], HRP4 [6], and REEM-B [7]. It has providing force and position tracking without the complexity
several advantages as it is low in cost and can be easily of variable structure or adaptive methods.
used and controlled. But its main problem appears while
connecting the electric motor to the load, where the limitation Then, Prut et al.[18] excluded the need for position

173106-1805-5454-IJMME-IJENS
c October 2018
IJENS
International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:18 No:05 2

knowledge for applying the force control law by using implementation is presented in section VI, showing the
force, force rate and pressure for force tracking. Finally, system components and the validation of the virtual model
K.Baghestan et al. in [19] proposed a linearized hydraulic and the controller. Finally, section VII is reserved for the
system around an operating point, while the polytopic conclusion and the future work.
uncertainties that emerged were faced by a robust H∞
controller. In general, all of these above advanced methods
improved the quality of force controller in this kind of II. M ATHEMATICAL MODEL OF THE ELECTRO - HYDRAULIC
system. However, the final result was not always the best. SYSTEM
Due to the fact of applying force/torque control on a
This paper deals with the control of the hydraulic actuators hydraulic actuated system, a model based control is required
of the humanoid hydraulic robot HYDROïD [20]. HYDROïD to achieve high dynamic performance. Therefore, knowing
is humanoid robot having 52 degrees of freedom. It is weighs that each joint of the robot arm is coupled by one servo
about 125 Kg and is 1.8 m height. It is the first european valve actuator, the dynamics of this kind of actuator should
robot to have the hydraulic integration technology, in which first be analyzed. These dynamic equations for the hydraulic
the hydraulic oil is transmitted inside the robot parts by system mainly come from the work of Merritt [21]. The
drilling into the mechanical parts. Its main objective is to transfer function between the control current Iin , and the
navigate in rough terrains, assist the elders and interact spool displacement on valve, xv , is given by :
socially with humans. Therefore, the development of a safe
interaction capability for its joints is a necessity. Kv ωn2
xv (s) = Iin (1)
s2 + 2ζωn s + ωn2 xv
Under the mantle of HYDROïD ’s project, A prototype
The control signal applied to the spool valve is directly
of a 7 degree of freedom robotic arm is being developed, in
proportional to the spool position, meaning that the dynamics
which each joint is equipped with one servo valve actuator,
of the valve motor/flapper are fast enough to be neglected.
sharing the same hydraulic source. The pressure and rotation
However, the effects of servovalve dynamics was included by
displacement sensors are attached suitably at each joint, in
other researchers [17] but in this case, it requires an additional
order to send the necessary feedback information to the
sensor to obtain the spool position and only minimal perfor-
controller. While, the geometrical and kinematics models are
mance improvement is achieved for position tracking. So, the
solved, an inverse dynamic model is needed to estimate the
flow is related to the spool valve displacement, neglecting the
force required for each actuator. Therefore, a force controller
leakage, can be described as :
is needed on the hydraulic actuators fixed at the joints to
ensure the right positioning of hydraulic actuator with the (
right torque. p Ps − P1 , xv ≥ 0
Q1 = k1 xv ∆P1 , ∆P1 =
P1 − Pr , xv < 0
But implementing the controller algorithms on the arm
prototype directly may have some problems. As the highly (
p P2 − Pr , xv ≥ 0
non-linear system and the powerful capacity of the hydraulic Q2 = k2 xv ∆P2 , ∆P2 =
actuator makes it very dangerous to apply directly the Ps − P2 , xv < 0
experimental controller to the prototype. Moreover, before Where k1 , k2 are the flow gain coefficients of the valve;
applying the controller algorithms on the arm prototype Ps and Pr are the supply pressure of the hydraulic oil and
directly, all the tasks should be built and simulated in the the tank pressure, respectively.
simulation software to ensure precision. Therefore, a linear
actuator test bench was developed for one degree of freedom As can be seen from the equations (2) and (3), the pres-
of motion and it is used for elementary implementation surized flow provided by the servo valve can be decomposed
subject. Where, the proposed force algorithm to be tested in three components: a flow generated by the displacement of
and verified with the a virtual model built in EASY5 and the piston, a flow induced by the compression of the oil in the
ADAMS software. actuator chamber, and a flow due to leakage in the actuator.

So, this paper reviews the dynamic behaviors of hydraulic V1 ˙


Q1 = A1 ẋ + P1 + QLI + QLE1 (2)
actuators through its mathematical model in section II. The 4β
geometrical and the kinematics models of the arm mechanism
V2 ˙
are presented in section III. The forces required for each Q2 = A2 ẋ + P2 + QLI + QLE2 (3)
hydraulic actuator are estimated through the inverse dynamic 4β
model of the arm mechanism which is shown in section where V1 = V01 + A1 x and V2 = V02 + A2 x are the total
IV. Also, a force control technique using PID controller is volumes of the chambers; V01 and V02 are the extend and
added to the virtual model of the joint mechanism built in retract chamber volumes when x = 0; β is the effective bulk
ADAMS software, in addition to the mathematical model modulus of the hydraulic oil; QLI is the internal flow leakage
of the hydraulic system which is built in EASY5r . This of the cylinder; QLE1 and QLE2 are the external flow leakage
co-simulation is shown in section V. After that the hardware of the chambers.

173106-1805-5454-IJMME-IJENS
c October 2018
IJENS
International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:18 No:05 3

Then, the dynamics of the actuator’s moving part is given


by :

mẍ = P1 A1 − P2 A2 − cẋ − Fs − Ff (4)

where, x is the actuator’s displacement; P1 , P2 are the pres-


sures inside the extend and retract chambers of the cylinder,
respectively;A1 ,A2 are the piston areas facing the extend and
retract chambers, respectively;Fs is the spring force; Ff is
the friction force; m is the mass of the moving part; c is the
equivalent viscous damping coefficient.

III. T HE KINEMATICS OF THE ARM MECHANISM Fig. 2. The arm mechanism coordinate frame.

Most of the robots present are designed with rigid links,


as Rigidty generates kinematic accuracy. So, the robotic links In which, Qi+1 is the rotation matrix and di+1 is the
i i
are modeled as a rigid body systems to simplify modeling translation vector.
and to increase the computational efficiency [22]. Therefore,
the arm mechanism can be considered as a system of rigid  
bodies connected together through joint elements as seen in cos qi − cos αi sin qi sin αi sin qi
Fig.1, where, the arm mechanism can be considered a serial Qi+1 = Qi =  sin qi cos αi cos qi − sin αi cos qi 
 
i
manipulator of joints of revolute type. This model of the arm 0 sin αi cos αi
mechanism will be main representation for calculating the (6)
geometric, kinematic and dynamic models in the following  
sections. ai cos qi
di+1 = di =  ai sin qi  (7)
 
i
bi
By applying the values of DH parameters in Fig.2 in Qi
and di as i ∈ 1 : 7 gives :

 
cos qi 0 sin qi
Qi+1 = Qi = ... = Q7 =  sin qi 0 − cos qi  (8)
 
i
0 1 0
 
0
d1 = d2 = d4 = d6 = 0 (9)
 

0
Fig. 1. The arm mechanism rigid model. The Base frame axis are denoted  
Xr , Yr and Zr while the end effector frame axis are denoted Xe , Ye and l1 cos q3
Ze
d3 =  l1 sin q3  (10)
 

0
 
A. Geometrical Model 0
d5 =  0  (11)
 
The kinematics of serial manipulators begins with the study
of the geometric relations between the joint variables, with −l2
one variable per joint. A seven axis manipulator, like the one  
displayed in Fig. 2 has seven joint variables, q1 , q2 ,q3 ..... l3 cos q7
qn . Denavit-Hartenberg notation was calculated and shown in d7 =  l3 sin q7 
 
(12)
Fig. 2.
0
Here, the transformation from frame Ri+1 to frame Ri is
represented by matrix Tii+1 , as: B. Kinematic Model
" # Based on the general case of of a serial revolute axis
i+1 Qi+1
i di+1
i manipulator seen in Fig.3, the angular velocity of the end
Ti = Ti = (5)
0 1 effector can be described as :

173106-1805-5454-IJMME-IJENS
c October 2018
IJENS
International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:18 No:05 4

q˙1
 
h i  q˙2 
0
wn+1 = e1 e2 .... en  (13)

 
....
q˙n

While, the linear velocity of the end effector can be de-


scribed as :

q˙1
 
Fig. 3. Serial n-revolute axis manipulator
h i  q˙ 
0 2
Vn+1 = e1 Xr1 e2 Xr2 .... en Xrn   (14)
....
IV. T HE INVERSE DYNAMIC MODEL
q˙n
Robot dynamics is the study of the relationship between
Where, ri = di + di+1 + .... + dn . From both equation 15 the applied forces/torques and the resulting motion of the
and equation 14, the linear and the velocity of the end effector manipulator. Similarly to kinematics, also for the dynamics
are represented as : it is possible to define direct and inverse model. The direct
dynamic model is that once the forces/torques applied to the
joints knowing the joint positions and velocities, the joint
q˙1
 
" # accelerations Rcan be computed as: q̈ = f (q,q̇,τ ) and then q̇ =
e1 e2 .... en  q˙  R
 0 0
  2 q̈ dt , q = q̇ dt.
wn+1 Vn+1 =  
e1 Xr1 e2 Xr2 .... en Xrn ....
q˙n On the other hand, the inverse dynamic model is that once
(15) the joint accelerations, velocities and positions are known,
the corresponding forces/torques can be computed as : τ =
Where, the jacobian matrix can be described as J6xn which f −1 (q,q̇, q̈) = g(q,q̇, q̈).
equals :
The main goal is to derive the dynamic model in short time.
" # The number of link and joints in the kinematic chain, the
e1 e2 .... en topology of the chain (e.g. serial or parallel), the position and
J6Xn = (16)
e1 Xr1 e2 Xr2 .... en Xrn orientation of the coordinate frames, and whether a recursive
procedure is used or not, are factors that influence the
Therefore, the direct kinematic model of the manipulator is computation time. The Newton/Euler formulation is usually
defined as : the preferred choice for manipulators with many degrees
of freedom. The reason is the recursive structure which the
Newton/Euler formulation is based on. If the frames are
q˙1
 
" # attached in a convenient way, the recursions will be greatly
e1 e2 .... en    q˙ 
 2 simplified. In this study, the Newton/Euler formulation is
= J6Xn (17)
used to solve the inverse dynamic model.
 
e1 Xr1 e2 Xr2 .... en Xrn ....
q˙n

In which, the angular velocity of each joint q1 , q2 ,q3 .....


qn are known, in order to calculate the angular and the linear
velocity of the end effector. Also, the inverse kinematic model
can be described as :

q˙1
 
" #
 q˙   e1 e2 .... en
 2 −1

  = J6Xn (18)
.... e1 Xr1 e2 Xr2 .... en Xrn
q˙n
−1
Where, J6Xn is denoted as inverse jacobian matrix. Which
is used to calculate the angular velocity of each joint from the
known velocities of the end effector. Fig. 4. Analytical schematic of serial links dynamics

173106-1805-5454-IJMME-IJENS
c October 2018
IJENS
International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:18 No:05 5

The Newton/Euler formalism is based on two fundamental


laws : the force balance 19 and the torque balance equation
20. Fig.4 illustrates the internal and the external generated
forces applied to the i link.

X
f =m×a (19)
link
X
τ = ω × (Iω) + I ω̇ (20) Fig. 5. Block diagram showing the co-simulation of arm mechanism using
link ADAMS and EASY5
So, in order to calculate the kinematic and the dynamic
models for the case of 7 DOF arm mechanism are concluded Parameter Value Unit
as follows :
Ps 50 bar
ωi = ωi−1 + ωii−1 (21) Iin ±15 mA
β 1.5 GP a
Pa 1 bar
A1 0.0025 m2
αi = αi−1 + αii−1 + ωi−1 × ωii−1 (22)
A2 0.00125 m2
Q 6.666 ∗ 10− 5 m3 /s
ζ 0.8 −
me,i = me,i−1 × rei−1,ei + ωi × (ωi × rei−1,ei ) (23) m 20 Kg
ωn 30 rad/s
c 3000 N.s/m
µ 300 N.s/m
mc,i = me,i−1 + αi × rei−1,ci + ωi × (ωi × rei−1,ci ) (24) K 1000 N/m

As the previous equations 21,22,23 and 24, are the TABLE I


equations for the inverse dynamic model to be applied for T HE SIMULATION PARAMETERS FOR THE SYSTEM
the all the links of the mechanism in a recursive manner.
The software Maple [23] was used to calculate the forward
and the backward recursive equations for the mechanism links.
error between the actual force and the desired force, applying
appropriate current to the motor to correct any force errors.
V. M ECHANISM C O - SIMULATION
In order to apply the required control algorithms, a virtual
model of whole system has to be simulated. The whole arm
mechanism is a series of joints connected together to one
input pressure source. But each joint has its electro-hydraulic
servo system. The shoulder joint piston was taken as an
example to represent one degree of freedom for the actuators
on the arm mechanism. Once the the model and the applied
controllers are validated, They can be repeated for all other
joints of the arm mechanism.

The virtual model of the hydraulic cylinder is built in


ADAMS and the mathematical model is built is EASY5r
and a C++ subroutine is created in EASY5r to write the Fig. 6. Position and Force control strategies of the robot arm
required controller functions to drive the virtual model in
ADAMS. This way, the physical responses are shown in The nominal simulation values of the electro-hydraulic
ADAMS, while the corresponding graphical response of the servoactuator system are listed in table I. In which the system
mathematical model is shown in EASY5r (as seen in Fig5). is simulated with a time interval of xs against the load
applied of the hydraulic piston.
Moreover, the required sensory feedback is attained by
adding a compression spring to the ADAMS model. Since it The hydraulic system was built in EASY5r , in which
is difficult to model a feedback sensor in such simulation, the auxiliary components are: The reservoir, relief valve,
the compression of the compliant element, which is here the pipes, and the junctions are connected with the main sub-
added spring, makes the force on the load can be calculated model(Actuator and Controller) which is shown in Fig.7.
using Hooke0 s Law. A feedback controller calculates the

173106-1805-5454-IJMME-IJENS
c October 2018
IJENS
International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:18 No:05 6

3) PID controller group:


It receives the error signal from the group 2 and
generates the control signal(voltage)for Group 4.

4) Saturation group:
Its function is to limit the control voltage signal from
the controller in the suitable range. And the saturation
limits are −15v and 15v

5) Voltage to current group:


Fig. 7. Modeling of the hydraulic system in EASY5 It transforms the limited control voltage to the control
current, putting into the servo valve in Group 1. And it
1
is shown that transfer function equals 0.01s+1 .
In this sub-model, as shown in Fig.8, the servo valve
denoted as (VI), the actuator chamber as (AC) and the spring
6) ADAMS Simulation Block:
as (SF) are connected. Where, the specified inputs parameters
It sends/receives the output signal from the mathematical
of the servo valve and the actuators are given. From this
model built in Easy5 to the virtual model built in
connection, Some generated forces, that represent the force
ADAMS.
balance equation(Eq.25), can be measured from this model.
These forces are :

Fa = Fp − Fs − Fd − Ff (25)

Fig. 9. Closed loop Co-simulation of an electro-hydraulic servo actuator with


PID Controller

A. Position control
In spite of the fact that a force control is to be performed
to the system, Acceptable position tracking should be also
Fig. 8. Configuration of servo valve actuator in EASY5r achieved. As the robot needs to perform a trajectory in
certain directions while a precise control of the force is
So, a new closed loop is built in EASY5r . This closed loop required in the same time. This means that in all other
(seen in Fig.9), Where it can be divided into 6 main groups : directions (and orientations), the robot needs to perform a
1) Actuator group: standard, programmed position trajectory. Therefore, in real
The servo valve controls the pressurized flows into applications, force control is in fact an hybrid force/position
and out of the actuator, moving the piston, while the control for which the joint torques are computed using two
spring represents the external force on the actuator. The references [17]. On top of that, the control scheme needs to
valve receives the pressurized flow from the hydraulic be dynamically changed between two operations. Therefore a
system (maximum rated pressure Pmax = 210bars) proper position control should be shown for the piston before
and the control current signal from Group 5 (maximum applying the algorithms of force control.
input current Imax = 15m.A), while the actuator and
spring can give the measured feedback values for the A PID control block was added to the proposed model.
controller in Group 2 and 3. Where its gains are added to the simulated system using
Zieglar Nichols tuning method to examine the system
2) Error group: response. Several simulations were performed with various
It generates the error from the difference of the input trajectories to determine the desired position. As a
reference value and the measured feedback value. result of such simulation, the desired trajectory is tracked
with minimum errors with gains Kp = 0.4, Ki = 0.08 and

173106-1805-5454-IJMME-IJENS
c October 2018
IJENS
International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:18 No:05 7

Kd = 1 as shown in Fig.10.

Fig. 11. Simulation of the hydraulic actuator in ADAMS

as shown in Fig.11 and it is simulated, In which the resultant


force is compared to force applied as shown in Fig.12. The
PID gains were found to be Kp = 4.4, Ki = 0.02 and
Kd = 0. Moreover, the damping and the spring force values
are shown in Fig.16. Also, the pressure forces Pe xtension
and Pr etraction are displayed in Fig.14 as blue dotted line
and a black continuous line respectively.
Fig. 10. Position control tracking at xr = 20mm

B. Force control
As previously mentioned in section III-A, robotic
manipulators are modeled as a rigid body systems with
torques as its primary input. So, in order to achieve high
control performance, A controlled torque source is required
for each joint of the rigid body system.

Since the manipulator system at hand is hydraulically


actuated, The hydraulic system control has to be studied. By
its physical nature, a hydraulic actuator is a velocity source,
i.e., a given controlled flow rate into the actuator will results Fig. 12. Closed loop force control output using PID controller
in a certain velocity. Hydraulic actuators are characterized
by its high impedance (mechanically stiff) systems. Due to
the need of having a force controlled joints in the humanoid
robot HYDROïD, force control strategies are needed to be
developed.

The controller to be applied is a conventional PID


controller, where it can be simply added to the mathematical
model built in EASY5r (as will be shown in sectionV).
But in spite of PID controllers are considered the most
widely used controller in industrial applications [24], the
output desired performance in the closed loop systems can
not be guaranteed. As the presence of non linear plant Fig. 13. The output graphs of the Co-simulation of the hydraulic piston.
(a)shows the damping force Fd while (b) shows the spring force Fs .
parameter variations and external disturbances greatly affect
the controller applied. As for hydraulic servo systems, the
main parameters causing non-linearity for the system are : The
hydraulic fluid compressibility, complex flow properties of the VI. H ARDWARE I MPLEMENTATION
servo valve, friction, system mass and variable loading [17]. After achieving acceptable results in simulation, the control
Further research showed that the two common approaches to law was implemented on the existing hydraulic test system
compensate the nonlinear behavior of hydraulic servo systems shown in Fig.15. In which, the whole hydraulic circuit was
which are : adaptive control and variable structure systems. built on a test bench having its main components shown in
But, both are very complex in implementation [18]. table II. The real target for control implementation is to apply
it on the actuators of the arm mechanism. Therefore, the
The output force calculated by the mathematical model in shoulder joint piston was chosen to apply the control law.
EASY5r is applied to the virtual model present in ADAMS The dimensions of the used cylinder 0.185 stroke and a 42

173106-1805-5454-IJMME-IJENS
c October 2018
IJENS
International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:18 No:05 8

any discrepancies. The active force sensing and closed loop


control work together to decrease the effects of friction and
inertia, thereby attaining a higher force fidelity and lower
impedance than with current control alone.

Fig. 14. Pressure forces acting on the hydraulic piston

Mechanical Part Specification Manufacturer Model

Hydraulic radial pump up to 220 bars MTS Series 505.6 SilentFlow


Hydraulic servo valve ±15 mA MOOG MOOG30
Pressure sensors up to 1000 bar Keller Series 4 LC
Pressure gauges Scale up to 1000 bars WIKA Model 213.53
Pressure relief valve 200 bar MTS Integrated in 505.6 MTS pump Fig. 16. A screen-shot for the developed electro-hydraulic servo system.
Load Cell up to 50 KN ELAF piezo resistive load cell (1)Servo-valve, (2)Integrated Pressure sensors, (3)Load cell, (4)Hydraulic
Linear Position Sensor 0 to 50 cm range ASM magnetic position sensor cylinder piston and (5)Linear Position Sensor
TABLE II
T HE MAIN COMPONENTS FOR THE HYDRAULIC TEST BENCH The output position and force outputs are shown in Fig.17
and Fig.18 respectively. The PID gains for the position loop
were found to be Kp = 3.46, Ki = 1.11 and Kd = 0.
Meanwhile, the PID gains for the force control loop were
mm outer diameter diameter. The same load that was applied Kp = 22.5, Ki = 0.0196 and Kd = 0.
in EASY5r simulation model is added here. The piston was
connected to 4 kg of weights mounted on a horizontal linear
pulley track system. Fluid pressure was supplied at 50 bar by
a MTS 505 silent flow hydraulic group. A 12 bit A/D and
D/A board connected to personal computer, which is used to
obtain system data from the two pressure sensors and output
the control signal to the servovalve. A sampling rate of 100
KS/s was used. A screen-shot for the hardware is shown in
Fig.16
.

Fig. 17. Position control response at reference value xr = 3 cm

The output response of position control is shown in Fig.17.


The reference position of the piston xr and the output
displacement xp are shown in blue dotted line and black line
respectively. There were no steady state error in the output
but there is a small delay which is negligible in our case.

The output response of force control is shown in Fig.18.


The reference position of the piston Fr and the output
displacement Fp are shown in blue dotted line and black
Fig. 15. The hardware schematic used to control the electro-hydraulic servo line respectively. There were no steady state error in the
actuator system output but there is an overshoot in a very limited time
during flipping the current signal. This overshoot due to
The position sensor provides the precise position of the either presence a high coefficient of static friction or some
piston, while the load cell measures the force imparted on uncontrollable current overshoot from the servo actuator
the load by the actuator. The feedback controller calculates board. Such overshoot can be smoothed through the addition
the error between the measured force and the desired force of capacitors in the electronic board controlling the servo
and applies the appropriate current to the motor to correct valve. More performance enhancement can be done through

173106-1805-5454-IJMME-IJENS
c October 2018
IJENS
International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:18 No:05 9

actuator will greatly enhance the mobility of the mechanism


and will decrease the nonlinear problems caused by the servo
valves and the hydraulic connections.

R EFERENCES
[1] MSC Software. www.mscsoftware.com/products/caetools/
adams.aspx. Website, March 2015.
[2] Claude Ginsburg. Modeling and simulation of complex
hydraulic valves using easy5 software. 1997
Fig. 18. Force control response at reference value Fr between 100 and 300 [3] N. G. Tsagarakis, G. Metta, G. Sandini, D. Vernon, R.
N Beira, F. Becchi, L. Righetti, J. Santos-Victor, a. J. Ijspeert,
M. C. Carrozza, and D. G. Caldwell, “iCub: the design and
realization of an open humanoid platform for cognitive and
further research on friction compensation techniques to
neuroscience research,” Adv. Robot., vol. 21, no. 10, pp.
eliminate the overshoot error. Moreover, the pressure output
1151–1175, 2007.
values during extension and retraction are shown in Fig.19.
[4] A. Abdellatif, Samer Alfayad, Fethi B. Ouezdou, Salem
A. Haggag, Faycal Namoun,“Mathematical Modeling of
an Electro-Hydraulic Actuator for Humanoid Robots”,
WSEAS Transactions on Circuits and Systems, ISSN /
E-ISSN: 1109-2734 / 2224-266X, Volume 16, 2017, Art.
# 22, pp. 187-195
[5] Thomas Buschmann, Sebastian Lohmeier, and Heinz Ul-
brich. Humanoid robot Lola: Design and walking con-
trol. Journal of Physiology Paris, 103(3-5):141–148, 2009.
ISSN 09284257. doi: 10.1016/j.jphysparis.2009.07.008.
[6] Kenji Kaneko, Fumio Kanehiro, Mitsuharu Morisawa,
Kazuhiko Akachi, Go Miyamori, Atsushi Hayashi, and
Noriyuki Kanehira. Humanoid robot HRP-4 - Humanoid
Fig. 19. Pressure values during extension and retraction of the hydraulic robotics platform with lightweight and slim body. IEEE
cylinder.
International Conference on Intelligent Robots and Sys-
tems, pages 4400–4407, 2011. ISSN 2153-0858. doi:
10.1109/IROS.2011.6048074.
VII. C ONCLUSION [7] Ricardo Tellez, Francesco Ferro, Sergio Garcia, Esteban
This paper presents the mathematical model of the electro- Gomez, Enric Jorge, Dario Mora, Daniel Pinyol, Joan
hydraulic actuators used for arm mechanism of the robot Poyatos, Oriol Torres, Jorge Velazquez, and Davide Fa-
HYDROïD. Based on Newton/Euler formalism, the kinematic conti. Reem-B : an autonomous lightweight human-size
model and inverse dynamic models of the HYDROïD arm humanoid robot.
mechanism were calculated. The mathematical model of [8] Scott Kuindersma, Robin Deits, Maurice Fallon Andr,
the electro-hydraulic servo system was used in EASY5r Hongkai Dai, Frank Permenter, Koolen Pat, and Marion
to drive the virtual model of shoulder joint cylinder in Russ. Optimization-based Locomotion Planning , Estima-
ADAMS software. PID controllers for both position and force tion , and Control Design for the Atlas Humanoid Robot.
were theoretically revised for this mechanism. Furthermore, [9] N Pollard, J K Hodgins, M J Riley, and C G Atkeson.
experimental validation for these controllers was presented Adapting Human Motion for the Control of a Humanoid
and the results were shown and discussed. Robot. Proc. IEEE Intl Conf. on Robotics and Automation
(ICRA), 2002.
For future work, the dynamic results reached in this study [10] C. Semini, N. G. Tsagarakis, E. Guglielmino, M. Foc-
can be applied on all the joints of the arm mechanism not chi, F. Cannella, and D. G. Caldwell. Design of HyQ
just for one actuator. In which the practical responses can - a hydraulically and electrically actuated quadruped
be compared with the model simulation and find out the robot. Proceedings of the Institution of Mechanical En-
best controller gains for each joint. Further research can gineers, Part I: Journal of Systems and Control Engineer-
be done to compensate the error present in controller gains ing, 225(February):831–849, 2011. ISSN 0959-6518. doi:
while controlling position and force. As the correct controller 10.1177/0959651811402275.
should control both features simultaneously. Moreover, further [11] A. Abdellatif, S. Alfayad, Arne-Christoph Hildebrandt,
research in achieving precise torque control for the hydraulic F.B. Ouezdou, N. Mechbal, Yahya Zweiri. Development of
servo system acts as the first step in achieving a compliance a New Hydraulic Ankle for HYDROïD Humanoid Robot,
control joints for an overall safe interaction hydraulic robot. Journal of Intelligent & Robotic Systems, 2018. Pages:1-
Also, the addition of the new integrated electro-hydraulic 16, DOI: 10.1007/s10846-017-0750-z

173106-1805-5454-IJMME-IJENS
c October 2018
IJENS
International Journal of Mechanical & Mechatronics Engineering IJMME-IJENS Vol:18 No:05 10

[12] T. H. Lambert and R. M. Davies, Investigation


of the Response of an Hydraulic Servomechanism
with Inertial Load. Journal of Mechanical Engineer-
ing Science, Vol5, N3, pages = (281-294), 1963. doi:
10.1243/JMES/JOUR/1963/005/037/02.
[13] Jerry E Pratt and Benjamin T Krupp. Series Elastic
Actuators for legged robots. Proceedings of SPIE 5422,
Unmanned Ground Vehicle Technology VI, 5422:135–
144, 2004. ISSN 0277786X. doi: 10.1117/12.548000.
[14] R Liu. Nonlinear control of electro-hydraulic servosys-
tems: theory and experiment. page 122, 1998.
[15] Andrew Alleyne. Tracing Control for Hydraulic. 121
(April 1998):184–190, 2013.
[16] C.L. Hwang and C.H. Lan. The position control of elec-
trohydraulic servomechanism via a novel variable struc-
ture control. Mechatronics, 4(4):369–391, 1994. ISSN
09574158. doi: 10.1016/0957-4158(94)90018-3.
[17] G a Sohl and J E Bobrow. Experiments and simulations
on the nonlinear control of a hydraulic servosystem.
Proceedings of the 1997 American Control Conference
Cat No97CH36041, 1(2):238–247, 1999. ISSN 10636536.
doi: 10.1109/87.748150.
[18] Prut Nakkarat and Suwat Kuntanapreeda. Observerbased
backstepping force control of an electrohydraulic actuator.
Control Engineering Practice, 17(8):895–902, 2009. ISSN
09670661.
[19] K. Baghestan, S.M. Rezaei, H.a. Talebi, and M. Zareine-
jad. Robust force control in a novel electro-hydraulic
structure using polytopic uncertainty representation. ISA
Transactions, 53(6):1873–1880, 2014. ISSN 00190578.
doi: 10.1016/j.isatra.2014.08.002.
[20] M Elasswad, A Tayba, A. Abdellatif, S.Alfayad,
K.Khalil. Development of lightweight hydraulic cylinder
for humanoid robots applications. Proceedings of the
Institution of Mechanical Engineers, Part C: Journal of
Mechanical Engineering Science, September 21, 2017,
https://doi.org/10.1177/0954406217731794
[21] Herbert E. Merrit. hydraulic control systems -Herbert E
Merritt.pdf, 1967.
[22] Wei Wang, Robert N.K. Loh, and Edward Y. Gu. Pas-
sive compliance versus active compliance in robot-based
automated assembly systems. Industrial Robot: An Inter-
national Journal, 25(1):48–57, February 1998. ISSN 0143-
991X. doi: 10.1108/01439919810196964.
[23] Michael B. Monagan, Keith O. Geddes, K. Michael Heal,
George Labahn, Stefan M. Vorkoetter, James McCarron,
and Paul DeMarco. Maple 10 Programming Guide. Maple-
soft, Waterloo ON, Canada, 2005.
[24] Valery D Yurkevich. PI / PID Control for Nonlinear
Systems via Singular Perturbation Technique. pages 0–
30.

173106-1805-5454-IJMME-IJENS
c October 2018
IJENS

You might also like