arxiv: v1 [cs.sy] 14 Jan 2017

Transcription

1 Moeling an Control of A Cable-Driven Serie Elatic Actuator Wulin Zou,2, Ningbo Yu,2. Intitute of Robotic an Automatic Information Sytem, Nankai Univerity, Tianjin , P. R. China 2. Tianjin ey Laboratory of Intelligent Robotic, Nankai Univerity, Tianjin , P. R. China wlzou@mail.nankai.eu.cn, nyu@nankai.eu.cn arxiv: v [c.sy] 4 Jan 207 Abtract: Serie elatic actuator (SEA) are playing an increaingly important role in the fiel of phyical human-robot interaction. Thi paper focue on the moeling an control of a cable-riven SEA. Firt, the cheme of the cable-riven SEA ha been propoe, an a velocity controlle DC motor ha been ue a it power ource. Bae on thi, the moel of the cable-riven SEA ha been built up. Further, a two egree of freeom (2-DOF) control approach ha been employe to control the output torque. Simulation reult have hown that the 2-DOF metho ha achieve better robut performance than the PD metho. ey Wor: Serie elatic actuator, Stabilizing 2-DOF controller, Phyical human-robot interaction, Torque control Introuction Serie elatic actuator wa firt recommene by Pratt an Williamon for it benefit of greater hock tolerance, accurate an table force output an the ability of energy torage []. Nowaay, SEA are wiely applie in variou phyical human-robot interaction application, e.g., the SEA for walking robot [2], the compact rotary SEA for human aitive robot [3], the compact compliant actuator for rehabilitation robot [4], etc. Cable actuation ha attracte intenive reearch for it avantage of low inertia, flexible intallation, remote actuation, etc. Cable with low weight to length ratio can change the force irection intentionally an eaily, enable power tranmiion to a remote itance with le energy lo an pace occupation [5, 6], an allow etachment of the actuation motor from the robot frame [7]. Beie, a cable actuate ytem can be a afe olution ue to it uniirectional force contraint an property of breaking when the tenion exceeing the threhol. Many cable actuate ytem have been applie for phyical human-robot interaction, uch a the LOwer extremity Powere ExoSkeleton (LOPES) [7], the Univeral Haptic Drive (UHD) for upper extremity rehabilitation [8], the MR-compatible writ robot [9], etc. The force/torque controller of a erie elatic actuator i eigne to generate a pring eflection force/torque to follow a given comman trajectory. Variou control approache have been evelope for ifferent SEA to achieve high force/torque tracking performance. A Proportional-Integral-Differential (PID) control metho wa introuce in [0] to illutrate the concept an performance of a SEA explicitly. A lot of reearcher have mae important contribution to the evelopment of SEA bae on PID control [8, 9, 3]. Diturbance oberver (DOB) bae control metho have been alo aopte in [4 6] to enhance robutne. Wyeth propoe a cacae torque control metho with an inner velocity loop to overcome problem of non-linearitie []. In thi paper, the torque controller i eigne uing the 2- DOF metho to track torque reference, eliminate iturbance an noie. Horowitz reveale that the -DOF configuration i unable to cope with the two problem of achieving a eire tracking repone an attaining a goo iturbance/noie rejection at the ame time, but the 2-DOF controller coul achieve thee two goal imultaneouly [7]. The reaon i that the 2- DOF controller provie an inepenent way to eign tracking repone an optimize iturbance/noie rejection. Sytematic introuction an eign proceure about the 2-DOF control metho can be foun in [8, 9]. Thi paper i alo an extenive work of [20 22]. Thi paper i organize a follow. Section 2 ecribe the concept an moel of the velocity ource cable-riven SEA. Detail for the torque controller eign are given in Section 3. Simulation an reult are preente in Section 4. Section 5 conclue the paper. 2 The Cable-Driven SEA 2. The Moel of the Cable-Driven SEA The principle of a cable-riven SEA i hown in Fig.. A cable-pring erie tructure i introuce between the motor an the loa. The power ource of the actuator i upplie by a velocity controlle DC motor. Velocity Source DC Motor Gearbox Cable Spring T o Loa Fig. : The velocity ource cable-riven SEA. Neglecting the eflection of the cable, the velocity of the cable i given a ω m = ω g. () Where, g i the gearbox ratio an ω i the output velocity of the DC motor. Then, the iplacement of the cable i θ m = ω m. (2)

