Jtam-A4.dvi JOURNAL OF THEORETICAL AND APPLIED MECHANICS 52, 3, pp. 793-801, Warsaw 2014 A CASE STUDY OF INVERSE DYNAMICS CONTROL OF MANIPULATORS WITH PASSIVE JOINTS Wojciech Blajer, Krzysztof Kołodziejczyk University of Technology and Humanities in Radom, Faculty of Mechanical Engineering, Radom, Poland e-mail: w.blajer@uthrad.pl; k.kolodziejczyk@uthrad.pl Manipulators with both active and passive joints are examples of underactuated systems, featured by less control inputs than degrees of freedom. Due to the underactuation, in the trajectory tracking (servo-constraint) problem, the feed-forward control obtained from an inverse model is influenced by internal dynamics of the system, leading to a more involved control design than in the fully actuated case. It is demonstrated that a convenient ap- proach to the problem solution is to formulate the underactuated system dynamics in the input-output normal form, with the arising governing equations formulated either as ODEs (ordinary differential equations) or DAEs (differential-algebraic equations). The interrela- tionship between the inverse dynamics control and the associated internal dynamics is then studied and illustrated using a planar manipulator with two active and one passive joint. Some simulation results for the sample case study are reported. Keywords: inverse dynamics, underactuatedmanipulators, passive joints, servo-constraints 1. Introduction Most typically,manipulators aredesignedandmodeled as fullyactuated, inwhich thenumber m of control inputs equals the number f of degrees of freedom, m= f. Given a (fully) prescribed motion of the system, the inverse dynamics simulation allows for determination of the desired control, which, combinedwith feedback linearization, is used in the computed torque controllers (Paul, 1981).The situation isdifferent formanipulatorswith elastic/passive joints and/orflexible members (Spong, 1987; De Luca and Oriolo, 2002; Benosman and Le Vey, 2004), where the relatedunactuateddegrees of freedomresult inunderactuationof the system, m 0. Intuitively, one can expect a positive (counterclockwise) sense of τ required to initiate the upward motion of the point E. Thismay not be the case, however.More strictly, the effect of τ on link 2 is an upward reaction R in the joint A (Fig. 4b), whichmoved to the linkmass center C2 is associated with a couple with a clockwise torque T =Rs2. Assumed link 2 is homogeneous, i.e. s2 = l2/2 and JC2 =m2l 2 2/12, the acceleration of the point E is then ÿE = R m2 − Rs2 JC2 (l2−s2)= R m2 − Rl2 2 12 m2l 2 2 l2 2 =− 2R m2 (4.4) The action of a “positive” τ has thus the opposite effect from what is expected – a “negati- ve” ¨̃yE is produced. A “positive” ¨̃yE will thus require a “negative” τ. This “reverse” control is certainly wrong, and, when continued, will soon lead to collapse of the servo-constraint problem execution. As shown by Seifried (2012a), the inverse simulation control inappropriateness can be overcome by modifying (optimizing) the system parameters, resulting specifically in redu- cing s2 and enlarging JC2 so that the same senses in the input-output relationship are achieved. Another possibility is reformulation of the desired output ỹ(t), applied in the following for the present case study. Fig. 4. A rotational armwith one active and one passive joint: (a) the model; (b) illustration of the action of control torque τ on link 2 The described inappropriateness in the output-input inverse model, which relates also the present case study, can be overcome by assigning the outputs to the coordinates of the inner point P instead of the end point E (Fig. 3a), y = [xP ,yP ] T, and a reasonable choice used in the forthcoming simulations is P →C3 (sP = l3/2). The output relationships of Eq. (2.2) are then defined by y= [ xP yP ] = [ l1cosθ1+ l2cosθ2+sP cosθ3 l1 sinθ1+ l2 sinθ2+sP sinθ3 ] H= [ −l1 sinθ1 −l2 sinθ2 −sP sinθ3 l1cosθ1 l2cosθ2 sP cosθ3 ] h= [ −l1θ̇ 2 1 cosθ1− l2θ̇ 2 2 cosθ2−sP θ̇ 2 3 cosθ3 −l1θ̇ 2 1 sinθ1− l2θ̇ 2 2 sinθ2−sP θ̇ 2 3 sinθ3 ] (4.5) A case study of inverse dynamics control of manipulators... 799 The reference trajectories ỹ(t) = [x̃P , ỹP ] T → ˙̃y(t) = [˙̃xP , ˙̃yP ] T → ¨̃y(t) = [¨̃xP , ¨̃yP ] T have been determined from the manipulator inverse kinematics for θ3 = θ2, illustrated in Fig. 5 together with the end point E trajectories. The assumedmaneuver duration was T =5s. Fig. 5. The reference trajectories for points P (black lines) and E (grey lines) The results of inverse dynamics simulation for the manipulator arm tracking the specified motion of the point P are illustrated in Fig. 6. In addition to the abovementioned manipulator geometrical parameters and the task specifications, the inertial parameters used in calculations were: m1 = 8kg, m2 = m3 = 6kg, m4 = 10kg, JC1 = 0.45kgm 2, JC2 = JC3 = 0.2kgm 2, and the stiffness and damping coefficients were c = 10Mm/rad and d = 2Mms/rad. The integration time step was ∆t = 0.001s. As seen from the graphs, the internal dynamics is bounded (stabilized), and, due to the assumed damping in the passive joint, the manipulator quickly achieves the final rest position for t > T = 5s. Since the specification of the point P →C3, ỹ(t) = [x̃P(t), ỹP(t)] T, the motion of the end point E is affected also by the internal motion evolution. The resulted trajectory and velocity components of the point E are shown in Fig. 7 (black lines), compared to those obtained for θ3 = θ2 (grey lines). Fig. 6. Simulation of the manipulator motion and control in the prescribedmotion 800 W. Blajer, K. Kołodziejczyk Fig. 7. Motion of the end point E 5. Summary and conclusions Manipulatorswithpassive joints, studied in this paper, fall into the category of non-flat underac- tuated systems. A non-ideal orthogonal realization of servo-constraints imposed on the systems is observed, denoting that the inputs can directly regulate the motion specifications. However, besides the output-input inverse dynamics model, exemplified in Eqs. (3.3)1, (3.4) and (3.5)3, an additional internal dynamics arises. The servo-constraint problem becomes thus a dynamical model, with the internal dynamics which may be bounded (stable) or unbounded (unstable). Meaningful solutions to the servo-constraint problem require therefore a careful analysis related both to the design of the underactuatedmanipulator and to the imposedmotion specifications. For the case study analyzed in the paper, choosing the end-effector position coordinates as outputs, and then specifying them in time to formulate servo-constraints on the system, is not a good practice.While the orthogonal realization of the servo-constraints is maintained and the inverse dynamics control can explicitly be determined, the assisted internal dynamics (affec- ted by the required control) is unbounded, and the solution leads to collapse. It was shown by Seifried (2012a) that the situation can be improved by modifying/optimizing the design para- meters of the underactuated system, usually the geometric dimensions and mass distribution. The other possibility, motivated in this contribution, is to choose some appropriate outputs. Regulating some inner point position, instead of the end-effector position, is recommended. The servo-constraint problemexecution becomes then stablewithout anymodification to the original system design. The sacrifice is that, whereas the exact tracking of the inner point (specified) trajectory is assured, the end-effector motion is also affected by the internal dynamics. The end-effector trajectory tracking is then realized with a limited accuracy. The situation can be improved by enlarging (or additionally adding) the damping in the system, and, evidently, for large stiffness in the passive joint the solution becomes similar to that obtained for a “rigid” manipulator (with the passive joint jammed). Finally, itmay beworth noting that the stabiliza- tion of the servo-constraint problem execution with limited accuracy was also discussed in e.g. Seifried (2011,b) and Kovács and Bencsik (2012), where a linearly combined output instead of the end-effector position was used as the reference trajectory, which is somewhat equivalent to the regulating of the inner point position used in the present paper. References 1. Ascher U.M., Petzold L.R., 1998,Computer Methods for Ordinary Differential Equations and Differential–Algebraic Equations, SIAM, Philadelphia 2. Bajodah A.H., Hodges D.H., Chen Y.-H., 2005, Inverse dynamics of servo-constraints based on the generalized inverse,Nonlinear Dynamics, 39, 1/2, 179-196 A case study of inverse dynamics control of manipulators... 801 3. Benosman M., Le Vey G., 2004, Control of flexible manipulators: a survey, Robotica, 22, 5, 533-545 4. Blajer W., KołodziejczykK., 2007,Control of underactuatedmechanical systemswith servo- constraints,Nonlinear Dynamics, 50, 4, 781-791 5. Blajer W., Kołodziejczyk K., 2008,Modeling of underactuatedmechanical systems in partly specified motion, Journal of Theoretical and Applied Mechanics, 46, 2, 383-394 6. BlajerW., SeifriedR., 2012, Fromorthogonal to tangential control of underactuatedmechani- cal systems in partly specifiedmotion – a cases study illustration, International Journal of Applied Mechanics and Engineering, 17, 3, 689-706 7. De Luca A., Oriolo G., 2002, Trajectory planning and control for planar robots with passive last joint,The International Journal of Robotics Research, 21, 5/6, 575-590 8. Fantoni I., Lozano R., 2002,Non-linear Control for Underactuated Mechanical Systems, Sprin- ger, London 9. FliessM., Lévine J.,Martin P., RouchonP., 1995,Flatness anddefect of nonlinear systems: introductory theory and examples, International Journal of Control, 61, 6, 1327-1361 10. Kirgetov V.I., 1967, The motion of controlled mechanical systems with prescribed constraints (servoconstraints), Journal of Applied Mathematics and Mechanics, 31, 3, 433-466 11. Kovács L.L., Bencsik L., 2012, Stability case study of theACROBOTERunderactuated service robot,Theoretical and Applied Mechanics Letters, 2, 4, paper ID: 043004 (7 pages) 12. PaulR.P., 1981,RobotManipulators:Mathematics, Programming, andControl,MITPress,Cam- bridge, MA 13. R. Seifried R., 2011, Optimization-based design of minimum phase underactuated multibody systems, [In:]Multibody Dynamics: Computational Methods andApplications, ArczewskiK., Blajer W., Frączek J.,WojtyraM. (Eds.), Springer, Dordrecht, 261-282 14. SeifriedR., 2012a, Integratedmechanicalandcontroldesignofunderactuatedmultibody systems, Nonlinear Dynamics, 67, 2, 1539-1557 15. Seifried R., 2012b,Two approaches for feedforward control and optimal design of underactuated multibody systems,Multibody System Dynamics, 27, 1, 75-93 16. Seifried R., Blajer W., 2013, Analysis of servo-constraint problems for underactuated multi- body systems,Mechanical Sciences, 4, 1, 113-129 17. Spong M.W., 1987, Modeling and control of elastic joint robots, Transactions of the ASME, Journal of Dynamic Systems, Measurements, and Control, 109, 4, 310-319 18. Spong M.W., 1998, Underactuated mechanical systems, [In:] Control Problems in Robotics and Automation, Siciliano B., Valavanis K.P. (Eds.), Springer, London, 135-150 Manuscript received January 7, 2014; accepted for print February 27, 2014