arxiv: v1 [cs.sy] 30 Oct 2016

Transcription

1 Impeance Control of Cable-Driven Serie Elatic ctuator with the -DOF Control Structure Wulin Zou, Zhuo Yang, Wen Tan, Meng Wang, Jingtai Liu, Ningbo Yu* arxiv:.9v [c.sy] Oct btract Serie elatic actuator (SE) are growingly important in phyical human-robot interaction (HRI) ue to their inherent afety an compliance. Cable-riven SE alo allow flexible intallation an remote torque tranmiion, etc. However, there are till challenge for the impeance control of cable-riven SE, uch a the reuce banwith caue by the elatic component, an the performance balance between reference tracking an robutne. In thi paper, a velocity ource cable-riven SE ha been et up. Then, a tabilizing egree of freeom (-DOF) control approach wa eigne to eparately purue the goal of robutne an torque tracking. Further, the impeance control tructure for humanrobot interaction wa eigne an implemente with a torque compenator. Both imulation an practical experiment have valiate the efficacy of the -DOF metho for the control of cable-riven SE. I. INTRODUCTION Phyical human-robot interaction ha become ignificantly more important in recent year an i now a major focu in robotic an control. Safety an compliance houl be coniere in it eign proce. SE, firt introuce in [], how a number of benefit, uch a great hock tolerance, accurate an table force control, afety an energy torage, etc. Thu, SE have been wiely employe in variou phyical human-robot interaction application to improve afety an compliance [] []. Cable with low weight to length ratio can change the force irection intentionally an eaily, enable torque tranmiion to a remote itance with le energy lo an pace occupation [], [], an allow etachment of the actuation motor from the robot frame [7]. Beie, cable actuation can be a afe olution in human-robot interaction ue to it uniirectional force contraint an property of breaking when the tenion exceeing a certain threhol. Thu, Many phyical human-robot interaction application have aopte cable actuation for force or torque tranmiion [7] [9]. cable-riven SE can combine the avantage of SE an cable actuation. Thi work ha been upporte by the National Natural Science Founation of China (), the Natural Science Founation of Tianjin (JCYBJC) an the Funamental Reearch Fun for the Central Univeritie. Correponing author oc. Prof. Dr. Ningbo Yu i with the Intitute of Robotic an utomatic Information Sytem, Nankai Univerity, an Tianjin Key Laboratory of Intelligent Robotic, Nankai Univerity, Haihe Eucation Park, Tianjin, China. Phone: + () 9 ext., nyu@nankai.eu.cn. Mr. Wulin Zou, Mr. Zhuo Yang, Mr. Wen Tan, Mr. Meng Wang an Prof. Dr. Jingtai Liu are with the Intitute of Robotic an utomatic Information Sytem, Nankai Univerity, an Tianjin Key Laboratory of Intelligent Robotic, Nankai Univerity, Haihe Eucation Park, Tianjin, China. SE are initially eigne to output a eire torque. Different torque control metho have been evelope to achieve high performance for ifferent SE. In [], Robinon introuce a PID control metho to explicitly illutrate the concept an performance of SE. Subequently, a lot of reearcher have mae important contribution to PID bae SE control [7] [9], [], []. In [], [], [], iturbance oberver (DOB)-bae control metho have alo been aopte to enhance robutne. Wyeth propoe a cacae torque control metho with an inner velocity loop to overcome nonlinearity problem []. Impeance control i a funamentally important trategy to regulate the ytem compliance, epecially for phyical human-robot interaction. The impeance value in one ene repreent the ynamic relationhip between the interaction force/torque an the motion. Different impeance value are neee for variou interaction tak with ifferent people. torque-impeance cacae control tructure ha been applie [9], [] an achieve goo performance. Horowitz reveale that the conventional -DOF control configuration wa unable to cope with the two problem of achieving a eire tracking an attaining goo robutne at the ame time, but the -DOF control tructure coul achieve thee two goal imultaneouly []. The reaon i that the -DOF control tructure provie an inepenent way to optimize iturbance/noie rejection an improve tracking repone. Theorie an practice about the -DOF control can be foun in [] []. Detaile imulation reult of torque control uing the -DOF control metho for a cable-riven SE have been preente in our previou work [9]. In thi paper, we eign the torque controller uing the -DOF control tructure to track torque reference ignal, eliminate iturbance an noie, an further, to improve banwith. The impeance control tructure for human-robot interaction i then eigne bae on the -DOF torque controller an implemente with a compenator. The paper i organize a follow. Section II ecribe the harware platform an moeling of the eigne cable-riven SE. Detail of the controller eign are given in Section III. Simulation, practical experiment an reult are preente in Section IV. Finally, Section V conclue the paper. II. THE CBLE-DRIVEN SERIES ELSTIC CTUTOR. Mechanical Structure cable-riven SE i illutrate in Fig.. It realize prototype i hown in Fig.. It i a -DOF platform for phyical human-robot interaction [].

