IMECE BONDGRAPH BASED APPROACH TO PASSIVE TELEOPERATION OF A HYDRAULIC BACKHOE

Transcription

1 Proceedings of IMECE ASME International Mechanical Engineering Congress and Exposition November -,, Anaheim, California USA IMECE-6 BONDGRAPH BASED APPROACH TO PASSIVE TEEOPERATION OF A HYDRAUIC BACKHOE Kailash Krishnaswamy Honeywell abs 66 Technology Dr Minneapolis, MN 8 kailash.krishnaswamy@honeywell.com Perry Y. i Department of Mechanical Engineering University of Minnesota Church St. SE Minneapolis, MN pli@me.umn.edu ABSTRACT Human operated, hydraulic actuated machines are widely used in many high-power applications. Improving productivity, safety and task quality (eg. force feedback to the operator in a teleoperated scenario) has been the focus of past research. In addressing these issues, our research proposes and experimentally demonstrates a control technique that renders a hydraulic machine (teleoperated backhoe in this case) as a two-port, coordinated, passive machine. The passive teleoperated backhoe is driven by a human operator at one-port and interacts with the environment at the other. It guarantees interaction stability and safety with the human / work environment as the latter are usually passive. In previous work, a passive teleoperation algorithm was proposed for multi degree of freedom teleoperation of a hydraulic backhoe approximated by its kinematic behavior. The approximation led to severe performance deterioration under certain operating conditions. In this paper, a bondgraph based passive teleoperation architecture is proposed for the nonlinear dynamic modeled backhoe. Passive control is designed in two stages. In the first stage, bondgraph based system inversion ideas are used to determine a coordination control law. In the second stage, a desired locked system (desired dynamics of the coordinated teleoperator) is defined and an appropriate control law is determined to ensure the passivity property of the locked teleoperator. The proposed passive control law is experimentally verified for its bilateral energy transfer ability and performance enhancements. Associate Professor and Corresponding Author Introduction Passive systems possess the beneficial properties of ease of human control, and stable interaction with arbitrary passive systems. Motivated by these properties, our research has been directed towards developing passive hydraulic systems [ ]. A new hydraulic element called the passive valve was developed for both single-stage, [] and multi-stage [] valve configurations. The passive valves are mechatronic two-port devices with a command port and a hydraulic port such that they are passive with respect to the total scaled power input to the device. The single stage and multi-stage passive valves were used in passive bilateral teleoperation of a hydraulic actuator, [] and []. The single stage passive valve was experimentally used in the teleoperation of a -DOF kinematic modeled hydraulic backhoe, []. Passive teleoperation ensured rigid, mechanical, two-port passive behavior of the motorized joystick teleoperated hydraulic backhoe. The benefit of ensuring passivity of the teleoperated system is that the system can interact stably with other passive elements like humans and work environments. A dynamic system with input u(t) and output y(t) is passive with respect to a supply rate s(u(t),y(t)) e if c such that, for all u( ) and time τ >, τ s(u(t),y(t))dt c, [6].The inherent safety that passive systems provide has been exploited by researchers in the development of human interacting machines like smart exercise machines [7], passive bilateral teleoperators [8] and in other passive systems such as COBOTS [9] and PTER []. In a previous paper [], we developed a control design method for -DOF passive teleoperation of a hydraulic backhoe using a motorized joystick. Although passivity of the teleoperated system was ensured, the algorithm ensured coordination of Copyright c by ASME

