Anda di halaman 1dari 5

Intelligent Systems Conference 2018

6-7 September 2018 | London, UK

Tele-Operated Bilateral Control of Hydraulic Servo


System using TSMCSPO based Estimated Reaction
Force of End Effector

Karam Dad Kallu Wang Jie


Department of Mechanical Engineering Department of Mechanical Engineering
Pusan National University Pusan National University
Busan, South Korea Busan, South Korea
e-mail: Karamdadkallu@gmail.com

Min Cheol Lee


M Atif Yaqub Department of Mechanical Engineering
Department of Mechanical Engineering Pusan National University
Pusan National University Busan, South Korea
Busan, South Korea e-mail: mclee@pusan.ac.kr

Abstract— In this research, we have proposed to use a should be precisely controlled in remote site, high power
terminal sliding mode control with sliding perturbation observer actuator such as the hydraulic system is required to be used.
(TSMCSPO) to estimate the reaction force of a tele-operated
bilateral control of hydraulic servo system for master-slave In another research a Tele-operation system was adopted
manipulators. The hydraulic servo system has a key role in for human operator to control a manipulator located far away.
dismantling of nuclear power plants. The main objective is to It allows human operator to control a manipulator and made it
estimate the reaction force at the end effector of slave by sliding possible to feel the interaction between a manipulator and
perturbation observer (SPO) without using any sensor. For the environment. In Tele-operation systems, the controller is
position and force tracking between the master and slave, a designed according to the information flow between master
bilateral control strategy using terminal sliding mode control and slave. This control architecture is based on law of
(TSMC) is proposed. The experimental results show that the information flow and is called bilateral controller. Many
slave device can follows the trajectory of the master device using researches about bilateral control architecture have already
the proposed tele-operated bilateral control strategy and reaction been performed. Researchers have mainly studied two channel
force estimation method. architectures, such as force-force (F-F), position-position (P-P),
force-position (F-P), and position-force (P-F) architectures.
Keywords—Tele-operation, Bilateral Control, TSMCSPO, The referred research suggests a bilateral controller with three
Reaction Force Estimation, Master- Slave, Hydraulic Servo System
or four channel architecture [11-14]. In this paper we describe
I. INTRODUCTION a new robotic hand system with master slave configuration.
Bluetooth is being used as the communication channel between
Most currently available technologies and processes could the master and slave for the tele-operation [15-19]. In
be successfully converted for remote operation. Successful conventional bilateral control architecture, many studies have
remote operation requires the operator to see the area in which used force sensors to detect external force. However, the use of
the work is being performed and manipulate the equipment force sensor is the cause of some problems. Robot system with
well enough to accomplish the required tasks. Remote a force sensor is regarded as a two mass resonant system, it is
technologies can be categorized into several areas such as difficult to realize high frequency force sensing [20-21].
dismantling arrangement technology, cutting technology,
detection, segmenting, decontamination, sampling, handling Therefore, in this research we use terminal sliding mode
and handled remote equipment. Many researcher about the control with sliding perturbation observer (TSMCSPO), which
remote cutting technology for the dismantling nuclear facilities is a robust control algorithm, to estimate the reaction force and
had been carried out and the robot system was developed [1-8]. also tele-operated bilateral control of hydraulic servo system
Maestro robot system for the dismantling nuclear facilities was for end effector of master-slave manipulator. The reaction
developed in France [9-10]. Robot system whose structure force of slave is estimated by sliding perturbation observer
contains of master and slave (Bilateral Control) is suitable in (SPO) without using any sensor. The tele-operated bilateral
nuclear power plant where humans cannot get the directly control architecture is used to achieve a perfect tracking of
access and the object material with high load to be dismantled position and force between the master and slave in a real time.
Also the force reflection is applied to provide the information

1|P age
Intelligent Systems Conference 2018
6-7 September 2018 | London, UK

of remote working environment to human operator. Using