2 Control of the actuator an ata acquiition of the enor are realize by a MTLB/Simulink Real-Time Target Sytem running on a tanar computer. ata acquiition boar (HUMUSOFT MF PCI-Expre multifunction I/O car) i inerte into the PCI-Expre x lot of the target computer to en the velocity comman a analog ignal to the motor ervo controller an receive the encoer reaing. The control algorithm i implemente with MTLB/Simulink, compile in the hot computer, ownloae to the target computer an run there in real-time. Fig.. The tructure of the cable-riven SE platform: () cable for tranmiion; () DC motor, incluing a reuction gear hea an a rotary encoer; () linear pring a the elatic component; () hanle for humanrobot interaction; () liing guie; () magnetic linear encoer to meaure the iplacement of the lier, incluing a reaing hea an a magnetic tape attache parallely to the liing guie; (7) cable winch; () pulley for cable tranmiion an reirection. B. Sytem Moeling The chematic iagram i hown in Fig.. The ynamic of the interaction ytem can be ecribe by the following two equation: τ τ L = J ϕ + b f ϕ () τ L = K (ϕ ϕ L ) () Where, the variable τ L, which equal to interaction torque τ, i the output torque acting on the loa. ϕ an ϕ L are the iplacement of the motor an loa. K i the equivalent tiffne of the two pring. J repreent the reflecte inertia of the motor. b f i the reflecte amping of the vicou friction of the ytem. ll parameter an variable are converte from tranlational to rotational motion with repect to the cable winch. DC Motor J Cable K Spring L Loa L Fig.. The prototype of the cable-riven SE platform: () ervo controller for the DC motor; () ata acquiition boar; () Simulink Real-Time target computer; () cope to iplay the ata in real-time; () hot computer. b f Fig.. Schematic iagram of the cable-riven SE ytem DC bruh rotary motor (Maxon RE W V) i ue a the velocity ource. The motor ha a MR- CPT incremental encoer mounte an a GP : planetary gear hea intalle on it output haft. The motor velocity i manage by a ervo controller (Econ / 9). Both ie of the hanle are connecte to the motor in a cablepring erie tructure. The hanle i mounte at a lier an can move along the guie by cable tranmiion or human arm motion. The two cable are reirecte by the pulley an wrappe aroun the winch. The two pring have an initial length of 7.7 mm, an can be extene to the maximal length of.7 mm. They are pretenione to half of their maximum iplacement range. There i alo a lier at each conjunction of the pring an the cable. The iplacement of the hanle an the eformation of the two pring are meaure by three magnetic linear encoer (MLS) mounte at each lier, with the preciion of µm. The length of the liing guie i cm, which i ufficient for the linear movement range of the upper limb. Here, we let ϕ L =, ubtitute () into (), then, τ L () can be obtaine a: τ L () = K J + b f + K τ () To eign a well performing SE, the DC motor i ue a the velocity ource of the actuator. The reaon i that velocity control can overcome ome uneirable effect caue by motor internal iturbance. The chematic iagram of a velocity ource cable-riven SE i hown in Fig.. 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 velocity ignal quickly an accurately. Fig.. K pv J b f Schematic iagram of a velocity ource cable-riven SE L K L

