Bilateral Control in Teleoperated Robots
Bilateral Control in Teleoperated Robots
Abstract — Researches on Teleoperated robot have been carried 2. NEED OF VIRTUAL MODELS
out for a long time and it has been developed in several aspects by
now. Bilateral control is one of the areas which is researched under Most of early bilateral robotic systems were totally mechanical.
teleoperated robots. This paper consist of discussion on how That means the movements from the master and force feedback
bilateral control is used in teleoperated robots and a derivation a from the slave was transferred using mechanical systems.
virtual model for a simple bilateral control system with two rods Therefore it wasn’t possible to keep the slave robot at larger
connected by a torsion spring. distances. In modern days we have robots in space, under-sea
and hazardous environments. In order to improve the
Key words—Bilateral, Teleoperation, Force Feedback, Tele- performance of these robots, it is needed to equip them with
manipulation bilateral control systems. In these cases mechanical bilateral
control systems are not possible. So what is the solution? The
1. INTRODUCTION solution is to capture the movements of the master and transfer
them to the slave through a communication medium and
Tele-operation or Tele-manipulation is one of the most replicate them at the slave using relevant actuators, On the
researched areas in the field of robotics. Teleoperated robotic other hand feedback from the slave should be captured by
systems have been used in many real world applications such sensors and transferred through the communication medium
as explosive disposal, hazardous material handling. On the and replicate them at the master’s side using the actuators
other hand autonomous robots have been successfully there. To implement this type of bilateral control system it is
implemented in applications such as automotive needed to obtain a virtual model for the system. For a simple
manufacturing offering high productivity reduced cost and bilateral system mathematical model of its mechanical
counterpart can be used as the virtual model. The virtual model
higher quality. A teleoperated system or a human involved should generate the same effect as the master at slave’s side
system offers more feasible solution when considering more and generate the same feedback of the slave at the master’s
dynamic real world tasks in unpredictable environments. The side. Here a simple bilateral control system was modeled
Human interaction overcome the intelligence limitations of the virtually in order to simulate it in a computer.
robotic system by introducing desired capabilities to the
robotic system, such attributes are adaptability to a variety of 3. METHODOLOGY
environments, high level of intelligence. In tele-manipulation
human operator has to perform a given task on a remote The system have to be modeled is a vertically mounted two
environment. To capture the commands given by the operator similar rods connected by a torsion spring (Figure 3.1).
a local robotic interface is used, called the master. When
operator commands the local robot, it captures the commands
and transmits them to the remote robotic interface through a
communication medium. This remote robotic interface is
known as the slave. Slave’s task is to replicate the movements
of the master. The operator’s experience close to real if there
is a method to operator to know about the interactions of the
slave with the environment. Feedback information from the
slave can be obtained in several ways such as visual displays.
The ideal method to improve the operator’s ability is to
feedback the forces acting between the environment and the Figure 3.1
slave [5]. “When the force at the slave side is reflected back to
the human operator it is said that tele-manipulation is
controlled bilaterally” [1]. Block diagram of a bilateral control It was assumed that frictional are not present in the system and
system is shown figure 1.1 [2]. the system is always at rest before it moves. When developing
a mathematical model for virtual model we have to consider in
which manner a movement of rod1 is replicated at rod2 and on
the other hand we have to consider the feedback force exerted
on the rod 1 due to the inertia of the rod 2. Consider rod 1 is
Figure 1.1
moved by an angle of θ1 and let’s take the rod2 is rotated by (5)
an angle of θ1 in response to master’s movement (Figure 3.2).
τ ( S ) I 1 S − 2 KI 1 S
2 4 2
=
θ 2( S ) K
And also the transfer function for the reaction torqur exerted by
the slave on the master is given by
(6)
τ ' (S )
= I 1S 2
Figure 3.2 θ 2( S )
Applying = I for rod 1 and rod2
τ ..
By virtually implementing these functions the similar operation
as the mechanical system can be obtained when the spring is
θ not present in the system. The next step of modeling system is
to simulate the system in a computer environment with the help
where - Torque, I – Inertia, - angle ; of the derived mathematical model. There, it can be observed
τ the behavior of the slave according to the various force applied
to the master and forces exerted on master by the slave.
θ
III. SYSTEM ANALYSIS
(1)
When the input is measured as a torque
..
I 1θ 1 = τ − k (θ 1− θ 2) Using (5)
(2)
.. θ 2( S ) K / I12 (7)
= 2 2
I 2 θ 2 = k (θ 1− θ 2) τ ( S ) S {S − (2 K / I1 )}
Taking the laplacian of (1) and (2) we get, There are poles at S = 0 and
(3)
S = ± ( 2 K / I1 )
..
I 1[ S θ 1(s ) − Sθ 1(0) − θ 1(0)] + kθ 1( S ) − kθ 2( S ) = τ ( S )
2
I 2[ S 2θ 2( s ) − Sθ 2(0) − θ 2(0)] − kθ 1( S ) + kθ 2( S ) = 0
σ
− (2 K / I 1 ) 0 + (2 K / I1 )
.. ..
θ 1(0),θ 2(0) = 0
Figure 3.3
Since two rods are equal. Examining the locations of poles of S-plane it can be noted
that there is a exponentially increasing term and exponentially
decreasing term. But, since magnitudes of locations where
I1 = I 2 poles located, are equal these exponential terms are cancelled
0ut. So it’s difficult to comment on the stability of the system
By (3) and (4) transfer function of the master’s force to slave’s using those poles. Therefore we have to consider the S=0 pole
position can be derived, which governs the impulse response of the system. This can be
seen by deriving the impulse response of the system.
Using partial fraction for (7)
(8)
H(S)=kI2-1/2kIS2-1/(2k/I)32S+2k/I+1/(2k/I)32S-2k/I rod to a some angular position and then moving it back to the
original position in very small time period.
Then taking inverse Laplace transform function gives the 3. DIGITAL IMPLEMENTATION
impulse response of the system.
ht=L-1[Hs] For bilateral tele-manipulaton we have to use digital systems
in order to capture and process data and regenerate the forces
ht=-kI212kIt-1/(2k/I)32e-2k/It++1/(2k/I)32e2k/It (9) and feedbacks. The features of the digital system decide how
well the bilateral system works. That is how closer the system
work to the actual scenario. The systems quality heavily
Since the exponential terms are cancelled out. -12I3t term depends on the processing speed of the digital system. It
dominates the impulse response of the system. It can be noted
that is a constantly increasing term (not considering the decides the continuity of the system. If we are using a system
magnitude). Practically, this scenario can be noted. Due to with low processing speed we can’t expect a continuous
impulse torque slave tend to move at a constant angular speed. operation from the system. If the processing speed is too low
That angular speed depends only on the inertia of the system. compared to the speed of the movements of the system even
stability problems can arise. So when designing a suitable
When the input measured as an angle digital system for bilateral control systems we have to use a
consider it’s processing speed by analyzing the features of the
control system. In addition to the digital system ,the system’s
θs( s ) k/I performance depend on the features of the sensors used.
= 2 (10)
Generally sensors such as position sensors (Angular, Linear)
θm( s ) S + k / I and force, torque sensors used in less complicated bilateral
systems. The responsiveness and the resolution of the sensors
There are poles at and are very critical for a system. In order to transmit the master’s
date to slave and feedback of slave’s to the master, the sensors
S = ± (K / I ) should sense the data without any delays. A little delay could
make the system unstable. And also the resolutions of the
sensors should be at an acceptable level which helps to
Graphically interpreting this on S- plane reproduce the action of the master at slave’s side without any
discontinuities. If a sensors with low resolutions used small
jω deflection or small forces on the master’s side are not
transferred to the slave which reduces the performance of the
system.
Let’s take a force is applied to the master rod for a small time We have to sample the acquired data from the sensors from
regular intervals, δt. The sampling interval depends on
period(δt) and it is rotated by an angle of δƟM due to that frequency of outputs of the sensors or the processing speed of
force, and let’s consider the slave rod is deflected by an angle the digital system used. For the algorithm inertia, spring
of δƟS due to the force transferred through the torsion spring. constant, sampling time should be initialized first.
Let’s take the tension of the torsion spring before applying the
force is T(t-δt), Initialize I,K, δt
Then tension of the spring after a time period of δt
θMt-δt = 0;
Tt-δt = 0;
Tt-δt+K{δθMt– δθS t} (13) θs t-δt= 0;
Then the average tension during the time period δt while(true)
Tt-δt+ K{δθMt– δθS t}2 (14)
{
Considering Slave’s acceleration and applying the Newton’s
δθMt= θMt-θMt-δt
central difference formula for second derivate
// angular deflection of master during a sampling time period
θs= θs t+δt - 2θs t + θs t-δt(δt)2 (15) // θMt and θMt-δt obtained from position sensor of the master
}
I δθS t- δθS (t-δt) (δt)2= Tt-δt+ K{δθMt– δθS t}2
when the torsion spring is initially stressed
(19)
The same algorithm can be used when the spring is stressed
due to a force. But the initial values are different . θMt-δt and
(20)
θs t-δt should be known and then the Tt-δt can be found using Pδt2I=δθS t2Ikδt2+ 2+δθS t-δt-4Ikδt2-2+δθS t-2δt2Ikδt2+Tt-
the relationship δt-2k +Tt-2δt{2k }
Tt-δt=θMt-δt-θs t-δt
Then we can get δθS t as follows (27)
δθMt= 2I{δθS t- δθS (t-δt)}k(δt)2- 2T(t-δt)k+δθS t when the torsion spring is initially stressed t,he same algorithm
can be used but the initial values are different . θMt-δt and θs t-
(22) δt should be known and then the Tt-δt can be found using the
Applying τ=Iθ for slave relationship Tt-δt=θMt-δt-θs t-δt
T=IθS (23)
Applying τ=Iθ for master 4. SIMULATION AND RESULTS
P-T=IθM (24)
Using 1 and 2 The algorithm using a position sensor was implemented in
matlab and the output values were graphically plotted altering
P-IθS=IθM (25) the parameters of the system and noticeable results could be
Using Newton’s central difference formula for second observed. Graphs were obtained for the two behaviors when
derivative master rod moved at a constant speed and sinusoidally moved
Applying (26) in (25) When the master rod is moving at a constant angular speed
Input
actuators and sensors and also the data processing and
communication delays. At slower speeds nearly similar
behavior to the mechanical system could be observed. But at
higher speeds, faster data acquisition and processing methods
actuators and sensors with low response time should be used
in order to obtain that behavior. Communication delay is the
one of the significant issue in tele-operated bilateral control
systems. When the master and slave are located far away from
each other delays can arise when transmitting data through
communication medium. As an example when the tele-
Figure 4.1
operation uses the a packet switching network such as internet
as the communication medium there can be considerable
The response of the slave for a constant speed of a master is as amount of delay when transferring data from master to slave
follows and slave to master. When this delay can’t be neglected the
Output stability of the system can’t be guaranteed. [4]
REFERENCES
5. CONCLUSION
T
δƟs
T
δƟm
Let’s take a force is applied to the master rod for a small time
period(δt) and it is rotated by an angle of δƟM due to that
force, and let’s consider the slave rod is deflected by an angle
Software Implementation of the system of δƟS due to the force transferred through the torsion spring.
Let’s take the tension of the torsion spring before applying the
force is T(t-δt),
Then tension of the spring after a time period of δt Initialize I,K, δt
while(true)
Tt-δt+ K{δθMt– δθS t}2 (2)
{
Considering Slave’s acceleration and applying the Newton’s
central difference formula for second derivate δθMt= θMt-θMt-δt
// angular deflection of master during a sampling time period
θs= θs t+δt - 2θs t + θs t-δt(δt)2 (4) // θMt and θMt-δt obtained from position sensor of the master
Then the angle angular deflection of slave, δθS t is given The same algorithm can be used when the spring is stressed
due to a force. But the initial values are different . θMt-δt and
by θs t-δt should be known and then the Tt-δt can be found using
the relationship
δθS t= 2Tt-δt(δt)2+K(δt)2δθMt+ 2IδθS t-δt2I+K(δt)2 Tt-δt=θMt-δt-θs t-δt
Simulation Results
Using the above equation an algorithm can be implemented The algorithm was implemented in matlab and the output
for this bilateral system. values were graphically plotted altering the parameters of the
Algorithm system and noticeable results could be observed. Graphs were
obtained for the two behaviors when master rod moved at a
constant speed and sinusoidally moved.
If the system is initially at rest.
When the master rod is moving at a constant angular speed
The starting torque T = 0;
And θs t-δt= 0;
The response of the slave for a constant speed of a master is as Tt-δt+ K{δθMt– δθS t}2
follows Applying =I for slave, and substituting from 1 and 2
τ ..
θ
When the master has a Torque Sensor δθS t=Pδt2I-δθS t-δt-4Ikδt2-2-δθS t-2δt2Ikδt2-Tt-δt-2k -Tt-
2δt{2k }2Ikδt2+ 2
Algorithm
When there is a sensor to measure the applied torque to the
master, instead of a angular position sensor, slave behavior is If the system is initially at rest
determined according to the input torque pattern to the master. Tt-δt=0,Tt-2δt=0,θS t-δt=0, θS t-2δt=0
For accuracy its essential to have a torque sensor with lowest
minimum measurable force. And also the frequency of feeding Initialize I,k, δt
data to the digital systems also influence the accuracy of the
system. While(true)
Considering figure one, if a torque of P applied to master {
during an interval δt, and it can be assumed that the applied
torque p is constant during this time interval. And let’s take
the tension of the torsion spring is T before torque P applied. δθS t=Pδt2I-δθS t-δt-4Ikδt2-2-δθS t-2δt2Ikδt2-Tt-δt-2k -Tt-
Tension of the spring when the master and slave is deflected 2δt{2k }2Ikδt2+ 2
by angles of θM and θs respectively δθS t-2δt=δθS t-δt
Tt-δt+K{δθMt– δθS t} δθS t-δt=δθS δt
Tt-2δt=Tt-δt Applying =I for rod 1 and rod2
// setting Previous T to present T τ ..
Tt-δt = Tt-δt+IδθS t- δθS t-δtδt2-kδθS t2 θ
// New present T
// This is the feedback torque and this is generated at the master where - Torque, I – Inertia, - angle ;
using an actuator τ
θSt= θSt+ δθS θ
// current angular position of slave (1)
//This value is given to the slave’s actuator
..
} I 1θ 1 = τ − k (θ 1− θ 2)
when the torsion spring is initially stressed t,he same algorithm (2)
can be used but the initial values are different . θMt-δt and θs t- ..
δt should be known and then the Tt-δt can be found using the
relationship Tt-δt=θMt-δt-θs t-δt I 2 θ 2 = k (θ 1− θ 2)
.. ..
θ 1(0),θ 2(0) = 0
Since two rods are equal.
Figure 3.1
I1 = I 2
It was assumed that frictional are not present in the system and
the system is always at rest before it moves. When developing By (3) and (4) transfer function of the master’s force to slave’s
a mathematical model for virtual model we have to consider in position can be derived,
which manner a movement of rod1 is replicated at rod2 and on
the other hand we have to consider the feedback force exerted (5)
on the rod 1 due to the inertia of the rod 2. Consider rod 1 is θ 2( S ) K
moved by an angle of θ1 and let’s take the rod2 is rotated by = 2 4
an angle of θ1 in response to master’s movement (Figure 3.2). τ ( S ) I1 S − 2 KI1 S 2
And also the transfer function for the reaction force exerted by
the slave on the master is given by
(6)
τ ' (S )
= I 1S 2
θ 2( S )
Figure 3.2 In equation (5) its been considered that input to the system is
the torque applied to the master. That means there is a torque
sensors at the master’s side.If the input needed is the angular jω
deflection of the master ,it should be equipped with an angular
position sensor . The transfer function can be derived as
follows when angular position is used as the input.
S =− K/I S =+ K/I
σ
This also gives rise a impulse response of with two
exponential terms, decreasing one and an increasing one.But
there is not a pole at S = 0 as the previous case .Therefore the
exponential terms cancelled out and nothing left that is h. This
scenario can be cleary seen by examining the impulse response.
(1)
(2)
..
Applying =I for slave I 2 θ 2 = k (θ 1− θ 2)
τ ..
θ Taking the laplacian of (1) and (2) we get,
P-T=IθM
..
I 1[ S 2θ 1( s ) − Sθ 1(0) − θ 1(0)] + kθ 1( S ) − kθ 2( S ) = τ ( S )
(3)
(4)
..
I 2[ S 2θ 2( s) − Sθ 2(0) − θ 2(0)] − kθ 1( S ) + kθ 2( S ) = 0
.. ..
θ 1(0),θ 2(0) = 0
Since two rods are equal.
I1 = I 2
By (3) and (4) transfer function of the master’s force to slave’s
position can be derived,
(5) There are two well known bilateral control architectures used
at present, there are position-position architecture and
τ ( S ) I1 S − 2 KI1 S
2 4 2
position-force architecture.
=
θ 2( S ) K
Position to Position Architecture [3]
And also the transfer function for the reaction force exerted by
the slave on the master is given by In this architecture both robots are programmed to track each
other’s position. The slave imitates the movements of the
(6) master and also slave transfer the forces acting on it back to
the master. If master want to feel force acting on slave’s side
τ ' (S ) that force should be large enough to move the slave
= I 1S 2 actuators of the slave. If it doesn’t there is no method to
θ 2( S )
master to sense the forces acting on the slave. So this doesn’t
agree with the concept of force feedback all the time.
By virtually implementing these functions the similar operation
as the mechanical system can be obtained when the spring is Position-Force Architecture [3]
not present in the system. The next step of modeling system is
to simulate the system in a computer environment with the help In this architecture master can sense all forces acting on the
of the derived mathematical model. There, it can be observed
the behavior of the slave according to the various force applied slave whether they move the slave’s actuators or not. But this
to the master and forces exerted on master by the slave. architecture is less stable than the previous one.
IV. CONCLUSION The system modeled above is a system with a position-
position architecture because a torque should move the
When implementing the above system physically using the system if the force should be sensed.
virtual model, we can’t expect the exactly the same behavior
as the mechanical system. This happens due to delays of REFERENCES
actuators and sensors and also the data processing and
communication delays. At slower speeds nearly similar [5] Cristian Secchi,Stefano Stramigioli,Cesare Fantuzzi,“Control of
behavior to the mechanical system could be observed. But at Interactive Robotic Interfaces”,Springer,2007
higher speeds, faster data acquisition and processing methods [6] Horan, Ben, Creighton, Douglas, Nahavandi, Saeid and Jamshidi, Mo
actuators and sensors with low response time should be used 2007, Bilateral haptic teleoperation of an articulated track mobile robot,
in IEEE International Conference on System of Systems Engineering,
in order to obtain that behavior. Communication delay is the 2007. SoSE '07., IEEE Xplore, Piscataway, N.J, pp. 1-8.
one of the significant issue in tele-operated bilateral control [7] Bruno Siciliano, Oussama Khatib ,” Handbook of Robotics”,
systems. When the master and slave are located far away from Springer,2008
each other delays can arise when transmitting data through [8] William R. Feme11,“Remote Manipulation with Transmission Delay,”
communication medium. As an example when the tele- National Aeronautics and Space Administration.Washington, D. C.,1965
operation uses the a packet switching network such as internet [9] Thorsten A. Kern,”Engineering Haptic Devices”,Springer,2009
as the communication medium there can be considerable
amount of delay when transferring data from master to slave
and slave to master. When this delay can’t be neglected the
stability of the system can’t be guaranteed. [4]
σω