visual feedback to control the slave while seeing the control
system (PC).
The remaining part of the paper is organized as follow:
Section 2, describe the structure and dynamics of hydraulic
servo system used in dismantling power plant. In section 3,
Terminal sliding mode control with sliding perturbation
observer (TSMCSPO) is discussed. Section 4 describes the
tele-operated bilateral control between master and slave for
hydraulic servo system. Section 5 describes experimental
environment and results. Section 6 concludes the work.
II. STRUCTURE AND DYNAMICS OF HYDRAULIC SERVO
SYSTEM Fig. 2. Hydraulic servo system.
Hydraulic servo systems are heavily used in high Fig 3 shows the schematic diagram of end effector of the
performance applications such as the machine-tool industry. hydraulic servo system.
Examples are material handling, mobile equipment, plastics,
steel plants, mining, oil exploration and automotive testing. A
servomechanism can be designed to control almost any
physical quantity, e.g. motion, force, pressure, temperature,
electrical voltage or current. The hydraulic servo actuator
provides fast response, high force and short stroke
characteristics. The main advantages of hydraulic components
are easy and accurate control of work table position and
velocity, good stiffness characteristics, zero backlash, rapid
response to change in speed or direction, and low rate of wear.
The hydraulic actuators of robots for dismantling a nuclear
power plant consist of two hydraulic cylinders and one AC
servo motor. Vertical movement requires a greater force as
compared to horizontal movement in dismantling power plant Fig. 3. Schematic of end effector.
structure. Size, shape and structure of 3DOF hydraulic servo
system used in dismantling nuclear power plant is shown in The dynamics of a robot describe the relationship between
Fig 1 and Fig 2. forces, torques and motion. The general dynamic equation of a
manipulator in free space is described by

 
T  A   B  ,   g      

Where  , A , B , , g   and T are the the vector joint
of angles, the mass/inertia matrix, the centrifugal/coriolis
torque, the gravity torque in joint space, and the vector of joint
torques, respectively. The dynamics equation of end effector
of hydraulics servo system is as follow

( J s1  J s1)1  (Ds1  Ds1  1)1  0.5M s1L1g sin1   e1  T1 

In above equation, J s1 , D s1 are the interia and damper of


Fig. 1. Structure of hydraulic servo system. end effector.  shows the uncertainty of parameters,  1 is
viscosity of cylinders 1, M s1 is mass of end effector, L1 is
length of end effector,  e1 is reaction torques by contact with
environment of joint 1,  is dynamics effect, 1 is viscosity
friction of cylinder 1, T1 is joint torque of end effector.

III. TERMINAL SLIDING MODE CONTROL WITH SLIDING


PERTURBATION OBSERVER (TSMCSPO)
The combination of controller (TSMC) and observer (SPO)
makes a new form called terminal sliding mode control with
sliding perturbation observer (TSMCSPO) [22]. Terminal
Identify applicable sponsor/s here. If no sponsors, delete this text box
(sponsors).

2|P age
Intelligent Systems Conference 2018
6-7 September 2018 | London, UK

sliding mode control (TSMC) applies terminal sliding mode in displays the output of established connection by displaying a
the reaching phase and the sliding phase for robotic status message showing the connectivity state. On both GUIs
manipulators with global finite-time stability. The robustness we should press the AMP OFF and then AMP On buttons.
of controller is addressed using the Lyapunov stability theory, This will ensure the working of amplifiers. To start the system
which enables faster and higher-precision tracking operation Read button needs to be pressed. The master side
performance [23]. In TSMCSPO, TSMC is used to reduce the should press the read button followed immediately by the
error ê j between desired trajectories with estimation value. slave side. Once the system is started, the master reads the
The dynamics of ŝ j is defined as follow. current orientation of both axes and the calculation of all the
intermediate variables is done which is required by the slave.
These calculations are critical for the system performance.
sˆ j  eˆ j   j1 eˆ j signeˆ 
r
   The required information including the axes orientations is
transmitted to the slave via network sockets. These sockets are
Where eˆ j  xˆ1 j  x1dj is the estimated position tracking the pathways for the data transfer. The slave application
error. The sufficient existence condition of TSMCSPO can be receive the data sent by the master and moves the robotic
actuator to follow the master trajectory along with calculating
guaranteed when we design s̂ j as follow.
the reaction force using TSMCSPO. The slave then returns it
calculated position and estimated perturbation back to the
  r
sˆ j   j Rmax j k1 j  0 j sign(sˆ j )  3 j s j sign(sˆ j )  master using the same socket connection. This whole
procedure is kept running until the whole robotic system is
Where  j is the anticipated boundary of perturbation, 3 j working and slave continuously follows the master commands
along with providing the reaction force at the master end. Fig
is a positive constant number and Rmax j is defined as follow.
4 shows the schematic diagram of tele-operation.

Rmax j 
  p p  k1 j  0 j   
p 3
 k1 j  0 j p  k 2 j
2
 0 j p   32j k 2 j  0 j 

The control input u j of TSMCSPO is defined as follows.

   r

1  j Rmax j k1 j  0 j sign(sˆ j )  3 j s j sign(sˆ) 
uj     
 2 j 0 
3 j  k   k  2 ~x  x  ˆ
j 1 j 0 j 1 j 1dj j 

The actual s j -dynamics within the boundary layer


Fig. 4. Schematic diagram of tele-operation.
sˆ j   0 j becomes.
The client server topology is similar to master slave
s j  1 j sign(s j )   2 j s j sign(s j ) s j  configuration in robotics. For networking programming (Tele-
r

  operation) both PC’s must be accessible on network and their


