Modeling and set point control of closed-chain mechanisms: theory and experiment

We derive a reduced model, that is, a model in terms of independent generalized coordinates, for the equations of motion of closed-chain mechanisms. We highlight the fact that the model has two special characteristics which make it different from models of open-chain mechanisms. First, it is defined locally in the generalized coordinates. We therefore characterize the domain of validity of the model in which the mechanism satisfies the constraints and is not in a singular configuration. Second, it is an implicit model, that is, parts of the equations of motion are not expressed explicitly. Despite the implicit nature of the equations of motion, we show that closed-chain mechanisms still satisfy a skew symmetry property, and that proportional derivative (PD)-based control with so-called simple gravity compensation guarantees (local) asymptotic stability. We discuss the computational issues involved in the implementation of the proposed controller. The proposed modeling and PD control approach is illustrated experimentally using the Rice planar delta robot which was built to experiment with closed-chain mechanisms.

[1]  S. Ichiraku,et al.  A note on global implicit function theorems , 1985 .

[2]  Yung Ting,et al.  Torque redistribution and time regulation methods for actuator of fault-tolerant parallel robots , 1995, J. Field Robotics.

[3]  Y. Amirat,et al.  Fuzzy adaptation impedance of a 6 DOF parallel robot: application to peg in hole insertion , 1996, Proceedings of IEEE 5th International Fuzzy Systems.

[4]  J. Uicker.  Dynamic Behavior of Spatial Linkages: Part 1—Exact Equations of Motion, Part 2—Small Oscillations About Equilibrium , 1969 .

[5]  Tunc Geveci,et al.  Advanced Calculus , 2014, Nature.

[6]  Olivier Chételat,et al.  Algorithme numérique pour les changements de coordonnées des mécanismes articulés , 1997 .

[7]  Yuan F. Zheng,et al.  Computation of input generalized forces for robots with closed kinematic chain mechanisms , 1985, IEEE J. Robotics Autom..

[8]  Parviz E. Nikravesh,et al.  Systematic Construction of the Equations of Motion for Multibody Systems Containing Closed Kinematic Loops , 1989 .

[9]  I. Sandberg,et al.  Global implicit function theorems , 1981 .

[10]  Michael W. Walker,et al.  Adaptive control of manipulators containing closed kinematic loops , 1990, IEEE Trans. Robotics Autom..

[11]  Clément Gosselin.  Parallel computational algorithms for the kinematics and dynamics of parallel manipulators , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[12]  Fathi H. Ghorbel,et al.  On the boundedness of the Hessian of the potential energy of robot manipulators , 1999, J. Field Robotics.

[13]  George Leitmann,et al.  Dynamics and Control , 2020, Fundamentals of Robotics.

[14]  H. Brauchli.  Mass-orthogonal formulation of equations of motion for multibody systems , 1991 .

[15]  Mark W. Spong,et al.  Robot dynamics and control , 1989 .

[16]  Y. Amirat,et al.  Design and control of a new six dof parallel robot:application to equestrian gait simulation , 1996 .

[17]  Richard A. Tapia,et al.  The Kantorovich Theorem for Newton's Method , 1971 .

[18]  Fathi H. Ghorbel,et al.  A Uniform Bound for the Jacobian of the Gravitational Force Vector for a Class of Robot Manipulators , 1997 .

[19]  Patrizio Tomei,et al.  Adaptive PD controller for robot manipulators , 1991, IEEE Trans. Robotics Autom..

[20]  Shir-Kuan Lin,et al.  Dynamics of the manipulator with closed chains , 1990, IEEE Trans. Robotics Autom..

[21]  Jorge Angeles,et al.  Dynamics of a 3-DOF spatial parallel manipulator with flexible links , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[22]  Leonard S. Haynes,et al.  On the dynamic model and kinematic analysis of a class of Stewart platforms , 1992, Robotics Auton. Syst..

[23]  J. Wittenburg,et al.  Dynamics of systems of rigid bodies , 1977 .

[24]  Romeo Ortega,et al.  Adaptive motion control of rigid robots: a tutorial , 1988, Proceedings of the 27th IEEE Conference on Decision and Control.

[25]  Zhiming Ji.  Study of the effect of leg inertia in Stewart platforms , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[26]  Tojiro Aoyama,et al.  Learning control of a parallel-link direct-drive robot manipulator , 1989 .

[27]  Satoshi Tadokoro.  Control of parallel mechanisms , 1993, Adv. Robotics.

[28]  Jean-Pierre Merlet.  Force-feedback control of parallel manipulators , 1988, Proceedings. 1988 IEEE International Conference on Robotics and Automation.

[29]  Suguru Arimoto,et al.  Stability and robustness of PID feedback control for robot manipulators of sensory capability , 1984 .

[30]  H. Brauchli,et al.  Dynamical equations in natural coordinates , 1991 .

[31]  C. A. Desoer,et al.  Nonlinear Systems Analysis , 1978 .

[32]  P. Dorato,et al.  Survey of robust control for rigid robots , 1991, IEEE Control Systems.

[33]  A. Ostrowski.  Solution of equations and systems of equations , 1967 .

[34]  Ümit Özgüner,et al.  Decentralized control of robot manipulators via state and proportional-integral feedback , 1988, Proceedings. 1988 IEEE International Conference on Robotics and Automation.

[35]  Wisama Khalil,et al.  Identification of the dynamic parameters of a closed loop robot , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[36]  R. Clavel,et al.  A Fast Robot with Parallel Geometry , 1988 .

[37]  D. Stewart,et al.  A Platform with Six Degrees of Freedom , 1965 .

[38]  James D. Lee,et al.  Optimal control of a flexible parallel link robotic manipulator , 1993 .

[39]  C. Innocenti,et al.  Singularity-Free Evolution From One Configuration to Another in Serial and Fully-Parallel Manipulators , 1998 .

[40]  Fathi H. Ghorbel.  Modeling and PD control of closed-chain mechanical systems , 1995, Proceedings of 1995 34th IEEE Conference on Decision and Control.

[41]  Z. Geng,et al.  Dynamic control of a parallel link manipulator using CMAC neural network , 1991, Proceedings of the 1991 IEEE International Symposium on Intelligent Control.

[42]  Fathi Ghorbel.  Adaptive Control of Flexible Joint Robot Manipulators: A Singular Perturbation Approach , 1991 .

[43]  François Pierrot,et al.  Fuzzy sliding mode control of a fast parallel robot , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[44]  Yoshihiko Nakamura,et al.  Dynamics computation of closed-link robot mechanisms with nonredundant and redundant actuators , 1989, IEEE Trans. Robotics Autom..

[45]  James D. Lee,et al.  A dynamic model of a flexible stewart platform , 1993 .

[46]  J. C. Hudgens.  A Fully-Parallel Six Degree-of-Freedom Micromanipulator. Kinematic Analysis and Dynamic Model , 1988 .

[47]  P. Wenger,et al.  A General Criterion for the Identification of Nonsingular Posture Changing 3-DOF Manipulators , 1995 .

[48]  Kok-Meng Lee,et al.  Dynamic analysis of a three-degrees-of-freedom in-parallel actuated manipulator , 1988, IEEE J. Robotics Autom..

[49]  Fathi H. Ghorbel,et al.  On the uniform boundedness of the inertia matrix of serial robot manipulators , 1998, J. Field Robotics.

[50]  John J. Murray,et al.  Dynamic modeling of closed-chain robotic manipulators and implications for trajectory control , 1989, IEEE Trans. Robotics Autom..

[51]  François Pierrot,et al.  Towards a fully-parallel 6 DOF robot for high-speed applications , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.