2 HUMAN OPERATOR BAC KHOE JOYSTICK can follow the development of the models as outlined in []. Throughout this paper, matrices / vectors are represented as bold face symbols and the elements are represented as the same symbol in normal font with a superscript i denoting the link number. Single-stage passive valve: The development of a single stage passive valve, we use in our design and experimental work was presented in []. Due to space constraints we include only the dynamics of the passive valve as given in Eq. (). ẋ v = Ω + F x ΓF () Figure. PC Schematic of the Teleoperated Backhoe the joystick and the backhoe assuming a kinematic model of the latter. That is, dynamic effects due to a) hydraulic fluid compressibility and b) inertia of the hydraulic backhoe were ignored in order to determine a coordination control law. These assumptions led to poor performance during teleoperation under certain operating conditions. In the present paper, we propose a bond graph based passive teleoperation algorithm for the -DOF hydraulic backhoe by including the previously neglected fluid compressibility and inertial effects. The objective is to design a teleoperation controller, interacting with a -DOF master joystick at one port and a -DOF hydraulic backhoe at the other port. The controller ensures passive two-port behavior of the teleoperated backhoe w.r.t. a scaled power input as its supply rate. The twoport machine interacts with the human operator at one port and the environment at the other. The teleoperation controller also ensures the coordination of the master joystick and the backhoe at all times. The rest of this paper is organized as follows. Section presents the models of all the subsystems of the teleoperated backhoe and formulates the control design problem. In section we design the passive teleoperation controller. Experimental results of implementation are presented in section. Conclusions and future work are given in section. System modeling and control objective A schematic of the teleoperated backhoe is shown in Fig.. It consists of a -DOF master motorized joystick in a horizontal plane and a -DOF Backhoe of which -DOF (the boom) will be constrained. Backhoe motion is actuated by single-rod hydraulic actuators which are in-turn driven by single-stage proportional valves. A submerged constant displacement vane pump can provide upto 9 PM ( GPM) flow at. MPa (. KPSI). In this section, we present models of the teleoperated backhoe subsystems and formulate the control objective. Interested readers where = [xv,...,x v] i T denotes the valve spool position, F x = [Fx,...,Fx] i T denotes the passive valve control input, F = [F,...,Fi ]T ; F i = Ai cpc i A i rpr i denotes the differential hydraulic load force, Γ = Diag[γ,...,γ i ] denotes the load force gain acting on the spool, Ω = Diag[ω,...,ωi ]; ω i >. The valve is passive w.r.t. the supply rate: s v ((F x, ),(P,Q ),(P,Q )) = x T v K Q Γ F x Q T P Q T P, where P,Q, P,Q are the pressures and flows in the cap and rod side actuator chambers. The first term in the supply rate is the power input by the exogenous control F x, the sum of the second and the third terms is the net hydraulic power withdrawn by the hydraulic load (single-rod actuator). Hydraulic actuator: The pressure dynamics of a hydraulic actuator associated with link i are given by: V β P = Q A ẋ, V β P = Q + A ẋ () where V, V are the total volumes of the capside and the rodside chambers including the hose volume, respectively, β is the fluid compressibility, P = Diag[Pc,...,Pc],Q i = Diag[Q c,...,q i c], P = Diag[Pr,...,Pr],Q i = Diag[Q r,...,q i r] are the pressures and flows in the actuator chambers, A, A are the cap and rod side piston cross-section areas and x is the piston position. Since the actuator chamber volumes are primarily composed of hose volumes, although the actuator volumes V,V are dependant on the piston position x, it is assumed that V i β min(v i )β max(v i )β, Q i c = A i c(k i Q xi v K i T ( x i v,f i ) F i ) () Q i r = A i r(k i Q xi v K i T ( x i v,f i ) F i ), () KQ i = Kq i As P s () A i c + A i r KT i ( xv,f i ) i KQ i = xi v (6) As P s A s P s sign(xv)f i i { A i A s = c, xv i A i r, xv i (7) < Copyright c by ASME

3 Notice that KT i ( xi v,f i) Fi for all xi v,f i. The hydraulic actuator is a passive -port subsystem with respect to the supply rate: s a ((P,Q ),(P,Q ),(F,ẋ)) = Q T P + Q T P ẋ where F = A P A P. This supply rate is the difference of cumulative input hydraulic power at the cap, (Q T P ) and rod, (Q T P ) side ports and the output mechanical power, (ẋ ). Backhoe dynamics: The backhoe is modeled as a planar, rigid -link robotic system. Its dynamics are given by, M x (x)ẍ + C x (x,ẋ)ẋ = F F e, (8) where M x = M T x > and M x C x is skew-symmetric, F = A P A P is the differential hydraulic force acting on each backhoe link and F e is the net environment force acting on the backhoe. ẋ is a vector of the actuator piston velocities. The environment force includes effects due to friction (links and actuators) and gravity. The mechanical backhoe is a passive -port subsystem with respect to the supply rate, s b ((F,ẋ),( F e,ẋ)) = ẋ T (F F e ). Motorized joystick: The joystick is modeled as a planar, rigid -link robotic system. Its dynamics are: M q (q) q + C q (q, q) q = F q + T q, (9) where M q = M T q > and M q C q is skew-symmetric, F q and T q are the motor actuated control torque and the human input torque on the joystick. q is a vector of the link angular velocities. Notice that gravity does not affect the dynamics as the joystick motion is constrained to the horizontal plane. The joystick is a passive -port subsystem with respect to the supply rate, s j ((F q, q),(t q, q)) = q T (F q + T q ). In order to analyze the passivity property of the interconnection of the subsystems, we use the interconnection lemma, [] which states that the cascade interconnection of two passive systems results in a passive system with a modified supply rate. By virtue of this property the passive valve, hydraulic actuators and the backhoe form a cascade interconnected passive system. In order to ensure the passivity property of the teleoperated machine, we need to determine a teleoperation controller which ensures that he teleoperated system is passive with respect to the supply rate, s tele ((ρt q, q),(f e,ẋ)) = ρ q T T q ẋ e. () where ρ is the desired power scaling factor. In Eq. (), the first term is the scaled human power and the second term is the environment power input to the teleoperated backhoe. Human power input to the teleoperator is scaled using ρ. Satisfying the above passivity condition will ensure that the joystick teleoperated backhoe will behave like a passive -port device and thus SAVE (BACKHOE) DYNAMICS K Q Γ F x : S e I : K Q Γ (K QA ) R : Ω Figure. GY C : V β P }{{} P }{{} (K Q A ) A C : V β A R : K T A R : K T A ρf q : S e MASTER (JOYSTICK) DYNAMICS ẋ I : M x (x) S e : F e q I : ρm q (q) S e : ρt q Bondgraphs of Master and Slave systems. guarantee stable interaction with the passive power scaled human and work environment. In addition, our teleoperation control should also ensure that the scaled coordination error E := αq x, () asymptotically, where α is a kinematic scaling. This ensures that the backhoe motion mimics the scaled joystick motion. Passive teleoperation controller design The control design procedure consists of the following steps in sequence.. The dynamics of the teleoperated hydraulic backhoe will be represented using bondgraphs.. Bondgraph based system inversion ideas will be used to determine a coordination control law which will ensure that the master and slave systems of the backhoe remain coordinated at all times.. The coordination control law will be represented on the bondgraph of the hydraulic teleoperated backhoe and ) a suitable coordinate transformation and ) a passive control law will be determined so that the coordinated teleoperator (locked system) is passive w.r.t. the desired supply rate. The bondgraph representation of the passive motorized joystick with power scaling (9) and the passive hydraulic backhoe (), () and (8) is shown in Fig.. The dynamics of the master and slave systems represented in the above bond graph, Fig. are given by (). ρm q (q) M x (x) V β V β K Q Γ q d ẋ P dt P = ρc q (q, q) q ρ(f q + T q ) C x (x,ẋ) A A A A K ẋ F e T A A K T A K Q A A A K T A K P T A K Q P + A K Q A K Q Ω K Q Γ F x () where Ω = K Q Γ Ω. In order to simplify the passive control synthesis and analysis, the dynamics of the master and slave Copyright c by ASME

