An Analysis of the Operational Space Control of Robots

Transcription

1 EEE nternational Conference on Robotics an Automation Anchorage Convention District May 3-8,, Anchorage, Alaska, USA An Analysis of the Operational Space Control of Robots Ngoc Dung Vuong, Marcelo H Ang Jr, ao Ming Lim, Ser Yong Lim Abstract heoretically, the operational space control framework [] can be regare to be the most avance control framework for reunant robots. However, in practice, the control performance of this framework is significantly egrae in the presence of moel uncertainties an iscretizing effects. Using the singular perturbation theory, this paper shows that the same moel uncertainties can create ifferent effects on the task space an joint space control performance. From the analysis, a multi-rate operational space control was propose to minimize the effects of moel uncertainties on the control performance an while maintaining the avantages of the original operational space framework []. n this paper, we present a stability analysis of the multi-rate operational space control framework using the Lyapunov s irect metho.. NRODUCON enerally, most operational space (or task space) control Gapproaches relate to irectly closing the control loop in the operational space. ask space commans from the operational space controller are then translate into joint space commans through kinematic transformations. Operational space control approaches can be ivie into three groups base on the way they hanle the reunancy [3]. he first group resolves the reunancy at the velocity level [4-5] while the secon [6-7] an the thir groups [] are base on the acceleration. he main ifference between the secon an the thir group is whether the task-space an null-space are kinematically (secon) or ynamically (thir) ecouple. Because of the ynamically ecoupling property, the thir approach sometime has been referre as the force-base operational space control [3]. heoretically, the force-base operational space control is one of the most avance control framework for reunant robots. One main reason is because it uses the system s inertial matri to weight the pseuo-inverse solution. hus, the solution provie by this framework is an optimal solution since the instantaneous kinetic energy is minimize along the path [8]. n other wors, the force-base operational space framework provies a natural choice to ecouple the task-space ynamics from its internal (or nullspace) ynamics. n orer to aress the nonlinear effects ue to the link inertia, the gravity an so on in task space, Khatib introuce the concept of task-space ynamics []. Manuscript receive Sep 5, 9. his work was supporte by the CRP project between the National University of Singapore an SMech (Singapore nstitute of Manufacturing echnology). Ngoc Dung, Vuong an Marcelo Ang. H, Jr are with the National University of Singapore, 9 Engineering Drive, Singapore 7576 ( <nvuong, mpeangh>@ nus.eu.sg). ao Ming, Lim an Ser Yong, Lim is with SMech, 7 Nanyang Drive, Singapore, ( <tmlim, sylim>@simtech.a-star.eu.sg) He also suggeste a moel-base PD controller to achieve asymptotical performance. t is worth noting that this asymptotical performance is only vali when the robot moel is accurately known an the controller is continuously implemente. However, the assumption of perfect knowlege is always violate in practice, an therefore the control performance can be significantly egrae ue to the imperfect moel as has been eperimentally shown in [-3]. n orer to overcome this uncertainty issue, a number of approaches such as robust control approaches, aaptive control approaches an so on, have been propose in the literature. his paper looks at the moel uncertainty issue from a ifferent aspect: a multi-rate operational space control []. his approach has also been referre to as the inner-outer loop approach in the literature although the initial motivation is ifferent. One of the main initial motivations for the innerouter loop approach comes from the fact that most of the inustrial robot come with a motion controller at each joint [9]. As a result, the task-space commans can only be realize by creating an outer loop in the operational space. On the other han, the motivation in our case is the inaeuate performance when we implemente the conventional operational space controller [] on our eperimental platform, the Mitsubishi 7-egree-of-freeom (DOF) (from now on, the force-base operational space control introuce by Khaib [] will be referre to as the conventional operational space control). One eplanation for this poor performance is the inaccuracy of the task space inertial matri [3]. t is also worth noting that the subject of moel uncertainties in control has receive a consierable attention from the research community. For eample, Qu [] prove that the continuous PD compute-torue is robust with respect to the unknown ynamics. Moreover, the stability of the error system can be mae asymptotically stable with a finite-high control gains if the static balancing torue is known. n practice, however, the control gains have been shown to have upper limits ue to the presence of moel uncertainties an iscretizing effects []. So far, it is not known whether these upper limits of the control gains can have any averse effects on the control performance. By analyzing the closeloop systems of two control schemes (the igital PD joint space compute-torue control an the igital PD task space compute torue control), we provie a etaile eplanation why the theoretical more avance force-base operational space control cannot perform well in the presence of moel uncertainties. Base on the above analysis, a multi-rate control structure //$6. EEE 463

