Abstract

A new framework is proposed to mitigate the adverse effect of time-varying time delays on the passivity of a teleoperation system. To this end, the communication channel with time-varying delays is modeled as a constant-delay channel along with additive output disturbances. Then, disturbance estimator blocks are added in each of the feedforward and feedback paths to estimate these disturbances and to compensate for them. In the disturbance estimator block, there is a need for a virtual time-varying delay block such that the overall communication channel can be seen as one with a constant delay. We also propose a method for determining this virtual delay. Two PHANToM haptic devices connected through a communication channel with time-varying delays are considered for a case study. Simulation and experimental results confirm the efficiency of the proposed method in terms of passivating the teleoperation system in the presence of time-varying delays.

1. Introduction

Using a telerobotic system, a human operator can carry out tasks in a remote environment. Different applications of telerobotic systems vary from telesurgery to space manipulation. In telerobotics applications with a distance between local and remote robots, there will be a time delay in the communication channel of the system. The time delay in the closed-loop system can destabilize the telerobotic systems [13]. Control schemes have been developed to compensate for the time delay, most of which are based on the passivity theory. Passivity-based control schemes [49] are inspired from energy interaction between interconnected systems [10]. To this end, Anderson and Spong [4] proposed scattering schemes based on the passivity theory. Another prominent passivity-based scheme is the wave variable formulation for a two-port network proposed by Neimeyer and Slotine [5, 6]. These passivity-based approaches can guarantee the passivity of bilateral teleoperation systems just for constant time delay and cannot preserve the passivity for varying time delays [11]. Another important framework in stability analysis of teleoperation systems is based on input-to-state stability and small-gain conditions [1214].

In the passivity analysis of telerobotics systems using wave variable, wave signals are encoded and decoded before and after transmission based on the power signals (force and velocity) in such a way that the communication channel remains passive. The scattering and the wave variable approaches are the best-known methods in the passivity approach and have been the subject of recent studies concerning teleoperation under varying delays. An extension of the scattering approach to the case of varying time delays is reported in [7], in which a small positive gain is added in communication channel to dissipate the extra energy generated due to the distorted scattered signals caused by varying time delay. The gain should be less than , where is the instantaneous value of the varying time delay such that communication channel remains passive. Also, an extended version of the wave variable approach with varying time delay was reported in [15] in which to have the passive channel, the derivative of the time delay should be less than one.

Considering the effect of varying time delay on the stability and transparency of the network, in this paper a method is developed to improve the stability and transparency of the resultant network which is based on modeling the variable time delay with constant time delay, and additive disturbance. The simulation and experiment results on the tracking performance and passivity measurement of the varying delayed network show the efficiency of the proposed method to the typical wave variable scheme.

In the later part of the paper passivity and wave variable background is studied in Section 2, and passivity of the channel with respect to time delay is studied in Section 3. Main contribution is studied in Section 4. In Section 5 and 6 simulation and experiment results of the proposed method on two PHANToM haptic devices show the efficiency of the proposed method, and conclusion of the paper is considered in Section 7.

2. Passivity and Wave Variable Background

To study the stability of the teleoperation system, the network model could be considered based on the idea of passivity. The passivity represents mathematical description of the physical concepts of power and energy.

The passivity can be formally defined as follows.

Definition 2.1. A two-port network, Figure 1, is said to be passive if the total energy delivered to the network, , at its input and output ports is positive. In the case of master-slave telerobotics, if it is assumed that the operator and the environment are passive systems, then the sufficient condition of stability is that the teleoperator channel must be passive [16, 17]. The passivity of traditional teleoperator systems is very sensitive to transmission delays which can destroy passivity of the entire system by altering the power flow in the system and generating excess energy. To study stability in the presence of varying time delay the wave variable transformations [18] and passivity concepts [19] are used in this study. First, let us define the power delivered to the communication system as where and and and are master and slave forces and velocities, respectively. The wave variables are defined as follows: After some simplifications the power transfer can also be rewritten as follows:

3. Passivity of the Channel with respect to Time Delay

One of the advantages of wave formalism is that passivity could be preserved in the presence of time delays. In the ideal case where there are no delays between the master and the slave the communication channel is clearly passive. However, a communication device introduces some transmission delays which are time-varying in general.