3 Then, the ynamic relationhip between ω () an τ L () can be written a: where: an P () = τ L () = P ()ω () + G()ϕ L (), K K pv + K K iv J + (b f + K pv ) + (K + K iv ) G() = J K + (K b f + K K pv ) + K K iv J. + (b f + K pv ) + (K + K iv ) III. CONTROLLER DESIGN. Parameterization of ll Stabilizing -DOF Controller cloe loop ytem uing the -DOF approach to tabilize the plant P () i hown in Fig. [7]. It ha two input r an y intea of one input in the -DOF control tructure. The controller C() can be enote a C() = [ C () C () ]. It can inepenently eal with the tracking an iturbance/noie rejection problem for any P () with P (). r Fig.. u v C () P () y z n The -DOF control configuration The four tranfer function from r to the internal variable u, v, y, z are: C () + P ()C () C () + P ()C () P ()C () () + P ()C () P ()C () + P ()C () The eight tranfer function from, n to u, v, y, z are: P ()C () C () + P ()C () + P ()C () + P ()C () P () + P ()C () P () + P ()C () C () + P ()C () + P ()C () P ()C () + P ()C () ccoring to (), the tranfer ynamic from (t), n(t) to u(t), v(t), y(t), z(t) are etermine by the controller C (). Once the controller C () ha been eigne, the tranfer ynamic from r(t) to u(t), v(t), y(t), z(t) will only epen on the controller C (). () () Let P () = b() a() = b n + + b n a n + a n, + + a n where a() an b() are coprime an a. Let C () = q() p() = q m + q m + + q m p m + p m + + p m, where p() an q() are coprime an p, be any tabilizing controller, i.e., c() = a()p() + b()q() i table. Factorize c() a c() = f()h() uch that eg f() = n an eg h() = m. Let M() = a() f(), N() = b() f() p() q(), X() =, Y () = h() h(). Then, M(), N(), X() an Y () are all table tranfer function atifying P () = N() M(), C () = Y (), M()X()+N()Y () =. X() Theorem.: The et of all -DOF controller that give table cloe-loop ytem i { [ ]} C() =, Q () X() N()Q () Y () + M()Q () X() N()Q () where Q () an Q () are two arbitrary table ytem []. If one tabilizing controller wa foun, then all other tabilizing controller coul be obtaine. Sytematic eign for tabilizing -DOF H -optimal controller i given a the following tep []: Step : Denote P () a the form P () = b() a() = b n + + b n a n + a n, + + a n where a() an b() are coprime an a. Step : Fin a table polynomial ρ () calle pectral factor uch that ρ a( )a() + b( )b() = ρ ( ) ρ (), where ρ i a poitive number ue to give a relative weight to u(t) an tracking error e(t). Step : Fin a table polynomial λ,k () uch that k a( )a() + λ b( )b() = λ,k ( ) λ,k (), where λ i a poitive number ue to give a relative weight to (t) an r(t) an k i a poitive number ue to give a relative weight to n(t) an r(t). Step : The feeback part of the optimal controller C () = q()/p() with the ame orer a the plant i the unique trictly proper an type poleplacement controller uch that a()p() + b()q() = ρ () λ,k () Step : The feeforwar part of the optimal controller i C () = ρ() λ,k () b() p().

4 If ρ <, the ytem will achieve better tracking performance with more energy, vice vera; If λ > k, the ytem will achieve better iturbance rejection, otherwie, it achieve better noie rejection. It make a traeoff between reference tracking, iturbance rejection an energy conumption minimization by ajuting the parameter ρ, λ an k to receive a eire performance. B. Torque Control with the -DOF Structure The tructure an it contruction proce for torque control with a -DOF controller an a feeforwar compenator are preente in Fig.. Firtly, a -DOF controller i eigne to track the torque reference when the loa i fixe a hown in Fig. (a). If the influence caue by humanrobot interaction i taken into conieration, that i to ay, ϕ L () i not equal to zero, then, τ L () can be obtaine a: where: G () = τ L () = G ()τ () + G ()ϕ L () () P ()C () + P ()C (), G G() () = + P ()C () Uner thee conition, the output torque τ L () can t track the eire torque τ () very well, becaue the ytem alway ha teay tate error caue by ϕ L (). However, thi error can be eliminate by a feeforwar compenator C L () preente in Fig. b. Let: Then, there i: L C L () = G () τ L () = G ()[τ () C L ()ϕ L ()] + G ()ϕ L () C C = G ()[τ () G ()ϕ L ()] + G ()ϕ L () = G ()τ () + [ G ()]G ()ϕ L () C Saturation K pv (a) J bf L K L (7) n L L, I C L C Saturation K pv J bf Fig. 7. Impeance control for the cable-riven SE. I i the eire virtual impeance, an ϕ L, i ytem reference poition. C. Impeance Control for Human-Robot Interaction Fig. 7 how the block chart of the cable-riven SE embee in an impeance control loop. The impeance controller regulate the relation between hanle motion ϕ L an reulting torque τ L. There, we only focu on virtual tiffne control, an ignore virtual inertia, virtual amping from virtual impeance. That i to ay, I i the eire virtual tiffne, which i proportional to K. For the applie hanle motion, it pecifie the value of eire torque τ. The torque controller implement that output torque τ L track the eire torque τ atifactorily. If τ L () τ (), then, τ L τ = I (ϕ L, ϕ L ). When the ytem reference point i et to zero, there i τ L τ = I ϕ L. IV. EXPERIMENTS ND RESULTS. Simulation an Reult The cable-riven SE parameter hown in Fig. are lite in Table I. J an b f are ientifie uing MTLB Sytem Ientification Toolbox. The velocity controller parameter K pv, K iv were tune a.7 Nm/(ra/) an. Nm/(ra/). TBLE I CBLE-DRIVEN SE PRMETERS Reflecte total inertia J.9 kg m Coefficient of vicou friction b f.9nm/(ra/) Stiffne of ouble pring K.Nm/ra K L C L C Saturation K pv J bf K L Raiu of cable winch r 7.mm Ratio of gear hea K g : (b) Fig.. Torque cacae control principle bae on the -DOF metho. C τ coniting of C an C enote the -DOF controller. Diturbance, noie n an motor aturation (threhol i ± ra/) are all taken into conieration. (a) The torque controller i eigne uner the conition of loa fixe (ϕ L () = ). (b) n aitional compenator C L () i eigne to minimize the effect caue by interaction force. If the torque controller C τ () i ieal (G () ), (7) i reuce a τ L () τ (). Therefore, exact torque control i achieve with a -DOF controller C τ () an a feeforwar compenator C L (). lo, the iturbance an noie n are rejecte by the -DOF controller C τ (). Subtituting thoe parameter into (), there i: P () = ccoring to the eign proceure in Section III-, the parameter ρ, λ, k etermining the -DOF controller were choen a., an. Then, the -DOF torque controller for the cable-riven SE i given a: C () = C () =