2 which was propose in [] is reviewe in the net section. Note that this control structure is not new in the sense that it has been mentione in some previous works such as [9, - 3]. he contribution here is that the feeback linearization concept has been shifte from the operational space [] into joint space in orer to minimize the effects (if possible) of the moel uncertainties. Details of the multi-rate control structure are given in section -3. t is also important to point out that in most of the previous works, the robot moel is either perfectly known [] or ignore [9, 3]. As a result, the performance of the inner-loop can be egrae if the nonlinear effects of the robot moel are significant. he main contributions of this paper are as follows: - An eplicit eplanation on how the moel uncertainties affect the control performance of the force-base operational space control. - An analysis on the stability of the multi-rate operational space control framework uner the presence of moel uncertainties. - he multi-rate operational space controller an its stability are verifie eperimentally. he rest of the paper is presente as follows: firstly, the iscrete high-gain compute-torue controls are analyze by the singular perturbation theory. Net, the multi-rate operational space control is reviewe an finally, the stability of the propose controller is given using Lyapunov s irect metho.. COMPUED-ORQUE CONROL FOR JON SPACE AND ASK SPACE: AN ANALYSS A. High-gain compute-torue control he following iscussion is motivate from []. Consier a simple rigi ynamic moel of an n-dof robot (without gravity an joint friction) in joint space an task space: A ( ) C (, ) () ( ) (, ) F () where an are the generalize coorinate, an F are the generalize force in joint space an task space accoringly. For simplicity, let us only consier nonreunant robots at singular-free configuration in this section. he relationship between the joint space ynamics an task space ynamics can be state as follows []: J AJ (3) J C J (4) J F (5) Consier the two set-point PD compute-torue controllers in joint space an task space as follows: Au C A kv k p C (6) F u kv kp (7) where an are the esire set point, kv,, k p, are the control gains an AC,, an are the estimate/ientifie ynamic moel of the robot. he close-loop euations in joint space an task space become: A As A C, s (8-9) where: kp kp kv,, kv, kv kv (-) s, s After introucing a fast time scale t /, the joint space an task space close-loop system become: t t (-3), s s A As s A C At high-gain i.e.,, (-3) reuces to the fast reuce subsystem by the singular perturbation theory [4]: s s A As s an s s (4) Note that the inertia matrices A, are always positive efinite, thus if the estimate/ientifie inertia matrices A, is also positive efinite (please refer to [5] for etaile iscussion on how to obtain an positive efinite inertia matri), the eigenvalues of, will be all positive [6]. As a result, s an s ten to eponentially as iscusse in []. As is seen from above analysis, as long as the control gains can be increase, the effects of the moel uncertainties (- 3): D A C (5) D on the close-loop response can be mae arbitrary small an the behavior of the close-loop systems (8-9) can be efine by ajusting an. Practically, because the control laws (6-7) are usually implemente using igital computers, thus, the control gains will have upper limits as iscusse in [] an section V of [7]. his observation raises a uestion on how these gain s limits restrict the response of the close-loop systems (8-9) in practice. B. Discrete high-gain compute torue control Before iscussing the effects of the iscrete high-gain compute-torue control in joint space an task space, let us summarize the uestion in han again: (i) Assume that we have an ientifie ynamic moel of the robot in joint space ( A, C ). he euivalent task space ynamics can be obtaine using (3-4). (ii) Let the task in joint space an task space be eactly the same i.e. FKN( ), where F KN is the forwar kinematics of the robot. n aition, let us assume that the kinematics moel is accurately known. (iii) Let the control laws (6-7) be igitally implemente with the same sampling perio, an assume that the control gains are chosen high enough so that the close-loop systems can be approimate by (4). he uestion we are intereste in here is how the responses 464