4 systems () are transformed using an orthogonal decomposition (w.r.t. the metric M) similar to the one proposed by [], conceptually. The difference is that the following decomposition is proposed for N-DOF fourth order hydraulic system whereas the decomposition proposed by [] is applicable to N-DOF PSfragsecond replacements order systems. The metric, M of the orthogonal decomposition is given by ρm q (q) M x (x) M := V β V β K Q Γ K Q Γ F x : S e Figure. I : K Q Γ K Q C : F R : K T R : Ω I : M I/α (αψ T I) Ė GY : C E SS I : M E S e : ρt q F e Ψ T S e : ρf q S e : ρψ T T E Bondgraph of coordinate transformed teleoperator and the decomposition is given in Eq. (). Ė αi I I αψ Ψ F F := A A A (I A Φ) Φ xv I where q ẋ P P () Ψ = α(ρm q (q)m x (x) + α I) () Φ = A + A V β A A V β. () The above decomposition transforms the master-slave dynamics into dynamics involving the states; ) coordination error, Ė, ) average motion of the master and slave systems, = ẋ = α q, if Ė =, ) load force acting on the backhoe, F and ) its perpendicular component, F. Using the above decomposition, the dynamics of the master and slave are transformed into M E Ė C E C E (αψ T I) Ė M d dt F = C E C αi (I αψ) αi K T K Q F K Q Γ K Q Ω ρψ T F q ρψ T T E + ρf q + ρt q F e K Q Γ F x d dt F =. (6) An interested reader is referred to [] for details on the individual parameters. The bond graph describing the above dynamics is given in Fig... Coordination control design The shortest causal path between the output Ė and a control input is of length to the joystick control input F q. Using bicausal bonds [], the inverse dynamics bondgraph between the K Q Γ F x : S e Figure. output Ė I : K Q Γ K Q C : F R : K T R : Ω I : M I/α (αψ T I) Ė GY : C E SS I : M E S e : ρt q F e Ψ T S e : ρf q S e : ρψ T T E Inverse dynamics bondgraph of the teleoperator, input F q and input Ė and the output F q is represented as shown in Fig.. The inverse dynamics from the bondgraph can be written as follows: M d q F = C αi αi K T K Q q F K Q Γ dt K Q Ω + ρt q F e + ρf q C E Ė (I αψ)ė K Q Γ F x F q = d [ ME Ė ] T E + Ψ T ( CE (αψ T ) I)F. dt ρ (7) The following choice of joystick control F q F q = T E + Ψ T ρ ( CE (αψ T I)F K E E B E Ė ), (8) Copyright c by ASME