The conventional wave variable scheme [20] is shown in Figure 2, where , . The input-output relationships for each wave block are same as (2.2). The dissipated energy in the communication channel is given by More simplification gives where and . Note that, in the above simplifications, we are using the facts that and. It can be easily shown that when and are constant, (3.2) will be positive. In this case, the communication channel’s passivity is ensured in the exact same way as in the original wave formalism proposed in the literature [20].

If > 1 and , we will have

which result in . On the other hand, for and , the method proposed in [15] can be used to have a passive communication channel.

In time-delayed teleoperation systems, however, it is possible to have and and/or vice versa at time instants or in time periods during the teleoperation. In such cases, the communication channel’s passivity is not guaranteed. In this paper, it is tried to introduce a new method and lift all assumptions on and by modeling a time-varying delay in the communication channel as a constant delay along with an external disturbance. Note that our approach will maintain the input-output relationships for each wave block remains as in (2.2).

4. Main Contribution

In this part, a method is introduced to improve transparency of the proposed scheme. The basis of this part is modeling a time-varying delay in the communication channel as a constant delay along with an external disturbance. Therefore, if the disturbance can be estimated, it is possible to compensate for the tracking errors caused by the disturbance (i.e., the delay variations). In Figure 3, conventional wave variable blocks are used with constant time delays and in the feedforward and feedback paths as well as two disturbances at the outputs of the communication channel.

In order to figure out that and would decrease the teleoperation transparency, let us consider the tracking errors which comply with the following dynamics:

By using the estimates of and , which are denoted by and , respectively, it is possible to decrease the tracking errors in the communication network.

Observing the proposed scheme in Figure 3, we have Therefore, it is easy to define and as

In order to estimate and , first of all, we have to estimate and . Note that and can be measured directly in the proposed scheme. Therefore

Let us inspect the estimation of which is applicable for the estimation of . Since we can just measure and we need the estimation of , in which is constant, the proposed method is to add a virtual delay, , in the estimating block as in Figure 4.

The virtual delay,, should be defined in such a way that would be equal to:

Therefore, to calculate the required amount of the virtual delay such that (4.6) holds, we need to be able to measure. Based on the scheme in Figure 4 which has been used in [21], can be found.

To have a causal virtual delay, that is, > 0, it could be assumed that where and. A geometric approach to estimate is studied in the appendix. Using the estimated virtual delay, it is possible to estimate and then .

The overall proposed scheme is shown in Figure 6, in which a disturbance estimator block in each of the feedforward and feedback paths is added to compensate for the variable time delay effects in terms of velocity and force tracking performance.

Adding and in the proposed scheme, time-varying delays in the communication channel effectively act as constant delays. Therefore, the overall proposed method shown in Figure 6 would have better stability and transparency behaviors.

5. Simulation Results

In this part, simulation results of the proposed method in controlling of the PHANToM robot in telerobotics application are studied. In the later parts, we first study the PHANToM robot and then apply simple P+D. controller to the robots in telemanipulation with the proposed scheme.

5.1. PHANToM Setup

The schematics of PHANToM robot with its corresponding joint angles are shown in Figure 7. The local and remote PHANToM dynamics can be modeled as where , and for are the joint positions, velocities, and accelerations of the local and the remote robots, respectively, and is the contact effect between remote robot and environment. The local and remote PHANToM dynamics are given in [22].

5.2. Simulation with Hard Contact Scenario

The overall block diagram is shown in Figure 8. In this controlling system, proposed scheme shown in Figure 6 is used to decode and send velocity and force signals to the other side. To have more suitable performance of position tracking, integrals of wave variables are employed [23]. This way it is possible to send integrals of velocity and force, that is, position and momentum, which makes it possible to avoid the effects of mismatch in initial position to the performance of position tracking. Following controllers used in local and remote sides are simple P+D controllers added by gravitational term and measured environment force: where is the force command transmitted to the local side and is the position command transmitted to the remote side to be used in the local and remote controllers, respectively (see Figure 8). Also, is the Jacobin transpose of the local robot and used to transform a Cartesian-space force to its equivalent joint-space torque. In the controller (5.2), the parameters and are proportional and derivative matrix gains that can be adjusted by the user. In this simulation, the proportional gain is set to , and the derivative gain is set to , where is the identity matrix.

