Dynamics and contouring control of a 3-DoF parallel kinematics machine

Abstract In machining applications, instead of tracking error (the difference between the actual position and the desired position), contouring error (the minimum distance from the actual position to the desired trajectory) characterizes product quality. In this paper, we propose a generalized moving task coordinate frames based contouring control for parallel kinematics machines, whose dynamics is in general coupled and strongly nonlinear. The Orthopod, a 3 degree-of-freedom purely translational parallel kinematics machine, is introduced as a control plant. The Lagrange-D’Alembert formulation is used to model the system dynamics. The developed dynamic model in Cartesian space is transformed and parametrized by tangential error, normal error, and binormal error in moving task coordinate frames. The contouring error is then approximated by the normal error and the binormal error, which is the projection of tracking error to the normal plane at the desired position. By employing the structural properties of the transformed dynamics, a special feedback linearization, the computed torque control is applied. It leads to a stabilization problem for a second-order linear time-invariant system. Coulumb plus viscous friction model is used to compensate friction effects. Friction parameters are identified by least-squares approach. For comparison purpose, the tracking error based computed torque control is also carried out. Experiments demonstrate that the proposed control scheme not only leads to improved contouring accuracy, but also produces smaller and smoother control input torques, which may contribute to smaller vibration.

[1]  Lung-Wen Tsai,et al.  Kinematics of A Three-Dof Platform with Three Extensible Limbs , 1996 .

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

[3]  Liping Wang,et al.  Kinematic Analysis of the SPKM165, a 5-Axis Serial-Parallel Kinematic Milling Machine , 2009, ICIRA.

[4]  Zexiang Li,et al.  Quotient Kinematics Machines: Concept, Analysis, and Synthesis , 2011 .

[5]  Damien Chablat,et al.  Kinematic Analysis of a Serial - Parallel Machine Tool: the VERNE machine , 2008, ArXiv.

[6]  Yoram Koren,et al.  Cross-Coupled Biaxial Computer Control for Manufacturing Systems , 1980 .

[7]  Zexiang Li,et al.  Dynamics and control of redundantly actuated parallel manipulators , 2003 .

[8]  Jean-Pierre Merlet,et al.  Parallel Robots , 2000 .

[9]  Masayoshi Tomizuka,et al.  High-performance robust motion control of machine tools: an adaptive robust control approach and comparative experiments , 1997 .

[10]  K. Srinivasan,et al.  Contouring control of Stewart Platform based machine tools , 2004, Proceedings of the 2004 American Control Conference.

[11]  Masayoshi Tomizuka,et al.  Coordinated Position Control of Multi-Axis Mechanical Systems , 1998 .

[12]  Shyh-Leh Chen,et al.  Contouring control of a parallel mechanism based on equivalent errors , 2008, 2008 American Control Conference.

[13]  Shyh-Leh Chen,et al.  Contouring control of biaxial systems based on polar coordinates , 2002 .

[14]  D. Stewart A Platform with Six Degrees of Freedom , 1965 .

[15]  Zexiang Li,et al.  Quotient kinematics machines: Concept, analysis and synthesis , 2008, 2010 IEEE International Conference on Robotics and Automation.

[16]  Damien Chablat,et al.  Architecture optimization of a 3-DOF translational parallel mechanism for machining applications, the orthoglide , 2003, IEEE Trans. Robotics Autom..

[17]  Masayoshi Tomizuka,et al.  Contouring control of machine tool feed drive systems: a task coordinate frame approach , 2001, IEEE Trans. Control. Syst. Technol..

[18]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[19]  Zexiang Li,et al.  Development of a Novel 3-DoF Purely Translational Parallel Mechanism , 2007, ICRA.

[20]  Manfredo P. do Carmo,et al.  Differential geometry of curves and surfaces , 1976 .

[21]  Shuang Cong,et al.  Active Joint Synchronization Control for a 2-DOF Redundantly Actuated Parallel Manipulator , 2009, IEEE Trans. Control. Syst. Technol..

[22]  Shyh-Leh Chen,et al.  Contouring Control of Smooth Paths for Multiaxis Motion Systems Based on Equivalent Errors , 2007, IEEE Transactions on Control Systems Technology.

[23]  L. W. Tsai,et al.  Robot Analysis: The Mechanics of Serial and Parallel Ma-nipulators , 1999 .

[24]  R. Longchamp,et al.  A closed form inverse dynamics model of the delta parallel robot , 1994 .

[25]  Masayoshi Tomizuka,et al.  Zero Phase Error Tracking Algorithm for Digital Control , 1987 .

[26]  Zexiang Li,et al.  Task Space Based Contouring Control of Parallel Machining Systems , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[27]  L. Tsai Solving the Inverse Dynamics of a Stewart-Gough Manipulator by the Principle of Virtual Work , 2000 .

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

[29]  George W. Younkin,et al.  Dynamic Errors in Type 1 Contouring Systems , 1972 .

[30]  Pau-Lo Hsu,et al.  An optimal and adaptive design of the feedforward motion controller , 1999 .

[31]  Lu Ren,et al.  Adaptive Synchronized Control for a Planar Parallel Manipulator: Theory and Experiments , 2006 .