5 PSfrag replacements C : C : K Q Γ F x : S e OCKED SYSTEM DYNAMICS I : K Q Γ K Q F R : Ω I/α I : M S e : (αψ T I) Ė R : K T R : K E R : B E S e : ρt q F e S e : E F (Ψ T I/α) th ORDER OCKED SYSTEM I : K Q Γ K Q z z R : Ω Ψ T R : K T R : K E I : M R : B E S e : ρt q F e E Ė E Ė I : M E COORDINATION ERROR DYNAMICS Figure. Bondgraph of the master and slave systems with coordination control law Figure 6. I : M E DISSIPATIVE Fourth order desired locked system where B E = B E T > and K E = K E T > ensures asymptotic coordination error dynamics, M E (x,q)ë + C E ((x,q),(ẋ, q))ė = B E Ė K E E. (9) In the above particular case, the shortest causal path led to the joystick control input, F q. In a general case, the shortest causal path would be associated with the system (master or slave) with lower relative degree. We now determine the energy necessary to implement the coordination control law (8) and a passive control so that the coordinated teleoperator is passive w.r.t. the supply rate (). This is achieved by first graphically representing the coordination control in the bondgraph Fig. and analyzing the power flow.. Closed loop passivity property The coordination control (8) is represented in the bondgraph shown in Fig.. Notice the use of a signal bond to indicate the flow of effort from F to. Other researchers have used regular power bonds with one of the port variables set to (Effort (AE) or Flow Amplifiers (AF) in []). Signal (active) bonds are used here as they visually certifying the non-passive property of the bond graph. In Fig., E F is given by: E F = ρt E ρ ( K E E + B E Ė ) C E Ė Ψ T C E. The bondgraph shown in Fig. represents the ocked System behavior; i.e., the behavior of the coordinated teleoperator and Shape System behavior; i.e., the behavior of the coordination dynamics of the teleoperator. The bottom disconnected bond graph in the figure represents the dynamics of the coordination error. The top disconnected bond graph in the figure represents the dynamics of the locked system and determines the haptics experienced by the human operator. Unlike the locked system in [] which is the result of an isometric energetic decomposition, the desired locked systems (introduced in the following section) proposed in this paper is a design variable. This approach has the advantage of letting the control designer choose the haptic behavior of the teleoperator while ensuring the control objectives listed above. Notice that the locked system shown in Fig. is not passive w.r.t. the desired supply rate () due to the presence of ) signal bonds (uni-directional arrows) and ) additional effort sources S e in the bond graph Fig.. The task now is to determine the remaining control input F x so that the bondgraph shown in Fig. is passive w.r.t. the supply rate (). As stated above, the desired locked system structure is up to the control system engineer. Towards that end, two locked system designs are proposed in this paper. The first design shown in Fig. 6 proposes a fourth order locked system. The second design shown in Fig. 7 proposes a second order locked system. ocked System Design : th Order, -DOF Haptic Behavior We need to determine the passive valve exogenous control input F x in Fig. so that the closed loop dynamics of the actual locked system shown in the figure behaves like the desired locked system dynamics shown in Fig. 6. The design process involves comparing the dynamics of the actual and desired locked systems and choosing the appropriate coordinate transformation which makes choice of the passive control input F x almost trivial. The coordinate transformation and control input ensure that the actual dynamics mimic the desired dynamics. The dynamics of the actual locked system shown in Fig. are: M d F = C Ψ T αi K T K Q F + ρt q F e K Q Γ dt K Q Ω ρt E ρ ( K E E + B E Ė ) C E Ė + Ψ T C E + (I αψ)ė K Q Γ F x () The dynamics of the desired locked system shown in Fig. 6 are: M d z = C Ψ T Ψ K T K Q z + ρt q F e K Q Γ dt z K Q Ω z () Copyright c by ASME