Human force is applied to the local robot in -direction as shown in Figure 9. Human force is 0 between 0 and 1 s and increases to 4 N at 2.5 s. The force is kept constant until 9.5 s then increases to 10 N at 12 s. It is kept constant until 27.5 s and then decreases to 4 N at 30.5 s and remains constant between 30.5 s and 40 s.

In the remote side there is a stiff wall in. When the remote robot reaches the wall and moves further, the feedback force is applied to the remote robot. In this simulation, the initial conditions are set to , and it is assumed that time delays are sinusoidal. The simulation results are shown in Figures 10, 11, 12, 13, and 14. Figures 10, 11, and 12 show the -, -, and -positions of the local and the remote robots. Figure 13 shows the environment force, , and the force applied to the local robot, , from the communication channel. The force is the force that could be sensed by human when remote robot contacts an obstacle.

When human forces increases, the local and remote robots move forward that can be seen from Figure 10. About 14 seconds, the remote robot contacts the wall at and could not move longer, while the local robot moves further because of the human force and reaches about 0.4 m. In Figure 13, it could be seen that an environment force applied to the remote robot at about instant 14 when remote robot touches the wall. Environment force increases rapidly and after some damping oscillation reaches a constant value 1 N. It is noticeable that has similar behavior as , and it means that human senses same force as environment force which is applied to the remote robot by the wall. About time 30 s, and reduce to zero which means that remote robot is taken away from the wall and both robot’s positions act synchronously between 35 s and 40 s which could be seen from Figure 10.

In this simulation, human force is applied just in -direction but because of coupling effects in PHANToM dynamics, some little movements happen in - and -directions which are shown in Figures 11 and 12.

To study passivity simulation of the proposed method, the net energy exchange at the two ports of the communication channel,, is shown in Figure 14.

Considering Figure 14, it could be seen that before and after contacts between remote robot and the environment, the net exchange energy is almost zero. During contact between 14 s and 30 s, it could be seen from Figure 14 that about 0.12 joules energy is absorbed in the communication channel. Regarding the fact that is almost equal to , most of absorbed energy is because of the differences between and during contact.

6. Experimental Results

To verify the theoretical results presented in the paper, the local and the remote manipulators are considered to be two PHANToM Omni robots (Sensable Technologies, Inc., Wilmington, MA) as shown in Figure 17. The utilized PHANToM devices are three degree-of-freedom robots that map the generalized joint angles of the robot (, , and ) to the Cartesian position (, , and ) of the gimbal. The local and remote robots are connected to a computer using FireWire IEEE 1394 ports. One robot (master) interacts with the human hand while the other one (slave) interacts with an environment. This experiment will compare the stability and performance of the proposed method versus the conventional wave variable scheme.

Controllers for the local and the remote robots are implemented based on (5.2). In this experiment, the proportional gain and the derivative gain are set to and , respectively, in which is the identity matrix. To artificially create time-varying time delays between the local and the remote robots, a first-input/first-output delay-inducing buffer is used for each robot—changing the position of the indicator, which is related to the present-time delay’s value, causes this buffer to simulate time-varying time delays in the communication channel (Figure 15).

To implement the virtual delay , a scheme similar to the block diagram shown in Figure 23 in the appendix is used; see Figure 16. In this scheme, the input is obtained from the system shown in Figure 5. Note that the Quantizer block in Figures 15 and 16 is used to discretize the time delay; the quantized time delay value will determine the number of buffer cells required at each sampling time.

The schematics of the PHANToM robot with its joint angles are shown in Figure 7. The dynamics of the local and remote PHANToM robots are same as (5.1), and the block diagram of the experimental teleoperation system is shown in Figure 8. The proposed scheme is used to transform and send velocity and force signals from one end to the other end of the teleoperation system. Integrals of wave variables are also transmitted to avoid an offset in position tracking. The controllers (5.2) used for the local and remote robots have a P+D term and a gravity compensation term. The local robot controller also has a force term. The choice of controllers is not unique; the selection (5.2) for controllers is only used to test the passivity of the communication channel and compare the proposed method with the conventional wave variable scheme in time-varying delay teleoperation.