3 of the close-loop systems (-3) will be. Let us first consier the following Lemma: Lemma : Uner the above assumptions (i, ii, iii), the upper limits of the control gains of the joint space an task space controller (6-7) are the same. Proof: note that (4) can be rewritten as follows: s A As t (6) A Au s s t (7) u he iscrete forms of the above euations, uner the assumption that the computation time of the control law is negligible, are: e e k [ ] k [ ] (8) k [ ] [ ] k e e Qk [ ] Qk [ ] an e e k [ ] k [ ] k [ ] [ ] k (9) e e Xk [ ] Xk [ ] where is the sampling perio. Substitute (3-5) into leas to: JA AJ J J () hus, can be rewritten as: e e J J e e J J J J J J () Note that by similar matri property, an have the same set of eigenvalues [6]. Because the stability of (8) an (9) can only be guarantee if an only if the eigenvalues of an are insie the unit circle [8] (this is where the upper limits of the control gains occur), () implies that the upper limits of the control gains for both systems are the same. From Lemma, it is clear that the responses of the closeloop systems (-3) will now epen on how significant the isturbances (5) are. he reason is because, cannot be arbitrarily reuce to zero to eliminate the effects of the moel uncertainties, as in the continuous case. o see the effects of moel uncertainties on the close-loop systems (-3), let us further epan the isturbance terms (5): D A C () D J( A C ) JA AJ J (3) As is seen, the joint space close-loop system () is isturbe by () an the responses can be transforme to the operational space using the kinematics relationship between the joint space an task space. However, if the control is one in task space, the close-loop system (3) has to cope with the isturbance (3) which is the result of the joint-space isturbance () multiplie by the Jacobian. Moreover, the uncertainties of the inertial matri also appear as an etra term in the isturbance euation (3). As a result, if the kinematics moel of the robot happens to magnify the moeling errors, the control performance of the task space controller (7) can be much worse than the one in joint space (6). he main reason is because the control gains cannot be further increase to compensate for the moel uncertainties. o verify the above observation, let us consier the simulation of a -DOF robot as shown in Figure : m( kg) y ylsin( ), J lcos( ).( m) A 7.68, zz A66.7 l ( m) C, C.( s) /6y Figure : One-DOF arm For simplicity, let us choose the control gains kp, k v as (Hurwitz polynomial): k v w, kp w (4) he control laws for joint space an task space are (6) an (7) accoringly. Base on the above iscussion, the upper limit of the control gains is w for both joint space an task space. Figure (a) shows the response of the joint space controller (6) for some w (the responses in task space are similar as the previously prove). his simulation was one using SimMechanics oolbo uner MatLAB/Simulink environment. Clearly that when w is near to the theoretical unstable value (), chattering occurre. n orer to evaluate the control performances, the ifference between the task space responses y e y y is plotte in Figure (b). Here, y lsin( ) is the response of the controller (6) an y lsin( ) is the response of the controller (7). As is seen, the ifference y e tens to be negative which implies that the overshoot of y is less. n other wors, uner the same control gains (the maimum gains that the iscrete high-gain system can take), the PD joint space controller (6) provies a better response in comparison to the task space controller (7). (a) (b) Figure : System responses with various gains 465

