Professional Documents
Culture Documents
Pag 64-68 PDF
Pag 64-68 PDF
Abstract – The paper focuses on speed and position control for a hydraulic rotary motor and tries to
bring light on this very important subject featuring new information on this subject. This work shows
results obtained by a research team in Politehnica University of Bucharest over the last years and
explores old and new concepts in the field of hydraulics.
Keywords: Pneutronic systems, speed and position control, hydraulic rotary motor.
LA
FP-AI-V10B
MHR
xi,pA xi,pB
TPA TPB
A B DHP
i1 i2
EMP1 P T EMP2
The Romanian Review Precision Mechanics, Optics & Mechatronics, 2014, No. 45 63
Speed and Position Control for a Hydraulic Rotary Motor
With this experimental setup it is possible to to the speed transducer, already presented, it is replaced
track in real-time the angular speed variations of the with an incremental angular position transducer Tp .
rotary hydraulic motor shaft and also the motor active The hydraulic motor is the rotary motor orbital
cameras pressures. type, "Danfoss", this motor has the following
The control system program was developed and characteristic: ensure regular movement even at low
implemented in LabVIEW 2013 environment. angular speeds, constant torque for a wide range of
The positioning system is shown in Figure 3 . rotational speeds , high starting torque, high efficiency,
In this structure, in the hydraulic power side can long lifetime even in harsh and robust operating
be found on the same equipment as in the already shown conditions and compact design.
system , namely MHR rotating the hydraulic motor and Regarding the proportional hydraulic throttle, it
the hydraulic proportional throttle DHP. is a translation spool, piloted without any position
The electronic control board is ECB, structured feedback . Control signals, i1 and i2 must be in the range
around an Arduino development boards type. In contrast 200-800 [mA].
Tp MHR
DHP
A B
Y1 Y2
A B I
Arduino Due
+24VDC
LM78XX +5VDC Kp Ki Kd
BEC
3. Control algorithm
Electronic control block BEC consists of:
- A amplifier dedicated to the proportional To test the developed controller it was necessary
throttle provided on output with two channels between to develop and implement some simple operation
0-800 [mA], it offers the possibility of overlapping algorithms. In their design it was took into account the
control signal Dither signal frequency between 100- fact that the proportion throttle does not allow two
proportional solenoids to be active simultaneously.
250[Hz] hysteresis appears necessary to reduce the They were considered the following algorithms:
proportional electromagnet, the amplifier output signal a) algorithm to control motor direction - this
is about 24 [V], 0-1 [A], on each channel; algorithm is necessary to test the functionality of the
- Due Arduino development board type, with system.
Atmega 328 microcontroller; To do this, set a control voltage on each input
- RC lowpass filter and operational amplifier amplifier , voltage control was arbitrarily chosen mid
acting as double amplitude analogue command voltage range 0 .. 5 [V]. This test proved the functionality of the
proportional electromagnets [7]. mechanical system in both directions of movement. It
- A counter type interface, for incremental was also confirmed the functionality of the transducer.
encoder rotation Tp (TTL digital signals A, B and I); b) simple positioning algorithm - this algorithm
- Voltage analogue interface, for three rotary allows the motor to run after a trapezoidal variation law
of the angular velocity of the motor shaft . This is
potentiometers, respectively the Kp, Ki, Kd. ensured by means of the control voltage (Figure 4).
The controller has been designed to control Motor acceleration - αa , desired operating speed - ur ,
independently the mentioned hydraulic system. as well as motor braking acceleration, uf , and braking
motor speed, αf , can be set by user.
64 The Romanian Review Precision Mechanics, Optics & Mechatronics, 2014, No. 45
Speed and Position Control for a Hydraulic Rotary Motor
αf t[s]
uf
αa
uc2[V]
uf t[s]
Tds
Referinta Eroare
u (t) ɛ (t) + y (t)
+ Kp +
- +
1
Tis+1
After getting slow speed motion, there is The adjustment of the positioning system is
continued the movement until the target position is operated by changing the parameters Kp , Ki and Kd
reached. If it passes this position, then it moves in with three potentiometers .
opposite direction, with slow speed. The algorithm is These algorithms have been implemented as a
repeated until the desired error is obtained. software library.
c) algorithm to control motor speed and direction Programs are stored in the microcontroller's
after a given (required) law. This procedure is necessary memory and can run successively, only after
in order to determine the dynamic characteristics of the determining in advance, by the user, all specific input
system. The types of signals are on one of the values for each signal type (amplitude , period, phase ,
subsequent shapes: step, ramp, triangular, trapezoidal etc.).
and sinusoidal. Link to the PC is based on a RS232 bus ( FTDI )
d) PID controller for controlling the angular and serves to initiate control and reporting the results.
position of the motor shaft. This type of algorithm Microcontroller programming is developed in C + +
allows, by providing values for gains proportional, environment .
integrative and derivative to achieve in a short time the PC programming is developed using a graphic
target position. The algorithm works in its parallel form language, LabVIEW . Chart program designed for
(Figure 5) based on the formula: interfacing with the development board is shown in
1 dε (t ) Figure 6, known as block diagram.
u (t ) = K p ⋅ ε (t ) +
Ti ∫ ε (t )dt + Td
dt
, It contains the necessary elements for interfacing
the microcontroller Atmega with the VISA drivers and
with transfer function, for results interpretation received from it. To avoid any
Ki discrepancies that may occur between the time data are
H ( s ) = Kp + + Kd s , transmitted and respectively data are received , as well
s as issues related to the buffer size , the received data is
where Ti and Td is the time integrative constants, first stored in a text file.
respectively derivatives, ɛ(t) represents the evolution of From this point, the data are imported in
the error in time and u(t) is the reference system value LabVIEW, and then saved, in processed order and at
[3] [5] [6]. last displayed to the user .
The Romanian Review Precision Mechanics, Optics & Mechatronics, 2014, No. 45 65
Speed and Position Control for a Hydraulic Rotary Motor
4. Presenting the experimental model In Figure 8 is shown the result of motor shaft
displacement with 500 degrees. It can be seen that the
The experimental results (Fig. 7) were PID algorithm causes positive overshoot of the unit
materialized schematic by sketch shown in Figure 3. In around the target position. In figure 9 is presented the
addition, in this image appears also the pumping group application in LabVIEW front panel, where one can see
GP. Equipment used, less rotary hydraulic motor, are the values used to control the system (target position,
manufactured by FESTO and equipment are for Kp, Ki and Kd, etc).
educational purpose. As already was mentioned, the
motor is manufactured by DANFOS.
DHP
AEDHP
MHR Tp
φ [o]
500
GP 400
300
200
100
5 10 15 20 25 t [s]
Fig. 7 Experimental setup Fig.8 Motor shaft displacement - 500°
66 The Romanian Review Precision Mechanics, Optics & Mechatronics, 2014, No. 45
Speed and Position Control for a Hydraulic Rotary Motor
The Romanian Review Precision Mechanics, Optics & Mechatronics, 2014, No. 45 67