5 . Reference PI -DOF.. = [Nm] The imulation reult of impeance control preente in Fig. 7 were hown in Fig.. Sytem reference point ϕl, wa et to zero an the hanle motion caue by upper limb wa et a a inuoial ignal with a frequency of Hz. From the reult, the output torque τl tracke the eire torque τ atifactorily in ifferent virtual tiffnee changing from.k to.k I=.K,= I=.K, I=.K,= I=.K, I=.9K,= I=.9K, I=.K,= I=.K, (a)..! of PI Metho -! [ra/]! [ra/]! of -DOF Metho - -. (b) (c) Fig. 9. Experiment reult of tracking a inuoial ignal uing the two metho. (b) an (c) are the plot of ω of the two metho repectively Fig.. Simulation reult of impeance control for ifferent virtual impeance. Reference ignal DOF. -. Boe Diagram 7 9 theoretical experimental Frequency (ra/) Fig.. Experimental reult of tracking a chirp ignal uing the -DOF metho. The boe plot of the etimate cloe-loop tranfer function an the theoretically expecte frequency repone are alo illutrate. I=.K 'L [ra] 'L [ra] -. = I=.K - = I=.9K 'L [ra] 'L [ra] The realize prototype of the cable-riven SE in Fig. wa ue to further verify the performance of the -DOF torque controller an the impeance control. In the firt experiment, the loa wa fixe at the ytem reference poition. To compare the -DOF controller with a conventional one, a PI torque controller wa tune a Cτ () = +. The torque reference ignal wa et to a inuoial ignal with a magnitue of. Nm an a frequency of Hz, an an extra white Gauian noie with a variance of. wa ae into the torque feeback channel. hown in Fig. 9, both of the two control metho tracke the reference very well. However, the DOF controller reacte to noie more quickly an howe better noie rejection. In the econ experiment, the torque reference ignal wa et to a chirp ignal with frequencie ranging from to Hz an a magnitue of. Nm. The tracking reult of the -DOF metho wa illutrate in Fig.. The boe plot of theoretical cloe-loop tranfer function an experimental etimate were plotte in Fig.. banwith of 7 Hz with a phae lag of at thi cutoff frequency wa achieve. In the thir experiment, the hanle wa move along the guie by human in ifferent frequencie. The virtual tiffne change from.k to.k. The reult were hown in Fig.. pplying an intantaneou loa motion to tet the tability of the ytem, it reulte in ecaying ocillation of the lier a hown in Fig.. It can be een that with the eigne -DOF force controller, the impeance controller I=.K - B. Experiment an Reult Phae (eg) Mag (B) - = =. -. Fig.. Experimental reult of impeance control in ifferent virtual impeance.