6 Note that z, z are different from F, even though they have the same dynamics. We will determine the relationship between them later. In general, the desired locked dynamics () need not have the same parameters as the actual locked system (). However, the proposed locked system minimizes additional control effort F x which would be necessary to modify the natural behavior of the coordinated hydraulic teleoperator and hence the actual locked system. The passive control objective is to design the passive valve control F x in () (also in bondgraph in Fig. ) so that the actual locked system behaves like the desired locked system in Eq. () (also in bondgraph in Fig. 6). By doing so, we can ensure that the locked system is passive with respect to the supply rate (). In order to achieve this, compare the actual dynamics of in () and the desired dynamics as given by (), using a procedure similar to the procedure proposed by [] where a bondgraph approach to passification of a single-stage valve is presented. Notice that the actual locked system dynamics () and desired dynamics () will be identical if and only if z := F + Ψ T D(t). () where D(t) = ρt E ρ ( K E E + B E Ė ) C E Ė + Ψ T C E. By substituting this transformation for z into the desired dynamics () and comparing the actual and desired dynamics of F it can be noted that the dynamics will be identical if and only if [ z := K Q (Ψ T αi) + + K Q K T Ψ T D(t) + d ] dt [ Ψ T D(t)]. () Proceeding in this manner, the above analysis leads to the following coordinate transformation [ F ] T [ z z ] T : q I z = I q F z K Q (Ψ αi) I + Ψ T D(t) K ( Q K T Ψ T D(t) + dt d [ Ψ T D(t)] ), () where D(t) = ρt E ρ ( K E E + B E Ė ) C E Ė + Ψ T C E. This transformation (Eq. ()) when applied to the actual locked system dynamics () results in the following transformed dynamics: M d q z = C Ψ T Ψ T K T K Q q z K Q Γ dt z K Q Ω z ρt q F e +, () K Q Γ F x + D (t) where D (t) = K Q [z F ] + K Q Γ (Ω[z ] + d ) dt [z ], (6) z F := Ψ T D(t), z := K Q (Ψ αi) + K Q ( K T Ψ T D(t) + d ) dt [ Ψ T D(t)]. Notice that the signals z F and z are dependant on D(t) and its successive derivatives which are functions of external variables T E,,F,E and Ė. If the locked system control F x in () is chosen as follows: K Q Γ F x = D (t), (7) then the locked system is passive w.r.t. the supply rate () and its dynamics are given by: M d z = C Ψ T Ψ T K T K Q z + ρt q F e. K Q Γ dt z K Q Ω z (8) The above analysis provides a sketch of the proof of the following theorem which summarizes the passive teleoperation design procedure. Interested readers are refered to [] for a proof of the theorem. Theorem th Order, -DOF ocked System, perfect model: The teleoperated hydraulic backhoe composed of a) the passive valve (), b) the dynamically modeled hydraulic actuators (), c) the mechanical backhoe (8) and d) the motorized joystick (9) which is concisely represented in Eq. (6) transforms to an interconnected locked system () under the choice of joystick control input F q as given in () and the coordinate transformation (). The interconnected locked system () is passive with respect to the supply rate: s tele ((T q, F e ),(, )) = q T (ρt q F e ), (9) if the passive valve control input, F x is chosen as follows: F q = T E + Ψ T ρ [ CE (αψ T I)F K E E B E Ė ], F x = ΓK Q D (t), () where D (t) is given by (6). The choice of joystick control input F q in () ensures that the coordination error E asymptotically. Remark Since the coordination error states (E, Ė) (, ) (as stated in theorem ), the energy associated with the error dynamics V. Owing to this property, ensuring that the locked system given by Eq. (8) is passive w.r.t. the supply rate (9) implies that the teleoperated backhoe is also passive w.r.t. the same supply rate, (9). Moreover, ensuring that the teleoperated backhoe is passive w.r.t. the -port supply rate s tele ((T q, F e ),(, )) = q T (ρt q F e ), () 6 Copyright c by ASME