k    k    sign(s )   s r sign(s )   r eˆ r 1 e  k   ~x

IP and port number are required to connect them together.
 2 j 0 j  1 j 0 j 1 j j 2j j j  j1 j
 j 1 j 0 j  1 j
 After the connection is established the system can
~ communicate and work in real-time. Fig 5 shows the diagram
 1 j sign(s j )   2 j s j sign(s j )   j1r eˆ j e j  ~x2 j   j
r r 1

  of tele-operation.

IV. TELE-OPERATED BILATERAL CONTROL BETWEEN


MASTER AND SLAVE
A. Tele-operation
The master and slave robotic systems are set to operating
conditions with necessary safety and electric power checking.
One the systems are powered up the master application is
started followed by the slave application. The master is started Fig. 5. Tele-operation.
first as it has to listen for incoming slave connections on its IP
address and port number 3000. The master stays in the waiting
B. Bilateral Control
state until the slave application is started. When the slave
application is started, it tries to connect with the master system The objective of bilateral control is that the position of
by using the IP address and port number of the master system. slave follow the position of master and operator can feel the
Following this sequence, the Graphical User Interface (GUI) reaction force from the environment through the master. The

3|P age
Intelligent Systems Conference 2018
6-7 September 2018 | London, UK

dynamics equation of master and slave for hydraulic servo


system are described by.
J mm  Bmm  u m   h    
J ss  Bss  u s   e    
Where J m , J s , u m and u s are inertia, position and control
input of master and slave of hydraulic servo system,
respectively. Action force generated by operator while
maneuvering the master device is denoted by  h , while
reaction force appears when slave device is touching remote
environment is defined by  e . The structure of bilateral
Fig. 8. Video feedback.
controller is shown in Fig. 6.
Fig. 9 shows the experimental result of master-slave
trajectories for end effector. The red line shows the
experimental result of master device whereas, the blue line
shows the experimental result of slave device by using
TSMCSPO. It can be observed that the slave device can follow
the master device. The maximum value of trajectory is 56
degree at 11 sec. The end effector of slave device can move
between 0 and 90 degree.

Fig. 6. Bilateral control structure.


The experimental setup includes master device, slave
device and a control system as shown in Fig 7.

Fig. 9. Master slave trajectories of end effector.


The error between master-slave trajectories for end
effector is shown in Fig. 10. The maximum error between
master and slave trajectories is 0.9 degree at 30 sec. It can be
observed that the error between master and slave trajectories
are very small.

Fig. 7. Experimental setup.


V. EXPERIMENTAL ENVIRONMENT AND RESULTS
The master and slave device consist of three links each, in
which third link connected with base. We can find the reaction
force at end effector. TSMCSPO is used to estimate the
reaction force. The scenario of experiment is set up such that
the operator (Human) moves the master device and slave
device can follow the trajectory of master device using
TSMCSPO while seeing on the control system (PC) through
video feedback. The TSMC will control the slave device to
follow the master device trajectory. Fig. 8 shows the video
feedback to control the slave while seeing the control system Fig. 10. Error between master-slave trajectories of end
(PC). effector.

4|P age
Intelligent Systems Conference 2018
6-7 September 2018 | London, UK