4 n conclusion, the analysis on this section inicates that for an inaccurate ientifie robot moel, it is better to use this ynamic moel in joint space rather than task space unless one can guarantee that the isturbance in () is much larger than the one in (3).. MUL-RAE OPERAONAL SPACE CONROL As iscusse in the previous section, if the joint space isturbance () is smaller than the task space isturbance (3), the compute-torue control shoul be one in the joint space to minimize the effects of moel uncertainties on the control performance. A natural uestion shoul be raise is how to get the joint space commans from tasks which are specifie in the operational space. As point out in [9], the inverse kinematics approach has several isavantages such as it ignores the robot ynamics an the compleity is significantly increase for reunant robots. On the other han, the operational space control framework [] is suppose to take care of the robot ynamics an ynamically ecouple the null space from the task space. o maintain the avantages of the operational space framework an still minimize the moel uncertainties on the control performance, the following multi-rate operational space control has been propose []: - Outer loop: the operational space comman force is compute as in [] using the ientifie ynamics moel as a reference []. his task space comman is then applie to the joint space ientifie moel to get the joint acceleration comman: J u J JJ A null (5) u KV KP (6) where KV, KP is the control gains in task space, an: J A J JA J (7) t is worth noting that (7) is actually a inertia-weighte pseuo-inverse at the acceleration level [8]. hus, euation (7) will give a joint space response with respect to a task space comman {,, } through the ientifie ynamic moel Â. n other wors, the purpose of the outer loop is to transform the task space comman to the joint space comman using the ientifie ynamic moel. he output of this outer loop is then realize by the P compute-torue control at the inner loop as below. - nner loop: a P compute torue controller is use to control the joint velocity of the robots. he use of the ynamics moel here will enhance the performance as in [5]. he input of this controller is the reference joint velocities. he controller can be state as: Au C g Fric (8) u K( ) K( ) t (9) where K, K are the control gains in joint space. he esire joint velocity can be obtaine by integrating the esire joint acceleration (5): tt t ( t) t ( ) t (3) with the initial conition as the current {,}. Clearly, if the inner velocity control loop is able to bring the manipulator from the current state { t ( ), t ( )} to { t ( t), t ( t)} after t (sec), the behavior of the robot will be eactly etermine by the ientifie ynamic moel as epicte in Figure 3. Because the assumption that the inner velocity control loop can change the system states in t (sec) is usually violate in practice, an outer loop, which is the force-base operational space control, is always necessary to ensure the task space performance. he efficiency of the propose multi-rate operational space control has been eperimentally verifie on the Mitsubishi 7-DOF PA manipulator as escribe in the following section. A. Eperiment testbe he propose controller has been implemente on the Mitsubishi 7-DOF PA manipulator. n orer to achieve real-time torue control capability (which is necessary for the inner-loop controller), the original controller of the PA has been replace by our custom controllers. QNX Neutrino Real-time Operate System (6.3) has been use to implement the above multi-rate control laws as epicte in Figure 3. Note that because the robot is reunant, the following simple null-space controller is use throughout this paper: null KnD V (3) V ( rest ) KnP ( rest ) (3) where rest is some preferre joint configuration. X, X, X, F Operational space control KHz X esire F C F J, sensor Figure 3: he propose controller: (ot frame): outer loop, (ot-ash frame): inner loop B. Eperiment results n orer to evaluate the control performance, the eneffector of the manipulator was commane to move. meter in the y-irection of the base frame in secons from the same initial configuration (Figure 4a) using two ifferent controllers: (): the conventional operational space control introuce by Khatib [] an (): the propose multi-rate operational space control. Both controllers has been tune the first sign of instability appears i.e. chattering occurs at any control variables. t C O Computetorue Forwar ynamics Robot esire Null- Space control Forwar kinematics 5KHz control 466