7 PSfrag replacements also ensures passivity of the teleoperated backhoe w.r.t. the - port supply rate s tele ((T q, F e ),( q,ẋ)) = ρ q T T q }{{} Operatorinput power Workenv.input power ẋ e. () This is significant as, the environment consisting of the human and the work environment interact with the teleoperated backoe via a supply rate given by s tele and not s tele. Hence, ensuring passivity of the teleoperated backhoe (6) w.r.t. the supply rate () not only has better physical relevance but is also necessary to ensure -port passivity property of the teleoperated backhoe. Ensuring that the teleoperated backhoe behaves like a -port passive device is in turn beneficial as it is then possible to analyze the stability of interconnection of the passive backhoe with other passive systems by invoking properties of interconnection of passive systems stated in section. Theorems presented a passive teleoperation control design which ensures that the master-slave teleoperator mimics a passive th order -DOF system operated upon by the human operator and the environment. Since the locked system dynamics are of fourth order, the teleoperator behaves like a fourth system when operated upon by the operator, interacting with the environment. While the system order has certain advantages in terms of filtering high frequency content of environment forces, it may be disadvantageous in other circumstances when the operator requires an agile teleoperator. Hence, it would be benefecial to control (using passive valve control F x ) the locked system to behave like a lower order dynamic system. Such a method is proposed in the following section where, the teleoperator behaves like a second order locked system. ocked System Design : nd Order, -DOF Haptic Behavior The locked system control objective remains the same which is to determine F x in Fig. so that the closed loop dynamics of the actual locked system shown in the figure behaves like the desired nd order locked system dynamics as shown in Fig. 7. The design process is similar to that outlined in the previous section and involves comparing the dynamics of the actual and desired locked systems and choosing the appropriate control input F x so that the actual dynamics mimic the desired dynamics. Due to space limitations, the algorithm is not presented here. The design results in the following closed loop dynamics: M (x,q) q + C ((x,q),(ẋ, q)) = ρt q F e. () Notice that the locked system given by () is nd order whereas the locked system given by (8) is th order. The valve and joystick control forces F x and F q that ensure both the th and nd order locked system assume accurate knowledge of Ψ,T E which C : DISSIPATIVE I : K Q Γ K Q z z R : Ω Figure 7. R : K T I : M S e : Ψ T z nd ORDER OCKED SYSTEM R : K E E R : B E I : M E Ė DISSIPATIVE S e : ρt q F e Second order desired locked system depend on the backhoe / joystick inertia and external forces respectively. In reality, it may not be possible to know these parameters exactly. As a result it is necessary to analyze the passivity and coordination property of the proposed algorithm in the presence of such uncertainties. Due to space constraints, the formal results are not presented in this paper. We just state the result that both the algorithms undergo minor implementation modifications in order to ensure the coordination and passivity properties of the teleoperation control algorithm. The design procedure is exactly the same as outlined in this paper. Theorem demonstrates the ability of the control design method in achieving different order locked systems and hence designing the haptic behavior of the passive teleoperator. This is beneficial as the locked system behavior is exactly the haptic dynamics of the teleoperator. Being able to flexibly design the order of the teleoperator will improve the efficiency of the teleoperator depending on its purpose. Experimental results Experimental results of teleoperation of the hydraulic backhoe using the algorithms presented in the preceding section are presented. A schematic of the experimental setup is shown in Fig.. The motors in the joystick are of the low speed hi torque type. These provide the necessary haptic force to the operator (F q in section ). The motors are also instrumented with co-axial encoders which provides angular position (q in section ) reading of the joystick links and a JR force sensor which measures the operator input force (T q in section ) on the teleoperator. Since the master has only -DOF, the slave hydraulic backhoe is also restricted to operate as a -DOF robot. Of the three links of the backhoe, the boom, the stick and the bucket, the boom is constrained and the bucket and stick are teleoperated using the master joystick. The hydraulic actuation system of the backhoe involves ) A pressure compensated constant flow pump regulated at a fixed psi of pressure (P s ), ) Vickers KBFDGV- series proportional valve which is passified and the exogenous valve command (F x in section ) to spool position ( in section 7 Copyright c by ASME

8 Bucket Displacement (inches) Feedback Torque (N m)... 7 Stick Displacement (inches) 6 Time (seconds) Figure 8. Displacement trajectories (Scaled joystick - solid, Backhoe - dashed) during a digging task. ) bandwidth of about Hz, ) Vickers customized hydraulic actuators instrumented with Hydroline sensors to measure the actuator position x and ) Pressure sensors to measure the individual actuator chamber pressures (P i,pi in section ). The RealTime Operating System used for the experiments is MAT- AB xpc Target. The interface used are ) AD card with 6 channels, ) DA card with 8 channels, ) decoder card with channels and ) Force sensor signal conditioning card. A sample rate of KHz was used for all the command and sensor signals. The teleoperator control algorithms are experimentally verified in this section. The conducted experiments are typical of a digging task. The backhoe is teleoperated to dig into a sand box. A wooden box buried in the sandbox is supposed to mimic underground obstacles. The first and second experiments test the th and nd order locked system teleoperation algorithm presented in section.. Both the algorithms are compared to the kinematic teleoperation experimental results presented in []. Kinematic Teleoperation In this section, experimental results obtained by implementing the intrinsically passive control law developed in [] are presented. The controller was designed assuming a kinematic model of the the hydraulic actuators on the backhoe (fluid compressibility neglected). Backhoe inertia was also neglected. The teleoperated trajectories of the bucket and the stick (and their corresponding joystick links) are shown in Fig. 8. The corresponding haptic force (F q ) experienced by the operator is shown in Fig. 9. A kinematic scaling, α = in./rad and a power scaling ρ = Watt/Watt. Notice from Fig. 8 that the maximum observed coordination error is within.in. Notice also that when the backhoe hits the wooden box (t = 8 repetitively and 8 seconds repeatedly), the operator experiences the backhoe contact force (F e ) embedded in the bucket and stick haptic forces (F q ). There are severe oscillations in the haptic force experienced by the operator primarily because compressible dynamics of the hydraulic backhoe have been neglected in the control design. Although the experiments indicate bilateral power transferability of time (sec) Figure 9. Haptic torque (F q ) trajectories (Stick - solid, Bucket - dashed) during a digging task. the controller, there is much scope for improvement in both the haptics and coordination performance. Dynamic Teleoperation We test the bondgraph based dynamic teleoperation control algorithms which were designed for a -DOF teleoperated system with included nonlinear models of the joystick and backhoe and compressible effects of the hydraulic actuator. th order locked system: The control law which ensured that the nonlinear teleoperated system (6) behaves like a th order locked system is tested. The teleoperated trajectories of the bucket and the stick (and their corresponding joystick links) are shown in Fig.. The corresponding locked system force (ρt q F e ) experienced by the th order locked system while performing the task is shown in Fig.. A kinematic scaling, α = in./rad and two different power scaling ρ = Watt/Watt and ρ = 8Watt/Watt were used for the experiments. Notice from Fig. that the maximum observed coordination error is within.in for the backhoe stick. When the locked system hits the underground wooden box (about t = 8 seconds), the locked system force (Fig. ) does not experience any oscillation as did the Haptic torque in Fig. 9 due to the fact that compressible dynamics of hydraulic fluid are modeled in the dynamic teleoperation scenario. When the backhoe hits the box, the net force on the locked system shown in Fig. is about zero even though the operator is pushing on the joystick (ρt q > ). This is because, the environment force (F e ) provides an equal and opposite reaction force on the joystick thus indicating a bilateral transfer of power. The high order (th) of the teleoperator is felt by the operator during hi frequency motion (oscillatory for example) of the teleoperator. The teleoperator (via the master joystick) feels resistant to instantaneous change in direction of motion. nd order locked system: The control law which ensures that the nonlinear teleoperated system (6) behaves like a nd order locked system is tested. The teleoperated trajectories of the bucket and the stick (and their corresponding joystick links) are shown in Fig. and the corresponding locked system haptic force (ρt q F e ) experienced by the nd order locked system is shown in Fig.. A kinematic scaling, α = in./rad and two different power scaling ρ = Watt/Watt and ρ = 8Watt/Watt were used for the experiments. The maximum observed coordination error is within 8 Copyright c by ASME