Fig. 11 shows the estimated perturbation of master and [5] J. Varley, “Windscale, Getting Down to the Core,” Nucl. Eng.
slave for end effector. The maximum estimated perturbation is International, pp.26-27, 1997.
600 N*m at 19 sec. [6] T. Benest, “Taking up Arms for Decommissioning,” Nucl. Eng.
International, p.15, Aug. 2014.
[7] M. Tachibana, T. Shimada, and S. Yanagihara, “Development of
Remote Dismantling Systems for Decommissioning of Nuclear
Facilities,” WM’00 conference, 2000.
[8] M. J. Bakari, K. M. Zied, and D. W. Seward, “Development of a Multi-
Arm Mobile Robot for Nuclear Decommissioning Tasks,” International
Journal of Advanced Robotic Systems, vol. 4, no. 4, 2007.
[9] G. Dubus, O. David, Y. Measson, J. P. Friconneau and J. Palmer,
“Making Hydraulic Manipulators Cleaner and Safer: From Oil to
Demineralized Water hydraulics,” IROS 2008.
[10] C. Chabal, A. Proietti, J. F. Mante, J. M. Idasiak, “Virtual Reality
Technologies: a Way to Verify Dismantling Operations,” ACHI.
[11] G. J. Raju, G. C. Verghese, and T. B. Sheridan, “Design issue in 2-port
network models of bilateral remote manipulation,” IEEE Int. Conference
on Robotics and Automations, pp. 1316-1321, 1989.
[12] K. Hashtrudi-Zaad, and S. E. Salcudean, “Transparency in time-delayed
Fig. 11. Estimated perturbation of end effector. systems and the effect of local force feedback for transparent tele-
operation,” IEEE Trans. Robot Autom, vol. 18, no. 1, pp. 108-114,
VI. CONCLUSION 2002.
[13] D. A. Lawrence, “Stability and transparency in bilateral tele-operation,”
In this paper, we have estimated the reaction force of end IEEE Transaction Robotics and Automation, vol. 9, no. 5, pp. 624-637,
effector of hydraulic servo system with master-slave Oct. 1993.
manipulators using TSMCSPO without using any sensor. By [14] Y. Yokokohji and T. Yoshikawa, “Bilateral control of Master-Slave
using a TSMC based tele-operated bilateral control strategy Manipulators for Ideal Kinesthetic coupling-formulation and
and visual feedback, the slave device followed the trajectory of experiment,” IEEE Transaction Robotics and Automation, vol. 10, no. 5,
master device (Human operator) with minimum error. It is pp. 605-620, Oct. 1994.
useful, such as transportation of active uranium in nuclear [15] A. M. Zaid, M. Atif Yaqub, M. R. Arshad, M. S. Wahab, “UTHM Hand:
Mechanics behind dexterous anthropomorphic hand,” World Academy
power plants or disposal of explosive, remote cutting for of Science, Engineering and Technology, vol. 74, Feb 2011.
nuclear power plant dismantling etc. [16] A. M. Zaid, M. Atif Yaqub, “UTHM HAND: Design of Dexterous
Anthropomorphic Robotic Hand,” International Review of Automatic
ACKNOWLEDGMENT Control (IREACO), vol. 4, November 2011.
This research was supported by Higher Education [17] A. M. Zaid, M. Atif Yaqub, “UTHM HAND: Performance of Complete
Commission (HEC) of Pakistan, under the research and System of Dexterous Anthropomorphic Robotic Hand,” Journal of
Procedia Engineering, International Symposium on Robotics and
development program Intelligent Sensors (IRIS), vol. 41, 2012.
This research was supported by the MOTIE (Ministry of [18] A. M. Zaid, M. Atif Yaqub, “UTHM HAND: Kinematics behind the
Trade, Industry & Energy), Korea, under the Industry Dexterous Anthropomorphic Robotic Hand”, Communications in
Computer and Information Science (CCIS), International Conference on
Convergence Liaison Robotics Creative Graduates Education Intelligent Robotics, Automation and Manufacturing (IRAM), vol. 330,
Program supervised by the KIAT (N0001126). 2012.
This work was supported by the National Research [19] A. M. Zaid, M. Atif Yaqub, and D. Hanafi, “Modelling and Simulation
of 20 DOF Dexterous Anthropomorphic UTHM Hand,” International
Foundation of Korea (NRF) grant funded by the Korea Journal of Systems Applications, Engineering & Development, vol. 8,
Government (MSIP) (No.NRF-2012M2B2B 1055503). 2014.
[20] Y. F. Li, and X. B. Chen, “On the Dynamic Behaviour of a
Force/Torque Sensor for Robots,” IEEE Transaction Instrumentation
and Measurement, vol. 47, no. 1, pp. 304-308, Feb. 1998.
REFERENCES
[21] S. Katsura, Y. Matsumoto, and K. Ohnishi, “Analysis and Experimental
[1] J. J. Fisher, “Applying Robotics in Nuclear Applications,” RI/SME Validation of Force Bandwidth for Force Control,” IEEE Transaction
Robots conf. 1985. Ind. Electron., vol. 53, no. 3, pp. 922-928, Jun. 2006.
[2] G. Clement, J. Vertut, A. Cregut, P. Antione, and J. Guittet, “Remote [22] W. Jie, K. D. Kallu, and M. C. Lee, “A robust controller design using
Handling and Transfer Techniques in Dismantling Strategy,” Proc of the terminal sliding mode control with sliding perturbation observer
Seminar on Remote Handling in Nuclear Facilities, pp. 556-569, 1984. (TSMCSPO),” IJCAS, Under Revision
[3] S. Ma, S. Hirose, and H. Yoshinada, “ Development of a Hyper [23] S. Yu, X. Yu, B. Shirinzadeh, and Z. Man, “Continuous finite-time
Redundant Multi Joint Manipulator for Maintenance of Nuclear control for robotic manipulators with terminal sliding mode,”
Reactor,” Advanced robotics, vol. 9 no. 3 pp.281-300, 1994. Automatica, vol. 41, no. 11, pp. 1957-1964, 2005.
[4] T. Demeade, “A Pioneer’s Journey into the Sarcophagus,” Nucl. Eng.
International, vol. 3, pp.18-21, 1998.

5|P age

Anda mungkin juga menyukai