5 z y (a) ( cm) () () (b) (c) () Figure 4: (a) Eperiment setup. (b) racking error in -irection. (c) racking error in y-irection. () racking error in z-irection. As is seen in Figure 4, the tracking performance of the conventional operational space control () is poorer than the one using the propose controller (). One eplanation as iscusse in section is because the moeling errors, such as inertial parameters an joint frictions, are magnifie through the Jacobian as in (3). V. SABLY ANALYSS OF HE MUL-RAE OS CONROL he iscussion from section an the eperimental results from the previous section is consistent in justifying the usefulness of the propose multi-rate operational space controller over the conventional one. However, it is still necessary to investigate the stability of the propose controller, at least for the continuous case. t is important to stress that the stability analysis in this section only serves as a necessary conition for the usefulness of the propose controller because we o not account for iscretizing effects, signal noise an so on. f the control law is igitally implemente, the performance of the close-loop system will now epen on how high the control gains can take as iscusse in section. Note that only a sketch of proof is given here ue to the limite space. A. Problem statements Consier the rigi ynamic moel of an n-dof robot as follows: A ( ) C (, ) g ( ) Fric D (33) where { AC,, g, D } are inertial matri, Coriolis- Centrifugal, gravity, friction torue an unknown isturbance in joint space. By applying the control law (5-9), the close-loop control becomes: KV KP Jw w A AKw A AKz A A A H (34) z w () () () () KP KV JA AK JA AK t w A AKA CA AA K A AK w A C z z JA A JA H A CA Aw A Cz A A A H (35) X X B (36) where:,, w, w (37) H C g D C g Fric Here, we are intereste in the stability property of the euilibrium w z of the e nonlinear system (34). Note that there are etra terms ( A C A A A K ) in the matri, an they have been cancele out later in vector B. he purpose of these terms is to simplify the analysis for the nominal system as shown in the net section. o analyze the stability of (34), we aopt the methoology propose by Khalil [], that is: - Firstly, the asymptotic stability property of the nominal system X X is stuie. - Net, the solution of the overall system (34) is shown to be uniformly ultimately boune. B. Stability of the nominal system Consier the following Lyapunov function caniate inspire by []: V X PX (38) where: Kv P A A A K A Fric (39) is positive efinite when kv, k,. he erivative of V is (after making use of the skew-symmetric property of the inertial matri X A CC X ): K JA AK JA AK K K JA AK JA AK V w z P P V AK K AK w AK AK z X QX (4) After some manipulation, it can be shown that Q when: kp, kv ( / 4) kp, (4) ( / )( kp kv kp ( kp kv ) ) ( ) k kh / ( ( ) ( ( ) ) 4 ) where min ( A) is the smallest eigenvalues of Â. Assume that the inuce norm of the Jacobian is boune by J kj then k H kjma ( A ) ma ( A). As is seen, if the control gain k is fie (i.e. after the inner-loop control is 467

6 tune), (4) can always be satisfie by increasing the task space gains { kp, kv }. As a result, the nominal system X X is eponentially stable because: V X QX ( Q) X, ( Q) (4) ma C. Stability of the overall system Because the isturbance B is a function of joint position an acceleration, using the similar approach as in [], it can be shown that: B X 3 X (43) where,, 3 are the system parameters. Using the same Lyapunov function (38), V now becomes: V X QX X B X ( ( ma( Q)) X 3 X ) (44) hus, by applying Lemma 3.5 in [], the overall system is uniformly ultimately boune. Note that the purpose of this stability analysis is only to show that the propose control law can be stabilize by a proper choice of control gains. However, in practice, the size of the uniform/uniform ultimate boun cannot be mae arbitrarily small because of the upper limits on the control gains. his propose controller performe better than the conventional operational space control because the moel uncertainties has been shifte from task space to joint space as the iscussion in section -3. ntensive eperiments ha been one in orer to valiate the performance of the propose controller []. V. CONCLUSON n this paper, we ha eplicitly shown that the control performance of the conventional operational space control can be significant egrae ue to moel uncertainties an iscretizing effects. As a result, the compute torue techniue shoul be one in joint space to avoi magnifying the moeling errors through the robot kinematics. n orer to maintain the avantages of the force-base operational space control, a multi-rate operational space controller was propose. Eperimental results showe significant improvements in comparison to the conventional one. Stability analysis ha been carrie out to show that the propose controller is stable in the continuous omain. Since the joint space control of the propose controller is a simple P controller, further improvements on the inner loop control can be one in orer to enhance the overall performance of the system. ACKNOWLEDGMEN he authors woul like to thank Prof. Frank Lewis (UA) for all the invaluable iscussions. REFERENCES. Khatib, O., A unifie approach for motion an force control of robot manipulators: he Operational Space Formulation. EEE Journal of Robotics an Automation, 987. RA-3(): p Ngoc Dung, V., et al., Multi-rate perational space control of compliant motion in robotic manipulators, in 9 ma EEE SMC 9. 9, San Antonio, eas, US. 3. Nakanishi, J., et al., Operational space control: A theoretical an empirical comparison. nternational Journal of Robotics Research, 8. 7(6): p Whitney, D.E., Resolve motion rate control of manipulators an human prostheses. EEE ransactions on Man-Machine Systems, 969. mms-(): p Nakamura, Y. an H. Hanafusa, Optimal Reunancy Control of Robot Manipulators. he nternational Journal of Robotics Research, (): p Hollerbach, J. an S. Ki, Reunancy resolution of manipulators through torue optimization. EEE Journal of Robotics an Automation, (4): p Hsu, P., J. Hauser, an S. Sastry. Dynamic control of reunant manipulators, American Automatic Control Council, 988. Green Valley, AZ, USA. 8. Featherstone, B. an O. Khatib, Loa inepenence of the ynamically consistent inverse of the Jacobian matri. JRR, (): p Freun, E. an J. Pesara, High-banwith force an impeance control for inustrial robots. Robotica, : p Zhihua, Q., et al., Robust control of robots by the compute torue law. Systems & Control Letters, 99. 6(): p Shang-eh, W., Digital high-gain PD control of robot manipulators. J. of Robotic Systems, 997. p Kelly, R. an J. Moreno, Manipulator motion control in operational space using joint velocity inner loops. Automatica, 5. 4(8): p Garrio, R., E. Canul, an A. Soria. ask space robot control using an inner PD loop. EEE nternational Conference on Robotics an Automation (CRA), -7 May 9, Piscataway, NJ, USA: EEE. 4. Kokotovic, P.V., H.K. Khalil, an J. O'Reilly, Singular perturbation methos in control: Analysis an Design. Classics in applie mathematics, 999, Philaelphia. 5. Ngoc Dung, V. an J. Marcelo H. Ang, Dynamic Moel entification For nustrial Manipulator Subject o Avance Moel Base Control, 4 th nternational Conference HNCCEM. 8: Manila, Philippines. 6. Horn, R.A. an C.R. Johnson, opics in matri analysis. New York: Cambrige University Press. viii, 67p. 7. Yabuta,., Nonlinear basic stability concept of the hybri position/force control scheme for robot manipulators. EEE ransactions on Robotics an Automation, 99. 8(5): p Franklin, G.F., J.D. Powell, an M.L. Workman, Digital control of ynamic systems. 3r, Aison-Wesley, 74p. 9. Bruyninck, H. an O. Khatib. Gauss' principle an the ynamics of reunant an constraine manipulators, Robotics an Automation,. Proceeings.. Khalil, H.K., Nonlinear systems. 3r, Upper Sale River, N.J. Prentice Hall, 75p.. Camarillo, K., et al., Stability analysis of the operational space control for inustrial robots using their own joint velocity P controllers. Robotica, 8. 6(6): p Qu, Z. an D.M. Dawson, Robust tracking control of robot manipulators. New York: EEE Press, 33p. 468