6 'L [ra] - - Fig.. I = :K... n intantaneou loa motion reulting in ecaying ocillation. an the compenator, virtual tiffne ranging from. to. time of the phyical pring tiffne K can be realize. V. CONCLUSION Thi paper ha emontrate the efficacy of the -DOF control approach for the challenging torque control an impeance control problem of a cable-riven SE. The - DOF torque controller performe well in the preence of noie, iturbance, motor aturation an moeling uncertaintie. Experimental reult emontrate that the -DOF controller brought better robutne than the PI controller. It i convenient to ajut thee competing performance. Further, the impeance controller for human-robot interaction wa eigne an implemente with a torque compenator. Both imulation an experiment have valiate the efficacy of the -DOF control tructure for the cable-riven SE ytem. CKNOWLEDGMENTS The author woul like to thank Prof. Dr. Li Qiu an M. Dan Wang from the Hong Kong Univerity of Science an Technology for the helpful icuion, an Mr. Bin Li from Nankai Univerity for the mechanical eign of the prototype of the cable-riven SE. [7] J. F. Veneman, R. Ekkelenkamp, R. Kruihof, F. C. V. D. Helm, an H. V. D. Kooij, erie elatic-an bowen-cable-bae actuation ytem for ue a torque actuator in exokeleton-type robot, The International Journal of Robotic Reearch, vol., no., pp.,. [] J. Oblak an Z. Matja cić, Deign of a erie vico-elatic actuator for multi-purpoe rehabilitation haptic evice, Journal of neuroengineering an rehabilitation, vol., no., p.,. [9] F. Sergi an M. K. O Malley, On the tability an accuracy of high tiffne renering in non-backrivable actuator through erie elaticity, Mechatronic, vol., pp. 7,. [] D. W. Robinon, Deign an analyi of erie elaticity in cloeloop actuator force control, Thei, Maachuett Intitute of Technology,. [] H. Vallery, J. Veneman, E. V. elonk, R. Ekkelenkamp, M. Bu, an H. V. D. Kooij, Compliant actuation of rehabilitation robot, Robotic an utomation Magazine, vol., no., pp. 9,. [] G. Wyeth, Demontrating the afety an performance of a velocity ource erie elatic actuator, in Proceeing of the IEEE International Conference on Robotic an utomation (ICR),, pp. 7. [] S. Yoo an W. K. Chung, SE 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 utomation (ICR),, pp.. [] J. Lu, K. Haninger, W. Chen, an M. Tomizuka, Deign an torquemoe control of a cable-riven rotary erie elatic actuator for ubject-robot interaction, in Proceeing of the IEEE International Conference on vance Intelligent Mechatronic (IM),, pp.. [] I. M. Horowitz, Synthei of feeback ytem. Lonon: cemic Pre, 9. [] D. C. Youla an J. J. Bongiorno Jr, feeback theory of twoegree-of-freeom optimal wiener-hopf eign, IEEE Tranaction on utomatic Control, vol., no. 7, pp., 9. [7] L. Qiu an K. Zhou, Introuction to feeback control. New Jerey: Pearon Prentice Hall,. [] P. Huang, Theoretical an experimental tuie on two-egree-offreeom controller, Thei, Hong Kong Univerity of Science an Technology,. [9] W. Zou, W. Tan, Z. Yang, an N. Yu, Torque control of a cable-riven erie elatic actuator uing the -DOF metho, in Proceeing of the th Chinee Control Conference,, pp. 9. [] N. Yu, W. Tan, an J. Liu, Deign an analyi of a writ-han manipulator for rehabilitation of upper limb exterou function, in Proceeing of the IEEE International Conference on Robotic an Biomimetic (ROBIO),, pp REFERENCES [] G.. Pratt an M. M. Williamon, Serie elatic actuator, in Proceeing of the IEEE/RSJ International Conference on Intelligent Robot an Sytem, vol., 99, pp. 99. [] 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/SME International Conference on vance Intelligent Mechatronic, 999, pp.. [] K. Kong, J. Bae, an M. Tomizuka, compact rotary erie elatic actuator for human aitive ytem, IEEE/SME Tranaction on Mechatronic, vol. 7, no., pp. 97,. [] H. Yu, S. Huang, N. V. Thakor, G. Chen, S. L. Toh, M. S. Cruz, Y. Ghorbel, an C. Zhu, novel compact compliant actuator eign for rehabilitation robot, in Proceeing of the IEEE International Conference on Rehabilitation Robotic (ICORR),, pp.. [] 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/RS-EMBS International Conference on Biomeical Robotic an Biomechatronic,, pp.. [] R. J. Caverly, J. R. Forbe, an D. Mohammahahi, Dynamic moeling an paivity-bae control of a ingle egree of freeom cableactuate ytem, IEEE Tranaction on Control Sytem Technology, vol., no., pp. 9 99,.