9 Bucket Displacement (inches) Bucket Displacement (inches) Stick Displacement (inches) Stick Displacement (inches) 7 6 Time (seconds) Time (seconds) Bucket Displacement (inches) Bucket Displacement (inches).... Stick Displacement (inches) Time (seconds) Stick Displacement (inches).... Time (seconds) Figure. Displacement trajectories for th Order locked system (Joystick - Solid, Backhoe - dashed) during a digging task. Sequentially from top : )-) ρ =, )-) ρ = 8. Figure. Displacement trajectories for nd Order locked system (Joystick - Solid, Backhoe - dashed) during a digging task. Sequentially from top : )-) ρ =, )-) ρ = 8. Haptic Force, ρ = (N) Haptic Force, ρ = (N)... Haptic Force, ρ = 8 (N) time (sec) Haptic Force, ρ = 8 (N) time (sec) Figure. ocked system Force (ρt q F e ) trajectories during a digging task for th Order locked system (Stick - solid, Backhoe - dashed). Figure. ocked system force (ρt q F e ) trajectories during a digging task for nd Order locked system (Stick - solid, Backhoe - dashed). 9 Copyright c by ASME

10 .in and significantly better than the th order locked system. The behavior of the locked system when it hits an underground wooden box (t = 6,9 sec) is similar to the th order locked system behavior. A key factor to notice is that the range of locked system force acting on the nd order locked system (Fig. ) is only about % of that acting on the th order locked system (Fig. ) at similar speeds. This is an indication that the nd order locked system is easier (in terms of necessary power) to teleoperate than the th order locked system. This nd order locked system has the haptic benefits similar to the kinematic teleoperation but with improved performance owing to the richer model (compressible effects + inertial effects) used to design the passive coordination control. Hence, it is very beneficial to be able to not only design passive teleoperators but also design their dynamic behavior as was shown in this paper and proven using experiments. Conclusions and Future Work A passive teleoperation control algorithm for backhoe operation is proposed. The controller provides amplification / attenuation of joystick motions and also scaled feedback force to the operator. The passivity property of the teleoperation scheme ensures stability of interaction of the teleoperated backhoe and arbitrary human / work environment (usually strictly passive). The current teleoperation approach rectifies a previously developed algorithm which assumed a kinematic modeled backhoe. Severe performance deterioration was observed in certain operating conditions with the previously developed algorithm. The proposed algorithm is shown to perform significantly better. The main advantage of the proposed algorithm is that the haptic dynamics of the teleoperated backhoe feature as a design variable. The procedure to ensure that the coordinated teleoperated backhoe behaves a th order locked system and a nd order locked system is shown in this paper. The proposed algorithm does not guarantee an Intrinsically Passive Controller (IPC). An IPC has the advantage of guaranteeing passivity of the teleoperated backhoe even under parametric uncertainties. This is because, cascade interconnection of passive systems (passive joystick + passive controller + passive backhoe) guarantees a passive system. Development of such a controller will greatly enhance the robustness properties of the teleoperated backhoe. REFERENCES [] i, P. Y.,. Towards safe and human friendly hydraulics: The passive valve. ASME Journal of Dynamic Systems, Measurement and Control,, pp. 9. [] i, P. Y., and Krishnaswamy, K.,. Passive bilateral teleoperation of an electrohydraulic actuator using an electrohydraulic passive valve. Proceedings of the American Control Conference, [Jul.], pp [] Krishnaswamy, K., and i, P. Y.,. Passification of a two-stage pressure control servo-valve. Proceedings of the American Control Conference, Anchorage, AK, 6 [May], pp [] Krishnaswamy, K., and i, P. Y.,. Single degree of freedom passive bilateral teleoperation of an electrohydraulic actuator using a passive multi-stage valve. Proceedings of the IFAC Mechatronics Conference, Berkeley, CA [Dec]. [] Krishnaswamy, K., and i, P. Y.,. Passive teleoperation of a multiple degree of freedom hydraulic backhoe using a dynamic passive valve. Proceedings of the ASME- IMECE. [6] Vidyasagar, M., 99. Nonlinear systems analysis. Prentice Hall. [7] i, P. Y., and Horowitz, R., 997. Control of smart exercise machines, part : problem formulation and non-adaptive control. IEEE/ASME Transactions on Mechatronics,, pp [8] ee, D. J., and i, P. Y.,. Passive control of bilateral teleoperated manipulators: Theory. Proceedings of the American Control Conference, 6 [Jul.], pp. 6 68, Arlington, VA. [9] Colgate, J. E., Wannasuphoprasit, W., and Peshkin, M. A., 996. Cobots: Robots for collaboration with human operators. Proceedings of the ASME Dynamic Systems and Control Division, 8, pp. 9. [] Gomes, M. W., and Book, W., 997. Control approaches for a dissipative passive trajectory enhancing robot. IEEE/ASME Conference on Advanced Intelligent Mechatronics. [] Krishnaswamy, K.,. Passive teleoperation of hydraulic systems. PhD Thesis. Available at kk/thesis [May]. [] ee, D., and i, P.,. Passive coordination control of nonlinear mechanical teleoperator. Submitted to IEEE Transactions on Robotics and Automation. [] Gawthrop, P. J., 99. Bicausal bond graphs. Proceedings of the International Conference on Bond Graph Modeling and simulation (ICBGM), pp [] Ngwompo, R. F., and Gawthrop, P. J., 999. Bond graph based simulation of nonlinear inverse systems using physical performance specifications. Journal of the Franklin Institute, 6, pp. 7. [] i, P. Y., and Ngwompo, R. F.,. Passification of electrohydraulic valves using bond graphs. Proceedings of th IFAC World Congress [July]. Copyright c by ASME