2 If the iplacement of the loa i θ l, the pring eflection θ can be erive a θ = θ m θ l. (3) The torque T o applie to the loa i ue to the eflection of the pring, uch that T o = θ. (4) If the inertia an amping of the pring are coniere, it become T o = (M 2 + C + )(θ m θ l ). (5) Let θ l = 0 an combine (), (2) an (5), there i T o () ω() = M 2 + C +. (6) g 2.2 Velocity Source DC Motor To eign a well performe SEA, a DC motor i ue a the velocity ource of the actuator. The reaon that thi iea i aopte i that velocity control i eaier an more traightforwar than current control. What more, velocity control can overcome ome uneirable effect caue by motor internal iturbance. The chematic iagram of a velocity ource DC motor i hown in Fig. 2. The velocity feeback regulate by a well tune PI controller form a table cloe loop o that the DC Motor ytem can track the reference ignal quickly an accurately. iv pv v a v b b La Ra f c i a t J Fig. 2: The iagram of the velocity ource DC motor. When the current i a flow through the motor coil, there i L a i a t + i ar a + v b = v a. (7) Where v a i the applie voltage acro the motor terminal, R a i the reitance of the motor wining, L a i the inuctance of the motor coil, an v b i the back emf voltage that i linearly proportional to the angular velocity ω of the motor, uch that v b = b ω. The equation of the haft rotating about a fixe axi i t i a f ω f c T l = Jα. (8) Where α i the angular acceleration uch that α = ω. The magnetic torque i linearly proportional ( t ) to the current i a flowing through the motor coil. The vicou friction torque i in the oppoite irection of the motion an i linearly proportional ( f ) to the angular velocity ω. f c i the Coulomb friction an T l i the loa torque. Subtitute (7) into (8) an convert it to frequency omain equation, ω() can be obtaine a ω() = v a () t (L a + R a )(f c () + T l ()) JL a 2 + (JR a + f L a ) + f R a + b t. (9) f T l 2.3 Deign of the Velocity Controller In orer to control the DC motor to be an effective velocity ource, a PI controller i eigne there. A hown in Fig. 2, the velocity controller ha the form of C v () = pv + iv. (0) The velocity controller i tune in the cae of no loa attache an neglecting the Coulomb friction, that i to ay, the loa torque T l an the Coulomb friction f c are et a zero. To create a ytem that will be of type, change (9) an (0) to the following form: G v () = ω() t v a () = JL a ( + p )( + p 2 ), () pv ) C v () = pv( + iv. (2) Where p 2 > p > 0 an both can be obtaine from (9) an (). Let iv = p, (3) pv then, the open loop tranfer function become H open = C v ()G v () = pv( + iv pv ) t JL a ( + p )( + p 2 ) = pv t JL a ( + p 2 ). (4) The cloe loop tranfer function will become a typical two orer ytem, an ha the form of ω 2 n H cloe = 2 + 2ξω n + ωn 2. (5) Accoring to (3), (4) an (5), there are pv = ω2 njl a t. (6) iv = p pv 2ξω n = p 2 Given the eire performance of the cloe loop ytem, the natural frequency ω n an amping ratio ξ can be etimate. Then, the controller parameter can be obtaine from (6). Further, the tranfer function from the eire velocity input ω () to the actuator output torque T o () can be obtaine by P () = T o() ω (). 3 Torque Controller Deign 3. Controller with Optimal Tranient In thi ubection, a poible way to eign the bet tabilizing controller an meaure the quality will be introuce.

3 Aume that P () i trictly proper an enote a the form of P () = b() a() = b n + + b n a 0 n + a n. (7) + + a n Where a() an b() are coprime an a 0 0. w y u P () C () u 2 y 2 w 2 Fig. 3: Feeback ytem for tabilization. Conier the ytem hown in Fig. 3, if the cloe loop ytem i internally table an the external input w i (t), i =, 2, are all impule ignal, all the internal ignal u j (t), y j (t), j =, 2, will eventually ettle to zero when time goe to infinity. So, the RMS value of y i (t) i =, 2, when w i (t), i =, 2, are unit impule can be ue to meaure the quality of the performance a follow: J =( y (t) y 2 (t) 2 2) w(t)=δ(t) w 2(t)=0 + ( y (t) y 2 (t) 2 2) w(t)=0. w 2(t)=δ(t) (8) For ifferent tabilizing controller, their RMS value J are ifferent. The minimum value of J enote by J when C() i choen among all tabilizing controller mean that the bet performance i achieve. The tranfer function from (w,w 2 ) to (y,y 2 ) i: P ()C() + P ()C() P () + P ()C() C() + P ()C() P ()C() + P ()C(). (9) The next problem to be olve i how to fin the mot optimal tabilizing controller. Firtly, there mut exit a table polynomial () calle pectral factor of a( )a() + b( )b() uch that: a( )a() + b( )b() = ( )(). Now let C() = q() be the unique n-th orer trictly p() proper pole placement controller uch that: a()p() + b()q() = 2 (). Then, thi controller C() i the mot optimal controller which minimize J an give J () a() = b() () () 2 2 () p() q() () () 2 2. (20) If w i, i =, 2, are external iturbance or noie, a tabilizing controller with optimal tranient can eliminate them in a hort time. 3.2 Stabilizing 2-DOF Controller A cloe loop ytem uing 2-DOF controller to tabilize the plant P () i hown in Fig. 4. The output z can track the reference input ignal r in a atifactory way, alo, the iturbance an the noie n can be eliminate cloe to zero in a hort time. r u v C( ) P( ) Fig. 4: The 2-DOF control configuration. The tabilizing 2-DOF controller bae on the controller with optimal tranient i hown in Fig. 5. Let C 0 () be a tabilizing controller with optimal tranient: C 0 () = q() p(). Let,, X(), Y () be: = a() b(), = () (), X() = p() q(), Y () = () (). y z n (2) Then,, X(), Y () are all table tranfer function atifying: r P () =, C 0() = Y () X(), X() + Y () =. Q () X () P () Q () 2 Y() u N () M () Fig. 5: Stabilizing 2-DOF control tructure. Denote the et of all the 2-DOF controller which give table cloe loop ytem by Ω(P ): [ Q () Y () + Q 2 () Ω(P ) = {C() = X() Q 2 () X() Q 2 () (22) y v z n ] }.

4 Where, Q (), Q 2 () are arbitrary table tranfer function. Every tabilizing 2-DOF controller ha the form hown in Fig. 5. For a fixe plant P (), if we plug a tabilizing 2-DOF controller of thi form to a cloe loop tranfer function, then the cloe loop tranfer function become a function of Q () an Q 2 (). The problem become chooing goo Q () an Q 2 () to meet the eign pecification, a long a they are table. The four tranfer function from r to the internal variable u, v, y, z epen only on Q (): C () C () P ()C () P ()C () = Q (). (23) The eight tranfer function from, n to u, v, y, z epen only on Q 2 (): P ()C 2 () C 2 () P () C 2 () P () P ()C 2 () Y () Y () X() Y () X() Y () X() X() Q 2() [ ] =. (24) Thi make chooing Q () an chooing Q 2 () ecouple an rather convenient. 3.3 Parameterization of Q () an Q 2 () Since the tranfer function from the reference input r to the output ignal z i Q (), let Q () = ω 2 n ( ξ ω n + ω 2 n). Then, the tranfer function from r to z become ω 2 n Q () = ξ ω n + ω n 2 Coniering that Q 2 () i mainly ue to filter the iturbance an noie n whoe inutrial frequencie are aume to be 50 Hz, let Q 2 () = 4 Simulation an Reult /(00π) +. The cable-riven SEA parameter are lite in Table. Table : Parameter of the cable-riven SEA. J kg m 2 L a 0.62mH R a 2.07Ω t Nm/A b V/ra f Nm/(ra/) 38Nm/ra g 56 : C 0.0Nm/(ra/) J l 0.kg m 2 M kg m 2 4. Simulation Reult of the Velocity Control The tranfer function from v a () to ω() i: v a () ω() =.27e e05. When the amping ratio ξ i choen to be 0.88, the coefficient of the proportional-integral controller are pv = 0.26, iv = The tep repone of velocity cloe loop ytem i hown in Fig. 6. The rie time of the velocity cloe loop ytem i within 0.002, almot no overhoot, can meet the requirement of a velocity ource. Fig. 6: Step repone of the velocity control 4.2 Simulation Reult of the Torque Control The tranfer function P () from ω () to T o () when the loa i fixe i: P () = e e e e08 The tabilizing 2-DOF controller can be obtaine by chooing ω n = an ξ = In the imulation, a PD

5 T u C( ) P( ) Fig. 7: Torque control tructure for the cable-riven SEA. controller C P D () = i ue for comparion. The torque control tructure for the cable-riven SEA i hown in Fig. 7. In the firt imulation, the iturbance an the noie n are et to zero. Then, the tep repone from T () to T o () of the two control metho are hown in Fig. 8. Both the two metho track the tep input quickly an accurately. Fig. 8: Tracking tep ignal without iturbance an noie In the econ imulation, the iturbance an the noie n are et a gauian white noie with zero mean. The input ignal T i et a a inuoial ignal with frequency of 5 Hz an amplitue of Nm. The tracking reult are hown in Fig. 9. It i clear that the tabilizing 2-DOF controller can enhance the ytem robutne. Fig. 9: Tracking inuoial ignal with iturbance an noie 5 Concluion Thi paper emontrate the efficacy of the 2-DOF control approach for the challenging torque control problem of y T o n a cable-riven SEA. The 2-DOF torque controller performe better compare with the PD metho in the preence of noie an iturbance in the imulation. The torque control performance can be conveniently ajute by chooing appropriate filter Q () an Q 2 (). Further reearch will be focue on the impeance control of the cable-riven SEA. Reference [] G. A. Pratt an M. M. Williamon. Serie elatic actuator. In Proceeing of the IEEE/RSJ International Conference on Intelligent Robot an Sytem, volume, page , 995. [2] D. W. Robinon, J. E. Pratt, D. J. Paluka, an G. Pratt. Serie elatic actuator evelopment for a biomimetic walking robot. In Proceeing of the IEEE/ASME International Conference on Avance Intelligent Mechatronic, page , 999. [3]. ong, J. Bae, an M. Tomizuka. A compact rotary erie elatic actuator for human aitive ytem. IEEE/ASME Tranaction on Mechatronic, 7(2): , 202. [4] H. Yu, S. Huang, N. V. Thakor, G. Chen, S. L. Toh, M. S. Cruz, Y. Ghorbel, an C. Zhu. A novel compact compliant actuator eign for rehabilitation robot. In Proceeing of the IEEE International Conference on Rehabilitation Robotic, page 6, 203. [5] D. Chapui, R. Gaert, G. Ganeh, E. Buret, an H. Bleuler. Invetigation of a cable tranmiion for the actuation of MR compatible haptic interface. In Proceeing of the Firt IEEE/RAS-EMBS International Conference on Biomeical Robotic an Biomechatronic, page , [6] R. J. Caverly, J. R. Forbe, an D. Mohammahahi. Dynamic moeling an paivity-bae control of a ingle egree of freeom cable-actuate ytem. IEEE Tranaction on Control Sytem Technology, 23(3): , 205. [7] J. F. Veneman, R. Ekkelenkamp, R. ruihof, F. C. V. D. Helm, an H. V. D. ooij. A erie elatic-an bowen-cable-bae actuation ytem for ue a torque actuator in exokeletontype robot. The International Journal of Robotic Reearch, 25(3):26 28, [8] J. Oblak, I. Cikajlo, an Z. Matja cić. Univeral haptic rive: A robot for arm an writ rehabilitation. IEEE Tranaction on Neural Sytem an Rehabilitation Engineering, 8(3): , 200. [9] F. Sergi an M.. O Malley. On the tability an accuracy of high tiffne renering in non-backrivable actuator through erie elaticity. Mechatronic, 26:64 75, 205. [0] D. W. Robinon. Deign an analyi of erie elaticity in cloe-loop actuator force control. Thei, Maachuett Intitute of Technology, [] G. Wyeth. Control iue for velocity ource erie elatic actuator. In Proceeing of the Autralaian Conference on Robotic an Automation, [2] H. Vallery, R. Ekkelenkamp, H. V. D. ooij, an M. Bu. Paive an accurate torque control of erie elatic actuator. In Proceeing of the IEEE/RSJ International Conference on Intelligent Robot an Sytem, page , [3] D. Accoto, G. Carpino, F. Sergi, N. L. Tagliamonte, L. Zollo, an E. Guglielmelli. Deign an characterization of a novel high-power erie elatic actuator for a lower limb robotic orthoi. International Journal of Avance Robotic Sytem, 0:359, 203. [4]. ong, J. Bae, an M. Tomizuka. Control of rotary erie

6 elatic actuator for ieal force-moe actuation in human-robot interaction application. IEEE/ASME Tranaction on Mechatronic, 4():05 8, [5] S. Yoo an W.. Chung. SEA force/torque ervo control with moel-bae robut motion control an link-ie motion feeback. In Proceeing of the IEEE International Conference on Robotic an Automation, page , 205. [6] J. Lu,. Haninger, W. Chen, an M. Tomizuka. Deign an torque-moe control of a cable-riven rotary erie elatic actuator for ubject-robot interaction. In Proceeing of the IEEE International Conference on Avance Intelligent Mechatronic, page 58 64, 205. [7] I. M. Horowitz. Synthei of feeback ytem. Acemic Pre, Lonon, 963. [8] L. Qiu an. Zhou. Introuction to feeback control. Pearon Prentice Hall, New Jerey, 200. [9] P. Huang. Theoretical an experimental tuie on two-egreeof-freeom controller. Thei, Hong ong Univerity of Science an Technology, 205. [20] W. Zou, W. Tan, Z. Yang, an N. Yu. Torque control of a cable-riven erie elatic actuator uing the 2-DOF metho. In Proceeing of the Chinenee Control Conference, page , 206. [2] W. Zou, Z. Yang, W. Tan, M. Wang, J. Liu, an N. Yu. Impeance control of a cable-riven erie elatic actuator with the 2-DOF control tructure. In Proceeing of the IEEE/RSJ International Conference on Intelligent Robot an Sytem, page , 206. [22] W. Zou, W. Tan, Z. Yang, an N. Yu. Augmente virtual tiffne renering of a cable-riven SEA for human-robot interaction. The IEEE/CAA Journal of Automatica Sinica, 207.