In this experiment, the forward and backward time delays are chosen to be the asymmetric sinusoidal time-varying functions and . Note that the time derivatives of these varying time delays are in the range . The fact that exceeds 1 makes it possible to show the effectiveness of the proposed method for fast varying time delays as compared to past methods.

To study the passivity of the proposed method compared with the typical wave variable method, the net energy exchange at the two ports of the communication channel, , is shown in Figures 18 and 19. Whereas in Figure 18 (i.e., in the conventional wave variable scheme) the energy in the channel becomes negative at certain times, which means that the communication channel produces energy and is nonpassive, in Figure 19 (i.e., in the proposed scheme) the energy in the channel is always positive.

To compare the tracking performance under the proposed method and the conventional wave variable scheme in the presence of varying time delays, experimental results concerning joint positions tracking between the local and the remote robots using the same controllers are shown in Figures 20 and 21. It is evident from Figure 21 that instability happens in the teleoperation system with the conventional wave variables in the presence of time-varying delay. Using the proposed method, however, position tracking is considerably better in the presence of the same variable time delays—see Figure 20.

Note that the single-way time delays used in this experiment vary between 0 and 220 ms with a frequency of 10 Hz. This is reasonable in Internet-based teleoperation applications because the round-trip delay has been shown to have an average of 350 ms if the distance between the local and the remote robots is up 10,000 km [24]. Increasing the time delay further might cause the teleoperation system to be unstable; it is well known that wave reflection [6] can cause stability problems under large delays.

Also note that with a different choice of the control laws, these results may change; yet our contribution in terms of passivating the communication channel under varying delays is independent of that.

7. Conclusion and Future Works

In this paper a new method is proposed to pacify communication channels with varying time delays. Using proposed method, the effect of varying delays on the transmitted signals could be seen as an additive disturbance to the delayed signals which is transmitted in the channel with constant time delay. By defining a virtual delay, this disturbance is estimated and added to the channel with negative sign so that the effect of varying time delay on the transmitted signal reduces. In fact, using disturbance estimator and combining it by time-varying delay in the communication channel it is possible to make the channel seen as a constant time delay. The efficiency of the proposed method is studied in simulation and experiment in which two PHANToM robots are connected via communication network with time varying delays.

In the scheme shown in Figure 5, the differentiation and integration blocks may cause noisy signals and noise accumulation, respectively. By frequently resetting the integrator, the noise accumulation problem can be alleviated. Also, it is possible to use differentiators that are robust to measurement noise. For instance, Levant [25] designed a robust exact differentiator, and Suzuki et al. [26] proposed an adaptive version of Levant’s differentiator. Incorporating such robust differentiators in our scheme remains as future work.

Appendices

Two methods for estimation of the virtual delay are proposed here. We name the first method as geometric and the second one as block diagram based.

A. Geometric Approach to Estimate the Virtual Delay

Inspired by the method used in [27], we will investigate how (4.6) can be used to estimate geometrically. From Figure 5, we can estimate; thus define and assume it has a typical profile of time-varying time delays as shown in Figure 22. Here, is the general time variable and is the current instant.

Using the definition of , at time , we have , which corresponds to point in Figure 22. Note that in the shaded triangle shown in Figure 22, the horizontal side’s length is and the vertical side’s length is . Therefore, to estimate, a point in the profile should be found in such a way that the sum of the vertical and horizontal sides of the triangle equals; that is, we need to have .

We know from trigonometry that if the sum of vertical and horizontal sides in a right-angle triangle is constant, then the locus of each vertex is a straight line. Therefore, as the horizontal side’s length decreases, the vertical side’s length increases and the vertex moves on the straight line . At time , when the horizontal side vanishes, the vertical side’s length will be.

We have because it interconnects the two points and . Since the point is the intersection of the two profiles and , we have

Note that using the scheme shown in Figure 5, it is possible to estimate for every instant. Using the estimated profile for past times, at a given time , the nonlinear equation can be solved numerically and can be found. Then the amount of the virtual delay is found, which is what we strived to determine.

B. Block Diagram Approach to Estimate the Virtual Delay

To estimate the virtual delay, we can alternatively use the scheme shown in Figure 23 in which is the output of the scheme shown in Figure 5. Note that the scheme shown in Figure 23 is readily implementable in environments such as Simulink where time-varying time delay blocks exist.